iwlwifi: mvm: use LIST_HEAD() macro

[linux-2.6/btrfs-unstable.git] / net / rxrpc / recvmsg.c

/* RxRPC recvmsg() implementation
 *
 * Copyright (C) 2007 Red Hat, Inc. All Rights Reserved.
 * Written by David Howells (dhowells@redhat.com)
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * as published by the Free Software Foundation; either version
 * 2 of the License, or (at your option) any later version.
 */

#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

#include <linux/net.h>
#include <linux/skbuff.h>
#include <linux/export.h>
#include <net/sock.h>
#include <net/af_rxrpc.h>
#include "ar-internal.h"

/*
 * Post a call for attention by the socket or kernel service.  Further
 * notifications are suppressed by putting recvmsg_link on a dummy queue.
 */
void rxrpc_notify_socket(struct rxrpc_call *call)
{
        struct rxrpc_sock *rx;
        struct sock *sk;

        _enter("%d", call->debug_id);

        if (!list_empty(&call->recvmsg_link))
                return;

        rcu_read_lock();

        rx = rcu_dereference(call->socket);
        sk = &rx->sk;
        if (rx && sk->sk_state < RXRPC_CLOSE) {
                if (call->notify_rx) {
                        call->notify_rx(sk, call, call->user_call_ID);
                } else {
                        write_lock_bh(&rx->recvmsg_lock);
                        if (list_empty(&call->recvmsg_link)) {
                                rxrpc_get_call(call, rxrpc_call_got);
                                list_add_tail(&call->recvmsg_link, &rx->recvmsg_q);
                        }
                        write_unlock_bh(&rx->recvmsg_lock);

                        if (!sock_flag(sk, SOCK_DEAD)) {
                                _debug("call %ps", sk->sk_data_ready);
                                sk->sk_data_ready(sk);
                        }
                }
        }

        rcu_read_unlock();
        _leave("");
}

/*
 * Pass a call terminating message to userspace.
 */
static int rxrpc_recvmsg_term(struct rxrpc_call *call, struct msghdr *msg)
{
        u32 tmp = 0;
        int ret;

        switch (call->completion) {
        case RXRPC_CALL_SUCCEEDED:
                ret = 0;
                if (rxrpc_is_service_call(call))
                        ret = put_cmsg(msg, SOL_RXRPC, RXRPC_ACK, 0, &tmp);
                break;
        case RXRPC_CALL_REMOTELY_ABORTED:
                tmp = call->abort_code;
                ret = put_cmsg(msg, SOL_RXRPC, RXRPC_ABORT, 4, &tmp);
                break;
        case RXRPC_CALL_LOCALLY_ABORTED:
                tmp = call->abort_code;
                ret = put_cmsg(msg, SOL_RXRPC, RXRPC_ABORT, 4, &tmp);
                break;
        case RXRPC_CALL_NETWORK_ERROR:
                tmp = call->error;
                ret = put_cmsg(msg, SOL_RXRPC, RXRPC_NET_ERROR, 4, &tmp);
                break;
        case RXRPC_CALL_LOCAL_ERROR:
                tmp = call->error;
                ret = put_cmsg(msg, SOL_RXRPC, RXRPC_LOCAL_ERROR, 4, &tmp);
                break;
        default:
                pr_err("Invalid terminal call state %u\n", call->state);
                BUG();
                break;
        }

        return ret;
}

/*
 * Pass back notification of a new call.  The call is added to the
 * to-be-accepted list.  This means that the next call to be accepted might not
 * be the last call seen awaiting acceptance, but unless we leave this on the
 * front of the queue and block all other messages until someone gives us a
 * user_ID for it, there's not a lot we can do.
 */
static int rxrpc_recvmsg_new_call(struct rxrpc_sock *rx,
                                  struct rxrpc_call *call,
                                  struct msghdr *msg, int flags)
{
        int tmp = 0, ret;

        ret = put_cmsg(msg, SOL_RXRPC, RXRPC_NEW_CALL, 0, &tmp);

        if (ret == 0 && !(flags & MSG_PEEK)) {
                _debug("to be accepted");
                write_lock_bh(&rx->recvmsg_lock);
                list_del_init(&call->recvmsg_link);
                write_unlock_bh(&rx->recvmsg_lock);

                rxrpc_get_call(call, rxrpc_call_got);
                write_lock(&rx->call_lock);
                list_add_tail(&call->accept_link, &rx->to_be_accepted);
                write_unlock(&rx->call_lock);
        }

