net/rxrpc/ar-output.c - android_kernel_htc_msm8960 - Gitiles

 /* RxRPC packet transmission
  *
  * 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.
  */

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

 int rxrpc_resend_timeout = 4;

 static int rxrpc_send_data(struct kiocb *iocb,
 			   struct rxrpc_sock *rx,
 			   struct rxrpc_call *call,
 			   struct msghdr *msg, size_t len);

 /*
  * extract control messages from the sendmsg() control buffer
  */
 static int rxrpc_sendmsg_cmsg(struct rxrpc_sock *rx, struct msghdr *msg,
 			      unsigned long *user_call_ID,
 			      enum rxrpc_command *command,
 			      u32 *abort_code,
 			      bool server)
 {
 	struct cmsghdr *cmsg;
 	int len;

 	*command = RXRPC_CMD_SEND_DATA;

 	if (msg->msg_controllen == 0)
 		return -EINVAL;

 	for (cmsg = CMSG_FIRSTHDR(msg); cmsg; cmsg = CMSG_NXTHDR(msg, cmsg)) {
 		if (!CMSG_OK(msg, cmsg))
 			return -EINVAL;

 		len = cmsg->cmsg_len - CMSG_ALIGN(sizeof(struct cmsghdr));
 		_debug("CMSG %d, %d, %d",
 		       cmsg->cmsg_level, cmsg->cmsg_type, len);

 		if (cmsg->cmsg_level != SOL_RXRPC)
 			continue;

 		switch (cmsg->cmsg_type) {
 		case RXRPC_USER_CALL_ID:
 			if (msg->msg_flags & MSG_CMSG_COMPAT) {
 				if (len != sizeof(u32))
 					return -EINVAL;
 				*user_call_ID = *(u32 *) CMSG_DATA(cmsg);
 			} else {
 				if (len != sizeof(unsigned long))
 					return -EINVAL;
 				*user_call_ID = *(unsigned long *)
 					CMSG_DATA(cmsg);
 			}
 			_debug("User Call ID %lx", *user_call_ID);
 			break;

 		case RXRPC_ABORT:
 			if (*command != RXRPC_CMD_SEND_DATA)
 				return -EINVAL;
 			*command = RXRPC_CMD_SEND_ABORT;
 			if (len != sizeof(*abort_code))
 				return -EINVAL;
 			*abort_code = *(unsigned int *) CMSG_DATA(cmsg);
 			_debug("Abort %x", *abort_code);
 			if (*abort_code == 0)
 				return -EINVAL;
 			break;

 		case RXRPC_ACCEPT:
 			if (*command != RXRPC_CMD_SEND_DATA)
 				return -EINVAL;
 			*command = RXRPC_CMD_ACCEPT;
 			if (len != 0)
 				return -EINVAL;
 			if (!server)
 				return -EISCONN;
 			break;

 		default:
 			return -EINVAL;
 		}
 	}

 	_leave(" = 0");
 	return 0;
 }

 /*
  * abort a call, sending an ABORT packet to the peer
  */
 static void rxrpc_send_abort(struct rxrpc_call *call, u32 abort_code)
 {
 	write_lock_bh(&call->state_lock);

 	if (call->state <= RXRPC_CALL_COMPLETE) {
 		call->state = RXRPC_CALL_LOCALLY_ABORTED;
 		call->abort_code = abort_code;
 		set_bit(RXRPC_CALL_ABORT, &call->events);
 		del_timer_sync(&call->resend_timer);
 		del_timer_sync(&call->ack_timer);
 		clear_bit(RXRPC_CALL_RESEND_TIMER, &call->events);
 		clear_bit(RXRPC_CALL_ACK, &call->events);
 		clear_bit(RXRPC_CALL_RUN_RTIMER, &call->flags);
 		rxrpc_queue_call(call);
 	}

 	write_unlock_bh(&call->state_lock);
 }

 /*
  * send a message forming part of a client call through an RxRPC socket
  * - caller holds the socket locked
  * - the socket may be either a client socket or a server socket
  */
 int rxrpc_client_sendmsg(struct kiocb *iocb, struct rxrpc_sock *rx,
 			 struct rxrpc_transport *trans, struct msghdr *msg,
 			 size_t len)
 {
 	struct rxrpc_conn_bundle *bundle;
 	enum rxrpc_command cmd;
 	struct rxrpc_call *call;
 	unsigned long user_call_ID = 0;
 	struct key *key;
 	__be16 service_id;
 	u32 abort_code = 0;
 	int ret;

 	_enter("");

 	ASSERT(trans != NULL);

 	ret = rxrpc_sendmsg_cmsg(rx, msg, &user_call_ID, &cmd, &abort_code,
 				 false);
 	if (ret < 0)
 		return ret;

 	bundle = NULL;
 	if (trans) {
 		service_id = rx->service_id;
 		if (msg->msg_name) {
 			struct sockaddr_rxrpc *srx =
 				(struct sockaddr_rxrpc *) msg->msg_name;
 			service_id = htons(srx->srx_service);
 		}
 		key = rx->key;
 		if (key && !rx->key->payload.data)
 			key = NULL;
 		bundle = rxrpc_get_bundle(rx, trans, key, service_id,
 					  GFP_KERNEL);
 		if (IS_ERR(bundle))
 			return PTR_ERR(bundle);
 	}

 	call = rxrpc_get_client_call(rx, trans, bundle, user_call_ID,
 				     abort_code == 0, GFP_KERNEL);
 	if (trans)
 		rxrpc_put_bundle(trans, bundle);
 	if (IS_ERR(call)) {
 		_leave(" = %ld", PTR_ERR(call));
 		return PTR_ERR(call);
 	}

 	_debug("CALL %d USR %lx ST %d on CONN %p",
 	       call->debug_id, call->user_call_ID, call->state, call->conn);

 	if (call->state >= RXRPC_CALL_COMPLETE) {
 		/* it's too late for this call */
 		ret = -ESHUTDOWN;
 	} else if (cmd == RXRPC_CMD_SEND_ABORT) {
 		rxrpc_send_abort(call, abort_code);
 	} else if (cmd != RXRPC_CMD_SEND_DATA) {
 		ret = -EINVAL;
 	} else if (call->state != RXRPC_CALL_CLIENT_SEND_REQUEST) {
 		/* request phase complete for this client call */
 		ret = -EPROTO;
 	} else {
 		ret = rxrpc_send_data(iocb, rx, call, msg, len);
 	}

 	rxrpc_put_call(call);
 	_leave(" = %d", ret);
 	return ret;
 }

 /**
  * rxrpc_kernel_send_data - Allow a kernel service to send data on a call
  * @call: The call to send data through
  * @msg: The data to send
  * @len: The amount of data to send
  *
  * Allow a kernel service to send data on a call.  The call must be in an state
  * appropriate to sending data.  No control data should be supplied in @msg,
  * nor should an address be supplied.  MSG_MORE should be flagged if there's
  * more data to come, otherwise this data will end the transmission phase.
  */
 int rxrpc_kernel_send_data(struct rxrpc_call *call, struct msghdr *msg,
 			   size_t len)
 {
 	int ret;

 	_enter("{%d,%s},", call->debug_id, rxrpc_call_states[call->state]);

 	ASSERTCMP(msg->msg_name, ==, NULL);
 	ASSERTCMP(msg->msg_control, ==, NULL);

 	lock_sock(&call->socket->sk);

 	_debug("CALL %d USR %lx ST %d on CONN %p",
 	       call->debug_id, call->user_call_ID, call->state, call->conn);

 	if (call->state >= RXRPC_CALL_COMPLETE) {
 		ret = -ESHUTDOWN; /* it's too late for this call */
 	} else if (call->state != RXRPC_CALL_CLIENT_SEND_REQUEST &&
 		   call->state != RXRPC_CALL_SERVER_ACK_REQUEST &&
 		   call->state != RXRPC_CALL_SERVER_SEND_REPLY) {
 		ret = -EPROTO; /* request phase complete for this client call */
 	} else {
 		mm_segment_t oldfs = get_fs();
 		set_fs(KERNEL_DS);
 		ret = rxrpc_send_data(NULL, call->socket, call, msg, len);
 		set_fs(oldfs);
 	}

 	release_sock(&call->socket->sk);
 	_leave(" = %d", ret);
 	return ret;
 }

 EXPORT_SYMBOL(rxrpc_kernel_send_data);

 /*
  * rxrpc_kernel_abort_call - Allow a kernel service to abort a call
  * @call: The call to be aborted
  * @abort_code: The abort code to stick into the ABORT packet
  *
  * Allow a kernel service to abort a call, if it's still in an abortable state.
  */
 void rxrpc_kernel_abort_call(struct rxrpc_call *call, u32 abort_code)
 {
 	_enter("{%d},%d", call->debug_id, abort_code);

 	lock_sock(&call->socket->sk);

 	_debug("CALL %d USR %lx ST %d on CONN %p",
 	       call->debug_id, call->user_call_ID, call->state, call->conn);

 	if (call->state < RXRPC_CALL_COMPLETE)
 		rxrpc_send_abort(call, abort_code);

 	release_sock(&call->socket->sk);
 	_leave("");
 }

 EXPORT_SYMBOL(rxrpc_kernel_abort_call);

 /*
  * send a message through a server socket
  * - caller holds the socket locked
  */
 int rxrpc_server_sendmsg(struct kiocb *iocb, struct rxrpc_sock *rx,
 			 struct msghdr *msg, size_t len)
 {
 	enum rxrpc_command cmd;
 	struct rxrpc_call *call;
 	unsigned long user_call_ID = 0;
 	u32 abort_code = 0;
 	int ret;

 	_enter("");

 	ret = rxrpc_sendmsg_cmsg(rx, msg, &user_call_ID, &cmd, &abort_code,
 				 true);
 	if (ret < 0)
 		return ret;

 	if (cmd == RXRPC_CMD_ACCEPT) {
 		call = rxrpc_accept_call(rx, user_call_ID);
 		if (IS_ERR(call))
 			return PTR_ERR(call);
 		rxrpc_put_call(call);
 		return 0;
 	}

 	call = rxrpc_find_server_call(rx, user_call_ID);
 	if (!call)
 		return -EBADSLT;
 	if (call->state >= RXRPC_CALL_COMPLETE) {
 		ret = -ESHUTDOWN;
 		goto out;
 	}

 	switch (cmd) {
 	case RXRPC_CMD_SEND_DATA:
 		if (call->state != RXRPC_CALL_CLIENT_SEND_REQUEST &&
 		    call->state != RXRPC_CALL_SERVER_ACK_REQUEST &&
 		    call->state != RXRPC_CALL_SERVER_SEND_REPLY) {
 			/* Tx phase not yet begun for this call */
 			ret = -EPROTO;
 			break;
 		}

 		ret = rxrpc_send_data(iocb, rx, call, msg, len);
 		break;

 	case RXRPC_CMD_SEND_ABORT:
 		rxrpc_send_abort(call, abort_code);
 		break;
 	default:
 		BUG();
 	}

 	out:
 	rxrpc_put_call(call);
 	_leave(" = %d", ret);
 	return ret;
 }

 /*
  * send a packet through the transport endpoint
  */
 int rxrpc_send_packet(struct rxrpc_transport *trans, struct sk_buff *skb)
 {
 	struct kvec iov[1];
 	struct msghdr msg;
 	int ret, opt;

 	_enter(",{%d}", skb->len);

 	iov[0].iov_base = skb->head;
 	iov[0].iov_len = skb->len;

 	msg.msg_name = &trans->peer->srx.transport.sin;
 	msg.msg_namelen = sizeof(trans->peer->srx.transport.sin);
 	msg.msg_control = NULL;
 	msg.msg_controllen = 0;
 	msg.msg_flags = 0;

 	/* send the packet with the don't fragment bit set if we currently
 	 * think it's small enough */
 	if (skb->len - sizeof(struct rxrpc_header) < trans->peer->maxdata) {
 		down_read(&trans->local->defrag_sem);
 		/* send the packet by UDP
 		 * - returns -EMSGSIZE if UDP would have to fragment the packet
 		 *   to go out of the interface
 		 *   - in which case, we'll have processed the ICMP error
 		 *     message and update the peer record
 		 */
 		ret = kernel_sendmsg(trans->local->socket, &msg, iov, 1,
 				     iov[0].iov_len);

 		up_read(&trans->local->defrag_sem);
 		if (ret == -EMSGSIZE)
 			goto send_fragmentable;

 		_leave(" = %d [%u]", ret, trans->peer->maxdata);
 		return ret;
 	}

 send_fragmentable:
 	/* attempt to send this message with fragmentation enabled */
 	_debug("send fragment");

 	down_write(&trans->local->defrag_sem);
 	opt = IP_PMTUDISC_DONT;
 	ret = kernel_setsockopt(trans->local->socket, SOL_IP, IP_MTU_DISCOVER,
 				(char *) &opt, sizeof(opt));
 	if (ret == 0) {
 		ret = kernel_sendmsg(trans->local->socket, &msg, iov, 1,
 				     iov[0].iov_len);

 		opt = IP_PMTUDISC_DO;
 		kernel_setsockopt(trans->local->socket, SOL_IP,
 				  IP_MTU_DISCOVER, (char *) &opt, sizeof(opt));
 	}

 	up_write(&trans->local->defrag_sem);
 	_leave(" = %d [frag %u]", ret, trans->peer->maxdata);
 	return ret;
 }

 /*
  * wait for space to appear in the transmit/ACK window
  * - caller holds the socket locked
  */
 static int rxrpc_wait_for_tx_window(struct rxrpc_sock *rx,
 				    struct rxrpc_call *call,
 				    long *timeo)
 {
 	DECLARE_WAITQUEUE(myself, current);
 	int ret;

 	_enter(",{%d},%ld",
 	       CIRC_SPACE(call->acks_head, call->acks_tail, call->acks_winsz),
 	       *timeo);

 	add_wait_queue(&call->tx_waitq, &myself);

 	for (;;) {
 		set_current_state(TASK_INTERRUPTIBLE);
 		ret = 0;
 		if (CIRC_SPACE(call->acks_head, call->acks_tail,
 			       call->acks_winsz) > 0)
 			break;
 		if (signal_pending(current)) {
 			ret = sock_intr_errno(*timeo);
 			break;
 		}

 		release_sock(&rx->sk);
 		*timeo = schedule_timeout(*timeo);
 		lock_sock(&rx->sk);
 	}

 	remove_wait_queue(&call->tx_waitq, &myself);
 	set_current_state(TASK_RUNNING);
 	_leave(" = %d", ret);
 	return ret;
 }

 /*
  * attempt to schedule an instant Tx resend
  */
 static inline void rxrpc_instant_resend(struct rxrpc_call *call)
 {
 	read_lock_bh(&call->state_lock);
 	if (try_to_del_timer_sync(&call->resend_timer) >= 0) {
 		clear_bit(RXRPC_CALL_RUN_RTIMER, &call->flags);
 		if (call->state < RXRPC_CALL_COMPLETE &&
 		    !test_and_set_bit(RXRPC_CALL_RESEND_TIMER, &call->events))
 			rxrpc_queue_call(call);
 	}
 	read_unlock_bh(&call->state_lock);
 }

 /*
  * queue a packet for transmission, set the resend timer and attempt
  * to send the packet immediately
  */
 static void rxrpc_queue_packet(struct rxrpc_call *call, struct sk_buff *skb,
 			       bool last)
 {
 	struct rxrpc_skb_priv *sp = rxrpc_skb(skb);
 	int ret;

 	_net("queue skb %p [%d]", skb, call->acks_head);

 	ASSERT(call->acks_window != NULL);
 	call->acks_window[call->acks_head] = (unsigned long) skb;
 	smp_wmb();
 	call->acks_head = (call->acks_head + 1) & (call->acks_winsz - 1);

 	if (last || call->state == RXRPC_CALL_SERVER_ACK_REQUEST) {
 		_debug("________awaiting reply/ACK__________");
 		write_lock_bh(&call->state_lock);
 		switch (call->state) {
 		case RXRPC_CALL_CLIENT_SEND_REQUEST:
 			call->state = RXRPC_CALL_CLIENT_AWAIT_REPLY;
 			break;
 		case RXRPC_CALL_SERVER_ACK_REQUEST:
 			call->state = RXRPC_CALL_SERVER_SEND_REPLY;
 			if (!last)
 				break;
 		case RXRPC_CALL_SERVER_SEND_REPLY:
 			call->state = RXRPC_CALL_SERVER_AWAIT_ACK;
 			break;
 		default:
 			break;
 		}
 		write_unlock_bh(&call->state_lock);
 	}

 	_proto("Tx DATA %%%u { #%u }",
 	       ntohl(sp->hdr.serial), ntohl(sp->hdr.seq));

 	sp->need_resend = 0;
 	sp->resend_at = jiffies + rxrpc_resend_timeout * HZ;
 	if (!test_and_set_bit(RXRPC_CALL_RUN_RTIMER, &call->flags)) {
 		_debug("run timer");
 		call->resend_timer.expires = sp->resend_at;
 		add_timer(&call->resend_timer);
 	}

 	/* attempt to cancel the rx-ACK timer, deferring reply transmission if
 	 * we're ACK'ing the request phase of an incoming call */
 	ret = -EAGAIN;
 	if (try_to_del_timer_sync(&call->ack_timer) >= 0) {
 		/* the packet may be freed by rxrpc_process_call() before this
 		 * returns */
 		ret = rxrpc_send_packet(call->conn->trans, skb);
 		_net("sent skb %p", skb);
 	} else {
 		_debug("failed to delete ACK timer");
 	}

 	if (ret < 0) {
 		_debug("need instant resend %d", ret);
 		sp->need_resend = 1;
 		rxrpc_instant_resend(call);
 	}

 	_leave("");
 }

 /*
  * send data through a socket
  * - must be called in process context
  * - caller holds the socket locked
  */
 static int rxrpc_send_data(struct kiocb *iocb,
 			   struct rxrpc_sock *rx,
 			   struct rxrpc_call *call,
 			   struct msghdr *msg, size_t len)
 {
 	struct rxrpc_skb_priv *sp;
 	unsigned char __user *from;
 	struct sk_buff *skb;
 	struct iovec *iov;
 	struct sock *sk = &rx->sk;
 	long timeo;
 	bool more;
 	int ret, ioc, segment, copied;

 	_enter(",,,{%zu},%zu", msg->msg_iovlen, len);

 	timeo = sock_sndtimeo(sk, msg->msg_flags & MSG_DONTWAIT);

 	/* this should be in poll */
 	clear_bit(SOCK_ASYNC_NOSPACE, &sk->sk_socket->flags);

 	if (sk->sk_err || (sk->sk_shutdown & SEND_SHUTDOWN))
 		return -EPIPE;

 	iov = msg->msg_iov;
 	ioc = msg->msg_iovlen - 1;
 	from = iov->iov_base;
 	segment = iov->iov_len;
 	iov++;
 	more = msg->msg_flags & MSG_MORE;

 	skb = call->tx_pending;
 	call->tx_pending = NULL;

 	copied = 0;
 	do {
 		int copy;

 		if (segment > len)
 			segment = len;

 		_debug("SEGMENT %d @%p", segment, from);

 		if (!skb) {
 			size_t size, chunk, max, space;

 			_debug("alloc");

 			if (CIRC_SPACE(call->acks_head, call->acks_tail,
 				       call->acks_winsz) <= 0) {
 				ret = -EAGAIN;
 				if (msg->msg_flags & MSG_DONTWAIT)
 					goto maybe_error;
 				ret = rxrpc_wait_for_tx_window(rx, call,
 							       &timeo);
 				if (ret < 0)
 					goto maybe_error;
 			}

 			max = call->conn->trans->peer->maxdata;
 			max -= call->conn->security_size;
 			max &= ~(call->conn->size_align - 1UL);

 			chunk = max;
 			if (chunk > len && !more)
 				chunk = len;

 			space = chunk + call->conn->size_align;
 			space &= ~(call->conn->size_align - 1UL);

 			size = space + call->conn->header_size;

 			_debug("SIZE: %zu/%zu/%zu", chunk, space, size);

 			/* create a buffer that we can retain until it's ACK'd */
 			skb = sock_alloc_send_skb(
 				sk, size, msg->msg_flags & MSG_DONTWAIT, &ret);
 			if (!skb)
 				goto maybe_error;

 			rxrpc_new_skb(skb);

 			_debug("ALLOC SEND %p", skb);

 			ASSERTCMP(skb->mark, ==, 0);

 			_debug("HS: %u", call->conn->header_size);
 			skb_reserve(skb, call->conn->header_size);
 			skb->len += call->conn->header_size;

 			sp = rxrpc_skb(skb);
 			sp->remain = chunk;
 			if (sp->remain > skb_tailroom(skb))
 				sp->remain = skb_tailroom(skb);

 			_net("skb: hr %d, tr %d, hl %d, rm %d",
 			       skb_headroom(skb),
 			       skb_tailroom(skb),
 			       skb_headlen(skb),
 			       sp->remain);

 			skb->ip_summed = CHECKSUM_UNNECESSARY;
 		}

 		_debug("append");
 		sp = rxrpc_skb(skb);

 		/* append next segment of data to the current buffer */
 		copy = skb_tailroom(skb);
 		ASSERTCMP(copy, >, 0);
 		if (copy > segment)
 			copy = segment;
 		if (copy > sp->remain)
 			copy = sp->remain;

 		_debug("add");
 		ret = skb_add_data(skb, from, copy);
 		_debug("added");
 		if (ret < 0)
 			goto efault;
 		sp->remain -= copy;
 		skb->mark += copy;
 		copied += copy;

 		len -= copy;
 		segment -= copy;
 		from += copy;
 		while (segment == 0 && ioc > 0) {
 			from = iov->iov_base;
 			segment = iov->iov_len;
 			iov++;
 			ioc--;
 		}
 		if (len == 0) {
 			segment = 0;
 			ioc = 0;
 		}

 		/* check for the far side aborting the call or a network error
 		 * occurring */
 		if (call->state > RXRPC_CALL_COMPLETE)
 			goto call_aborted;

 		/* add the packet to the send queue if it's now full */
 		if (sp->remain <= 0 || (segment == 0 && !more)) {
 			struct rxrpc_connection *conn = call->conn;
 			size_t pad;

 			/* pad out if we're using security */
 			if (conn->security) {
 				pad = conn->security_size + skb->mark;
 				pad = conn->size_align - pad;
 				pad &= conn->size_align - 1;
 				_debug("pad %zu", pad);
 				if (pad)
 					memset(skb_put(skb, pad), 0, pad);
 			}

 			sp->hdr.epoch = conn->epoch;
 			sp->hdr.cid = call->cid;
 			sp->hdr.callNumber = call->call_id;
 			sp->hdr.seq =
 				htonl(atomic_inc_return(&call->sequence));
 			sp->hdr.serial =
 				htonl(atomic_inc_return(&conn->serial));
 			sp->hdr.type = RXRPC_PACKET_TYPE_DATA;
 			sp->hdr.userStatus = 0;
 			sp->hdr.securityIndex = conn->security_ix;
 			sp->hdr._rsvd = 0;
 			sp->hdr.serviceId = conn->service_id;

 			sp->hdr.flags = conn->out_clientflag;
 			if (len == 0 && !more)
 				sp->hdr.flags |= RXRPC_LAST_PACKET;
 			else if (CIRC_SPACE(call->acks_head, call->acks_tail,
 					    call->acks_winsz) > 1)
 				sp->hdr.flags |= RXRPC_MORE_PACKETS;

 			ret = rxrpc_secure_packet(
 				call, skb, skb->mark,
 				skb->head + sizeof(struct rxrpc_header));
 			if (ret < 0)
 				goto out;

 			memcpy(skb->head, &sp->hdr,
 			       sizeof(struct rxrpc_header));
 			rxrpc_queue_packet(call, skb, segment == 0 && !more);
 			skb = NULL;
 		}

 	} while (segment > 0);

 success:
 	ret = copied;
 out:
 	call->tx_pending = skb;
 	_leave(" = %d", ret);
 	return ret;

 call_aborted:
 	rxrpc_free_skb(skb);
 	if (call->state == RXRPC_CALL_NETWORK_ERROR)
 		ret = call->conn->trans->peer->net_error;
 	else
 		ret = -ECONNABORTED;
 	_leave(" = %d", ret);
 	return ret;

 maybe_error:
 	if (copied)
 		goto success;
 	goto out;

 efault:
 	ret = -EFAULT;
 	goto out;
 }
	/* RxRPC packet transmission
	*
	* 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.
	*/

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

	int rxrpc_resend_timeout = 4;

	static int rxrpc_send_data(struct kiocb *iocb,
	struct rxrpc_sock *rx,
	struct rxrpc_call *call,
	struct msghdr *msg, size_t len);

	/*
	* extract control messages from the sendmsg() control buffer
	*/
	static int rxrpc_sendmsg_cmsg(struct rxrpc_sock rx, struct msghdr msg,
	unsigned long *user_call_ID,
	enum rxrpc_command *command,
	u32 *abort_code,
	bool server)
	{
	struct cmsghdr *cmsg;
	int len;

	*command = RXRPC_CMD_SEND_DATA;

	if (msg->msg_controllen == 0)
	return -EINVAL;

	for (cmsg = CMSG_FIRSTHDR(msg); cmsg; cmsg = CMSG_NXTHDR(msg, cmsg)) {
	if (!CMSG_OK(msg, cmsg))
	return -EINVAL;

	len = cmsg->cmsg_len - CMSG_ALIGN(sizeof(struct cmsghdr));
	_debug("CMSG %d, %d, %d",
	cmsg->cmsg_level, cmsg->cmsg_type, len);

	if (cmsg->cmsg_level != SOL_RXRPC)
	continue;

	switch (cmsg->cmsg_type) {
	case RXRPC_USER_CALL_ID:
	if (msg->msg_flags & MSG_CMSG_COMPAT) {
	if (len != sizeof(u32))
	return -EINVAL;
	user_call_ID = (u32 *) CMSG_DATA(cmsg);
	} else {
	if (len != sizeof(unsigned long))
	return -EINVAL;
	user_call_ID = (unsigned long *)
	CMSG_DATA(cmsg);
	}
	_debug("User Call ID %lx", *user_call_ID);
	break;

	case RXRPC_ABORT:
	if (*command != RXRPC_CMD_SEND_DATA)
	return -EINVAL;
	*command = RXRPC_CMD_SEND_ABORT;
	if (len != sizeof(*abort_code))
	return -EINVAL;
	abort_code = (unsigned int *) CMSG_DATA(cmsg);
	_debug("Abort %x", *abort_code);
	if (*abort_code == 0)
	return -EINVAL;
	break;

	case RXRPC_ACCEPT:
	if (*command != RXRPC_CMD_SEND_DATA)
	return -EINVAL;
	*command = RXRPC_CMD_ACCEPT;
	if (len != 0)
	return -EINVAL;
	if (!server)
	return -EISCONN;
	break;

	default:
	return -EINVAL;
	}
	}

	_leave(" = 0");
	return 0;
	}

	/*
	* abort a call, sending an ABORT packet to the peer
	*/
	static void rxrpc_send_abort(struct rxrpc_call *call, u32 abort_code)
	{
	write_lock_bh(&call->state_lock);

	if (call->state <= RXRPC_CALL_COMPLETE) {
	call->state = RXRPC_CALL_LOCALLY_ABORTED;
	call->abort_code = abort_code;
	set_bit(RXRPC_CALL_ABORT, &call->events);
	del_timer_sync(&call->resend_timer);
	del_timer_sync(&call->ack_timer);
	clear_bit(RXRPC_CALL_RESEND_TIMER, &call->events);
	clear_bit(RXRPC_CALL_ACK, &call->events);
	clear_bit(RXRPC_CALL_RUN_RTIMER, &call->flags);
	rxrpc_queue_call(call);
	}

	write_unlock_bh(&call->state_lock);
	}

	/*
	* send a message forming part of a client call through an RxRPC socket
	* - caller holds the socket locked
	* - the socket may be either a client socket or a server socket
	*/
	int rxrpc_client_sendmsg(struct kiocb iocb, struct rxrpc_sock rx,
	struct rxrpc_transport trans, struct msghdr msg,
	size_t len)
	{
	struct rxrpc_conn_bundle *bundle;
	enum rxrpc_command cmd;
	struct rxrpc_call *call;
	unsigned long user_call_ID = 0;
	struct key *key;
	__be16 service_id;
	u32 abort_code = 0;
	int ret;

	_enter("");

	ASSERT(trans != NULL);

	ret = rxrpc_sendmsg_cmsg(rx, msg, &user_call_ID, &cmd, &abort_code,
	false);
	if (ret < 0)
	return ret;

	bundle = NULL;
	if (trans) {
	service_id = rx->service_id;
	if (msg->msg_name) {
	struct sockaddr_rxrpc *srx =
	(struct sockaddr_rxrpc *) msg->msg_name;
	service_id = htons(srx->srx_service);
	}
	key = rx->key;
	if (key && !rx->key->payload.data)
	key = NULL;
	bundle = rxrpc_get_bundle(rx, trans, key, service_id,
	GFP_KERNEL);
	if (IS_ERR(bundle))
	return PTR_ERR(bundle);
	}

	call = rxrpc_get_client_call(rx, trans, bundle, user_call_ID,
	abort_code == 0, GFP_KERNEL);
	if (trans)
	rxrpc_put_bundle(trans, bundle);
	if (IS_ERR(call)) {
	_leave(" = %ld", PTR_ERR(call));
	return PTR_ERR(call);
	}

	_debug("CALL %d USR %lx ST %d on CONN %p",
	call->debug_id, call->user_call_ID, call->state, call->conn);

	if (call->state >= RXRPC_CALL_COMPLETE) {
	/* it's too late for this call */
	ret = -ESHUTDOWN;
	} else if (cmd == RXRPC_CMD_SEND_ABORT) {
	rxrpc_send_abort(call, abort_code);
	} else if (cmd != RXRPC_CMD_SEND_DATA) {
	ret = -EINVAL;
	} else if (call->state != RXRPC_CALL_CLIENT_SEND_REQUEST) {
	/* request phase complete for this client call */
	ret = -EPROTO;
	} else {
	ret = rxrpc_send_data(iocb, rx, call, msg, len);
	}

	rxrpc_put_call(call);
	_leave(" = %d", ret);
	return ret;
	}

	/**
	* rxrpc_kernel_send_data - Allow a kernel service to send data on a call
	* @call: The call to send data through
	* @msg: The data to send
	* @len: The amount of data to send
	*
	* Allow a kernel service to send data on a call. The call must be in an state
	* appropriate to sending data. No control data should be supplied in @msg,
	* nor should an address be supplied. MSG_MORE should be flagged if there's
	* more data to come, otherwise this data will end the transmission phase.
	*/
	int rxrpc_kernel_send_data(struct rxrpc_call call, struct msghdr msg,
	size_t len)
	{
	int ret;

	_enter("{%d,%s},", call->debug_id, rxrpc_call_states[call->state]);

	ASSERTCMP(msg->msg_name, ==, NULL);
	ASSERTCMP(msg->msg_control, ==, NULL);

	lock_sock(&call->socket->sk);

	_debug("CALL %d USR %lx ST %d on CONN %p",
	call->debug_id, call->user_call_ID, call->state, call->conn);

	if (call->state >= RXRPC_CALL_COMPLETE) {
	ret = -ESHUTDOWN; /* it's too late for this call */
	} else if (call->state != RXRPC_CALL_CLIENT_SEND_REQUEST &&
	call->state != RXRPC_CALL_SERVER_ACK_REQUEST &&
	call->state != RXRPC_CALL_SERVER_SEND_REPLY) {
	ret = -EPROTO; /* request phase complete for this client call */
	} else {
	mm_segment_t oldfs = get_fs();
	set_fs(KERNEL_DS);
	ret = rxrpc_send_data(NULL, call->socket, call, msg, len);
	set_fs(oldfs);
	}

	release_sock(&call->socket->sk);
	_leave(" = %d", ret);
	return ret;
	}

	EXPORT_SYMBOL(rxrpc_kernel_send_data);

	/*
	* rxrpc_kernel_abort_call - Allow a kernel service to abort a call
	* @call: The call to be aborted
	* @abort_code: The abort code to stick into the ABORT packet
	*
	* Allow a kernel service to abort a call, if it's still in an abortable state.
	*/
	void rxrpc_kernel_abort_call(struct rxrpc_call *call, u32 abort_code)
	{
	_enter("{%d},%d", call->debug_id, abort_code);

	lock_sock(&call->socket->sk);

	_debug("CALL %d USR %lx ST %d on CONN %p",
	call->debug_id, call->user_call_ID, call->state, call->conn);

	if (call->state < RXRPC_CALL_COMPLETE)
	rxrpc_send_abort(call, abort_code);

	release_sock(&call->socket->sk);
	_leave("");
	}

	EXPORT_SYMBOL(rxrpc_kernel_abort_call);

	/*
	* send a message through a server socket
	* - caller holds the socket locked
	*/
	int rxrpc_server_sendmsg(struct kiocb iocb, struct rxrpc_sock rx,
	struct msghdr *msg, size_t len)
	{
	enum rxrpc_command cmd;
	struct rxrpc_call *call;
	unsigned long user_call_ID = 0;
	u32 abort_code = 0;
	int ret;

	_enter("");

	ret = rxrpc_sendmsg_cmsg(rx, msg, &user_call_ID, &cmd, &abort_code,
	true);
	if (ret < 0)
	return ret;

	if (cmd == RXRPC_CMD_ACCEPT) {
	call = rxrpc_accept_call(rx, user_call_ID);
	if (IS_ERR(call))
	return PTR_ERR(call);
	rxrpc_put_call(call);
	return 0;
	}

	call = rxrpc_find_server_call(rx, user_call_ID);
	if (!call)
	return -EBADSLT;
	if (call->state >= RXRPC_CALL_COMPLETE) {
	ret = -ESHUTDOWN;
	goto out;
	}

	switch (cmd) {
	case RXRPC_CMD_SEND_DATA:
	if (call->state != RXRPC_CALL_CLIENT_SEND_REQUEST &&
	call->state != RXRPC_CALL_SERVER_ACK_REQUEST &&
	call->state != RXRPC_CALL_SERVER_SEND_REPLY) {
	/* Tx phase not yet begun for this call */
	ret = -EPROTO;
	break;
	}

	ret = rxrpc_send_data(iocb, rx, call, msg, len);
	break;

	case RXRPC_CMD_SEND_ABORT:
	rxrpc_send_abort(call, abort_code);
	break;
	default:
	BUG();
	}

	out:
	rxrpc_put_call(call);
	_leave(" = %d", ret);
	return ret;
	}

	/*
	* send a packet through the transport endpoint
	*/
	int rxrpc_send_packet(struct rxrpc_transport trans, struct sk_buff skb)
	{
	struct kvec iov[1];
	struct msghdr msg;
	int ret, opt;

	_enter(",{%d}", skb->len);

	iov[0].iov_base = skb->head;
	iov[0].iov_len = skb->len;

	msg.msg_name = &trans->peer->srx.transport.sin;
	msg.msg_namelen = sizeof(trans->peer->srx.transport.sin);
	msg.msg_control = NULL;
	msg.msg_controllen = 0;
	msg.msg_flags = 0;

	/* send the packet with the don't fragment bit set if we currently
	* think it's small enough */
	if (skb->len - sizeof(struct rxrpc_header) < trans->peer->maxdata) {
	down_read(&trans->local->defrag_sem);
	/* send the packet by UDP
	* - returns -EMSGSIZE if UDP would have to fragment the packet
	* to go out of the interface
	* - in which case, we'll have processed the ICMP error
	* message and update the peer record
	*/
	ret = kernel_sendmsg(trans->local->socket, &msg, iov, 1,
	iov[0].iov_len);

	up_read(&trans->local->defrag_sem);
	if (ret == -EMSGSIZE)
	goto send_fragmentable;

	_leave(" = %d [%u]", ret, trans->peer->maxdata);
	return ret;
	}

	send_fragmentable:
	/* attempt to send this message with fragmentation enabled */
	_debug("send fragment");

	down_write(&trans->local->defrag_sem);
	opt = IP_PMTUDISC_DONT;
	ret = kernel_setsockopt(trans->local->socket, SOL_IP, IP_MTU_DISCOVER,
	(char *) &opt, sizeof(opt));
	if (ret == 0) {
	ret = kernel_sendmsg(trans->local->socket, &msg, iov, 1,
	iov[0].iov_len);

	opt = IP_PMTUDISC_DO;
	kernel_setsockopt(trans->local->socket, SOL_IP,
	IP_MTU_DISCOVER, (char *) &opt, sizeof(opt));
	}

	up_write(&trans->local->defrag_sem);
	_leave(" = %d [frag %u]", ret, trans->peer->maxdata);
	return ret;
	}

	/*
	* wait for space to appear in the transmit/ACK window
	* - caller holds the socket locked
	*/
	static int rxrpc_wait_for_tx_window(struct rxrpc_sock *rx,
	struct rxrpc_call *call,
	long *timeo)
	{
	DECLARE_WAITQUEUE(myself, current);
	int ret;

	_enter(",{%d},%ld",
	CIRC_SPACE(call->acks_head, call->acks_tail, call->acks_winsz),
	*timeo);

	add_wait_queue(&call->tx_waitq, &myself);

	for (;;) {
	set_current_state(TASK_INTERRUPTIBLE);
	ret = 0;
	if (CIRC_SPACE(call->acks_head, call->acks_tail,
	call->acks_winsz) > 0)
	break;
	if (signal_pending(current)) {
	ret = sock_intr_errno(*timeo);
	break;
	}

	release_sock(&rx->sk);
	timeo = schedule_timeout(timeo);
	lock_sock(&rx->sk);
	}

	remove_wait_queue(&call->tx_waitq, &myself);
	set_current_state(TASK_RUNNING);
	_leave(" = %d", ret);
	return ret;
	}

	/*
	* attempt to schedule an instant Tx resend
	*/
	static inline void rxrpc_instant_resend(struct rxrpc_call *call)
	{
	read_lock_bh(&call->state_lock);
	if (try_to_del_timer_sync(&call->resend_timer) >= 0) {
	clear_bit(RXRPC_CALL_RUN_RTIMER, &call->flags);
	if (call->state < RXRPC_CALL_COMPLETE &&
	!test_and_set_bit(RXRPC_CALL_RESEND_TIMER, &call->events))
	rxrpc_queue_call(call);
	}
	read_unlock_bh(&call->state_lock);
	}

	/*
	* queue a packet for transmission, set the resend timer and attempt
	* to send the packet immediately
	*/
	static void rxrpc_queue_packet(struct rxrpc_call call, struct sk_buff skb,
	bool last)
	{
	struct rxrpc_skb_priv *sp = rxrpc_skb(skb);
	int ret;

	_net("queue skb %p [%d]", skb, call->acks_head);

	ASSERT(call->acks_window != NULL);
	call->acks_window[call->acks_head] = (unsigned long) skb;
	smp_wmb();
	call->acks_head = (call->acks_head + 1) & (call->acks_winsz - 1);

	if (last \|\| call->state == RXRPC_CALL_SERVER_ACK_REQUEST) {
	_debug("________awaiting reply/ACK__________");
	write_lock_bh(&call->state_lock);
	switch (call->state) {
	case RXRPC_CALL_CLIENT_SEND_REQUEST:
	call->state = RXRPC_CALL_CLIENT_AWAIT_REPLY;
	break;
	case RXRPC_CALL_SERVER_ACK_REQUEST:
	call->state = RXRPC_CALL_SERVER_SEND_REPLY;
	if (!last)
	break;
	case RXRPC_CALL_SERVER_SEND_REPLY:
	call->state = RXRPC_CALL_SERVER_AWAIT_ACK;
	break;
	default:
	break;
	}
	write_unlock_bh(&call->state_lock);
	}

	_proto("Tx DATA %%%u { #%u }",
	ntohl(sp->hdr.serial), ntohl(sp->hdr.seq));

	sp->need_resend = 0;
	sp->resend_at = jiffies + rxrpc_resend_timeout * HZ;
	if (!test_and_set_bit(RXRPC_CALL_RUN_RTIMER, &call->flags)) {
	_debug("run timer");
	call->resend_timer.expires = sp->resend_at;
	add_timer(&call->resend_timer);
	}

	/* attempt to cancel the rx-ACK timer, deferring reply transmission if
	* we're ACK'ing the request phase of an incoming call */
	ret = -EAGAIN;
	if (try_to_del_timer_sync(&call->ack_timer) >= 0) {
	/* the packet may be freed by rxrpc_process_call() before this
	* returns */
	ret = rxrpc_send_packet(call->conn->trans, skb);
	_net("sent skb %p", skb);
	} else {
	_debug("failed to delete ACK timer");
	}

	if (ret < 0) {
	_debug("need instant resend %d", ret);
	sp->need_resend = 1;
	rxrpc_instant_resend(call);
	}

	_leave("");
	}

	/*
	* send data through a socket
	* - must be called in process context
	* - caller holds the socket locked
	*/
	static int rxrpc_send_data(struct kiocb *iocb,
	struct rxrpc_sock *rx,
	struct rxrpc_call *call,
	struct msghdr *msg, size_t len)
	{
	struct rxrpc_skb_priv *sp;
	unsigned char __user *from;
	struct sk_buff *skb;
	struct iovec *iov;
	struct sock *sk = &rx->sk;
	long timeo;
	bool more;
	int ret, ioc, segment, copied;

	_enter(",,,{%zu},%zu", msg->msg_iovlen, len);

	timeo = sock_sndtimeo(sk, msg->msg_flags & MSG_DONTWAIT);

	/* this should be in poll */
	clear_bit(SOCK_ASYNC_NOSPACE, &sk->sk_socket->flags);

	if (sk->sk_err \|\| (sk->sk_shutdown & SEND_SHUTDOWN))
	return -EPIPE;

	iov = msg->msg_iov;
	ioc = msg->msg_iovlen - 1;
	from = iov->iov_base;
	segment = iov->iov_len;
	iov++;
	more = msg->msg_flags & MSG_MORE;

	skb = call->tx_pending;
	call->tx_pending = NULL;

	copied = 0;
	do {
	int copy;

	if (segment > len)
	segment = len;

	_debug("SEGMENT %d @%p", segment, from);

	if (!skb) {
	size_t size, chunk, max, space;

	_debug("alloc");

	if (CIRC_SPACE(call->acks_head, call->acks_tail,
	call->acks_winsz) <= 0) {
	ret = -EAGAIN;
	if (msg->msg_flags & MSG_DONTWAIT)
	goto maybe_error;
	ret = rxrpc_wait_for_tx_window(rx, call,
	&timeo);
	if (ret < 0)
	goto maybe_error;
	}

	max = call->conn->trans->peer->maxdata;
	max -= call->conn->security_size;
	max &= ~(call->conn->size_align - 1UL);

	chunk = max;
	if (chunk > len && !more)
	chunk = len;

	space = chunk + call->conn->size_align;
	space &= ~(call->conn->size_align - 1UL);

	size = space + call->conn->header_size;

	_debug("SIZE: %zu/%zu/%zu", chunk, space, size);

	/* create a buffer that we can retain until it's ACK'd */
	skb = sock_alloc_send_skb(
	sk, size, msg->msg_flags & MSG_DONTWAIT, &ret);
	if (!skb)
	goto maybe_error;

	rxrpc_new_skb(skb);

	_debug("ALLOC SEND %p", skb);

	ASSERTCMP(skb->mark, ==, 0);

	_debug("HS: %u", call->conn->header_size);
	skb_reserve(skb, call->conn->header_size);
	skb->len += call->conn->header_size;

	sp = rxrpc_skb(skb);
	sp->remain = chunk;
	if (sp->remain > skb_tailroom(skb))
	sp->remain = skb_tailroom(skb);

	_net("skb: hr %d, tr %d, hl %d, rm %d",
	skb_headroom(skb),
	skb_tailroom(skb),
	skb_headlen(skb),
	sp->remain);

	skb->ip_summed = CHECKSUM_UNNECESSARY;
	}

	_debug("append");
	sp = rxrpc_skb(skb);

	/* append next segment of data to the current buffer */
	copy = skb_tailroom(skb);
	ASSERTCMP(copy, >, 0);
	if (copy > segment)
	copy = segment;
	if (copy > sp->remain)
	copy = sp->remain;

	_debug("add");
	ret = skb_add_data(skb, from, copy);
	_debug("added");
	if (ret < 0)
	goto efault;
	sp->remain -= copy;
	skb->mark += copy;
	copied += copy;

	len -= copy;
	segment -= copy;
	from += copy;
	while (segment == 0 && ioc > 0) {
	from = iov->iov_base;
	segment = iov->iov_len;
	iov++;
	ioc--;
	}
	if (len == 0) {
	segment = 0;
	ioc = 0;
	}

	/* check for the far side aborting the call or a network error
	* occurring */
	if (call->state > RXRPC_CALL_COMPLETE)
	goto call_aborted;

	/* add the packet to the send queue if it's now full */
	if (sp->remain <= 0 \|\| (segment == 0 && !more)) {
	struct rxrpc_connection *conn = call->conn;
	size_t pad;

	/* pad out if we're using security */
	if (conn->security) {
	pad = conn->security_size + skb->mark;
	pad = conn->size_align - pad;
	pad &= conn->size_align - 1;
	_debug("pad %zu", pad);
	if (pad)
	memset(skb_put(skb, pad), 0, pad);
	}

	sp->hdr.epoch = conn->epoch;
	sp->hdr.cid = call->cid;
	sp->hdr.callNumber = call->call_id;
	sp->hdr.seq =
	htonl(atomic_inc_return(&call->sequence));
	sp->hdr.serial =
	htonl(atomic_inc_return(&conn->serial));
	sp->hdr.type = RXRPC_PACKET_TYPE_DATA;
	sp->hdr.userStatus = 0;
	sp->hdr.securityIndex = conn->security_ix;
	sp->hdr._rsvd = 0;
	sp->hdr.serviceId = conn->service_id;

	sp->hdr.flags = conn->out_clientflag;
	if (len == 0 && !more)
	sp->hdr.flags \|= RXRPC_LAST_PACKET;
	else if (CIRC_SPACE(call->acks_head, call->acks_tail,
	call->acks_winsz) > 1)
	sp->hdr.flags \|= RXRPC_MORE_PACKETS;

	ret = rxrpc_secure_packet(
	call, skb, skb->mark,
	skb->head + sizeof(struct rxrpc_header));
	if (ret < 0)
	goto out;

	memcpy(skb->head, &sp->hdr,
	sizeof(struct rxrpc_header));
	rxrpc_queue_packet(call, skb, segment == 0 && !more);
	skb = NULL;
	}

	} while (segment > 0);

	success:
	ret = copied;
	out:
	call->tx_pending = skb;
	_leave(" = %d", ret);
	return ret;

	call_aborted:
	rxrpc_free_skb(skb);
	if (call->state == RXRPC_CALL_NETWORK_ERROR)
	ret = call->conn->trans->peer->net_error;
	else
	ret = -ECONNABORTED;
	_leave(" = %d", ret);
	return ret;

	maybe_error:
	if (copied)
	goto success;
	goto out;

	efault:
	ret = -EFAULT;
	goto out;
	}