xref: /openbmc/linux/net/tipc/socket.c (revision f30828a6)
1 /*
2  * net/tipc/socket.c: TIPC socket API
3  *
4  * Copyright (c) 2001-2007, Ericsson AB
5  * Copyright (c) 2004-2007, Wind River Systems
6  * All rights reserved.
7  *
8  * Redistribution and use in source and binary forms, with or without
9  * modification, are permitted provided that the following conditions are met:
10  *
11  * 1. Redistributions of source code must retain the above copyright
12  *    notice, this list of conditions and the following disclaimer.
13  * 2. Redistributions in binary form must reproduce the above copyright
14  *    notice, this list of conditions and the following disclaimer in the
15  *    documentation and/or other materials provided with the distribution.
16  * 3. Neither the names of the copyright holders nor the names of its
17  *    contributors may be used to endorse or promote products derived from
18  *    this software without specific prior written permission.
19  *
20  * Alternatively, this software may be distributed under the terms of the
21  * GNU General Public License ("GPL") version 2 as published by the Free
22  * Software Foundation.
23  *
24  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
25  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
26  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
27  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
28  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
29  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
30  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
31  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
32  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
33  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
34  * POSSIBILITY OF SUCH DAMAGE.
35  */
36 
37 #include <linux/module.h>
38 #include <linux/types.h>
39 #include <linux/net.h>
40 #include <linux/socket.h>
41 #include <linux/errno.h>
42 #include <linux/mm.h>
43 #include <linux/slab.h>
44 #include <linux/poll.h>
45 #include <linux/fcntl.h>
46 #include <asm/string.h>
47 #include <asm/atomic.h>
48 #include <net/sock.h>
49 
50 #include <linux/tipc.h>
51 #include <linux/tipc_config.h>
52 #include <net/tipc/tipc_msg.h>
53 #include <net/tipc/tipc_port.h>
54 
55 #include "core.h"
56 
57 #define SS_LISTENING	-1	/* socket is listening */
58 #define SS_READY	-2	/* socket is connectionless */
59 
60 #define OVERLOAD_LIMIT_BASE	5000
61 #define CONN_TIMEOUT_DEFAULT	8000	/* default connect timeout = 8s */
62 
63 struct tipc_sock {
64 	struct sock sk;
65 	struct tipc_port *p;
66 };
67 
68 #define tipc_sk(sk) ((struct tipc_sock *)(sk))
69 #define tipc_sk_port(sk) ((struct tipc_port *)(tipc_sk(sk)->p))
70 
71 static int backlog_rcv(struct sock *sk, struct sk_buff *skb);
72 static u32 dispatch(struct tipc_port *tport, struct sk_buff *buf);
73 static void wakeupdispatch(struct tipc_port *tport);
74 
75 static const struct proto_ops packet_ops;
76 static const struct proto_ops stream_ops;
77 static const struct proto_ops msg_ops;
78 
79 static struct proto tipc_proto;
80 
81 static int sockets_enabled = 0;
82 
83 static atomic_t tipc_queue_size = ATOMIC_INIT(0);
84 
85 /*
86  * Revised TIPC socket locking policy:
87  *
88  * Most socket operations take the standard socket lock when they start
89  * and hold it until they finish (or until they need to sleep).  Acquiring
90  * this lock grants the owner exclusive access to the fields of the socket
91  * data structures, with the exception of the backlog queue.  A few socket
92  * operations can be done without taking the socket lock because they only
93  * read socket information that never changes during the life of the socket.
94  *
95  * Socket operations may acquire the lock for the associated TIPC port if they
96  * need to perform an operation on the port.  If any routine needs to acquire
97  * both the socket lock and the port lock it must take the socket lock first
98  * to avoid the risk of deadlock.
99  *
100  * The dispatcher handling incoming messages cannot grab the socket lock in
101  * the standard fashion, since invoked it runs at the BH level and cannot block.
102  * Instead, it checks to see if the socket lock is currently owned by someone,
103  * and either handles the message itself or adds it to the socket's backlog
104  * queue; in the latter case the queued message is processed once the process
105  * owning the socket lock releases it.
106  *
107  * NOTE: Releasing the socket lock while an operation is sleeping overcomes
108  * the problem of a blocked socket operation preventing any other operations
109  * from occurring.  However, applications must be careful if they have
110  * multiple threads trying to send (or receive) on the same socket, as these
111  * operations might interfere with each other.  For example, doing a connect
112  * and a receive at the same time might allow the receive to consume the
113  * ACK message meant for the connect.  While additional work could be done
114  * to try and overcome this, it doesn't seem to be worthwhile at the present.
115  *
116  * NOTE: Releasing the socket lock while an operation is sleeping also ensures
117  * that another operation that must be performed in a non-blocking manner is
118  * not delayed for very long because the lock has already been taken.
119  *
120  * NOTE: This code assumes that certain fields of a port/socket pair are
121  * constant over its lifetime; such fields can be examined without taking
122  * the socket lock and/or port lock, and do not need to be re-read even
123  * after resuming processing after waiting.  These fields include:
124  *   - socket type
125  *   - pointer to socket sk structure (aka tipc_sock structure)
126  *   - pointer to port structure
127  *   - port reference
128  */
129 
130 /**
131  * advance_rx_queue - discard first buffer in socket receive queue
132  *
133  * Caller must hold socket lock
134  */
135 
136 static void advance_rx_queue(struct sock *sk)
137 {
138 	buf_discard(__skb_dequeue(&sk->sk_receive_queue));
139 	atomic_dec(&tipc_queue_size);
140 }
141 
142 /**
143  * discard_rx_queue - discard all buffers in socket receive queue
144  *
145  * Caller must hold socket lock
146  */
147 
148 static void discard_rx_queue(struct sock *sk)
149 {
150 	struct sk_buff *buf;
151 
152 	while ((buf = __skb_dequeue(&sk->sk_receive_queue))) {
153 		atomic_dec(&tipc_queue_size);
154 		buf_discard(buf);
155 	}
156 }
157 
158 /**
159  * reject_rx_queue - reject all buffers in socket receive queue
160  *
161  * Caller must hold socket lock
162  */
163 
164 static void reject_rx_queue(struct sock *sk)
165 {
166 	struct sk_buff *buf;
167 
168 	while ((buf = __skb_dequeue(&sk->sk_receive_queue))) {
169 		tipc_reject_msg(buf, TIPC_ERR_NO_PORT);
170 		atomic_dec(&tipc_queue_size);
171 	}
172 }
173 
174 /**
175  * tipc_create - create a TIPC socket
176  * @net: network namespace (must be default network)
177  * @sock: pre-allocated socket structure
178  * @protocol: protocol indicator (must be 0)
179  *
180  * This routine creates additional data structures used by the TIPC socket,
181  * initializes them, and links them together.
182  *
183  * Returns 0 on success, errno otherwise
184  */
185 
186 static int tipc_create(struct net *net, struct socket *sock, int protocol)
187 {
188 	const struct proto_ops *ops;
189 	socket_state state;
190 	struct sock *sk;
191 	u32 portref;
192 
193 	/* Validate arguments */
194 
195 	if (net != &init_net)
196 		return -EAFNOSUPPORT;
197 
198 	if (unlikely(protocol != 0))
199 		return -EPROTONOSUPPORT;
200 
201 	switch (sock->type) {
202 	case SOCK_STREAM:
203 		ops = &stream_ops;
204 		state = SS_UNCONNECTED;
205 		break;
206 	case SOCK_SEQPACKET:
207 		ops = &packet_ops;
208 		state = SS_UNCONNECTED;
209 		break;
210 	case SOCK_DGRAM:
211 	case SOCK_RDM:
212 		ops = &msg_ops;
213 		state = SS_READY;
214 		break;
215 	default:
216 		return -EPROTOTYPE;
217 	}
218 
219 	/* Allocate socket's protocol area */
220 
221 	sk = sk_alloc(net, AF_TIPC, GFP_KERNEL, &tipc_proto);
222 	if (sk == NULL)
223 		return -ENOMEM;
224 
225 	/* Allocate TIPC port for socket to use */
226 
227 	portref = tipc_createport_raw(sk, &dispatch, &wakeupdispatch,
228 				      TIPC_LOW_IMPORTANCE);
229 	if (unlikely(portref == 0)) {
230 		sk_free(sk);
231 		return -ENOMEM;
232 	}
233 
234 	/* Finish initializing socket data structures */
235 
236 	sock->ops = ops;
237 	sock->state = state;
238 
239 	sock_init_data(sock, sk);
240 	sk->sk_rcvtimeo = msecs_to_jiffies(CONN_TIMEOUT_DEFAULT);
241 	sk->sk_backlog_rcv = backlog_rcv;
242 	tipc_sk(sk)->p = tipc_get_port(portref);
243 
244 	if (sock->state == SS_READY) {
245 		tipc_set_portunreturnable(portref, 1);
246 		if (sock->type == SOCK_DGRAM)
247 			tipc_set_portunreliable(portref, 1);
248 	}
249 
250 	atomic_inc(&tipc_user_count);
251 	return 0;
252 }
253 
254 /**
255  * release - destroy a TIPC socket
256  * @sock: socket to destroy
257  *
258  * This routine cleans up any messages that are still queued on the socket.
259  * For DGRAM and RDM socket types, all queued messages are rejected.
260  * For SEQPACKET and STREAM socket types, the first message is rejected
261  * and any others are discarded.  (If the first message on a STREAM socket
262  * is partially-read, it is discarded and the next one is rejected instead.)
263  *
264  * NOTE: Rejected messages are not necessarily returned to the sender!  They
265  * are returned or discarded according to the "destination droppable" setting
266  * specified for the message by the sender.
267  *
268  * Returns 0 on success, errno otherwise
269  */
270 
271 static int release(struct socket *sock)
272 {
273 	struct sock *sk = sock->sk;
274 	struct tipc_port *tport;
275 	struct sk_buff *buf;
276 	int res;
277 
278 	/*
279 	 * Exit if socket isn't fully initialized (occurs when a failed accept()
280 	 * releases a pre-allocated child socket that was never used)
281 	 */
282 
283 	if (sk == NULL)
284 		return 0;
285 
286 	tport = tipc_sk_port(sk);
287 	lock_sock(sk);
288 
289 	/*
290 	 * Reject all unreceived messages, except on an active connection
291 	 * (which disconnects locally & sends a 'FIN+' to peer)
292 	 */
293 
294 	while (sock->state != SS_DISCONNECTING) {
295 		buf = __skb_dequeue(&sk->sk_receive_queue);
296 		if (buf == NULL)
297 			break;
298 		atomic_dec(&tipc_queue_size);
299 		if (TIPC_SKB_CB(buf)->handle != msg_data(buf_msg(buf)))
300 			buf_discard(buf);
301 		else {
302 			if ((sock->state == SS_CONNECTING) ||
303 			    (sock->state == SS_CONNECTED)) {
304 				sock->state = SS_DISCONNECTING;
305 				tipc_disconnect(tport->ref);
306 			}
307 			tipc_reject_msg(buf, TIPC_ERR_NO_PORT);
308 		}
309 	}
310 
311 	/*
312 	 * Delete TIPC port; this ensures no more messages are queued
313 	 * (also disconnects an active connection & sends a 'FIN-' to peer)
314 	 */
315 
316 	res = tipc_deleteport(tport->ref);
317 
318 	/* Discard any remaining (connection-based) messages in receive queue */
319 
320 	discard_rx_queue(sk);
321 
322 	/* Reject any messages that accumulated in backlog queue */
323 
324 	sock->state = SS_DISCONNECTING;
325 	release_sock(sk);
326 
327 	sock_put(sk);
328 	sock->sk = NULL;
329 
330 	atomic_dec(&tipc_user_count);
331 	return res;
332 }
333 
334 /**
335  * bind - associate or disassocate TIPC name(s) with a socket
336  * @sock: socket structure
337  * @uaddr: socket address describing name(s) and desired operation
338  * @uaddr_len: size of socket address data structure
339  *
340  * Name and name sequence binding is indicated using a positive scope value;
341  * a negative scope value unbinds the specified name.  Specifying no name
342  * (i.e. a socket address length of 0) unbinds all names from the socket.
343  *
344  * Returns 0 on success, errno otherwise
345  *
346  * NOTE: This routine doesn't need to take the socket lock since it doesn't
347  *       access any non-constant socket information.
348  */
349 
350 static int bind(struct socket *sock, struct sockaddr *uaddr, int uaddr_len)
351 {
352 	struct sockaddr_tipc *addr = (struct sockaddr_tipc *)uaddr;
353 	u32 portref = tipc_sk_port(sock->sk)->ref;
354 
355 	if (unlikely(!uaddr_len))
356 		return tipc_withdraw(portref, 0, NULL);
357 
358 	if (uaddr_len < sizeof(struct sockaddr_tipc))
359 		return -EINVAL;
360 	if (addr->family != AF_TIPC)
361 		return -EAFNOSUPPORT;
362 
363 	if (addr->addrtype == TIPC_ADDR_NAME)
364 		addr->addr.nameseq.upper = addr->addr.nameseq.lower;
365 	else if (addr->addrtype != TIPC_ADDR_NAMESEQ)
366 		return -EAFNOSUPPORT;
367 
368 	return (addr->scope > 0) ?
369 		tipc_publish(portref, addr->scope, &addr->addr.nameseq) :
370 		tipc_withdraw(portref, -addr->scope, &addr->addr.nameseq);
371 }
372 
373 /**
374  * get_name - get port ID of socket or peer socket
375  * @sock: socket structure
376  * @uaddr: area for returned socket address
377  * @uaddr_len: area for returned length of socket address
378  * @peer: 0 to obtain socket name, 1 to obtain peer socket name
379  *
380  * Returns 0 on success, errno otherwise
381  *
382  * NOTE: This routine doesn't need to take the socket lock since it doesn't
383  *       access any non-constant socket information.
384  */
385 
386 static int get_name(struct socket *sock, struct sockaddr *uaddr,
387 		    int *uaddr_len, int peer)
388 {
389 	struct sockaddr_tipc *addr = (struct sockaddr_tipc *)uaddr;
390 	u32 portref = tipc_sk_port(sock->sk)->ref;
391 	u32 res;
392 
393 	if (peer) {
394 		res = tipc_peer(portref, &addr->addr.id);
395 		if (res)
396 			return res;
397 	} else {
398 		tipc_ownidentity(portref, &addr->addr.id);
399 	}
400 
401 	*uaddr_len = sizeof(*addr);
402 	addr->addrtype = TIPC_ADDR_ID;
403 	addr->family = AF_TIPC;
404 	addr->scope = 0;
405 	addr->addr.name.domain = 0;
406 
407 	return 0;
408 }
409 
410 /**
411  * poll - read and possibly block on pollmask
412  * @file: file structure associated with the socket
413  * @sock: socket for which to calculate the poll bits
414  * @wait: ???
415  *
416  * Returns pollmask value
417  *
418  * COMMENTARY:
419  * It appears that the usual socket locking mechanisms are not useful here
420  * since the pollmask info is potentially out-of-date the moment this routine
421  * exits.  TCP and other protocols seem to rely on higher level poll routines
422  * to handle any preventable race conditions, so TIPC will do the same ...
423  *
424  * TIPC sets the returned events as follows:
425  * a) POLLRDNORM and POLLIN are set if the socket's receive queue is non-empty
426  *    or if a connection-oriented socket is does not have an active connection
427  *    (i.e. a read operation will not block).
428  * b) POLLOUT is set except when a socket's connection has been terminated
429  *    (i.e. a write operation will not block).
430  * c) POLLHUP is set when a socket's connection has been terminated.
431  *
432  * IMPORTANT: The fact that a read or write operation will not block does NOT
433  * imply that the operation will succeed!
434  */
435 
436 static unsigned int poll(struct file *file, struct socket *sock,
437 			 poll_table *wait)
438 {
439 	struct sock *sk = sock->sk;
440 	u32 mask;
441 
442 	poll_wait(file, sk->sk_sleep, wait);
443 
444 	if (!skb_queue_empty(&sk->sk_receive_queue) ||
445 	    (sock->state == SS_UNCONNECTED) ||
446 	    (sock->state == SS_DISCONNECTING))
447 		mask = (POLLRDNORM | POLLIN);
448 	else
449 		mask = 0;
450 
451 	if (sock->state == SS_DISCONNECTING)
452 		mask |= POLLHUP;
453 	else
454 		mask |= POLLOUT;
455 
456 	return mask;
457 }
458 
459 /**
460  * dest_name_check - verify user is permitted to send to specified port name
461  * @dest: destination address
462  * @m: descriptor for message to be sent
463  *
464  * Prevents restricted configuration commands from being issued by
465  * unauthorized users.
466  *
467  * Returns 0 if permission is granted, otherwise errno
468  */
469 
470 static int dest_name_check(struct sockaddr_tipc *dest, struct msghdr *m)
471 {
472 	struct tipc_cfg_msg_hdr hdr;
473 
474 	if (likely(dest->addr.name.name.type >= TIPC_RESERVED_TYPES))
475 		return 0;
476 	if (likely(dest->addr.name.name.type == TIPC_TOP_SRV))
477 		return 0;
478 	if (likely(dest->addr.name.name.type != TIPC_CFG_SRV))
479 		return -EACCES;
480 
481 	if (copy_from_user(&hdr, m->msg_iov[0].iov_base, sizeof(hdr)))
482 		return -EFAULT;
483 	if ((ntohs(hdr.tcm_type) & 0xC000) && (!capable(CAP_NET_ADMIN)))
484 		return -EACCES;
485 
486 	return 0;
487 }
488 
489 /**
490  * send_msg - send message in connectionless manner
491  * @iocb: if NULL, indicates that socket lock is already held
492  * @sock: socket structure
493  * @m: message to send
494  * @total_len: length of message
495  *
496  * Message must have an destination specified explicitly.
497  * Used for SOCK_RDM and SOCK_DGRAM messages,
498  * and for 'SYN' messages on SOCK_SEQPACKET and SOCK_STREAM connections.
499  * (Note: 'SYN+' is prohibited on SOCK_STREAM.)
500  *
501  * Returns the number of bytes sent on success, or errno otherwise
502  */
503 
504 static int send_msg(struct kiocb *iocb, struct socket *sock,
505 		    struct msghdr *m, size_t total_len)
506 {
507 	struct sock *sk = sock->sk;
508 	struct tipc_port *tport = tipc_sk_port(sk);
509 	struct sockaddr_tipc *dest = (struct sockaddr_tipc *)m->msg_name;
510 	int needs_conn;
511 	int res = -EINVAL;
512 
513 	if (unlikely(!dest))
514 		return -EDESTADDRREQ;
515 	if (unlikely((m->msg_namelen < sizeof(*dest)) ||
516 		     (dest->family != AF_TIPC)))
517 		return -EINVAL;
518 
519 	if (iocb)
520 		lock_sock(sk);
521 
522 	needs_conn = (sock->state != SS_READY);
523 	if (unlikely(needs_conn)) {
524 		if (sock->state == SS_LISTENING) {
525 			res = -EPIPE;
526 			goto exit;
527 		}
528 		if (sock->state != SS_UNCONNECTED) {
529 			res = -EISCONN;
530 			goto exit;
531 		}
532 		if ((tport->published) ||
533 		    ((sock->type == SOCK_STREAM) && (total_len != 0))) {
534 			res = -EOPNOTSUPP;
535 			goto exit;
536 		}
537 		if (dest->addrtype == TIPC_ADDR_NAME) {
538 			tport->conn_type = dest->addr.name.name.type;
539 			tport->conn_instance = dest->addr.name.name.instance;
540 		}
541 
542 		/* Abort any pending connection attempts (very unlikely) */
543 
544 		reject_rx_queue(sk);
545 	}
546 
547 	do {
548 		if (dest->addrtype == TIPC_ADDR_NAME) {
549 			if ((res = dest_name_check(dest, m)))
550 				break;
551 			res = tipc_send2name(tport->ref,
552 					     &dest->addr.name.name,
553 					     dest->addr.name.domain,
554 					     m->msg_iovlen,
555 					     m->msg_iov);
556 		}
557 		else if (dest->addrtype == TIPC_ADDR_ID) {
558 			res = tipc_send2port(tport->ref,
559 					     &dest->addr.id,
560 					     m->msg_iovlen,
561 					     m->msg_iov);
562 		}
563 		else if (dest->addrtype == TIPC_ADDR_MCAST) {
564 			if (needs_conn) {
565 				res = -EOPNOTSUPP;
566 				break;
567 			}
568 			if ((res = dest_name_check(dest, m)))
569 				break;
570 			res = tipc_multicast(tport->ref,
571 					     &dest->addr.nameseq,
572 					     0,
573 					     m->msg_iovlen,
574 					     m->msg_iov);
575 		}
576 		if (likely(res != -ELINKCONG)) {
577 			if (needs_conn && (res >= 0)) {
578 				sock->state = SS_CONNECTING;
579 			}
580 			break;
581 		}
582 		if (m->msg_flags & MSG_DONTWAIT) {
583 			res = -EWOULDBLOCK;
584 			break;
585 		}
586 		release_sock(sk);
587 		res = wait_event_interruptible(*sk->sk_sleep,
588 					       !tport->congested);
589 		lock_sock(sk);
590 		if (res)
591 			break;
592 	} while (1);
593 
594 exit:
595 	if (iocb)
596 		release_sock(sk);
597 	return res;
598 }
599 
600 /**
601  * send_packet - send a connection-oriented message
602  * @iocb: if NULL, indicates that socket lock is already held
603  * @sock: socket structure
604  * @m: message to send
605  * @total_len: length of message
606  *
607  * Used for SOCK_SEQPACKET messages and SOCK_STREAM data.
608  *
609  * Returns the number of bytes sent on success, or errno otherwise
610  */
611 
612 static int send_packet(struct kiocb *iocb, struct socket *sock,
613 		       struct msghdr *m, size_t total_len)
614 {
615 	struct sock *sk = sock->sk;
616 	struct tipc_port *tport = tipc_sk_port(sk);
617 	struct sockaddr_tipc *dest = (struct sockaddr_tipc *)m->msg_name;
618 	int res;
619 
620 	/* Handle implied connection establishment */
621 
622 	if (unlikely(dest))
623 		return send_msg(iocb, sock, m, total_len);
624 
625 	if (iocb)
626 		lock_sock(sk);
627 
628 	do {
629 		if (unlikely(sock->state != SS_CONNECTED)) {
630 			if (sock->state == SS_DISCONNECTING)
631 				res = -EPIPE;
632 			else
633 				res = -ENOTCONN;
634 			break;
635 		}
636 
637 		res = tipc_send(tport->ref, m->msg_iovlen, m->msg_iov);
638 		if (likely(res != -ELINKCONG)) {
639 			break;
640 		}
641 		if (m->msg_flags & MSG_DONTWAIT) {
642 			res = -EWOULDBLOCK;
643 			break;
644 		}
645 		release_sock(sk);
646 		res = wait_event_interruptible(*sk->sk_sleep,
647 			(!tport->congested || !tport->connected));
648 		lock_sock(sk);
649 		if (res)
650 			break;
651 	} while (1);
652 
653 	if (iocb)
654 		release_sock(sk);
655 	return res;
656 }
657 
658 /**
659  * send_stream - send stream-oriented data
660  * @iocb: (unused)
661  * @sock: socket structure
662  * @m: data to send
663  * @total_len: total length of data to be sent
664  *
665  * Used for SOCK_STREAM data.
666  *
667  * Returns the number of bytes sent on success (or partial success),
668  * or errno if no data sent
669  */
670 
671 static int send_stream(struct kiocb *iocb, struct socket *sock,
672 		       struct msghdr *m, size_t total_len)
673 {
674 	struct sock *sk = sock->sk;
675 	struct tipc_port *tport = tipc_sk_port(sk);
676 	struct msghdr my_msg;
677 	struct iovec my_iov;
678 	struct iovec *curr_iov;
679 	int curr_iovlen;
680 	char __user *curr_start;
681 	u32 hdr_size;
682 	int curr_left;
683 	int bytes_to_send;
684 	int bytes_sent;
685 	int res;
686 
687 	lock_sock(sk);
688 
689 	/* Handle special cases where there is no connection */
690 
691 	if (unlikely(sock->state != SS_CONNECTED)) {
692 		if (sock->state == SS_UNCONNECTED) {
693 			res = send_packet(NULL, sock, m, total_len);
694 			goto exit;
695 		} else if (sock->state == SS_DISCONNECTING) {
696 			res = -EPIPE;
697 			goto exit;
698 		} else {
699 			res = -ENOTCONN;
700 			goto exit;
701 		}
702 	}
703 
704 	if (unlikely(m->msg_name)) {
705 		res = -EISCONN;
706 		goto exit;
707 	}
708 
709 	/*
710 	 * Send each iovec entry using one or more messages
711 	 *
712 	 * Note: This algorithm is good for the most likely case
713 	 * (i.e. one large iovec entry), but could be improved to pass sets
714 	 * of small iovec entries into send_packet().
715 	 */
716 
717 	curr_iov = m->msg_iov;
718 	curr_iovlen = m->msg_iovlen;
719 	my_msg.msg_iov = &my_iov;
720 	my_msg.msg_iovlen = 1;
721 	my_msg.msg_flags = m->msg_flags;
722 	my_msg.msg_name = NULL;
723 	bytes_sent = 0;
724 
725 	hdr_size = msg_hdr_sz(&tport->phdr);
726 
727 	while (curr_iovlen--) {
728 		curr_start = curr_iov->iov_base;
729 		curr_left = curr_iov->iov_len;
730 
731 		while (curr_left) {
732 			bytes_to_send = tport->max_pkt - hdr_size;
733 			if (bytes_to_send > TIPC_MAX_USER_MSG_SIZE)
734 				bytes_to_send = TIPC_MAX_USER_MSG_SIZE;
735 			if (curr_left < bytes_to_send)
736 				bytes_to_send = curr_left;
737 			my_iov.iov_base = curr_start;
738 			my_iov.iov_len = bytes_to_send;
739 			if ((res = send_packet(NULL, sock, &my_msg, 0)) < 0) {
740 				if (bytes_sent)
741 					res = bytes_sent;
742 				goto exit;
743 			}
744 			curr_left -= bytes_to_send;
745 			curr_start += bytes_to_send;
746 			bytes_sent += bytes_to_send;
747 		}
748 
749 		curr_iov++;
750 	}
751 	res = bytes_sent;
752 exit:
753 	release_sock(sk);
754 	return res;
755 }
756 
757 /**
758  * auto_connect - complete connection setup to a remote port
759  * @sock: socket structure
760  * @msg: peer's response message
761  *
762  * Returns 0 on success, errno otherwise
763  */
764 
765 static int auto_connect(struct socket *sock, struct tipc_msg *msg)
766 {
767 	struct tipc_port *tport = tipc_sk_port(sock->sk);
768 	struct tipc_portid peer;
769 
770 	if (msg_errcode(msg)) {
771 		sock->state = SS_DISCONNECTING;
772 		return -ECONNREFUSED;
773 	}
774 
775 	peer.ref = msg_origport(msg);
776 	peer.node = msg_orignode(msg);
777 	tipc_connect2port(tport->ref, &peer);
778 	tipc_set_portimportance(tport->ref, msg_importance(msg));
779 	sock->state = SS_CONNECTED;
780 	return 0;
781 }
782 
783 /**
784  * set_orig_addr - capture sender's address for received message
785  * @m: descriptor for message info
786  * @msg: received message header
787  *
788  * Note: Address is not captured if not requested by receiver.
789  */
790 
791 static void set_orig_addr(struct msghdr *m, struct tipc_msg *msg)
792 {
793 	struct sockaddr_tipc *addr = (struct sockaddr_tipc *)m->msg_name;
794 
795 	if (addr) {
796 		addr->family = AF_TIPC;
797 		addr->addrtype = TIPC_ADDR_ID;
798 		addr->addr.id.ref = msg_origport(msg);
799 		addr->addr.id.node = msg_orignode(msg);
800 		addr->addr.name.domain = 0;   	/* could leave uninitialized */
801 		addr->scope = 0;   		/* could leave uninitialized */
802 		m->msg_namelen = sizeof(struct sockaddr_tipc);
803 	}
804 }
805 
806 /**
807  * anc_data_recv - optionally capture ancillary data for received message
808  * @m: descriptor for message info
809  * @msg: received message header
810  * @tport: TIPC port associated with message
811  *
812  * Note: Ancillary data is not captured if not requested by receiver.
813  *
814  * Returns 0 if successful, otherwise errno
815  */
816 
817 static int anc_data_recv(struct msghdr *m, struct tipc_msg *msg,
818 				struct tipc_port *tport)
819 {
820 	u32 anc_data[3];
821 	u32 err;
822 	u32 dest_type;
823 	int has_name;
824 	int res;
825 
826 	if (likely(m->msg_controllen == 0))
827 		return 0;
828 
829 	/* Optionally capture errored message object(s) */
830 
831 	err = msg ? msg_errcode(msg) : 0;
832 	if (unlikely(err)) {
833 		anc_data[0] = err;
834 		anc_data[1] = msg_data_sz(msg);
835 		if ((res = put_cmsg(m, SOL_TIPC, TIPC_ERRINFO, 8, anc_data)))
836 			return res;
837 		if (anc_data[1] &&
838 		    (res = put_cmsg(m, SOL_TIPC, TIPC_RETDATA, anc_data[1],
839 				    msg_data(msg))))
840 			return res;
841 	}
842 
843 	/* Optionally capture message destination object */
844 
845 	dest_type = msg ? msg_type(msg) : TIPC_DIRECT_MSG;
846 	switch (dest_type) {
847 	case TIPC_NAMED_MSG:
848 		has_name = 1;
849 		anc_data[0] = msg_nametype(msg);
850 		anc_data[1] = msg_namelower(msg);
851 		anc_data[2] = msg_namelower(msg);
852 		break;
853 	case TIPC_MCAST_MSG:
854 		has_name = 1;
855 		anc_data[0] = msg_nametype(msg);
856 		anc_data[1] = msg_namelower(msg);
857 		anc_data[2] = msg_nameupper(msg);
858 		break;
859 	case TIPC_CONN_MSG:
860 		has_name = (tport->conn_type != 0);
861 		anc_data[0] = tport->conn_type;
862 		anc_data[1] = tport->conn_instance;
863 		anc_data[2] = tport->conn_instance;
864 		break;
865 	default:
866 		has_name = 0;
867 	}
868 	if (has_name &&
869 	    (res = put_cmsg(m, SOL_TIPC, TIPC_DESTNAME, 12, anc_data)))
870 		return res;
871 
872 	return 0;
873 }
874 
875 /**
876  * recv_msg - receive packet-oriented message
877  * @iocb: (unused)
878  * @m: descriptor for message info
879  * @buf_len: total size of user buffer area
880  * @flags: receive flags
881  *
882  * Used for SOCK_DGRAM, SOCK_RDM, and SOCK_SEQPACKET messages.
883  * If the complete message doesn't fit in user area, truncate it.
884  *
885  * Returns size of returned message data, errno otherwise
886  */
887 
888 static int recv_msg(struct kiocb *iocb, struct socket *sock,
889 		    struct msghdr *m, size_t buf_len, int flags)
890 {
891 	struct sock *sk = sock->sk;
892 	struct tipc_port *tport = tipc_sk_port(sk);
893 	struct sk_buff *buf;
894 	struct tipc_msg *msg;
895 	unsigned int sz;
896 	u32 err;
897 	int res;
898 
899 	/* Catch invalid receive requests */
900 
901 	if (m->msg_iovlen != 1)
902 		return -EOPNOTSUPP;   /* Don't do multiple iovec entries yet */
903 
904 	if (unlikely(!buf_len))
905 		return -EINVAL;
906 
907 	lock_sock(sk);
908 
909 	if (unlikely(sock->state == SS_UNCONNECTED)) {
910 		res = -ENOTCONN;
911 		goto exit;
912 	}
913 
914 restart:
915 
916 	/* Look for a message in receive queue; wait if necessary */
917 
918 	while (skb_queue_empty(&sk->sk_receive_queue)) {
919 		if (sock->state == SS_DISCONNECTING) {
920 			res = -ENOTCONN;
921 			goto exit;
922 		}
923 		if (flags & MSG_DONTWAIT) {
924 			res = -EWOULDBLOCK;
925 			goto exit;
926 		}
927 		release_sock(sk);
928 		res = wait_event_interruptible(*sk->sk_sleep,
929 			(!skb_queue_empty(&sk->sk_receive_queue) ||
930 			 (sock->state == SS_DISCONNECTING)));
931 		lock_sock(sk);
932 		if (res)
933 			goto exit;
934 	}
935 
936 	/* Look at first message in receive queue */
937 
938 	buf = skb_peek(&sk->sk_receive_queue);
939 	msg = buf_msg(buf);
940 	sz = msg_data_sz(msg);
941 	err = msg_errcode(msg);
942 
943 	/* Complete connection setup for an implied connect */
944 
945 	if (unlikely(sock->state == SS_CONNECTING)) {
946 		res = auto_connect(sock, msg);
947 		if (res)
948 			goto exit;
949 	}
950 
951 	/* Discard an empty non-errored message & try again */
952 
953 	if ((!sz) && (!err)) {
954 		advance_rx_queue(sk);
955 		goto restart;
956 	}
957 
958 	/* Capture sender's address (optional) */
959 
960 	set_orig_addr(m, msg);
961 
962 	/* Capture ancillary data (optional) */
963 
964 	res = anc_data_recv(m, msg, tport);
965 	if (res)
966 		goto exit;
967 
968 	/* Capture message data (if valid) & compute return value (always) */
969 
970 	if (!err) {
971 		if (unlikely(buf_len < sz)) {
972 			sz = buf_len;
973 			m->msg_flags |= MSG_TRUNC;
974 		}
975 		if (unlikely(copy_to_user(m->msg_iov->iov_base, msg_data(msg),
976 					  sz))) {
977 			res = -EFAULT;
978 			goto exit;
979 		}
980 		res = sz;
981 	} else {
982 		if ((sock->state == SS_READY) ||
983 		    ((err == TIPC_CONN_SHUTDOWN) || m->msg_control))
984 			res = 0;
985 		else
986 			res = -ECONNRESET;
987 	}
988 
989 	/* Consume received message (optional) */
990 
991 	if (likely(!(flags & MSG_PEEK))) {
992 		if ((sock->state != SS_READY) &&
993 		    (++tport->conn_unacked >= TIPC_FLOW_CONTROL_WIN))
994 			tipc_acknowledge(tport->ref, tport->conn_unacked);
995 		advance_rx_queue(sk);
996 	}
997 exit:
998 	release_sock(sk);
999 	return res;
1000 }
1001 
1002 /**
1003  * recv_stream - receive stream-oriented data
1004  * @iocb: (unused)
1005  * @m: descriptor for message info
1006  * @buf_len: total size of user buffer area
1007  * @flags: receive flags
1008  *
1009  * Used for SOCK_STREAM messages only.  If not enough data is available
1010  * will optionally wait for more; never truncates data.
1011  *
1012  * Returns size of returned message data, errno otherwise
1013  */
1014 
1015 static int recv_stream(struct kiocb *iocb, struct socket *sock,
1016 		       struct msghdr *m, size_t buf_len, int flags)
1017 {
1018 	struct sock *sk = sock->sk;
1019 	struct tipc_port *tport = tipc_sk_port(sk);
1020 	struct sk_buff *buf;
1021 	struct tipc_msg *msg;
1022 	unsigned int sz;
1023 	int sz_to_copy;
1024 	int sz_copied = 0;
1025 	int needed;
1026 	char __user *crs = m->msg_iov->iov_base;
1027 	unsigned char *buf_crs;
1028 	u32 err;
1029 	int res = 0;
1030 
1031 	/* Catch invalid receive attempts */
1032 
1033 	if (m->msg_iovlen != 1)
1034 		return -EOPNOTSUPP;   /* Don't do multiple iovec entries yet */
1035 
1036 	if (unlikely(!buf_len))
1037 		return -EINVAL;
1038 
1039 	lock_sock(sk);
1040 
1041 	if (unlikely((sock->state == SS_UNCONNECTED) ||
1042 		     (sock->state == SS_CONNECTING))) {
1043 		res = -ENOTCONN;
1044 		goto exit;
1045 	}
1046 
1047 restart:
1048 
1049 	/* Look for a message in receive queue; wait if necessary */
1050 
1051 	while (skb_queue_empty(&sk->sk_receive_queue)) {
1052 		if (sock->state == SS_DISCONNECTING) {
1053 			res = -ENOTCONN;
1054 			goto exit;
1055 		}
1056 		if (flags & MSG_DONTWAIT) {
1057 			res = -EWOULDBLOCK;
1058 			goto exit;
1059 		}
1060 		release_sock(sk);
1061 		res = wait_event_interruptible(*sk->sk_sleep,
1062 			(!skb_queue_empty(&sk->sk_receive_queue) ||
1063 			 (sock->state == SS_DISCONNECTING)));
1064 		lock_sock(sk);
1065 		if (res)
1066 			goto exit;
1067 	}
1068 
1069 	/* Look at first message in receive queue */
1070 
1071 	buf = skb_peek(&sk->sk_receive_queue);
1072 	msg = buf_msg(buf);
1073 	sz = msg_data_sz(msg);
1074 	err = msg_errcode(msg);
1075 
1076 	/* Discard an empty non-errored message & try again */
1077 
1078 	if ((!sz) && (!err)) {
1079 		advance_rx_queue(sk);
1080 		goto restart;
1081 	}
1082 
1083 	/* Optionally capture sender's address & ancillary data of first msg */
1084 
1085 	if (sz_copied == 0) {
1086 		set_orig_addr(m, msg);
1087 		res = anc_data_recv(m, msg, tport);
1088 		if (res)
1089 			goto exit;
1090 	}
1091 
1092 	/* Capture message data (if valid) & compute return value (always) */
1093 
1094 	if (!err) {
1095 		buf_crs = (unsigned char *)(TIPC_SKB_CB(buf)->handle);
1096 		sz = (unsigned char *)msg + msg_size(msg) - buf_crs;
1097 
1098 		needed = (buf_len - sz_copied);
1099 		sz_to_copy = (sz <= needed) ? sz : needed;
1100 		if (unlikely(copy_to_user(crs, buf_crs, sz_to_copy))) {
1101 			res = -EFAULT;
1102 			goto exit;
1103 		}
1104 		sz_copied += sz_to_copy;
1105 
1106 		if (sz_to_copy < sz) {
1107 			if (!(flags & MSG_PEEK))
1108 				TIPC_SKB_CB(buf)->handle = buf_crs + sz_to_copy;
1109 			goto exit;
1110 		}
1111 
1112 		crs += sz_to_copy;
1113 	} else {
1114 		if (sz_copied != 0)
1115 			goto exit; /* can't add error msg to valid data */
1116 
1117 		if ((err == TIPC_CONN_SHUTDOWN) || m->msg_control)
1118 			res = 0;
1119 		else
1120 			res = -ECONNRESET;
1121 	}
1122 
1123 	/* Consume received message (optional) */
1124 
1125 	if (likely(!(flags & MSG_PEEK))) {
1126 		if (unlikely(++tport->conn_unacked >= TIPC_FLOW_CONTROL_WIN))
1127 			tipc_acknowledge(tport->ref, tport->conn_unacked);
1128 		advance_rx_queue(sk);
1129 	}
1130 
1131 	/* Loop around if more data is required */
1132 
1133 	if ((sz_copied < buf_len)    /* didn't get all requested data */
1134 	    && (!skb_queue_empty(&sock->sk->sk_receive_queue) ||
1135 		(flags & MSG_WAITALL))
1136 				     /* ... and more is ready or required */
1137 	    && (!(flags & MSG_PEEK)) /* ... and aren't just peeking at data */
1138 	    && (!err)                /* ... and haven't reached a FIN */
1139 	    )
1140 		goto restart;
1141 
1142 exit:
1143 	release_sock(sk);
1144 	return sz_copied ? sz_copied : res;
1145 }
1146 
1147 /**
1148  * rx_queue_full - determine if receive queue can accept another message
1149  * @msg: message to be added to queue
1150  * @queue_size: current size of queue
1151  * @base: nominal maximum size of queue
1152  *
1153  * Returns 1 if queue is unable to accept message, 0 otherwise
1154  */
1155 
1156 static int rx_queue_full(struct tipc_msg *msg, u32 queue_size, u32 base)
1157 {
1158 	u32 threshold;
1159 	u32 imp = msg_importance(msg);
1160 
1161 	if (imp == TIPC_LOW_IMPORTANCE)
1162 		threshold = base;
1163 	else if (imp == TIPC_MEDIUM_IMPORTANCE)
1164 		threshold = base * 2;
1165 	else if (imp == TIPC_HIGH_IMPORTANCE)
1166 		threshold = base * 100;
1167 	else
1168 		return 0;
1169 
1170 	if (msg_connected(msg))
1171 		threshold *= 4;
1172 
1173 	return (queue_size >= threshold);
1174 }
1175 
1176 /**
1177  * filter_rcv - validate incoming message
1178  * @sk: socket
1179  * @buf: message
1180  *
1181  * Enqueues message on receive queue if acceptable; optionally handles
1182  * disconnect indication for a connected socket.
1183  *
1184  * Called with socket lock already taken; port lock may also be taken.
1185  *
1186  * Returns TIPC error status code (TIPC_OK if message is not to be rejected)
1187  */
1188 
1189 static u32 filter_rcv(struct sock *sk, struct sk_buff *buf)
1190 {
1191 	struct socket *sock = sk->sk_socket;
1192 	struct tipc_msg *msg = buf_msg(buf);
1193 	u32 recv_q_len;
1194 
1195 	/* Reject message if it is wrong sort of message for socket */
1196 
1197 	/*
1198 	 * WOULD IT BE BETTER TO JUST DISCARD THESE MESSAGES INSTEAD?
1199 	 * "NO PORT" ISN'T REALLY THE RIGHT ERROR CODE, AND THERE MAY
1200 	 * BE SECURITY IMPLICATIONS INHERENT IN REJECTING INVALID TRAFFIC
1201 	 */
1202 
1203 	if (sock->state == SS_READY) {
1204 		if (msg_connected(msg)) {
1205 			msg_dbg(msg, "dispatch filter 1\n");
1206 			return TIPC_ERR_NO_PORT;
1207 		}
1208 	} else {
1209 		if (msg_mcast(msg)) {
1210 			msg_dbg(msg, "dispatch filter 2\n");
1211 			return TIPC_ERR_NO_PORT;
1212 		}
1213 		if (sock->state == SS_CONNECTED) {
1214 			if (!msg_connected(msg)) {
1215 				msg_dbg(msg, "dispatch filter 3\n");
1216 				return TIPC_ERR_NO_PORT;
1217 			}
1218 		}
1219 		else if (sock->state == SS_CONNECTING) {
1220 			if (!msg_connected(msg) && (msg_errcode(msg) == 0)) {
1221 				msg_dbg(msg, "dispatch filter 4\n");
1222 				return TIPC_ERR_NO_PORT;
1223 			}
1224 		}
1225 		else if (sock->state == SS_LISTENING) {
1226 			if (msg_connected(msg) || msg_errcode(msg)) {
1227 				msg_dbg(msg, "dispatch filter 5\n");
1228 				return TIPC_ERR_NO_PORT;
1229 			}
1230 		}
1231 		else if (sock->state == SS_DISCONNECTING) {
1232 			msg_dbg(msg, "dispatch filter 6\n");
1233 			return TIPC_ERR_NO_PORT;
1234 		}
1235 		else /* (sock->state == SS_UNCONNECTED) */ {
1236 			if (msg_connected(msg) || msg_errcode(msg)) {
1237 				msg_dbg(msg, "dispatch filter 7\n");
1238 				return TIPC_ERR_NO_PORT;
1239 			}
1240 		}
1241 	}
1242 
1243 	/* Reject message if there isn't room to queue it */
1244 
1245 	recv_q_len = (u32)atomic_read(&tipc_queue_size);
1246 	if (unlikely(recv_q_len >= OVERLOAD_LIMIT_BASE)) {
1247 		if (rx_queue_full(msg, recv_q_len, OVERLOAD_LIMIT_BASE))
1248 			return TIPC_ERR_OVERLOAD;
1249 	}
1250 	recv_q_len = skb_queue_len(&sk->sk_receive_queue);
1251 	if (unlikely(recv_q_len >= (OVERLOAD_LIMIT_BASE / 2))) {
1252 		if (rx_queue_full(msg, recv_q_len, OVERLOAD_LIMIT_BASE / 2))
1253 			return TIPC_ERR_OVERLOAD;
1254 	}
1255 
1256 	/* Enqueue message (finally!) */
1257 
1258 	msg_dbg(msg, "<DISP<: ");
1259 	TIPC_SKB_CB(buf)->handle = msg_data(msg);
1260 	atomic_inc(&tipc_queue_size);
1261 	__skb_queue_tail(&sk->sk_receive_queue, buf);
1262 
1263 	/* Initiate connection termination for an incoming 'FIN' */
1264 
1265 	if (unlikely(msg_errcode(msg) && (sock->state == SS_CONNECTED))) {
1266 		sock->state = SS_DISCONNECTING;
1267 		tipc_disconnect_port(tipc_sk_port(sk));
1268 	}
1269 
1270 	if (waitqueue_active(sk->sk_sleep))
1271 		wake_up_interruptible(sk->sk_sleep);
1272 	return TIPC_OK;
1273 }
1274 
1275 /**
1276  * backlog_rcv - handle incoming message from backlog queue
1277  * @sk: socket
1278  * @buf: message
1279  *
1280  * Caller must hold socket lock, but not port lock.
1281  *
1282  * Returns 0
1283  */
1284 
1285 static int backlog_rcv(struct sock *sk, struct sk_buff *buf)
1286 {
1287 	u32 res;
1288 
1289 	res = filter_rcv(sk, buf);
1290 	if (res)
1291 		tipc_reject_msg(buf, res);
1292 	return 0;
1293 }
1294 
1295 /**
1296  * dispatch - handle incoming message
1297  * @tport: TIPC port that received message
1298  * @buf: message
1299  *
1300  * Called with port lock already taken.
1301  *
1302  * Returns TIPC error status code (TIPC_OK if message is not to be rejected)
1303  */
1304 
1305 static u32 dispatch(struct tipc_port *tport, struct sk_buff *buf)
1306 {
1307 	struct sock *sk = (struct sock *)tport->usr_handle;
1308 	u32 res;
1309 
1310 	/*
1311 	 * Process message if socket is unlocked; otherwise add to backlog queue
1312 	 *
1313 	 * This code is based on sk_receive_skb(), but must be distinct from it
1314 	 * since a TIPC-specific filter/reject mechanism is utilized
1315 	 */
1316 
1317 	bh_lock_sock(sk);
1318 	if (!sock_owned_by_user(sk)) {
1319 		res = filter_rcv(sk, buf);
1320 	} else {
1321 		sk_add_backlog(sk, buf);
1322 		res = TIPC_OK;
1323 	}
1324 	bh_unlock_sock(sk);
1325 
1326 	return res;
1327 }
1328 
1329 /**
1330  * wakeupdispatch - wake up port after congestion
1331  * @tport: port to wakeup
1332  *
1333  * Called with port lock already taken.
1334  */
1335 
1336 static void wakeupdispatch(struct tipc_port *tport)
1337 {
1338 	struct sock *sk = (struct sock *)tport->usr_handle;
1339 
1340 	if (waitqueue_active(sk->sk_sleep))
1341 		wake_up_interruptible(sk->sk_sleep);
1342 }
1343 
1344 /**
1345  * connect - establish a connection to another TIPC port
1346  * @sock: socket structure
1347  * @dest: socket address for destination port
1348  * @destlen: size of socket address data structure
1349  * @flags: file-related flags associated with socket
1350  *
1351  * Returns 0 on success, errno otherwise
1352  */
1353 
1354 static int connect(struct socket *sock, struct sockaddr *dest, int destlen,
1355 		   int flags)
1356 {
1357 	struct sock *sk = sock->sk;
1358 	struct sockaddr_tipc *dst = (struct sockaddr_tipc *)dest;
1359 	struct msghdr m = {NULL,};
1360 	struct sk_buff *buf;
1361 	struct tipc_msg *msg;
1362 	int res;
1363 
1364 	lock_sock(sk);
1365 
1366 	/* For now, TIPC does not allow use of connect() with DGRAM/RDM types */
1367 
1368 	if (sock->state == SS_READY) {
1369 		res = -EOPNOTSUPP;
1370 		goto exit;
1371 	}
1372 
1373 	/* For now, TIPC does not support the non-blocking form of connect() */
1374 
1375 	if (flags & O_NONBLOCK) {
1376 		res = -EWOULDBLOCK;
1377 		goto exit;
1378 	}
1379 
1380 	/* Issue Posix-compliant error code if socket is in the wrong state */
1381 
1382 	if (sock->state == SS_LISTENING) {
1383 		res = -EOPNOTSUPP;
1384 		goto exit;
1385 	}
1386 	if (sock->state == SS_CONNECTING) {
1387 		res = -EALREADY;
1388 		goto exit;
1389 	}
1390 	if (sock->state != SS_UNCONNECTED) {
1391 		res = -EISCONN;
1392 		goto exit;
1393 	}
1394 
1395 	/*
1396 	 * Reject connection attempt using multicast address
1397 	 *
1398 	 * Note: send_msg() validates the rest of the address fields,
1399 	 *       so there's no need to do it here
1400 	 */
1401 
1402 	if (dst->addrtype == TIPC_ADDR_MCAST) {
1403 		res = -EINVAL;
1404 		goto exit;
1405 	}
1406 
1407 	/* Reject any messages already in receive queue (very unlikely) */
1408 
1409 	reject_rx_queue(sk);
1410 
1411 	/* Send a 'SYN-' to destination */
1412 
1413 	m.msg_name = dest;
1414 	m.msg_namelen = destlen;
1415 	res = send_msg(NULL, sock, &m, 0);
1416 	if (res < 0) {
1417 		goto exit;
1418 	}
1419 
1420 	/* Wait until an 'ACK' or 'RST' arrives, or a timeout occurs */
1421 
1422 	release_sock(sk);
1423 	res = wait_event_interruptible_timeout(*sk->sk_sleep,
1424 			(!skb_queue_empty(&sk->sk_receive_queue) ||
1425 			(sock->state != SS_CONNECTING)),
1426 			sk->sk_rcvtimeo);
1427 	lock_sock(sk);
1428 
1429 	if (res > 0) {
1430 		buf = skb_peek(&sk->sk_receive_queue);
1431 		if (buf != NULL) {
1432 			msg = buf_msg(buf);
1433 			res = auto_connect(sock, msg);
1434 			if (!res) {
1435 				if (!msg_data_sz(msg))
1436 					advance_rx_queue(sk);
1437 			}
1438 		} else {
1439 			if (sock->state == SS_CONNECTED) {
1440 				res = -EISCONN;
1441 			} else {
1442 				res = -ECONNREFUSED;
1443 			}
1444 		}
1445 	} else {
1446 		if (res == 0)
1447 			res = -ETIMEDOUT;
1448 		else
1449 			; /* leave "res" unchanged */
1450 		sock->state = SS_DISCONNECTING;
1451 	}
1452 
1453 exit:
1454 	release_sock(sk);
1455 	return res;
1456 }
1457 
1458 /**
1459  * listen - allow socket to listen for incoming connections
1460  * @sock: socket structure
1461  * @len: (unused)
1462  *
1463  * Returns 0 on success, errno otherwise
1464  */
1465 
1466 static int listen(struct socket *sock, int len)
1467 {
1468 	struct sock *sk = sock->sk;
1469 	int res;
1470 
1471 	lock_sock(sk);
1472 
1473 	if (sock->state == SS_READY)
1474 		res = -EOPNOTSUPP;
1475 	else if (sock->state != SS_UNCONNECTED)
1476 		res = -EINVAL;
1477 	else {
1478 		sock->state = SS_LISTENING;
1479 		res = 0;
1480 	}
1481 
1482 	release_sock(sk);
1483 	return res;
1484 }
1485 
1486 /**
1487  * accept - wait for connection request
1488  * @sock: listening socket
1489  * @newsock: new socket that is to be connected
1490  * @flags: file-related flags associated with socket
1491  *
1492  * Returns 0 on success, errno otherwise
1493  */
1494 
1495 static int accept(struct socket *sock, struct socket *new_sock, int flags)
1496 {
1497 	struct sock *sk = sock->sk;
1498 	struct sk_buff *buf;
1499 	int res;
1500 
1501 	lock_sock(sk);
1502 
1503 	if (sock->state == SS_READY) {
1504 		res = -EOPNOTSUPP;
1505 		goto exit;
1506 	}
1507 	if (sock->state != SS_LISTENING) {
1508 		res = -EINVAL;
1509 		goto exit;
1510 	}
1511 
1512 	while (skb_queue_empty(&sk->sk_receive_queue)) {
1513 		if (flags & O_NONBLOCK) {
1514 			res = -EWOULDBLOCK;
1515 			goto exit;
1516 		}
1517 		release_sock(sk);
1518 		res = wait_event_interruptible(*sk->sk_sleep,
1519 				(!skb_queue_empty(&sk->sk_receive_queue)));
1520 		lock_sock(sk);
1521 		if (res)
1522 			goto exit;
1523 	}
1524 
1525 	buf = skb_peek(&sk->sk_receive_queue);
1526 
1527 	res = tipc_create(sock_net(sock->sk), new_sock, 0);
1528 	if (!res) {
1529 		struct sock *new_sk = new_sock->sk;
1530 		struct tipc_port *new_tport = tipc_sk_port(new_sk);
1531 		u32 new_ref = new_tport->ref;
1532 		struct tipc_portid id;
1533 		struct tipc_msg *msg = buf_msg(buf);
1534 
1535 		lock_sock(new_sk);
1536 
1537 		/*
1538 		 * Reject any stray messages received by new socket
1539 		 * before the socket lock was taken (very, very unlikely)
1540 		 */
1541 
1542 		reject_rx_queue(new_sk);
1543 
1544 		/* Connect new socket to it's peer */
1545 
1546 		id.ref = msg_origport(msg);
1547 		id.node = msg_orignode(msg);
1548 		tipc_connect2port(new_ref, &id);
1549 		new_sock->state = SS_CONNECTED;
1550 
1551 		tipc_set_portimportance(new_ref, msg_importance(msg));
1552 		if (msg_named(msg)) {
1553 			new_tport->conn_type = msg_nametype(msg);
1554 			new_tport->conn_instance = msg_nameinst(msg);
1555 		}
1556 
1557 		/*
1558 		 * Respond to 'SYN-' by discarding it & returning 'ACK'-.
1559 		 * Respond to 'SYN+' by queuing it on new socket.
1560 		 */
1561 
1562 		msg_dbg(msg,"<ACC<: ");
1563 		if (!msg_data_sz(msg)) {
1564 			struct msghdr m = {NULL,};
1565 
1566 			advance_rx_queue(sk);
1567 			send_packet(NULL, new_sock, &m, 0);
1568 		} else {
1569 			__skb_dequeue(&sk->sk_receive_queue);
1570 			__skb_queue_head(&new_sk->sk_receive_queue, buf);
1571 		}
1572 		release_sock(new_sk);
1573 	}
1574 exit:
1575 	release_sock(sk);
1576 	return res;
1577 }
1578 
1579 /**
1580  * shutdown - shutdown socket connection
1581  * @sock: socket structure
1582  * @how: direction to close (must be SHUT_RDWR)
1583  *
1584  * Terminates connection (if necessary), then purges socket's receive queue.
1585  *
1586  * Returns 0 on success, errno otherwise
1587  */
1588 
1589 static int shutdown(struct socket *sock, int how)
1590 {
1591 	struct sock *sk = sock->sk;
1592 	struct tipc_port *tport = tipc_sk_port(sk);
1593 	struct sk_buff *buf;
1594 	int res;
1595 
1596 	if (how != SHUT_RDWR)
1597 		return -EINVAL;
1598 
1599 	lock_sock(sk);
1600 
1601 	switch (sock->state) {
1602 	case SS_CONNECTING:
1603 	case SS_CONNECTED:
1604 
1605 		/* Disconnect and send a 'FIN+' or 'FIN-' message to peer */
1606 restart:
1607 		buf = __skb_dequeue(&sk->sk_receive_queue);
1608 		if (buf) {
1609 			atomic_dec(&tipc_queue_size);
1610 			if (TIPC_SKB_CB(buf)->handle != msg_data(buf_msg(buf))) {
1611 				buf_discard(buf);
1612 				goto restart;
1613 			}
1614 			tipc_disconnect(tport->ref);
1615 			tipc_reject_msg(buf, TIPC_CONN_SHUTDOWN);
1616 		} else {
1617 			tipc_shutdown(tport->ref);
1618 		}
1619 
1620 		sock->state = SS_DISCONNECTING;
1621 
1622 		/* fall through */
1623 
1624 	case SS_DISCONNECTING:
1625 
1626 		/* Discard any unreceived messages; wake up sleeping tasks */
1627 
1628 		discard_rx_queue(sk);
1629 		if (waitqueue_active(sk->sk_sleep))
1630 			wake_up_interruptible(sk->sk_sleep);
1631 		res = 0;
1632 		break;
1633 
1634 	default:
1635 		res = -ENOTCONN;
1636 	}
1637 
1638 	release_sock(sk);
1639 	return res;
1640 }
1641 
1642 /**
1643  * setsockopt - set socket option
1644  * @sock: socket structure
1645  * @lvl: option level
1646  * @opt: option identifier
1647  * @ov: pointer to new option value
1648  * @ol: length of option value
1649  *
1650  * For stream sockets only, accepts and ignores all IPPROTO_TCP options
1651  * (to ease compatibility).
1652  *
1653  * Returns 0 on success, errno otherwise
1654  */
1655 
1656 static int setsockopt(struct socket *sock,
1657 		      int lvl, int opt, char __user *ov, int ol)
1658 {
1659 	struct sock *sk = sock->sk;
1660 	struct tipc_port *tport = tipc_sk_port(sk);
1661 	u32 value;
1662 	int res;
1663 
1664 	if ((lvl == IPPROTO_TCP) && (sock->type == SOCK_STREAM))
1665 		return 0;
1666 	if (lvl != SOL_TIPC)
1667 		return -ENOPROTOOPT;
1668 	if (ol < sizeof(value))
1669 		return -EINVAL;
1670 	if ((res = get_user(value, (u32 __user *)ov)))
1671 		return res;
1672 
1673 	lock_sock(sk);
1674 
1675 	switch (opt) {
1676 	case TIPC_IMPORTANCE:
1677 		res = tipc_set_portimportance(tport->ref, value);
1678 		break;
1679 	case TIPC_SRC_DROPPABLE:
1680 		if (sock->type != SOCK_STREAM)
1681 			res = tipc_set_portunreliable(tport->ref, value);
1682 		else
1683 			res = -ENOPROTOOPT;
1684 		break;
1685 	case TIPC_DEST_DROPPABLE:
1686 		res = tipc_set_portunreturnable(tport->ref, value);
1687 		break;
1688 	case TIPC_CONN_TIMEOUT:
1689 		sk->sk_rcvtimeo = msecs_to_jiffies(value);
1690 		/* no need to set "res", since already 0 at this point */
1691 		break;
1692 	default:
1693 		res = -EINVAL;
1694 	}
1695 
1696 	release_sock(sk);
1697 
1698 	return res;
1699 }
1700 
1701 /**
1702  * getsockopt - get socket option
1703  * @sock: socket structure
1704  * @lvl: option level
1705  * @opt: option identifier
1706  * @ov: receptacle for option value
1707  * @ol: receptacle for length of option value
1708  *
1709  * For stream sockets only, returns 0 length result for all IPPROTO_TCP options
1710  * (to ease compatibility).
1711  *
1712  * Returns 0 on success, errno otherwise
1713  */
1714 
1715 static int getsockopt(struct socket *sock,
1716 		      int lvl, int opt, char __user *ov, int __user *ol)
1717 {
1718 	struct sock *sk = sock->sk;
1719 	struct tipc_port *tport = tipc_sk_port(sk);
1720 	int len;
1721 	u32 value;
1722 	int res;
1723 
1724 	if ((lvl == IPPROTO_TCP) && (sock->type == SOCK_STREAM))
1725 		return put_user(0, ol);
1726 	if (lvl != SOL_TIPC)
1727 		return -ENOPROTOOPT;
1728 	if ((res = get_user(len, ol)))
1729 		return res;
1730 
1731 	lock_sock(sk);
1732 
1733 	switch (opt) {
1734 	case TIPC_IMPORTANCE:
1735 		res = tipc_portimportance(tport->ref, &value);
1736 		break;
1737 	case TIPC_SRC_DROPPABLE:
1738 		res = tipc_portunreliable(tport->ref, &value);
1739 		break;
1740 	case TIPC_DEST_DROPPABLE:
1741 		res = tipc_portunreturnable(tport->ref, &value);
1742 		break;
1743 	case TIPC_CONN_TIMEOUT:
1744 		value = jiffies_to_msecs(sk->sk_rcvtimeo);
1745 		/* no need to set "res", since already 0 at this point */
1746 		break;
1747 	default:
1748 		res = -EINVAL;
1749 	}
1750 
1751 	release_sock(sk);
1752 
1753 	if (res) {
1754 		/* "get" failed */
1755 	}
1756 	else if (len < sizeof(value)) {
1757 		res = -EINVAL;
1758 	}
1759 	else if (copy_to_user(ov, &value, sizeof(value))) {
1760 		res = -EFAULT;
1761 	}
1762 	else {
1763 		res = put_user(sizeof(value), ol);
1764 	}
1765 
1766 	return res;
1767 }
1768 
1769 /**
1770  * Protocol switches for the various types of TIPC sockets
1771  */
1772 
1773 static const struct proto_ops msg_ops = {
1774 	.owner 		= THIS_MODULE,
1775 	.family		= AF_TIPC,
1776 	.release	= release,
1777 	.bind		= bind,
1778 	.connect	= connect,
1779 	.socketpair	= sock_no_socketpair,
1780 	.accept		= accept,
1781 	.getname	= get_name,
1782 	.poll		= poll,
1783 	.ioctl		= sock_no_ioctl,
1784 	.listen		= listen,
1785 	.shutdown	= shutdown,
1786 	.setsockopt	= setsockopt,
1787 	.getsockopt	= getsockopt,
1788 	.sendmsg	= send_msg,
1789 	.recvmsg	= recv_msg,
1790 	.mmap		= sock_no_mmap,
1791 	.sendpage	= sock_no_sendpage
1792 };
1793 
1794 static const struct proto_ops packet_ops = {
1795 	.owner 		= THIS_MODULE,
1796 	.family		= AF_TIPC,
1797 	.release	= release,
1798 	.bind		= bind,
1799 	.connect	= connect,
1800 	.socketpair	= sock_no_socketpair,
1801 	.accept		= accept,
1802 	.getname	= get_name,
1803 	.poll		= poll,
1804 	.ioctl		= sock_no_ioctl,
1805 	.listen		= listen,
1806 	.shutdown	= shutdown,
1807 	.setsockopt	= setsockopt,
1808 	.getsockopt	= getsockopt,
1809 	.sendmsg	= send_packet,
1810 	.recvmsg	= recv_msg,
1811 	.mmap		= sock_no_mmap,
1812 	.sendpage	= sock_no_sendpage
1813 };
1814 
1815 static const struct proto_ops stream_ops = {
1816 	.owner 		= THIS_MODULE,
1817 	.family		= AF_TIPC,
1818 	.release	= release,
1819 	.bind		= bind,
1820 	.connect	= connect,
1821 	.socketpair	= sock_no_socketpair,
1822 	.accept		= accept,
1823 	.getname	= get_name,
1824 	.poll		= poll,
1825 	.ioctl		= sock_no_ioctl,
1826 	.listen		= listen,
1827 	.shutdown	= shutdown,
1828 	.setsockopt	= setsockopt,
1829 	.getsockopt	= getsockopt,
1830 	.sendmsg	= send_stream,
1831 	.recvmsg	= recv_stream,
1832 	.mmap		= sock_no_mmap,
1833 	.sendpage	= sock_no_sendpage
1834 };
1835 
1836 static const struct net_proto_family tipc_family_ops = {
1837 	.owner 		= THIS_MODULE,
1838 	.family		= AF_TIPC,
1839 	.create		= tipc_create
1840 };
1841 
1842 static struct proto tipc_proto = {
1843 	.name		= "TIPC",
1844 	.owner		= THIS_MODULE,
1845 	.obj_size	= sizeof(struct tipc_sock)
1846 };
1847 
1848 /**
1849  * tipc_socket_init - initialize TIPC socket interface
1850  *
1851  * Returns 0 on success, errno otherwise
1852  */
1853 int tipc_socket_init(void)
1854 {
1855 	int res;
1856 
1857 	res = proto_register(&tipc_proto, 1);
1858 	if (res) {
1859 		err("Failed to register TIPC protocol type\n");
1860 		goto out;
1861 	}
1862 
1863 	res = sock_register(&tipc_family_ops);
1864 	if (res) {
1865 		err("Failed to register TIPC socket type\n");
1866 		proto_unregister(&tipc_proto);
1867 		goto out;
1868 	}
1869 
1870 	sockets_enabled = 1;
1871  out:
1872 	return res;
1873 }
1874 
1875 /**
1876  * tipc_socket_stop - stop TIPC socket interface
1877  */
1878 
1879 void tipc_socket_stop(void)
1880 {
1881 	if (!sockets_enabled)
1882 		return;
1883 
1884 	sockets_enabled = 0;
1885 	sock_unregister(tipc_family_ops.family);
1886 	proto_unregister(&tipc_proto);
1887 }
1888 
1889