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         tipc_bearer_add_dest(n->net, bearer_id, n->addr);
 299
 300         pr_debug("Established link <%s> on network plane %c\n",
 301                  l->name, l->net_plane);
 302
 303         /* No active links ? => take both active slots */
 304         if (!tipc_node_is_up(n)) {
 305                 *slot0 = bearer_id;
 306                 *slot1 = bearer_id;
 307                 node_established_contact(n);
 308                 return;
 309         }
 310
 311         /* Lower prio than current active ? => no slot */
 312         if (l->priority < links[*slot0].link->priority) {
 313                 pr_debug("New link <%s> becomes standby\n", l->name);
 314                 return;
 315         }
 316         tipc_link_dup_queue_xmit(links[*slot0].link, l);
 317
 318         /* Same prio as current active ? => take one slot */
 319         if (l->priority == links[*slot0].link->priority) {
 320                 *slot0 = bearer_id;
 321                 return;
 322         }
 323
 324         /* Higher prio than current active => take both active slots */
 325         pr_debug("Old link <%s> now standby\n", links[*slot0].link->name);
 326         *slot0 = bearer_id;
 327         *slot1 = bearer_id;
 328 }
 329
 330 /**
 331  * tipc_node_link_down - handle loss of link
 332  */
 333 void tipc_node_link_down(struct tipc_node *n, int bearer_id)
 334 {
 335         int *slot0 = &n->active_links[0];
 336         int *slot1 = &n->active_links[1];
 337         int i, highest = 0;
 338         struct tipc_link *l, *_l;
 339
 340         l = n->links[bearer_id].link;
 341         n->working_links--;
 342         n->action_flags |= TIPC_NOTIFY_LINK_DOWN;
 343         n->link_id = l->peer_bearer_id << 16 | l->bearer_id;
 344
 345         pr_debug("Lost link <%s> on network plane %c\n",
 346                  l->name, l->net_plane);
 347
 348         /* Select new active link if any available */
 349         *slot0 = INVALID_BEARER_ID;
 350         *slot1 = INVALID_BEARER_ID;
 351         for (i = 0; i < MAX_BEARERS; i++) {
 352                 _l = n->links[i].link;
 353                 if (!_l || !tipc_link_is_up(_l))
 354                         continue;
 355                 if (_l->priority < highest)
 356                         continue;
 357                 if (_l->priority > highest) {
 358                         highest = _l->priority;
 359                         *slot0 = i;
 360                         *slot1 = i;
 361                         continue;
 362                 }
 363                 *slot1 = i;
 364         }
 365         if (tipc_node_is_up(n))
 366                 tipc_link_failover_send_queue(l);
 367         else
 368                 node_lost_contact(n);
 369 }
 370
 371 bool tipc_node_is_up(struct tipc_node *n)
 372 {
 373         return n->active_links[0] != INVALID_BEARER_ID;
 374 }
 375
 376 void tipc_node_check_dest(struct tipc_node *n, struct tipc_bearer *b,
 377                           bool *link_up, bool *addr_match,
 378                           struct tipc_media_addr *maddr)
 379 {
 380         struct tipc_link *l = n->links[b->identity].link;
 381         struct tipc_media_addr *curr = &n->links[b->identity].maddr;
 382
 383         *link_up = l && tipc_link_is_up(l);
 384         *addr_match = l && !memcmp(curr, maddr, sizeof(*maddr));
 385 }
 386
 387 bool tipc_node_update_dest(struct tipc_node *n,  struct tipc_bearer *b,
 388                            struct tipc_media_addr *maddr)
 389 {
 390         struct tipc_link *l = n->links[b->identity].link;
 391         struct tipc_media_addr *curr = &n->links[b->identity].maddr;
 392         struct sk_buff_head *inputq = &n->links[b->identity].inputq;
 393
 394         if (!l) {
 395                 l = tipc_link_create(n, b, maddr, inputq, &n->bclink.namedq);
 396                 if (!l)
 397                         return false;
 398                 tipc_node_calculate_timer(n, l);
 399                 if (n->link_cnt == 1) {
 400                         if (!mod_timer(&n->timer, jiffies + n->keepalive_intv))
 401                                 tipc_node_get(n);
 402                 }
 403         }
 404         memcpy(&l->media_addr, maddr, sizeof(*maddr));
 405         memcpy(curr, maddr, sizeof(*maddr));
 406         tipc_link_reset(l);
 407         return true;
 408 }
 409
 410 void tipc_node_attach_link(struct tipc_node *n_ptr, struct tipc_link *l_ptr)
 411 {
 412         n_ptr->links[l_ptr->bearer_id].link = l_ptr;
 413         n_ptr->link_cnt++;
 414 }
 415
 416 void tipc_node_detach_link(struct tipc_node *n_ptr, struct tipc_link *l_ptr)
 417 {
 418         int i;
 419
 420         for (i = 0; i < MAX_BEARERS; i++) {
 421                 if (l_ptr != n_ptr->links[i].link)
 422                         continue;
 423                 n_ptr->links[i].link = NULL;
 424                 n_ptr->link_cnt--;
 425         }
 426 }
 427
 428 /* tipc_node_fsm_evt - node finite state machine
 429  * Determines when contact is allowed with peer node
 430  */
 431 static void tipc_node_fsm_evt(struct tipc_node *n, int evt)
 432 {
 433         int state = n->state;
 434
 435         switch (state) {
 436         case SELF_DOWN_PEER_DOWN:
 437                 switch (evt) {
 438                 case SELF_ESTABL_CONTACT_EVT:
 439                         state = SELF_UP_PEER_COMING;
 440                         break;
 441                 case PEER_ESTABL_CONTACT_EVT:
 442                         state = SELF_COMING_PEER_UP;
 443                         break;
 444                 case SELF_LOST_CONTACT_EVT:
 445                 case PEER_LOST_CONTACT_EVT:
 446                         break;
 447                 default:
 448                         pr_err("Unknown node fsm evt %x/%x\n", state, evt);
 449                 }
 450                 break;
 451         case SELF_UP_PEER_UP:
 452                 switch (evt) {
 453                 case SELF_LOST_CONTACT_EVT:
 454                         state = SELF_DOWN_PEER_LEAVING;
 455                         break;
 456                 case PEER_LOST_CONTACT_EVT:
 457                         state = SELF_LEAVING_PEER_DOWN;
 458                         break;
 459                 case SELF_ESTABL_CONTACT_EVT:
 460                 case PEER_ESTABL_CONTACT_EVT:
 461                         break;
 462                 default:
 463                         pr_err("Unknown node fsm evt %x/%x\n", state, evt);
 464                 }
 465                 break;
 466         case SELF_DOWN_PEER_LEAVING:
 467                 switch (evt) {
 468                 case PEER_LOST_CONTACT_EVT:
 469                         state = SELF_DOWN_PEER_DOWN;
 470                         break;
 471                 case SELF_ESTABL_CONTACT_EVT:
 472                 case PEER_ESTABL_CONTACT_EVT:
 473                 case SELF_LOST_CONTACT_EVT:
 474                         break;
 475                 default:
 476                         pr_err("Unknown node fsm evt %x/%x\n", state, evt);
 477                 }
 478                 break;
 479         case SELF_UP_PEER_COMING:
 480                 switch (evt) {
 481                 case PEER_ESTABL_CONTACT_EVT:
 482                         state = SELF_UP_PEER_UP;
 483                         break;
 484                 case SELF_LOST_CONTACT_EVT:
 485                         state = SELF_DOWN_PEER_LEAVING;
 486                         break;
 487                 case SELF_ESTABL_CONTACT_EVT:
 488                 case PEER_LOST_CONTACT_EVT:
 489                         break;
 490                 default:
 491                         pr_err("Unknown node fsm evt %x/%x\n", state, evt);
 492                 }
 493                 break;
 494         case SELF_COMING_PEER_UP:
 495                 switch (evt) {
 496                 case SELF_ESTABL_CONTACT_EVT:
 497                         state = SELF_UP_PEER_UP;
 498                         break;
 499                 case PEER_LOST_CONTACT_EVT:
 500                         state = SELF_LEAVING_PEER_DOWN;
 501                         break;
 502                 case SELF_LOST_CONTACT_EVT:
 503                 case PEER_ESTABL_CONTACT_EVT:
 504                         break;
 505                 default:
 506                         pr_err("Unknown node fsm evt %x/%x\n", state, evt);
 507                 }
 508                 break;
 509         case SELF_LEAVING_PEER_DOWN:
 510                 switch (evt) {
 511                 case SELF_LOST_CONTACT_EVT:
 512                         state = SELF_DOWN_PEER_DOWN;
 513                         break;
 514                 case SELF_ESTABL_CONTACT_EVT:
 515                 case PEER_ESTABL_CONTACT_EVT:
 516                 case PEER_LOST_CONTACT_EVT:
 517                         break;
 518                 default:
 519                         pr_err("Unknown node fsm evt %x/%x\n", state, evt);
 520                 }
 521                 break;
 522         default:
 523                 pr_err("Unknown node fsm state %x\n", state);
 524                 break;
 525         }
 526
 527         n->state = state;
 528 }
 529
 530 bool tipc_node_filter_skb(struct tipc_node *n, struct tipc_link *l,
 531                           struct tipc_msg *hdr)
 532 {
 533         int state = n->state;
 534
 535         if (likely(state == SELF_UP_PEER_UP))
 536                 return true;
 537
 538         if (state == SELF_DOWN_PEER_DOWN)
 539                 return true;
 540
 541         if (state == SELF_UP_PEER_COMING) {
 542                 /* If not traffic msg, peer may still be ESTABLISHING */
 543                 if (tipc_link_is_up(l) && msg_is_traffic(hdr))
 544                         tipc_node_fsm_evt(n, PEER_ESTABL_CONTACT_EVT);
 545                 return true;
 546         }
 547
 548         if (state == SELF_COMING_PEER_UP)
 549                 return true;
 550
 551         if (state == SELF_LEAVING_PEER_DOWN)
 552                 return false;
 553
 554         if (state == SELF_DOWN_PEER_LEAVING) {
 555                 if (msg_peer_is_up(hdr))
 556                         return false;
 557                 tipc_node_fsm_evt(n, PEER_LOST_CONTACT_EVT);
 558                 return true;
 559         }
 560         return false;
 561 }
 562
 563 static void node_established_contact(struct tipc_node *n_ptr)
 564 {
 565         tipc_node_fsm_evt(n_ptr, SELF_ESTABL_CONTACT_EVT);
 566         n_ptr->action_flags |= TIPC_NOTIFY_NODE_UP;
 567         n_ptr->bclink.oos_state = 0;
 568         n_ptr->bclink.acked = tipc_bclink_get_last_sent(n_ptr->net);
 569         tipc_bclink_add_node(n_ptr->net, n_ptr->addr);
 570 }
 571
 572 static void node_lost_contact(struct tipc_node *n_ptr)
 573 {
 574         char addr_string[16];
 575         struct tipc_sock_conn *conn, *safe;
 576         struct list_head *conns = &n_ptr->conn_sks;
 577         struct sk_buff *skb;
 578         struct tipc_net *tn = net_generic(n_ptr->net, tipc_net_id);
 579         uint i;
 580
 581         pr_debug("Lost contact with %s\n",
 582                  tipc_addr_string_fill(addr_string, n_ptr->addr));
 583
 584         /* Flush broadcast link info associated with lost node */
 585         if (n_ptr->bclink.recv_permitted) {
 586                 __skb_queue_purge(&n_ptr->bclink.deferdq);
 587
 588                 if (n_ptr->bclink.reasm_buf) {
 589                         kfree_skb(n_ptr->bclink.reasm_buf);
 590                         n_ptr->bclink.reasm_buf = NULL;
 591                 }
 592
 593                 tipc_bclink_remove_node(n_ptr->net, n_ptr->addr);
 594                 tipc_bclink_acknowledge(n_ptr, INVALID_LINK_SEQ);
 595
 596                 n_ptr->bclink.recv_permitted = false;
 597         }
 598
 599         /* Abort any ongoing link failover */
 600         for (i = 0; i < MAX_BEARERS; i++) {
 601                 struct tipc_link *l_ptr = n_ptr->links[i].link;
 602                 if (!l_ptr)
 603                         continue;
 604                 l_ptr->exec_mode = TIPC_LINK_OPEN;
 605                 l_ptr->failover_checkpt = 0;
 606                 l_ptr->failover_pkts = 0;
 607                 kfree_skb(l_ptr->failover_skb);
 608                 l_ptr->failover_skb = NULL;
 609                 tipc_link_reset_fragments(l_ptr);
 610         }
 611         /* Prevent re-contact with node until cleanup is done */
 612         tipc_node_fsm_evt(n_ptr, SELF_LOST_CONTACT_EVT);
 613
 614         /* Notify publications from this node */
 615         n_ptr->action_flags |= TIPC_NOTIFY_NODE_DOWN;
 616
 617         /* Notify sockets connected to node */
 618         list_for_each_entry_safe(conn, safe, conns, list) {
 619                 skb = tipc_msg_create(TIPC_CRITICAL_IMPORTANCE, TIPC_CONN_MSG,
 620                                       SHORT_H_SIZE, 0, tn->own_addr,
 621                                       conn->peer_node, conn->port,
 622                                       conn->peer_port, TIPC_ERR_NO_NODE);
 623                 if (likely(skb)) {
 624                         skb_queue_tail(n_ptr->inputq, skb);
 625                         n_ptr->action_flags |= TIPC_MSG_EVT;
 626                 }
 627                 list_del(&conn->list);
 628                 kfree(conn);
 629         }
 630 }
 631
 632 /**
 633  * tipc_node_get_linkname - get the name of a link
 634  *
 635  * @bearer_id: id of the bearer
 636  * @node: peer node address
 637  * @linkname: link name output buffer
 638  *
 639  * Returns 0 on success
 640  */
 641 int tipc_node_get_linkname(struct net *net, u32 bearer_id, u32 addr,
 642                            char *linkname, size_t len)
 643 {
 644         struct tipc_link *link;
 645         int err = -EINVAL;
 646         struct tipc_node *node = tipc_node_find(net, addr);
 647
 648         if (!node)
 649                 return err;
 650
 651         if (bearer_id >= MAX_BEARERS)
 652                 goto exit;
 653
 654         tipc_node_lock(node);
 655         link = node->links[bearer_id].link;
 656         if (link) {
 657                 strncpy(linkname, link->name, len);
 658                 err = 0;
 659         }
 660 exit:
 661         tipc_node_unlock(node);
 662         tipc_node_put(node);
 663         return err;
 664 }
 665
 666 void tipc_node_unlock(struct tipc_node *node)
 667 {
 668         struct net *net = node->net;
 669         u32 addr = 0;
 670         u32 flags = node->action_flags;
 671         u32 link_id = 0;
 672         struct list_head *publ_list;
 673         struct sk_buff_head *inputq = node->inputq;
 674         struct sk_buff_head *namedq;
 675
 676         if (likely(!flags || (flags == TIPC_MSG_EVT))) {
 677                 node->action_flags = 0;
 678                 spin_unlock_bh(&node->lock);
 679                 if (flags == TIPC_MSG_EVT)
 680                         tipc_sk_rcv(net, inputq);
 681                 return;
 682         }
 683
 684         addr = node->addr;
 685         link_id = node->link_id;
 686         namedq = node->namedq;
 687         publ_list = &node->publ_list;
 688
 689         node->action_flags &= ~(TIPC_MSG_EVT |
 690                                 TIPC_NOTIFY_NODE_DOWN | TIPC_NOTIFY_NODE_UP |
 691                                 TIPC_NOTIFY_LINK_DOWN | TIPC_NOTIFY_LINK_UP |
 692                                 TIPC_WAKEUP_BCAST_USERS | TIPC_BCAST_MSG_EVT |
 693                                 TIPC_NAMED_MSG_EVT | TIPC_BCAST_RESET);
 694
 695         spin_unlock_bh(&node->lock);
 696
 697         if (flags & TIPC_NOTIFY_NODE_DOWN)
 698                 tipc_publ_notify(net, publ_list, addr);
 699
 700         if (flags & TIPC_WAKEUP_BCAST_USERS)
 701                 tipc_bclink_wakeup_users(net);
 702
 703         if (flags & TIPC_NOTIFY_NODE_UP)
 704                 tipc_named_node_up(net, addr);
 705
 706         if (flags & TIPC_NOTIFY_LINK_UP)
 707                 tipc_nametbl_publish(net, TIPC_LINK_STATE, addr, addr,
 708                                      TIPC_NODE_SCOPE, link_id, addr);
 709
 710         if (flags & TIPC_NOTIFY_LINK_DOWN)
 711                 tipc_nametbl_withdraw(net, TIPC_LINK_STATE, addr,
 712                                       link_id, addr);
 713
 714         if (flags & TIPC_MSG_EVT)
 715                 tipc_sk_rcv(net, inputq);
 716
 717         if (flags & TIPC_NAMED_MSG_EVT)
 718                 tipc_named_rcv(net, namedq);
 719
 720         if (flags & TIPC_BCAST_MSG_EVT)
 721                 tipc_bclink_input(net);
 722
 723         if (flags & TIPC_BCAST_RESET)
 724                 tipc_link_reset_all(node);
 725 }
 726
 727 /* Caller should hold node lock for the passed node */
 728 static int __tipc_nl_add_node(struct tipc_nl_msg *msg, struct tipc_node *node)
 729 {
 730         void *hdr;
 731         struct nlattr *attrs;
 732
 733         hdr = genlmsg_put(msg->skb, msg->portid, msg->seq, &tipc_genl_family,
 734                           NLM_F_MULTI, TIPC_NL_NODE_GET);
 735         if (!hdr)
 736                 return -EMSGSIZE;
 737
 738         attrs = nla_nest_start(msg->skb, TIPC_NLA_NODE);
 739         if (!attrs)
 740                 goto msg_full;
 741
 742         if (nla_put_u32(msg->skb, TIPC_NLA_NODE_ADDR, node->addr))
 743                 goto attr_msg_full;
 744         if (tipc_node_is_up(node))
 745                 if (nla_put_flag(msg->skb, TIPC_NLA_NODE_UP))
 746                         goto attr_msg_full;
 747
 748         nla_nest_end(msg->skb, attrs);
 749         genlmsg_end(msg->skb, hdr);
 750
 751         return 0;
 752
 753 attr_msg_full:
 754         nla_nest_cancel(msg->skb, attrs);
 755 msg_full:
 756         genlmsg_cancel(msg->skb, hdr);
 757
 758         return -EMSGSIZE;
 759 }
 760
 761 static struct tipc_link *tipc_node_select_link(struct tipc_node *n, int sel,
 762                                                int *bearer_id,
 763                                                struct tipc_media_addr **maddr)
 764 {
 765         int id = n->active_links[sel & 1];
 766
 767         if (unlikely(id < 0))
 768                 return NULL;
 769
 770         *bearer_id = id;
 771         *maddr = &n->links[id].maddr;
 772         return n->links[id].link;
 773 }
 774
 775 /**
 776  * tipc_node_xmit() is the general link level function for message sending
 777  * @net: the applicable net namespace
 778  * @list: chain of buffers containing message
 779  * @dnode: address of destination node
 780  * @selector: a number used for deterministic link selection
 781  * Consumes the buffer chain, except when returning -ELINKCONG
 782  * Returns 0 if success, otherwise errno: -ELINKCONG,-EHOSTUNREACH,-EMSGSIZE
 783  */
 784 int tipc_node_xmit(struct net *net, struct sk_buff_head *list,
 785                    u32 dnode, int selector)
 786 {
 787         struct tipc_link *l = NULL;
 788         struct tipc_node *n;
 789         struct sk_buff_head xmitq;
 790         struct tipc_media_addr *maddr;
 791         int bearer_id;
 792         int rc = -EHOSTUNREACH;
 793
 794         __skb_queue_head_init(&xmitq);
 795         n = tipc_node_find(net, dnode);
 796         if (likely(n)) {
 797                 tipc_node_lock(n);
 798                 l = tipc_node_select_link(n, selector, &bearer_id, &maddr);
 799                 if (likely(l))
 800                         rc = tipc_link_xmit(l, list, &xmitq);
 801                 if (unlikely(rc == -ENOBUFS))
 802                         tipc_link_reset(l);
 803                 tipc_node_unlock(n);
 804                 tipc_node_put(n);
 805         }
 806         if (likely(!rc)) {
 807                 tipc_bearer_xmit(net, bearer_id, &xmitq, maddr);
 808                 return 0;
 809         }
 810         if (likely(in_own_node(net, dnode))) {
 811                 tipc_sk_rcv(net, list);
 812                 return 0;
 813         }
 814         return rc;
 815 }
 816
 817 /* tipc_node_xmit_skb(): send single buffer to destination
 818  * Buffers sent via this functon are generally TIPC_SYSTEM_IMPORTANCE
 819  * messages, which will not be rejected
 820  * The only exception is datagram messages rerouted after secondary
 821  * lookup, which are rare and safe to dispose of anyway.
 822  * TODO: Return real return value, and let callers use
 823  * tipc_wait_for_sendpkt() where applicable
 824  */
 825 int tipc_node_xmit_skb(struct net *net, struct sk_buff *skb, u32 dnode,
 826                        u32 selector)
 827 {
 828         struct sk_buff_head head;
 829         int rc;
 830
 831         skb_queue_head_init(&head);
 832         __skb_queue_tail(&head, skb);
 833         rc = tipc_node_xmit(net, &head, dnode, selector);
 834         if (rc == -ELINKCONG)
 835                 kfree_skb(skb);
 836         return 0;
 837 }
 838
 839 /**
 840  * tipc_rcv - process TIPC packets/messages arriving from off-node
 841  * @net: the applicable net namespace
 842  * @skb: TIPC packet
 843  * @bearer: pointer to bearer message arrived on
 844  *
 845  * Invoked with no locks held. Bearer pointer must point to a valid bearer
 846  * structure (i.e. cannot be NULL), but bearer can be inactive.
 847  */
 848 void tipc_rcv(struct net *net, struct sk_buff *skb, struct tipc_bearer *b)
 849 {
 850         struct sk_buff_head xmitq;
 851         struct tipc_node *n;
 852         struct tipc_link *l;
 853         struct tipc_msg *hdr;
 854         struct tipc_media_addr *maddr;
 855         int bearer_id = b->identity;
 856         int rc = 0;
 857
 858         __skb_queue_head_init(&xmitq);
 859
 860         /* Ensure message is well-formed */
 861         if (unlikely(!tipc_msg_validate(skb)))
 862                 goto discard;
 863
 864         /* Handle arrival of a non-unicast link packet */
 865         hdr = buf_msg(skb);
 866         if (unlikely(msg_non_seq(hdr))) {
 867                 if (msg_user(hdr) ==  LINK_CONFIG)
 868                         tipc_disc_rcv(net, skb, b);
 869                 else
 870                         tipc_bclink_rcv(net, skb);
 871                 return;
 872         }
 873
 874         /* Locate neighboring node that sent packet */
 875         n = tipc_node_find(net, msg_prevnode(hdr));
 876         if (unlikely(!n))
 877                 goto discard;
 878         tipc_node_lock(n);
 879
 880         /* Locate link endpoint that should handle packet */
 881         l = n->links[bearer_id].link;
 882         if (unlikely(!l))
 883                 goto unlock;
 884
 885         /* Is reception of this packet permitted at the moment ? */
 886         if (unlikely(n->state != SELF_UP_PEER_UP))
 887                 if (!tipc_node_filter_skb(n, l, hdr))
 888                         goto unlock;
 889
 890         if (unlikely(msg_user(hdr) == LINK_PROTOCOL))
 891                 tipc_bclink_sync_state(n, hdr);
 892
 893         /* Release acked broadcast messages */
 894         if (unlikely(n->bclink.acked != msg_bcast_ack(hdr)))
 895                 tipc_bclink_acknowledge(n, msg_bcast_ack(hdr));
 896
 897         /* Check protocol and update link state */
 898         rc = tipc_link_rcv(l, skb, &xmitq);
 899
 900         if (unlikely(rc & TIPC_LINK_UP_EVT))
 901                 tipc_node_link_up(n, bearer_id);
 902         if (unlikely(rc & TIPC_LINK_DOWN_EVT))
 903                 tipc_link_reset(l);
 904         skb = NULL;
 905 unlock:
 906         tipc_node_unlock(n);
 907         tipc_sk_rcv(net, &n->links[bearer_id].inputq);
 908         maddr = &n->links[bearer_id].maddr;
 909         tipc_bearer_xmit(net, bearer_id, &xmitq, maddr);
 910         tipc_node_put(n);
 911 discard:
 912         kfree_skb(skb);
 913 }
 914
 915 int tipc_nl_node_dump(struct sk_buff *skb, struct netlink_callback *cb)
 916 {
 917         int err;
 918         struct net *net = sock_net(skb->sk);
 919         struct tipc_net *tn = net_generic(net, tipc_net_id);
 920         int done = cb->args[0];
 921         int last_addr = cb->args[1];
 922         struct tipc_node *node;
 923         struct tipc_nl_msg msg;
 924
 925         if (done)
 926                 return 0;
 927
 928         msg.skb = skb;
 929         msg.portid = NETLINK_CB(cb->skb).portid;
 930         msg.seq = cb->nlh->nlmsg_seq;
 931
 932         rcu_read_lock();
 933         if (last_addr) {
 934                 node = tipc_node_find(net, last_addr);
 935                 if (!node) {
 936                         rcu_read_unlock();
 937                         /* We never set seq or call nl_dump_check_consistent()
 938                          * this means that setting prev_seq here will cause the
 939                          * consistence check to fail in the netlink callback
 940                          * handler. Resulting in the NLMSG_DONE message having
 941                          * the NLM_F_DUMP_INTR flag set if the node state
 942                          * changed while we released the lock.
 943                          */
 944                         cb->prev_seq = 1;
 945                         return -EPIPE;
 946                 }
 947                 tipc_node_put(node);
 948         }
 949
 950         list_for_each_entry_rcu(node, &tn->node_list, list) {
 951                 if (last_addr) {
 952                         if (node->addr == last_addr)
 953                                 last_addr = 0;
 954                         else
 955                                 continue;
 956                 }
 957
 958                 tipc_node_lock(node);
 959                 err = __tipc_nl_add_node(&msg, node);
 960                 if (err) {
 961                         last_addr = node->addr;
 962                         tipc_node_unlock(node);
 963                         goto out;
 964                 }
 965
 966                 tipc_node_unlock(node);
 967         }
 968         done = 1;
 969 out:
 970         cb->args[0] = done;
 971         cb->args[1] = last_addr;
 972         rcu_read_unlock();
 973
 974         return skb->len;
 975 }