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_delete_links(struct net *net, int bearer_id)
 411 {
 412         struct tipc_net *tn = net_generic(net, tipc_net_id);
 413         struct tipc_link *l;
 414         struct tipc_node *n;
 415
 416         rcu_read_lock();
 417         list_for_each_entry_rcu(n, &tn->node_list, list) {
 418                 tipc_node_lock(n);
 419                 l = n->links[bearer_id].link;
 420                 if (l) {
 421                         tipc_link_reset(l);
 422                         n->links[bearer_id].link = NULL;
 423                         n->link_cnt--;
 424                 }
 425                 tipc_node_unlock(n);
 426                 kfree(l);
 427         }
 428         rcu_read_unlock();
 429 }
 430
 431 static void tipc_node_reset_links(struct tipc_node *n)
 432 {
 433         char addr_string[16];
 434         u32 i;
 435
 436         tipc_node_lock(n);
 437
 438         pr_warn("Resetting all links to %s\n",
 439                 tipc_addr_string_fill(addr_string, n->addr));
 440
 441         for (i = 0; i < MAX_BEARERS; i++) {
 442                 if (n->links[i].link)
 443                         tipc_link_reset(n->links[i].link);
 444         }
 445         tipc_node_unlock(n);
 446 }
 447
 448 void tipc_node_attach_link(struct tipc_node *n_ptr, struct tipc_link *l_ptr)
 449 {
 450         n_ptr->links[l_ptr->bearer_id].link = l_ptr;
 451         n_ptr->link_cnt++;
 452 }
 453
 454 void tipc_node_detach_link(struct tipc_node *n_ptr, struct tipc_link *l_ptr)
 455 {
 456         int i;
 457
 458         for (i = 0; i < MAX_BEARERS; i++) {
 459                 if (l_ptr != n_ptr->links[i].link)
 460                         continue;
 461                 n_ptr->links[i].link = NULL;
 462                 n_ptr->link_cnt--;
 463         }
 464 }
 465
 466 /* tipc_node_fsm_evt - node finite state machine
 467  * Determines when contact is allowed with peer node
 468  */
 469 static void tipc_node_fsm_evt(struct tipc_node *n, int evt)
 470 {
 471         int state = n->state;
 472
 473         switch (state) {
 474         case SELF_DOWN_PEER_DOWN:
 475                 switch (evt) {
 476                 case SELF_ESTABL_CONTACT_EVT:
 477                         state = SELF_UP_PEER_COMING;
 478                         break;
 479                 case PEER_ESTABL_CONTACT_EVT:
 480                         state = SELF_COMING_PEER_UP;
 481                         break;
 482                 case SELF_LOST_CONTACT_EVT:
 483                 case PEER_LOST_CONTACT_EVT:
 484                         break;
 485                 default:
 486                         pr_err("Unknown node fsm evt %x/%x\n", state, evt);
 487                 }
 488                 break;
 489         case SELF_UP_PEER_UP:
 490                 switch (evt) {
 491                 case SELF_LOST_CONTACT_EVT:
 492                         state = SELF_DOWN_PEER_LEAVING;
 493                         break;
 494                 case PEER_LOST_CONTACT_EVT:
 495                         state = SELF_LEAVING_PEER_DOWN;
 496                         break;
 497                 case SELF_ESTABL_CONTACT_EVT:
 498                 case PEER_ESTABL_CONTACT_EVT:
 499                         break;
 500                 default:
 501                         pr_err("Unknown node fsm evt %x/%x\n", state, evt);
 502                 }
 503                 break;
 504         case SELF_DOWN_PEER_LEAVING:
 505                 switch (evt) {
 506                 case PEER_LOST_CONTACT_EVT:
 507                         state = SELF_DOWN_PEER_DOWN;
 508                         break;
 509                 case SELF_ESTABL_CONTACT_EVT:
 510                 case PEER_ESTABL_CONTACT_EVT:
 511                 case SELF_LOST_CONTACT_EVT:
 512                         break;
 513                 default:
 514                         pr_err("Unknown node fsm evt %x/%x\n", state, evt);
 515                 }
 516                 break;
 517         case SELF_UP_PEER_COMING:
 518                 switch (evt) {
 519                 case PEER_ESTABL_CONTACT_EVT:
 520                         state = SELF_UP_PEER_UP;
 521                         break;
 522                 case SELF_LOST_CONTACT_EVT:
 523                         state = SELF_DOWN_PEER_LEAVING;
 524                         break;
 525                 case SELF_ESTABL_CONTACT_EVT:
 526                 case PEER_LOST_CONTACT_EVT:
 527                         break;
 528                 default:
 529                         pr_err("Unknown node fsm evt %x/%x\n", state, evt);
 530                 }
 531                 break;
 532         case SELF_COMING_PEER_UP:
 533                 switch (evt) {
 534                 case SELF_ESTABL_CONTACT_EVT:
 535                         state = SELF_UP_PEER_UP;
 536                         break;
 537                 case PEER_LOST_CONTACT_EVT:
 538                         state = SELF_LEAVING_PEER_DOWN;
 539                         break;
 540                 case SELF_LOST_CONTACT_EVT:
 541                 case PEER_ESTABL_CONTACT_EVT:
 542                         break;
 543                 default:
 544                         pr_err("Unknown node fsm evt %x/%x\n", state, evt);
 545                 }
 546                 break;
 547         case SELF_LEAVING_PEER_DOWN:
 548                 switch (evt) {
 549                 case SELF_LOST_CONTACT_EVT:
 550                         state = SELF_DOWN_PEER_DOWN;
 551                         break;
 552                 case SELF_ESTABL_CONTACT_EVT:
 553                 case PEER_ESTABL_CONTACT_EVT:
 554                 case PEER_LOST_CONTACT_EVT:
 555                         break;
 556                 default:
 557                         pr_err("Unknown node fsm evt %x/%x\n", state, evt);
 558                 }
 559                 break;
 560         default:
 561                 pr_err("Unknown node fsm state %x\n", state);
 562                 break;
 563         }
 564
 565         n->state = state;
 566 }
 567
 568 bool tipc_node_filter_skb(struct tipc_node *n, struct tipc_link *l,
 569                           struct tipc_msg *hdr)
 570 {
 571         int state = n->state;
 572
 573         if (likely(state == SELF_UP_PEER_UP))
 574                 return true;
 575
 576         if (state == SELF_DOWN_PEER_DOWN)
 577                 return true;
 578
 579         if (state == SELF_UP_PEER_COMING) {
 580                 /* If not traffic msg, peer may still be ESTABLISHING */
 581                 if (tipc_link_is_up(l) && msg_is_traffic(hdr))
 582                         tipc_node_fsm_evt(n, PEER_ESTABL_CONTACT_EVT);
 583                 return true;
 584         }
 585
 586         if (state == SELF_COMING_PEER_UP)
 587                 return true;
 588
 589         if (state == SELF_LEAVING_PEER_DOWN)
 590                 return false;
 591
 592         if (state == SELF_DOWN_PEER_LEAVING) {
 593                 if (msg_peer_is_up(hdr))
 594                         return false;
 595                 tipc_node_fsm_evt(n, PEER_LOST_CONTACT_EVT);
 596                 return true;
 597         }
 598         return false;
 599 }
 600
 601 static void node_established_contact(struct tipc_node *n_ptr)
 602 {
 603         tipc_node_fsm_evt(n_ptr, SELF_ESTABL_CONTACT_EVT);
 604         n_ptr->action_flags |= TIPC_NOTIFY_NODE_UP;
 605         n_ptr->bclink.oos_state = 0;
 606         n_ptr->bclink.acked = tipc_bclink_get_last_sent(n_ptr->net);
 607         tipc_bclink_add_node(n_ptr->net, n_ptr->addr);
 608 }
 609
 610 static void node_lost_contact(struct tipc_node *n_ptr)
 611 {
 612         char addr_string[16];
 613         struct tipc_sock_conn *conn, *safe;
 614         struct list_head *conns = &n_ptr->conn_sks;
 615         struct sk_buff *skb;
 616         struct tipc_net *tn = net_generic(n_ptr->net, tipc_net_id);
 617         uint i;
 618
 619         pr_debug("Lost contact with %s\n",
 620                  tipc_addr_string_fill(addr_string, n_ptr->addr));
 621
 622         /* Flush broadcast link info associated with lost node */
 623         if (n_ptr->bclink.recv_permitted) {
 624                 __skb_queue_purge(&n_ptr->bclink.deferdq);
 625
 626                 if (n_ptr->bclink.reasm_buf) {
 627                         kfree_skb(n_ptr->bclink.reasm_buf);
 628                         n_ptr->bclink.reasm_buf = NULL;
 629                 }
 630
 631                 tipc_bclink_remove_node(n_ptr->net, n_ptr->addr);
 632                 tipc_bclink_acknowledge(n_ptr, INVALID_LINK_SEQ);
 633
 634                 n_ptr->bclink.recv_permitted = false;
 635         }
 636
 637         /* Abort any ongoing link failover */
 638         for (i = 0; i < MAX_BEARERS; i++) {
 639                 struct tipc_link *l_ptr = n_ptr->links[i].link;
 640                 if (!l_ptr)
 641                         continue;
 642                 l_ptr->exec_mode = TIPC_LINK_OPEN;
 643                 l_ptr->failover_checkpt = 0;
 644                 l_ptr->failover_pkts = 0;
 645                 kfree_skb(l_ptr->failover_skb);
 646                 l_ptr->failover_skb = NULL;
 647                 tipc_link_reset_fragments(l_ptr);
 648         }
 649         /* Prevent re-contact with node until cleanup is done */
 650         tipc_node_fsm_evt(n_ptr, SELF_LOST_CONTACT_EVT);
 651
 652         /* Notify publications from this node */
 653         n_ptr->action_flags |= TIPC_NOTIFY_NODE_DOWN;
 654
 655         /* Notify sockets connected to node */
 656         list_for_each_entry_safe(conn, safe, conns, list) {
 657                 skb = tipc_msg_create(TIPC_CRITICAL_IMPORTANCE, TIPC_CONN_MSG,
 658                                       SHORT_H_SIZE, 0, tn->own_addr,
 659                                       conn->peer_node, conn->port,
 660                                       conn->peer_port, TIPC_ERR_NO_NODE);
 661                 if (likely(skb)) {
 662                         skb_queue_tail(n_ptr->inputq, skb);
 663                         n_ptr->action_flags |= TIPC_MSG_EVT;
 664                 }
 665                 list_del(&conn->list);
 666                 kfree(conn);
 667         }
 668 }
 669
 670 /**
 671  * tipc_node_get_linkname - get the name of a link
 672  *
 673  * @bearer_id: id of the bearer
 674  * @node: peer node address
 675  * @linkname: link name output buffer
 676  *
 677  * Returns 0 on success
 678  */
 679 int tipc_node_get_linkname(struct net *net, u32 bearer_id, u32 addr,
 680                            char *linkname, size_t len)
 681 {
 682         struct tipc_link *link;
 683         int err = -EINVAL;
 684         struct tipc_node *node = tipc_node_find(net, addr);
 685
 686         if (!node)
 687                 return err;
 688
 689         if (bearer_id >= MAX_BEARERS)
 690                 goto exit;
 691
 692         tipc_node_lock(node);
 693         link = node->links[bearer_id].link;
 694         if (link) {
 695                 strncpy(linkname, link->name, len);
 696                 err = 0;
 697         }
 698 exit:
 699         tipc_node_unlock(node);
 700         tipc_node_put(node);
 701         return err;
 702 }
 703
 704 void tipc_node_unlock(struct tipc_node *node)
 705 {
 706         struct net *net = node->net;
 707         u32 addr = 0;
 708         u32 flags = node->action_flags;
 709         u32 link_id = 0;
 710         struct list_head *publ_list;
 711         struct sk_buff_head *inputq = node->inputq;
 712         struct sk_buff_head *namedq;
 713
 714         if (likely(!flags || (flags == TIPC_MSG_EVT))) {
 715                 node->action_flags = 0;
 716                 spin_unlock_bh(&node->lock);
 717                 if (flags == TIPC_MSG_EVT)
 718                         tipc_sk_rcv(net, inputq);
 719                 return;
 720         }
 721
 722         addr = node->addr;
 723         link_id = node->link_id;
 724         namedq = node->namedq;
 725         publ_list = &node->publ_list;
 726
 727         node->action_flags &= ~(TIPC_MSG_EVT |
 728                                 TIPC_NOTIFY_NODE_DOWN | TIPC_NOTIFY_NODE_UP |
 729                                 TIPC_NOTIFY_LINK_DOWN | TIPC_NOTIFY_LINK_UP |
 730                                 TIPC_WAKEUP_BCAST_USERS | TIPC_BCAST_MSG_EVT |
 731                                 TIPC_NAMED_MSG_EVT | TIPC_BCAST_RESET);
 732
 733         spin_unlock_bh(&node->lock);
 734
 735         if (flags & TIPC_NOTIFY_NODE_DOWN)
 736                 tipc_publ_notify(net, publ_list, addr);
 737
 738         if (flags & TIPC_WAKEUP_BCAST_USERS)
 739                 tipc_bclink_wakeup_users(net);
 740
 741         if (flags & TIPC_NOTIFY_NODE_UP)
 742                 tipc_named_node_up(net, addr);
 743
 744         if (flags & TIPC_NOTIFY_LINK_UP)
 745                 tipc_nametbl_publish(net, TIPC_LINK_STATE, addr, addr,
 746                                      TIPC_NODE_SCOPE, link_id, addr);
 747
 748         if (flags & TIPC_NOTIFY_LINK_DOWN)
 749                 tipc_nametbl_withdraw(net, TIPC_LINK_STATE, addr,
 750                                       link_id, addr);
 751
 752         if (flags & TIPC_MSG_EVT)
 753                 tipc_sk_rcv(net, inputq);
 754
 755         if (flags & TIPC_NAMED_MSG_EVT)
 756                 tipc_named_rcv(net, namedq);
 757
 758         if (flags & TIPC_BCAST_MSG_EVT)
 759                 tipc_bclink_input(net);
 760
 761         if (flags & TIPC_BCAST_RESET)
 762                 tipc_node_reset_links(node);
 763 }
 764
 765 /* Caller should hold node lock for the passed node */
 766 static int __tipc_nl_add_node(struct tipc_nl_msg *msg, struct tipc_node *node)
 767 {
 768         void *hdr;
 769         struct nlattr *attrs;
 770
 771         hdr = genlmsg_put(msg->skb, msg->portid, msg->seq, &tipc_genl_family,
 772                           NLM_F_MULTI, TIPC_NL_NODE_GET);
 773         if (!hdr)
 774                 return -EMSGSIZE;
 775
 776         attrs = nla_nest_start(msg->skb, TIPC_NLA_NODE);
 777         if (!attrs)
 778                 goto msg_full;
 779
 780         if (nla_put_u32(msg->skb, TIPC_NLA_NODE_ADDR, node->addr))
 781                 goto attr_msg_full;
 782         if (tipc_node_is_up(node))
 783                 if (nla_put_flag(msg->skb, TIPC_NLA_NODE_UP))
 784                         goto attr_msg_full;
 785
 786         nla_nest_end(msg->skb, attrs);
 787         genlmsg_end(msg->skb, hdr);
 788
 789         return 0;
 790
 791 attr_msg_full:
 792         nla_nest_cancel(msg->skb, attrs);
 793 msg_full:
 794         genlmsg_cancel(msg->skb, hdr);
 795
 796         return -EMSGSIZE;
 797 }
 798
 799 static struct tipc_link *tipc_node_select_link(struct tipc_node *n, int sel,
 800                                                int *bearer_id,
 801                                                struct tipc_media_addr **maddr)
 802 {
 803         int id = n->active_links[sel & 1];
 804
 805         if (unlikely(id < 0))
 806                 return NULL;
 807
 808         *bearer_id = id;
 809         *maddr = &n->links[id].maddr;
 810         return n->links[id].link;
 811 }
 812
 813 /**
 814  * tipc_node_xmit() is the general link level function for message sending
 815  * @net: the applicable net namespace
 816  * @list: chain of buffers containing message
 817  * @dnode: address of destination node
 818  * @selector: a number used for deterministic link selection
 819  * Consumes the buffer chain, except when returning -ELINKCONG
 820  * Returns 0 if success, otherwise errno: -ELINKCONG,-EHOSTUNREACH,-EMSGSIZE
 821  */
 822 int tipc_node_xmit(struct net *net, struct sk_buff_head *list,
 823                    u32 dnode, int selector)
 824 {
 825         struct tipc_link *l = NULL;
 826         struct tipc_node *n;
 827         struct sk_buff_head xmitq;
 828         struct tipc_media_addr *maddr;
 829         int bearer_id;
 830         int rc = -EHOSTUNREACH;
 831
 832         __skb_queue_head_init(&xmitq);
 833         n = tipc_node_find(net, dnode);
 834         if (likely(n)) {
 835                 tipc_node_lock(n);
 836                 l = tipc_node_select_link(n, selector, &bearer_id, &maddr);
 837                 if (likely(l))
 838                         rc = tipc_link_xmit(l, list, &xmitq);
 839                 if (unlikely(rc == -ENOBUFS))
 840                         tipc_link_reset(l);
 841                 tipc_node_unlock(n);
 842                 tipc_node_put(n);
 843         }
 844         if (likely(!rc)) {
 845                 tipc_bearer_xmit(net, bearer_id, &xmitq, maddr);
 846                 return 0;
 847         }
 848         if (likely(in_own_node(net, dnode))) {
 849                 tipc_sk_rcv(net, list);
 850                 return 0;
 851         }
 852         return rc;
 853 }
 854
 855 /* tipc_node_xmit_skb(): send single buffer to destination
 856  * Buffers sent via this functon are generally TIPC_SYSTEM_IMPORTANCE
 857  * messages, which will not be rejected
 858  * The only exception is datagram messages rerouted after secondary
 859  * lookup, which are rare and safe to dispose of anyway.
 860  * TODO: Return real return value, and let callers use
 861  * tipc_wait_for_sendpkt() where applicable
 862  */
 863 int tipc_node_xmit_skb(struct net *net, struct sk_buff *skb, u32 dnode,
 864                        u32 selector)
 865 {
 866         struct sk_buff_head head;
 867         int rc;
 868
 869         skb_queue_head_init(&head);
 870         __skb_queue_tail(&head, skb);
 871         rc = tipc_node_xmit(net, &head, dnode, selector);
 872         if (rc == -ELINKCONG)
 873                 kfree_skb(skb);
 874         return 0;
 875 }
 876
 877 /* tipc_node_tnl_init(): handle a received TUNNEL_PROTOCOL packet,
 878  * in order to control parallel link failover or synchronization
 879  */
 880 static void tipc_node_tnl_init(struct tipc_node *n, int bearer_id,
 881                                struct sk_buff *skb)
 882 {
 883         struct tipc_link *tnl, *pl;
 884         struct tipc_msg *hdr = buf_msg(skb);
 885         u16 oseqno = msg_seqno(hdr);
 886         int pb_id = msg_bearer_id(hdr);
 887
 888         if (pb_id >= MAX_BEARERS)
 889                 return;
 890
 891         tnl = n->links[bearer_id].link;
 892         if (!tnl)
 893                 return;
 894
 895         /* Ignore if duplicate */
 896         if (less(oseqno, tnl->rcv_nxt))
 897                 return;
 898
 899         pl = n->links[pb_id].link;
 900         if (!pl)
 901                 return;
 902
 903         if (msg_type(hdr) == FAILOVER_MSG) {
 904                 if (tipc_link_is_up(pl)) {
 905                         tipc_link_reset(pl);
 906                         pl->exec_mode = TIPC_LINK_BLOCKED;
 907                 }
 908         }
 909 }
 910
 911 /**
 912  * tipc_rcv - process TIPC packets/messages arriving from off-node
 913  * @net: the applicable net namespace
 914  * @skb: TIPC packet
 915  * @bearer: pointer to bearer message arrived on
 916  *
 917  * Invoked with no locks held. Bearer pointer must point to a valid bearer
 918  * structure (i.e. cannot be NULL), but bearer can be inactive.
 919  */
 920 void tipc_rcv(struct net *net, struct sk_buff *skb, struct tipc_bearer *b)
 921 {
 922         struct sk_buff_head xmitq;
 923         struct tipc_node *n;
 924         struct tipc_link *l;
 925         struct tipc_msg *hdr;
 926         struct tipc_media_addr *maddr;
 927         int bearer_id = b->identity;
 928         int rc = 0;
 929         int usr;
 930
 931         __skb_queue_head_init(&xmitq);
 932
 933         /* Ensure message is well-formed */
 934         if (unlikely(!tipc_msg_validate(skb)))
 935                 goto discard;
 936
 937         /* Handle arrival of a non-unicast link packet */
 938         hdr = buf_msg(skb);
 939         usr = msg_user(hdr);
 940         if (unlikely(msg_non_seq(hdr))) {
 941                 if (usr ==  LINK_CONFIG)
 942                         tipc_disc_rcv(net, skb, b);
 943                 else
 944                         tipc_bclink_rcv(net, skb);
 945                 return;
 946         }
 947
 948         /* Locate neighboring node that sent packet */
 949         n = tipc_node_find(net, msg_prevnode(hdr));
 950         if (unlikely(!n))
 951                 goto discard;
 952         tipc_node_lock(n);
 953
 954         /* Prepare links for tunneled reception if applicable */
 955         if (unlikely(usr == TUNNEL_PROTOCOL))
 956                 tipc_node_tnl_init(n, bearer_id, skb);
 957
 958         /* Locate link endpoint that should handle packet */
 959         l = n->links[bearer_id].link;
 960         if (unlikely(!l))
 961                 goto unlock;
 962
 963         /* Is reception of this packet permitted at the moment ? */
 964         if (unlikely(n->state != SELF_UP_PEER_UP))
 965                 if (!tipc_node_filter_skb(n, l, hdr))
 966                         goto unlock;
 967
 968         if (unlikely(usr == LINK_PROTOCOL))
 969                 tipc_bclink_sync_state(n, hdr);
 970
 971         /* Release acked broadcast messages */
 972         if (unlikely(n->bclink.acked != msg_bcast_ack(hdr)))
 973                 tipc_bclink_acknowledge(n, msg_bcast_ack(hdr));
 974
 975         /* Check protocol and update link state */
 976         rc = tipc_link_rcv(l, skb, &xmitq);
 977
 978         if (unlikely(rc & TIPC_LINK_UP_EVT))
 979                 tipc_node_link_up(n, bearer_id);
 980         if (unlikely(rc & TIPC_LINK_DOWN_EVT))
 981                 tipc_link_reset(l);
 982         skb = NULL;
 983 unlock:
 984         tipc_node_unlock(n);
 985         tipc_sk_rcv(net, &n->links[bearer_id].inputq);
 986         maddr = &n->links[bearer_id].maddr;
 987         tipc_bearer_xmit(net, bearer_id, &xmitq, maddr);
 988         tipc_node_put(n);
 989 discard:
 990         kfree_skb(skb);
 991 }
 992
 993 int tipc_nl_node_dump(struct sk_buff *skb, struct netlink_callback *cb)
 994 {
 995         int err;
 996         struct net *net = sock_net(skb->sk);
 997         struct tipc_net *tn = net_generic(net, tipc_net_id);
 998         int done = cb->args[0];
 999         int last_addr = cb->args[1];
1000         struct tipc_node *node;
1001         struct tipc_nl_msg msg;
1002
1003         if (done)
1004                 return 0;
1005
1006         msg.skb = skb;
1007         msg.portid = NETLINK_CB(cb->skb).portid;
1008         msg.seq = cb->nlh->nlmsg_seq;
1009
1010         rcu_read_lock();
1011         if (last_addr) {
1012                 node = tipc_node_find(net, last_addr);
1013                 if (!node) {
1014                         rcu_read_unlock();
1015                         /* We never set seq or call nl_dump_check_consistent()
1016                          * this means that setting prev_seq here will cause the
1017                          * consistence check to fail in the netlink callback
1018                          * handler. Resulting in the NLMSG_DONE message having
1019                          * the NLM_F_DUMP_INTR flag set if the node state
1020                          * changed while we released the lock.
1021                          */
1022                         cb->prev_seq = 1;
1023                         return -EPIPE;
1024                 }
1025                 tipc_node_put(node);
1026         }
1027
1028         list_for_each_entry_rcu(node, &tn->node_list, list) {
1029                 if (last_addr) {
1030                         if (node->addr == last_addr)
1031                                 last_addr = 0;
1032                         else
1033                                 continue;
1034                 }
1035
1036                 tipc_node_lock(node);
1037                 err = __tipc_nl_add_node(&msg, node);
1038                 if (err) {
1039                         last_addr = node->addr;
1040                         tipc_node_unlock(node);
1041                         goto out;
1042                 }
1043
1044                 tipc_node_unlock(node);
1045         }
1046         done = 1;
1047 out:
1048         cb->args[0] = done;
1049         cb->args[1] = last_addr;
1050         rcu_read_unlock();
1051
1052         return skb->len;
1053 }