        return ret;
}

/*
 * End the packet reception phase.
 */
static void rxrpc_end_rx_phase(struct rxrpc_call *call)
{
        _enter("%d,%s", call->debug_id, rxrpc_call_states[call->state]);

        if (call->state == RXRPC_CALL_CLIENT_RECV_REPLY) {
                rxrpc_propose_ACK(call, RXRPC_ACK_IDLE, 0, 0, true, false);
                rxrpc_send_call_packet(call, RXRPC_PACKET_TYPE_ACK);
        } else {
                rxrpc_propose_ACK(call, RXRPC_ACK_IDLE, 0, 0, false, false);
        }

        write_lock_bh(&call->state_lock);

        switch (call->state) {
        case RXRPC_CALL_CLIENT_RECV_REPLY:
                __rxrpc_call_completed(call);
                break;

        case RXRPC_CALL_SERVER_RECV_REQUEST:
                call->state = RXRPC_CALL_SERVER_ACK_REQUEST;
                break;
        default:
                break;
        }

        write_unlock_bh(&call->state_lock);
}

/*
 * Discard a packet we've used up and advance the Rx window by one.
 */
static void rxrpc_rotate_rx_window(struct rxrpc_call *call)
{
        struct sk_buff *skb;
        rxrpc_seq_t hard_ack, top;
        int ix;

        _enter("%d", call->debug_id);

        hard_ack = call->rx_hard_ack;
        top = smp_load_acquire(&call->rx_top);
        ASSERT(before(hard_ack, top));

        hard_ack++;
        ix = hard_ack & RXRPC_RXTX_BUFF_MASK;
        skb = call->rxtx_buffer[ix];
        rxrpc_see_skb(skb);
        call->rxtx_buffer[ix] = NULL;
        call->rxtx_annotations[ix] = 0;
        /* Barrier against rxrpc_input_data(). */
        smp_store_release(&call->rx_hard_ack, hard_ack);

        rxrpc_free_skb(skb);

        _debug("%u,%u,%lx", hard_ack, top, call->flags);
        if (hard_ack == top && test_bit(RXRPC_CALL_RX_LAST, &call->flags))
                rxrpc_end_rx_phase(call);
}

/*
 * Decrypt and verify a (sub)packet.  The packet's length may be changed due to
 * padding, but if this is the case, the packet length will be resident in the
 * socket buffer.  Note that we can't modify the master skb info as the skb may
 * be the home to multiple subpackets.
 */
static int rxrpc_verify_packet(struct rxrpc_call *call, struct sk_buff *skb,
                               u8 annotation,
                               unsigned int offset, unsigned int len)
{
        struct rxrpc_skb_priv *sp = rxrpc_skb(skb);
        rxrpc_seq_t seq = sp->hdr.seq;
        u16 cksum = sp->hdr.cksum;

        _enter("");

        /* For all but the head jumbo subpacket, the security checksum is in a
         * jumbo header immediately prior to the data.
         */
        if ((annotation & RXRPC_RX_ANNO_JUMBO) > 1) {
                __be16 tmp;
                if (skb_copy_bits(skb, offset - 2, &tmp, 2) < 0)
                        BUG();
                cksum = ntohs(tmp);
                seq += (annotation & RXRPC_RX_ANNO_JUMBO) - 1;
        }

        return call->conn->security->verify_packet(call, skb, offset, len,
                                                   seq, cksum);
}

/*
 * Locate the data within a packet.  This is complicated by:
 *
 * (1) An skb may contain a jumbo packet - so we have to find the appropriate
 *     subpacket.
 *
 * (2) The (sub)packets may be encrypted and, if so, the encrypted portion
 *     contains an extra header which includes the true length of the data,
 *     excluding any encrypted padding.
 */
