tipc: resolve race problem at unicast message reception
[cascardo/linux.git] / net / tipc / socket.c
1 /*
2  * net/tipc/socket.c: TIPC socket API
3  *
4  * Copyright (c) 2001-2007, 2012-2014, Ericsson AB
5  * Copyright (c) 2004-2008, 2010-2013, 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/rhashtable.h>
38 #include <linux/jhash.h>
39 #include "core.h"
40 #include "name_table.h"
41 #include "node.h"
42 #include "link.h"
43 #include "config.h"
44 #include "name_distr.h"
45 #include "socket.h"
46
47 #define SS_LISTENING            -1      /* socket is listening */
48 #define SS_READY                -2      /* socket is connectionless */
49
50 #define CONN_TIMEOUT_DEFAULT    8000    /* default connect timeout = 8s */
51 #define CONN_PROBING_INTERVAL   msecs_to_jiffies(3600000)  /* [ms] => 1 h */
52 #define TIPC_FWD_MSG            1
53 #define TIPC_CONN_OK            0
54 #define TIPC_CONN_PROBING       1
55 #define TIPC_MAX_PORT           0xffffffff
56 #define TIPC_MIN_PORT           1
57
58 /**
59  * struct tipc_sock - TIPC socket structure
60  * @sk: socket - interacts with 'port' and with user via the socket API
61  * @connected: non-zero if port is currently connected to a peer port
62  * @conn_type: TIPC type used when connection was established
63  * @conn_instance: TIPC instance used when connection was established
64  * @published: non-zero if port has one or more associated names
65  * @max_pkt: maximum packet size "hint" used when building messages sent by port
66  * @portid: unique port identity in TIPC socket hash table
67  * @phdr: preformatted message header used when sending messages
68  * @port_list: adjacent ports in TIPC's global list of ports
69  * @publications: list of publications for port
70  * @pub_count: total # of publications port has made during its lifetime
71  * @probing_state:
72  * @probing_intv:
73  * @conn_timeout: the time we can wait for an unresponded setup request
74  * @dupl_rcvcnt: number of bytes counted twice, in both backlog and rcv queue
75  * @link_cong: non-zero if owner must sleep because of link congestion
76  * @sent_unacked: # messages sent by socket, and not yet acked by peer
77  * @rcv_unacked: # messages read by user, but not yet acked back to peer
78  * @node: hash table node
79  * @rcu: rcu struct for tipc_sock
80  */
81 struct tipc_sock {
82         struct sock sk;
83         int connected;
84         u32 conn_type;
85         u32 conn_instance;
86         int published;
87         u32 max_pkt;
88         u32 portid;
89         struct tipc_msg phdr;
90         struct list_head sock_list;
91         struct list_head publications;
92         u32 pub_count;
93         u32 probing_state;
94         unsigned long probing_intv;
95         uint conn_timeout;
96         atomic_t dupl_rcvcnt;
97         bool link_cong;
98         uint sent_unacked;
99         uint rcv_unacked;
100         struct rhash_head node;
101         struct rcu_head rcu;
102 };
103
104 static int tipc_backlog_rcv(struct sock *sk, struct sk_buff *skb);
105 static void tipc_data_ready(struct sock *sk);
106 static void tipc_write_space(struct sock *sk);
107 static int tipc_release(struct socket *sock);
108 static int tipc_accept(struct socket *sock, struct socket *new_sock, int flags);
109 static int tipc_wait_for_sndmsg(struct socket *sock, long *timeo_p);
110 static void tipc_sk_timeout(unsigned long data);
111 static int tipc_sk_publish(struct tipc_sock *tsk, uint scope,
112                            struct tipc_name_seq const *seq);
113 static int tipc_sk_withdraw(struct tipc_sock *tsk, uint scope,
114                             struct tipc_name_seq const *seq);
115 static struct tipc_sock *tipc_sk_lookup(struct net *net, u32 portid);
116 static int tipc_sk_insert(struct tipc_sock *tsk);
117 static void tipc_sk_remove(struct tipc_sock *tsk);
118
119 static const struct proto_ops packet_ops;
120 static const struct proto_ops stream_ops;
121 static const struct proto_ops msg_ops;
122
123 static struct proto tipc_proto;
124 static struct proto tipc_proto_kern;
125
126 static const struct nla_policy tipc_nl_sock_policy[TIPC_NLA_SOCK_MAX + 1] = {
127         [TIPC_NLA_SOCK_UNSPEC]          = { .type = NLA_UNSPEC },
128         [TIPC_NLA_SOCK_ADDR]            = { .type = NLA_U32 },
129         [TIPC_NLA_SOCK_REF]             = { .type = NLA_U32 },
130         [TIPC_NLA_SOCK_CON]             = { .type = NLA_NESTED },
131         [TIPC_NLA_SOCK_HAS_PUBL]        = { .type = NLA_FLAG }
132 };
133
134 /*
135  * Revised TIPC socket locking policy:
136  *
137  * Most socket operations take the standard socket lock when they start
138  * and hold it until they finish (or until they need to sleep).  Acquiring
139  * this lock grants the owner exclusive access to the fields of the socket
140  * data structures, with the exception of the backlog queue.  A few socket
141  * operations can be done without taking the socket lock because they only
142  * read socket information that never changes during the life of the socket.
143  *
144  * Socket operations may acquire the lock for the associated TIPC port if they
145  * need to perform an operation on the port.  If any routine needs to acquire
146  * both the socket lock and the port lock it must take the socket lock first
147  * to avoid the risk of deadlock.
148  *
149  * The dispatcher handling incoming messages cannot grab the socket lock in
150  * the standard fashion, since invoked it runs at the BH level and cannot block.
151  * Instead, it checks to see if the socket lock is currently owned by someone,
152  * and either handles the message itself or adds it to the socket's backlog
153  * queue; in the latter case the queued message is processed once the process
154  * owning the socket lock releases it.
155  *
156  * NOTE: Releasing the socket lock while an operation is sleeping overcomes
157  * the problem of a blocked socket operation preventing any other operations
158  * from occurring.  However, applications must be careful if they have
159  * multiple threads trying to send (or receive) on the same socket, as these
160  * operations might interfere with each other.  For example, doing a connect
161  * and a receive at the same time might allow the receive to consume the
162  * ACK message meant for the connect.  While additional work could be done
163  * to try and overcome this, it doesn't seem to be worthwhile at the present.
164  *
165  * NOTE: Releasing the socket lock while an operation is sleeping also ensures
166  * that another operation that must be performed in a non-blocking manner is
167  * not delayed for very long because the lock has already been taken.
168  *
169  * NOTE: This code assumes that certain fields of a port/socket pair are
170  * constant over its lifetime; such fields can be examined without taking
171  * the socket lock and/or port lock, and do not need to be re-read even
172  * after resuming processing after waiting.  These fields include:
173  *   - socket type
174  *   - pointer to socket sk structure (aka tipc_sock structure)
175  *   - pointer to port structure
176  *   - port reference
177  */
178
179 static u32 tsk_own_node(struct tipc_sock *tsk)
180 {
181         return msg_prevnode(&tsk->phdr);
182 }
183
184 static u32 tsk_peer_node(struct tipc_sock *tsk)
185 {
186         return msg_destnode(&tsk->phdr);
187 }
188
189 static u32 tsk_peer_port(struct tipc_sock *tsk)
190 {
191         return msg_destport(&tsk->phdr);
192 }
193
194 static  bool tsk_unreliable(struct tipc_sock *tsk)
195 {
196         return msg_src_droppable(&tsk->phdr) != 0;
197 }
198
199 static void tsk_set_unreliable(struct tipc_sock *tsk, bool unreliable)
200 {
201         msg_set_src_droppable(&tsk->phdr, unreliable ? 1 : 0);
202 }
203
204 static bool tsk_unreturnable(struct tipc_sock *tsk)
205 {
206         return msg_dest_droppable(&tsk->phdr) != 0;
207 }
208
209 static void tsk_set_unreturnable(struct tipc_sock *tsk, bool unreturnable)
210 {
211         msg_set_dest_droppable(&tsk->phdr, unreturnable ? 1 : 0);
212 }
213
214 static int tsk_importance(struct tipc_sock *tsk)
215 {
216         return msg_importance(&tsk->phdr);
217 }
218
219 static int tsk_set_importance(struct tipc_sock *tsk, int imp)
220 {
221         if (imp > TIPC_CRITICAL_IMPORTANCE)
222                 return -EINVAL;
223         msg_set_importance(&tsk->phdr, (u32)imp);
224         return 0;
225 }
226
227 static struct tipc_sock *tipc_sk(const struct sock *sk)
228 {
229         return container_of(sk, struct tipc_sock, sk);
230 }
231
232 static int tsk_conn_cong(struct tipc_sock *tsk)
233 {
234         return tsk->sent_unacked >= TIPC_FLOWCTRL_WIN;
235 }
236
237 /**
238  * tsk_advance_rx_queue - discard first buffer in socket receive queue
239  *
240  * Caller must hold socket lock
241  */
242 static void tsk_advance_rx_queue(struct sock *sk)
243 {
244         kfree_skb(__skb_dequeue(&sk->sk_receive_queue));
245 }
246
247 /**
248  * tsk_rej_rx_queue - reject all buffers in socket receive queue
249  *
250  * Caller must hold socket lock
251  */
252 static void tsk_rej_rx_queue(struct sock *sk)
253 {
254         struct sk_buff *skb;
255         u32 dnode;
256         u32 own_node = tsk_own_node(tipc_sk(sk));
257
258         while ((skb = __skb_dequeue(&sk->sk_receive_queue))) {
259                 if (tipc_msg_reverse(own_node, skb, &dnode, TIPC_ERR_NO_PORT))
260                         tipc_link_xmit_skb(sock_net(sk), skb, dnode, 0);
261         }
262 }
263
264 /* tsk_peer_msg - verify if message was sent by connected port's peer
265  *
266  * Handles cases where the node's network address has changed from
267  * the default of <0.0.0> to its configured setting.
268  */
269 static bool tsk_peer_msg(struct tipc_sock *tsk, struct tipc_msg *msg)
270 {
271         struct tipc_net *tn = net_generic(sock_net(&tsk->sk), tipc_net_id);
272         u32 peer_port = tsk_peer_port(tsk);
273         u32 orig_node;
274         u32 peer_node;
275
276         if (unlikely(!tsk->connected))
277                 return false;
278
279         if (unlikely(msg_origport(msg) != peer_port))
280                 return false;
281
282         orig_node = msg_orignode(msg);
283         peer_node = tsk_peer_node(tsk);
284
285         if (likely(orig_node == peer_node))
286                 return true;
287
288         if (!orig_node && (peer_node == tn->own_addr))
289                 return true;
290
291         if (!peer_node && (orig_node == tn->own_addr))
292                 return true;
293
294         return false;
295 }
296
297 /**
298  * tipc_sk_create - create a TIPC socket
299  * @net: network namespace (must be default network)
300  * @sock: pre-allocated socket structure
301  * @protocol: protocol indicator (must be 0)
302  * @kern: caused by kernel or by userspace?
303  *
304  * This routine creates additional data structures used by the TIPC socket,
305  * initializes them, and links them together.
306  *
307  * Returns 0 on success, errno otherwise
308  */
309 static int tipc_sk_create(struct net *net, struct socket *sock,
310                           int protocol, int kern)
311 {
312         struct tipc_net *tn;
313         const struct proto_ops *ops;
314         socket_state state;
315         struct sock *sk;
316         struct tipc_sock *tsk;
317         struct tipc_msg *msg;
318
319         /* Validate arguments */
320         if (unlikely(protocol != 0))
321                 return -EPROTONOSUPPORT;
322
323         switch (sock->type) {
324         case SOCK_STREAM:
325                 ops = &stream_ops;
326                 state = SS_UNCONNECTED;
327                 break;
328         case SOCK_SEQPACKET:
329                 ops = &packet_ops;
330                 state = SS_UNCONNECTED;
331                 break;
332         case SOCK_DGRAM:
333         case SOCK_RDM:
334                 ops = &msg_ops;
335                 state = SS_READY;
336                 break;
337         default:
338                 return -EPROTOTYPE;
339         }
340
341         /* Allocate socket's protocol area */
342         if (!kern)
343                 sk = sk_alloc(net, AF_TIPC, GFP_KERNEL, &tipc_proto);
344         else
345                 sk = sk_alloc(net, AF_TIPC, GFP_KERNEL, &tipc_proto_kern);
346
347         if (sk == NULL)
348                 return -ENOMEM;
349
350         tsk = tipc_sk(sk);
351         tsk->max_pkt = MAX_PKT_DEFAULT;
352         INIT_LIST_HEAD(&tsk->publications);
353         msg = &tsk->phdr;
354         tn = net_generic(sock_net(sk), tipc_net_id);
355         tipc_msg_init(tn->own_addr, msg, TIPC_LOW_IMPORTANCE, TIPC_NAMED_MSG,
356                       NAMED_H_SIZE, 0);
357
358         /* Finish initializing socket data structures */
359         sock->ops = ops;
360         sock->state = state;
361         sock_init_data(sock, sk);
362         if (tipc_sk_insert(tsk)) {
363                 pr_warn("Socket create failed; port numbrer exhausted\n");
364                 return -EINVAL;
365         }
366         msg_set_origport(msg, tsk->portid);
367         setup_timer(&sk->sk_timer, tipc_sk_timeout, (unsigned long)tsk);
368         sk->sk_backlog_rcv = tipc_backlog_rcv;
369         sk->sk_rcvbuf = sysctl_tipc_rmem[1];
370         sk->sk_data_ready = tipc_data_ready;
371         sk->sk_write_space = tipc_write_space;
372         tsk->conn_timeout = CONN_TIMEOUT_DEFAULT;
373         tsk->sent_unacked = 0;
374         atomic_set(&tsk->dupl_rcvcnt, 0);
375
376         if (sock->state == SS_READY) {
377                 tsk_set_unreturnable(tsk, true);
378                 if (sock->type == SOCK_DGRAM)
379                         tsk_set_unreliable(tsk, true);
380         }
381         return 0;
382 }
383
384 /**
385  * tipc_sock_create_local - create TIPC socket from inside TIPC module
386  * @type: socket type - SOCK_RDM or SOCK_SEQPACKET
387  *
388  * We cannot use sock_creat_kern here because it bumps module user count.
389  * Since socket owner and creator is the same module we must make sure
390  * that module count remains zero for module local sockets, otherwise
391  * we cannot do rmmod.
392  *
393  * Returns 0 on success, errno otherwise
394  */
395 int tipc_sock_create_local(struct net *net, int type, struct socket **res)
396 {
397         int rc;
398
399         rc = sock_create_lite(AF_TIPC, type, 0, res);
400         if (rc < 0) {
401                 pr_err("Failed to create kernel socket\n");
402                 return rc;
403         }
404         tipc_sk_create(net, *res, 0, 1);
405
406         return 0;
407 }
408
409 /**
410  * tipc_sock_release_local - release socket created by tipc_sock_create_local
411  * @sock: the socket to be released.
412  *
413  * Module reference count is not incremented when such sockets are created,
414  * so we must keep it from being decremented when they are released.
415  */
416 void tipc_sock_release_local(struct socket *sock)
417 {
418         tipc_release(sock);
419         sock->ops = NULL;
420         sock_release(sock);
421 }
422
423 /**
424  * tipc_sock_accept_local - accept a connection on a socket created
425  * with tipc_sock_create_local. Use this function to avoid that
426  * module reference count is inadvertently incremented.
427  *
428  * @sock:    the accepting socket
429  * @newsock: reference to the new socket to be created
430  * @flags:   socket flags
431  */
432
433 int tipc_sock_accept_local(struct socket *sock, struct socket **newsock,
434                            int flags)
435 {
436         struct sock *sk = sock->sk;
437         int ret;
438
439         ret = sock_create_lite(sk->sk_family, sk->sk_type,
440                                sk->sk_protocol, newsock);
441         if (ret < 0)
442                 return ret;
443
444         ret = tipc_accept(sock, *newsock, flags);
445         if (ret < 0) {
446                 sock_release(*newsock);
447                 return ret;
448         }
449         (*newsock)->ops = sock->ops;
450         return ret;
451 }
452
453 static void tipc_sk_callback(struct rcu_head *head)
454 {
455         struct tipc_sock *tsk = container_of(head, struct tipc_sock, rcu);
456
457         sock_put(&tsk->sk);
458 }
459
460 /**
461  * tipc_release - destroy a TIPC socket
462  * @sock: socket to destroy
463  *
464  * This routine cleans up any messages that are still queued on the socket.
465  * For DGRAM and RDM socket types, all queued messages are rejected.
466  * For SEQPACKET and STREAM socket types, the first message is rejected
467  * and any others are discarded.  (If the first message on a STREAM socket
468  * is partially-read, it is discarded and the next one is rejected instead.)
469  *
470  * NOTE: Rejected messages are not necessarily returned to the sender!  They
471  * are returned or discarded according to the "destination droppable" setting
472  * specified for the message by the sender.
473  *
474  * Returns 0 on success, errno otherwise
475  */
476 static int tipc_release(struct socket *sock)
477 {
478         struct sock *sk = sock->sk;
479         struct net *net;
480         struct tipc_sock *tsk;
481         struct sk_buff *skb;
482         u32 dnode, probing_state;
483
484         /*
485          * Exit if socket isn't fully initialized (occurs when a failed accept()
486          * releases a pre-allocated child socket that was never used)
487          */
488         if (sk == NULL)
489                 return 0;
490
491         net = sock_net(sk);
492         tsk = tipc_sk(sk);
493         lock_sock(sk);
494
495         /*
496          * Reject all unreceived messages, except on an active connection
497          * (which disconnects locally & sends a 'FIN+' to peer)
498          */
499         dnode = tsk_peer_node(tsk);
500         while (sock->state != SS_DISCONNECTING) {
501                 skb = __skb_dequeue(&sk->sk_receive_queue);
502                 if (skb == NULL)
503                         break;
504                 if (TIPC_SKB_CB(skb)->handle != NULL)
505                         kfree_skb(skb);
506                 else {
507                         if ((sock->state == SS_CONNECTING) ||
508                             (sock->state == SS_CONNECTED)) {
509                                 sock->state = SS_DISCONNECTING;
510                                 tsk->connected = 0;
511                                 tipc_node_remove_conn(net, dnode, tsk->portid);
512                         }
513                         if (tipc_msg_reverse(tsk_own_node(tsk), skb, &dnode,
514                                              TIPC_ERR_NO_PORT))
515                                 tipc_link_xmit_skb(net, skb, dnode, 0);
516                 }
517         }
518
519         tipc_sk_withdraw(tsk, 0, NULL);
520         probing_state = tsk->probing_state;
521         if (del_timer_sync(&sk->sk_timer) &&
522             probing_state != TIPC_CONN_PROBING)
523                 sock_put(sk);
524         tipc_sk_remove(tsk);
525         if (tsk->connected) {
526                 skb = tipc_msg_create(TIPC_CRITICAL_IMPORTANCE,
527                                       TIPC_CONN_MSG, SHORT_H_SIZE, 0, dnode,
528                                       tsk_own_node(tsk), tsk_peer_port(tsk),
529                                       tsk->portid, TIPC_ERR_NO_PORT);
530                 if (skb)
531                         tipc_link_xmit_skb(net, skb, dnode, tsk->portid);
532                 tipc_node_remove_conn(net, dnode, tsk->portid);
533         }
534
535         /* Discard any remaining (connection-based) messages in receive queue */
536         __skb_queue_purge(&sk->sk_receive_queue);
537
538         /* Reject any messages that accumulated in backlog queue */
539         sock->state = SS_DISCONNECTING;
540         release_sock(sk);
541
542         call_rcu(&tsk->rcu, tipc_sk_callback);
543         sock->sk = NULL;
544
545         return 0;
546 }
547
548 /**
549  * tipc_bind - associate or disassocate TIPC name(s) with a socket
550  * @sock: socket structure
551  * @uaddr: socket address describing name(s) and desired operation
552  * @uaddr_len: size of socket address data structure
553  *
554  * Name and name sequence binding is indicated using a positive scope value;
555  * a negative scope value unbinds the specified name.  Specifying no name
556  * (i.e. a socket address length of 0) unbinds all names from the socket.
557  *
558  * Returns 0 on success, errno otherwise
559  *
560  * NOTE: This routine doesn't need to take the socket lock since it doesn't
561  *       access any non-constant socket information.
562  */
563 static int tipc_bind(struct socket *sock, struct sockaddr *uaddr,
564                      int uaddr_len)
565 {
566         struct sock *sk = sock->sk;
567         struct sockaddr_tipc *addr = (struct sockaddr_tipc *)uaddr;
568         struct tipc_sock *tsk = tipc_sk(sk);
569         int res = -EINVAL;
570
571         lock_sock(sk);
572         if (unlikely(!uaddr_len)) {
573                 res = tipc_sk_withdraw(tsk, 0, NULL);
574                 goto exit;
575         }
576
577         if (uaddr_len < sizeof(struct sockaddr_tipc)) {
578                 res = -EINVAL;
579                 goto exit;
580         }
581         if (addr->family != AF_TIPC) {
582                 res = -EAFNOSUPPORT;
583                 goto exit;
584         }
585
586         if (addr->addrtype == TIPC_ADDR_NAME)
587                 addr->addr.nameseq.upper = addr->addr.nameseq.lower;
588         else if (addr->addrtype != TIPC_ADDR_NAMESEQ) {
589                 res = -EAFNOSUPPORT;
590                 goto exit;
591         }
592
593         if ((addr->addr.nameseq.type < TIPC_RESERVED_TYPES) &&
594             (addr->addr.nameseq.type != TIPC_TOP_SRV) &&
595             (addr->addr.nameseq.type != TIPC_CFG_SRV)) {
596                 res = -EACCES;
597                 goto exit;
598         }
599
600         res = (addr->scope > 0) ?
601                 tipc_sk_publish(tsk, addr->scope, &addr->addr.nameseq) :
602                 tipc_sk_withdraw(tsk, -addr->scope, &addr->addr.nameseq);
603 exit:
604         release_sock(sk);
605         return res;
606 }
607
608 /**
609  * tipc_getname - get port ID of socket or peer socket
610  * @sock: socket structure
611  * @uaddr: area for returned socket address
612  * @uaddr_len: area for returned length of socket address
613  * @peer: 0 = own ID, 1 = current peer ID, 2 = current/former peer ID
614  *
615  * Returns 0 on success, errno otherwise
616  *
617  * NOTE: This routine doesn't need to take the socket lock since it only
618  *       accesses socket information that is unchanging (or which changes in
619  *       a completely predictable manner).
620  */
621 static int tipc_getname(struct socket *sock, struct sockaddr *uaddr,
622                         int *uaddr_len, int peer)
623 {
624         struct sockaddr_tipc *addr = (struct sockaddr_tipc *)uaddr;
625         struct tipc_sock *tsk = tipc_sk(sock->sk);
626         struct tipc_net *tn = net_generic(sock_net(sock->sk), tipc_net_id);
627
628         memset(addr, 0, sizeof(*addr));
629         if (peer) {
630                 if ((sock->state != SS_CONNECTED) &&
631                         ((peer != 2) || (sock->state != SS_DISCONNECTING)))
632                         return -ENOTCONN;
633                 addr->addr.id.ref = tsk_peer_port(tsk);
634                 addr->addr.id.node = tsk_peer_node(tsk);
635         } else {
636                 addr->addr.id.ref = tsk->portid;
637                 addr->addr.id.node = tn->own_addr;
638         }
639
640         *uaddr_len = sizeof(*addr);
641         addr->addrtype = TIPC_ADDR_ID;
642         addr->family = AF_TIPC;
643         addr->scope = 0;
644         addr->addr.name.domain = 0;
645
646         return 0;
647 }
648
649 /**
650  * tipc_poll - read and possibly block on pollmask
651  * @file: file structure associated with the socket
652  * @sock: socket for which to calculate the poll bits
653  * @wait: ???
654  *
655  * Returns pollmask value
656  *
657  * COMMENTARY:
658  * It appears that the usual socket locking mechanisms are not useful here
659  * since the pollmask info is potentially out-of-date the moment this routine
660  * exits.  TCP and other protocols seem to rely on higher level poll routines
661  * to handle any preventable race conditions, so TIPC will do the same ...
662  *
663  * TIPC sets the returned events as follows:
664  *
665  * socket state         flags set
666  * ------------         ---------
667  * unconnected          no read flags
668  *                      POLLOUT if port is not congested
669  *
670  * connecting           POLLIN/POLLRDNORM if ACK/NACK in rx queue
671  *                      no write flags
672  *
673  * connected            POLLIN/POLLRDNORM if data in rx queue
674  *                      POLLOUT if port is not congested
675  *
676  * disconnecting        POLLIN/POLLRDNORM/POLLHUP
677  *                      no write flags
678  *
679  * listening            POLLIN if SYN in rx queue
680  *                      no write flags
681  *
682  * ready                POLLIN/POLLRDNORM if data in rx queue
683  * [connectionless]     POLLOUT (since port cannot be congested)
684  *
685  * IMPORTANT: The fact that a read or write operation is indicated does NOT
686  * imply that the operation will succeed, merely that it should be performed
687  * and will not block.
688  */
689 static unsigned int tipc_poll(struct file *file, struct socket *sock,
690                               poll_table *wait)
691 {
692         struct sock *sk = sock->sk;
693         struct tipc_sock *tsk = tipc_sk(sk);
694         u32 mask = 0;
695
696         sock_poll_wait(file, sk_sleep(sk), wait);
697
698         switch ((int)sock->state) {
699         case SS_UNCONNECTED:
700                 if (!tsk->link_cong)
701                         mask |= POLLOUT;
702                 break;
703         case SS_READY:
704         case SS_CONNECTED:
705                 if (!tsk->link_cong && !tsk_conn_cong(tsk))
706                         mask |= POLLOUT;
707                 /* fall thru' */
708         case SS_CONNECTING:
709         case SS_LISTENING:
710                 if (!skb_queue_empty(&sk->sk_receive_queue))
711                         mask |= (POLLIN | POLLRDNORM);
712                 break;
713         case SS_DISCONNECTING:
714                 mask = (POLLIN | POLLRDNORM | POLLHUP);
715                 break;
716         }
717
718         return mask;
719 }
720
721 /**
722  * tipc_sendmcast - send multicast message
723  * @sock: socket structure
724  * @seq: destination address
725  * @msg: message to send
726  * @dsz: total length of message data
727  * @timeo: timeout to wait for wakeup
728  *
729  * Called from function tipc_sendmsg(), which has done all sanity checks
730  * Returns the number of bytes sent on success, or errno
731  */
732 static int tipc_sendmcast(struct  socket *sock, struct tipc_name_seq *seq,
733                           struct msghdr *msg, size_t dsz, long timeo)
734 {
735         struct sock *sk = sock->sk;
736         struct tipc_sock *tsk = tipc_sk(sk);
737         struct net *net = sock_net(sk);
738         struct tipc_msg *mhdr = &tsk->phdr;
739         struct sk_buff_head *pktchain = &sk->sk_write_queue;
740         struct iov_iter save = msg->msg_iter;
741         uint mtu;
742         int rc;
743
744         msg_set_type(mhdr, TIPC_MCAST_MSG);
745         msg_set_lookup_scope(mhdr, TIPC_CLUSTER_SCOPE);
746         msg_set_destport(mhdr, 0);
747         msg_set_destnode(mhdr, 0);
748         msg_set_nametype(mhdr, seq->type);
749         msg_set_namelower(mhdr, seq->lower);
750         msg_set_nameupper(mhdr, seq->upper);
751         msg_set_hdr_sz(mhdr, MCAST_H_SIZE);
752
753 new_mtu:
754         mtu = tipc_bclink_get_mtu();
755         rc = tipc_msg_build(mhdr, msg, 0, dsz, mtu, pktchain);
756         if (unlikely(rc < 0))
757                 return rc;
758
759         do {
760                 rc = tipc_bclink_xmit(net, pktchain);
761                 if (likely(rc >= 0)) {
762                         rc = dsz;
763                         break;
764                 }
765                 if (rc == -EMSGSIZE) {
766                         msg->msg_iter = save;
767                         goto new_mtu;
768                 }
769                 if (rc != -ELINKCONG)
770                         break;
771                 tipc_sk(sk)->link_cong = 1;
772                 rc = tipc_wait_for_sndmsg(sock, &timeo);
773                 if (rc)
774                         __skb_queue_purge(pktchain);
775         } while (!rc);
776         return rc;
777 }
778
779 /* tipc_sk_mcast_rcv - Deliver multicast message to all destination sockets
780  */
781 void tipc_sk_mcast_rcv(struct net *net, struct sk_buff *buf)
782 {
783         struct tipc_msg *msg = buf_msg(buf);
784         struct tipc_port_list dports = {0, NULL, };
785         struct tipc_port_list *item;
786         struct sk_buff *b;
787         uint i, last, dst = 0;
788         u32 scope = TIPC_CLUSTER_SCOPE;
789         struct sk_buff_head msgs;
790
791         if (in_own_node(net, msg_orignode(msg)))
792                 scope = TIPC_NODE_SCOPE;
793
794         if (unlikely(!msg_mcast(msg))) {
795                 pr_warn("Received non-multicast msg in multicast\n");
796                 kfree_skb(buf);
797                 goto exit;
798         }
799         /* Create destination port list: */
800         tipc_nametbl_mc_translate(net, msg_nametype(msg), msg_namelower(msg),
801                                   msg_nameupper(msg), scope, &dports);
802         last = dports.count;
803         if (!last) {
804                 kfree_skb(buf);
805                 return;
806         }
807
808         for (item = &dports; item; item = item->next) {
809                 for (i = 0; i < PLSIZE && ++dst <= last; i++) {
810                         b = (dst != last) ? skb_clone(buf, GFP_ATOMIC) : buf;
811                         if (!b) {
812                                 pr_warn("Failed do clone mcast rcv buffer\n");
813                                 continue;
814                         }
815                         msg_set_destport(msg, item->ports[i]);
816                         skb_queue_head_init(&msgs);
817                         skb_queue_tail(&msgs, b);
818                         tipc_sk_rcv(net, &msgs);
819                 }
820         }
821 exit:
822         tipc_port_list_free(&dports);
823 }
824
825 /**
826  * tipc_sk_proto_rcv - receive a connection mng protocol message
827  * @tsk: receiving socket
828  * @skb: pointer to message buffer. Set to NULL if buffer is consumed.
829  */
830 static void tipc_sk_proto_rcv(struct tipc_sock *tsk, struct sk_buff **skb)
831 {
832         struct tipc_msg *msg = buf_msg(*skb);
833         int conn_cong;
834         u32 dnode;
835         u32 own_node = tsk_own_node(tsk);
836         /* Ignore if connection cannot be validated: */
837         if (!tsk_peer_msg(tsk, msg))
838                 goto exit;
839
840         tsk->probing_state = TIPC_CONN_OK;
841
842         if (msg_type(msg) == CONN_ACK) {
843                 conn_cong = tsk_conn_cong(tsk);
844                 tsk->sent_unacked -= msg_msgcnt(msg);
845                 if (conn_cong)
846                         tsk->sk.sk_write_space(&tsk->sk);
847         } else if (msg_type(msg) == CONN_PROBE) {
848                 if (tipc_msg_reverse(own_node, *skb, &dnode, TIPC_OK)) {
849                         msg_set_type(msg, CONN_PROBE_REPLY);
850                         return;
851                 }
852         }
853         /* Do nothing if msg_type() == CONN_PROBE_REPLY */
854 exit:
855         kfree_skb(*skb);
856         *skb = NULL;
857 }
858
859 static int tipc_wait_for_sndmsg(struct socket *sock, long *timeo_p)
860 {
861         struct sock *sk = sock->sk;
862         struct tipc_sock *tsk = tipc_sk(sk);
863         DEFINE_WAIT(wait);
864         int done;
865
866         do {
867                 int err = sock_error(sk);
868                 if (err)
869                         return err;
870                 if (sock->state == SS_DISCONNECTING)
871                         return -EPIPE;
872                 if (!*timeo_p)
873                         return -EAGAIN;
874                 if (signal_pending(current))
875                         return sock_intr_errno(*timeo_p);
876
877                 prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
878                 done = sk_wait_event(sk, timeo_p, !tsk->link_cong);
879                 finish_wait(sk_sleep(sk), &wait);
880         } while (!done);
881         return 0;
882 }
883
884 /**
885  * tipc_sendmsg - send message in connectionless manner
886  * @iocb: if NULL, indicates that socket lock is already held
887  * @sock: socket structure
888  * @m: message to send
889  * @dsz: amount of user data to be sent
890  *
891  * Message must have an destination specified explicitly.
892  * Used for SOCK_RDM and SOCK_DGRAM messages,
893  * and for 'SYN' messages on SOCK_SEQPACKET and SOCK_STREAM connections.
894  * (Note: 'SYN+' is prohibited on SOCK_STREAM.)
895  *
896  * Returns the number of bytes sent on success, or errno otherwise
897  */
898 static int tipc_sendmsg(struct kiocb *iocb, struct socket *sock,
899                         struct msghdr *m, size_t dsz)
900 {
901         DECLARE_SOCKADDR(struct sockaddr_tipc *, dest, m->msg_name);
902         struct sock *sk = sock->sk;
903         struct tipc_sock *tsk = tipc_sk(sk);
904         struct net *net = sock_net(sk);
905         struct tipc_msg *mhdr = &tsk->phdr;
906         u32 dnode, dport;
907         struct sk_buff_head *pktchain = &sk->sk_write_queue;
908         struct sk_buff *skb;
909         struct tipc_name_seq *seq = &dest->addr.nameseq;
910         struct iov_iter save;
911         u32 mtu;
912         long timeo;
913         int rc;
914
915         if (unlikely(!dest))
916                 return -EDESTADDRREQ;
917
918         if (unlikely((m->msg_namelen < sizeof(*dest)) ||
919                      (dest->family != AF_TIPC)))
920                 return -EINVAL;
921
922         if (dsz > TIPC_MAX_USER_MSG_SIZE)
923                 return -EMSGSIZE;
924
925         if (iocb)
926                 lock_sock(sk);
927
928         if (unlikely(sock->state != SS_READY)) {
929                 if (sock->state == SS_LISTENING) {
930                         rc = -EPIPE;
931                         goto exit;
932                 }
933                 if (sock->state != SS_UNCONNECTED) {
934                         rc = -EISCONN;
935                         goto exit;
936                 }
937                 if (tsk->published) {
938                         rc = -EOPNOTSUPP;
939                         goto exit;
940                 }
941                 if (dest->addrtype == TIPC_ADDR_NAME) {
942                         tsk->conn_type = dest->addr.name.name.type;
943                         tsk->conn_instance = dest->addr.name.name.instance;
944                 }
945         }
946
947         timeo = sock_sndtimeo(sk, m->msg_flags & MSG_DONTWAIT);
948
949         if (dest->addrtype == TIPC_ADDR_MCAST) {
950                 rc = tipc_sendmcast(sock, seq, m, dsz, timeo);
951                 goto exit;
952         } else if (dest->addrtype == TIPC_ADDR_NAME) {
953                 u32 type = dest->addr.name.name.type;
954                 u32 inst = dest->addr.name.name.instance;
955                 u32 domain = dest->addr.name.domain;
956
957                 dnode = domain;
958                 msg_set_type(mhdr, TIPC_NAMED_MSG);
959                 msg_set_hdr_sz(mhdr, NAMED_H_SIZE);
960                 msg_set_nametype(mhdr, type);
961                 msg_set_nameinst(mhdr, inst);
962                 msg_set_lookup_scope(mhdr, tipc_addr_scope(domain));
963                 dport = tipc_nametbl_translate(net, type, inst, &dnode);
964                 msg_set_destnode(mhdr, dnode);
965                 msg_set_destport(mhdr, dport);
966                 if (unlikely(!dport && !dnode)) {
967                         rc = -EHOSTUNREACH;
968                         goto exit;
969                 }
970         } else if (dest->addrtype == TIPC_ADDR_ID) {
971                 dnode = dest->addr.id.node;
972                 msg_set_type(mhdr, TIPC_DIRECT_MSG);
973                 msg_set_lookup_scope(mhdr, 0);
974                 msg_set_destnode(mhdr, dnode);
975                 msg_set_destport(mhdr, dest->addr.id.ref);
976                 msg_set_hdr_sz(mhdr, BASIC_H_SIZE);
977         }
978
979         save = m->msg_iter;
980 new_mtu:
981         mtu = tipc_node_get_mtu(net, dnode, tsk->portid);
982         rc = tipc_msg_build(mhdr, m, 0, dsz, mtu, pktchain);
983         if (rc < 0)
984                 goto exit;
985
986         do {
987                 skb = skb_peek(pktchain);
988                 TIPC_SKB_CB(skb)->wakeup_pending = tsk->link_cong;
989                 rc = tipc_link_xmit(net, pktchain, dnode, tsk->portid);
990                 if (likely(rc >= 0)) {
991                         if (sock->state != SS_READY)
992                                 sock->state = SS_CONNECTING;
993                         rc = dsz;
994                         break;
995                 }
996                 if (rc == -EMSGSIZE) {
997                         m->msg_iter = save;
998                         goto new_mtu;
999                 }
1000                 if (rc != -ELINKCONG)
1001                         break;
1002                 tsk->link_cong = 1;
1003                 rc = tipc_wait_for_sndmsg(sock, &timeo);
1004                 if (rc)
1005                         __skb_queue_purge(pktchain);
1006         } while (!rc);
1007 exit:
1008         if (iocb)
1009                 release_sock(sk);
1010
1011         return rc;
1012 }
1013
1014 static int tipc_wait_for_sndpkt(struct socket *sock, long *timeo_p)
1015 {
1016         struct sock *sk = sock->sk;
1017         struct tipc_sock *tsk = tipc_sk(sk);
1018         DEFINE_WAIT(wait);
1019         int done;
1020
1021         do {
1022                 int err = sock_error(sk);
1023                 if (err)
1024                         return err;
1025                 if (sock->state == SS_DISCONNECTING)
1026                         return -EPIPE;
1027                 else if (sock->state != SS_CONNECTED)
1028                         return -ENOTCONN;
1029                 if (!*timeo_p)
1030                         return -EAGAIN;
1031                 if (signal_pending(current))
1032                         return sock_intr_errno(*timeo_p);
1033
1034                 prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
1035                 done = sk_wait_event(sk, timeo_p,
1036                                      (!tsk->link_cong &&
1037                                       !tsk_conn_cong(tsk)) ||
1038                                      !tsk->connected);
1039                 finish_wait(sk_sleep(sk), &wait);
1040         } while (!done);
1041         return 0;
1042 }
1043
1044 /**
1045  * tipc_send_stream - send stream-oriented data
1046  * @iocb: (unused)
1047  * @sock: socket structure
1048  * @m: data to send
1049  * @dsz: total length of data to be transmitted
1050  *
1051  * Used for SOCK_STREAM data.
1052  *
1053  * Returns the number of bytes sent on success (or partial success),
1054  * or errno if no data sent
1055  */
1056 static int tipc_send_stream(struct kiocb *iocb, struct socket *sock,
1057                             struct msghdr *m, size_t dsz)
1058 {
1059         struct sock *sk = sock->sk;
1060         struct net *net = sock_net(sk);
1061         struct tipc_sock *tsk = tipc_sk(sk);
1062         struct tipc_msg *mhdr = &tsk->phdr;
1063         struct sk_buff_head *pktchain = &sk->sk_write_queue;
1064         DECLARE_SOCKADDR(struct sockaddr_tipc *, dest, m->msg_name);
1065         u32 portid = tsk->portid;
1066         int rc = -EINVAL;
1067         long timeo;
1068         u32 dnode;
1069         uint mtu, send, sent = 0;
1070         struct iov_iter save;
1071
1072         /* Handle implied connection establishment */
1073         if (unlikely(dest)) {
1074                 rc = tipc_sendmsg(iocb, sock, m, dsz);
1075                 if (dsz && (dsz == rc))
1076                         tsk->sent_unacked = 1;
1077                 return rc;
1078         }
1079         if (dsz > (uint)INT_MAX)
1080                 return -EMSGSIZE;
1081
1082         if (iocb)
1083                 lock_sock(sk);
1084
1085         if (unlikely(sock->state != SS_CONNECTED)) {
1086                 if (sock->state == SS_DISCONNECTING)
1087                         rc = -EPIPE;
1088                 else
1089                         rc = -ENOTCONN;
1090                 goto exit;
1091         }
1092
1093         timeo = sock_sndtimeo(sk, m->msg_flags & MSG_DONTWAIT);
1094         dnode = tsk_peer_node(tsk);
1095
1096 next:
1097         save = m->msg_iter;
1098         mtu = tsk->max_pkt;
1099         send = min_t(uint, dsz - sent, TIPC_MAX_USER_MSG_SIZE);
1100         rc = tipc_msg_build(mhdr, m, sent, send, mtu, pktchain);
1101         if (unlikely(rc < 0))
1102                 goto exit;
1103         do {
1104                 if (likely(!tsk_conn_cong(tsk))) {
1105                         rc = tipc_link_xmit(net, pktchain, dnode, portid);
1106                         if (likely(!rc)) {
1107                                 tsk->sent_unacked++;
1108                                 sent += send;
1109                                 if (sent == dsz)
1110                                         break;
1111                                 goto next;
1112                         }
1113                         if (rc == -EMSGSIZE) {
1114                                 tsk->max_pkt = tipc_node_get_mtu(net, dnode,
1115                                                                  portid);
1116                                 m->msg_iter = save;
1117                                 goto next;
1118                         }
1119                         if (rc != -ELINKCONG)
1120                                 break;
1121                         tsk->link_cong = 1;
1122                 }
1123                 rc = tipc_wait_for_sndpkt(sock, &timeo);
1124                 if (rc)
1125                         __skb_queue_purge(pktchain);
1126         } while (!rc);
1127 exit:
1128         if (iocb)
1129                 release_sock(sk);
1130         return sent ? sent : rc;
1131 }
1132
1133 /**
1134  * tipc_send_packet - send a connection-oriented message
1135  * @iocb: if NULL, indicates that socket lock is already held
1136  * @sock: socket structure
1137  * @m: message to send
1138  * @dsz: length of data to be transmitted
1139  *
1140  * Used for SOCK_SEQPACKET messages.
1141  *
1142  * Returns the number of bytes sent on success, or errno otherwise
1143  */
1144 static int tipc_send_packet(struct kiocb *iocb, struct socket *sock,
1145                             struct msghdr *m, size_t dsz)
1146 {
1147         if (dsz > TIPC_MAX_USER_MSG_SIZE)
1148                 return -EMSGSIZE;
1149
1150         return tipc_send_stream(iocb, sock, m, dsz);
1151 }
1152
1153 /* tipc_sk_finish_conn - complete the setup of a connection
1154  */
1155 static void tipc_sk_finish_conn(struct tipc_sock *tsk, u32 peer_port,
1156                                 u32 peer_node)
1157 {
1158         struct sock *sk = &tsk->sk;
1159         struct net *net = sock_net(sk);
1160         struct tipc_msg *msg = &tsk->phdr;
1161
1162         msg_set_destnode(msg, peer_node);
1163         msg_set_destport(msg, peer_port);
1164         msg_set_type(msg, TIPC_CONN_MSG);
1165         msg_set_lookup_scope(msg, 0);
1166         msg_set_hdr_sz(msg, SHORT_H_SIZE);
1167
1168         tsk->probing_intv = CONN_PROBING_INTERVAL;
1169         tsk->probing_state = TIPC_CONN_OK;
1170         tsk->connected = 1;
1171         sk_reset_timer(sk, &sk->sk_timer, jiffies + tsk->probing_intv);
1172         tipc_node_add_conn(net, peer_node, tsk->portid, peer_port);
1173         tsk->max_pkt = tipc_node_get_mtu(net, peer_node, tsk->portid);
1174 }
1175
1176 /**
1177  * set_orig_addr - capture sender's address for received message
1178  * @m: descriptor for message info
1179  * @msg: received message header
1180  *
1181  * Note: Address is not captured if not requested by receiver.
1182  */
1183 static void set_orig_addr(struct msghdr *m, struct tipc_msg *msg)
1184 {
1185         DECLARE_SOCKADDR(struct sockaddr_tipc *, addr, m->msg_name);
1186
1187         if (addr) {
1188                 addr->family = AF_TIPC;
1189                 addr->addrtype = TIPC_ADDR_ID;
1190                 memset(&addr->addr, 0, sizeof(addr->addr));
1191                 addr->addr.id.ref = msg_origport(msg);
1192                 addr->addr.id.node = msg_orignode(msg);
1193                 addr->addr.name.domain = 0;     /* could leave uninitialized */
1194                 addr->scope = 0;                /* could leave uninitialized */
1195                 m->msg_namelen = sizeof(struct sockaddr_tipc);
1196         }
1197 }
1198
1199 /**
1200  * tipc_sk_anc_data_recv - optionally capture ancillary data for received message
1201  * @m: descriptor for message info
1202  * @msg: received message header
1203  * @tsk: TIPC port associated with message
1204  *
1205  * Note: Ancillary data is not captured if not requested by receiver.
1206  *
1207  * Returns 0 if successful, otherwise errno
1208  */
1209 static int tipc_sk_anc_data_recv(struct msghdr *m, struct tipc_msg *msg,
1210                                  struct tipc_sock *tsk)
1211 {
1212         u32 anc_data[3];
1213         u32 err;
1214         u32 dest_type;
1215         int has_name;
1216         int res;
1217
1218         if (likely(m->msg_controllen == 0))
1219                 return 0;
1220
1221         /* Optionally capture errored message object(s) */
1222         err = msg ? msg_errcode(msg) : 0;
1223         if (unlikely(err)) {
1224                 anc_data[0] = err;
1225                 anc_data[1] = msg_data_sz(msg);
1226                 res = put_cmsg(m, SOL_TIPC, TIPC_ERRINFO, 8, anc_data);
1227                 if (res)
1228                         return res;
1229                 if (anc_data[1]) {
1230                         res = put_cmsg(m, SOL_TIPC, TIPC_RETDATA, anc_data[1],
1231                                        msg_data(msg));
1232                         if (res)
1233                                 return res;
1234                 }
1235         }
1236
1237         /* Optionally capture message destination object */
1238         dest_type = msg ? msg_type(msg) : TIPC_DIRECT_MSG;
1239         switch (dest_type) {
1240         case TIPC_NAMED_MSG:
1241                 has_name = 1;
1242                 anc_data[0] = msg_nametype(msg);
1243                 anc_data[1] = msg_namelower(msg);
1244                 anc_data[2] = msg_namelower(msg);
1245                 break;
1246         case TIPC_MCAST_MSG:
1247                 has_name = 1;
1248                 anc_data[0] = msg_nametype(msg);
1249                 anc_data[1] = msg_namelower(msg);
1250                 anc_data[2] = msg_nameupper(msg);
1251                 break;
1252         case TIPC_CONN_MSG:
1253                 has_name = (tsk->conn_type != 0);
1254                 anc_data[0] = tsk->conn_type;
1255                 anc_data[1] = tsk->conn_instance;
1256                 anc_data[2] = tsk->conn_instance;
1257                 break;
1258         default:
1259                 has_name = 0;
1260         }
1261         if (has_name) {
1262                 res = put_cmsg(m, SOL_TIPC, TIPC_DESTNAME, 12, anc_data);
1263                 if (res)
1264                         return res;
1265         }
1266
1267         return 0;
1268 }
1269
1270 static void tipc_sk_send_ack(struct tipc_sock *tsk, uint ack)
1271 {
1272         struct net *net = sock_net(&tsk->sk);
1273         struct sk_buff *skb = NULL;
1274         struct tipc_msg *msg;
1275         u32 peer_port = tsk_peer_port(tsk);
1276         u32 dnode = tsk_peer_node(tsk);
1277
1278         if (!tsk->connected)
1279                 return;
1280         skb = tipc_msg_create(CONN_MANAGER, CONN_ACK, INT_H_SIZE, 0,
1281                               dnode, tsk_own_node(tsk), peer_port,
1282                               tsk->portid, TIPC_OK);
1283         if (!skb)
1284                 return;
1285         msg = buf_msg(skb);
1286         msg_set_msgcnt(msg, ack);
1287         tipc_link_xmit_skb(net, skb, dnode, msg_link_selector(msg));
1288 }
1289
1290 static int tipc_wait_for_rcvmsg(struct socket *sock, long *timeop)
1291 {
1292         struct sock *sk = sock->sk;
1293         DEFINE_WAIT(wait);
1294         long timeo = *timeop;
1295         int err;
1296
1297         for (;;) {
1298                 prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
1299                 if (timeo && skb_queue_empty(&sk->sk_receive_queue)) {
1300                         if (sock->state == SS_DISCONNECTING) {
1301                                 err = -ENOTCONN;
1302                                 break;
1303                         }
1304                         release_sock(sk);
1305                         timeo = schedule_timeout(timeo);
1306                         lock_sock(sk);
1307                 }
1308                 err = 0;
1309                 if (!skb_queue_empty(&sk->sk_receive_queue))
1310                         break;
1311                 err = sock_intr_errno(timeo);
1312                 if (signal_pending(current))
1313                         break;
1314                 err = -EAGAIN;
1315                 if (!timeo)
1316                         break;
1317         }
1318         finish_wait(sk_sleep(sk), &wait);
1319         *timeop = timeo;
1320         return err;
1321 }
1322
1323 /**
1324  * tipc_recvmsg - receive packet-oriented message
1325  * @iocb: (unused)
1326  * @m: descriptor for message info
1327  * @buf_len: total size of user buffer area
1328  * @flags: receive flags
1329  *
1330  * Used for SOCK_DGRAM, SOCK_RDM, and SOCK_SEQPACKET messages.
1331  * If the complete message doesn't fit in user area, truncate it.
1332  *
1333  * Returns size of returned message data, errno otherwise
1334  */
1335 static int tipc_recvmsg(struct kiocb *iocb, struct socket *sock,
1336                         struct msghdr *m, size_t buf_len, int flags)
1337 {
1338         struct sock *sk = sock->sk;
1339         struct tipc_sock *tsk = tipc_sk(sk);
1340         struct sk_buff *buf;
1341         struct tipc_msg *msg;
1342         long timeo;
1343         unsigned int sz;
1344         u32 err;
1345         int res;
1346
1347         /* Catch invalid receive requests */
1348         if (unlikely(!buf_len))
1349                 return -EINVAL;
1350
1351         lock_sock(sk);
1352
1353         if (unlikely(sock->state == SS_UNCONNECTED)) {
1354                 res = -ENOTCONN;
1355                 goto exit;
1356         }
1357
1358         timeo = sock_rcvtimeo(sk, flags & MSG_DONTWAIT);
1359 restart:
1360
1361         /* Look for a message in receive queue; wait if necessary */
1362         res = tipc_wait_for_rcvmsg(sock, &timeo);
1363         if (res)
1364                 goto exit;
1365
1366         /* Look at first message in receive queue */
1367         buf = skb_peek(&sk->sk_receive_queue);
1368         msg = buf_msg(buf);
1369         sz = msg_data_sz(msg);
1370         err = msg_errcode(msg);
1371
1372         /* Discard an empty non-errored message & try again */
1373         if ((!sz) && (!err)) {
1374                 tsk_advance_rx_queue(sk);
1375                 goto restart;
1376         }
1377
1378         /* Capture sender's address (optional) */
1379         set_orig_addr(m, msg);
1380
1381         /* Capture ancillary data (optional) */
1382         res = tipc_sk_anc_data_recv(m, msg, tsk);
1383         if (res)
1384                 goto exit;
1385
1386         /* Capture message data (if valid) & compute return value (always) */
1387         if (!err) {
1388                 if (unlikely(buf_len < sz)) {
1389                         sz = buf_len;
1390                         m->msg_flags |= MSG_TRUNC;
1391                 }
1392                 res = skb_copy_datagram_msg(buf, msg_hdr_sz(msg), m, sz);
1393                 if (res)
1394                         goto exit;
1395                 res = sz;
1396         } else {
1397                 if ((sock->state == SS_READY) ||
1398                     ((err == TIPC_CONN_SHUTDOWN) || m->msg_control))
1399                         res = 0;
1400                 else
1401                         res = -ECONNRESET;
1402         }
1403
1404         /* Consume received message (optional) */
1405         if (likely(!(flags & MSG_PEEK))) {
1406                 if ((sock->state != SS_READY) &&
1407                     (++tsk->rcv_unacked >= TIPC_CONNACK_INTV)) {
1408                         tipc_sk_send_ack(tsk, tsk->rcv_unacked);
1409                         tsk->rcv_unacked = 0;
1410                 }
1411                 tsk_advance_rx_queue(sk);
1412         }
1413 exit:
1414         release_sock(sk);
1415         return res;
1416 }
1417
1418 /**
1419  * tipc_recv_stream - receive stream-oriented data
1420  * @iocb: (unused)
1421  * @m: descriptor for message info
1422  * @buf_len: total size of user buffer area
1423  * @flags: receive flags
1424  *
1425  * Used for SOCK_STREAM messages only.  If not enough data is available
1426  * will optionally wait for more; never truncates data.
1427  *
1428  * Returns size of returned message data, errno otherwise
1429  */
1430 static int tipc_recv_stream(struct kiocb *iocb, struct socket *sock,
1431                             struct msghdr *m, size_t buf_len, int flags)
1432 {
1433         struct sock *sk = sock->sk;
1434         struct tipc_sock *tsk = tipc_sk(sk);
1435         struct sk_buff *buf;
1436         struct tipc_msg *msg;
1437         long timeo;
1438         unsigned int sz;
1439         int sz_to_copy, target, needed;
1440         int sz_copied = 0;
1441         u32 err;
1442         int res = 0;
1443
1444         /* Catch invalid receive attempts */
1445         if (unlikely(!buf_len))
1446                 return -EINVAL;
1447
1448         lock_sock(sk);
1449
1450         if (unlikely(sock->state == SS_UNCONNECTED)) {
1451                 res = -ENOTCONN;
1452                 goto exit;
1453         }
1454
1455         target = sock_rcvlowat(sk, flags & MSG_WAITALL, buf_len);
1456         timeo = sock_rcvtimeo(sk, flags & MSG_DONTWAIT);
1457
1458 restart:
1459         /* Look for a message in receive queue; wait if necessary */
1460         res = tipc_wait_for_rcvmsg(sock, &timeo);
1461         if (res)
1462                 goto exit;
1463
1464         /* Look at first message in receive queue */
1465         buf = skb_peek(&sk->sk_receive_queue);
1466         msg = buf_msg(buf);
1467         sz = msg_data_sz(msg);
1468         err = msg_errcode(msg);
1469
1470         /* Discard an empty non-errored message & try again */
1471         if ((!sz) && (!err)) {
1472                 tsk_advance_rx_queue(sk);
1473                 goto restart;
1474         }
1475
1476         /* Optionally capture sender's address & ancillary data of first msg */
1477         if (sz_copied == 0) {
1478                 set_orig_addr(m, msg);
1479                 res = tipc_sk_anc_data_recv(m, msg, tsk);
1480                 if (res)
1481                         goto exit;
1482         }
1483
1484         /* Capture message data (if valid) & compute return value (always) */
1485         if (!err) {
1486                 u32 offset = (u32)(unsigned long)(TIPC_SKB_CB(buf)->handle);
1487
1488                 sz -= offset;
1489                 needed = (buf_len - sz_copied);
1490                 sz_to_copy = (sz <= needed) ? sz : needed;
1491
1492                 res = skb_copy_datagram_msg(buf, msg_hdr_sz(msg) + offset,
1493                                             m, sz_to_copy);
1494                 if (res)
1495                         goto exit;
1496
1497                 sz_copied += sz_to_copy;
1498
1499                 if (sz_to_copy < sz) {
1500                         if (!(flags & MSG_PEEK))
1501                                 TIPC_SKB_CB(buf)->handle =
1502                                 (void *)(unsigned long)(offset + sz_to_copy);
1503                         goto exit;
1504                 }
1505         } else {
1506                 if (sz_copied != 0)
1507                         goto exit; /* can't add error msg to valid data */
1508
1509                 if ((err == TIPC_CONN_SHUTDOWN) || m->msg_control)
1510                         res = 0;
1511                 else
1512                         res = -ECONNRESET;
1513         }
1514
1515         /* Consume received message (optional) */
1516         if (likely(!(flags & MSG_PEEK))) {
1517                 if (unlikely(++tsk->rcv_unacked >= TIPC_CONNACK_INTV)) {
1518                         tipc_sk_send_ack(tsk, tsk->rcv_unacked);
1519                         tsk->rcv_unacked = 0;
1520                 }
1521                 tsk_advance_rx_queue(sk);
1522         }
1523
1524         /* Loop around if more data is required */
1525         if ((sz_copied < buf_len) &&    /* didn't get all requested data */
1526             (!skb_queue_empty(&sk->sk_receive_queue) ||
1527             (sz_copied < target)) &&    /* and more is ready or required */
1528             (!(flags & MSG_PEEK)) &&    /* and aren't just peeking at data */
1529             (!err))                     /* and haven't reached a FIN */
1530                 goto restart;
1531
1532 exit:
1533         release_sock(sk);
1534         return sz_copied ? sz_copied : res;
1535 }
1536
1537 /**
1538  * tipc_write_space - wake up thread if port congestion is released
1539  * @sk: socket
1540  */
1541 static void tipc_write_space(struct sock *sk)
1542 {
1543         struct socket_wq *wq;
1544
1545         rcu_read_lock();
1546         wq = rcu_dereference(sk->sk_wq);
1547         if (wq_has_sleeper(wq))
1548                 wake_up_interruptible_sync_poll(&wq->wait, POLLOUT |
1549                                                 POLLWRNORM | POLLWRBAND);
1550         rcu_read_unlock();
1551 }
1552
1553 /**
1554  * tipc_data_ready - wake up threads to indicate messages have been received
1555  * @sk: socket
1556  * @len: the length of messages
1557  */
1558 static void tipc_data_ready(struct sock *sk)
1559 {
1560         struct socket_wq *wq;
1561
1562         rcu_read_lock();
1563         wq = rcu_dereference(sk->sk_wq);
1564         if (wq_has_sleeper(wq))
1565                 wake_up_interruptible_sync_poll(&wq->wait, POLLIN |
1566                                                 POLLRDNORM | POLLRDBAND);
1567         rcu_read_unlock();
1568 }
1569
1570 /**
1571  * filter_connect - Handle all incoming messages for a connection-based socket
1572  * @tsk: TIPC socket
1573  * @skb: pointer to message buffer. Set to NULL if buffer is consumed
1574  *
1575  * Returns 0 (TIPC_OK) if everything ok, -TIPC_ERR_NO_PORT otherwise
1576  */
1577 static int filter_connect(struct tipc_sock *tsk, struct sk_buff **skb)
1578 {
1579         struct sock *sk = &tsk->sk;
1580         struct net *net = sock_net(sk);
1581         struct socket *sock = sk->sk_socket;
1582         struct tipc_msg *msg = buf_msg(*skb);
1583         int retval = -TIPC_ERR_NO_PORT;
1584
1585         if (msg_mcast(msg))
1586                 return retval;
1587
1588         switch ((int)sock->state) {
1589         case SS_CONNECTED:
1590                 /* Accept only connection-based messages sent by peer */
1591                 if (tsk_peer_msg(tsk, msg)) {
1592                         if (unlikely(msg_errcode(msg))) {
1593                                 sock->state = SS_DISCONNECTING;
1594                                 tsk->connected = 0;
1595                                 /* let timer expire on it's own */
1596                                 tipc_node_remove_conn(net, tsk_peer_node(tsk),
1597                                                       tsk->portid);
1598                         }
1599                         retval = TIPC_OK;
1600                 }
1601                 break;
1602         case SS_CONNECTING:
1603                 /* Accept only ACK or NACK message */
1604
1605                 if (unlikely(!msg_connected(msg)))
1606                         break;
1607
1608                 if (unlikely(msg_errcode(msg))) {
1609                         sock->state = SS_DISCONNECTING;
1610                         sk->sk_err = ECONNREFUSED;
1611                         retval = TIPC_OK;
1612                         break;
1613                 }
1614
1615                 if (unlikely(msg_importance(msg) > TIPC_CRITICAL_IMPORTANCE)) {
1616                         sock->state = SS_DISCONNECTING;
1617                         sk->sk_err = EINVAL;
1618                         retval = TIPC_OK;
1619                         break;
1620                 }
1621
1622                 tipc_sk_finish_conn(tsk, msg_origport(msg), msg_orignode(msg));
1623                 msg_set_importance(&tsk->phdr, msg_importance(msg));
1624                 sock->state = SS_CONNECTED;
1625
1626                 /* If an incoming message is an 'ACK-', it should be
1627                  * discarded here because it doesn't contain useful
1628                  * data. In addition, we should try to wake up
1629                  * connect() routine if sleeping.
1630                  */
1631                 if (msg_data_sz(msg) == 0) {
1632                         kfree_skb(*skb);
1633                         *skb = NULL;
1634                         if (waitqueue_active(sk_sleep(sk)))
1635                                 wake_up_interruptible(sk_sleep(sk));
1636                 }
1637                 retval = TIPC_OK;
1638                 break;
1639         case SS_LISTENING:
1640         case SS_UNCONNECTED:
1641                 /* Accept only SYN message */
1642                 if (!msg_connected(msg) && !(msg_errcode(msg)))
1643                         retval = TIPC_OK;
1644                 break;
1645         case SS_DISCONNECTING:
1646                 break;
1647         default:
1648                 pr_err("Unknown socket state %u\n", sock->state);
1649         }
1650         return retval;
1651 }
1652
1653 /**
1654  * rcvbuf_limit - get proper overload limit of socket receive queue
1655  * @sk: socket
1656  * @buf: message
1657  *
1658  * For all connection oriented messages, irrespective of importance,
1659  * the default overload value (i.e. 67MB) is set as limit.
1660  *
1661  * For all connectionless messages, by default new queue limits are
1662  * as belows:
1663  *
1664  * TIPC_LOW_IMPORTANCE       (4 MB)
1665  * TIPC_MEDIUM_IMPORTANCE    (8 MB)
1666  * TIPC_HIGH_IMPORTANCE      (16 MB)
1667  * TIPC_CRITICAL_IMPORTANCE  (32 MB)
1668  *
1669  * Returns overload limit according to corresponding message importance
1670  */
1671 static unsigned int rcvbuf_limit(struct sock *sk, struct sk_buff *buf)
1672 {
1673         struct tipc_msg *msg = buf_msg(buf);
1674
1675         if (msg_connected(msg))
1676                 return sysctl_tipc_rmem[2];
1677
1678         return sk->sk_rcvbuf >> TIPC_CRITICAL_IMPORTANCE <<
1679                 msg_importance(msg);
1680 }
1681
1682 /**
1683  * filter_rcv - validate incoming message
1684  * @sk: socket
1685  * @skb: pointer to message. Set to NULL if buffer is consumed.
1686  *
1687  * Enqueues message on receive queue if acceptable; optionally handles
1688  * disconnect indication for a connected socket.
1689  *
1690  * Called with socket lock already taken
1691  *
1692  * Returns 0 (TIPC_OK) if message was ok, -TIPC error code if rejected
1693  */
1694 static int filter_rcv(struct sock *sk, struct sk_buff **skb)
1695 {
1696         struct socket *sock = sk->sk_socket;
1697         struct tipc_sock *tsk = tipc_sk(sk);
1698         struct tipc_msg *msg = buf_msg(*skb);
1699         unsigned int limit = rcvbuf_limit(sk, *skb);
1700         int rc = TIPC_OK;
1701
1702         if (unlikely(msg_user(msg) == CONN_MANAGER)) {
1703                 tipc_sk_proto_rcv(tsk, skb);
1704                 return TIPC_OK;
1705         }
1706
1707         if (unlikely(msg_user(msg) == SOCK_WAKEUP)) {
1708                 kfree_skb(*skb);
1709                 tsk->link_cong = 0;
1710                 sk->sk_write_space(sk);
1711                 *skb = NULL;
1712                 return TIPC_OK;
1713         }
1714
1715         /* Reject message if it is wrong sort of message for socket */
1716         if (msg_type(msg) > TIPC_DIRECT_MSG)
1717                 return -TIPC_ERR_NO_PORT;
1718
1719         if (sock->state == SS_READY) {
1720                 if (msg_connected(msg))
1721                         return -TIPC_ERR_NO_PORT;
1722         } else {
1723                 rc = filter_connect(tsk, skb);
1724                 if (rc != TIPC_OK || !*skb)
1725                         return rc;
1726         }
1727
1728         /* Reject message if there isn't room to queue it */
1729         if (sk_rmem_alloc_get(sk) + (*skb)->truesize >= limit)
1730                 return -TIPC_ERR_OVERLOAD;
1731
1732         /* Enqueue message */
1733         TIPC_SKB_CB(*skb)->handle = NULL;
1734         __skb_queue_tail(&sk->sk_receive_queue, *skb);
1735         skb_set_owner_r(*skb, sk);
1736
1737         sk->sk_data_ready(sk);
1738         *skb = NULL;
1739         return TIPC_OK;
1740 }
1741
1742 /**
1743  * tipc_backlog_rcv - handle incoming message from backlog queue
1744  * @sk: socket
1745  * @skb: message
1746  *
1747  * Caller must hold socket lock
1748  *
1749  * Returns 0
1750  */
1751 static int tipc_backlog_rcv(struct sock *sk, struct sk_buff *skb)
1752 {
1753         int err;
1754         atomic_t *dcnt;
1755         u32 dnode;
1756         struct tipc_sock *tsk = tipc_sk(sk);
1757         struct net *net = sock_net(sk);
1758         uint truesize = skb->truesize;
1759
1760         err = filter_rcv(sk, &skb);
1761         if (likely(!skb)) {
1762                 dcnt = &tsk->dupl_rcvcnt;
1763                 if (atomic_read(dcnt) < TIPC_CONN_OVERLOAD_LIMIT)
1764                         atomic_add(truesize, dcnt);
1765                 return 0;
1766         }
1767         if (!err || tipc_msg_reverse(tsk_own_node(tsk), skb, &dnode, -err))
1768                 tipc_link_xmit_skb(net, skb, dnode, tsk->portid);
1769         return 0;
1770 }
1771
1772 /**
1773  * tipc_sk_enqueue - extract all buffers with destination 'dport' from
1774  *                   inputq and try adding them to socket or backlog queue
1775  * @inputq: list of incoming buffers with potentially different destinations
1776  * @sk: socket where the buffers should be enqueued
1777  * @dport: port number for the socket
1778  * @_skb: returned buffer to be forwarded or rejected, if applicable
1779  *
1780  * Caller must hold socket lock
1781  *
1782  * Returns TIPC_OK if all buffers enqueued, otherwise -TIPC_ERR_OVERLOAD
1783  * or -TIPC_ERR_NO_PORT
1784  */
1785 static int tipc_sk_enqueue(struct sk_buff_head *inputq, struct sock *sk,
1786                            u32 dport, struct sk_buff **_skb)
1787 {
1788         unsigned int lim;
1789         atomic_t *dcnt;
1790         int err;
1791         struct sk_buff *skb;
1792         unsigned long time_limit = jiffies + 2;
1793
1794         while (skb_queue_len(inputq)) {
1795                 skb = tipc_skb_dequeue(inputq, dport);
1796                 if (unlikely(!skb))
1797                         return TIPC_OK;
1798                 /* Return if softirq window exhausted */
1799                 if (unlikely(time_after_eq(jiffies, time_limit)))
1800                         return TIPC_OK;
1801                 if (!sock_owned_by_user(sk)) {
1802                         err = filter_rcv(sk, &skb);
1803                         if (likely(!skb))
1804                                 continue;
1805                         *_skb = skb;
1806                         return err;
1807                 }
1808                 dcnt = &tipc_sk(sk)->dupl_rcvcnt;
1809                 if (sk->sk_backlog.len)
1810                         atomic_set(dcnt, 0);
1811                 lim = rcvbuf_limit(sk, skb) + atomic_read(dcnt);
1812                 if (likely(!sk_add_backlog(sk, skb, lim)))
1813                         continue;
1814                 *_skb = skb;
1815                 return -TIPC_ERR_OVERLOAD;
1816         }
1817         return TIPC_OK;
1818 }
1819
1820 /**
1821  * tipc_sk_rcv - handle a chain of incoming buffers
1822  * @inputq: buffer list containing the buffers
1823  * Consumes all buffers in list until inputq is empty
1824  * Note: may be called in multiple threads referring to the same queue
1825  * Returns 0 if last buffer was accepted, otherwise -EHOSTUNREACH
1826  * Only node local calls check the return value, sending single-buffer queues
1827  */
1828 int tipc_sk_rcv(struct net *net, struct sk_buff_head *inputq)
1829 {
1830         u32 dnode, dport = 0;
1831         int err = -TIPC_ERR_NO_PORT;
1832         struct sk_buff *skb;
1833         struct tipc_sock *tsk;
1834         struct tipc_net *tn;
1835         struct sock *sk;
1836
1837         while (skb_queue_len(inputq)) {
1838                 skb = NULL;
1839                 dport = tipc_skb_peek_port(inputq, dport);
1840                 tsk = tipc_sk_lookup(net, dport);
1841                 if (likely(tsk)) {
1842                         sk = &tsk->sk;
1843                         if (likely(spin_trylock_bh(&sk->sk_lock.slock))) {
1844                                 err = tipc_sk_enqueue(inputq, sk, dport, &skb);
1845                                 spin_unlock_bh(&sk->sk_lock.slock);
1846                                 dport = 0;
1847                         }
1848                         sock_put(sk);
1849                 } else {
1850                         skb = tipc_skb_dequeue(inputq, dport);
1851                 }
1852                 if (likely(!skb))
1853                         continue;
1854                 if (tipc_msg_lookup_dest(net, skb, &dnode, &err))
1855                         goto xmit;
1856                 if (!err) {
1857                         dnode = msg_destnode(buf_msg(skb));
1858                         goto xmit;
1859                 }
1860                 tn = net_generic(net, tipc_net_id);
1861                 if (!tipc_msg_reverse(tn->own_addr, skb, &dnode, -err))
1862                         continue;
1863 xmit:
1864                 tipc_link_xmit_skb(net, skb, dnode, dport);
1865         }
1866         return err ? -EHOSTUNREACH : 0;
1867 }
1868
1869 static int tipc_wait_for_connect(struct socket *sock, long *timeo_p)
1870 {
1871         struct sock *sk = sock->sk;
1872         DEFINE_WAIT(wait);
1873         int done;
1874
1875         do {
1876                 int err = sock_error(sk);
1877                 if (err)
1878                         return err;
1879                 if (!*timeo_p)
1880                         return -ETIMEDOUT;
1881                 if (signal_pending(current))
1882                         return sock_intr_errno(*timeo_p);
1883
1884                 prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
1885                 done = sk_wait_event(sk, timeo_p, sock->state != SS_CONNECTING);
1886                 finish_wait(sk_sleep(sk), &wait);
1887         } while (!done);
1888         return 0;
1889 }
1890
1891 /**
1892  * tipc_connect - establish a connection to another TIPC port
1893  * @sock: socket structure
1894  * @dest: socket address for destination port
1895  * @destlen: size of socket address data structure
1896  * @flags: file-related flags associated with socket
1897  *
1898  * Returns 0 on success, errno otherwise
1899  */
1900 static int tipc_connect(struct socket *sock, struct sockaddr *dest,
1901                         int destlen, int flags)
1902 {
1903         struct sock *sk = sock->sk;
1904         struct sockaddr_tipc *dst = (struct sockaddr_tipc *)dest;
1905         struct msghdr m = {NULL,};
1906         long timeout = (flags & O_NONBLOCK) ? 0 : tipc_sk(sk)->conn_timeout;
1907         socket_state previous;
1908         int res;
1909
1910         lock_sock(sk);
1911
1912         /* For now, TIPC does not allow use of connect() with DGRAM/RDM types */
1913         if (sock->state == SS_READY) {
1914                 res = -EOPNOTSUPP;
1915                 goto exit;
1916         }
1917
1918         /*
1919          * Reject connection attempt using multicast address
1920          *
1921          * Note: send_msg() validates the rest of the address fields,
1922          *       so there's no need to do it here
1923          */
1924         if (dst->addrtype == TIPC_ADDR_MCAST) {
1925                 res = -EINVAL;
1926                 goto exit;
1927         }
1928
1929         previous = sock->state;
1930         switch (sock->state) {
1931         case SS_UNCONNECTED:
1932                 /* Send a 'SYN-' to destination */
1933                 m.msg_name = dest;
1934                 m.msg_namelen = destlen;
1935
1936                 /* If connect is in non-blocking case, set MSG_DONTWAIT to
1937                  * indicate send_msg() is never blocked.
1938                  */
1939                 if (!timeout)
1940                         m.msg_flags = MSG_DONTWAIT;
1941
1942                 res = tipc_sendmsg(NULL, sock, &m, 0);
1943                 if ((res < 0) && (res != -EWOULDBLOCK))
1944                         goto exit;
1945
1946                 /* Just entered SS_CONNECTING state; the only
1947                  * difference is that return value in non-blocking
1948                  * case is EINPROGRESS, rather than EALREADY.
1949                  */
1950                 res = -EINPROGRESS;
1951         case SS_CONNECTING:
1952                 if (previous == SS_CONNECTING)
1953                         res = -EALREADY;
1954                 if (!timeout)
1955                         goto exit;
1956                 timeout = msecs_to_jiffies(timeout);
1957                 /* Wait until an 'ACK' or 'RST' arrives, or a timeout occurs */
1958                 res = tipc_wait_for_connect(sock, &timeout);
1959                 break;
1960         case SS_CONNECTED:
1961                 res = -EISCONN;
1962                 break;
1963         default:
1964                 res = -EINVAL;
1965                 break;
1966         }
1967 exit:
1968         release_sock(sk);
1969         return res;
1970 }
1971
1972 /**
1973  * tipc_listen - allow socket to listen for incoming connections
1974  * @sock: socket structure
1975  * @len: (unused)
1976  *
1977  * Returns 0 on success, errno otherwise
1978  */
1979 static int tipc_listen(struct socket *sock, int len)
1980 {
1981         struct sock *sk = sock->sk;
1982         int res;
1983
1984         lock_sock(sk);
1985
1986         if (sock->state != SS_UNCONNECTED)
1987                 res = -EINVAL;
1988         else {
1989                 sock->state = SS_LISTENING;
1990                 res = 0;
1991         }
1992
1993         release_sock(sk);
1994         return res;
1995 }
1996
1997 static int tipc_wait_for_accept(struct socket *sock, long timeo)
1998 {
1999         struct sock *sk = sock->sk;
2000         DEFINE_WAIT(wait);
2001         int err;
2002
2003         /* True wake-one mechanism for incoming connections: only
2004          * one process gets woken up, not the 'whole herd'.
2005          * Since we do not 'race & poll' for established sockets
2006          * anymore, the common case will execute the loop only once.
2007         */
2008         for (;;) {
2009                 prepare_to_wait_exclusive(sk_sleep(sk), &wait,
2010                                           TASK_INTERRUPTIBLE);
2011                 if (timeo && skb_queue_empty(&sk->sk_receive_queue)) {
2012                         release_sock(sk);
2013                         timeo = schedule_timeout(timeo);
2014                         lock_sock(sk);
2015                 }
2016                 err = 0;
2017                 if (!skb_queue_empty(&sk->sk_receive_queue))
2018                         break;
2019                 err = -EINVAL;
2020                 if (sock->state != SS_LISTENING)
2021                         break;
2022                 err = sock_intr_errno(timeo);
2023                 if (signal_pending(current))
2024                         break;
2025                 err = -EAGAIN;
2026                 if (!timeo)
2027                         break;
2028         }
2029         finish_wait(sk_sleep(sk), &wait);
2030         return err;
2031 }
2032
2033 /**
2034  * tipc_accept - wait for connection request
2035  * @sock: listening socket
2036  * @newsock: new socket that is to be connected
2037  * @flags: file-related flags associated with socket
2038  *
2039  * Returns 0 on success, errno otherwise
2040  */
2041 static int tipc_accept(struct socket *sock, struct socket *new_sock, int flags)
2042 {
2043         struct sock *new_sk, *sk = sock->sk;
2044         struct sk_buff *buf;
2045         struct tipc_sock *new_tsock;
2046         struct tipc_msg *msg;
2047         long timeo;
2048         int res;
2049
2050         lock_sock(sk);
2051
2052         if (sock->state != SS_LISTENING) {
2053                 res = -EINVAL;
2054                 goto exit;
2055         }
2056         timeo = sock_rcvtimeo(sk, flags & O_NONBLOCK);
2057         res = tipc_wait_for_accept(sock, timeo);
2058         if (res)
2059                 goto exit;
2060
2061         buf = skb_peek(&sk->sk_receive_queue);
2062
2063         res = tipc_sk_create(sock_net(sock->sk), new_sock, 0, 1);
2064         if (res)
2065                 goto exit;
2066
2067         new_sk = new_sock->sk;
2068         new_tsock = tipc_sk(new_sk);
2069         msg = buf_msg(buf);
2070
2071         /* we lock on new_sk; but lockdep sees the lock on sk */
2072         lock_sock_nested(new_sk, SINGLE_DEPTH_NESTING);
2073
2074         /*
2075          * Reject any stray messages received by new socket
2076          * before the socket lock was taken (very, very unlikely)
2077          */
2078         tsk_rej_rx_queue(new_sk);
2079
2080         /* Connect new socket to it's peer */
2081         tipc_sk_finish_conn(new_tsock, msg_origport(msg), msg_orignode(msg));
2082         new_sock->state = SS_CONNECTED;
2083
2084         tsk_set_importance(new_tsock, msg_importance(msg));
2085         if (msg_named(msg)) {
2086                 new_tsock->conn_type = msg_nametype(msg);
2087                 new_tsock->conn_instance = msg_nameinst(msg);
2088         }
2089
2090         /*
2091          * Respond to 'SYN-' by discarding it & returning 'ACK'-.
2092          * Respond to 'SYN+' by queuing it on new socket.
2093          */
2094         if (!msg_data_sz(msg)) {
2095                 struct msghdr m = {NULL,};
2096
2097                 tsk_advance_rx_queue(sk);
2098                 tipc_send_packet(NULL, new_sock, &m, 0);
2099         } else {
2100                 __skb_dequeue(&sk->sk_receive_queue);
2101                 __skb_queue_head(&new_sk->sk_receive_queue, buf);
2102                 skb_set_owner_r(buf, new_sk);
2103         }
2104         release_sock(new_sk);
2105 exit:
2106         release_sock(sk);
2107         return res;
2108 }
2109
2110 /**
2111  * tipc_shutdown - shutdown socket connection
2112  * @sock: socket structure
2113  * @how: direction to close (must be SHUT_RDWR)
2114  *
2115  * Terminates connection (if necessary), then purges socket's receive queue.
2116  *
2117  * Returns 0 on success, errno otherwise
2118  */
2119 static int tipc_shutdown(struct socket *sock, int how)
2120 {
2121         struct sock *sk = sock->sk;
2122         struct net *net = sock_net(sk);
2123         struct tipc_sock *tsk = tipc_sk(sk);
2124         struct sk_buff *skb;
2125         u32 dnode;
2126         int res;
2127
2128         if (how != SHUT_RDWR)
2129                 return -EINVAL;
2130
2131         lock_sock(sk);
2132
2133         switch (sock->state) {
2134         case SS_CONNECTING:
2135         case SS_CONNECTED:
2136
2137 restart:
2138                 /* Disconnect and send a 'FIN+' or 'FIN-' message to peer */
2139                 skb = __skb_dequeue(&sk->sk_receive_queue);
2140                 if (skb) {
2141                         if (TIPC_SKB_CB(skb)->handle != NULL) {
2142                                 kfree_skb(skb);
2143                                 goto restart;
2144                         }
2145                         if (tipc_msg_reverse(tsk_own_node(tsk), skb, &dnode,
2146                                              TIPC_CONN_SHUTDOWN))
2147                                 tipc_link_xmit_skb(net, skb, dnode,
2148                                                    tsk->portid);
2149                         tipc_node_remove_conn(net, dnode, tsk->portid);
2150                 } else {
2151                         dnode = tsk_peer_node(tsk);
2152
2153                         skb = tipc_msg_create(TIPC_CRITICAL_IMPORTANCE,
2154                                               TIPC_CONN_MSG, SHORT_H_SIZE,
2155                                               0, dnode, tsk_own_node(tsk),
2156                                               tsk_peer_port(tsk),
2157                                               tsk->portid, TIPC_CONN_SHUTDOWN);
2158                         tipc_link_xmit_skb(net, skb, dnode, tsk->portid);
2159                 }
2160                 tsk->connected = 0;
2161                 sock->state = SS_DISCONNECTING;
2162                 tipc_node_remove_conn(net, dnode, tsk->portid);
2163                 /* fall through */
2164
2165         case SS_DISCONNECTING:
2166
2167                 /* Discard any unreceived messages */
2168                 __skb_queue_purge(&sk->sk_receive_queue);
2169
2170                 /* Wake up anyone sleeping in poll */
2171                 sk->sk_state_change(sk);
2172                 res = 0;
2173                 break;
2174
2175         default:
2176                 res = -ENOTCONN;
2177         }
2178
2179         release_sock(sk);
2180         return res;
2181 }
2182
2183 static void tipc_sk_timeout(unsigned long data)
2184 {
2185         struct tipc_sock *tsk = (struct tipc_sock *)data;
2186         struct sock *sk = &tsk->sk;
2187         struct sk_buff *skb = NULL;
2188         u32 peer_port, peer_node;
2189         u32 own_node = tsk_own_node(tsk);
2190
2191         bh_lock_sock(sk);
2192         if (!tsk->connected) {
2193                 bh_unlock_sock(sk);
2194                 goto exit;
2195         }
2196         peer_port = tsk_peer_port(tsk);
2197         peer_node = tsk_peer_node(tsk);
2198
2199         if (tsk->probing_state == TIPC_CONN_PROBING) {
2200                 /* Previous probe not answered -> self abort */
2201                 skb = tipc_msg_create(TIPC_CRITICAL_IMPORTANCE,
2202                                       TIPC_CONN_MSG, SHORT_H_SIZE, 0,
2203                                       own_node, peer_node, tsk->portid,
2204                                       peer_port, TIPC_ERR_NO_PORT);
2205         } else {
2206                 skb = tipc_msg_create(CONN_MANAGER, CONN_PROBE,
2207                                       INT_H_SIZE, 0, peer_node, own_node,
2208                                       peer_port, tsk->portid, TIPC_OK);
2209                 tsk->probing_state = TIPC_CONN_PROBING;
2210                 sk_reset_timer(sk, &sk->sk_timer, jiffies + tsk->probing_intv);
2211         }
2212         bh_unlock_sock(sk);
2213         if (skb)
2214                 tipc_link_xmit_skb(sock_net(sk), skb, peer_node, tsk->portid);
2215 exit:
2216         sock_put(sk);
2217 }
2218
2219 static int tipc_sk_publish(struct tipc_sock *tsk, uint scope,
2220                            struct tipc_name_seq const *seq)
2221 {
2222         struct net *net = sock_net(&tsk->sk);
2223         struct publication *publ;
2224         u32 key;
2225
2226         if (tsk->connected)
2227                 return -EINVAL;
2228         key = tsk->portid + tsk->pub_count + 1;
2229         if (key == tsk->portid)
2230                 return -EADDRINUSE;
2231
2232         publ = tipc_nametbl_publish(net, seq->type, seq->lower, seq->upper,
2233                                     scope, tsk->portid, key);
2234         if (unlikely(!publ))
2235                 return -EINVAL;
2236
2237         list_add(&publ->pport_list, &tsk->publications);
2238         tsk->pub_count++;
2239         tsk->published = 1;
2240         return 0;
2241 }
2242
2243 static int tipc_sk_withdraw(struct tipc_sock *tsk, uint scope,
2244                             struct tipc_name_seq const *seq)
2245 {
2246         struct net *net = sock_net(&tsk->sk);
2247         struct publication *publ;
2248         struct publication *safe;
2249         int rc = -EINVAL;
2250
2251         list_for_each_entry_safe(publ, safe, &tsk->publications, pport_list) {
2252                 if (seq) {
2253                         if (publ->scope != scope)
2254                                 continue;
2255                         if (publ->type != seq->type)
2256                                 continue;
2257                         if (publ->lower != seq->lower)
2258                                 continue;
2259                         if (publ->upper != seq->upper)
2260                                 break;
2261                         tipc_nametbl_withdraw(net, publ->type, publ->lower,
2262                                               publ->ref, publ->key);
2263                         rc = 0;
2264                         break;
2265                 }
2266                 tipc_nametbl_withdraw(net, publ->type, publ->lower,
2267                                       publ->ref, publ->key);
2268                 rc = 0;
2269         }
2270         if (list_empty(&tsk->publications))
2271                 tsk->published = 0;
2272         return rc;
2273 }
2274
2275 static int tipc_sk_show(struct tipc_sock *tsk, char *buf,
2276                         int len, int full_id)
2277 {
2278         struct net *net = sock_net(&tsk->sk);
2279         struct tipc_net *tn = net_generic(net, tipc_net_id);
2280         struct publication *publ;
2281         int ret;
2282
2283         if (full_id)
2284                 ret = tipc_snprintf(buf, len, "<%u.%u.%u:%u>:",
2285                                     tipc_zone(tn->own_addr),
2286                                     tipc_cluster(tn->own_addr),
2287                                     tipc_node(tn->own_addr), tsk->portid);
2288         else
2289                 ret = tipc_snprintf(buf, len, "%-10u:", tsk->portid);
2290
2291         if (tsk->connected) {
2292                 u32 dport = tsk_peer_port(tsk);
2293                 u32 destnode = tsk_peer_node(tsk);
2294
2295                 ret += tipc_snprintf(buf + ret, len - ret,
2296                                      " connected to <%u.%u.%u:%u>",
2297                                      tipc_zone(destnode),
2298                                      tipc_cluster(destnode),
2299                                      tipc_node(destnode), dport);
2300                 if (tsk->conn_type != 0)
2301                         ret += tipc_snprintf(buf + ret, len - ret,
2302                                              " via {%u,%u}", tsk->conn_type,
2303                                              tsk->conn_instance);
2304         } else if (tsk->published) {
2305                 ret += tipc_snprintf(buf + ret, len - ret, " bound to");
2306                 list_for_each_entry(publ, &tsk->publications, pport_list) {
2307                         if (publ->lower == publ->upper)
2308                                 ret += tipc_snprintf(buf + ret, len - ret,
2309                                                      " {%u,%u}", publ->type,
2310                                                      publ->lower);
2311                         else
2312                                 ret += tipc_snprintf(buf + ret, len - ret,
2313                                                      " {%u,%u,%u}", publ->type,
2314                                                      publ->lower, publ->upper);
2315                 }
2316         }
2317         ret += tipc_snprintf(buf + ret, len - ret, "\n");
2318         return ret;
2319 }
2320
2321 struct sk_buff *tipc_sk_socks_show(struct net *net)
2322 {
2323         struct tipc_net *tn = net_generic(net, tipc_net_id);
2324         const struct bucket_table *tbl;
2325         struct rhash_head *pos;
2326         struct sk_buff *buf;
2327         struct tlv_desc *rep_tlv;
2328         char *pb;
2329         int pb_len;
2330         struct tipc_sock *tsk;
2331         int str_len = 0;
2332         int i;
2333
2334         buf = tipc_cfg_reply_alloc(TLV_SPACE(ULTRA_STRING_MAX_LEN));
2335         if (!buf)
2336                 return NULL;
2337         rep_tlv = (struct tlv_desc *)buf->data;
2338         pb = TLV_DATA(rep_tlv);
2339         pb_len = ULTRA_STRING_MAX_LEN;
2340
2341         rcu_read_lock();
2342         tbl = rht_dereference_rcu((&tn->sk_rht)->tbl, &tn->sk_rht);
2343         for (i = 0; i < tbl->size; i++) {
2344                 rht_for_each_entry_rcu(tsk, pos, tbl, i, node) {
2345                         spin_lock_bh(&tsk->sk.sk_lock.slock);
2346                         str_len += tipc_sk_show(tsk, pb + str_len,
2347                                                 pb_len - str_len, 0);
2348                         spin_unlock_bh(&tsk->sk.sk_lock.slock);
2349                 }
2350         }
2351         rcu_read_unlock();
2352
2353         str_len += 1;   /* for "\0" */
2354         skb_put(buf, TLV_SPACE(str_len));
2355         TLV_SET(rep_tlv, TIPC_TLV_ULTRA_STRING, NULL, str_len);
2356
2357         return buf;
2358 }
2359
2360 /* tipc_sk_reinit: set non-zero address in all existing sockets
2361  *                 when we go from standalone to network mode.
2362  */
2363 void tipc_sk_reinit(struct net *net)
2364 {
2365         struct tipc_net *tn = net_generic(net, tipc_net_id);
2366         const struct bucket_table *tbl;
2367         struct rhash_head *pos;
2368         struct tipc_sock *tsk;
2369         struct tipc_msg *msg;
2370         int i;
2371
2372         rcu_read_lock();
2373         tbl = rht_dereference_rcu((&tn->sk_rht)->tbl, &tn->sk_rht);
2374         for (i = 0; i < tbl->size; i++) {
2375                 rht_for_each_entry_rcu(tsk, pos, tbl, i, node) {
2376                         spin_lock_bh(&tsk->sk.sk_lock.slock);
2377                         msg = &tsk->phdr;
2378                         msg_set_prevnode(msg, tn->own_addr);
2379                         msg_set_orignode(msg, tn->own_addr);
2380                         spin_unlock_bh(&tsk->sk.sk_lock.slock);
2381                 }
2382         }
2383         rcu_read_unlock();
2384 }
2385
2386 static struct tipc_sock *tipc_sk_lookup(struct net *net, u32 portid)
2387 {
2388         struct tipc_net *tn = net_generic(net, tipc_net_id);
2389         struct tipc_sock *tsk;
2390
2391         rcu_read_lock();
2392         tsk = rhashtable_lookup(&tn->sk_rht, &portid);
2393         if (tsk)
2394                 sock_hold(&tsk->sk);
2395         rcu_read_unlock();
2396
2397         return tsk;
2398 }
2399
2400 static int tipc_sk_insert(struct tipc_sock *tsk)
2401 {
2402         struct sock *sk = &tsk->sk;
2403         struct net *net = sock_net(sk);
2404         struct tipc_net *tn = net_generic(net, tipc_net_id);
2405         u32 remaining = (TIPC_MAX_PORT - TIPC_MIN_PORT) + 1;
2406         u32 portid = prandom_u32() % remaining + TIPC_MIN_PORT;
2407
2408         while (remaining--) {
2409                 portid++;
2410                 if ((portid < TIPC_MIN_PORT) || (portid > TIPC_MAX_PORT))
2411                         portid = TIPC_MIN_PORT;
2412                 tsk->portid = portid;
2413                 sock_hold(&tsk->sk);
2414                 if (rhashtable_lookup_insert(&tn->sk_rht, &tsk->node))
2415                         return 0;
2416                 sock_put(&tsk->sk);
2417         }
2418
2419         return -1;
2420 }
2421
2422 static void tipc_sk_remove(struct tipc_sock *tsk)
2423 {
2424         struct sock *sk = &tsk->sk;
2425         struct tipc_net *tn = net_generic(sock_net(sk), tipc_net_id);
2426
2427         if (rhashtable_remove(&tn->sk_rht, &tsk->node)) {
2428                 WARN_ON(atomic_read(&sk->sk_refcnt) == 1);
2429                 __sock_put(sk);
2430         }
2431 }
2432
2433 int tipc_sk_rht_init(struct net *net)
2434 {
2435         struct tipc_net *tn = net_generic(net, tipc_net_id);
2436         struct rhashtable_params rht_params = {
2437                 .nelem_hint = 192,
2438                 .head_offset = offsetof(struct tipc_sock, node),
2439                 .key_offset = offsetof(struct tipc_sock, portid),
2440                 .key_len = sizeof(u32), /* portid */
2441                 .hashfn = jhash,
2442                 .max_shift = 20, /* 1M */
2443                 .min_shift = 8,  /* 256 */
2444                 .grow_decision = rht_grow_above_75,
2445                 .shrink_decision = rht_shrink_below_30,
2446         };
2447
2448         return rhashtable_init(&tn->sk_rht, &rht_params);
2449 }
2450
2451 void tipc_sk_rht_destroy(struct net *net)
2452 {
2453         struct tipc_net *tn = net_generic(net, tipc_net_id);
2454
2455         /* Wait for socket readers to complete */
2456         synchronize_net();
2457
2458         rhashtable_destroy(&tn->sk_rht);
2459 }
2460
2461 /**
2462  * tipc_setsockopt - set socket option
2463  * @sock: socket structure
2464  * @lvl: option level
2465  * @opt: option identifier
2466  * @ov: pointer to new option value
2467  * @ol: length of option value
2468  *
2469  * For stream sockets only, accepts and ignores all IPPROTO_TCP options
2470  * (to ease compatibility).
2471  *
2472  * Returns 0 on success, errno otherwise
2473  */
2474 static int tipc_setsockopt(struct socket *sock, int lvl, int opt,
2475                            char __user *ov, unsigned int ol)
2476 {
2477         struct sock *sk = sock->sk;
2478         struct tipc_sock *tsk = tipc_sk(sk);
2479         u32 value;
2480         int res;
2481
2482         if ((lvl == IPPROTO_TCP) && (sock->type == SOCK_STREAM))
2483                 return 0;
2484         if (lvl != SOL_TIPC)
2485                 return -ENOPROTOOPT;
2486         if (ol < sizeof(value))
2487                 return -EINVAL;
2488         res = get_user(value, (u32 __user *)ov);
2489         if (res)
2490                 return res;
2491
2492         lock_sock(sk);
2493
2494         switch (opt) {
2495         case TIPC_IMPORTANCE:
2496                 res = tsk_set_importance(tsk, value);
2497                 break;
2498         case TIPC_SRC_DROPPABLE:
2499                 if (sock->type != SOCK_STREAM)
2500                         tsk_set_unreliable(tsk, value);
2501                 else
2502                         res = -ENOPROTOOPT;
2503                 break;
2504         case TIPC_DEST_DROPPABLE:
2505                 tsk_set_unreturnable(tsk, value);
2506                 break;
2507         case TIPC_CONN_TIMEOUT:
2508                 tipc_sk(sk)->conn_timeout = value;
2509                 /* no need to set "res", since already 0 at this point */
2510                 break;
2511         default:
2512                 res = -EINVAL;
2513         }
2514
2515         release_sock(sk);
2516
2517         return res;
2518 }
2519
2520 /**
2521  * tipc_getsockopt - get socket option
2522  * @sock: socket structure
2523  * @lvl: option level
2524  * @opt: option identifier
2525  * @ov: receptacle for option value
2526  * @ol: receptacle for length of option value
2527  *
2528  * For stream sockets only, returns 0 length result for all IPPROTO_TCP options
2529  * (to ease compatibility).
2530  *
2531  * Returns 0 on success, errno otherwise
2532  */
2533 static int tipc_getsockopt(struct socket *sock, int lvl, int opt,
2534                            char __user *ov, int __user *ol)
2535 {
2536         struct sock *sk = sock->sk;
2537         struct tipc_sock *tsk = tipc_sk(sk);
2538         int len;
2539         u32 value;
2540         int res;
2541
2542         if ((lvl == IPPROTO_TCP) && (sock->type == SOCK_STREAM))
2543                 return put_user(0, ol);
2544         if (lvl != SOL_TIPC)
2545                 return -ENOPROTOOPT;
2546         res = get_user(len, ol);
2547         if (res)
2548                 return res;
2549
2550         lock_sock(sk);
2551
2552         switch (opt) {
2553         case TIPC_IMPORTANCE:
2554                 value = tsk_importance(tsk);
2555                 break;
2556         case TIPC_SRC_DROPPABLE:
2557                 value = tsk_unreliable(tsk);
2558                 break;
2559         case TIPC_DEST_DROPPABLE:
2560                 value = tsk_unreturnable(tsk);
2561                 break;
2562         case TIPC_CONN_TIMEOUT:
2563                 value = tsk->conn_timeout;
2564                 /* no need to set "res", since already 0 at this point */
2565                 break;
2566         case TIPC_NODE_RECVQ_DEPTH:
2567                 value = 0; /* was tipc_queue_size, now obsolete */
2568                 break;
2569         case TIPC_SOCK_RECVQ_DEPTH:
2570                 value = skb_queue_len(&sk->sk_receive_queue);
2571                 break;
2572         default:
2573                 res = -EINVAL;
2574         }
2575
2576         release_sock(sk);
2577
2578         if (res)
2579                 return res;     /* "get" failed */
2580
2581         if (len < sizeof(value))
2582                 return -EINVAL;
2583
2584         if (copy_to_user(ov, &value, sizeof(value)))
2585                 return -EFAULT;
2586
2587         return put_user(sizeof(value), ol);
2588 }
2589
2590 static int tipc_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
2591 {
2592         struct sock *sk = sock->sk;
2593         struct tipc_sioc_ln_req lnr;
2594         void __user *argp = (void __user *)arg;
2595
2596         switch (cmd) {
2597         case SIOCGETLINKNAME:
2598                 if (copy_from_user(&lnr, argp, sizeof(lnr)))
2599                         return -EFAULT;
2600                 if (!tipc_node_get_linkname(sock_net(sk),
2601                                             lnr.bearer_id & 0xffff, lnr.peer,
2602                                             lnr.linkname, TIPC_MAX_LINK_NAME)) {
2603                         if (copy_to_user(argp, &lnr, sizeof(lnr)))
2604                                 return -EFAULT;
2605                         return 0;
2606                 }
2607                 return -EADDRNOTAVAIL;
2608         default:
2609                 return -ENOIOCTLCMD;
2610         }
2611 }
2612
2613 /* Protocol switches for the various types of TIPC sockets */
2614
2615 static const struct proto_ops msg_ops = {
2616         .owner          = THIS_MODULE,
2617         .family         = AF_TIPC,
2618         .release        = tipc_release,
2619         .bind           = tipc_bind,
2620         .connect        = tipc_connect,
2621         .socketpair     = sock_no_socketpair,
2622         .accept         = sock_no_accept,
2623         .getname        = tipc_getname,
2624         .poll           = tipc_poll,
2625         .ioctl          = tipc_ioctl,
2626         .listen         = sock_no_listen,
2627         .shutdown       = tipc_shutdown,
2628         .setsockopt     = tipc_setsockopt,
2629         .getsockopt     = tipc_getsockopt,
2630         .sendmsg        = tipc_sendmsg,
2631         .recvmsg        = tipc_recvmsg,
2632         .mmap           = sock_no_mmap,
2633         .sendpage       = sock_no_sendpage
2634 };
2635
2636 static const struct proto_ops packet_ops = {
2637         .owner          = THIS_MODULE,
2638         .family         = AF_TIPC,
2639         .release        = tipc_release,
2640         .bind           = tipc_bind,
2641         .connect        = tipc_connect,
2642         .socketpair     = sock_no_socketpair,
2643         .accept         = tipc_accept,
2644         .getname        = tipc_getname,
2645         .poll           = tipc_poll,
2646         .ioctl          = tipc_ioctl,
2647         .listen         = tipc_listen,
2648         .shutdown       = tipc_shutdown,
2649         .setsockopt     = tipc_setsockopt,
2650         .getsockopt     = tipc_getsockopt,
2651         .sendmsg        = tipc_send_packet,
2652         .recvmsg        = tipc_recvmsg,
2653         .mmap           = sock_no_mmap,
2654         .sendpage       = sock_no_sendpage
2655 };
2656
2657 static const struct proto_ops stream_ops = {
2658         .owner          = THIS_MODULE,
2659         .family         = AF_TIPC,
2660         .release        = tipc_release,
2661         .bind           = tipc_bind,
2662         .connect        = tipc_connect,
2663         .socketpair     = sock_no_socketpair,
2664         .accept         = tipc_accept,
2665         .getname        = tipc_getname,
2666         .poll           = tipc_poll,
2667         .ioctl          = tipc_ioctl,
2668         .listen         = tipc_listen,
2669         .shutdown       = tipc_shutdown,
2670         .setsockopt     = tipc_setsockopt,
2671         .getsockopt     = tipc_getsockopt,
2672         .sendmsg        = tipc_send_stream,
2673         .recvmsg        = tipc_recv_stream,
2674         .mmap           = sock_no_mmap,
2675         .sendpage       = sock_no_sendpage
2676 };
2677
2678 static const struct net_proto_family tipc_family_ops = {
2679         .owner          = THIS_MODULE,
2680         .family         = AF_TIPC,
2681         .create         = tipc_sk_create
2682 };
2683
2684 static struct proto tipc_proto = {
2685         .name           = "TIPC",
2686         .owner          = THIS_MODULE,
2687         .obj_size       = sizeof(struct tipc_sock),
2688         .sysctl_rmem    = sysctl_tipc_rmem
2689 };
2690
2691 static struct proto tipc_proto_kern = {
2692         .name           = "TIPC",
2693         .obj_size       = sizeof(struct tipc_sock),
2694         .sysctl_rmem    = sysctl_tipc_rmem
2695 };
2696
2697 /**
2698  * tipc_socket_init - initialize TIPC socket interface
2699  *
2700  * Returns 0 on success, errno otherwise
2701  */
2702 int tipc_socket_init(void)
2703 {
2704         int res;
2705
2706         res = proto_register(&tipc_proto, 1);
2707         if (res) {
2708                 pr_err("Failed to register TIPC protocol type\n");
2709                 goto out;
2710         }
2711
2712         res = sock_register(&tipc_family_ops);
2713         if (res) {
2714                 pr_err("Failed to register TIPC socket type\n");
2715                 proto_unregister(&tipc_proto);
2716                 goto out;
2717         }
2718  out:
2719         return res;
2720 }
2721
2722 /**
2723  * tipc_socket_stop - stop TIPC socket interface
2724  */
2725 void tipc_socket_stop(void)
2726 {
2727         sock_unregister(tipc_family_ops.family);
2728         proto_unregister(&tipc_proto);
2729 }
2730
2731 /* Caller should hold socket lock for the passed tipc socket. */
2732 static int __tipc_nl_add_sk_con(struct sk_buff *skb, struct tipc_sock *tsk)
2733 {
2734         u32 peer_node;
2735         u32 peer_port;
2736         struct nlattr *nest;
2737
2738         peer_node = tsk_peer_node(tsk);
2739         peer_port = tsk_peer_port(tsk);
2740
2741         nest = nla_nest_start(skb, TIPC_NLA_SOCK_CON);
2742
2743         if (nla_put_u32(skb, TIPC_NLA_CON_NODE, peer_node))
2744                 goto msg_full;
2745         if (nla_put_u32(skb, TIPC_NLA_CON_SOCK, peer_port))
2746                 goto msg_full;
2747
2748         if (tsk->conn_type != 0) {
2749                 if (nla_put_flag(skb, TIPC_NLA_CON_FLAG))
2750                         goto msg_full;
2751                 if (nla_put_u32(skb, TIPC_NLA_CON_TYPE, tsk->conn_type))
2752                         goto msg_full;
2753                 if (nla_put_u32(skb, TIPC_NLA_CON_INST, tsk->conn_instance))
2754                         goto msg_full;
2755         }
2756         nla_nest_end(skb, nest);
2757
2758         return 0;
2759
2760 msg_full:
2761         nla_nest_cancel(skb, nest);
2762
2763         return -EMSGSIZE;
2764 }
2765
2766 /* Caller should hold socket lock for the passed tipc socket. */
2767 static int __tipc_nl_add_sk(struct sk_buff *skb, struct netlink_callback *cb,
2768                             struct tipc_sock *tsk)
2769 {
2770         int err;
2771         void *hdr;
2772         struct nlattr *attrs;
2773         struct net *net = sock_net(skb->sk);
2774         struct tipc_net *tn = net_generic(net, tipc_net_id);
2775
2776         hdr = genlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq,
2777                           &tipc_genl_v2_family, NLM_F_MULTI, TIPC_NL_SOCK_GET);
2778         if (!hdr)
2779                 goto msg_cancel;
2780
2781         attrs = nla_nest_start(skb, TIPC_NLA_SOCK);
2782         if (!attrs)
2783                 goto genlmsg_cancel;
2784         if (nla_put_u32(skb, TIPC_NLA_SOCK_REF, tsk->portid))
2785                 goto attr_msg_cancel;
2786         if (nla_put_u32(skb, TIPC_NLA_SOCK_ADDR, tn->own_addr))
2787                 goto attr_msg_cancel;
2788
2789         if (tsk->connected) {
2790                 err = __tipc_nl_add_sk_con(skb, tsk);
2791                 if (err)
2792                         goto attr_msg_cancel;
2793         } else if (!list_empty(&tsk->publications)) {
2794                 if (nla_put_flag(skb, TIPC_NLA_SOCK_HAS_PUBL))
2795                         goto attr_msg_cancel;
2796         }
2797         nla_nest_end(skb, attrs);
2798         genlmsg_end(skb, hdr);
2799
2800         return 0;
2801
2802 attr_msg_cancel:
2803         nla_nest_cancel(skb, attrs);
2804 genlmsg_cancel:
2805         genlmsg_cancel(skb, hdr);
2806 msg_cancel:
2807         return -EMSGSIZE;
2808 }
2809
2810 int tipc_nl_sk_dump(struct sk_buff *skb, struct netlink_callback *cb)
2811 {
2812         int err;
2813         struct tipc_sock *tsk;
2814         const struct bucket_table *tbl;
2815         struct rhash_head *pos;
2816         struct net *net = sock_net(skb->sk);
2817         struct tipc_net *tn = net_generic(net, tipc_net_id);
2818         u32 tbl_id = cb->args[0];
2819         u32 prev_portid = cb->args[1];
2820
2821         rcu_read_lock();
2822         tbl = rht_dereference_rcu((&tn->sk_rht)->tbl, &tn->sk_rht);
2823         for (; tbl_id < tbl->size; tbl_id++) {
2824                 rht_for_each_entry_rcu(tsk, pos, tbl, tbl_id, node) {
2825                         spin_lock_bh(&tsk->sk.sk_lock.slock);
2826                         if (prev_portid && prev_portid != tsk->portid) {
2827                                 spin_unlock_bh(&tsk->sk.sk_lock.slock);
2828                                 continue;
2829                         }
2830
2831                         err = __tipc_nl_add_sk(skb, cb, tsk);
2832                         if (err) {
2833                                 prev_portid = tsk->portid;
2834                                 spin_unlock_bh(&tsk->sk.sk_lock.slock);
2835                                 goto out;
2836                         }
2837                         prev_portid = 0;
2838                         spin_unlock_bh(&tsk->sk.sk_lock.slock);
2839                 }
2840         }
2841 out:
2842         rcu_read_unlock();
2843         cb->args[0] = tbl_id;
2844         cb->args[1] = prev_portid;
2845
2846         return skb->len;
2847 }
2848
2849 /* Caller should hold socket lock for the passed tipc socket. */
2850 static int __tipc_nl_add_sk_publ(struct sk_buff *skb,
2851                                  struct netlink_callback *cb,
2852                                  struct publication *publ)
2853 {
2854         void *hdr;
2855         struct nlattr *attrs;
2856
2857         hdr = genlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq,
2858                           &tipc_genl_v2_family, NLM_F_MULTI, TIPC_NL_PUBL_GET);
2859         if (!hdr)
2860                 goto msg_cancel;
2861
2862         attrs = nla_nest_start(skb, TIPC_NLA_PUBL);
2863         if (!attrs)
2864                 goto genlmsg_cancel;
2865
2866         if (nla_put_u32(skb, TIPC_NLA_PUBL_KEY, publ->key))
2867                 goto attr_msg_cancel;
2868         if (nla_put_u32(skb, TIPC_NLA_PUBL_TYPE, publ->type))
2869                 goto attr_msg_cancel;
2870         if (nla_put_u32(skb, TIPC_NLA_PUBL_LOWER, publ->lower))
2871                 goto attr_msg_cancel;
2872         if (nla_put_u32(skb, TIPC_NLA_PUBL_UPPER, publ->upper))
2873                 goto attr_msg_cancel;
2874
2875         nla_nest_end(skb, attrs);
2876         genlmsg_end(skb, hdr);
2877
2878         return 0;
2879
2880 attr_msg_cancel:
2881         nla_nest_cancel(skb, attrs);
2882 genlmsg_cancel:
2883         genlmsg_cancel(skb, hdr);
2884 msg_cancel:
2885         return -EMSGSIZE;
2886 }
2887
2888 /* Caller should hold socket lock for the passed tipc socket. */
2889 static int __tipc_nl_list_sk_publ(struct sk_buff *skb,
2890                                   struct netlink_callback *cb,
2891                                   struct tipc_sock *tsk, u32 *last_publ)
2892 {
2893         int err;
2894         struct publication *p;
2895
2896         if (*last_publ) {
2897                 list_for_each_entry(p, &tsk->publications, pport_list) {
2898                         if (p->key == *last_publ)
2899                                 break;
2900                 }
2901                 if (p->key != *last_publ) {
2902                         /* We never set seq or call nl_dump_check_consistent()
2903                          * this means that setting prev_seq here will cause the
2904                          * consistence check to fail in the netlink callback
2905                          * handler. Resulting in the last NLMSG_DONE message
2906                          * having the NLM_F_DUMP_INTR flag set.
2907                          */
2908                         cb->prev_seq = 1;
2909                         *last_publ = 0;
2910                         return -EPIPE;
2911                 }
2912         } else {
2913                 p = list_first_entry(&tsk->publications, struct publication,
2914                                      pport_list);
2915         }
2916
2917         list_for_each_entry_from(p, &tsk->publications, pport_list) {
2918                 err = __tipc_nl_add_sk_publ(skb, cb, p);
2919                 if (err) {
2920                         *last_publ = p->key;
2921                         return err;
2922                 }
2923         }
2924         *last_publ = 0;
2925
2926         return 0;
2927 }
2928
2929 int tipc_nl_publ_dump(struct sk_buff *skb, struct netlink_callback *cb)
2930 {
2931         int err;
2932         u32 tsk_portid = cb->args[0];
2933         u32 last_publ = cb->args[1];
2934         u32 done = cb->args[2];
2935         struct net *net = sock_net(skb->sk);
2936         struct tipc_sock *tsk;
2937
2938         if (!tsk_portid) {
2939                 struct nlattr **attrs;
2940                 struct nlattr *sock[TIPC_NLA_SOCK_MAX + 1];
2941
2942                 err = tipc_nlmsg_parse(cb->nlh, &attrs);
2943                 if (err)
2944                         return err;
2945
2946                 err = nla_parse_nested(sock, TIPC_NLA_SOCK_MAX,
2947                                        attrs[TIPC_NLA_SOCK],
2948                                        tipc_nl_sock_policy);
2949                 if (err)
2950                         return err;
2951
2952                 if (!sock[TIPC_NLA_SOCK_REF])
2953                         return -EINVAL;
2954
2955                 tsk_portid = nla_get_u32(sock[TIPC_NLA_SOCK_REF]);
2956         }
2957
2958         if (done)
2959                 return 0;
2960
2961         tsk = tipc_sk_lookup(net, tsk_portid);
2962         if (!tsk)
2963                 return -EINVAL;
2964
2965         lock_sock(&tsk->sk);
2966         err = __tipc_nl_list_sk_publ(skb, cb, tsk, &last_publ);
2967         if (!err)
2968                 done = 1;
2969         release_sock(&tsk->sk);
2970         sock_put(&tsk->sk);
2971
2972         cb->args[0] = tsk_portid;
2973         cb->args[1] = last_publ;
2974         cb->args[2] = done;
2975
2976         return skb->len;
2977 }