net/tipc/node.c

   1 /*
   2  * net/tipc/node.c: TIPC node management routines
   3  *
   4  * Copyright (c) 2000-2006, 2012-2015, Ericsson AB
   5  * Copyright (c) 2005-2006, 2010-2014, 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 "core.h"
  38 #include "link.h"
  39 #include "node.h"
  40 #include "name_distr.h"
  41 #include "socket.h"
  42 #include "bcast.h"
  43 #include "discover.h"
  44
  45 static void node_lost_contact(struct tipc_node *n_ptr);
  46 static void node_established_contact(struct tipc_node *n_ptr);
  47 static void tipc_node_delete(struct tipc_node *node);
  48 static void tipc_node_timeout(unsigned long data);
  49 static void tipc_node_fsm_evt(struct tipc_node *n, int evt);
  50
  51 struct tipc_sock_conn {
  52         u32 port;
  53         u32 peer_port;
  54         u32 peer_node;
  55         struct list_head list;
  56 };
  57
  58 static const struct nla_policy tipc_nl_node_policy[TIPC_NLA_NODE_MAX + 1] = {
  59         [TIPC_NLA_NODE_UNSPEC]          = { .type = NLA_UNSPEC },
  60         [TIPC_NLA_NODE_ADDR]            = { .type = NLA_U32 },
  61         [TIPC_NLA_NODE_UP]              = { .type = NLA_FLAG }
  62 };
  63
  64 /*
  65  * A trivial power-of-two bitmask technique is used for speed, since this
  66  * operation is done for every incoming TIPC packet. The number of hash table
  67  * entries has been chosen so that no hash chain exceeds 8 nodes and will
  68  * usually be much smaller (typically only a single node).
  69  */
  70 static unsigned int tipc_hashfn(u32 addr)
  71 {
  72         return addr & (NODE_HTABLE_SIZE - 1);
  73 }
  74
  75 static void tipc_node_kref_release(struct kref *kref)
  76 {
  77         struct tipc_node *node = container_of(kref, struct tipc_node, kref);
  78
  79         tipc_node_delete(node);
  80 }
  81
  82 void tipc_node_put(struct tipc_node *node)
  83 {
  84         kref_put(&node->kref, tipc_node_kref_release);
  85 }
  86
  87 static void tipc_node_get(struct tipc_node *node)
  88 {
  89         kref_get(&node->kref);
  90 }
  91
  92 /*
  93  * tipc_node_find - locate specified node object, if it exists
  94  */
  95 struct tipc_node *tipc_node_find(struct net *net, u32 addr)
  96 {
  97         struct tipc_net *tn = net_generic(net, tipc_net_id);
  98         struct tipc_node *node;
  99
 100         if (unlikely(!in_own_cluster_exact(net, addr)))
 101                 return NULL;
 102
 103         rcu_read_lock();
 104         hlist_for_each_entry_rcu(node, &tn->node_htable[tipc_hashfn(addr)],
 105                                  hash) {
 106                 if (node->addr == addr) {
 107                         tipc_node_get(node);
 108                         rcu_read_unlock();
 109                         return node;
 110                 }
 111         }
 112         rcu_read_unlock();
 113         return NULL;
 114 }
 115
 116 struct tipc_node *tipc_node_create(struct net *net, u32 addr)
 117 {
 118         struct tipc_net *tn = net_generic(net, tipc_net_id);
 119         struct tipc_node *n_ptr, *temp_node;
 120
 121         spin_lock_bh(&tn->node_list_lock);
 122         n_ptr = tipc_node_find(net, addr);
 123         if (n_ptr)
 124                 goto exit;
 125         n_ptr = kzalloc(sizeof(*n_ptr), GFP_ATOMIC);
 126         if (!n_ptr) {
 127                 pr_warn("Node creation failed, no memory\n");
 128                 goto exit;
 129         }
 130         n_ptr->addr = addr;
 131         n_ptr->net = net;
 132         kref_init(&n_ptr->kref);
 133         spin_lock_init(&n_ptr->lock);
 134         INIT_HLIST_NODE(&n_ptr->hash);
 135         INIT_LIST_HEAD(&n_ptr->list);
 136         INIT_LIST_HEAD(&n_ptr->publ_list);
 137         INIT_LIST_HEAD(&n_ptr->conn_sks);
 138         skb_queue_head_init(&n_ptr->bclink.namedq);
 139         __skb_queue_head_init(&n_ptr->bclink.deferdq);
 140         hlist_add_head_rcu(&n_ptr->hash, &tn->node_htable[tipc_hashfn(addr)]);
 141         list_for_each_entry_rcu(temp_node, &tn->node_list, list) {
 142                 if (n_ptr->addr < temp_node->addr)
 143                         break;
 144         }
 145         list_add_tail_rcu(&n_ptr->list, &temp_node->list);
 146         n_ptr->state = SELF_DOWN_PEER_LEAVING;
 147         n_ptr->signature = INVALID_NODE_SIG;
 148         n_ptr->active_links[0] = INVALID_BEARER_ID;
 149         n_ptr->active_links[1] = INVALID_BEARER_ID;
 150         tipc_node_get(n_ptr);
 151         setup_timer(&n_ptr->timer, tipc_node_timeout, (unsigned long)n_ptr);
 152         n_ptr->keepalive_intv = U32_MAX;
 153 exit:
 154         spin_unlock_bh(&tn->node_list_lock);
 155         return n_ptr;
 156 }
 157
 158 static void tipc_node_calculate_timer(struct tipc_node *n, struct tipc_link *l)
 159 {
 160         unsigned long tol = l->tolerance;
 161         unsigned long intv = ((tol / 4) > 500) ? 500 : tol / 4;
 162         unsigned long keepalive_intv = msecs_to_jiffies(intv);
 163
 164         /* Link with lowest tolerance determines timer interval */
 165         if (keepalive_intv < n->keepalive_intv)
 166                 n->keepalive_intv = keepalive_intv;
 167
 168         /* Ensure link's abort limit corresponds to current interval */
 169         l->abort_limit = l->tolerance / jiffies_to_msecs(n->keepalive_intv);
 170 }
 171
 172 static void tipc_node_delete(struct tipc_node *node)
 173 {
 174         list_del_rcu(&node->list);
 175         hlist_del_rcu(&node->hash);
 176         kfree_rcu(node, rcu);
 177 }
 178
 179 void tipc_node_stop(struct net *net)
 180 {
 181         struct tipc_net *tn = net_generic(net, tipc_net_id);
 182         struct tipc_node *node, *t_node;
 183
 184         spin_lock_bh(&tn->node_list_lock);
 185         list_for_each_entry_safe(node, t_node, &tn->node_list, list) {
 186                 if (del_timer(&node->timer))
 187                         tipc_node_put(node);
 188                 tipc_node_put(node);
 189         }
 190         spin_unlock_bh(&tn->node_list_lock);
 191 }
 192
 193 int tipc_node_add_conn(struct net *net, u32 dnode, u32 port, u32 peer_port)
 194 {
 195         struct tipc_node *node;
 196         struct tipc_sock_conn *conn;
 197         int err = 0;
 198
 199         if (in_own_node(net, dnode))
 200                 return 0;
 201
 202         node = tipc_node_find(net, dnode);
 203         if (!node) {
 204                 pr_warn("Connecting sock to node 0x%x failed\n", dnode);
 205                 return -EHOSTUNREACH;
 206         }
 207         conn = kmalloc(sizeof(*conn), GFP_ATOMIC);
 208         if (!conn) {
 209                 err = -EHOSTUNREACH;
 210                 goto exit;
 211         }
 212         conn->peer_node = dnode;
 213         conn->port = port;
 214         conn->peer_port = peer_port;
 215
 216         tipc_node_lock(node);
 217         list_add_tail(&conn->list, &node->conn_sks);
 218         tipc_node_unlock(node);
 219 exit:
 220         tipc_node_put(node);
 221         return err;
 222 }
 223
 224 void tipc_node_remove_conn(struct net *net, u32 dnode, u32 port)
 225 {
 226         struct tipc_node *node;
 227         struct tipc_sock_conn *conn, *safe;
 228
 229         if (in_own_node(net, dnode))
 230                 return;
 231
 232         node = tipc_node_find(net, dnode);
 233         if (!node)
 234                 return;
 235
 236         tipc_node_lock(node);
 237         list_for_each_entry_safe(conn, safe, &node->conn_sks, list) {
 238                 if (port != conn->port)
 239                         continue;
 240                 list_del(&conn->list);
 241                 kfree(conn);
 242         }
 243         tipc_node_unlock(node);
 244         tipc_node_put(node);
 245 }
 246
 247 /* tipc_node_timeout - handle expiration of node timer
 248  */
 249 static void tipc_node_timeout(unsigned long data)
 250 {
 251         struct tipc_node *n = (struct tipc_node *)data;
 252         struct sk_buff_head xmitq;
 253         struct tipc_link *l;
 254         struct tipc_media_addr *maddr;
 255         int bearer_id;
 256         int rc = 0;
 257
 258         __skb_queue_head_init(&xmitq);
 259
 260         for (bearer_id = 0; bearer_id < MAX_BEARERS; bearer_id++) {
 261                 tipc_node_lock(n);
 262                 l = n->links[bearer_id].link;
 263                 if (l) {
 264                         /* Link tolerance may change asynchronously: */
 265                         tipc_node_calculate_timer(n, l);
 266                         rc = tipc_link_timeout(l, &xmitq);
 267                         if (rc & TIPC_LINK_DOWN_EVT)
 268                                 tipc_link_reset(l);
 269                 }
 270                 tipc_node_unlock(n);
 271                 maddr = &n->links[bearer_id].maddr;
 272                 tipc_bearer_xmit(n->net, bearer_id, &xmitq, maddr);
 273         }
 274         if (!mod_timer(&n->timer, jiffies + n->keepalive_intv))
 275                 tipc_node_get(n);
 276         tipc_node_put(n);
 277 }
 278
 279 /**
 280  * tipc_node_link_up - handle addition of link
 281  *
 282  * Link becomes active (alone or shared) or standby, depending on its priority.
 283  */
 284 void tipc_node_link_up(struct tipc_node *n, int bearer_id)
 285 {
 286         int *slot0 = &n->active_links[0];
 287         int *slot1 = &n->active_links[1];
 288         struct tipc_link_entry *links = n->links;
 289         struct tipc_link *l = n->links[bearer_id].link;
 290
 291         /* Leave room for tunnel header when returning 'mtu' to users: */
 292         links[bearer_id].mtu = l->mtu - INT_H_SIZE;
 293
 294         n->working_links++;
 295         n->action_flags |= TIPC_NOTIFY_LINK_UP;
 296         n->link_id = l->peer_bearer_id << 16 | l->bearer_id;
 297
 298         pr_debug("Established link <%s> on network plane %c\n",
 299                  l->name, l->net_plane);
 300
 301         /* No active links ? => take both active slots */
 302         if (*slot0 < 0) {
 303                 *slot0 = bearer_id;
 304                 *slot1 = bearer_id;
 305                 node_established_contact(n);
 306                 return;
 307         }
 308
 309         /* Lower prio than current active ? => no slot */
 310         if (l->priority < links[*slot0].link->priority) {
 311                 pr_debug("New link <%s> becomes standby\n", l->name);
 312                 return;
 313         }
 314         tipc_link_dup_queue_xmit(links[*slot0].link, l);
 315
 316         /* Same prio as current active ? => take one slot */
 317         if (l->priority == links[*slot0].link->priority) {
 318                 *slot0 = bearer_id;
 319                 return;
 320         }
 321
 322         /* Higher prio than current active => take both active slots */
 323         pr_debug("Old link <%s> now standby\n", links[*slot0].link->name);
 324         *slot0 = bearer_id;
 325         *slot1 = bearer_id;
 326 }
 327
 328 /**
 329  * tipc_node_link_down - handle loss of link
 330  */
 331 void tipc_node_link_down(struct tipc_node *n, int bearer_id)
 332 {
 333         int *slot0 = &n->active_links[0];
 334         int *slot1 = &n->active_links[1];
 335         int i, highest = 0;
 336         struct tipc_link *l, *_l;
 337
 338         l = n->links[bearer_id].link;
 339         n->working_links--;
 340         n->action_flags |= TIPC_NOTIFY_LINK_DOWN;
 341         n->link_id = l->peer_bearer_id << 16 | l->bearer_id;
 342
 343         pr_debug("Lost link <%s> on network plane %c\n",
 344                  l->name, l->net_plane);
 345
 346         /* Select new active link if any available */
 347         *slot0 = INVALID_BEARER_ID;
 348         *slot1 = INVALID_BEARER_ID;
 349         for (i = 0; i < MAX_BEARERS; i++) {
 350                 _l = n->links[i].link;
 351                 if (!_l || !tipc_link_is_up(_l))
 352                         continue;
 353                 if (_l->priority < highest)
 354                         continue;
 355                 if (_l->priority > highest) {
 356                         highest = _l->priority;
 357                         *slot0 = i;
 358                         *slot1 = i;
 359                         continue;
 360                 }
 361                 *slot1 = i;
 362         }
 363         if (tipc_node_is_up(n))
 364                 tipc_link_failover_send_queue(l);
 365         else
 366                 node_lost_contact(n);
 367 }
 368
 369 bool tipc_node_is_up(struct tipc_node *n)
 370 {
 371         return n->active_links[0] != INVALID_BEARER_ID;
 372 }
 373
 374 void tipc_node_check_dest(struct tipc_node *n, struct tipc_bearer *b,
 375                           bool *link_up, bool *addr_match,
 376                           struct tipc_media_addr *maddr)
 377 {
 378         struct tipc_link *l = n->links[b->identity].link;
 379         struct tipc_media_addr *curr = &n->links[b->identity].maddr;
 380
 381         *link_up = l && tipc_link_is_up(l);
 382         *addr_match = l && !memcmp(curr, maddr, sizeof(*maddr));
 383 }
 384
 385 bool tipc_node_update_dest(struct tipc_node *n,  struct tipc_bearer *b,
 386                            struct tipc_media_addr *maddr)
 387 {
 388         struct tipc_link *l = n->links[b->identity].link;
 389         struct tipc_media_addr *curr = &n->links[b->identity].maddr;
 390         struct sk_buff_head *inputq = &n->links[b->identity].inputq;
 391
 392         if (!l) {
 393                 l = tipc_link_create(n, b, maddr, inputq, &n->bclink.namedq);
 394                 if (!l)
 395                         return false;
 396                 tipc_node_calculate_timer(n, l);
 397                 if (n->link_cnt == 1) {
 398                         if (!mod_timer(&n->timer, jiffies + n->keepalive_intv))
 399                                 tipc_node_get(n);
 400                 }
 401         }
 402         memcpy(&l->media_addr, maddr, sizeof(*maddr));
 403         memcpy(curr, maddr, sizeof(*maddr));
 404         tipc_link_reset(l);
 405         return true;
 406 }
 407
 408 void tipc_node_attach_link(struct tipc_node *n_ptr, struct tipc_link *l_ptr)
 409 {
 410         n_ptr->links[l_ptr->bearer_id].link = l_ptr;
 411         n_ptr->link_cnt++;
 412 }
 413
 414 void tipc_node_detach_link(struct tipc_node *n_ptr, struct tipc_link *l_ptr)
 415 {
 416         int i;
 417
 418         for (i = 0; i < MAX_BEARERS; i++) {
 419                 if (l_ptr != n_ptr->links[i].link)
 420                         continue;
 421                 n_ptr->links[i].link = NULL;
 422                 n_ptr->link_cnt--;
 423         }
 424 }
 425
 426 /* tipc_node_fsm_evt - node finite state machine
 427  * Determines when contact is allowed with peer node
 428  */
 429 static void tipc_node_fsm_evt(struct tipc_node *n, int evt)
 430 {
 431         int state = n->state;
 432
 433         switch (state) {
 434         case SELF_DOWN_PEER_DOWN:
 435                 switch (evt) {
 436                 case SELF_ESTABL_CONTACT_EVT:
 437                         state = SELF_UP_PEER_COMING;
 438                         break;
 439                 case PEER_ESTABL_CONTACT_EVT:
 440                         state = SELF_COMING_PEER_UP;
 441                         break;
 442                 case SELF_LOST_CONTACT_EVT:
 443                 case PEER_LOST_CONTACT_EVT:
 444                         break;
 445                 default:
 446                         pr_err("Unknown node fsm evt %x/%x\n", state, evt);
 447                 }
 448                 break;
 449         case SELF_UP_PEER_UP:
 450                 switch (evt) {
 451                 case SELF_LOST_CONTACT_EVT:
 452                         state = SELF_DOWN_PEER_LEAVING;
 453                         break;
 454                 case PEER_LOST_CONTACT_EVT:
 455                         state = SELF_LEAVING_PEER_DOWN;
 456                         break;
 457                 case SELF_ESTABL_CONTACT_EVT:
 458                 case PEER_ESTABL_CONTACT_EVT:
 459                         break;
 460                 default:
 461                         pr_err("Unknown node fsm evt %x/%x\n", state, evt);
 462                 }
 463                 break;
 464         case SELF_DOWN_PEER_LEAVING:
 465                 switch (evt) {
 466                 case PEER_LOST_CONTACT_EVT:
 467                         state = SELF_DOWN_PEER_DOWN;
 468                         break;
 469                 case SELF_ESTABL_CONTACT_EVT:
 470                 case PEER_ESTABL_CONTACT_EVT:
 471                 case SELF_LOST_CONTACT_EVT:
 472                         break;
 473                 default:
 474                         pr_err("Unknown node fsm evt %x/%x\n", state, evt);
 475                 }
 476                 break;
 477         case SELF_UP_PEER_COMING:
 478                 switch (evt) {
 479                 case PEER_ESTABL_CONTACT_EVT:
 480                         state = SELF_UP_PEER_UP;
 481                         break;
 482                 case SELF_LOST_CONTACT_EVT:
 483                         state = SELF_DOWN_PEER_LEAVING;
 484                         break;
 485                 case SELF_ESTABL_CONTACT_EVT:
 486                 case PEER_LOST_CONTACT_EVT:
 487                         break;
 488                 default:
 489                         pr_err("Unknown node fsm evt %x/%x\n", state, evt);
 490                 }
 491                 break;
 492         case SELF_COMING_PEER_UP:
 493                 switch (evt) {
 494                 case SELF_ESTABL_CONTACT_EVT:
 495                         state = SELF_UP_PEER_UP;
 496                         break;
 497                 case PEER_LOST_CONTACT_EVT:
 498                         state = SELF_LEAVING_PEER_DOWN;
 499                         break;
 500                 case SELF_LOST_CONTACT_EVT:
 501                 case PEER_ESTABL_CONTACT_EVT:
 502                         break;
 503                 default:
 504                         pr_err("Unknown node fsm evt %x/%x\n", state, evt);
 505                 }
 506                 break;
 507         case SELF_LEAVING_PEER_DOWN:
 508                 switch (evt) {
 509                 case SELF_LOST_CONTACT_EVT:
 510                         state = SELF_DOWN_PEER_DOWN;
 511                         break;
 512                 case SELF_ESTABL_CONTACT_EVT:
 513                 case PEER_ESTABL_CONTACT_EVT:
 514                 case PEER_LOST_CONTACT_EVT:
 515                         break;
 516                 default:
 517                         pr_err("Unknown node fsm evt %x/%x\n", state, evt);
 518                 }
 519                 break;
 520         default:
 521                 pr_err("Unknown node fsm state %x\n", state);
 522                 break;
 523         }
 524
 525         n->state = state;
 526 }
 527
 528 bool tipc_node_filter_skb(struct tipc_node *n, struct tipc_link *l,
 529                           struct tipc_msg *hdr)
 530 {
 531         int state = n->state;
 532
 533         if (likely(state == SELF_UP_PEER_UP))
 534                 return true;
 535
 536         if (state == SELF_DOWN_PEER_DOWN)
 537                 return true;
 538
 539         if (state == SELF_UP_PEER_COMING) {
 540                 /* If not traffic msg, peer may still be ESTABLISHING */
 541                 if (tipc_link_is_up(l) && msg_is_traffic(hdr))
 542                         tipc_node_fsm_evt(n, PEER_ESTABL_CONTACT_EVT);
 543                 return true;
 544         }
 545
 546         if (state == SELF_COMING_PEER_UP)
 547                 return true;
 548
 549         if (state == SELF_LEAVING_PEER_DOWN)
 550                 return false;
 551
 552         if (state == SELF_DOWN_PEER_LEAVING) {
 553                 if (msg_peer_is_up(hdr))
 554                         return false;
 555                 tipc_node_fsm_evt(n, PEER_LOST_CONTACT_EVT);
 556                 return true;
 557         }
 558         return false;
 559 }
 560
 561 static void node_established_contact(struct tipc_node *n_ptr)
 562 {
 563         tipc_node_fsm_evt(n_ptr, SELF_ESTABL_CONTACT_EVT);
 564         n_ptr->action_flags |= TIPC_NOTIFY_NODE_UP;
 565         n_ptr->bclink.oos_state = 0;
 566         n_ptr->bclink.acked = tipc_bclink_get_last_sent(n_ptr->net);
 567         tipc_bclink_add_node(n_ptr->net, n_ptr->addr);
 568 }
 569
 570 static void node_lost_contact(struct tipc_node *n_ptr)
 571 {
 572         char addr_string[16];
 573         struct tipc_sock_conn *conn, *safe;
 574         struct list_head *conns = &n_ptr->conn_sks;
 575         struct sk_buff *skb;
 576         struct tipc_net *tn = net_generic(n_ptr->net, tipc_net_id);
 577         uint i;
 578
 579         pr_debug("Lost contact with %s\n",
 580                  tipc_addr_string_fill(addr_string, n_ptr->addr));
 581
 582         /* Flush broadcast link info associated with lost node */
 583         if (n_ptr->bclink.recv_permitted) {
 584                 __skb_queue_purge(&n_ptr->bclink.deferdq);
 585
 586                 if (n_ptr->bclink.reasm_buf) {
 587                         kfree_skb(n_ptr->bclink.reasm_buf);
 588                         n_ptr->bclink.reasm_buf = NULL;
 589                 }
 590
 591                 tipc_bclink_remove_node(n_ptr->net, n_ptr->addr);
 592                 tipc_bclink_acknowledge(n_ptr, INVALID_LINK_SEQ);
 593
 594                 n_ptr->bclink.recv_permitted = false;
 595         }
 596
 597         /* Abort any ongoing link failover */
 598         for (i = 0; i < MAX_BEARERS; i++) {
 599                 struct tipc_link *l_ptr = n_ptr->links[i].link;
 600                 if (!l_ptr)
 601                         continue;
 602                 l_ptr->exec_mode = TIPC_LINK_OPEN;
 603                 l_ptr->failover_checkpt = 0;
 604                 l_ptr->failover_pkts = 0;
 605                 kfree_skb(l_ptr->failover_skb);
 606                 l_ptr->failover_skb = NULL;
 607                 tipc_link_reset_fragments(l_ptr);
 608         }
 609         /* Prevent re-contact with node until cleanup is done */
 610         tipc_node_fsm_evt(n_ptr, SELF_LOST_CONTACT_EVT);
 611
 612         /* Notify publications from this node */
 613         n_ptr->action_flags |= TIPC_NOTIFY_NODE_DOWN;
 614
 615         /* Notify sockets connected to node */
 616         list_for_each_entry_safe(conn, safe, conns, list) {
 617                 skb = tipc_msg_create(TIPC_CRITICAL_IMPORTANCE, TIPC_CONN_MSG,
 618                                       SHORT_H_SIZE, 0, tn->own_addr,
 619                                       conn->peer_node, conn->port,
 620                                       conn->peer_port, TIPC_ERR_NO_NODE);
 621                 if (likely(skb)) {
 622                         skb_queue_tail(n_ptr->inputq, skb);
 623                         n_ptr->action_flags |= TIPC_MSG_EVT;
 624                 }
 625                 list_del(&conn->list);
 626                 kfree(conn);
 627         }
 628 }
 629
 630 /**
 631  * tipc_node_get_linkname - get the name of a link
 632  *
 633  * @bearer_id: id of the bearer
 634  * @node: peer node address
 635  * @linkname: link name output buffer
 636  *
 637  * Returns 0 on success
 638  */
 639 int tipc_node_get_linkname(struct net *net, u32 bearer_id, u32 addr,
 640                            char *linkname, size_t len)
 641 {
 642         struct tipc_link *link;
 643         int err = -EINVAL;
 644         struct tipc_node *node = tipc_node_find(net, addr);
 645
 646         if (!node)
 647                 return err;
 648
 649         if (bearer_id >= MAX_BEARERS)
 650                 goto exit;
 651
 652         tipc_node_lock(node);
 653         link = node->links[bearer_id].link;
 654         if (link) {
 655                 strncpy(linkname, link->name, len);
 656                 err = 0;
 657         }
 658 exit:
 659         tipc_node_unlock(node);
 660         tipc_node_put(node);
 661         return err;
 662 }
 663
 664 void tipc_node_unlock(struct tipc_node *node)
 665 {
 666         struct net *net = node->net;
 667         u32 addr = 0;
 668         u32 flags = node->action_flags;
 669         u32 link_id = 0;
 670         struct list_head *publ_list;
 671         struct sk_buff_head *inputq = node->inputq;
 672         struct sk_buff_head *namedq;
 673
 674         if (likely(!flags || (flags == TIPC_MSG_EVT))) {
 675                 node->action_flags = 0;
 676                 spin_unlock_bh(&node->lock);
 677                 if (flags == TIPC_MSG_EVT)
 678                         tipc_sk_rcv(net, inputq);
 679                 return;
 680         }
 681
 682         addr = node->addr;
 683         link_id = node->link_id;
 684         namedq = node->namedq;
 685         publ_list = &node->publ_list;
 686
 687         node->action_flags &= ~(TIPC_MSG_EVT |
 688                                 TIPC_NOTIFY_NODE_DOWN | TIPC_NOTIFY_NODE_UP |
 689                                 TIPC_NOTIFY_LINK_DOWN | TIPC_NOTIFY_LINK_UP |
 690                                 TIPC_WAKEUP_BCAST_USERS | TIPC_BCAST_MSG_EVT |
 691                                 TIPC_NAMED_MSG_EVT | TIPC_BCAST_RESET);
 692
 693         spin_unlock_bh(&node->lock);
 694
 695         if (flags & TIPC_NOTIFY_NODE_DOWN)
 696                 tipc_publ_notify(net, publ_list, addr);
 697
 698         if (flags & TIPC_WAKEUP_BCAST_USERS)
 699                 tipc_bclink_wakeup_users(net);
 700
 701         if (flags & TIPC_NOTIFY_NODE_UP)
 702                 tipc_named_node_up(net, addr);
 703
 704         if (flags & TIPC_NOTIFY_LINK_UP)
 705                 tipc_nametbl_publish(net, TIPC_LINK_STATE, addr, addr,
 706                                      TIPC_NODE_SCOPE, link_id, addr);
 707
 708         if (flags & TIPC_NOTIFY_LINK_DOWN)
 709                 tipc_nametbl_withdraw(net, TIPC_LINK_STATE, addr,
 710                                       link_id, addr);
 711
 712         if (flags & TIPC_MSG_EVT)
 713                 tipc_sk_rcv(net, inputq);
 714
 715         if (flags & TIPC_NAMED_MSG_EVT)
 716                 tipc_named_rcv(net, namedq);
 717
 718         if (flags & TIPC_BCAST_MSG_EVT)
 719                 tipc_bclink_input(net);
 720
 721         if (flags & TIPC_BCAST_RESET)
 722                 tipc_link_reset_all(node);
 723 }
 724
 725 /* Caller should hold node lock for the passed node */
 726 static int __tipc_nl_add_node(struct tipc_nl_msg *msg, struct tipc_node *node)
 727 {
 728         void *hdr;
 729         struct nlattr *attrs;
 730
 731         hdr = genlmsg_put(msg->skb, msg->portid, msg->seq, &tipc_genl_family,
 732                           NLM_F_MULTI, TIPC_NL_NODE_GET);
 733         if (!hdr)
 734                 return -EMSGSIZE;
 735
 736         attrs = nla_nest_start(msg->skb, TIPC_NLA_NODE);
 737         if (!attrs)
 738                 goto msg_full;
 739
 740         if (nla_put_u32(msg->skb, TIPC_NLA_NODE_ADDR, node->addr))
 741                 goto attr_msg_full;
 742         if (tipc_node_is_up(node))
 743                 if (nla_put_flag(msg->skb, TIPC_NLA_NODE_UP))
 744                         goto attr_msg_full;
 745
 746         nla_nest_end(msg->skb, attrs);
 747         genlmsg_end(msg->skb, hdr);
 748
 749         return 0;
 750
 751 attr_msg_full:
 752         nla_nest_cancel(msg->skb, attrs);
 753 msg_full:
 754         genlmsg_cancel(msg->skb, hdr);
 755
 756         return -EMSGSIZE;
 757 }
 758
 759 static struct tipc_link *tipc_node_select_link(struct tipc_node *n, int sel,
 760                                                int *bearer_id,
 761                                                struct tipc_media_addr **maddr)
 762 {
 763         int id = n->active_links[sel & 1];
 764
 765         if (unlikely(id < 0))
 766                 return NULL;
 767
 768         *bearer_id = id;
 769         *maddr = &n->links[id].maddr;
 770         return n->links[id].link;
 771 }
 772
 773 /**
 774  * tipc_node_xmit() is the general link level function for message sending
 775  * @net: the applicable net namespace
 776  * @list: chain of buffers containing message
 777  * @dnode: address of destination node
 778  * @selector: a number used for deterministic link selection
 779  * Consumes the buffer chain, except when returning -ELINKCONG
 780  * Returns 0 if success, otherwise errno: -ELINKCONG,-EHOSTUNREACH,-EMSGSIZE
 781  */
 782 int tipc_node_xmit(struct net *net, struct sk_buff_head *list,
 783                    u32 dnode, int selector)
 784 {
 785         struct tipc_link *l = NULL;
 786         struct tipc_node *n;
 787         struct sk_buff_head xmitq;
 788         struct tipc_media_addr *maddr;
 789         int bearer_id;
 790         int rc = -EHOSTUNREACH;
 791
 792         __skb_queue_head_init(&xmitq);
 793         n = tipc_node_find(net, dnode);
 794         if (likely(n)) {
 795                 tipc_node_lock(n);
 796                 l = tipc_node_select_link(n, selector, &bearer_id, &maddr);
 797                 if (likely(l))
 798                         rc = tipc_link_xmit(l, list, &xmitq);
 799                 if (unlikely(rc == -ENOBUFS))
 800                         tipc_link_reset(l);
 801                 tipc_node_unlock(n);
 802                 tipc_node_put(n);
 803         }
 804         if (likely(!rc)) {
 805                 tipc_bearer_xmit(net, bearer_id, &xmitq, maddr);
 806                 return 0;
 807         }
 808         if (likely(in_own_node(net, dnode))) {
 809                 tipc_sk_rcv(net, list);
 810                 return 0;
 811         }
 812         return rc;
 813 }
 814
 815 /* tipc_node_xmit_skb(): send single buffer to destination
 816  * Buffers sent via this functon are generally TIPC_SYSTEM_IMPORTANCE
 817  * messages, which will not be rejected
 818  * The only exception is datagram messages rerouted after secondary
 819  * lookup, which are rare and safe to dispose of anyway.
 820  * TODO: Return real return value, and let callers use
 821  * tipc_wait_for_sendpkt() where applicable
 822  */
 823 int tipc_node_xmit_skb(struct net *net, struct sk_buff *skb, u32 dnode,
 824                        u32 selector)
 825 {
 826         struct sk_buff_head head;
 827         int rc;
 828
 829         skb_queue_head_init(&head);
 830         __skb_queue_tail(&head, skb);
 831         rc = tipc_node_xmit(net, &head, dnode, selector);
 832         if (rc == -ELINKCONG)
 833                 kfree_skb(skb);
 834         return 0;
 835 }
 836
 837 /**
 838  * tipc_rcv - process TIPC packets/messages arriving from off-node
 839  * @net: the applicable net namespace
 840  * @skb: TIPC packet
 841  * @bearer: pointer to bearer message arrived on
 842  *
 843  * Invoked with no locks held. Bearer pointer must point to a valid bearer
 844  * structure (i.e. cannot be NULL), but bearer can be inactive.
 845  */
 846 void tipc_rcv(struct net *net, struct sk_buff *skb, struct tipc_bearer *b)
 847 {
 848         struct sk_buff_head xmitq;
 849         struct tipc_node *n;
 850         struct tipc_link *l;
 851         struct tipc_msg *hdr;
 852         struct tipc_media_addr *maddr;
 853         int bearer_id = b->identity;
 854         int rc = 0;
 855
 856         __skb_queue_head_init(&xmitq);
 857
 858         /* Ensure message is well-formed */
 859         if (unlikely(!tipc_msg_validate(skb)))
 860                 goto discard;
 861
 862         /* Handle arrival of a non-unicast link packet */
 863         hdr = buf_msg(skb);
 864         if (unlikely(msg_non_seq(hdr))) {
 865                 if (msg_user(hdr) ==  LINK_CONFIG)
 866                         tipc_disc_rcv(net, skb, b);
 867                 else
 868                         tipc_bclink_rcv(net, skb);
 869                 return;
 870         }
 871
 872         /* Locate neighboring node that sent packet */
 873         n = tipc_node_find(net, msg_prevnode(hdr));
 874         if (unlikely(!n))
 875                 goto discard;
 876         tipc_node_lock(n);
 877
 878         /* Locate link endpoint that should handle packet */
 879         l = n->links[bearer_id].link;
 880         if (unlikely(!l))
 881                 goto unlock;
 882
 883         /* Is reception of this packet permitted at the moment ? */
 884         if (unlikely(n->state != SELF_UP_PEER_UP))
 885                 if (!tipc_node_filter_skb(n, l, hdr))
 886                         goto unlock;
 887
 888         if (unlikely(msg_user(hdr) == LINK_PROTOCOL))
 889                 tipc_bclink_sync_state(n, hdr);
 890
 891         /* Release acked broadcast messages */
 892         if (unlikely(n->bclink.acked != msg_bcast_ack(hdr)))
 893                 tipc_bclink_acknowledge(n, msg_bcast_ack(hdr));
 894
 895         /* Check protocol and update link state */
 896         rc = tipc_link_rcv(l, skb, &xmitq);
 897
 898         if (unlikely(rc & TIPC_LINK_UP_EVT))
 899                 tipc_link_activate(l);
 900         if (unlikely(rc & TIPC_LINK_DOWN_EVT))
 901                 tipc_link_reset(l);
 902         skb = NULL;
 903 unlock:
 904         tipc_node_unlock(n);
 905         tipc_sk_rcv(net, &n->links[bearer_id].inputq);
 906         maddr = &n->links[bearer_id].maddr;
 907         tipc_bearer_xmit(net, bearer_id, &xmitq, maddr);
 908         tipc_node_put(n);
 909 discard:
 910         kfree_skb(skb);
 911 }
 912
 913 int tipc_nl_node_dump(struct sk_buff *skb, struct netlink_callback *cb)
 914 {
 915         int err;
 916         struct net *net = sock_net(skb->sk);
 917         struct tipc_net *tn = net_generic(net, tipc_net_id);
 918         int done = cb->args[0];
 919         int last_addr = cb->args[1];
 920         struct tipc_node *node;
 921         struct tipc_nl_msg msg;
 922
 923         if (done)
 924                 return 0;
 925
 926         msg.skb = skb;
 927         msg.portid = NETLINK_CB(cb->skb).portid;
 928         msg.seq = cb->nlh->nlmsg_seq;
 929
 930         rcu_read_lock();
 931         if (last_addr) {
 932                 node = tipc_node_find(net, last_addr);
 933                 if (!node) {
 934                         rcu_read_unlock();
 935                         /* We never set seq or call nl_dump_check_consistent()
 936                          * this means that setting prev_seq here will cause the
 937                          * consistence check to fail in the netlink callback
 938                          * handler. Resulting in the NLMSG_DONE message having
 939                          * the NLM_F_DUMP_INTR flag set if the node state
 940                          * changed while we released the lock.
 941                          */
 942                         cb->prev_seq = 1;
 943                         return -EPIPE;
 944                 }
 945                 tipc_node_put(node);
 946         }
 947
 948         list_for_each_entry_rcu(node, &tn->node_list, list) {
 949                 if (last_addr) {
 950                         if (node->addr == last_addr)
 951                                 last_addr = 0;
 952                         else
 953                                 continue;
 954                 }
 955
 956                 tipc_node_lock(node);
 957                 err = __tipc_nl_add_node(&msg, node);
 958                 if (err) {
 959                         last_addr = node->addr;
 960                         tipc_node_unlock(node);
 961                         goto out;
 962                 }
 963
 964                 tipc_node_unlock(node);
 965         }
 966         done = 1;
 967 out:
 968         cb->args[0] = done;
 969         cb->args[1] = last_addr;
 970         rcu_read_unlock();
 971
 972         return skb->len;
 973 }