static int rxrpc_locate_data(struct rxrpc_call *call, struct sk_buff *skb,
                             u8 *_annotation,
                             unsigned int *_offset, unsigned int *_len)
{
        struct rxrpc_skb_priv *sp = rxrpc_skb(skb);
        unsigned int offset = *_offset;
        unsigned int len = *_len;
        int ret;
        u8 annotation = *_annotation;

        if (offset > 0)
                return 0;

        /* Locate the subpacket */
        offset = sp->offset;
        len = skb->len - sp->offset;
        if ((annotation & RXRPC_RX_ANNO_JUMBO) > 0) {
                offset += (((annotation & RXRPC_RX_ANNO_JUMBO) - 1) *
                           RXRPC_JUMBO_SUBPKTLEN);
                len = (annotation & RXRPC_RX_ANNO_JLAST) ?
                        skb->len - offset : RXRPC_JUMBO_SUBPKTLEN;
        }

        if (!(annotation & RXRPC_RX_ANNO_VERIFIED)) {
                ret = rxrpc_verify_packet(call, skb, annotation, offset, len);
                if (ret < 0)
                        return ret;
                *_annotation |= RXRPC_RX_ANNO_VERIFIED;
        }

        *_offset = offset;
        *_len = len;
        call->conn->security->locate_data(call, skb, _offset, _len);
        return 0;
}

/*
 * Deliver messages to a call.  This keeps processing packets until the buffer
 * is filled and we find either more DATA (returns 0) or the end of the DATA
 * (returns 1).  If more packets are required, it returns -EAGAIN.
 */
static int rxrpc_recvmsg_data(struct socket *sock, struct rxrpc_call *call,
                              struct msghdr *msg, struct iov_iter *iter,
                              size_t len, int flags, size_t *_offset)
{
        struct rxrpc_skb_priv *sp;
        struct sk_buff *skb;
        rxrpc_seq_t hard_ack, top, seq;
        size_t remain;
        bool last;
        unsigned int rx_pkt_offset, rx_pkt_len;
        int ix, copy, ret = 0;

        _enter("");

        rx_pkt_offset = call->rx_pkt_offset;
        rx_pkt_len = call->rx_pkt_len;

        /* Barriers against rxrpc_input_data(). */
        hard_ack = call->rx_hard_ack;
        top = smp_load_acquire(&call->rx_top);
        for (seq = hard_ack + 1; before_eq(seq, top); seq++) {
                ix = seq & RXRPC_RXTX_BUFF_MASK;
                skb = call->rxtx_buffer[ix];
                if (!skb)
                        break;
                smp_rmb();
                rxrpc_see_skb(skb);
                sp = rxrpc_skb(skb);

                if (msg)
                        sock_recv_timestamp(msg, sock->sk, skb);

                ret = rxrpc_locate_data(call, skb, &call->rxtx_annotations[ix],
                                        &rx_pkt_offset, &rx_pkt_len);
                _debug("recvmsg %x DATA #%u { %d, %d }",
                       sp->hdr.callNumber, seq, rx_pkt_offset, rx_pkt_len);

                /* We have to handle short, empty and used-up DATA packets. */
                remain = len - *_offset;
                copy = rx_pkt_len;
                if (copy > remain)
                        copy = remain;
                if (copy > 0) {
                        ret = skb_copy_datagram_iter(skb, rx_pkt_offset, iter,
                                                     copy);
                        if (ret < 0)
                                goto out;

                        /* handle piecemeal consumption of data packets */
                        _debug("copied %d @%zu", copy, *_offset);

                        rx_pkt_offset += copy;
                        rx_pkt_len -= copy;
                        *_offset += copy;
                }

                if (rx_pkt_len > 0) {
                        _debug("buffer full");
                        ASSERTCMP(*_offset, ==, len);
                        break;
                }

                /* The whole packet has been transferred. */
                last = sp->hdr.flags & RXRPC_LAST_PACKET;
                if (!(flags & MSG_PEEK))
                        rxrpc_rotate_rx_window(call);
                rx_pkt_offset = 0;
                rx_pkt_len = 0;

                ASSERTIFCMP(last, seq, ==, top);
        }

        if (after(seq, top)) {
                ret = -EAGAIN;
                if (test_bit(RXRPC_CALL_RX_LAST, &call->flags))
                        ret = 1;
        }
out:
        if (!(flags & MSG_PEEK)) {
                call->rx_pkt_offset = rx_pkt_offset;
                call->rx_pkt_len = rx_pkt_len;
        }
        _leave(" = %d [%u/%u]", ret, seq, top);
        return ret;
}

