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