tipc: eliminate race condition at multicast reception
[cascardo/linux.git] / net / tipc / socket.c
1 /*
2  * net/tipc/socket.c: TIPC socket API
3  *
4  * Copyright (c) 2001-2007, 2012-2015, 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 /**
780  * tipc_sk_mcast_rcv - Deliver multicast messages to all destination sockets
781  * @arrvq: queue with arriving messages, to be cloned after destination lookup
782  * @inputq: queue with cloned messages, delivered to socket after dest lookup
783  *
784  * Multi-threaded: parallel calls with reference to same queues may occur
785  */
786 void tipc_sk_mcast_rcv(struct net *net, struct sk_buff_head *arrvq,
787                        struct sk_buff_head *inputq)
788 {
789         struct tipc_msg *msg;
790         struct tipc_plist dports;
791         u32 portid;
792         u32 scope = TIPC_CLUSTER_SCOPE;
793         struct sk_buff_head tmpq;
794         uint hsz;
795         struct sk_buff *skb, *_skb;
796
797         __skb_queue_head_init(&tmpq);
798         tipc_plist_init(&dports);
799
800         skb = tipc_skb_peek(arrvq, &inputq->lock);
801         for (; skb; skb = tipc_skb_peek(arrvq, &inputq->lock)) {
802                 msg = buf_msg(skb);
803                 hsz = skb_headroom(skb) + msg_hdr_sz(msg);
804
805                 if (in_own_node(net, msg_orignode(msg)))
806                         scope = TIPC_NODE_SCOPE;
807
808                 /* Create destination port list and message clones: */
809                 tipc_nametbl_mc_translate(net,
810                                           msg_nametype(msg), msg_namelower(msg),
811                                           msg_nameupper(msg), scope, &dports);
812                 portid = tipc_plist_pop(&dports);
813                 for (; portid; portid = tipc_plist_pop(&dports)) {
814                         _skb = __pskb_copy(skb, hsz, GFP_ATOMIC);
815                         if (_skb) {
816                                 msg_set_destport(buf_msg(_skb), portid);
817                                 __skb_queue_tail(&tmpq, _skb);
818                                 continue;
819                         }
820                         pr_warn("Failed to clone mcast rcv buffer\n");
821                 }
822                 /* Append to inputq if not already done by other thread */
823                 spin_lock_bh(&inputq->lock);
824                 if (skb_peek(arrvq) == skb) {
825                         skb_queue_splice_tail_init(&tmpq, inputq);
826                         kfree_skb(__skb_dequeue(arrvq));
827                 }
828                 spin_unlock_bh(&inputq->lock);
829                 __skb_queue_purge(&tmpq);
830                 kfree_skb(skb);
831         }
832         tipc_sk_rcv(net, inputq);
833 }
834
835 /**
836  * tipc_sk_proto_rcv - receive a connection mng protocol message
837  * @tsk: receiving socket
838  * @skb: pointer to message buffer. Set to NULL if buffer is consumed.
839  */
840 static void tipc_sk_proto_rcv(struct tipc_sock *tsk, struct sk_buff **skb)
841 {
842         struct tipc_msg *msg = buf_msg(*skb);
843         int conn_cong;
844         u32 dnode;
845         u32 own_node = tsk_own_node(tsk);
846         /* Ignore if connection cannot be validated: */
847         if (!tsk_peer_msg(tsk, msg))
848                 goto exit;
849
850         tsk->probing_state = TIPC_CONN_OK;
851
852         if (msg_type(msg) == CONN_ACK) {
853                 conn_cong = tsk_conn_cong(tsk);
854                 tsk->sent_unacked -= msg_msgcnt(msg);
855                 if (conn_cong)
856                         tsk->sk.sk_write_space(&tsk->sk);
857         } else if (msg_type(msg) == CONN_PROBE) {
858                 if (tipc_msg_reverse(own_node, *skb, &dnode, TIPC_OK)) {
859                         msg_set_type(msg, CONN_PROBE_REPLY);
860                         return;
861                 }
862         }
863         /* Do nothing if msg_type() == CONN_PROBE_REPLY */
864 exit:
865         kfree_skb(*skb);
866         *skb = NULL;
867 }
868
869 static int tipc_wait_for_sndmsg(struct socket *sock, long *timeo_p)
870 {
871         struct sock *sk = sock->sk;
872         struct tipc_sock *tsk = tipc_sk(sk);
873         DEFINE_WAIT(wait);
874         int done;
875
876         do {
877                 int err = sock_error(sk);
878                 if (err)
879                         return err;
880                 if (sock->state == SS_DISCONNECTING)
881                         return -EPIPE;
882                 if (!*timeo_p)
883                         return -EAGAIN;
884                 if (signal_pending(current))
885                         return sock_intr_errno(*timeo_p);
886
887                 prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
888                 done = sk_wait_event(sk, timeo_p, !tsk->link_cong);
889                 finish_wait(sk_sleep(sk), &wait);
890         } while (!done);
891         return 0;
892 }
893
894 /**
895  * tipc_sendmsg - send message in connectionless manner
896  * @iocb: if NULL, indicates that socket lock is already held
897  * @sock: socket structure
898  * @m: message to send
899  * @dsz: amount of user data to be sent
900  *
901  * Message must have an destination specified explicitly.
902  * Used for SOCK_RDM and SOCK_DGRAM messages,
903  * and for 'SYN' messages on SOCK_SEQPACKET and SOCK_STREAM connections.
904  * (Note: 'SYN+' is prohibited on SOCK_STREAM.)
905  *
906  * Returns the number of bytes sent on success, or errno otherwise
907  */
908 static int tipc_sendmsg(struct kiocb *iocb, struct socket *sock,
909                         struct msghdr *m, size_t dsz)
910 {
911         DECLARE_SOCKADDR(struct sockaddr_tipc *, dest, m->msg_name);
912         struct sock *sk = sock->sk;
913         struct tipc_sock *tsk = tipc_sk(sk);
914         struct net *net = sock_net(sk);
915         struct tipc_msg *mhdr = &tsk->phdr;
916         u32 dnode, dport;
917         struct sk_buff_head *pktchain = &sk->sk_write_queue;
918         struct sk_buff *skb;
919         struct tipc_name_seq *seq = &dest->addr.nameseq;
920         struct iov_iter save;
921         u32 mtu;
922         long timeo;
923         int rc;
924
925         if (unlikely(!dest))
926                 return -EDESTADDRREQ;
927
928         if (unlikely((m->msg_namelen < sizeof(*dest)) ||
929                      (dest->family != AF_TIPC)))
930                 return -EINVAL;
931
932         if (dsz > TIPC_MAX_USER_MSG_SIZE)
933                 return -EMSGSIZE;
934
935         if (iocb)
936                 lock_sock(sk);
937
938         if (unlikely(sock->state != SS_READY)) {
939                 if (sock->state == SS_LISTENING) {
940                         rc = -EPIPE;
941                         goto exit;
942                 }
943                 if (sock->state != SS_UNCONNECTED) {
944                         rc = -EISCONN;
945                         goto exit;
946                 }
947                 if (tsk->published) {
948                         rc = -EOPNOTSUPP;
949                         goto exit;
950                 }
951                 if (dest->addrtype == TIPC_ADDR_NAME) {
952                         tsk->conn_type = dest->addr.name.name.type;
953                         tsk->conn_instance = dest->addr.name.name.instance;
954                 }
955         }
956
957         timeo = sock_sndtimeo(sk, m->msg_flags & MSG_DONTWAIT);
958
959         if (dest->addrtype == TIPC_ADDR_MCAST) {
960                 rc = tipc_sendmcast(sock, seq, m, dsz, timeo);
961                 goto exit;
962         } else if (dest->addrtype == TIPC_ADDR_NAME) {
963                 u32 type = dest->addr.name.name.type;
964                 u32 inst = dest->addr.name.name.instance;
965                 u32 domain = dest->addr.name.domain;
966
967                 dnode = domain;
968                 msg_set_type(mhdr, TIPC_NAMED_MSG);
969                 msg_set_hdr_sz(mhdr, NAMED_H_SIZE);
970                 msg_set_nametype(mhdr, type);
971                 msg_set_nameinst(mhdr, inst);
972                 msg_set_lookup_scope(mhdr, tipc_addr_scope(domain));
973                 dport = tipc_nametbl_translate(net, type, inst, &dnode);
974                 msg_set_destnode(mhdr, dnode);
975                 msg_set_destport(mhdr, dport);
976                 if (unlikely(!dport && !dnode)) {
977                         rc = -EHOSTUNREACH;
978                         goto exit;
979                 }
980         } else if (dest->addrtype == TIPC_ADDR_ID) {
981                 dnode = dest->addr.id.node;
982                 msg_set_type(mhdr, TIPC_DIRECT_MSG);
983                 msg_set_lookup_scope(mhdr, 0);
984                 msg_set_destnode(mhdr, dnode);
985                 msg_set_destport(mhdr, dest->addr.id.ref);
986                 msg_set_hdr_sz(mhdr, BASIC_H_SIZE);
987         }
988
989         save = m->msg_iter;
990 new_mtu:
991         mtu = tipc_node_get_mtu(net, dnode, tsk->portid);
992         rc = tipc_msg_build(mhdr, m, 0, dsz, mtu, pktchain);
993         if (rc < 0)
994                 goto exit;
995
996         do {
997                 skb = skb_peek(pktchain);
998                 TIPC_SKB_CB(skb)->wakeup_pending = tsk->link_cong;
999                 rc = tipc_link_xmit(net, pktchain, dnode, tsk->portid);
1000                 if (likely(rc >= 0)) {
1001                         if (sock->state != SS_READY)
1002                                 sock->state = SS_CONNECTING;
1003                         rc = dsz;
1004                         break;
1005                 }
1006                 if (rc == -EMSGSIZE) {
1007                         m->msg_iter = save;
1008                         goto new_mtu;
1009                 }
1010                 if (rc != -ELINKCONG)
1011                         break;
1012                 tsk->link_cong = 1;
1013                 rc = tipc_wait_for_sndmsg(sock, &timeo);
1014                 if (rc)
1015                         __skb_queue_purge(pktchain);
1016         } while (!rc);
1017 exit:
1018         if (iocb)
1019                 release_sock(sk);
1020
1021         return rc;
1022 }
1023
1024 static int tipc_wait_for_sndpkt(struct socket *sock, long *timeo_p)
1025 {
1026         struct sock *sk = sock->sk;
1027         struct tipc_sock *tsk = tipc_sk(sk);
1028         DEFINE_WAIT(wait);
1029         int done;
1030
1031         do {
1032                 int err = sock_error(sk);
1033                 if (err)
1034                         return err;
1035                 if (sock->state == SS_DISCONNECTING)
1036                         return -EPIPE;
1037                 else if (sock->state != SS_CONNECTED)
1038                         return -ENOTCONN;
1039                 if (!*timeo_p)
1040                         return -EAGAIN;
1041                 if (signal_pending(current))
1042                         return sock_intr_errno(*timeo_p);
1043
1044                 prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
1045                 done = sk_wait_event(sk, timeo_p,
1046                                      (!tsk->link_cong &&
1047                                       !tsk_conn_cong(tsk)) ||
1048                                      !tsk->connected);
1049                 finish_wait(sk_sleep(sk), &wait);
1050         } while (!done);
1051         return 0;
1052 }
1053
1054 /**
1055  * tipc_send_stream - send stream-oriented data
1056  * @iocb: (unused)
1057  * @sock: socket structure
1058  * @m: data to send
1059  * @dsz: total length of data to be transmitted
1060  *
1061  * Used for SOCK_STREAM data.
1062  *
1063  * Returns the number of bytes sent on success (or partial success),
1064  * or errno if no data sent
1065  */
1066 static int tipc_send_stream(struct kiocb *iocb, struct socket *sock,
1067                             struct msghdr *m, size_t dsz)
1068 {
1069         struct sock *sk = sock->sk;
1070         struct net *net = sock_net(sk);
1071         struct tipc_sock *tsk = tipc_sk(sk);
1072         struct tipc_msg *mhdr = &tsk->phdr;
1073         struct sk_buff_head *pktchain = &sk->sk_write_queue;
1074         DECLARE_SOCKADDR(struct sockaddr_tipc *, dest, m->msg_name);
1075         u32 portid = tsk->portid;
1076         int rc = -EINVAL;
1077         long timeo;
1078         u32 dnode;
1079         uint mtu, send, sent = 0;
1080         struct iov_iter save;
1081
1082         /* Handle implied connection establishment */
1083         if (unlikely(dest)) {
1084                 rc = tipc_sendmsg(iocb, sock, m, dsz);
1085                 if (dsz && (dsz == rc))
1086                         tsk->sent_unacked = 1;
1087                 return rc;
1088         }
1089         if (dsz > (uint)INT_MAX)
1090                 return -EMSGSIZE;
1091
1092         if (iocb)
1093                 lock_sock(sk);
1094
1095         if (unlikely(sock->state != SS_CONNECTED)) {
1096                 if (sock->state == SS_DISCONNECTING)
1097                         rc = -EPIPE;
1098                 else
1099                         rc = -ENOTCONN;
1100                 goto exit;
1101         }
1102
1103         timeo = sock_sndtimeo(sk, m->msg_flags & MSG_DONTWAIT);
1104         dnode = tsk_peer_node(tsk);
1105
1106 next:
1107         save = m->msg_iter;
1108         mtu = tsk->max_pkt;
1109         send = min_t(uint, dsz - sent, TIPC_MAX_USER_MSG_SIZE);
1110         rc = tipc_msg_build(mhdr, m, sent, send, mtu, pktchain);
1111         if (unlikely(rc < 0))
1112                 goto exit;
1113         do {
1114                 if (likely(!tsk_conn_cong(tsk))) {
1115                         rc = tipc_link_xmit(net, pktchain, dnode, portid);
1116                         if (likely(!rc)) {
1117                                 tsk->sent_unacked++;
1118                                 sent += send;
1119                                 if (sent == dsz)
1120                                         break;
1121                                 goto next;
1122                         }
1123                         if (rc == -EMSGSIZE) {
1124                                 tsk->max_pkt = tipc_node_get_mtu(net, dnode,
1125                                                                  portid);
1126                                 m->msg_iter = save;
1127                                 goto next;
1128                         }
1129                         if (rc != -ELINKCONG)
1130                                 break;
1131                         tsk->link_cong = 1;
1132                 }
1133                 rc = tipc_wait_for_sndpkt(sock, &timeo);
1134                 if (rc)
1135                         __skb_queue_purge(pktchain);
1136         } while (!rc);
1137 exit:
1138         if (iocb)
1139                 release_sock(sk);
1140         return sent ? sent : rc;
1141 }
1142
1143 /**
1144  * tipc_send_packet - send a connection-oriented message
1145  * @iocb: if NULL, indicates that socket lock is already held
1146  * @sock: socket structure
1147  * @m: message to send
1148  * @dsz: length of data to be transmitted
1149  *
1150  * Used for SOCK_SEQPACKET messages.
1151  *
1152  * Returns the number of bytes sent on success, or errno otherwise
1153  */
1154 static int tipc_send_packet(struct kiocb *iocb, struct socket *sock,
1155                             struct msghdr *m, size_t dsz)
1156 {
1157         if (dsz > TIPC_MAX_USER_MSG_SIZE)
1158                 return -EMSGSIZE;
1159
1160         return tipc_send_stream(iocb, sock, m, dsz);
1161 }
1162
1163 /* tipc_sk_finish_conn - complete the setup of a connection
1164  */
1165 static void tipc_sk_finish_conn(struct tipc_sock *tsk, u32 peer_port,
1166                                 u32 peer_node)
1167 {
1168         struct sock *sk = &tsk->sk;
1169         struct net *net = sock_net(sk);
1170         struct tipc_msg *msg = &tsk->phdr;
1171
1172         msg_set_destnode(msg, peer_node);
1173         msg_set_destport(msg, peer_port);
1174         msg_set_type(msg, TIPC_CONN_MSG);
1175         msg_set_lookup_scope(msg, 0);
1176         msg_set_hdr_sz(msg, SHORT_H_SIZE);
1177
1178         tsk->probing_intv = CONN_PROBING_INTERVAL;
1179         tsk->probing_state = TIPC_CONN_OK;
1180         tsk->connected = 1;
1181         sk_reset_timer(sk, &sk->sk_timer, jiffies + tsk->probing_intv);
1182         tipc_node_add_conn(net, peer_node, tsk->portid, peer_port);
1183         tsk->max_pkt = tipc_node_get_mtu(net, peer_node, tsk->portid);
1184 }
1185
1186 /**
1187  * set_orig_addr - capture sender's address for received message
1188  * @m: descriptor for message info
1189  * @msg: received message header
1190  *
1191  * Note: Address is not captured if not requested by receiver.
1192  */
1193 static void set_orig_addr(struct msghdr *m, struct tipc_msg *msg)
1194 {
1195         DECLARE_SOCKADDR(struct sockaddr_tipc *, addr, m->msg_name);
1196
1197         if (addr) {
1198                 addr->family = AF_TIPC;
1199                 addr->addrtype = TIPC_ADDR_ID;
1200                 memset(&addr->addr, 0, sizeof(addr->addr));
1201                 addr->addr.id.ref = msg_origport(msg);
1202                 addr->addr.id.node = msg_orignode(msg);
1203                 addr->addr.name.domain = 0;     /* could leave uninitialized */
1204                 addr->scope = 0;                /* could leave uninitialized */
1205                 m->msg_namelen = sizeof(struct sockaddr_tipc);
1206         }
1207 }
1208
1209 /**
1210  * tipc_sk_anc_data_recv - optionally capture ancillary data for received message
1211  * @m: descriptor for message info
1212  * @msg: received message header
1213  * @tsk: TIPC port associated with message
1214  *
1215  * Note: Ancillary data is not captured if not requested by receiver.
1216  *
1217  * Returns 0 if successful, otherwise errno
1218  */
1219 static int tipc_sk_anc_data_recv(struct msghdr *m, struct tipc_msg *msg,
1220                                  struct tipc_sock *tsk)
1221 {
1222         u32 anc_data[3];
1223         u32 err;
1224         u32 dest_type;
1225         int has_name;
1226         int res;
1227
1228         if (likely(m->msg_controllen == 0))
1229                 return 0;
1230
1231         /* Optionally capture errored message object(s) */
1232         err = msg ? msg_errcode(msg) : 0;
1233         if (unlikely(err)) {
1234                 anc_data[0] = err;
1235                 anc_data[1] = msg_data_sz(msg);
1236                 res = put_cmsg(m, SOL_TIPC, TIPC_ERRINFO, 8, anc_data);
1237                 if (res)
1238                         return res;
1239                 if (anc_data[1]) {
1240                         res = put_cmsg(m, SOL_TIPC, TIPC_RETDATA, anc_data[1],
1241                                        msg_data(msg));
1242                         if (res)
1243                                 return res;
1244                 }
1245         }
1246
1247         /* Optionally capture message destination object */
1248         dest_type = msg ? msg_type(msg) : TIPC_DIRECT_MSG;
1249         switch (dest_type) {
1250         case TIPC_NAMED_MSG:
1251                 has_name = 1;
1252                 anc_data[0] = msg_nametype(msg);
1253                 anc_data[1] = msg_namelower(msg);
1254                 anc_data[2] = msg_namelower(msg);
1255                 break;
1256         case TIPC_MCAST_MSG:
1257                 has_name = 1;
1258                 anc_data[0] = msg_nametype(msg);
1259                 anc_data[1] = msg_namelower(msg);
1260                 anc_data[2] = msg_nameupper(msg);
1261                 break;
1262         case TIPC_CONN_MSG:
1263                 has_name = (tsk->conn_type != 0);
1264                 anc_data[0] = tsk->conn_type;
1265                 anc_data[1] = tsk->conn_instance;
1266                 anc_data[2] = tsk->conn_instance;
1267                 break;
1268         default:
1269                 has_name = 0;
1270         }
1271         if (has_name) {
1272                 res = put_cmsg(m, SOL_TIPC, TIPC_DESTNAME, 12, anc_data);
1273                 if (res)
1274                         return res;
1275         }
1276
1277         return 0;
1278 }
1279
1280 static void tipc_sk_send_ack(struct tipc_sock *tsk, uint ack)
1281 {
1282         struct net *net = sock_net(&tsk->sk);
1283         struct sk_buff *skb = NULL;
1284         struct tipc_msg *msg;
1285         u32 peer_port = tsk_peer_port(tsk);
1286         u32 dnode = tsk_peer_node(tsk);
1287
1288         if (!tsk->connected)
1289                 return;
1290         skb = tipc_msg_create(CONN_MANAGER, CONN_ACK, INT_H_SIZE, 0,
1291                               dnode, tsk_own_node(tsk), peer_port,
1292                               tsk->portid, TIPC_OK);
1293         if (!skb)
1294                 return;
1295         msg = buf_msg(skb);
1296         msg_set_msgcnt(msg, ack);
1297         tipc_link_xmit_skb(net, skb, dnode, msg_link_selector(msg));
1298 }
1299
1300 static int tipc_wait_for_rcvmsg(struct socket *sock, long *timeop)
1301 {
1302         struct sock *sk = sock->sk;
1303         DEFINE_WAIT(wait);
1304         long timeo = *timeop;
1305         int err;
1306
1307         for (;;) {
1308                 prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
1309                 if (timeo && skb_queue_empty(&sk->sk_receive_queue)) {
1310                         if (sock->state == SS_DISCONNECTING) {
1311                                 err = -ENOTCONN;
1312                                 break;
1313                         }
1314                         release_sock(sk);
1315                         timeo = schedule_timeout(timeo);
1316                         lock_sock(sk);
1317                 }
1318                 err = 0;
1319                 if (!skb_queue_empty(&sk->sk_receive_queue))
1320                         break;
1321                 err = sock_intr_errno(timeo);
1322                 if (signal_pending(current))
1323                         break;
1324                 err = -EAGAIN;
1325                 if (!timeo)
1326                         break;
1327         }
1328         finish_wait(sk_sleep(sk), &wait);
1329         *timeop = timeo;
1330         return err;
1331 }
1332
1333 /**
1334  * tipc_recvmsg - receive packet-oriented message
1335  * @iocb: (unused)
1336  * @m: descriptor for message info
1337  * @buf_len: total size of user buffer area
1338  * @flags: receive flags
1339  *
1340  * Used for SOCK_DGRAM, SOCK_RDM, and SOCK_SEQPACKET messages.
1341  * If the complete message doesn't fit in user area, truncate it.
1342  *
1343  * Returns size of returned message data, errno otherwise
1344  */
1345 static int tipc_recvmsg(struct kiocb *iocb, struct socket *sock,
1346                         struct msghdr *m, size_t buf_len, int flags)
1347 {
1348         struct sock *sk = sock->sk;
1349         struct tipc_sock *tsk = tipc_sk(sk);
1350         struct sk_buff *buf;
1351         struct tipc_msg *msg;
1352         long timeo;
1353         unsigned int sz;
1354         u32 err;
1355         int res;
1356
1357         /* Catch invalid receive requests */
1358         if (unlikely(!buf_len))
1359                 return -EINVAL;
1360
1361         lock_sock(sk);
1362
1363         if (unlikely(sock->state == SS_UNCONNECTED)) {
1364                 res = -ENOTCONN;
1365                 goto exit;
1366         }
1367
1368         timeo = sock_rcvtimeo(sk, flags & MSG_DONTWAIT);
1369 restart:
1370
1371         /* Look for a message in receive queue; wait if necessary */
1372         res = tipc_wait_for_rcvmsg(sock, &timeo);
1373         if (res)
1374                 goto exit;
1375
1376         /* Look at first message in receive queue */
1377         buf = skb_peek(&sk->sk_receive_queue);
1378         msg = buf_msg(buf);
1379         sz = msg_data_sz(msg);
1380         err = msg_errcode(msg);
1381
1382         /* Discard an empty non-errored message & try again */
1383         if ((!sz) && (!err)) {
1384                 tsk_advance_rx_queue(sk);
1385                 goto restart;
1386         }
1387
1388         /* Capture sender's address (optional) */
1389         set_orig_addr(m, msg);
1390
1391         /* Capture ancillary data (optional) */
1392         res = tipc_sk_anc_data_recv(m, msg, tsk);
1393         if (res)
1394                 goto exit;
1395
1396         /* Capture message data (if valid) & compute return value (always) */
1397         if (!err) {
1398                 if (unlikely(buf_len < sz)) {
1399                         sz = buf_len;
1400                         m->msg_flags |= MSG_TRUNC;
1401                 }
1402                 res = skb_copy_datagram_msg(buf, msg_hdr_sz(msg), m, sz);
1403                 if (res)
1404                         goto exit;
1405                 res = sz;
1406         } else {
1407                 if ((sock->state == SS_READY) ||
1408                     ((err == TIPC_CONN_SHUTDOWN) || m->msg_control))
1409                         res = 0;
1410                 else
1411                         res = -ECONNRESET;
1412         }
1413
1414         /* Consume received message (optional) */
1415         if (likely(!(flags & MSG_PEEK))) {
1416                 if ((sock->state != SS_READY) &&
1417                     (++tsk->rcv_unacked >= TIPC_CONNACK_INTV)) {
1418                         tipc_sk_send_ack(tsk, tsk->rcv_unacked);
1419                         tsk->rcv_unacked = 0;
1420                 }
1421                 tsk_advance_rx_queue(sk);
1422         }
1423 exit:
1424         release_sock(sk);
1425         return res;
1426 }
1427
1428 /**
1429  * tipc_recv_stream - receive stream-oriented data
1430  * @iocb: (unused)
1431  * @m: descriptor for message info
1432  * @buf_len: total size of user buffer area
1433  * @flags: receive flags
1434  *
1435  * Used for SOCK_STREAM messages only.  If not enough data is available
1436  * will optionally wait for more; never truncates data.
1437  *
1438  * Returns size of returned message data, errno otherwise
1439  */
1440 static int tipc_recv_stream(struct kiocb *iocb, struct socket *sock,
1441                             struct msghdr *m, size_t buf_len, int flags)
1442 {
1443         struct sock *sk = sock->sk;
1444         struct tipc_sock *tsk = tipc_sk(sk);
1445         struct sk_buff *buf;
1446         struct tipc_msg *msg;
1447         long timeo;
1448         unsigned int sz;
1449         int sz_to_copy, target, needed;
1450         int sz_copied = 0;
1451         u32 err;
1452         int res = 0;
1453
1454         /* Catch invalid receive attempts */
1455         if (unlikely(!buf_len))
1456                 return -EINVAL;
1457
1458         lock_sock(sk);
1459
1460         if (unlikely(sock->state == SS_UNCONNECTED)) {
1461                 res = -ENOTCONN;
1462                 goto exit;
1463         }
1464
1465         target = sock_rcvlowat(sk, flags & MSG_WAITALL, buf_len);
1466         timeo = sock_rcvtimeo(sk, flags & MSG_DONTWAIT);
1467
1468 restart:
1469         /* Look for a message in receive queue; wait if necessary */
1470         res = tipc_wait_for_rcvmsg(sock, &timeo);
1471         if (res)
1472                 goto exit;
1473
1474         /* Look at first message in receive queue */
1475         buf = skb_peek(&sk->sk_receive_queue);
1476         msg = buf_msg(buf);
1477         sz = msg_data_sz(msg);
1478         err = msg_errcode(msg);
1479
1480         /* Discard an empty non-errored message & try again */
1481         if ((!sz) && (!err)) {
1482                 tsk_advance_rx_queue(sk);
1483                 goto restart;
1484         }
1485
1486         /* Optionally capture sender's address & ancillary data of first msg */
1487         if (sz_copied == 0) {
1488                 set_orig_addr(m, msg);
1489                 res = tipc_sk_anc_data_recv(m, msg, tsk);
1490                 if (res)
1491                         goto exit;
1492         }
1493
1494         /* Capture message data (if valid) & compute return value (always) */
1495         if (!err) {
1496                 u32 offset = (u32)(unsigned long)(TIPC_SKB_CB(buf)->handle);
1497
1498                 sz -= offset;
1499                 needed = (buf_len - sz_copied);
1500                 sz_to_copy = (sz <= needed) ? sz : needed;
1501
1502                 res = skb_copy_datagram_msg(buf, msg_hdr_sz(msg) + offset,
1503                                             m, sz_to_copy);
1504                 if (res)
1505                         goto exit;
1506
1507                 sz_copied += sz_to_copy;
1508
1509                 if (sz_to_copy < sz) {
1510                         if (!(flags & MSG_PEEK))
1511                                 TIPC_SKB_CB(buf)->handle =
1512                                 (void *)(unsigned long)(offset + sz_to_copy);
1513                         goto exit;
1514                 }
1515         } else {
1516                 if (sz_copied != 0)
1517                         goto exit; /* can't add error msg to valid data */
1518
1519                 if ((err == TIPC_CONN_SHUTDOWN) || m->msg_control)
1520                         res = 0;
1521                 else
1522                         res = -ECONNRESET;
1523         }
1524
1525         /* Consume received message (optional) */
1526         if (likely(!(flags & MSG_PEEK))) {
1527                 if (unlikely(++tsk->rcv_unacked >= TIPC_CONNACK_INTV)) {
1528                         tipc_sk_send_ack(tsk, tsk->rcv_unacked);
1529                         tsk->rcv_unacked = 0;
1530                 }
1531                 tsk_advance_rx_queue(sk);
1532         }
1533
1534         /* Loop around if more data is required */
1535         if ((sz_copied < buf_len) &&    /* didn't get all requested data */
1536             (!skb_queue_empty(&sk->sk_receive_queue) ||
1537             (sz_copied < target)) &&    /* and more is ready or required */
1538             (!(flags & MSG_PEEK)) &&    /* and aren't just peeking at data */
1539             (!err))                     /* and haven't reached a FIN */
1540                 goto restart;
1541
1542 exit:
1543         release_sock(sk);
1544         return sz_copied ? sz_copied : res;
1545 }
1546
1547 /**
1548  * tipc_write_space - wake up thread if port congestion is released
1549  * @sk: socket
1550  */
1551 static void tipc_write_space(struct sock *sk)
1552 {
1553         struct socket_wq *wq;
1554
1555         rcu_read_lock();
1556         wq = rcu_dereference(sk->sk_wq);
1557         if (wq_has_sleeper(wq))
1558                 wake_up_interruptible_sync_poll(&wq->wait, POLLOUT |
1559                                                 POLLWRNORM | POLLWRBAND);
1560         rcu_read_unlock();
1561 }
1562
1563 /**
1564  * tipc_data_ready - wake up threads to indicate messages have been received
1565  * @sk: socket
1566  * @len: the length of messages
1567  */
1568 static void tipc_data_ready(struct sock *sk)
1569 {
1570         struct socket_wq *wq;
1571
1572         rcu_read_lock();
1573         wq = rcu_dereference(sk->sk_wq);
1574         if (wq_has_sleeper(wq))
1575                 wake_up_interruptible_sync_poll(&wq->wait, POLLIN |
1576                                                 POLLRDNORM | POLLRDBAND);
1577         rcu_read_unlock();
1578 }
1579
1580 /**
1581  * filter_connect - Handle all incoming messages for a connection-based socket
1582  * @tsk: TIPC socket
1583  * @skb: pointer to message buffer. Set to NULL if buffer is consumed
1584  *
1585  * Returns 0 (TIPC_OK) if everything ok, -TIPC_ERR_NO_PORT otherwise
1586  */
1587 static int filter_connect(struct tipc_sock *tsk, struct sk_buff **skb)
1588 {
1589         struct sock *sk = &tsk->sk;
1590         struct net *net = sock_net(sk);
1591         struct socket *sock = sk->sk_socket;
1592         struct tipc_msg *msg = buf_msg(*skb);
1593         int retval = -TIPC_ERR_NO_PORT;
1594
1595         if (msg_mcast(msg))
1596                 return retval;
1597
1598         switch ((int)sock->state) {
1599         case SS_CONNECTED:
1600                 /* Accept only connection-based messages sent by peer */
1601                 if (tsk_peer_msg(tsk, msg)) {
1602                         if (unlikely(msg_errcode(msg))) {
1603                                 sock->state = SS_DISCONNECTING;
1604                                 tsk->connected = 0;
1605                                 /* let timer expire on it's own */
1606                                 tipc_node_remove_conn(net, tsk_peer_node(tsk),
1607                                                       tsk->portid);
1608                         }
1609                         retval = TIPC_OK;
1610                 }
1611                 break;
1612         case SS_CONNECTING:
1613                 /* Accept only ACK or NACK message */
1614
1615                 if (unlikely(!msg_connected(msg)))
1616                         break;
1617
1618                 if (unlikely(msg_errcode(msg))) {
1619                         sock->state = SS_DISCONNECTING;
1620                         sk->sk_err = ECONNREFUSED;
1621                         retval = TIPC_OK;
1622                         break;
1623                 }
1624
1625                 if (unlikely(msg_importance(msg) > TIPC_CRITICAL_IMPORTANCE)) {
1626                         sock->state = SS_DISCONNECTING;
1627                         sk->sk_err = EINVAL;
1628                         retval = TIPC_OK;
1629                         break;
1630                 }
1631
1632                 tipc_sk_finish_conn(tsk, msg_origport(msg), msg_orignode(msg));
1633                 msg_set_importance(&tsk->phdr, msg_importance(msg));
1634                 sock->state = SS_CONNECTED;
1635
1636                 /* If an incoming message is an 'ACK-', it should be
1637                  * discarded here because it doesn't contain useful
1638                  * data. In addition, we should try to wake up
1639                  * connect() routine if sleeping.
1640                  */
1641                 if (msg_data_sz(msg) == 0) {
1642                         kfree_skb(*skb);
1643                         *skb = NULL;
1644                         if (waitqueue_active(sk_sleep(sk)))
1645                                 wake_up_interruptible(sk_sleep(sk));
1646                 }
1647                 retval = TIPC_OK;
1648                 break;
1649         case SS_LISTENING:
1650         case SS_UNCONNECTED:
1651                 /* Accept only SYN message */
1652                 if (!msg_connected(msg) && !(msg_errcode(msg)))
1653                         retval = TIPC_OK;
1654                 break;
1655         case SS_DISCONNECTING:
1656                 break;
1657         default:
1658                 pr_err("Unknown socket state %u\n", sock->state);
1659         }
1660         return retval;
1661 }
1662
1663 /**
1664  * rcvbuf_limit - get proper overload limit of socket receive queue
1665  * @sk: socket
1666  * @buf: message
1667  *
1668  * For all connection oriented messages, irrespective of importance,
1669  * the default overload value (i.e. 67MB) is set as limit.
1670  *
1671  * For all connectionless messages, by default new queue limits are
1672  * as belows:
1673  *
1674  * TIPC_LOW_IMPORTANCE       (4 MB)
1675  * TIPC_MEDIUM_IMPORTANCE    (8 MB)
1676  * TIPC_HIGH_IMPORTANCE      (16 MB)
1677  * TIPC_CRITICAL_IMPORTANCE  (32 MB)
1678  *
1679  * Returns overload limit according to corresponding message importance
1680  */
1681 static unsigned int rcvbuf_limit(struct sock *sk, struct sk_buff *buf)
1682 {
1683         struct tipc_msg *msg = buf_msg(buf);
1684
1685         if (msg_connected(msg))
1686                 return sysctl_tipc_rmem[2];
1687
1688         return sk->sk_rcvbuf >> TIPC_CRITICAL_IMPORTANCE <<
1689                 msg_importance(msg);
1690 }
1691
1692 /**
1693  * filter_rcv - validate incoming message
1694  * @sk: socket
1695  * @skb: pointer to message. Set to NULL if buffer is consumed.
1696  *
1697  * Enqueues message on receive queue if acceptable; optionally handles
1698  * disconnect indication for a connected socket.
1699  *
1700  * Called with socket lock already taken
1701  *
1702  * Returns 0 (TIPC_OK) if message was ok, -TIPC error code if rejected
1703  */
1704 static int filter_rcv(struct sock *sk, struct sk_buff **skb)
1705 {
1706         struct socket *sock = sk->sk_socket;
1707         struct tipc_sock *tsk = tipc_sk(sk);
1708         struct tipc_msg *msg = buf_msg(*skb);
1709         unsigned int limit = rcvbuf_limit(sk, *skb);
1710         int rc = TIPC_OK;
1711
1712         if (unlikely(msg_user(msg) == CONN_MANAGER)) {
1713                 tipc_sk_proto_rcv(tsk, skb);
1714                 return TIPC_OK;
1715         }
1716
1717         if (unlikely(msg_user(msg) == SOCK_WAKEUP)) {
1718                 kfree_skb(*skb);
1719                 tsk->link_cong = 0;
1720                 sk->sk_write_space(sk);
1721                 *skb = NULL;
1722                 return TIPC_OK;
1723         }
1724
1725         /* Reject message if it is wrong sort of message for socket */
1726         if (msg_type(msg) > TIPC_DIRECT_MSG)
1727                 return -TIPC_ERR_NO_PORT;
1728
1729         if (sock->state == SS_READY) {
1730                 if (msg_connected(msg))
1731                         return -TIPC_ERR_NO_PORT;
1732         } else {
1733                 rc = filter_connect(tsk, skb);
1734                 if (rc != TIPC_OK || !*skb)
1735                         return rc;
1736         }
1737
1738         /* Reject message if there isn't room to queue it */
1739         if (sk_rmem_alloc_get(sk) + (*skb)->truesize >= limit)
1740                 return -TIPC_ERR_OVERLOAD;
1741
1742         /* Enqueue message */
1743         TIPC_SKB_CB(*skb)->handle = NULL;
1744         __skb_queue_tail(&sk->sk_receive_queue, *skb);
1745         skb_set_owner_r(*skb, sk);
1746
1747         sk->sk_data_ready(sk);
1748         *skb = NULL;
1749         return TIPC_OK;
1750 }
1751
1752 /**
1753  * tipc_backlog_rcv - handle incoming message from backlog queue
1754  * @sk: socket
1755  * @skb: message
1756  *
1757  * Caller must hold socket lock
1758  *
1759  * Returns 0
1760  */
1761 static int tipc_backlog_rcv(struct sock *sk, struct sk_buff *skb)
1762 {
1763         int err;
1764         atomic_t *dcnt;
1765         u32 dnode;
1766         struct tipc_sock *tsk = tipc_sk(sk);
1767         struct net *net = sock_net(sk);
1768         uint truesize = skb->truesize;
1769
1770         err = filter_rcv(sk, &skb);
1771         if (likely(!skb)) {
1772                 dcnt = &tsk->dupl_rcvcnt;
1773                 if (atomic_read(dcnt) < TIPC_CONN_OVERLOAD_LIMIT)
1774                         atomic_add(truesize, dcnt);
1775                 return 0;
1776         }
1777         if (!err || tipc_msg_reverse(tsk_own_node(tsk), skb, &dnode, -err))
1778                 tipc_link_xmit_skb(net, skb, dnode, tsk->portid);
1779         return 0;
1780 }
1781
1782 /**
1783  * tipc_sk_enqueue - extract all buffers with destination 'dport' from
1784  *                   inputq and try adding them to socket or backlog queue
1785  * @inputq: list of incoming buffers with potentially different destinations
1786  * @sk: socket where the buffers should be enqueued
1787  * @dport: port number for the socket
1788  * @_skb: returned buffer to be forwarded or rejected, if applicable
1789  *
1790  * Caller must hold socket lock
1791  *
1792  * Returns TIPC_OK if all buffers enqueued, otherwise -TIPC_ERR_OVERLOAD
1793  * or -TIPC_ERR_NO_PORT
1794  */
1795 static int tipc_sk_enqueue(struct sk_buff_head *inputq, struct sock *sk,
1796                            u32 dport, struct sk_buff **_skb)
1797 {
1798         unsigned int lim;
1799         atomic_t *dcnt;
1800         int err;
1801         struct sk_buff *skb;
1802         unsigned long time_limit = jiffies + 2;
1803
1804         while (skb_queue_len(inputq)) {
1805                 skb = tipc_skb_dequeue(inputq, dport);
1806                 if (unlikely(!skb))
1807                         return TIPC_OK;
1808                 /* Return if softirq window exhausted */
1809                 if (unlikely(time_after_eq(jiffies, time_limit)))
1810                         return TIPC_OK;
1811                 if (!sock_owned_by_user(sk)) {
1812                         err = filter_rcv(sk, &skb);
1813                         if (likely(!skb))
1814                                 continue;
1815                         *_skb = skb;
1816                         return err;
1817                 }
1818                 dcnt = &tipc_sk(sk)->dupl_rcvcnt;
1819                 if (sk->sk_backlog.len)
1820                         atomic_set(dcnt, 0);
1821                 lim = rcvbuf_limit(sk, skb) + atomic_read(dcnt);
1822                 if (likely(!sk_add_backlog(sk, skb, lim)))
1823                         continue;
1824                 *_skb = skb;
1825                 return -TIPC_ERR_OVERLOAD;
1826         }
1827         return TIPC_OK;
1828 }
1829
1830 /**
1831  * tipc_sk_rcv - handle a chain of incoming buffers
1832  * @inputq: buffer list containing the buffers
1833  * Consumes all buffers in list until inputq is empty
1834  * Note: may be called in multiple threads referring to the same queue
1835  * Returns 0 if last buffer was accepted, otherwise -EHOSTUNREACH
1836  * Only node local calls check the return value, sending single-buffer queues
1837  */
1838 int tipc_sk_rcv(struct net *net, struct sk_buff_head *inputq)
1839 {
1840         u32 dnode, dport = 0;
1841         int err = -TIPC_ERR_NO_PORT;
1842         struct sk_buff *skb;
1843         struct tipc_sock *tsk;
1844         struct tipc_net *tn;
1845         struct sock *sk;
1846
1847         while (skb_queue_len(inputq)) {
1848                 skb = NULL;
1849                 dport = tipc_skb_peek_port(inputq, dport);
1850                 tsk = tipc_sk_lookup(net, dport);
1851                 if (likely(tsk)) {
1852                         sk = &tsk->sk;
1853                         if (likely(spin_trylock_bh(&sk->sk_lock.slock))) {
1854                                 err = tipc_sk_enqueue(inputq, sk, dport, &skb);
1855                                 spin_unlock_bh(&sk->sk_lock.slock);
1856                                 dport = 0;
1857                         }
1858                         sock_put(sk);
1859                 } else {
1860                         skb = tipc_skb_dequeue(inputq, dport);
1861                 }
1862                 if (likely(!skb))
1863                         continue;
1864                 if (tipc_msg_lookup_dest(net, skb, &dnode, &err))
1865                         goto xmit;
1866                 if (!err) {
1867                         dnode = msg_destnode(buf_msg(skb));
1868                         goto xmit;
1869                 }
1870                 tn = net_generic(net, tipc_net_id);
1871                 if (!tipc_msg_reverse(tn->own_addr, skb, &dnode, -err))
1872                         continue;
1873 xmit:
1874                 tipc_link_xmit_skb(net, skb, dnode, dport);
1875         }
1876         return err ? -EHOSTUNREACH : 0;
1877 }
1878
1879 static int tipc_wait_for_connect(struct socket *sock, long *timeo_p)
1880 {
1881         struct sock *sk = sock->sk;
1882         DEFINE_WAIT(wait);
1883         int done;
1884
1885         do {
1886                 int err = sock_error(sk);
1887                 if (err)
1888                         return err;
1889                 if (!*timeo_p)
1890                         return -ETIMEDOUT;
1891                 if (signal_pending(current))
1892                         return sock_intr_errno(*timeo_p);
1893
1894                 prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
1895                 done = sk_wait_event(sk, timeo_p, sock->state != SS_CONNECTING);
1896                 finish_wait(sk_sleep(sk), &wait);
1897         } while (!done);
1898         return 0;
1899 }
1900
1901 /**
1902  * tipc_connect - establish a connection to another TIPC port
1903  * @sock: socket structure
1904  * @dest: socket address for destination port
1905  * @destlen: size of socket address data structure
1906  * @flags: file-related flags associated with socket
1907  *
1908  * Returns 0 on success, errno otherwise
1909  */
1910 static int tipc_connect(struct socket *sock, struct sockaddr *dest,
1911                         int destlen, int flags)
1912 {
1913         struct sock *sk = sock->sk;
1914         struct sockaddr_tipc *dst = (struct sockaddr_tipc *)dest;
1915         struct msghdr m = {NULL,};
1916         long timeout = (flags & O_NONBLOCK) ? 0 : tipc_sk(sk)->conn_timeout;
1917         socket_state previous;
1918         int res;
1919
1920         lock_sock(sk);
1921
1922         /* For now, TIPC does not allow use of connect() with DGRAM/RDM types */
1923         if (sock->state == SS_READY) {
1924                 res = -EOPNOTSUPP;
1925                 goto exit;
1926         }
1927
1928         /*
1929          * Reject connection attempt using multicast address
1930          *
1931          * Note: send_msg() validates the rest of the address fields,
1932          *       so there's no need to do it here
1933          */
1934         if (dst->addrtype == TIPC_ADDR_MCAST) {
1935                 res = -EINVAL;
1936                 goto exit;
1937         }
1938
1939         previous = sock->state;
1940         switch (sock->state) {
1941         case SS_UNCONNECTED:
1942                 /* Send a 'SYN-' to destination */
1943                 m.msg_name = dest;
1944                 m.msg_namelen = destlen;
1945
1946                 /* If connect is in non-blocking case, set MSG_DONTWAIT to
1947                  * indicate send_msg() is never blocked.
1948                  */
1949                 if (!timeout)
1950                         m.msg_flags = MSG_DONTWAIT;
1951
1952                 res = tipc_sendmsg(NULL, sock, &m, 0);
1953                 if ((res < 0) && (res != -EWOULDBLOCK))
1954                         goto exit;
1955
1956                 /* Just entered SS_CONNECTING state; the only
1957                  * difference is that return value in non-blocking
1958                  * case is EINPROGRESS, rather than EALREADY.
1959                  */
1960                 res = -EINPROGRESS;
1961         case SS_CONNECTING:
1962                 if (previous == SS_CONNECTING)
1963                         res = -EALREADY;
1964                 if (!timeout)
1965                         goto exit;
1966                 timeout = msecs_to_jiffies(timeout);
1967                 /* Wait until an 'ACK' or 'RST' arrives, or a timeout occurs */
1968                 res = tipc_wait_for_connect(sock, &timeout);
1969                 break;
1970         case SS_CONNECTED:
1971                 res = -EISCONN;
1972                 break;
1973         default:
1974                 res = -EINVAL;
1975                 break;
1976         }
1977 exit:
1978         release_sock(sk);
1979         return res;
1980 }
1981
1982 /**
1983  * tipc_listen - allow socket to listen for incoming connections
1984  * @sock: socket structure
1985  * @len: (unused)
1986  *
1987  * Returns 0 on success, errno otherwise
1988  */
1989 static int tipc_listen(struct socket *sock, int len)
1990 {
1991         struct sock *sk = sock->sk;
1992         int res;
1993
1994         lock_sock(sk);
1995
1996         if (sock->state != SS_UNCONNECTED)
1997                 res = -EINVAL;
1998         else {
1999                 sock->state = SS_LISTENING;
2000                 res = 0;
2001         }
2002
2003         release_sock(sk);
2004         return res;
2005 }
2006
2007 static int tipc_wait_for_accept(struct socket *sock, long timeo)
2008 {
2009         struct sock *sk = sock->sk;
2010         DEFINE_WAIT(wait);
2011         int err;
2012
2013         /* True wake-one mechanism for incoming connections: only
2014          * one process gets woken up, not the 'whole herd'.
2015          * Since we do not 'race & poll' for established sockets
2016          * anymore, the common case will execute the loop only once.
2017         */
2018         for (;;) {
2019                 prepare_to_wait_exclusive(sk_sleep(sk), &wait,
2020                                           TASK_INTERRUPTIBLE);
2021                 if (timeo && skb_queue_empty(&sk->sk_receive_queue)) {
2022                         release_sock(sk);
2023                         timeo = schedule_timeout(timeo);
2024                         lock_sock(sk);
2025                 }
2026                 err = 0;
2027                 if (!skb_queue_empty(&sk->sk_receive_queue))
2028                         break;
2029                 err = -EINVAL;
2030                 if (sock->state != SS_LISTENING)
2031                         break;
2032                 err = sock_intr_errno(timeo);
2033                 if (signal_pending(current))
2034                         break;
2035                 err = -EAGAIN;
2036                 if (!timeo)
2037                         break;
2038         }
2039         finish_wait(sk_sleep(sk), &wait);
2040         return err;
2041 }
2042
2043 /**
2044  * tipc_accept - wait for connection request
2045  * @sock: listening socket
2046  * @newsock: new socket that is to be connected
2047  * @flags: file-related flags associated with socket
2048  *
2049  * Returns 0 on success, errno otherwise
2050  */
2051 static int tipc_accept(struct socket *sock, struct socket *new_sock, int flags)
2052 {
2053         struct sock *new_sk, *sk = sock->sk;
2054         struct sk_buff *buf;
2055         struct tipc_sock *new_tsock;
2056         struct tipc_msg *msg;
2057         long timeo;
2058         int res;
2059
2060         lock_sock(sk);
2061
2062         if (sock->state != SS_LISTENING) {
2063                 res = -EINVAL;
2064                 goto exit;
2065         }
2066         timeo = sock_rcvtimeo(sk, flags & O_NONBLOCK);
2067         res = tipc_wait_for_accept(sock, timeo);
2068         if (res)
2069                 goto exit;
2070
2071         buf = skb_peek(&sk->sk_receive_queue);
2072
2073         res = tipc_sk_create(sock_net(sock->sk), new_sock, 0, 1);
2074         if (res)
2075                 goto exit;
2076
2077         new_sk = new_sock->sk;
2078         new_tsock = tipc_sk(new_sk);
2079         msg = buf_msg(buf);
2080
2081         /* we lock on new_sk; but lockdep sees the lock on sk */
2082         lock_sock_nested(new_sk, SINGLE_DEPTH_NESTING);
2083
2084         /*
2085          * Reject any stray messages received by new socket
2086          * before the socket lock was taken (very, very unlikely)
2087          */
2088         tsk_rej_rx_queue(new_sk);
2089
2090         /* Connect new socket to it's peer */
2091         tipc_sk_finish_conn(new_tsock, msg_origport(msg), msg_orignode(msg));
2092         new_sock->state = SS_CONNECTED;
2093
2094         tsk_set_importance(new_tsock, msg_importance(msg));
2095         if (msg_named(msg)) {
2096                 new_tsock->conn_type = msg_nametype(msg);
2097                 new_tsock->conn_instance = msg_nameinst(msg);
2098         }
2099
2100         /*
2101          * Respond to 'SYN-' by discarding it & returning 'ACK'-.
2102          * Respond to 'SYN+' by queuing it on new socket.
2103          */
2104         if (!msg_data_sz(msg)) {
2105                 struct msghdr m = {NULL,};
2106
2107                 tsk_advance_rx_queue(sk);
2108                 tipc_send_packet(NULL, new_sock, &m, 0);
2109         } else {
2110                 __skb_dequeue(&sk->sk_receive_queue);
2111                 __skb_queue_head(&new_sk->sk_receive_queue, buf);
2112                 skb_set_owner_r(buf, new_sk);
2113         }
2114         release_sock(new_sk);
2115 exit:
2116         release_sock(sk);
2117         return res;
2118 }
2119
2120 /**
2121  * tipc_shutdown - shutdown socket connection
2122  * @sock: socket structure
2123  * @how: direction to close (must be SHUT_RDWR)
2124  *
2125  * Terminates connection (if necessary), then purges socket's receive queue.
2126  *
2127  * Returns 0 on success, errno otherwise
2128  */
2129 static int tipc_shutdown(struct socket *sock, int how)
2130 {
2131         struct sock *sk = sock->sk;
2132         struct net *net = sock_net(sk);
2133         struct tipc_sock *tsk = tipc_sk(sk);
2134         struct sk_buff *skb;
2135         u32 dnode;
2136         int res;
2137
2138         if (how != SHUT_RDWR)
2139                 return -EINVAL;
2140
2141         lock_sock(sk);
2142
2143         switch (sock->state) {
2144         case SS_CONNECTING:
2145         case SS_CONNECTED:
2146
2147 restart:
2148                 /* Disconnect and send a 'FIN+' or 'FIN-' message to peer */
2149                 skb = __skb_dequeue(&sk->sk_receive_queue);
2150                 if (skb) {
2151                         if (TIPC_SKB_CB(skb)->handle != NULL) {
2152                                 kfree_skb(skb);
2153                                 goto restart;
2154                         }
2155                         if (tipc_msg_reverse(tsk_own_node(tsk), skb, &dnode,
2156                                              TIPC_CONN_SHUTDOWN))
2157                                 tipc_link_xmit_skb(net, skb, dnode,
2158                                                    tsk->portid);
2159                         tipc_node_remove_conn(net, dnode, tsk->portid);
2160                 } else {
2161                         dnode = tsk_peer_node(tsk);
2162
2163                         skb = tipc_msg_create(TIPC_CRITICAL_IMPORTANCE,
2164                                               TIPC_CONN_MSG, SHORT_H_SIZE,
2165                                               0, dnode, tsk_own_node(tsk),
2166                                               tsk_peer_port(tsk),
2167                                               tsk->portid, TIPC_CONN_SHUTDOWN);
2168                         tipc_link_xmit_skb(net, skb, dnode, tsk->portid);
2169                 }
2170                 tsk->connected = 0;
2171                 sock->state = SS_DISCONNECTING;
2172                 tipc_node_remove_conn(net, dnode, tsk->portid);
2173                 /* fall through */
2174
2175         case SS_DISCONNECTING:
2176
2177                 /* Discard any unreceived messages */
2178                 __skb_queue_purge(&sk->sk_receive_queue);
2179
2180                 /* Wake up anyone sleeping in poll */
2181                 sk->sk_state_change(sk);
2182                 res = 0;
2183                 break;
2184
2185         default:
2186                 res = -ENOTCONN;
2187         }
2188
2189         release_sock(sk);
2190         return res;
2191 }
2192
2193 static void tipc_sk_timeout(unsigned long data)
2194 {
2195         struct tipc_sock *tsk = (struct tipc_sock *)data;
2196         struct sock *sk = &tsk->sk;
2197         struct sk_buff *skb = NULL;
2198         u32 peer_port, peer_node;
2199         u32 own_node = tsk_own_node(tsk);
2200
2201         bh_lock_sock(sk);
2202         if (!tsk->connected) {
2203                 bh_unlock_sock(sk);
2204                 goto exit;
2205         }
2206         peer_port = tsk_peer_port(tsk);
2207         peer_node = tsk_peer_node(tsk);
2208
2209         if (tsk->probing_state == TIPC_CONN_PROBING) {
2210                 /* Previous probe not answered -> self abort */
2211                 skb = tipc_msg_create(TIPC_CRITICAL_IMPORTANCE,
2212                                       TIPC_CONN_MSG, SHORT_H_SIZE, 0,
2213                                       own_node, peer_node, tsk->portid,
2214                                       peer_port, TIPC_ERR_NO_PORT);
2215         } else {
2216                 skb = tipc_msg_create(CONN_MANAGER, CONN_PROBE,
2217                                       INT_H_SIZE, 0, peer_node, own_node,
2218                                       peer_port, tsk->portid, TIPC_OK);
2219                 tsk->probing_state = TIPC_CONN_PROBING;
2220                 sk_reset_timer(sk, &sk->sk_timer, jiffies + tsk->probing_intv);
2221         }
2222         bh_unlock_sock(sk);
2223         if (skb)
2224                 tipc_link_xmit_skb(sock_net(sk), skb, peer_node, tsk->portid);
2225 exit:
2226         sock_put(sk);
2227 }
2228
2229 static int tipc_sk_publish(struct tipc_sock *tsk, uint scope,
2230                            struct tipc_name_seq const *seq)
2231 {
2232         struct net *net = sock_net(&tsk->sk);
2233         struct publication *publ;
2234         u32 key;
2235
2236         if (tsk->connected)
2237                 return -EINVAL;
2238         key = tsk->portid + tsk->pub_count + 1;
2239         if (key == tsk->portid)
2240                 return -EADDRINUSE;
2241
2242         publ = tipc_nametbl_publish(net, seq->type, seq->lower, seq->upper,
2243                                     scope, tsk->portid, key);
2244         if (unlikely(!publ))
2245                 return -EINVAL;
2246
2247         list_add(&publ->pport_list, &tsk->publications);
2248         tsk->pub_count++;
2249         tsk->published = 1;
2250         return 0;
2251 }
2252
2253 static int tipc_sk_withdraw(struct tipc_sock *tsk, uint scope,
2254                             struct tipc_name_seq const *seq)
2255 {
2256         struct net *net = sock_net(&tsk->sk);
2257         struct publication *publ;
2258         struct publication *safe;
2259         int rc = -EINVAL;
2260
2261         list_for_each_entry_safe(publ, safe, &tsk->publications, pport_list) {
2262                 if (seq) {
2263                         if (publ->scope != scope)
2264                                 continue;
2265                         if (publ->type != seq->type)
2266                                 continue;
2267                         if (publ->lower != seq->lower)
2268                                 continue;
2269                         if (publ->upper != seq->upper)
2270                                 break;
2271                         tipc_nametbl_withdraw(net, publ->type, publ->lower,
2272                                               publ->ref, publ->key);
2273                         rc = 0;
2274                         break;
2275                 }
2276                 tipc_nametbl_withdraw(net, publ->type, publ->lower,
2277                                       publ->ref, publ->key);
2278                 rc = 0;
2279         }
2280         if (list_empty(&tsk->publications))
2281                 tsk->published = 0;
2282         return rc;
2283 }
2284
2285 static int tipc_sk_show(struct tipc_sock *tsk, char *buf,
2286                         int len, int full_id)
2287 {
2288         struct net *net = sock_net(&tsk->sk);
2289         struct tipc_net *tn = net_generic(net, tipc_net_id);
2290         struct publication *publ;
2291         int ret;
2292
2293         if (full_id)
2294                 ret = tipc_snprintf(buf, len, "<%u.%u.%u:%u>:",
2295                                     tipc_zone(tn->own_addr),
2296                                     tipc_cluster(tn->own_addr),
2297                                     tipc_node(tn->own_addr), tsk->portid);
2298         else
2299                 ret = tipc_snprintf(buf, len, "%-10u:", tsk->portid);
2300
2301         if (tsk->connected) {
2302                 u32 dport = tsk_peer_port(tsk);
2303                 u32 destnode = tsk_peer_node(tsk);
2304
2305                 ret += tipc_snprintf(buf + ret, len - ret,
2306                                      " connected to <%u.%u.%u:%u>",
2307                                      tipc_zone(destnode),
2308                                      tipc_cluster(destnode),
2309                                      tipc_node(destnode), dport);
2310                 if (tsk->conn_type != 0)
2311                         ret += tipc_snprintf(buf + ret, len - ret,
2312                                              " via {%u,%u}", tsk->conn_type,
2313                                              tsk->conn_instance);
2314         } else if (tsk->published) {
2315                 ret += tipc_snprintf(buf + ret, len - ret, " bound to");
2316                 list_for_each_entry(publ, &tsk->publications, pport_list) {
2317                         if (publ->lower == publ->upper)
2318                                 ret += tipc_snprintf(buf + ret, len - ret,
2319                                                      " {%u,%u}", publ->type,
2320                                                      publ->lower);
2321                         else
2322                                 ret += tipc_snprintf(buf + ret, len - ret,
2323                                                      " {%u,%u,%u}", publ->type,
2324                                                      publ->lower, publ->upper);
2325                 }
2326         }
2327         ret += tipc_snprintf(buf + ret, len - ret, "\n");
2328         return ret;
2329 }
2330
2331 struct sk_buff *tipc_sk_socks_show(struct net *net)
2332 {
2333         struct tipc_net *tn = net_generic(net, tipc_net_id);
2334         const struct bucket_table *tbl;
2335         struct rhash_head *pos;
2336         struct sk_buff *buf;
2337         struct tlv_desc *rep_tlv;
2338         char *pb;
2339         int pb_len;
2340         struct tipc_sock *tsk;
2341         int str_len = 0;
2342         int i;
2343
2344         buf = tipc_cfg_reply_alloc(TLV_SPACE(ULTRA_STRING_MAX_LEN));
2345         if (!buf)
2346                 return NULL;
2347         rep_tlv = (struct tlv_desc *)buf->data;
2348         pb = TLV_DATA(rep_tlv);
2349         pb_len = ULTRA_STRING_MAX_LEN;
2350
2351         rcu_read_lock();
2352         tbl = rht_dereference_rcu((&tn->sk_rht)->tbl, &tn->sk_rht);
2353         for (i = 0; i < tbl->size; i++) {
2354                 rht_for_each_entry_rcu(tsk, pos, tbl, i, node) {
2355                         spin_lock_bh(&tsk->sk.sk_lock.slock);
2356                         str_len += tipc_sk_show(tsk, pb + str_len,
2357                                                 pb_len - str_len, 0);
2358                         spin_unlock_bh(&tsk->sk.sk_lock.slock);
2359                 }
2360         }
2361         rcu_read_unlock();
2362
2363         str_len += 1;   /* for "\0" */
2364         skb_put(buf, TLV_SPACE(str_len));
2365         TLV_SET(rep_tlv, TIPC_TLV_ULTRA_STRING, NULL, str_len);
2366
2367         return buf;
2368 }
2369
2370 /* tipc_sk_reinit: set non-zero address in all existing sockets
2371  *                 when we go from standalone to network mode.
2372  */
2373 void tipc_sk_reinit(struct net *net)
2374 {
2375         struct tipc_net *tn = net_generic(net, tipc_net_id);
2376         const struct bucket_table *tbl;
2377         struct rhash_head *pos;
2378         struct tipc_sock *tsk;
2379         struct tipc_msg *msg;
2380         int i;
2381
2382         rcu_read_lock();
2383         tbl = rht_dereference_rcu((&tn->sk_rht)->tbl, &tn->sk_rht);
2384         for (i = 0; i < tbl->size; i++) {
2385                 rht_for_each_entry_rcu(tsk, pos, tbl, i, node) {
2386                         spin_lock_bh(&tsk->sk.sk_lock.slock);
2387                         msg = &tsk->phdr;
2388                         msg_set_prevnode(msg, tn->own_addr);
2389                         msg_set_orignode(msg, tn->own_addr);
2390                         spin_unlock_bh(&tsk->sk.sk_lock.slock);
2391                 }
2392         }
2393         rcu_read_unlock();
2394 }
2395
2396 static struct tipc_sock *tipc_sk_lookup(struct net *net, u32 portid)
2397 {
2398         struct tipc_net *tn = net_generic(net, tipc_net_id);
2399         struct tipc_sock *tsk;
2400
2401         rcu_read_lock();
2402         tsk = rhashtable_lookup(&tn->sk_rht, &portid);
2403         if (tsk)
2404                 sock_hold(&tsk->sk);
2405         rcu_read_unlock();
2406
2407         return tsk;
2408 }
2409
2410 static int tipc_sk_insert(struct tipc_sock *tsk)
2411 {
2412         struct sock *sk = &tsk->sk;
2413         struct net *net = sock_net(sk);
2414         struct tipc_net *tn = net_generic(net, tipc_net_id);
2415         u32 remaining = (TIPC_MAX_PORT - TIPC_MIN_PORT) + 1;
2416         u32 portid = prandom_u32() % remaining + TIPC_MIN_PORT;
2417
2418         while (remaining--) {
2419                 portid++;
2420                 if ((portid < TIPC_MIN_PORT) || (portid > TIPC_MAX_PORT))
2421                         portid = TIPC_MIN_PORT;
2422                 tsk->portid = portid;
2423                 sock_hold(&tsk->sk);
2424                 if (rhashtable_lookup_insert(&tn->sk_rht, &tsk->node))
2425                         return 0;
2426                 sock_put(&tsk->sk);
2427         }
2428
2429         return -1;
2430 }
2431
2432 static void tipc_sk_remove(struct tipc_sock *tsk)
2433 {
2434         struct sock *sk = &tsk->sk;
2435         struct tipc_net *tn = net_generic(sock_net(sk), tipc_net_id);
2436
2437         if (rhashtable_remove(&tn->sk_rht, &tsk->node)) {
2438                 WARN_ON(atomic_read(&sk->sk_refcnt) == 1);
2439                 __sock_put(sk);
2440         }
2441 }
2442
2443 int tipc_sk_rht_init(struct net *net)
2444 {
2445         struct tipc_net *tn = net_generic(net, tipc_net_id);
2446         struct rhashtable_params rht_params = {
2447                 .nelem_hint = 192,
2448                 .head_offset = offsetof(struct tipc_sock, node),
2449                 .key_offset = offsetof(struct tipc_sock, portid),
2450                 .key_len = sizeof(u32), /* portid */
2451                 .hashfn = jhash,
2452                 .max_shift = 20, /* 1M */
2453                 .min_shift = 8,  /* 256 */
2454                 .grow_decision = rht_grow_above_75,
2455                 .shrink_decision = rht_shrink_below_30,
2456         };
2457
2458         return rhashtable_init(&tn->sk_rht, &rht_params);
2459 }
2460
2461 void tipc_sk_rht_destroy(struct net *net)
2462 {
2463         struct tipc_net *tn = net_generic(net, tipc_net_id);
2464
2465         /* Wait for socket readers to complete */
2466         synchronize_net();
2467
2468         rhashtable_destroy(&tn->sk_rht);
2469 }
2470
2471 /**
2472  * tipc_setsockopt - set socket option
2473  * @sock: socket structure
2474  * @lvl: option level
2475  * @opt: option identifier
2476  * @ov: pointer to new option value
2477  * @ol: length of option value
2478  *
2479  * For stream sockets only, accepts and ignores all IPPROTO_TCP options
2480  * (to ease compatibility).
2481  *
2482  * Returns 0 on success, errno otherwise
2483  */
2484 static int tipc_setsockopt(struct socket *sock, int lvl, int opt,
2485                            char __user *ov, unsigned int ol)
2486 {
2487         struct sock *sk = sock->sk;
2488         struct tipc_sock *tsk = tipc_sk(sk);
2489         u32 value;
2490         int res;
2491
2492         if ((lvl == IPPROTO_TCP) && (sock->type == SOCK_STREAM))
2493                 return 0;
2494         if (lvl != SOL_TIPC)
2495                 return -ENOPROTOOPT;
2496         if (ol < sizeof(value))
2497                 return -EINVAL;
2498         res = get_user(value, (u32 __user *)ov);
2499         if (res)
2500                 return res;
2501
2502         lock_sock(sk);
2503
2504         switch (opt) {
2505         case TIPC_IMPORTANCE:
2506                 res = tsk_set_importance(tsk, value);
2507                 break;
2508         case TIPC_SRC_DROPPABLE:
2509                 if (sock->type != SOCK_STREAM)
2510                         tsk_set_unreliable(tsk, value);
2511                 else
2512                         res = -ENOPROTOOPT;
2513                 break;
2514         case TIPC_DEST_DROPPABLE:
2515                 tsk_set_unreturnable(tsk, value);
2516                 break;
2517         case TIPC_CONN_TIMEOUT:
2518                 tipc_sk(sk)->conn_timeout = value;
2519                 /* no need to set "res", since already 0 at this point */
2520                 break;
2521         default:
2522                 res = -EINVAL;
2523         }
2524
2525         release_sock(sk);
2526
2527         return res;
2528 }
2529
2530 /**
2531  * tipc_getsockopt - get socket option
2532  * @sock: socket structure
2533  * @lvl: option level
2534  * @opt: option identifier
2535  * @ov: receptacle for option value
2536  * @ol: receptacle for length of option value
2537  *
2538  * For stream sockets only, returns 0 length result for all IPPROTO_TCP options
2539  * (to ease compatibility).
2540  *
2541  * Returns 0 on success, errno otherwise
2542  */
2543 static int tipc_getsockopt(struct socket *sock, int lvl, int opt,
2544                            char __user *ov, int __user *ol)
2545 {
2546         struct sock *sk = sock->sk;
2547         struct tipc_sock *tsk = tipc_sk(sk);
2548         int len;
2549         u32 value;
2550         int res;
2551
2552         if ((lvl == IPPROTO_TCP) && (sock->type == SOCK_STREAM))
2553                 return put_user(0, ol);
2554         if (lvl != SOL_TIPC)
2555                 return -ENOPROTOOPT;
2556         res = get_user(len, ol);
2557         if (res)
2558                 return res;
2559
2560         lock_sock(sk);
2561
2562         switch (opt) {
2563         case TIPC_IMPORTANCE:
2564                 value = tsk_importance(tsk);
2565                 break;
2566         case TIPC_SRC_DROPPABLE:
2567                 value = tsk_unreliable(tsk);
2568                 break;
2569         case TIPC_DEST_DROPPABLE:
2570                 value = tsk_unreturnable(tsk);
2571                 break;
2572         case TIPC_CONN_TIMEOUT:
2573                 value = tsk->conn_timeout;
2574                 /* no need to set "res", since already 0 at this point */
2575                 break;
2576         case TIPC_NODE_RECVQ_DEPTH:
2577                 value = 0; /* was tipc_queue_size, now obsolete */
2578                 break;
2579         case TIPC_SOCK_RECVQ_DEPTH:
2580                 value = skb_queue_len(&sk->sk_receive_queue);
2581                 break;
2582         default:
2583                 res = -EINVAL;
2584         }
2585
2586         release_sock(sk);
2587
2588         if (res)
2589                 return res;     /* "get" failed */
2590
2591         if (len < sizeof(value))
2592                 return -EINVAL;
2593
2594         if (copy_to_user(ov, &value, sizeof(value)))
2595                 return -EFAULT;
2596
2597         return put_user(sizeof(value), ol);
2598 }
2599
2600 static int tipc_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
2601 {
2602         struct sock *sk = sock->sk;
2603         struct tipc_sioc_ln_req lnr;
2604         void __user *argp = (void __user *)arg;
2605
2606         switch (cmd) {
2607         case SIOCGETLINKNAME:
2608                 if (copy_from_user(&lnr, argp, sizeof(lnr)))
2609                         return -EFAULT;
2610                 if (!tipc_node_get_linkname(sock_net(sk),
2611                                             lnr.bearer_id & 0xffff, lnr.peer,
2612                                             lnr.linkname, TIPC_MAX_LINK_NAME)) {
2613                         if (copy_to_user(argp, &lnr, sizeof(lnr)))
2614                                 return -EFAULT;
2615                         return 0;
2616                 }
2617                 return -EADDRNOTAVAIL;
2618         default:
2619                 return -ENOIOCTLCMD;
2620         }
2621 }
2622
2623 /* Protocol switches for the various types of TIPC sockets */
2624
2625 static const struct proto_ops msg_ops = {
2626         .owner          = THIS_MODULE,
2627         .family         = AF_TIPC,
2628         .release        = tipc_release,
2629         .bind           = tipc_bind,
2630         .connect        = tipc_connect,
2631         .socketpair     = sock_no_socketpair,
2632         .accept         = sock_no_accept,
2633         .getname        = tipc_getname,
2634         .poll           = tipc_poll,
2635         .ioctl          = tipc_ioctl,
2636         .listen         = sock_no_listen,
2637         .shutdown       = tipc_shutdown,
2638         .setsockopt     = tipc_setsockopt,
2639         .getsockopt     = tipc_getsockopt,
2640         .sendmsg        = tipc_sendmsg,
2641         .recvmsg        = tipc_recvmsg,
2642         .mmap           = sock_no_mmap,
2643         .sendpage       = sock_no_sendpage
2644 };
2645
2646 static const struct proto_ops packet_ops = {
2647         .owner          = THIS_MODULE,
2648         .family         = AF_TIPC,
2649         .release        = tipc_release,
2650         .bind           = tipc_bind,
2651         .connect        = tipc_connect,
2652         .socketpair     = sock_no_socketpair,
2653         .accept         = tipc_accept,
2654         .getname        = tipc_getname,
2655         .poll           = tipc_poll,
2656         .ioctl          = tipc_ioctl,
2657         .listen         = tipc_listen,
2658         .shutdown       = tipc_shutdown,
2659         .setsockopt     = tipc_setsockopt,
2660         .getsockopt     = tipc_getsockopt,
2661         .sendmsg        = tipc_send_packet,
2662         .recvmsg        = tipc_recvmsg,
2663         .mmap           = sock_no_mmap,
2664         .sendpage       = sock_no_sendpage
2665 };
2666
2667 static const struct proto_ops stream_ops = {
2668         .owner          = THIS_MODULE,
2669         .family         = AF_TIPC,
2670         .release        = tipc_release,
2671         .bind           = tipc_bind,
2672         .connect        = tipc_connect,
2673         .socketpair     = sock_no_socketpair,
2674         .accept         = tipc_accept,
2675         .getname        = tipc_getname,
2676         .poll           = tipc_poll,
2677         .ioctl          = tipc_ioctl,
2678         .listen         = tipc_listen,
2679         .shutdown       = tipc_shutdown,
2680         .setsockopt     = tipc_setsockopt,
2681         .getsockopt     = tipc_getsockopt,
2682         .sendmsg        = tipc_send_stream,
2683         .recvmsg        = tipc_recv_stream,
2684         .mmap           = sock_no_mmap,
2685         .sendpage       = sock_no_sendpage
2686 };
2687
2688 static const struct net_proto_family tipc_family_ops = {
2689         .owner          = THIS_MODULE,
2690         .family         = AF_TIPC,
2691         .create         = tipc_sk_create
2692 };
2693
2694 static struct proto tipc_proto = {
2695         .name           = "TIPC",
2696         .owner          = THIS_MODULE,
2697         .obj_size       = sizeof(struct tipc_sock),
2698         .sysctl_rmem    = sysctl_tipc_rmem
2699 };
2700
2701 static struct proto tipc_proto_kern = {
2702         .name           = "TIPC",
2703         .obj_size       = sizeof(struct tipc_sock),
2704         .sysctl_rmem    = sysctl_tipc_rmem
2705 };
2706
2707 /**
2708  * tipc_socket_init - initialize TIPC socket interface
2709  *
2710  * Returns 0 on success, errno otherwise
2711  */
2712 int tipc_socket_init(void)
2713 {
2714         int res;
2715
2716         res = proto_register(&tipc_proto, 1);
2717         if (res) {
2718                 pr_err("Failed to register TIPC protocol type\n");
2719                 goto out;
2720         }
2721
2722         res = sock_register(&tipc_family_ops);
2723         if (res) {
2724                 pr_err("Failed to register TIPC socket type\n");
2725                 proto_unregister(&tipc_proto);
2726                 goto out;
2727         }
2728  out:
2729         return res;
2730 }
2731
2732 /**
2733  * tipc_socket_stop - stop TIPC socket interface
2734  */
2735 void tipc_socket_stop(void)
2736 {
2737         sock_unregister(tipc_family_ops.family);
2738         proto_unregister(&tipc_proto);
2739 }
2740
2741 /* Caller should hold socket lock for the passed tipc socket. */
2742 static int __tipc_nl_add_sk_con(struct sk_buff *skb, struct tipc_sock *tsk)
2743 {
2744         u32 peer_node;
2745         u32 peer_port;
2746         struct nlattr *nest;
2747
2748         peer_node = tsk_peer_node(tsk);
2749         peer_port = tsk_peer_port(tsk);
2750
2751         nest = nla_nest_start(skb, TIPC_NLA_SOCK_CON);
2752
2753         if (nla_put_u32(skb, TIPC_NLA_CON_NODE, peer_node))
2754                 goto msg_full;
2755         if (nla_put_u32(skb, TIPC_NLA_CON_SOCK, peer_port))
2756                 goto msg_full;
2757
2758         if (tsk->conn_type != 0) {
2759                 if (nla_put_flag(skb, TIPC_NLA_CON_FLAG))
2760                         goto msg_full;
2761                 if (nla_put_u32(skb, TIPC_NLA_CON_TYPE, tsk->conn_type))
2762                         goto msg_full;
2763                 if (nla_put_u32(skb, TIPC_NLA_CON_INST, tsk->conn_instance))
2764                         goto msg_full;
2765         }
2766         nla_nest_end(skb, nest);
2767
2768         return 0;
2769
2770 msg_full:
2771         nla_nest_cancel(skb, nest);
2772
2773         return -EMSGSIZE;
2774 }
2775
2776 /* Caller should hold socket lock for the passed tipc socket. */
2777 static int __tipc_nl_add_sk(struct sk_buff *skb, struct netlink_callback *cb,
2778                             struct tipc_sock *tsk)
2779 {
2780         int err;
2781         void *hdr;
2782         struct nlattr *attrs;
2783         struct net *net = sock_net(skb->sk);
2784         struct tipc_net *tn = net_generic(net, tipc_net_id);
2785
2786         hdr = genlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq,
2787                           &tipc_genl_v2_family, NLM_F_MULTI, TIPC_NL_SOCK_GET);
2788         if (!hdr)
2789                 goto msg_cancel;
2790
2791         attrs = nla_nest_start(skb, TIPC_NLA_SOCK);
2792         if (!attrs)
2793                 goto genlmsg_cancel;
2794         if (nla_put_u32(skb, TIPC_NLA_SOCK_REF, tsk->portid))
2795                 goto attr_msg_cancel;
2796         if (nla_put_u32(skb, TIPC_NLA_SOCK_ADDR, tn->own_addr))
2797                 goto attr_msg_cancel;
2798
2799         if (tsk->connected) {
2800                 err = __tipc_nl_add_sk_con(skb, tsk);
2801                 if (err)
2802                         goto attr_msg_cancel;
2803         } else if (!list_empty(&tsk->publications)) {
2804                 if (nla_put_flag(skb, TIPC_NLA_SOCK_HAS_PUBL))
2805                         goto attr_msg_cancel;
2806         }
2807         nla_nest_end(skb, attrs);
2808         genlmsg_end(skb, hdr);
2809
2810         return 0;
2811
2812 attr_msg_cancel:
2813         nla_nest_cancel(skb, attrs);
2814 genlmsg_cancel:
2815         genlmsg_cancel(skb, hdr);
2816 msg_cancel:
2817         return -EMSGSIZE;
2818 }
2819
2820 int tipc_nl_sk_dump(struct sk_buff *skb, struct netlink_callback *cb)
2821 {
2822         int err;
2823         struct tipc_sock *tsk;
2824         const struct bucket_table *tbl;
2825         struct rhash_head *pos;
2826         struct net *net = sock_net(skb->sk);
2827         struct tipc_net *tn = net_generic(net, tipc_net_id);
2828         u32 tbl_id = cb->args[0];
2829         u32 prev_portid = cb->args[1];
2830
2831         rcu_read_lock();
2832         tbl = rht_dereference_rcu((&tn->sk_rht)->tbl, &tn->sk_rht);
2833         for (; tbl_id < tbl->size; tbl_id++) {
2834                 rht_for_each_entry_rcu(tsk, pos, tbl, tbl_id, node) {
2835                         spin_lock_bh(&tsk->sk.sk_lock.slock);
2836                         if (prev_portid && prev_portid != tsk->portid) {
2837                                 spin_unlock_bh(&tsk->sk.sk_lock.slock);
2838                                 continue;
2839                         }
2840
2841                         err = __tipc_nl_add_sk(skb, cb, tsk);
2842                         if (err) {
2843                                 prev_portid = tsk->portid;
2844                                 spin_unlock_bh(&tsk->sk.sk_lock.slock);
2845                                 goto out;
2846                         }
2847                         prev_portid = 0;
2848                         spin_unlock_bh(&tsk->sk.sk_lock.slock);
2849                 }
2850         }
2851 out:
2852         rcu_read_unlock();
2853         cb->args[0] = tbl_id;
2854         cb->args[1] = prev_portid;
2855
2856         return skb->len;
2857 }
2858
2859 /* Caller should hold socket lock for the passed tipc socket. */
2860 static int __tipc_nl_add_sk_publ(struct sk_buff *skb,
2861                                  struct netlink_callback *cb,
2862                                  struct publication *publ)
2863 {
2864         void *hdr;
2865         struct nlattr *attrs;
2866
2867         hdr = genlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq,
2868                           &tipc_genl_v2_family, NLM_F_MULTI, TIPC_NL_PUBL_GET);
2869         if (!hdr)
2870                 goto msg_cancel;
2871
2872         attrs = nla_nest_start(skb, TIPC_NLA_PUBL);
2873         if (!attrs)
2874                 goto genlmsg_cancel;
2875
2876         if (nla_put_u32(skb, TIPC_NLA_PUBL_KEY, publ->key))
2877                 goto attr_msg_cancel;
2878         if (nla_put_u32(skb, TIPC_NLA_PUBL_TYPE, publ->type))
2879                 goto attr_msg_cancel;
2880         if (nla_put_u32(skb, TIPC_NLA_PUBL_LOWER, publ->lower))
2881                 goto attr_msg_cancel;
2882         if (nla_put_u32(skb, TIPC_NLA_PUBL_UPPER, publ->upper))
2883                 goto attr_msg_cancel;
2884
2885         nla_nest_end(skb, attrs);
2886         genlmsg_end(skb, hdr);
2887
2888         return 0;
2889
2890 attr_msg_cancel:
2891         nla_nest_cancel(skb, attrs);
2892 genlmsg_cancel:
2893         genlmsg_cancel(skb, hdr);
2894 msg_cancel:
2895         return -EMSGSIZE;
2896 }
2897
2898 /* Caller should hold socket lock for the passed tipc socket. */
2899 static int __tipc_nl_list_sk_publ(struct sk_buff *skb,
2900                                   struct netlink_callback *cb,
2901                                   struct tipc_sock *tsk, u32 *last_publ)
2902 {
2903         int err;
2904         struct publication *p;
2905
2906         if (*last_publ) {
2907                 list_for_each_entry(p, &tsk->publications, pport_list) {
2908                         if (p->key == *last_publ)
2909                                 break;
2910                 }
2911                 if (p->key != *last_publ) {
2912                         /* We never set seq or call nl_dump_check_consistent()
2913                          * this means that setting prev_seq here will cause the
2914                          * consistence check to fail in the netlink callback
2915                          * handler. Resulting in the last NLMSG_DONE message
2916                          * having the NLM_F_DUMP_INTR flag set.
2917                          */
2918                         cb->prev_seq = 1;
2919                         *last_publ = 0;
2920                         return -EPIPE;
2921                 }
2922         } else {
2923                 p = list_first_entry(&tsk->publications, struct publication,
2924                                      pport_list);
2925         }
2926
2927         list_for_each_entry_from(p, &tsk->publications, pport_list) {
2928                 err = __tipc_nl_add_sk_publ(skb, cb, p);
2929                 if (err) {
2930                         *last_publ = p->key;
2931                         return err;
2932                 }
2933         }
2934         *last_publ = 0;
2935
2936         return 0;
2937 }
2938
2939 int tipc_nl_publ_dump(struct sk_buff *skb, struct netlink_callback *cb)
2940 {
2941         int err;
2942         u32 tsk_portid = cb->args[0];
2943         u32 last_publ = cb->args[1];
2944         u32 done = cb->args[2];
2945         struct net *net = sock_net(skb->sk);
2946         struct tipc_sock *tsk;
2947
2948         if (!tsk_portid) {
2949                 struct nlattr **attrs;
2950                 struct nlattr *sock[TIPC_NLA_SOCK_MAX + 1];
2951
2952                 err = tipc_nlmsg_parse(cb->nlh, &attrs);
2953                 if (err)
2954                         return err;
2955
2956                 err = nla_parse_nested(sock, TIPC_NLA_SOCK_MAX,
2957                                        attrs[TIPC_NLA_SOCK],
2958                                        tipc_nl_sock_policy);
2959                 if (err)
2960                         return err;
2961
2962                 if (!sock[TIPC_NLA_SOCK_REF])
2963                         return -EINVAL;
2964
2965                 tsk_portid = nla_get_u32(sock[TIPC_NLA_SOCK_REF]);
2966         }
2967
2968         if (done)
2969                 return 0;
2970
2971         tsk = tipc_sk_lookup(net, tsk_portid);
2972         if (!tsk)
2973                 return -EINVAL;
2974
2975         lock_sock(&tsk->sk);
2976         err = __tipc_nl_list_sk_publ(skb, cb, tsk, &last_publ);
2977         if (!err)
2978                 done = 1;
2979         release_sock(&tsk->sk);
2980         sock_put(&tsk->sk);
2981
2982         cb->args[0] = tsk_portid;
2983         cb->args[1] = last_publ;
2984         cb->args[2] = done;
2985
2986         return skb->len;
2987 }