/*
 * Receive a message from an RxRPC socket
 * - we need to be careful about two or more threads calling recvmsg
 *   simultaneously
 */
int rxrpc_recvmsg(struct socket *sock, struct msghdr *msg, size_t len,
                  int flags)
{
        struct rxrpc_call *call;
        struct rxrpc_sock *rx = rxrpc_sk(sock->sk);
        struct list_head *l;
        size_t copied = 0;
        long timeo;
        int ret;

        DEFINE_WAIT(wait);

        _enter(",,,%zu,%d", len, flags);

        if (flags & (MSG_OOB | MSG_TRUNC))
                return -EOPNOTSUPP;

        timeo = sock_rcvtimeo(&rx->sk, flags & MSG_DONTWAIT);

try_again:
        lock_sock(&rx->sk);

        /* Return immediately if a client socket has no outstanding calls */
        if (RB_EMPTY_ROOT(&rx->calls) &&
            list_empty(&rx->recvmsg_q) &&
            rx->sk.sk_state != RXRPC_SERVER_LISTENING) {
                release_sock(&rx->sk);
                return -ENODATA;
        }

        if (list_empty(&rx->recvmsg_q)) {
                ret = -EWOULDBLOCK;
                if (timeo == 0)
                        goto error_no_call;

                release_sock(&rx->sk);

                /* Wait for something to happen */
                prepare_to_wait_exclusive(sk_sleep(&rx->sk), &wait,
                                          TASK_INTERRUPTIBLE);
                ret = sock_error(&rx->sk);
                if (ret)
                        goto wait_error;

                if (list_empty(&rx->recvmsg_q)) {
                        if (signal_pending(current))
                                goto wait_interrupted;
                        timeo = schedule_timeout(timeo);
                }
                finish_wait(sk_sleep(&rx->sk), &wait);
                goto try_again;
        }

        /* Find the next call and dequeue it if we're not just peeking.  If we
         * do dequeue it, that comes with a ref that we will need to release.
         */
        write_lock_bh(&rx->recvmsg_lock);
        l = rx->recvmsg_q.next;
        call = list_entry(l, struct rxrpc_call, recvmsg_link);
        if (!(flags & MSG_PEEK))
                list_del_init(&call->recvmsg_link);
        else
                rxrpc_get_call(call, rxrpc_call_got);
        write_unlock_bh(&rx->recvmsg_lock);

        _debug("recvmsg call %p", call);

        if (test_bit(RXRPC_CALL_RELEASED, &call->flags))
                BUG();

        if (test_bit(RXRPC_CALL_HAS_USERID, &call->flags)) {
                if (flags & MSG_CMSG_COMPAT) {
                        unsigned int id32 = call->user_call_ID;

                        ret = put_cmsg(msg, SOL_RXRPC, RXRPC_USER_CALL_ID,
                                       sizeof(unsigned int), &id32);
                } else {
                        ret = put_cmsg(msg, SOL_RXRPC, RXRPC_USER_CALL_ID,
                                       sizeof(unsigned long),
                                       &call->user_call_ID);
                }
                if (ret < 0)
                        goto error;
        }

        if (msg->msg_name) {
                size_t len = sizeof(call->conn->params.peer->srx);
                memcpy(msg->msg_name, &call->conn->params.peer->srx, len);
                msg->msg_namelen = len;
        }

        switch (call->state) {
        case RXRPC_CALL_SERVER_ACCEPTING:
                ret = rxrpc_recvmsg_new_call(rx, call, msg, flags);
                break;
        case RXRPC_CALL_CLIENT_RECV_REPLY:
        case RXRPC_CALL_SERVER_RECV_REQUEST:
        case RXRPC_CALL_SERVER_ACK_REQUEST:
                ret = rxrpc_recvmsg_data(sock, call, msg, &msg->msg_iter, len,
                                         flags, &copied);
                if (ret == -EAGAIN)
                        ret = 0;

                if (after(call->rx_top, call->rx_hard_ack) &&
                    call->rxtx_buffer[(call->rx_hard_ack + 1) & RXRPC_RXTX_BUFF_MASK])
                        rxrpc_notify_socket(call);
                break;
        default:
                ret = 0;
                break;
        }

        if (ret < 0)
                goto error;

        if (call->state == RXRPC_CALL_COMPLETE) {
                ret = rxrpc_recvmsg_term(call, msg);
                if (ret < 0)
                        goto error;
                if (!(flags & MSG_PEEK))
                        rxrpc_release_call(rx, call);
                msg->msg_flags |= MSG_EOR;
                ret = 1;
        }

        if (ret == 0)
                msg->msg_flags |= MSG_MORE;
        else
                msg->msg_flags &= ~MSG_MORE;
        ret = copied;

error:
        rxrpc_put_call(call, rxrpc_call_put);
error_no_call:
        release_sock(&rx->sk);
        _leave(" = %d", ret);
        return ret;

wait_interrupted:
        ret = sock_intr_errno(timeo);
wait_error:
        finish_wait(sk_sleep(&rx->sk), &wait);
        release_sock(&rx->sk);
        _leave(" = %d [wait]", ret);
        return ret;
}

