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                 if (unlikely(time_after_eq(jiffies, time_limit)))
1806                         return TIPC_OK;
1807                 skb = tipc_skb_dequeue(inputq, dport);
1808                 if (unlikely(!skb))
1809                         return TIPC_OK;
1810                 if (!sock_owned_by_user(sk)) {
1811                         err = filter_rcv(sk, &skb);
1812                         if (likely(!skb))
1813                                 continue;
1814                         *_skb = skb;
1815                         return err;
1816                 }
1817                 dcnt = &tipc_sk(sk)->dupl_rcvcnt;
1818                 if (sk->sk_backlog.len)
1819                         atomic_set(dcnt, 0);
1820                 lim = rcvbuf_limit(sk, skb) + atomic_read(dcnt);
1821                 if (likely(!sk_add_backlog(sk, skb, lim)))
1822                         continue;
1823                 *_skb = skb;
1824                 return -TIPC_ERR_OVERLOAD;
1825         }
1826         return TIPC_OK;
1827 }
1828
1829 /**
1830  * tipc_sk_rcv - handle a chain of incoming buffers
1831  * @inputq: buffer list containing the buffers
1832  * Consumes all buffers in list until inputq is empty
1833  * Note: may be called in multiple threads referring to the same queue
1834  * Returns 0 if last buffer was accepted, otherwise -EHOSTUNREACH
1835  * Only node local calls check the return value, sending single-buffer queues
1836  */
1837 int tipc_sk_rcv(struct net *net, struct sk_buff_head *inputq)
1838 {
1839         u32 dnode, dport = 0;
1840         int err = -TIPC_ERR_NO_PORT;
1841         struct sk_buff *skb;
1842         struct tipc_sock *tsk;
1843         struct tipc_net *tn;
1844         struct sock *sk;
1845
1846         while (skb_queue_len(inputq)) {
1847                 skb = NULL;
1848                 dport = tipc_skb_peek_port(inputq, dport);
1849                 tsk = tipc_sk_lookup(net, dport);
1850                 if (likely(tsk)) {
1851                         sk = &tsk->sk;
1852                         if (likely(spin_trylock_bh(&sk->sk_lock.slock))) {
1853                                 err = tipc_sk_enqueue(inputq, sk, dport, &skb);
1854                                 spin_unlock_bh(&sk->sk_lock.slock);
1855                                 dport = 0;
1856                         }
1857                         sock_put(sk);
1858                 } else {
1859                         skb = tipc_skb_dequeue(inputq, dport);
1860                 }
1861                 if (likely(!skb))
1862                         continue;
1863                 if (tipc_msg_lookup_dest(net, skb, &dnode, &err))
1864                         goto xmit;
1865                 if (!err) {
1866                         dnode = msg_destnode(buf_msg(skb));
1867                         goto xmit;
1868                 }
1869                 tn = net_generic(net, tipc_net_id);
1870                 if (!tipc_msg_reverse(tn->own_addr, skb, &dnode, -err))
1871                         continue;
1872 xmit:
1873                 tipc_link_xmit_skb(net, skb, dnode, dport);
1874         }
1875         return err ? -EHOSTUNREACH : 0;
1876 }
1877
1878 static int tipc_wait_for_connect(struct socket *sock, long *timeo_p)
1879 {
1880         struct sock *sk = sock->sk;
1881         DEFINE_WAIT(wait);
1882         int done;
1883
1884         do {
1885                 int err = sock_error(sk);
1886                 if (err)
1887                         return err;
1888                 if (!*timeo_p)
1889                         return -ETIMEDOUT;
1890                 if (signal_pending(current))
1891                         return sock_intr_errno(*timeo_p);
1892
1893                 prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
1894                 done = sk_wait_event(sk, timeo_p, sock->state != SS_CONNECTING);
1895                 finish_wait(sk_sleep(sk), &wait);
1896         } while (!done);
1897         return 0;
1898 }
1899
1900 /**
1901  * tipc_connect - establish a connection to another TIPC port
1902  * @sock: socket structure
1903  * @dest: socket address for destination port
1904  * @destlen: size of socket address data structure
1905  * @flags: file-related flags associated with socket
1906  *
1907  * Returns 0 on success, errno otherwise
1908  */
1909 static int tipc_connect(struct socket *sock, struct sockaddr *dest,
1910                         int destlen, int flags)
1911 {
1912         struct sock *sk = sock->sk;
1913         struct sockaddr_tipc *dst = (struct sockaddr_tipc *)dest;
1914         struct msghdr m = {NULL,};
1915         long timeout = (flags & O_NONBLOCK) ? 0 : tipc_sk(sk)->conn_timeout;
1916         socket_state previous;
1917         int res;
1918
1919         lock_sock(sk);
1920
1921         /* For now, TIPC does not allow use of connect() with DGRAM/RDM types */
1922         if (sock->state == SS_READY) {
1923                 res = -EOPNOTSUPP;
1924                 goto exit;
1925         }
1926
1927         /*
1928          * Reject connection attempt using multicast address
1929          *
1930          * Note: send_msg() validates the rest of the address fields,
1931          *       so there's no need to do it here
1932          */
1933         if (dst->addrtype == TIPC_ADDR_MCAST) {
1934                 res = -EINVAL;
1935                 goto exit;
1936         }
1937
1938         previous = sock->state;
1939         switch (sock->state) {
1940         case SS_UNCONNECTED:
1941                 /* Send a 'SYN-' to destination */
1942                 m.msg_name = dest;
1943                 m.msg_namelen = destlen;
1944
1945                 /* If connect is in non-blocking case, set MSG_DONTWAIT to
1946                  * indicate send_msg() is never blocked.
1947                  */
1948                 if (!timeout)
1949                         m.msg_flags = MSG_DONTWAIT;
1950
1951                 res = tipc_sendmsg(NULL, sock, &m, 0);
1952                 if ((res < 0) && (res != -EWOULDBLOCK))
1953                         goto exit;
1954
1955                 /* Just entered SS_CONNECTING state; the only
1956                  * difference is that return value in non-blocking
1957                  * case is EINPROGRESS, rather than EALREADY.
1958                  */
1959                 res = -EINPROGRESS;
1960         case SS_CONNECTING:
1961                 if (previous == SS_CONNECTING)
1962                         res = -EALREADY;
1963                 if (!timeout)
1964                         goto exit;
1965                 timeout = msecs_to_jiffies(timeout);
1966                 /* Wait until an 'ACK' or 'RST' arrives, or a timeout occurs */
1967                 res = tipc_wait_for_connect(sock, &timeout);
1968                 break;
1969         case SS_CONNECTED:
1970                 res = -EISCONN;
1971                 break;
1972         default:
1973                 res = -EINVAL;
1974                 break;
1975         }
1976 exit:
1977         release_sock(sk);
1978         return res;
1979 }
1980
1981 /**
1982  * tipc_listen - allow socket to listen for incoming connections
1983  * @sock: socket structure
1984  * @len: (unused)
1985  *
1986  * Returns 0 on success, errno otherwise
1987  */
1988 static int tipc_listen(struct socket *sock, int len)
1989 {
1990         struct sock *sk = sock->sk;
1991         int res;
1992
1993         lock_sock(sk);
1994
1995         if (sock->state != SS_UNCONNECTED)
1996                 res = -EINVAL;
1997         else {
1998                 sock->state = SS_LISTENING;
1999                 res = 0;
2000         }
2001
2002         release_sock(sk);
2003         return res;
2004 }
2005
2006 static int tipc_wait_for_accept(struct socket *sock, long timeo)
2007 {
2008         struct sock *sk = sock->sk;
2009         DEFINE_WAIT(wait);
2010         int err;
2011
2012         /* True wake-one mechanism for incoming connections: only
2013          * one process gets woken up, not the 'whole herd'.
2014          * Since we do not 'race & poll' for established sockets
2015          * anymore, the common case will execute the loop only once.
2016         */
2017         for (;;) {
2018                 prepare_to_wait_exclusive(sk_sleep(sk), &wait,
2019                                           TASK_INTERRUPTIBLE);
2020                 if (timeo && skb_queue_empty(&sk->sk_receive_queue)) {
2021                         release_sock(sk);
2022                         timeo = schedule_timeout(timeo);
2023                         lock_sock(sk);
2024                 }
2025                 err = 0;
2026                 if (!skb_queue_empty(&sk->sk_receive_queue))
2027                         break;
2028                 err = -EINVAL;
2029                 if (sock->state != SS_LISTENING)
2030                         break;
2031                 err = sock_intr_errno(timeo);
2032                 if (signal_pending(current))
2033                         break;
2034                 err = -EAGAIN;
2035                 if (!timeo)
2036                         break;
2037         }
2038         finish_wait(sk_sleep(sk), &wait);
2039         return err;
2040 }
2041
2042 /**
2043  * tipc_accept - wait for connection request
2044  * @sock: listening socket
2045  * @newsock: new socket that is to be connected
2046  * @flags: file-related flags associated with socket
2047  *
2048  * Returns 0 on success, errno otherwise
2049  */
2050 static int tipc_accept(struct socket *sock, struct socket *new_sock, int flags)
2051 {
2052         struct sock *new_sk, *sk = sock->sk;
2053         struct sk_buff *buf;
2054         struct tipc_sock *new_tsock;
2055         struct tipc_msg *msg;
2056         long timeo;
2057         int res;
2058
2059         lock_sock(sk);
2060
2061         if (sock->state != SS_LISTENING) {
2062                 res = -EINVAL;
2063                 goto exit;
2064         }
2065         timeo = sock_rcvtimeo(sk, flags & O_NONBLOCK);
2066         res = tipc_wait_for_accept(sock, timeo);
2067         if (res)
2068                 goto exit;
2069
2070         buf = skb_peek(&sk->sk_receive_queue);
2071
2072         res = tipc_sk_create(sock_net(sock->sk), new_sock, 0, 1);
2073         if (res)
2074                 goto exit;
2075
2076         new_sk = new_sock->sk;
2077         new_tsock = tipc_sk(new_sk);
2078         msg = buf_msg(buf);
2079
2080         /* we lock on new_sk; but lockdep sees the lock on sk */
2081         lock_sock_nested(new_sk, SINGLE_DEPTH_NESTING);
2082
2083         /*
2084          * Reject any stray messages received by new socket
2085          * before the socket lock was taken (very, very unlikely)
2086          */
2087         tsk_rej_rx_queue(new_sk);
2088
2089         /* Connect new socket to it's peer */
2090         tipc_sk_finish_conn(new_tsock, msg_origport(msg), msg_orignode(msg));
2091         new_sock->state = SS_CONNECTED;
2092
2093         tsk_set_importance(new_tsock, msg_importance(msg));
2094         if (msg_named(msg)) {
2095                 new_tsock->conn_type = msg_nametype(msg);
2096                 new_tsock->conn_instance = msg_nameinst(msg);
2097         }
2098
2099         /*
2100          * Respond to 'SYN-' by discarding it & returning 'ACK'-.
2101          * Respond to 'SYN+' by queuing it on new socket.
2102          */
2103         if (!msg_data_sz(msg)) {
2104                 struct msghdr m = {NULL,};
2105
2106                 tsk_advance_rx_queue(sk);
2107                 tipc_send_packet(NULL, new_sock, &m, 0);
2108         } else {
2109                 __skb_dequeue(&sk->sk_receive_queue);
2110                 __skb_queue_head(&new_sk->sk_receive_queue, buf);
2111                 skb_set_owner_r(buf, new_sk);
2112         }
2113         release_sock(new_sk);
2114 exit:
2115         release_sock(sk);
2116         return res;
2117 }
2118
2119 /**
2120  * tipc_shutdown - shutdown socket connection
2121  * @sock: socket structure
2122  * @how: direction to close (must be SHUT_RDWR)
2123  *
2124  * Terminates connection (if necessary), then purges socket's receive queue.
2125  *
2126  * Returns 0 on success, errno otherwise
2127  */
2128 static int tipc_shutdown(struct socket *sock, int how)
2129 {
2130         struct sock *sk = sock->sk;
2131         struct net *net = sock_net(sk);
2132         struct tipc_sock *tsk = tipc_sk(sk);
2133         struct sk_buff *skb;
2134         u32 dnode;
2135         int res;
2136
2137         if (how != SHUT_RDWR)
2138                 return -EINVAL;
2139
2140         lock_sock(sk);
2141
2142         switch (sock->state) {
2143         case SS_CONNECTING:
2144         case SS_CONNECTED:
2145
2146 restart:
2147                 /* Disconnect and send a 'FIN+' or 'FIN-' message to peer */
2148                 skb = __skb_dequeue(&sk->sk_receive_queue);
2149                 if (skb) {
2150                         if (TIPC_SKB_CB(skb)->handle != NULL) {
2151                                 kfree_skb(skb);
2152                                 goto restart;
2153                         }
2154                         if (tipc_msg_reverse(tsk_own_node(tsk), skb, &dnode,
2155                                              TIPC_CONN_SHUTDOWN))
2156                                 tipc_link_xmit_skb(net, skb, dnode,
2157                                                    tsk->portid);
2158                         tipc_node_remove_conn(net, dnode, tsk->portid);
2159                 } else {
2160                         dnode = tsk_peer_node(tsk);
2161
2162                         skb = tipc_msg_create(TIPC_CRITICAL_IMPORTANCE,
2163                                               TIPC_CONN_MSG, SHORT_H_SIZE,
2164                                               0, dnode, tsk_own_node(tsk),
2165                                               tsk_peer_port(tsk),
2166                                               tsk->portid, TIPC_CONN_SHUTDOWN);
2167                         tipc_link_xmit_skb(net, skb, dnode, tsk->portid);
2168                 }
2169                 tsk->connected = 0;
2170                 sock->state = SS_DISCONNECTING;
2171                 tipc_node_remove_conn(net, dnode, tsk->portid);
2172                 /* fall through */
2173
2174         case SS_DISCONNECTING:
2175
2176                 /* Discard any unreceived messages */
2177                 __skb_queue_purge(&sk->sk_receive_queue);
2178
2179                 /* Wake up anyone sleeping in poll */
2180                 sk->sk_state_change(sk);
2181                 res = 0;
2182                 break;
2183
2184         default:
2185                 res = -ENOTCONN;
2186         }
2187
2188         release_sock(sk);
2189         return res;
2190 }
2191
2192 static void tipc_sk_timeout(unsigned long data)
2193 {
2194         struct tipc_sock *tsk = (struct tipc_sock *)data;
2195         struct sock *sk = &tsk->sk;
2196         struct sk_buff *skb = NULL;
2197         u32 peer_port, peer_node;
2198         u32 own_node = tsk_own_node(tsk);
2199
2200         bh_lock_sock(sk);
2201         if (!tsk->connected) {
2202                 bh_unlock_sock(sk);
2203                 goto exit;
2204         }
2205         peer_port = tsk_peer_port(tsk);
2206         peer_node = tsk_peer_node(tsk);
2207
2208         if (tsk->probing_state == TIPC_CONN_PROBING) {
2209                 /* Previous probe not answered -> self abort */
2210                 skb = tipc_msg_create(TIPC_CRITICAL_IMPORTANCE,
2211                                       TIPC_CONN_MSG, SHORT_H_SIZE, 0,
2212                                       own_node, peer_node, tsk->portid,
2213                                       peer_port, TIPC_ERR_NO_PORT);
2214         } else {
2215                 skb = tipc_msg_create(CONN_MANAGER, CONN_PROBE,
2216                                       INT_H_SIZE, 0, peer_node, own_node,
2217                                       peer_port, tsk->portid, TIPC_OK);
2218                 tsk->probing_state = TIPC_CONN_PROBING;
2219                 sk_reset_timer(sk, &sk->sk_timer, jiffies + tsk->probing_intv);
2220         }
2221         bh_unlock_sock(sk);
2222         if (skb)
2223                 tipc_link_xmit_skb(sock_net(sk), skb, peer_node, tsk->portid);
2224 exit:
2225         sock_put(sk);
2226 }
2227
2228 static int tipc_sk_publish(struct tipc_sock *tsk, uint scope,
2229                            struct tipc_name_seq const *seq)
2230 {
2231         struct net *net = sock_net(&tsk->sk);
2232         struct publication *publ;
2233         u32 key;
2234
2235         if (tsk->connected)
2236                 return -EINVAL;
2237         key = tsk->portid + tsk->pub_count + 1;
2238         if (key == tsk->portid)
2239                 return -EADDRINUSE;
2240
2241         publ = tipc_nametbl_publish(net, seq->type, seq->lower, seq->upper,
2242                                     scope, tsk->portid, key);
2243         if (unlikely(!publ))
2244                 return -EINVAL;
2245
2246         list_add(&publ->pport_list, &tsk->publications);
2247         tsk->pub_count++;
2248         tsk->published = 1;
2249         return 0;
2250 }
2251
2252 static int tipc_sk_withdraw(struct tipc_sock *tsk, uint scope,
2253                             struct tipc_name_seq const *seq)
2254 {
2255         struct net *net = sock_net(&tsk->sk);
2256         struct publication *publ;
2257         struct publication *safe;
2258         int rc = -EINVAL;
2259
2260         list_for_each_entry_safe(publ, safe, &tsk->publications, pport_list) {
2261                 if (seq) {
2262                         if (publ->scope != scope)
2263                                 continue;
2264                         if (publ->type != seq->type)
2265                                 continue;
2266                         if (publ->lower != seq->lower)
2267                                 continue;
2268                         if (publ->upper != seq->upper)
2269                                 break;
2270                         tipc_nametbl_withdraw(net, publ->type, publ->lower,
2271                                               publ->ref, publ->key);
2272                         rc = 0;
2273                         break;
2274                 }
2275                 tipc_nametbl_withdraw(net, publ->type, publ->lower,
2276                                       publ->ref, publ->key);
2277                 rc = 0;
2278         }
2279         if (list_empty(&tsk->publications))
2280                 tsk->published = 0;
2281         return rc;
2282 }
2283
2284 static int tipc_sk_show(struct tipc_sock *tsk, char *buf,
2285                         int len, int full_id)
2286 {
2287         struct net *net = sock_net(&tsk->sk);
2288         struct tipc_net *tn = net_generic(net, tipc_net_id);
2289         struct publication *publ;
2290         int ret;
2291
2292         if (full_id)
2293                 ret = tipc_snprintf(buf, len, "<%u.%u.%u:%u>:",
2294                                     tipc_zone(tn->own_addr),
2295                                     tipc_cluster(tn->own_addr),
2296                                     tipc_node(tn->own_addr), tsk->portid);
2297         else
2298                 ret = tipc_snprintf(buf, len, "%-10u:", tsk->portid);
2299
2300         if (tsk->connected) {
2301                 u32 dport = tsk_peer_port(tsk);
2302                 u32 destnode = tsk_peer_node(tsk);
2303
2304                 ret += tipc_snprintf(buf + ret, len - ret,
2305                                      " connected to <%u.%u.%u:%u>",
2306                                      tipc_zone(destnode),
2307                                      tipc_cluster(destnode),
2308                                      tipc_node(destnode), dport);
2309                 if (tsk->conn_type != 0)
2310                         ret += tipc_snprintf(buf + ret, len - ret,
2311                                              " via {%u,%u}", tsk->conn_type,
2312                                              tsk->conn_instance);
2313         } else if (tsk->published) {
2314                 ret += tipc_snprintf(buf + ret, len - ret, " bound to");
2315                 list_for_each_entry(publ, &tsk->publications, pport_list) {
2316                         if (publ->lower == publ->upper)
2317                                 ret += tipc_snprintf(buf + ret, len - ret,
2318                                                      " {%u,%u}", publ->type,
2319                                                      publ->lower);
2320                         else
2321                                 ret += tipc_snprintf(buf + ret, len - ret,
2322                                                      " {%u,%u,%u}", publ->type,
2323                                                      publ->lower, publ->upper);
2324                 }
2325         }
2326         ret += tipc_snprintf(buf + ret, len - ret, "\n");
2327         return ret;
2328 }
2329
2330 struct sk_buff *tipc_sk_socks_show(struct net *net)
2331 {
2332         struct tipc_net *tn = net_generic(net, tipc_net_id);
2333         const struct bucket_table *tbl;
2334         struct rhash_head *pos;
2335         struct sk_buff *buf;
2336         struct tlv_desc *rep_tlv;
2337         char *pb;
2338         int pb_len;
2339         struct tipc_sock *tsk;
2340         int str_len = 0;
2341         int i;
2342
2343         buf = tipc_cfg_reply_alloc(TLV_SPACE(ULTRA_STRING_MAX_LEN));
2344         if (!buf)
2345                 return NULL;
2346         rep_tlv = (struct tlv_desc *)buf->data;
2347         pb = TLV_DATA(rep_tlv);
2348         pb_len = ULTRA_STRING_MAX_LEN;
2349
2350         rcu_read_lock();
2351         tbl = rht_dereference_rcu((&tn->sk_rht)->tbl, &tn->sk_rht);
2352         for (i = 0; i < tbl->size; i++) {
2353                 rht_for_each_entry_rcu(tsk, pos, tbl, i, node) {
2354                         spin_lock_bh(&tsk->sk.sk_lock.slock);
2355                         str_len += tipc_sk_show(tsk, pb + str_len,
2356                                                 pb_len - str_len, 0);
2357                         spin_unlock_bh(&tsk->sk.sk_lock.slock);
2358                 }
2359         }
2360         rcu_read_unlock();
2361
2362         str_len += 1;   /* for "\0" */
2363         skb_put(buf, TLV_SPACE(str_len));
2364         TLV_SET(rep_tlv, TIPC_TLV_ULTRA_STRING, NULL, str_len);
2365
2366         return buf;
2367 }
2368
2369 /* tipc_sk_reinit: set non-zero address in all existing sockets
2370  *                 when we go from standalone to network mode.
2371  */
2372 void tipc_sk_reinit(struct net *net)
2373 {
2374         struct tipc_net *tn = net_generic(net, tipc_net_id);
2375         const struct bucket_table *tbl;
2376         struct rhash_head *pos;
2377         struct tipc_sock *tsk;
2378         struct tipc_msg *msg;
2379         int i;
2380
2381         rcu_read_lock();
2382         tbl = rht_dereference_rcu((&tn->sk_rht)->tbl, &tn->sk_rht);
2383         for (i = 0; i < tbl->size; i++) {
2384                 rht_for_each_entry_rcu(tsk, pos, tbl, i, node) {
2385                         spin_lock_bh(&tsk->sk.sk_lock.slock);
2386                         msg = &tsk->phdr;
2387                         msg_set_prevnode(msg, tn->own_addr);
2388                         msg_set_orignode(msg, tn->own_addr);
2389                         spin_unlock_bh(&tsk->sk.sk_lock.slock);
2390                 }
2391         }
2392         rcu_read_unlock();
2393 }
2394
2395 static struct tipc_sock *tipc_sk_lookup(struct net *net, u32 portid)
2396 {
2397         struct tipc_net *tn = net_generic(net, tipc_net_id);
2398         struct tipc_sock *tsk;
2399
2400         rcu_read_lock();
2401         tsk = rhashtable_lookup(&tn->sk_rht, &portid);
2402         if (tsk)
2403                 sock_hold(&tsk->sk);
2404         rcu_read_unlock();
2405
2406         return tsk;
2407 }
2408
2409 static int tipc_sk_insert(struct tipc_sock *tsk)
2410 {
2411         struct sock *sk = &tsk->sk;
2412         struct net *net = sock_net(sk);
2413         struct tipc_net *tn = net_generic(net, tipc_net_id);
2414         u32 remaining = (TIPC_MAX_PORT - TIPC_MIN_PORT) + 1;
2415         u32 portid = prandom_u32() % remaining + TIPC_MIN_PORT;
2416
2417         while (remaining--) {
2418                 portid++;
2419                 if ((portid < TIPC_MIN_PORT) || (portid > TIPC_MAX_PORT))
2420                         portid = TIPC_MIN_PORT;
2421                 tsk->portid = portid;
2422                 sock_hold(&tsk->sk);
2423                 if (rhashtable_lookup_insert(&tn->sk_rht, &tsk->node))
2424                         return 0;
2425                 sock_put(&tsk->sk);
2426         }
2427
2428         return -1;
2429 }
2430
2431 static void tipc_sk_remove(struct tipc_sock *tsk)
2432 {
2433         struct sock *sk = &tsk->sk;
2434         struct tipc_net *tn = net_generic(sock_net(sk), tipc_net_id);
2435
2436         if (rhashtable_remove(&tn->sk_rht, &tsk->node)) {
2437                 WARN_ON(atomic_read(&sk->sk_refcnt) == 1);
2438                 __sock_put(sk);
2439         }
2440 }
2441
2442 int tipc_sk_rht_init(struct net *net)
2443 {
2444         struct tipc_net *tn = net_generic(net, tipc_net_id);
2445         struct rhashtable_params rht_params = {
2446                 .nelem_hint = 192,
2447                 .head_offset = offsetof(struct tipc_sock, node),
2448                 .key_offset = offsetof(struct tipc_sock, portid),
2449                 .key_len = sizeof(u32), /* portid */
2450                 .hashfn = jhash,
2451                 .max_shift = 20, /* 1M */
2452                 .min_shift = 8,  /* 256 */
2453                 .grow_decision = rht_grow_above_75,
2454                 .shrink_decision = rht_shrink_below_30,
2455         };
2456
2457         return rhashtable_init(&tn->sk_rht, &rht_params);
2458 }
2459
2460 void tipc_sk_rht_destroy(struct net *net)
2461 {
2462         struct tipc_net *tn = net_generic(net, tipc_net_id);
2463
2464         /* Wait for socket readers to complete */
2465         synchronize_net();
2466
2467         rhashtable_destroy(&tn->sk_rht);
2468 }
2469
2470 /**
2471  * tipc_setsockopt - set socket option
2472  * @sock: socket structure
2473  * @lvl: option level
2474  * @opt: option identifier
2475  * @ov: pointer to new option value
2476  * @ol: length of option value
2477  *
2478  * For stream sockets only, accepts and ignores all IPPROTO_TCP options
2479  * (to ease compatibility).
2480  *
2481  * Returns 0 on success, errno otherwise
2482  */
2483 static int tipc_setsockopt(struct socket *sock, int lvl, int opt,
2484                            char __user *ov, unsigned int ol)
2485 {
2486         struct sock *sk = sock->sk;
2487         struct tipc_sock *tsk = tipc_sk(sk);
2488         u32 value;
2489         int res;
2490
2491         if ((lvl == IPPROTO_TCP) && (sock->type == SOCK_STREAM))
2492                 return 0;
2493         if (lvl != SOL_TIPC)
2494                 return -ENOPROTOOPT;
2495         if (ol < sizeof(value))
2496                 return -EINVAL;
2497         res = get_user(value, (u32 __user *)ov);
2498         if (res)
2499                 return res;
2500
2501         lock_sock(sk);
2502
2503         switch (opt) {
2504         case TIPC_IMPORTANCE:
2505                 res = tsk_set_importance(tsk, value);
2506                 break;
2507         case TIPC_SRC_DROPPABLE:
2508                 if (sock->type != SOCK_STREAM)
2509                         tsk_set_unreliable(tsk, value);
2510                 else
2511                         res = -ENOPROTOOPT;
2512                 break;
2513         case TIPC_DEST_DROPPABLE:
2514                 tsk_set_unreturnable(tsk, value);
2515                 break;
2516         case TIPC_CONN_TIMEOUT:
2517                 tipc_sk(sk)->conn_timeout = value;
2518                 /* no need to set "res", since already 0 at this point */
2519                 break;
2520         default:
2521                 res = -EINVAL;
2522         }
2523
2524         release_sock(sk);
2525
2526         return res;
2527 }
2528
2529 /**
2530  * tipc_getsockopt - get socket option
2531  * @sock: socket structure
2532  * @lvl: option level
2533  * @opt: option identifier
2534  * @ov: receptacle for option value
2535  * @ol: receptacle for length of option value
2536  *
2537  * For stream sockets only, returns 0 length result for all IPPROTO_TCP options
2538  * (to ease compatibility).
2539  *
2540  * Returns 0 on success, errno otherwise
2541  */
2542 static int tipc_getsockopt(struct socket *sock, int lvl, int opt,
2543                            char __user *ov, int __user *ol)
2544 {
2545         struct sock *sk = sock->sk;
2546         struct tipc_sock *tsk = tipc_sk(sk);
2547         int len;
2548         u32 value;
2549         int res;
2550
2551         if ((lvl == IPPROTO_TCP) && (sock->type == SOCK_STREAM))
2552                 return put_user(0, ol);
2553         if (lvl != SOL_TIPC)
2554                 return -ENOPROTOOPT;
2555         res = get_user(len, ol);
2556         if (res)
2557                 return res;
2558
2559         lock_sock(sk);
2560
2561         switch (opt) {
2562         case TIPC_IMPORTANCE:
2563                 value = tsk_importance(tsk);
2564                 break;
2565         case TIPC_SRC_DROPPABLE:
2566                 value = tsk_unreliable(tsk);
2567                 break;
2568         case TIPC_DEST_DROPPABLE:
2569                 value = tsk_unreturnable(tsk);
2570                 break;
2571         case TIPC_CONN_TIMEOUT:
2572                 value = tsk->conn_timeout;
2573                 /* no need to set "res", since already 0 at this point */
2574                 break;
2575         case TIPC_NODE_RECVQ_DEPTH:
2576                 value = 0; /* was tipc_queue_size, now obsolete */
2577                 break;
2578         case TIPC_SOCK_RECVQ_DEPTH:
2579                 value = skb_queue_len(&sk->sk_receive_queue);
2580                 break;
2581         default:
2582                 res = -EINVAL;
2583         }
2584
2585         release_sock(sk);
2586
2587         if (res)
2588                 return res;     /* "get" failed */
2589
2590         if (len < sizeof(value))
2591                 return -EINVAL;
2592
2593         if (copy_to_user(ov, &value, sizeof(value)))
2594                 return -EFAULT;
2595
2596         return put_user(sizeof(value), ol);
2597 }
2598
2599 static int tipc_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
2600 {
2601         struct sock *sk = sock->sk;
2602         struct tipc_sioc_ln_req lnr;
2603         void __user *argp = (void __user *)arg;
2604
2605         switch (cmd) {
2606         case SIOCGETLINKNAME:
2607                 if (copy_from_user(&lnr, argp, sizeof(lnr)))
2608                         return -EFAULT;
2609                 if (!tipc_node_get_linkname(sock_net(sk),
2610                                             lnr.bearer_id & 0xffff, lnr.peer,
2611                                             lnr.linkname, TIPC_MAX_LINK_NAME)) {
2612                         if (copy_to_user(argp, &lnr, sizeof(lnr)))
2613                                 return -EFAULT;
2614                         return 0;
2615                 }
2616                 return -EADDRNOTAVAIL;
2617         default:
2618                 return -ENOIOCTLCMD;
2619         }
2620 }
2621
2622 /* Protocol switches for the various types of TIPC sockets */
2623
2624 static const struct proto_ops msg_ops = {
2625         .owner          = THIS_MODULE,
2626         .family         = AF_TIPC,
2627         .release        = tipc_release,
2628         .bind           = tipc_bind,
2629         .connect        = tipc_connect,
2630         .socketpair     = sock_no_socketpair,
2631         .accept         = sock_no_accept,
2632         .getname        = tipc_getname,
2633         .poll           = tipc_poll,
2634         .ioctl          = tipc_ioctl,
2635         .listen         = sock_no_listen,
2636         .shutdown       = tipc_shutdown,
2637         .setsockopt     = tipc_setsockopt,
2638         .getsockopt     = tipc_getsockopt,
2639         .sendmsg        = tipc_sendmsg,
2640         .recvmsg        = tipc_recvmsg,
2641         .mmap           = sock_no_mmap,
2642         .sendpage       = sock_no_sendpage
2643 };
2644
2645 static const struct proto_ops packet_ops = {
2646         .owner          = THIS_MODULE,
2647         .family         = AF_TIPC,
2648         .release        = tipc_release,
2649         .bind           = tipc_bind,
2650         .connect        = tipc_connect,
2651         .socketpair     = sock_no_socketpair,
2652         .accept         = tipc_accept,
2653         .getname        = tipc_getname,
2654         .poll           = tipc_poll,
2655         .ioctl          = tipc_ioctl,
2656         .listen         = tipc_listen,
2657         .shutdown       = tipc_shutdown,
2658         .setsockopt     = tipc_setsockopt,
2659         .getsockopt     = tipc_getsockopt,
2660         .sendmsg        = tipc_send_packet,
2661         .recvmsg        = tipc_recvmsg,
2662         .mmap           = sock_no_mmap,
2663         .sendpage       = sock_no_sendpage
2664 };
2665
2666 static const struct proto_ops stream_ops = {
2667         .owner          = THIS_MODULE,
2668         .family         = AF_TIPC,
2669         .release        = tipc_release,
2670         .bind           = tipc_bind,
2671         .connect        = tipc_connect,
2672         .socketpair     = sock_no_socketpair,
2673         .accept         = tipc_accept,
2674         .getname        = tipc_getname,
2675         .poll           = tipc_poll,
2676         .ioctl          = tipc_ioctl,
2677         .listen         = tipc_listen,
2678         .shutdown       = tipc_shutdown,
2679         .setsockopt     = tipc_setsockopt,
2680         .getsockopt     = tipc_getsockopt,
2681         .sendmsg        = tipc_send_stream,
2682         .recvmsg        = tipc_recv_stream,
2683         .mmap           = sock_no_mmap,
2684         .sendpage       = sock_no_sendpage
2685 };
2686
2687 static const struct net_proto_family tipc_family_ops = {
2688         .owner          = THIS_MODULE,
2689         .family         = AF_TIPC,
2690         .create         = tipc_sk_create
2691 };
2692
2693 static struct proto tipc_proto = {
2694         .name           = "TIPC",
2695         .owner          = THIS_MODULE,
2696         .obj_size       = sizeof(struct tipc_sock),
2697         .sysctl_rmem    = sysctl_tipc_rmem
2698 };
2699
2700 static struct proto tipc_proto_kern = {
2701         .name           = "TIPC",
2702         .obj_size       = sizeof(struct tipc_sock),
2703         .sysctl_rmem    = sysctl_tipc_rmem
2704 };
2705
2706 /**
2707  * tipc_socket_init - initialize TIPC socket interface
2708  *
2709  * Returns 0 on success, errno otherwise
2710  */
2711 int tipc_socket_init(void)
2712 {
2713         int res;
2714
2715         res = proto_register(&tipc_proto, 1);
2716         if (res) {
2717                 pr_err("Failed to register TIPC protocol type\n");
2718                 goto out;
2719         }
2720
2721         res = sock_register(&tipc_family_ops);
2722         if (res) {
2723                 pr_err("Failed to register TIPC socket type\n");
2724                 proto_unregister(&tipc_proto);
2725                 goto out;
2726         }
2727  out:
2728         return res;
2729 }
2730
2731 /**
2732  * tipc_socket_stop - stop TIPC socket interface
2733  */
2734 void tipc_socket_stop(void)
2735 {
2736         sock_unregister(tipc_family_ops.family);
2737         proto_unregister(&tipc_proto);
2738 }
2739
2740 /* Caller should hold socket lock for the passed tipc socket. */
2741 static int __tipc_nl_add_sk_con(struct sk_buff *skb, struct tipc_sock *tsk)
2742 {
2743         u32 peer_node;
2744         u32 peer_port;
2745         struct nlattr *nest;
2746
2747         peer_node = tsk_peer_node(tsk);
2748         peer_port = tsk_peer_port(tsk);
2749
2750         nest = nla_nest_start(skb, TIPC_NLA_SOCK_CON);
2751
2752         if (nla_put_u32(skb, TIPC_NLA_CON_NODE, peer_node))
2753                 goto msg_full;
2754         if (nla_put_u32(skb, TIPC_NLA_CON_SOCK, peer_port))
2755                 goto msg_full;
2756
2757         if (tsk->conn_type != 0) {
2758                 if (nla_put_flag(skb, TIPC_NLA_CON_FLAG))
2759                         goto msg_full;
2760                 if (nla_put_u32(skb, TIPC_NLA_CON_TYPE, tsk->conn_type))
2761                         goto msg_full;
2762                 if (nla_put_u32(skb, TIPC_NLA_CON_INST, tsk->conn_instance))
2763                         goto msg_full;
2764         }
2765         nla_nest_end(skb, nest);
2766
2767         return 0;
2768
2769 msg_full:
2770         nla_nest_cancel(skb, nest);
2771
2772         return -EMSGSIZE;
2773 }
2774
2775 /* Caller should hold socket lock for the passed tipc socket. */
2776 static int __tipc_nl_add_sk(struct sk_buff *skb, struct netlink_callback *cb,
2777                             struct tipc_sock *tsk)
2778 {
2779         int err;
2780         void *hdr;
2781         struct nlattr *attrs;
2782         struct net *net = sock_net(skb->sk);
2783         struct tipc_net *tn = net_generic(net, tipc_net_id);
2784
2785         hdr = genlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq,
2786                           &tipc_genl_family, NLM_F_MULTI, TIPC_NL_SOCK_GET);
2787         if (!hdr)
2788                 goto msg_cancel;
2789
2790         attrs = nla_nest_start(skb, TIPC_NLA_SOCK);
2791         if (!attrs)
2792                 goto genlmsg_cancel;
2793         if (nla_put_u32(skb, TIPC_NLA_SOCK_REF, tsk->portid))
2794                 goto attr_msg_cancel;
2795         if (nla_put_u32(skb, TIPC_NLA_SOCK_ADDR, tn->own_addr))
2796                 goto attr_msg_cancel;
2797
2798         if (tsk->connected) {
2799                 err = __tipc_nl_add_sk_con(skb, tsk);
2800                 if (err)
2801                         goto attr_msg_cancel;
2802         } else if (!list_empty(&tsk->publications)) {
2803                 if (nla_put_flag(skb, TIPC_NLA_SOCK_HAS_PUBL))
2804                         goto attr_msg_cancel;
2805         }
2806         nla_nest_end(skb, attrs);
2807         genlmsg_end(skb, hdr);
2808
2809         return 0;
2810
2811 attr_msg_cancel:
2812         nla_nest_cancel(skb, attrs);
2813 genlmsg_cancel:
2814         genlmsg_cancel(skb, hdr);
2815 msg_cancel:
2816         return -EMSGSIZE;
2817 }
2818
2819 int tipc_nl_sk_dump(struct sk_buff *skb, struct netlink_callback *cb)
2820 {
2821         int err;
2822         struct tipc_sock *tsk;
2823         const struct bucket_table *tbl;
2824         struct rhash_head *pos;
2825         struct net *net = sock_net(skb->sk);
2826         struct tipc_net *tn = net_generic(net, tipc_net_id);
2827         u32 tbl_id = cb->args[0];
2828         u32 prev_portid = cb->args[1];
2829
2830         rcu_read_lock();
2831         tbl = rht_dereference_rcu((&tn->sk_rht)->tbl, &tn->sk_rht);
2832         for (; tbl_id < tbl->size; tbl_id++) {
2833                 rht_for_each_entry_rcu(tsk, pos, tbl, tbl_id, node) {
2834                         spin_lock_bh(&tsk->sk.sk_lock.slock);
2835                         if (prev_portid && prev_portid != tsk->portid) {
2836                                 spin_unlock_bh(&tsk->sk.sk_lock.slock);
2837                                 continue;
2838                         }
2839
2840                         err = __tipc_nl_add_sk(skb, cb, tsk);
2841                         if (err) {
2842                                 prev_portid = tsk->portid;
2843                                 spin_unlock_bh(&tsk->sk.sk_lock.slock);
2844                                 goto out;
2845                         }
2846                         prev_portid = 0;
2847                         spin_unlock_bh(&tsk->sk.sk_lock.slock);
2848                 }
2849         }
2850 out:
2851         rcu_read_unlock();
2852         cb->args[0] = tbl_id;
2853         cb->args[1] = prev_portid;
2854
2855         return skb->len;
2856 }
2857
2858 /* Caller should hold socket lock for the passed tipc socket. */
2859 static int __tipc_nl_add_sk_publ(struct sk_buff *skb,
2860                                  struct netlink_callback *cb,
2861                                  struct publication *publ)
2862 {
2863         void *hdr;
2864         struct nlattr *attrs;
2865
2866         hdr = genlmsg_put(skb, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq,
2867                           &tipc_genl_family, NLM_F_MULTI, TIPC_NL_PUBL_GET);
2868         if (!hdr)
2869                 goto msg_cancel;
2870
2871         attrs = nla_nest_start(skb, TIPC_NLA_PUBL);
2872         if (!attrs)
2873                 goto genlmsg_cancel;
2874
2875         if (nla_put_u32(skb, TIPC_NLA_PUBL_KEY, publ->key))
2876                 goto attr_msg_cancel;
2877         if (nla_put_u32(skb, TIPC_NLA_PUBL_TYPE, publ->type))
2878                 goto attr_msg_cancel;
2879         if (nla_put_u32(skb, TIPC_NLA_PUBL_LOWER, publ->lower))
2880                 goto attr_msg_cancel;
2881         if (nla_put_u32(skb, TIPC_NLA_PUBL_UPPER, publ->upper))
2882                 goto attr_msg_cancel;
2883
2884         nla_nest_end(skb, attrs);
2885         genlmsg_end(skb, hdr);
2886
2887         return 0;
2888
2889 attr_msg_cancel:
2890         nla_nest_cancel(skb, attrs);
2891 genlmsg_cancel:
2892         genlmsg_cancel(skb, hdr);
2893 msg_cancel:
2894         return -EMSGSIZE;
2895 }
2896
2897 /* Caller should hold socket lock for the passed tipc socket. */
2898 static int __tipc_nl_list_sk_publ(struct sk_buff *skb,
2899                                   struct netlink_callback *cb,
2900                                   struct tipc_sock *tsk, u32 *last_publ)
2901 {
2902         int err;
2903         struct publication *p;
2904
2905         if (*last_publ) {
2906                 list_for_each_entry(p, &tsk->publications, pport_list) {
2907                         if (p->key == *last_publ)
2908                                 break;
2909                 }
2910                 if (p->key != *last_publ) {
2911                         /* We never set seq or call nl_dump_check_consistent()
2912                          * this means that setting prev_seq here will cause the
2913                          * consistence check to fail in the netlink callback
2914                          * handler. Resulting in the last NLMSG_DONE message
2915                          * having the NLM_F_DUMP_INTR flag set.
2916                          */
2917                         cb->prev_seq = 1;
2918                         *last_publ = 0;
2919                         return -EPIPE;
2920                 }
2921         } else {
2922                 p = list_first_entry(&tsk->publications, struct publication,
2923                                      pport_list);
2924         }
2925
2926         list_for_each_entry_from(p, &tsk->publications, pport_list) {
2927                 err = __tipc_nl_add_sk_publ(skb, cb, p);
2928                 if (err) {
2929                         *last_publ = p->key;
2930                         return err;
2931                 }
2932         }
2933         *last_publ = 0;
2934
2935         return 0;
2936 }
2937
2938 int tipc_nl_publ_dump(struct sk_buff *skb, struct netlink_callback *cb)
2939 {
2940         int err;
2941         u32 tsk_portid = cb->args[0];
2942         u32 last_publ = cb->args[1];
2943         u32 done = cb->args[2];
2944         struct net *net = sock_net(skb->sk);
2945         struct tipc_sock *tsk;
2946
2947         if (!tsk_portid) {
2948                 struct nlattr **attrs;
2949                 struct nlattr *sock[TIPC_NLA_SOCK_MAX + 1];
2950
2951                 err = tipc_nlmsg_parse(cb->nlh, &attrs);
2952                 if (err)
2953                         return err;
2954
2955                 err = nla_parse_nested(sock, TIPC_NLA_SOCK_MAX,
2956                                        attrs[TIPC_NLA_SOCK],
2957                                        tipc_nl_sock_policy);
2958                 if (err)
2959                         return err;
2960
2961                 if (!sock[TIPC_NLA_SOCK_REF])
2962                         return -EINVAL;
2963
2964                 tsk_portid = nla_get_u32(sock[TIPC_NLA_SOCK_REF]);
2965         }
2966
2967         if (done)
2968                 return 0;
2969
2970         tsk = tipc_sk_lookup(net, tsk_portid);
2971         if (!tsk)
2972                 return -EINVAL;
2973
2974         lock_sock(&tsk->sk);
2975         err = __tipc_nl_list_sk_publ(skb, cb, tsk, &last_publ);
2976         if (!err)
2977                 done = 1;
2978         release_sock(&tsk->sk);
2979         sock_put(&tsk->sk);
2980
2981         cb->args[0] = tsk_portid;
2982         cb->args[1] = last_publ;
2983         cb->args[2] = done;
2984
2985         return skb->len;
2986 }