/**
 * rxrpc_kernel_recv_data - Allow a kernel service to receive data/info
 * @sock: The socket that the call exists on
 * @call: The call to send data through
 * @buf: The buffer to receive into
 * @size: The size of the buffer, including data already read
 * @_offset: The running offset into the buffer.
 * @want_more: True if more data is expected to be read
 * @_abort: Where the abort code is stored if -ECONNABORTED is returned
 *
 * Allow a kernel service to receive data and pick up information about the
 * state of a call.  Returns 0 if got what was asked for and there's more
 * available, 1 if we got what was asked for and we're at the end of the data
 * and -EAGAIN if we need more data.
 *
 * Note that we may return -EAGAIN to drain empty packets at the end of the
 * data, even if we've already copied over the requested data.
 *
 * This function adds the amount it transfers to *_offset, so this should be
 * precleared as appropriate.  Note that the amount remaining in the buffer is
 * taken to be size - *_offset.
 *
 * *_abort should also be initialised to 0.
 */
int rxrpc_kernel_recv_data(struct socket *sock, struct rxrpc_call *call,
                           void *buf, size_t size, size_t *_offset,
                           bool want_more, u32 *_abort)
{
        struct iov_iter iter;
        struct kvec iov;
        int ret;

        _enter("{%d,%s},%zu/%zu,%d",
               call->debug_id, rxrpc_call_states[call->state],
               *_offset, size, want_more);

        ASSERTCMP(*_offset, <=, size);
        ASSERTCMP(call->state, !=, RXRPC_CALL_SERVER_ACCEPTING);

        iov.iov_base = buf + *_offset;
        iov.iov_len = size - *_offset;
        iov_iter_kvec(&iter, ITER_KVEC | READ, &iov, 1, size - *_offset);

        lock_sock(sock->sk);

        switch (call->state) {
        case RXRPC_CALL_CLIENT_RECV_REPLY:
        case RXRPC_CALL_SERVER_RECV_REQUEST:
        case RXRPC_CALL_SERVER_ACK_REQUEST:
                ret = rxrpc_recvmsg_data(sock, call, NULL, &iter, size, 0,
                                         _offset);
                if (ret < 0)
                        goto out;

                /* We can only reach here with a partially full buffer if we
                 * have reached the end of the data.  We must otherwise have a
                 * full buffer or have been given -EAGAIN.
                 */
                if (ret == 1) {
                        if (*_offset < size)
                                goto short_data;
                        if (!want_more)
                                goto read_phase_complete;
                        ret = 0;
                        goto out;
                }

                if (!want_more)
                        goto excess_data;
                goto out;

        case RXRPC_CALL_COMPLETE:
                goto call_complete;

        default:
                ret = -EINPROGRESS;
                goto out;
        }

read_phase_complete:
        ret = 1;
out:
        release_sock(sock->sk);
        _leave(" = %d [%zu,%d]", ret, *_offset, *_abort);
        return ret;

short_data:
        ret = -EBADMSG;
        goto out;
excess_data:
        ret = -EMSGSIZE;
        goto out;
call_complete:
        *_abort = call->abort_code;
        ret = call->error;
        if (call->completion == RXRPC_CALL_SUCCEEDED) {
                ret = 1;
                if (size > 0)
                        ret = -ECONNRESET;
        }
        goto out;
}
EXPORT_SYMBOL(rxrpc_kernel_recv_data);