Merge tag 'time-namespace-v5.11' of git://git.kernel.org/pub/scm/linux/kernel/git...
[linux-2.6-microblaze.git] / net / tipc / node.c
1 /*
2  * net/tipc/node.c: TIPC node management routines
3  *
4  * Copyright (c) 2000-2006, 2012-2016, 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 "monitor.h"
44 #include "discover.h"
45 #include "netlink.h"
46 #include "trace.h"
47 #include "crypto.h"
48
49 #define INVALID_NODE_SIG        0x10000
50 #define NODE_CLEANUP_AFTER      300000
51
52 /* Flags used to take different actions according to flag type
53  * TIPC_NOTIFY_NODE_DOWN: notify node is down
54  * TIPC_NOTIFY_NODE_UP: notify node is up
55  * TIPC_DISTRIBUTE_NAME: publish or withdraw link state name type
56  */
57 enum {
58         TIPC_NOTIFY_NODE_DOWN           = (1 << 3),
59         TIPC_NOTIFY_NODE_UP             = (1 << 4),
60         TIPC_NOTIFY_LINK_UP             = (1 << 6),
61         TIPC_NOTIFY_LINK_DOWN           = (1 << 7)
62 };
63
64 struct tipc_link_entry {
65         struct tipc_link *link;
66         spinlock_t lock; /* per link */
67         u32 mtu;
68         struct sk_buff_head inputq;
69         struct tipc_media_addr maddr;
70 };
71
72 struct tipc_bclink_entry {
73         struct tipc_link *link;
74         struct sk_buff_head inputq1;
75         struct sk_buff_head arrvq;
76         struct sk_buff_head inputq2;
77         struct sk_buff_head namedq;
78         u16 named_rcv_nxt;
79         bool named_open;
80 };
81
82 /**
83  * struct tipc_node - TIPC node structure
84  * @addr: network address of node
85  * @ref: reference counter to node object
86  * @lock: rwlock governing access to structure
87  * @net: the applicable net namespace
88  * @hash: links to adjacent nodes in unsorted hash chain
89  * @inputq: pointer to input queue containing messages for msg event
90  * @namedq: pointer to name table input queue with name table messages
91  * @active_links: bearer ids of active links, used as index into links[] array
92  * @links: array containing references to all links to node
93  * @action_flags: bit mask of different types of node actions
94  * @state: connectivity state vs peer node
95  * @preliminary: a preliminary node or not
96  * @sync_point: sequence number where synch/failover is finished
97  * @list: links to adjacent nodes in sorted list of cluster's nodes
98  * @working_links: number of working links to node (both active and standby)
99  * @link_cnt: number of links to node
100  * @capabilities: bitmap, indicating peer node's functional capabilities
101  * @signature: node instance identifier
102  * @link_id: local and remote bearer ids of changing link, if any
103  * @publ_list: list of publications
104  * @rcu: rcu struct for tipc_node
105  * @delete_at: indicates the time for deleting a down node
106  * @crypto_rx: RX crypto handler
107  */
108 struct tipc_node {
109         u32 addr;
110         struct kref kref;
111         rwlock_t lock;
112         struct net *net;
113         struct hlist_node hash;
114         int active_links[2];
115         struct tipc_link_entry links[MAX_BEARERS];
116         struct tipc_bclink_entry bc_entry;
117         int action_flags;
118         struct list_head list;
119         int state;
120         bool preliminary;
121         bool failover_sent;
122         u16 sync_point;
123         int link_cnt;
124         u16 working_links;
125         u16 capabilities;
126         u32 signature;
127         u32 link_id;
128         u8 peer_id[16];
129         char peer_id_string[NODE_ID_STR_LEN];
130         struct list_head publ_list;
131         struct list_head conn_sks;
132         unsigned long keepalive_intv;
133         struct timer_list timer;
134         struct rcu_head rcu;
135         unsigned long delete_at;
136         struct net *peer_net;
137         u32 peer_hash_mix;
138 #ifdef CONFIG_TIPC_CRYPTO
139         struct tipc_crypto *crypto_rx;
140 #endif
141 };
142
143 /* Node FSM states and events:
144  */
145 enum {
146         SELF_DOWN_PEER_DOWN    = 0xdd,
147         SELF_UP_PEER_UP        = 0xaa,
148         SELF_DOWN_PEER_LEAVING = 0xd1,
149         SELF_UP_PEER_COMING    = 0xac,
150         SELF_COMING_PEER_UP    = 0xca,
151         SELF_LEAVING_PEER_DOWN = 0x1d,
152         NODE_FAILINGOVER       = 0xf0,
153         NODE_SYNCHING          = 0xcc
154 };
155
156 enum {
157         SELF_ESTABL_CONTACT_EVT = 0xece,
158         SELF_LOST_CONTACT_EVT   = 0x1ce,
159         PEER_ESTABL_CONTACT_EVT = 0x9ece,
160         PEER_LOST_CONTACT_EVT   = 0x91ce,
161         NODE_FAILOVER_BEGIN_EVT = 0xfbe,
162         NODE_FAILOVER_END_EVT   = 0xfee,
163         NODE_SYNCH_BEGIN_EVT    = 0xcbe,
164         NODE_SYNCH_END_EVT      = 0xcee
165 };
166
167 static void __tipc_node_link_down(struct tipc_node *n, int *bearer_id,
168                                   struct sk_buff_head *xmitq,
169                                   struct tipc_media_addr **maddr);
170 static void tipc_node_link_down(struct tipc_node *n, int bearer_id,
171                                 bool delete);
172 static void node_lost_contact(struct tipc_node *n, struct sk_buff_head *inputq);
173 static void tipc_node_delete(struct tipc_node *node);
174 static void tipc_node_timeout(struct timer_list *t);
175 static void tipc_node_fsm_evt(struct tipc_node *n, int evt);
176 static struct tipc_node *tipc_node_find(struct net *net, u32 addr);
177 static struct tipc_node *tipc_node_find_by_id(struct net *net, u8 *id);
178 static bool node_is_up(struct tipc_node *n);
179 static void tipc_node_delete_from_list(struct tipc_node *node);
180
181 struct tipc_sock_conn {
182         u32 port;
183         u32 peer_port;
184         u32 peer_node;
185         struct list_head list;
186 };
187
188 static struct tipc_link *node_active_link(struct tipc_node *n, int sel)
189 {
190         int bearer_id = n->active_links[sel & 1];
191
192         if (unlikely(bearer_id == INVALID_BEARER_ID))
193                 return NULL;
194
195         return n->links[bearer_id].link;
196 }
197
198 int tipc_node_get_mtu(struct net *net, u32 addr, u32 sel, bool connected)
199 {
200         struct tipc_node *n;
201         int bearer_id;
202         unsigned int mtu = MAX_MSG_SIZE;
203
204         n = tipc_node_find(net, addr);
205         if (unlikely(!n))
206                 return mtu;
207
208         /* Allow MAX_MSG_SIZE when building connection oriented message
209          * if they are in the same core network
210          */
211         if (n->peer_net && connected) {
212                 tipc_node_put(n);
213                 return mtu;
214         }
215
216         bearer_id = n->active_links[sel & 1];
217         if (likely(bearer_id != INVALID_BEARER_ID))
218                 mtu = n->links[bearer_id].mtu;
219         tipc_node_put(n);
220         return mtu;
221 }
222
223 bool tipc_node_get_id(struct net *net, u32 addr, u8 *id)
224 {
225         u8 *own_id = tipc_own_id(net);
226         struct tipc_node *n;
227
228         if (!own_id)
229                 return true;
230
231         if (addr == tipc_own_addr(net)) {
232                 memcpy(id, own_id, TIPC_NODEID_LEN);
233                 return true;
234         }
235         n = tipc_node_find(net, addr);
236         if (!n)
237                 return false;
238
239         memcpy(id, &n->peer_id, TIPC_NODEID_LEN);
240         tipc_node_put(n);
241         return true;
242 }
243
244 u16 tipc_node_get_capabilities(struct net *net, u32 addr)
245 {
246         struct tipc_node *n;
247         u16 caps;
248
249         n = tipc_node_find(net, addr);
250         if (unlikely(!n))
251                 return TIPC_NODE_CAPABILITIES;
252         caps = n->capabilities;
253         tipc_node_put(n);
254         return caps;
255 }
256
257 u32 tipc_node_get_addr(struct tipc_node *node)
258 {
259         return (node) ? node->addr : 0;
260 }
261
262 char *tipc_node_get_id_str(struct tipc_node *node)
263 {
264         return node->peer_id_string;
265 }
266
267 #ifdef CONFIG_TIPC_CRYPTO
268 /**
269  * tipc_node_crypto_rx - Retrieve crypto RX handle from node
270  * Note: node ref counter must be held first!
271  */
272 struct tipc_crypto *tipc_node_crypto_rx(struct tipc_node *__n)
273 {
274         return (__n) ? __n->crypto_rx : NULL;
275 }
276
277 struct tipc_crypto *tipc_node_crypto_rx_by_list(struct list_head *pos)
278 {
279         return container_of(pos, struct tipc_node, list)->crypto_rx;
280 }
281
282 struct tipc_crypto *tipc_node_crypto_rx_by_addr(struct net *net, u32 addr)
283 {
284         struct tipc_node *n;
285
286         n = tipc_node_find(net, addr);
287         return (n) ? n->crypto_rx : NULL;
288 }
289 #endif
290
291 static void tipc_node_free(struct rcu_head *rp)
292 {
293         struct tipc_node *n = container_of(rp, struct tipc_node, rcu);
294
295 #ifdef CONFIG_TIPC_CRYPTO
296         tipc_crypto_stop(&n->crypto_rx);
297 #endif
298         kfree(n);
299 }
300
301 static void tipc_node_kref_release(struct kref *kref)
302 {
303         struct tipc_node *n = container_of(kref, struct tipc_node, kref);
304
305         kfree(n->bc_entry.link);
306         call_rcu(&n->rcu, tipc_node_free);
307 }
308
309 void tipc_node_put(struct tipc_node *node)
310 {
311         kref_put(&node->kref, tipc_node_kref_release);
312 }
313
314 void tipc_node_get(struct tipc_node *node)
315 {
316         kref_get(&node->kref);
317 }
318
319 /*
320  * tipc_node_find - locate specified node object, if it exists
321  */
322 static struct tipc_node *tipc_node_find(struct net *net, u32 addr)
323 {
324         struct tipc_net *tn = tipc_net(net);
325         struct tipc_node *node;
326         unsigned int thash = tipc_hashfn(addr);
327
328         rcu_read_lock();
329         hlist_for_each_entry_rcu(node, &tn->node_htable[thash], hash) {
330                 if (node->addr != addr || node->preliminary)
331                         continue;
332                 if (!kref_get_unless_zero(&node->kref))
333                         node = NULL;
334                 break;
335         }
336         rcu_read_unlock();
337         return node;
338 }
339
340 /* tipc_node_find_by_id - locate specified node object by its 128-bit id
341  * Note: this function is called only when a discovery request failed
342  * to find the node by its 32-bit id, and is not time critical
343  */
344 static struct tipc_node *tipc_node_find_by_id(struct net *net, u8 *id)
345 {
346         struct tipc_net *tn = tipc_net(net);
347         struct tipc_node *n;
348         bool found = false;
349
350         rcu_read_lock();
351         list_for_each_entry_rcu(n, &tn->node_list, list) {
352                 read_lock_bh(&n->lock);
353                 if (!memcmp(id, n->peer_id, 16) &&
354                     kref_get_unless_zero(&n->kref))
355                         found = true;
356                 read_unlock_bh(&n->lock);
357                 if (found)
358                         break;
359         }
360         rcu_read_unlock();
361         return found ? n : NULL;
362 }
363
364 static void tipc_node_read_lock(struct tipc_node *n)
365 {
366         read_lock_bh(&n->lock);
367 }
368
369 static void tipc_node_read_unlock(struct tipc_node *n)
370 {
371         read_unlock_bh(&n->lock);
372 }
373
374 static void tipc_node_write_lock(struct tipc_node *n)
375 {
376         write_lock_bh(&n->lock);
377 }
378
379 static void tipc_node_write_unlock_fast(struct tipc_node *n)
380 {
381         write_unlock_bh(&n->lock);
382 }
383
384 static void tipc_node_write_unlock(struct tipc_node *n)
385 {
386         struct net *net = n->net;
387         u32 addr = 0;
388         u32 flags = n->action_flags;
389         u32 link_id = 0;
390         u32 bearer_id;
391         struct list_head *publ_list;
392
393         if (likely(!flags)) {
394                 write_unlock_bh(&n->lock);
395                 return;
396         }
397
398         addr = n->addr;
399         link_id = n->link_id;
400         bearer_id = link_id & 0xffff;
401         publ_list = &n->publ_list;
402
403         n->action_flags &= ~(TIPC_NOTIFY_NODE_DOWN | TIPC_NOTIFY_NODE_UP |
404                              TIPC_NOTIFY_LINK_DOWN | TIPC_NOTIFY_LINK_UP);
405
406         write_unlock_bh(&n->lock);
407
408         if (flags & TIPC_NOTIFY_NODE_DOWN)
409                 tipc_publ_notify(net, publ_list, addr, n->capabilities);
410
411         if (flags & TIPC_NOTIFY_NODE_UP)
412                 tipc_named_node_up(net, addr, n->capabilities);
413
414         if (flags & TIPC_NOTIFY_LINK_UP) {
415                 tipc_mon_peer_up(net, addr, bearer_id);
416                 tipc_nametbl_publish(net, TIPC_LINK_STATE, addr, addr,
417                                      TIPC_NODE_SCOPE, link_id, link_id);
418         }
419         if (flags & TIPC_NOTIFY_LINK_DOWN) {
420                 tipc_mon_peer_down(net, addr, bearer_id);
421                 tipc_nametbl_withdraw(net, TIPC_LINK_STATE, addr,
422                                       addr, link_id);
423         }
424 }
425
426 static void tipc_node_assign_peer_net(struct tipc_node *n, u32 hash_mixes)
427 {
428         int net_id = tipc_netid(n->net);
429         struct tipc_net *tn_peer;
430         struct net *tmp;
431         u32 hash_chk;
432
433         if (n->peer_net)
434                 return;
435
436         for_each_net_rcu(tmp) {
437                 tn_peer = tipc_net(tmp);
438                 if (!tn_peer)
439                         continue;
440                 /* Integrity checking whether node exists in namespace or not */
441                 if (tn_peer->net_id != net_id)
442                         continue;
443                 if (memcmp(n->peer_id, tn_peer->node_id, NODE_ID_LEN))
444                         continue;
445                 hash_chk = tipc_net_hash_mixes(tmp, tn_peer->random);
446                 if (hash_mixes ^ hash_chk)
447                         continue;
448                 n->peer_net = tmp;
449                 n->peer_hash_mix = hash_mixes;
450                 break;
451         }
452 }
453
454 struct tipc_node *tipc_node_create(struct net *net, u32 addr, u8 *peer_id,
455                                    u16 capabilities, u32 hash_mixes,
456                                    bool preliminary)
457 {
458         struct tipc_net *tn = net_generic(net, tipc_net_id);
459         struct tipc_node *n, *temp_node;
460         struct tipc_link *l;
461         unsigned long intv;
462         int bearer_id;
463         int i;
464
465         spin_lock_bh(&tn->node_list_lock);
466         n = tipc_node_find(net, addr) ?:
467                 tipc_node_find_by_id(net, peer_id);
468         if (n) {
469                 if (!n->preliminary)
470                         goto update;
471                 if (preliminary)
472                         goto exit;
473                 /* A preliminary node becomes "real" now, refresh its data */
474                 tipc_node_write_lock(n);
475                 n->preliminary = false;
476                 n->addr = addr;
477                 hlist_del_rcu(&n->hash);
478                 hlist_add_head_rcu(&n->hash,
479                                    &tn->node_htable[tipc_hashfn(addr)]);
480                 list_del_rcu(&n->list);
481                 list_for_each_entry_rcu(temp_node, &tn->node_list, list) {
482                         if (n->addr < temp_node->addr)
483                                 break;
484                 }
485                 list_add_tail_rcu(&n->list, &temp_node->list);
486                 tipc_node_write_unlock_fast(n);
487
488 update:
489                 if (n->peer_hash_mix ^ hash_mixes)
490                         tipc_node_assign_peer_net(n, hash_mixes);
491                 if (n->capabilities == capabilities)
492                         goto exit;
493                 /* Same node may come back with new capabilities */
494                 tipc_node_write_lock(n);
495                 n->capabilities = capabilities;
496                 for (bearer_id = 0; bearer_id < MAX_BEARERS; bearer_id++) {
497                         l = n->links[bearer_id].link;
498                         if (l)
499                                 tipc_link_update_caps(l, capabilities);
500                 }
501                 tipc_node_write_unlock_fast(n);
502
503                 /* Calculate cluster capabilities */
504                 tn->capabilities = TIPC_NODE_CAPABILITIES;
505                 list_for_each_entry_rcu(temp_node, &tn->node_list, list) {
506                         tn->capabilities &= temp_node->capabilities;
507                 }
508
509                 tipc_bcast_toggle_rcast(net,
510                                         (tn->capabilities & TIPC_BCAST_RCAST));
511
512                 goto exit;
513         }
514         n = kzalloc(sizeof(*n), GFP_ATOMIC);
515         if (!n) {
516                 pr_warn("Node creation failed, no memory\n");
517                 goto exit;
518         }
519         tipc_nodeid2string(n->peer_id_string, peer_id);
520 #ifdef CONFIG_TIPC_CRYPTO
521         if (unlikely(tipc_crypto_start(&n->crypto_rx, net, n))) {
522                 pr_warn("Failed to start crypto RX(%s)!\n", n->peer_id_string);
523                 kfree(n);
524                 n = NULL;
525                 goto exit;
526         }
527 #endif
528         n->addr = addr;
529         n->preliminary = preliminary;
530         memcpy(&n->peer_id, peer_id, 16);
531         n->net = net;
532         n->peer_net = NULL;
533         n->peer_hash_mix = 0;
534         /* Assign kernel local namespace if exists */
535         tipc_node_assign_peer_net(n, hash_mixes);
536         n->capabilities = capabilities;
537         kref_init(&n->kref);
538         rwlock_init(&n->lock);
539         INIT_HLIST_NODE(&n->hash);
540         INIT_LIST_HEAD(&n->list);
541         INIT_LIST_HEAD(&n->publ_list);
542         INIT_LIST_HEAD(&n->conn_sks);
543         skb_queue_head_init(&n->bc_entry.namedq);
544         skb_queue_head_init(&n->bc_entry.inputq1);
545         __skb_queue_head_init(&n->bc_entry.arrvq);
546         skb_queue_head_init(&n->bc_entry.inputq2);
547         for (i = 0; i < MAX_BEARERS; i++)
548                 spin_lock_init(&n->links[i].lock);
549         n->state = SELF_DOWN_PEER_LEAVING;
550         n->delete_at = jiffies + msecs_to_jiffies(NODE_CLEANUP_AFTER);
551         n->signature = INVALID_NODE_SIG;
552         n->active_links[0] = INVALID_BEARER_ID;
553         n->active_links[1] = INVALID_BEARER_ID;
554         n->bc_entry.link = NULL;
555         tipc_node_get(n);
556         timer_setup(&n->timer, tipc_node_timeout, 0);
557         /* Start a slow timer anyway, crypto needs it */
558         n->keepalive_intv = 10000;
559         intv = jiffies + msecs_to_jiffies(n->keepalive_intv);
560         if (!mod_timer(&n->timer, intv))
561                 tipc_node_get(n);
562         hlist_add_head_rcu(&n->hash, &tn->node_htable[tipc_hashfn(addr)]);
563         list_for_each_entry_rcu(temp_node, &tn->node_list, list) {
564                 if (n->addr < temp_node->addr)
565                         break;
566         }
567         list_add_tail_rcu(&n->list, &temp_node->list);
568         /* Calculate cluster capabilities */
569         tn->capabilities = TIPC_NODE_CAPABILITIES;
570         list_for_each_entry_rcu(temp_node, &tn->node_list, list) {
571                 tn->capabilities &= temp_node->capabilities;
572         }
573         tipc_bcast_toggle_rcast(net, (tn->capabilities & TIPC_BCAST_RCAST));
574         trace_tipc_node_create(n, true, " ");
575 exit:
576         spin_unlock_bh(&tn->node_list_lock);
577         return n;
578 }
579
580 static void tipc_node_calculate_timer(struct tipc_node *n, struct tipc_link *l)
581 {
582         unsigned long tol = tipc_link_tolerance(l);
583         unsigned long intv = ((tol / 4) > 500) ? 500 : tol / 4;
584
585         /* Link with lowest tolerance determines timer interval */
586         if (intv < n->keepalive_intv)
587                 n->keepalive_intv = intv;
588
589         /* Ensure link's abort limit corresponds to current tolerance */
590         tipc_link_set_abort_limit(l, tol / n->keepalive_intv);
591 }
592
593 static void tipc_node_delete_from_list(struct tipc_node *node)
594 {
595 #ifdef CONFIG_TIPC_CRYPTO
596         tipc_crypto_key_flush(node->crypto_rx);
597 #endif
598         list_del_rcu(&node->list);
599         hlist_del_rcu(&node->hash);
600         tipc_node_put(node);
601 }
602
603 static void tipc_node_delete(struct tipc_node *node)
604 {
605         trace_tipc_node_delete(node, true, " ");
606         tipc_node_delete_from_list(node);
607
608         del_timer_sync(&node->timer);
609         tipc_node_put(node);
610 }
611
612 void tipc_node_stop(struct net *net)
613 {
614         struct tipc_net *tn = tipc_net(net);
615         struct tipc_node *node, *t_node;
616
617         spin_lock_bh(&tn->node_list_lock);
618         list_for_each_entry_safe(node, t_node, &tn->node_list, list)
619                 tipc_node_delete(node);
620         spin_unlock_bh(&tn->node_list_lock);
621 }
622
623 void tipc_node_subscribe(struct net *net, struct list_head *subscr, u32 addr)
624 {
625         struct tipc_node *n;
626
627         if (in_own_node(net, addr))
628                 return;
629
630         n = tipc_node_find(net, addr);
631         if (!n) {
632                 pr_warn("Node subscribe rejected, unknown node 0x%x\n", addr);
633                 return;
634         }
635         tipc_node_write_lock(n);
636         list_add_tail(subscr, &n->publ_list);
637         tipc_node_write_unlock_fast(n);
638         tipc_node_put(n);
639 }
640
641 void tipc_node_unsubscribe(struct net *net, struct list_head *subscr, u32 addr)
642 {
643         struct tipc_node *n;
644
645         if (in_own_node(net, addr))
646                 return;
647
648         n = tipc_node_find(net, addr);
649         if (!n) {
650                 pr_warn("Node unsubscribe rejected, unknown node 0x%x\n", addr);
651                 return;
652         }
653         tipc_node_write_lock(n);
654         list_del_init(subscr);
655         tipc_node_write_unlock_fast(n);
656         tipc_node_put(n);
657 }
658
659 int tipc_node_add_conn(struct net *net, u32 dnode, u32 port, u32 peer_port)
660 {
661         struct tipc_node *node;
662         struct tipc_sock_conn *conn;
663         int err = 0;
664
665         if (in_own_node(net, dnode))
666                 return 0;
667
668         node = tipc_node_find(net, dnode);
669         if (!node) {
670                 pr_warn("Connecting sock to node 0x%x failed\n", dnode);
671                 return -EHOSTUNREACH;
672         }
673         conn = kmalloc(sizeof(*conn), GFP_ATOMIC);
674         if (!conn) {
675                 err = -EHOSTUNREACH;
676                 goto exit;
677         }
678         conn->peer_node = dnode;
679         conn->port = port;
680         conn->peer_port = peer_port;
681
682         tipc_node_write_lock(node);
683         list_add_tail(&conn->list, &node->conn_sks);
684         tipc_node_write_unlock(node);
685 exit:
686         tipc_node_put(node);
687         return err;
688 }
689
690 void tipc_node_remove_conn(struct net *net, u32 dnode, u32 port)
691 {
692         struct tipc_node *node;
693         struct tipc_sock_conn *conn, *safe;
694
695         if (in_own_node(net, dnode))
696                 return;
697
698         node = tipc_node_find(net, dnode);
699         if (!node)
700                 return;
701
702         tipc_node_write_lock(node);
703         list_for_each_entry_safe(conn, safe, &node->conn_sks, list) {
704                 if (port != conn->port)
705                         continue;
706                 list_del(&conn->list);
707                 kfree(conn);
708         }
709         tipc_node_write_unlock(node);
710         tipc_node_put(node);
711 }
712
713 static void  tipc_node_clear_links(struct tipc_node *node)
714 {
715         int i;
716
717         for (i = 0; i < MAX_BEARERS; i++) {
718                 struct tipc_link_entry *le = &node->links[i];
719
720                 if (le->link) {
721                         kfree(le->link);
722                         le->link = NULL;
723                         node->link_cnt--;
724                 }
725         }
726 }
727
728 /* tipc_node_cleanup - delete nodes that does not
729  * have active links for NODE_CLEANUP_AFTER time
730  */
731 static bool tipc_node_cleanup(struct tipc_node *peer)
732 {
733         struct tipc_node *temp_node;
734         struct tipc_net *tn = tipc_net(peer->net);
735         bool deleted = false;
736
737         /* If lock held by tipc_node_stop() the node will be deleted anyway */
738         if (!spin_trylock_bh(&tn->node_list_lock))
739                 return false;
740
741         tipc_node_write_lock(peer);
742
743         if (!node_is_up(peer) && time_after(jiffies, peer->delete_at)) {
744                 tipc_node_clear_links(peer);
745                 tipc_node_delete_from_list(peer);
746                 deleted = true;
747         }
748         tipc_node_write_unlock(peer);
749
750         if (!deleted) {
751                 spin_unlock_bh(&tn->node_list_lock);
752                 return deleted;
753         }
754
755         /* Calculate cluster capabilities */
756         tn->capabilities = TIPC_NODE_CAPABILITIES;
757         list_for_each_entry_rcu(temp_node, &tn->node_list, list) {
758                 tn->capabilities &= temp_node->capabilities;
759         }
760         tipc_bcast_toggle_rcast(peer->net,
761                                 (tn->capabilities & TIPC_BCAST_RCAST));
762         spin_unlock_bh(&tn->node_list_lock);
763         return deleted;
764 }
765
766 /* tipc_node_timeout - handle expiration of node timer
767  */
768 static void tipc_node_timeout(struct timer_list *t)
769 {
770         struct tipc_node *n = from_timer(n, t, timer);
771         struct tipc_link_entry *le;
772         struct sk_buff_head xmitq;
773         int remains = n->link_cnt;
774         int bearer_id;
775         int rc = 0;
776
777         trace_tipc_node_timeout(n, false, " ");
778         if (!node_is_up(n) && tipc_node_cleanup(n)) {
779                 /*Removing the reference of Timer*/
780                 tipc_node_put(n);
781                 return;
782         }
783
784 #ifdef CONFIG_TIPC_CRYPTO
785         /* Take any crypto key related actions first */
786         tipc_crypto_timeout(n->crypto_rx);
787 #endif
788         __skb_queue_head_init(&xmitq);
789
790         /* Initial node interval to value larger (10 seconds), then it will be
791          * recalculated with link lowest tolerance
792          */
793         tipc_node_read_lock(n);
794         n->keepalive_intv = 10000;
795         tipc_node_read_unlock(n);
796         for (bearer_id = 0; remains && (bearer_id < MAX_BEARERS); bearer_id++) {
797                 tipc_node_read_lock(n);
798                 le = &n->links[bearer_id];
799                 if (le->link) {
800                         spin_lock_bh(&le->lock);
801                         /* Link tolerance may change asynchronously: */
802                         tipc_node_calculate_timer(n, le->link);
803                         rc = tipc_link_timeout(le->link, &xmitq);
804                         spin_unlock_bh(&le->lock);
805                         remains--;
806                 }
807                 tipc_node_read_unlock(n);
808                 tipc_bearer_xmit(n->net, bearer_id, &xmitq, &le->maddr, n);
809                 if (rc & TIPC_LINK_DOWN_EVT)
810                         tipc_node_link_down(n, bearer_id, false);
811         }
812         mod_timer(&n->timer, jiffies + msecs_to_jiffies(n->keepalive_intv));
813 }
814
815 /**
816  * __tipc_node_link_up - handle addition of link
817  * Node lock must be held by caller
818  * Link becomes active (alone or shared) or standby, depending on its priority.
819  */
820 static void __tipc_node_link_up(struct tipc_node *n, int bearer_id,
821                                 struct sk_buff_head *xmitq)
822 {
823         int *slot0 = &n->active_links[0];
824         int *slot1 = &n->active_links[1];
825         struct tipc_link *ol = node_active_link(n, 0);
826         struct tipc_link *nl = n->links[bearer_id].link;
827
828         if (!nl || tipc_link_is_up(nl))
829                 return;
830
831         tipc_link_fsm_evt(nl, LINK_ESTABLISH_EVT);
832         if (!tipc_link_is_up(nl))
833                 return;
834
835         n->working_links++;
836         n->action_flags |= TIPC_NOTIFY_LINK_UP;
837         n->link_id = tipc_link_id(nl);
838
839         /* Leave room for tunnel header when returning 'mtu' to users: */
840         n->links[bearer_id].mtu = tipc_link_mss(nl);
841
842         tipc_bearer_add_dest(n->net, bearer_id, n->addr);
843         tipc_bcast_inc_bearer_dst_cnt(n->net, bearer_id);
844
845         pr_debug("Established link <%s> on network plane %c\n",
846                  tipc_link_name(nl), tipc_link_plane(nl));
847         trace_tipc_node_link_up(n, true, " ");
848
849         /* Ensure that a STATE message goes first */
850         tipc_link_build_state_msg(nl, xmitq);
851
852         /* First link? => give it both slots */
853         if (!ol) {
854                 *slot0 = bearer_id;
855                 *slot1 = bearer_id;
856                 tipc_node_fsm_evt(n, SELF_ESTABL_CONTACT_EVT);
857                 n->action_flags |= TIPC_NOTIFY_NODE_UP;
858                 tipc_link_set_active(nl, true);
859                 tipc_bcast_add_peer(n->net, nl, xmitq);
860                 return;
861         }
862
863         /* Second link => redistribute slots */
864         if (tipc_link_prio(nl) > tipc_link_prio(ol)) {
865                 pr_debug("Old link <%s> becomes standby\n", tipc_link_name(ol));
866                 *slot0 = bearer_id;
867                 *slot1 = bearer_id;
868                 tipc_link_set_active(nl, true);
869                 tipc_link_set_active(ol, false);
870         } else if (tipc_link_prio(nl) == tipc_link_prio(ol)) {
871                 tipc_link_set_active(nl, true);
872                 *slot1 = bearer_id;
873         } else {
874                 pr_debug("New link <%s> is standby\n", tipc_link_name(nl));
875         }
876
877         /* Prepare synchronization with first link */
878         tipc_link_tnl_prepare(ol, nl, SYNCH_MSG, xmitq);
879 }
880
881 /**
882  * tipc_node_link_up - handle addition of link
883  *
884  * Link becomes active (alone or shared) or standby, depending on its priority.
885  */
886 static void tipc_node_link_up(struct tipc_node *n, int bearer_id,
887                               struct sk_buff_head *xmitq)
888 {
889         struct tipc_media_addr *maddr;
890
891         tipc_node_write_lock(n);
892         __tipc_node_link_up(n, bearer_id, xmitq);
893         maddr = &n->links[bearer_id].maddr;
894         tipc_bearer_xmit(n->net, bearer_id, xmitq, maddr, n);
895         tipc_node_write_unlock(n);
896 }
897
898 /**
899  * tipc_node_link_failover() - start failover in case "half-failover"
900  *
901  * This function is only called in a very special situation where link
902  * failover can be already started on peer node but not on this node.
903  * This can happen when e.g.
904  *      1. Both links <1A-2A>, <1B-2B> down
905  *      2. Link endpoint 2A up, but 1A still down (e.g. due to network
906  *         disturbance, wrong session, etc.)
907  *      3. Link <1B-2B> up
908  *      4. Link endpoint 2A down (e.g. due to link tolerance timeout)
909  *      5. Node 2 starts failover onto link <1B-2B>
910  *
911  *      ==> Node 1 does never start link/node failover!
912  *
913  * @n: tipc node structure
914  * @l: link peer endpoint failingover (- can be NULL)
915  * @tnl: tunnel link
916  * @xmitq: queue for messages to be xmited on tnl link later
917  */
918 static void tipc_node_link_failover(struct tipc_node *n, struct tipc_link *l,
919                                     struct tipc_link *tnl,
920                                     struct sk_buff_head *xmitq)
921 {
922         /* Avoid to be "self-failover" that can never end */
923         if (!tipc_link_is_up(tnl))
924                 return;
925
926         /* Don't rush, failure link may be in the process of resetting */
927         if (l && !tipc_link_is_reset(l))
928                 return;
929
930         tipc_link_fsm_evt(tnl, LINK_SYNCH_END_EVT);
931         tipc_node_fsm_evt(n, NODE_SYNCH_END_EVT);
932
933         n->sync_point = tipc_link_rcv_nxt(tnl) + (U16_MAX / 2 - 1);
934         tipc_link_failover_prepare(l, tnl, xmitq);
935
936         if (l)
937                 tipc_link_fsm_evt(l, LINK_FAILOVER_BEGIN_EVT);
938         tipc_node_fsm_evt(n, NODE_FAILOVER_BEGIN_EVT);
939 }
940
941 /**
942  * __tipc_node_link_down - handle loss of link
943  */
944 static void __tipc_node_link_down(struct tipc_node *n, int *bearer_id,
945                                   struct sk_buff_head *xmitq,
946                                   struct tipc_media_addr **maddr)
947 {
948         struct tipc_link_entry *le = &n->links[*bearer_id];
949         int *slot0 = &n->active_links[0];
950         int *slot1 = &n->active_links[1];
951         int i, highest = 0, prio;
952         struct tipc_link *l, *_l, *tnl;
953
954         l = n->links[*bearer_id].link;
955         if (!l || tipc_link_is_reset(l))
956                 return;
957
958         n->working_links--;
959         n->action_flags |= TIPC_NOTIFY_LINK_DOWN;
960         n->link_id = tipc_link_id(l);
961
962         tipc_bearer_remove_dest(n->net, *bearer_id, n->addr);
963
964         pr_debug("Lost link <%s> on network plane %c\n",
965                  tipc_link_name(l), tipc_link_plane(l));
966
967         /* Select new active link if any available */
968         *slot0 = INVALID_BEARER_ID;
969         *slot1 = INVALID_BEARER_ID;
970         for (i = 0; i < MAX_BEARERS; i++) {
971                 _l = n->links[i].link;
972                 if (!_l || !tipc_link_is_up(_l))
973                         continue;
974                 if (_l == l)
975                         continue;
976                 prio = tipc_link_prio(_l);
977                 if (prio < highest)
978                         continue;
979                 if (prio > highest) {
980                         highest = prio;
981                         *slot0 = i;
982                         *slot1 = i;
983                         continue;
984                 }
985                 *slot1 = i;
986         }
987
988         if (!node_is_up(n)) {
989                 if (tipc_link_peer_is_down(l))
990                         tipc_node_fsm_evt(n, PEER_LOST_CONTACT_EVT);
991                 tipc_node_fsm_evt(n, SELF_LOST_CONTACT_EVT);
992                 trace_tipc_link_reset(l, TIPC_DUMP_ALL, "link down!");
993                 tipc_link_fsm_evt(l, LINK_RESET_EVT);
994                 tipc_link_reset(l);
995                 tipc_link_build_reset_msg(l, xmitq);
996                 *maddr = &n->links[*bearer_id].maddr;
997                 node_lost_contact(n, &le->inputq);
998                 tipc_bcast_dec_bearer_dst_cnt(n->net, *bearer_id);
999                 return;
1000         }
1001         tipc_bcast_dec_bearer_dst_cnt(n->net, *bearer_id);
1002
1003         /* There is still a working link => initiate failover */
1004         *bearer_id = n->active_links[0];
1005         tnl = n->links[*bearer_id].link;
1006         tipc_link_fsm_evt(tnl, LINK_SYNCH_END_EVT);
1007         tipc_node_fsm_evt(n, NODE_SYNCH_END_EVT);
1008         n->sync_point = tipc_link_rcv_nxt(tnl) + (U16_MAX / 2 - 1);
1009         tipc_link_tnl_prepare(l, tnl, FAILOVER_MSG, xmitq);
1010         trace_tipc_link_reset(l, TIPC_DUMP_ALL, "link down -> failover!");
1011         tipc_link_reset(l);
1012         tipc_link_fsm_evt(l, LINK_RESET_EVT);
1013         tipc_link_fsm_evt(l, LINK_FAILOVER_BEGIN_EVT);
1014         tipc_node_fsm_evt(n, NODE_FAILOVER_BEGIN_EVT);
1015         *maddr = &n->links[*bearer_id].maddr;
1016 }
1017
1018 static void tipc_node_link_down(struct tipc_node *n, int bearer_id, bool delete)
1019 {
1020         struct tipc_link_entry *le = &n->links[bearer_id];
1021         struct tipc_media_addr *maddr = NULL;
1022         struct tipc_link *l = le->link;
1023         int old_bearer_id = bearer_id;
1024         struct sk_buff_head xmitq;
1025
1026         if (!l)
1027                 return;
1028
1029         __skb_queue_head_init(&xmitq);
1030
1031         tipc_node_write_lock(n);
1032         if (!tipc_link_is_establishing(l)) {
1033                 __tipc_node_link_down(n, &bearer_id, &xmitq, &maddr);
1034         } else {
1035                 /* Defuse pending tipc_node_link_up() */
1036                 tipc_link_reset(l);
1037                 tipc_link_fsm_evt(l, LINK_RESET_EVT);
1038         }
1039         if (delete) {
1040                 kfree(l);
1041                 le->link = NULL;
1042                 n->link_cnt--;
1043         }
1044         trace_tipc_node_link_down(n, true, "node link down or deleted!");
1045         tipc_node_write_unlock(n);
1046         if (delete)
1047                 tipc_mon_remove_peer(n->net, n->addr, old_bearer_id);
1048         if (!skb_queue_empty(&xmitq))
1049                 tipc_bearer_xmit(n->net, bearer_id, &xmitq, maddr, n);
1050         tipc_sk_rcv(n->net, &le->inputq);
1051 }
1052
1053 static bool node_is_up(struct tipc_node *n)
1054 {
1055         return n->active_links[0] != INVALID_BEARER_ID;
1056 }
1057
1058 bool tipc_node_is_up(struct net *net, u32 addr)
1059 {
1060         struct tipc_node *n;
1061         bool retval = false;
1062
1063         if (in_own_node(net, addr))
1064                 return true;
1065
1066         n = tipc_node_find(net, addr);
1067         if (!n)
1068                 return false;
1069         retval = node_is_up(n);
1070         tipc_node_put(n);
1071         return retval;
1072 }
1073
1074 static u32 tipc_node_suggest_addr(struct net *net, u32 addr)
1075 {
1076         struct tipc_node *n;
1077
1078         addr ^= tipc_net(net)->random;
1079         while ((n = tipc_node_find(net, addr))) {
1080                 tipc_node_put(n);
1081                 addr++;
1082         }
1083         return addr;
1084 }
1085
1086 /* tipc_node_try_addr(): Check if addr can be used by peer, suggest other if not
1087  * Returns suggested address if any, otherwise 0
1088  */
1089 u32 tipc_node_try_addr(struct net *net, u8 *id, u32 addr)
1090 {
1091         struct tipc_net *tn = tipc_net(net);
1092         struct tipc_node *n;
1093         bool preliminary;
1094         u32 sugg_addr;
1095
1096         /* Suggest new address if some other peer is using this one */
1097         n = tipc_node_find(net, addr);
1098         if (n) {
1099                 if (!memcmp(n->peer_id, id, NODE_ID_LEN))
1100                         addr = 0;
1101                 tipc_node_put(n);
1102                 if (!addr)
1103                         return 0;
1104                 return tipc_node_suggest_addr(net, addr);
1105         }
1106
1107         /* Suggest previously used address if peer is known */
1108         n = tipc_node_find_by_id(net, id);
1109         if (n) {
1110                 sugg_addr = n->addr;
1111                 preliminary = n->preliminary;
1112                 tipc_node_put(n);
1113                 if (!preliminary)
1114                         return sugg_addr;
1115         }
1116
1117         /* Even this node may be in conflict */
1118         if (tn->trial_addr == addr)
1119                 return tipc_node_suggest_addr(net, addr);
1120
1121         return 0;
1122 }
1123
1124 void tipc_node_check_dest(struct net *net, u32 addr,
1125                           u8 *peer_id, struct tipc_bearer *b,
1126                           u16 capabilities, u32 signature, u32 hash_mixes,
1127                           struct tipc_media_addr *maddr,
1128                           bool *respond, bool *dupl_addr)
1129 {
1130         struct tipc_node *n;
1131         struct tipc_link *l, *snd_l;
1132         struct tipc_link_entry *le;
1133         bool addr_match = false;
1134         bool sign_match = false;
1135         bool link_up = false;
1136         bool accept_addr = false;
1137         bool reset = true;
1138         char *if_name;
1139         unsigned long intv;
1140         u16 session;
1141
1142         *dupl_addr = false;
1143         *respond = false;
1144
1145         n = tipc_node_create(net, addr, peer_id, capabilities, hash_mixes,
1146                              false);
1147         if (!n)
1148                 return;
1149
1150         tipc_node_write_lock(n);
1151         if (unlikely(!n->bc_entry.link)) {
1152                 snd_l = tipc_bc_sndlink(net);
1153                 if (!tipc_link_bc_create(net, tipc_own_addr(net),
1154                                          addr, peer_id, U16_MAX,
1155                                          tipc_link_min_win(snd_l),
1156                                          tipc_link_max_win(snd_l),
1157                                          n->capabilities,
1158                                          &n->bc_entry.inputq1,
1159                                          &n->bc_entry.namedq, snd_l,
1160                                          &n->bc_entry.link)) {
1161                         pr_warn("Broadcast rcv link creation failed, no mem\n");
1162                         tipc_node_write_unlock_fast(n);
1163                         tipc_node_put(n);
1164                         return;
1165                 }
1166         }
1167
1168         le = &n->links[b->identity];
1169
1170         /* Prepare to validate requesting node's signature and media address */
1171         l = le->link;
1172         link_up = l && tipc_link_is_up(l);
1173         addr_match = l && !memcmp(&le->maddr, maddr, sizeof(*maddr));
1174         sign_match = (signature == n->signature);
1175
1176         /* These three flags give us eight permutations: */
1177
1178         if (sign_match && addr_match && link_up) {
1179                 /* All is fine. Do nothing. */
1180                 reset = false;
1181                 /* Peer node is not a container/local namespace */
1182                 if (!n->peer_hash_mix)
1183                         n->peer_hash_mix = hash_mixes;
1184         } else if (sign_match && addr_match && !link_up) {
1185                 /* Respond. The link will come up in due time */
1186                 *respond = true;
1187         } else if (sign_match && !addr_match && link_up) {
1188                 /* Peer has changed i/f address without rebooting.
1189                  * If so, the link will reset soon, and the next
1190                  * discovery will be accepted. So we can ignore it.
1191                  * It may also be an cloned or malicious peer having
1192                  * chosen the same node address and signature as an
1193                  * existing one.
1194                  * Ignore requests until the link goes down, if ever.
1195                  */
1196                 *dupl_addr = true;
1197         } else if (sign_match && !addr_match && !link_up) {
1198                 /* Peer link has changed i/f address without rebooting.
1199                  * It may also be a cloned or malicious peer; we can't
1200                  * distinguish between the two.
1201                  * The signature is correct, so we must accept.
1202                  */
1203                 accept_addr = true;
1204                 *respond = true;
1205         } else if (!sign_match && addr_match && link_up) {
1206                 /* Peer node rebooted. Two possibilities:
1207                  *  - Delayed re-discovery; this link endpoint has already
1208                  *    reset and re-established contact with the peer, before
1209                  *    receiving a discovery message from that node.
1210                  *    (The peer happened to receive one from this node first).
1211                  *  - The peer came back so fast that our side has not
1212                  *    discovered it yet. Probing from this side will soon
1213                  *    reset the link, since there can be no working link
1214                  *    endpoint at the peer end, and the link will re-establish.
1215                  *  Accept the signature, since it comes from a known peer.
1216                  */
1217                 n->signature = signature;
1218         } else if (!sign_match && addr_match && !link_up) {
1219                 /*  The peer node has rebooted.
1220                  *  Accept signature, since it is a known peer.
1221                  */
1222                 n->signature = signature;
1223                 *respond = true;
1224         } else if (!sign_match && !addr_match && link_up) {
1225                 /* Peer rebooted with new address, or a new/duplicate peer.
1226                  * Ignore until the link goes down, if ever.
1227                  */
1228                 *dupl_addr = true;
1229         } else if (!sign_match && !addr_match && !link_up) {
1230                 /* Peer rebooted with new address, or it is a new peer.
1231                  * Accept signature and address.
1232                  */
1233                 n->signature = signature;
1234                 accept_addr = true;
1235                 *respond = true;
1236         }
1237
1238         if (!accept_addr)
1239                 goto exit;
1240
1241         /* Now create new link if not already existing */
1242         if (!l) {
1243                 if (n->link_cnt == 2)
1244                         goto exit;
1245
1246                 if_name = strchr(b->name, ':') + 1;
1247                 get_random_bytes(&session, sizeof(u16));
1248                 if (!tipc_link_create(net, if_name, b->identity, b->tolerance,
1249                                       b->net_plane, b->mtu, b->priority,
1250                                       b->min_win, b->max_win, session,
1251                                       tipc_own_addr(net), addr, peer_id,
1252                                       n->capabilities,
1253                                       tipc_bc_sndlink(n->net), n->bc_entry.link,
1254                                       &le->inputq,
1255                                       &n->bc_entry.namedq, &l)) {
1256                         *respond = false;
1257                         goto exit;
1258                 }
1259                 trace_tipc_link_reset(l, TIPC_DUMP_ALL, "link created!");
1260                 tipc_link_reset(l);
1261                 tipc_link_fsm_evt(l, LINK_RESET_EVT);
1262                 if (n->state == NODE_FAILINGOVER)
1263                         tipc_link_fsm_evt(l, LINK_FAILOVER_BEGIN_EVT);
1264                 le->link = l;
1265                 n->link_cnt++;
1266                 tipc_node_calculate_timer(n, l);
1267                 if (n->link_cnt == 1) {
1268                         intv = jiffies + msecs_to_jiffies(n->keepalive_intv);
1269                         if (!mod_timer(&n->timer, intv))
1270                                 tipc_node_get(n);
1271                 }
1272         }
1273         memcpy(&le->maddr, maddr, sizeof(*maddr));
1274 exit:
1275         tipc_node_write_unlock(n);
1276         if (reset && l && !tipc_link_is_reset(l))
1277                 tipc_node_link_down(n, b->identity, false);
1278         tipc_node_put(n);
1279 }
1280
1281 void tipc_node_delete_links(struct net *net, int bearer_id)
1282 {
1283         struct tipc_net *tn = net_generic(net, tipc_net_id);
1284         struct tipc_node *n;
1285
1286         rcu_read_lock();
1287         list_for_each_entry_rcu(n, &tn->node_list, list) {
1288                 tipc_node_link_down(n, bearer_id, true);
1289         }
1290         rcu_read_unlock();
1291 }
1292
1293 static void tipc_node_reset_links(struct tipc_node *n)
1294 {
1295         int i;
1296
1297         pr_warn("Resetting all links to %x\n", n->addr);
1298
1299         trace_tipc_node_reset_links(n, true, " ");
1300         for (i = 0; i < MAX_BEARERS; i++) {
1301                 tipc_node_link_down(n, i, false);
1302         }
1303 }
1304
1305 /* tipc_node_fsm_evt - node finite state machine
1306  * Determines when contact is allowed with peer node
1307  */
1308 static void tipc_node_fsm_evt(struct tipc_node *n, int evt)
1309 {
1310         int state = n->state;
1311
1312         switch (state) {
1313         case SELF_DOWN_PEER_DOWN:
1314                 switch (evt) {
1315                 case SELF_ESTABL_CONTACT_EVT:
1316                         state = SELF_UP_PEER_COMING;
1317                         break;
1318                 case PEER_ESTABL_CONTACT_EVT:
1319                         state = SELF_COMING_PEER_UP;
1320                         break;
1321                 case SELF_LOST_CONTACT_EVT:
1322                 case PEER_LOST_CONTACT_EVT:
1323                         break;
1324                 case NODE_SYNCH_END_EVT:
1325                 case NODE_SYNCH_BEGIN_EVT:
1326                 case NODE_FAILOVER_BEGIN_EVT:
1327                 case NODE_FAILOVER_END_EVT:
1328                 default:
1329                         goto illegal_evt;
1330                 }
1331                 break;
1332         case SELF_UP_PEER_UP:
1333                 switch (evt) {
1334                 case SELF_LOST_CONTACT_EVT:
1335                         state = SELF_DOWN_PEER_LEAVING;
1336                         break;
1337                 case PEER_LOST_CONTACT_EVT:
1338                         state = SELF_LEAVING_PEER_DOWN;
1339                         break;
1340                 case NODE_SYNCH_BEGIN_EVT:
1341                         state = NODE_SYNCHING;
1342                         break;
1343                 case NODE_FAILOVER_BEGIN_EVT:
1344                         state = NODE_FAILINGOVER;
1345                         break;
1346                 case SELF_ESTABL_CONTACT_EVT:
1347                 case PEER_ESTABL_CONTACT_EVT:
1348                 case NODE_SYNCH_END_EVT:
1349                 case NODE_FAILOVER_END_EVT:
1350                         break;
1351                 default:
1352                         goto illegal_evt;
1353                 }
1354                 break;
1355         case SELF_DOWN_PEER_LEAVING:
1356                 switch (evt) {
1357                 case PEER_LOST_CONTACT_EVT:
1358                         state = SELF_DOWN_PEER_DOWN;
1359                         break;
1360                 case SELF_ESTABL_CONTACT_EVT:
1361                 case PEER_ESTABL_CONTACT_EVT:
1362                 case SELF_LOST_CONTACT_EVT:
1363                         break;
1364                 case NODE_SYNCH_END_EVT:
1365                 case NODE_SYNCH_BEGIN_EVT:
1366                 case NODE_FAILOVER_BEGIN_EVT:
1367                 case NODE_FAILOVER_END_EVT:
1368                 default:
1369                         goto illegal_evt;
1370                 }
1371                 break;
1372         case SELF_UP_PEER_COMING:
1373                 switch (evt) {
1374                 case PEER_ESTABL_CONTACT_EVT:
1375                         state = SELF_UP_PEER_UP;
1376                         break;
1377                 case SELF_LOST_CONTACT_EVT:
1378                         state = SELF_DOWN_PEER_DOWN;
1379                         break;
1380                 case SELF_ESTABL_CONTACT_EVT:
1381                 case PEER_LOST_CONTACT_EVT:
1382                 case NODE_SYNCH_END_EVT:
1383                 case NODE_FAILOVER_BEGIN_EVT:
1384                         break;
1385                 case NODE_SYNCH_BEGIN_EVT:
1386                 case NODE_FAILOVER_END_EVT:
1387                 default:
1388                         goto illegal_evt;
1389                 }
1390                 break;
1391         case SELF_COMING_PEER_UP:
1392                 switch (evt) {
1393                 case SELF_ESTABL_CONTACT_EVT:
1394                         state = SELF_UP_PEER_UP;
1395                         break;
1396                 case PEER_LOST_CONTACT_EVT:
1397                         state = SELF_DOWN_PEER_DOWN;
1398                         break;
1399                 case SELF_LOST_CONTACT_EVT:
1400                 case PEER_ESTABL_CONTACT_EVT:
1401                         break;
1402                 case NODE_SYNCH_END_EVT:
1403                 case NODE_SYNCH_BEGIN_EVT:
1404                 case NODE_FAILOVER_BEGIN_EVT:
1405                 case NODE_FAILOVER_END_EVT:
1406                 default:
1407                         goto illegal_evt;
1408                 }
1409                 break;
1410         case SELF_LEAVING_PEER_DOWN:
1411                 switch (evt) {
1412                 case SELF_LOST_CONTACT_EVT:
1413                         state = SELF_DOWN_PEER_DOWN;
1414                         break;
1415                 case SELF_ESTABL_CONTACT_EVT:
1416                 case PEER_ESTABL_CONTACT_EVT:
1417                 case PEER_LOST_CONTACT_EVT:
1418                         break;
1419                 case NODE_SYNCH_END_EVT:
1420                 case NODE_SYNCH_BEGIN_EVT:
1421                 case NODE_FAILOVER_BEGIN_EVT:
1422                 case NODE_FAILOVER_END_EVT:
1423                 default:
1424                         goto illegal_evt;
1425                 }
1426                 break;
1427         case NODE_FAILINGOVER:
1428                 switch (evt) {
1429                 case SELF_LOST_CONTACT_EVT:
1430                         state = SELF_DOWN_PEER_LEAVING;
1431                         break;
1432                 case PEER_LOST_CONTACT_EVT:
1433                         state = SELF_LEAVING_PEER_DOWN;
1434                         break;
1435                 case NODE_FAILOVER_END_EVT:
1436                         state = SELF_UP_PEER_UP;
1437                         break;
1438                 case NODE_FAILOVER_BEGIN_EVT:
1439                 case SELF_ESTABL_CONTACT_EVT:
1440                 case PEER_ESTABL_CONTACT_EVT:
1441                         break;
1442                 case NODE_SYNCH_BEGIN_EVT:
1443                 case NODE_SYNCH_END_EVT:
1444                 default:
1445                         goto illegal_evt;
1446                 }
1447                 break;
1448         case NODE_SYNCHING:
1449                 switch (evt) {
1450                 case SELF_LOST_CONTACT_EVT:
1451                         state = SELF_DOWN_PEER_LEAVING;
1452                         break;
1453                 case PEER_LOST_CONTACT_EVT:
1454                         state = SELF_LEAVING_PEER_DOWN;
1455                         break;
1456                 case NODE_SYNCH_END_EVT:
1457                         state = SELF_UP_PEER_UP;
1458                         break;
1459                 case NODE_FAILOVER_BEGIN_EVT:
1460                         state = NODE_FAILINGOVER;
1461                         break;
1462                 case NODE_SYNCH_BEGIN_EVT:
1463                 case SELF_ESTABL_CONTACT_EVT:
1464                 case PEER_ESTABL_CONTACT_EVT:
1465                         break;
1466                 case NODE_FAILOVER_END_EVT:
1467                 default:
1468                         goto illegal_evt;
1469                 }
1470                 break;
1471         default:
1472                 pr_err("Unknown node fsm state %x\n", state);
1473                 break;
1474         }
1475         trace_tipc_node_fsm(n->peer_id, n->state, state, evt);
1476         n->state = state;
1477         return;
1478
1479 illegal_evt:
1480         pr_err("Illegal node fsm evt %x in state %x\n", evt, state);
1481         trace_tipc_node_fsm(n->peer_id, n->state, state, evt);
1482 }
1483
1484 static void node_lost_contact(struct tipc_node *n,
1485                               struct sk_buff_head *inputq)
1486 {
1487         struct tipc_sock_conn *conn, *safe;
1488         struct tipc_link *l;
1489         struct list_head *conns = &n->conn_sks;
1490         struct sk_buff *skb;
1491         uint i;
1492
1493         pr_debug("Lost contact with %x\n", n->addr);
1494         n->delete_at = jiffies + msecs_to_jiffies(NODE_CLEANUP_AFTER);
1495         trace_tipc_node_lost_contact(n, true, " ");
1496
1497         /* Clean up broadcast state */
1498         tipc_bcast_remove_peer(n->net, n->bc_entry.link);
1499         skb_queue_purge(&n->bc_entry.namedq);
1500
1501         /* Abort any ongoing link failover */
1502         for (i = 0; i < MAX_BEARERS; i++) {
1503                 l = n->links[i].link;
1504                 if (l)
1505                         tipc_link_fsm_evt(l, LINK_FAILOVER_END_EVT);
1506         }
1507
1508         /* Notify publications from this node */
1509         n->action_flags |= TIPC_NOTIFY_NODE_DOWN;
1510         n->peer_net = NULL;
1511         n->peer_hash_mix = 0;
1512         /* Notify sockets connected to node */
1513         list_for_each_entry_safe(conn, safe, conns, list) {
1514                 skb = tipc_msg_create(TIPC_CRITICAL_IMPORTANCE, TIPC_CONN_MSG,
1515                                       SHORT_H_SIZE, 0, tipc_own_addr(n->net),
1516                                       conn->peer_node, conn->port,
1517                                       conn->peer_port, TIPC_ERR_NO_NODE);
1518                 if (likely(skb))
1519                         skb_queue_tail(inputq, skb);
1520                 list_del(&conn->list);
1521                 kfree(conn);
1522         }
1523 }
1524
1525 /**
1526  * tipc_node_get_linkname - get the name of a link
1527  *
1528  * @bearer_id: id of the bearer
1529  * @addr: peer node address
1530  * @linkname: link name output buffer
1531  *
1532  * Returns 0 on success
1533  */
1534 int tipc_node_get_linkname(struct net *net, u32 bearer_id, u32 addr,
1535                            char *linkname, size_t len)
1536 {
1537         struct tipc_link *link;
1538         int err = -EINVAL;
1539         struct tipc_node *node = tipc_node_find(net, addr);
1540
1541         if (!node)
1542                 return err;
1543
1544         if (bearer_id >= MAX_BEARERS)
1545                 goto exit;
1546
1547         tipc_node_read_lock(node);
1548         link = node->links[bearer_id].link;
1549         if (link) {
1550                 strncpy(linkname, tipc_link_name(link), len);
1551                 err = 0;
1552         }
1553         tipc_node_read_unlock(node);
1554 exit:
1555         tipc_node_put(node);
1556         return err;
1557 }
1558
1559 /* Caller should hold node lock for the passed node */
1560 static int __tipc_nl_add_node(struct tipc_nl_msg *msg, struct tipc_node *node)
1561 {
1562         void *hdr;
1563         struct nlattr *attrs;
1564
1565         hdr = genlmsg_put(msg->skb, msg->portid, msg->seq, &tipc_genl_family,
1566                           NLM_F_MULTI, TIPC_NL_NODE_GET);
1567         if (!hdr)
1568                 return -EMSGSIZE;
1569
1570         attrs = nla_nest_start_noflag(msg->skb, TIPC_NLA_NODE);
1571         if (!attrs)
1572                 goto msg_full;
1573
1574         if (nla_put_u32(msg->skb, TIPC_NLA_NODE_ADDR, node->addr))
1575                 goto attr_msg_full;
1576         if (node_is_up(node))
1577                 if (nla_put_flag(msg->skb, TIPC_NLA_NODE_UP))
1578                         goto attr_msg_full;
1579
1580         nla_nest_end(msg->skb, attrs);
1581         genlmsg_end(msg->skb, hdr);
1582
1583         return 0;
1584
1585 attr_msg_full:
1586         nla_nest_cancel(msg->skb, attrs);
1587 msg_full:
1588         genlmsg_cancel(msg->skb, hdr);
1589
1590         return -EMSGSIZE;
1591 }
1592
1593 static void tipc_lxc_xmit(struct net *peer_net, struct sk_buff_head *list)
1594 {
1595         struct tipc_msg *hdr = buf_msg(skb_peek(list));
1596         struct sk_buff_head inputq;
1597
1598         switch (msg_user(hdr)) {
1599         case TIPC_LOW_IMPORTANCE:
1600         case TIPC_MEDIUM_IMPORTANCE:
1601         case TIPC_HIGH_IMPORTANCE:
1602         case TIPC_CRITICAL_IMPORTANCE:
1603                 if (msg_connected(hdr) || msg_named(hdr) ||
1604                     msg_direct(hdr)) {
1605                         tipc_loopback_trace(peer_net, list);
1606                         spin_lock_init(&list->lock);
1607                         tipc_sk_rcv(peer_net, list);
1608                         return;
1609                 }
1610                 if (msg_mcast(hdr)) {
1611                         tipc_loopback_trace(peer_net, list);
1612                         skb_queue_head_init(&inputq);
1613                         tipc_sk_mcast_rcv(peer_net, list, &inputq);
1614                         __skb_queue_purge(list);
1615                         skb_queue_purge(&inputq);
1616                         return;
1617                 }
1618                 return;
1619         case MSG_FRAGMENTER:
1620                 if (tipc_msg_assemble(list)) {
1621                         tipc_loopback_trace(peer_net, list);
1622                         skb_queue_head_init(&inputq);
1623                         tipc_sk_mcast_rcv(peer_net, list, &inputq);
1624                         __skb_queue_purge(list);
1625                         skb_queue_purge(&inputq);
1626                 }
1627                 return;
1628         case GROUP_PROTOCOL:
1629         case CONN_MANAGER:
1630                 tipc_loopback_trace(peer_net, list);
1631                 spin_lock_init(&list->lock);
1632                 tipc_sk_rcv(peer_net, list);
1633                 return;
1634         case LINK_PROTOCOL:
1635         case NAME_DISTRIBUTOR:
1636         case TUNNEL_PROTOCOL:
1637         case BCAST_PROTOCOL:
1638                 return;
1639         default:
1640                 return;
1641         };
1642 }
1643
1644 /**
1645  * tipc_node_xmit() is the general link level function for message sending
1646  * @net: the applicable net namespace
1647  * @list: chain of buffers containing message
1648  * @dnode: address of destination node
1649  * @selector: a number used for deterministic link selection
1650  * Consumes the buffer chain.
1651  * Returns 0 if success, otherwise: -ELINKCONG,-EHOSTUNREACH,-EMSGSIZE,-ENOBUF
1652  */
1653 int tipc_node_xmit(struct net *net, struct sk_buff_head *list,
1654                    u32 dnode, int selector)
1655 {
1656         struct tipc_link_entry *le = NULL;
1657         struct tipc_node *n;
1658         struct sk_buff_head xmitq;
1659         bool node_up = false;
1660         int bearer_id;
1661         int rc;
1662
1663         if (in_own_node(net, dnode)) {
1664                 tipc_loopback_trace(net, list);
1665                 spin_lock_init(&list->lock);
1666                 tipc_sk_rcv(net, list);
1667                 return 0;
1668         }
1669
1670         n = tipc_node_find(net, dnode);
1671         if (unlikely(!n)) {
1672                 __skb_queue_purge(list);
1673                 return -EHOSTUNREACH;
1674         }
1675
1676         tipc_node_read_lock(n);
1677         node_up = node_is_up(n);
1678         if (node_up && n->peer_net && check_net(n->peer_net)) {
1679                 /* xmit inner linux container */
1680                 tipc_lxc_xmit(n->peer_net, list);
1681                 if (likely(skb_queue_empty(list))) {
1682                         tipc_node_read_unlock(n);
1683                         tipc_node_put(n);
1684                         return 0;
1685                 }
1686         }
1687
1688         bearer_id = n->active_links[selector & 1];
1689         if (unlikely(bearer_id == INVALID_BEARER_ID)) {
1690                 tipc_node_read_unlock(n);
1691                 tipc_node_put(n);
1692                 __skb_queue_purge(list);
1693                 return -EHOSTUNREACH;
1694         }
1695
1696         __skb_queue_head_init(&xmitq);
1697         le = &n->links[bearer_id];
1698         spin_lock_bh(&le->lock);
1699         rc = tipc_link_xmit(le->link, list, &xmitq);
1700         spin_unlock_bh(&le->lock);
1701         tipc_node_read_unlock(n);
1702
1703         if (unlikely(rc == -ENOBUFS))
1704                 tipc_node_link_down(n, bearer_id, false);
1705         else
1706                 tipc_bearer_xmit(net, bearer_id, &xmitq, &le->maddr, n);
1707
1708         tipc_node_put(n);
1709
1710         return rc;
1711 }
1712
1713 /* tipc_node_xmit_skb(): send single buffer to destination
1714  * Buffers sent via this functon are generally TIPC_SYSTEM_IMPORTANCE
1715  * messages, which will not be rejected
1716  * The only exception is datagram messages rerouted after secondary
1717  * lookup, which are rare and safe to dispose of anyway.
1718  */
1719 int tipc_node_xmit_skb(struct net *net, struct sk_buff *skb, u32 dnode,
1720                        u32 selector)
1721 {
1722         struct sk_buff_head head;
1723
1724         __skb_queue_head_init(&head);
1725         __skb_queue_tail(&head, skb);
1726         tipc_node_xmit(net, &head, dnode, selector);
1727         return 0;
1728 }
1729
1730 /* tipc_node_distr_xmit(): send single buffer msgs to individual destinations
1731  * Note: this is only for SYSTEM_IMPORTANCE messages, which cannot be rejected
1732  */
1733 int tipc_node_distr_xmit(struct net *net, struct sk_buff_head *xmitq)
1734 {
1735         struct sk_buff *skb;
1736         u32 selector, dnode;
1737
1738         while ((skb = __skb_dequeue(xmitq))) {
1739                 selector = msg_origport(buf_msg(skb));
1740                 dnode = msg_destnode(buf_msg(skb));
1741                 tipc_node_xmit_skb(net, skb, dnode, selector);
1742         }
1743         return 0;
1744 }
1745
1746 void tipc_node_broadcast(struct net *net, struct sk_buff *skb, int rc_dests)
1747 {
1748         struct sk_buff_head xmitq;
1749         struct sk_buff *txskb;
1750         struct tipc_node *n;
1751         u16 dummy;
1752         u32 dst;
1753
1754         /* Use broadcast if all nodes support it */
1755         if (!rc_dests && tipc_bcast_get_mode(net) != BCLINK_MODE_RCAST) {
1756                 __skb_queue_head_init(&xmitq);
1757                 __skb_queue_tail(&xmitq, skb);
1758                 tipc_bcast_xmit(net, &xmitq, &dummy);
1759                 return;
1760         }
1761
1762         /* Otherwise use legacy replicast method */
1763         rcu_read_lock();
1764         list_for_each_entry_rcu(n, tipc_nodes(net), list) {
1765                 dst = n->addr;
1766                 if (in_own_node(net, dst))
1767                         continue;
1768                 if (!node_is_up(n))
1769                         continue;
1770                 txskb = pskb_copy(skb, GFP_ATOMIC);
1771                 if (!txskb)
1772                         break;
1773                 msg_set_destnode(buf_msg(txskb), dst);
1774                 tipc_node_xmit_skb(net, txskb, dst, 0);
1775         }
1776         rcu_read_unlock();
1777         kfree_skb(skb);
1778 }
1779
1780 static void tipc_node_mcast_rcv(struct tipc_node *n)
1781 {
1782         struct tipc_bclink_entry *be = &n->bc_entry;
1783
1784         /* 'arrvq' is under inputq2's lock protection */
1785         spin_lock_bh(&be->inputq2.lock);
1786         spin_lock_bh(&be->inputq1.lock);
1787         skb_queue_splice_tail_init(&be->inputq1, &be->arrvq);
1788         spin_unlock_bh(&be->inputq1.lock);
1789         spin_unlock_bh(&be->inputq2.lock);
1790         tipc_sk_mcast_rcv(n->net, &be->arrvq, &be->inputq2);
1791 }
1792
1793 static void tipc_node_bc_sync_rcv(struct tipc_node *n, struct tipc_msg *hdr,
1794                                   int bearer_id, struct sk_buff_head *xmitq)
1795 {
1796         struct tipc_link *ucl;
1797         int rc;
1798
1799         rc = tipc_bcast_sync_rcv(n->net, n->bc_entry.link, hdr, xmitq);
1800
1801         if (rc & TIPC_LINK_DOWN_EVT) {
1802                 tipc_node_reset_links(n);
1803                 return;
1804         }
1805
1806         if (!(rc & TIPC_LINK_SND_STATE))
1807                 return;
1808
1809         /* If probe message, a STATE response will be sent anyway */
1810         if (msg_probe(hdr))
1811                 return;
1812
1813         /* Produce a STATE message carrying broadcast NACK */
1814         tipc_node_read_lock(n);
1815         ucl = n->links[bearer_id].link;
1816         if (ucl)
1817                 tipc_link_build_state_msg(ucl, xmitq);
1818         tipc_node_read_unlock(n);
1819 }
1820
1821 /**
1822  * tipc_node_bc_rcv - process TIPC broadcast packet arriving from off-node
1823  * @net: the applicable net namespace
1824  * @skb: TIPC packet
1825  * @bearer_id: id of bearer message arrived on
1826  *
1827  * Invoked with no locks held.
1828  */
1829 static void tipc_node_bc_rcv(struct net *net, struct sk_buff *skb, int bearer_id)
1830 {
1831         int rc;
1832         struct sk_buff_head xmitq;
1833         struct tipc_bclink_entry *be;
1834         struct tipc_link_entry *le;
1835         struct tipc_msg *hdr = buf_msg(skb);
1836         int usr = msg_user(hdr);
1837         u32 dnode = msg_destnode(hdr);
1838         struct tipc_node *n;
1839
1840         __skb_queue_head_init(&xmitq);
1841
1842         /* If NACK for other node, let rcv link for that node peek into it */
1843         if ((usr == BCAST_PROTOCOL) && (dnode != tipc_own_addr(net)))
1844                 n = tipc_node_find(net, dnode);
1845         else
1846                 n = tipc_node_find(net, msg_prevnode(hdr));
1847         if (!n) {
1848                 kfree_skb(skb);
1849                 return;
1850         }
1851         be = &n->bc_entry;
1852         le = &n->links[bearer_id];
1853
1854         rc = tipc_bcast_rcv(net, be->link, skb);
1855
1856         /* Broadcast ACKs are sent on a unicast link */
1857         if (rc & TIPC_LINK_SND_STATE) {
1858                 tipc_node_read_lock(n);
1859                 tipc_link_build_state_msg(le->link, &xmitq);
1860                 tipc_node_read_unlock(n);
1861         }
1862
1863         if (!skb_queue_empty(&xmitq))
1864                 tipc_bearer_xmit(net, bearer_id, &xmitq, &le->maddr, n);
1865
1866         if (!skb_queue_empty(&be->inputq1))
1867                 tipc_node_mcast_rcv(n);
1868
1869         /* Handle NAME_DISTRIBUTOR messages sent from 1.7 nodes */
1870         if (!skb_queue_empty(&n->bc_entry.namedq))
1871                 tipc_named_rcv(net, &n->bc_entry.namedq,
1872                                &n->bc_entry.named_rcv_nxt,
1873                                &n->bc_entry.named_open);
1874
1875         /* If reassembly or retransmission failure => reset all links to peer */
1876         if (rc & TIPC_LINK_DOWN_EVT)
1877                 tipc_node_reset_links(n);
1878
1879         tipc_node_put(n);
1880 }
1881
1882 /**
1883  * tipc_node_check_state - check and if necessary update node state
1884  * @skb: TIPC packet
1885  * @bearer_id: identity of bearer delivering the packet
1886  * Returns true if state and msg are ok, otherwise false
1887  */
1888 static bool tipc_node_check_state(struct tipc_node *n, struct sk_buff *skb,
1889                                   int bearer_id, struct sk_buff_head *xmitq)
1890 {
1891         struct tipc_msg *hdr = buf_msg(skb);
1892         int usr = msg_user(hdr);
1893         int mtyp = msg_type(hdr);
1894         u16 oseqno = msg_seqno(hdr);
1895         u16 exp_pkts = msg_msgcnt(hdr);
1896         u16 rcv_nxt, syncpt, dlv_nxt, inputq_len;
1897         int state = n->state;
1898         struct tipc_link *l, *tnl, *pl = NULL;
1899         struct tipc_media_addr *maddr;
1900         int pb_id;
1901
1902         if (trace_tipc_node_check_state_enabled()) {
1903                 trace_tipc_skb_dump(skb, false, "skb for node state check");
1904                 trace_tipc_node_check_state(n, true, " ");
1905         }
1906         l = n->links[bearer_id].link;
1907         if (!l)
1908                 return false;
1909         rcv_nxt = tipc_link_rcv_nxt(l);
1910
1911
1912         if (likely((state == SELF_UP_PEER_UP) && (usr != TUNNEL_PROTOCOL)))
1913                 return true;
1914
1915         /* Find parallel link, if any */
1916         for (pb_id = 0; pb_id < MAX_BEARERS; pb_id++) {
1917                 if ((pb_id != bearer_id) && n->links[pb_id].link) {
1918                         pl = n->links[pb_id].link;
1919                         break;
1920                 }
1921         }
1922
1923         if (!tipc_link_validate_msg(l, hdr)) {
1924                 trace_tipc_skb_dump(skb, false, "PROTO invalid (2)!");
1925                 trace_tipc_link_dump(l, TIPC_DUMP_NONE, "PROTO invalid (2)!");
1926                 return false;
1927         }
1928
1929         /* Check and update node accesibility if applicable */
1930         if (state == SELF_UP_PEER_COMING) {
1931                 if (!tipc_link_is_up(l))
1932                         return true;
1933                 if (!msg_peer_link_is_up(hdr))
1934                         return true;
1935                 tipc_node_fsm_evt(n, PEER_ESTABL_CONTACT_EVT);
1936         }
1937
1938         if (state == SELF_DOWN_PEER_LEAVING) {
1939                 if (msg_peer_node_is_up(hdr))
1940                         return false;
1941                 tipc_node_fsm_evt(n, PEER_LOST_CONTACT_EVT);
1942                 return true;
1943         }
1944
1945         if (state == SELF_LEAVING_PEER_DOWN)
1946                 return false;
1947
1948         /* Ignore duplicate packets */
1949         if ((usr != LINK_PROTOCOL) && less(oseqno, rcv_nxt))
1950                 return true;
1951
1952         /* Initiate or update failover mode if applicable */
1953         if ((usr == TUNNEL_PROTOCOL) && (mtyp == FAILOVER_MSG)) {
1954                 syncpt = oseqno + exp_pkts - 1;
1955                 if (pl && !tipc_link_is_reset(pl)) {
1956                         __tipc_node_link_down(n, &pb_id, xmitq, &maddr);
1957                         trace_tipc_node_link_down(n, true,
1958                                                   "node link down <- failover!");
1959                         tipc_skb_queue_splice_tail_init(tipc_link_inputq(pl),
1960                                                         tipc_link_inputq(l));
1961                 }
1962
1963                 /* If parallel link was already down, and this happened before
1964                  * the tunnel link came up, node failover was never started.
1965                  * Ensure that a FAILOVER_MSG is sent to get peer out of
1966                  * NODE_FAILINGOVER state, also this node must accept
1967                  * TUNNEL_MSGs from peer.
1968                  */
1969                 if (n->state != NODE_FAILINGOVER)
1970                         tipc_node_link_failover(n, pl, l, xmitq);
1971
1972                 /* If pkts arrive out of order, use lowest calculated syncpt */
1973                 if (less(syncpt, n->sync_point))
1974                         n->sync_point = syncpt;
1975         }
1976
1977         /* Open parallel link when tunnel link reaches synch point */
1978         if ((n->state == NODE_FAILINGOVER) && tipc_link_is_up(l)) {
1979                 if (!more(rcv_nxt, n->sync_point))
1980                         return true;
1981                 tipc_node_fsm_evt(n, NODE_FAILOVER_END_EVT);
1982                 if (pl)
1983                         tipc_link_fsm_evt(pl, LINK_FAILOVER_END_EVT);
1984                 return true;
1985         }
1986
1987         /* No synching needed if only one link */
1988         if (!pl || !tipc_link_is_up(pl))
1989                 return true;
1990
1991         /* Initiate synch mode if applicable */
1992         if ((usr == TUNNEL_PROTOCOL) && (mtyp == SYNCH_MSG) && (oseqno == 1)) {
1993                 if (n->capabilities & TIPC_TUNNEL_ENHANCED)
1994                         syncpt = msg_syncpt(hdr);
1995                 else
1996                         syncpt = msg_seqno(msg_inner_hdr(hdr)) + exp_pkts - 1;
1997                 if (!tipc_link_is_up(l))
1998                         __tipc_node_link_up(n, bearer_id, xmitq);
1999                 if (n->state == SELF_UP_PEER_UP) {
2000                         n->sync_point = syncpt;
2001                         tipc_link_fsm_evt(l, LINK_SYNCH_BEGIN_EVT);
2002                         tipc_node_fsm_evt(n, NODE_SYNCH_BEGIN_EVT);
2003                 }
2004         }
2005
2006         /* Open tunnel link when parallel link reaches synch point */
2007         if (n->state == NODE_SYNCHING) {
2008                 if (tipc_link_is_synching(l)) {
2009                         tnl = l;
2010                 } else {
2011                         tnl = pl;
2012                         pl = l;
2013                 }
2014                 inputq_len = skb_queue_len(tipc_link_inputq(pl));
2015                 dlv_nxt = tipc_link_rcv_nxt(pl) - inputq_len;
2016                 if (more(dlv_nxt, n->sync_point)) {
2017                         tipc_link_fsm_evt(tnl, LINK_SYNCH_END_EVT);
2018                         tipc_node_fsm_evt(n, NODE_SYNCH_END_EVT);
2019                         return true;
2020                 }
2021                 if (l == pl)
2022                         return true;
2023                 if ((usr == TUNNEL_PROTOCOL) && (mtyp == SYNCH_MSG))
2024                         return true;
2025                 if (usr == LINK_PROTOCOL)
2026                         return true;
2027                 return false;
2028         }
2029         return true;
2030 }
2031
2032 /**
2033  * tipc_rcv - process TIPC packets/messages arriving from off-node
2034  * @net: the applicable net namespace
2035  * @skb: TIPC packet
2036  * @b: pointer to bearer message arrived on
2037  *
2038  * Invoked with no locks held. Bearer pointer must point to a valid bearer
2039  * structure (i.e. cannot be NULL), but bearer can be inactive.
2040  */
2041 void tipc_rcv(struct net *net, struct sk_buff *skb, struct tipc_bearer *b)
2042 {
2043         struct sk_buff_head xmitq;
2044         struct tipc_link_entry *le;
2045         struct tipc_msg *hdr;
2046         struct tipc_node *n;
2047         int bearer_id = b->identity;
2048         u32 self = tipc_own_addr(net);
2049         int usr, rc = 0;
2050         u16 bc_ack;
2051 #ifdef CONFIG_TIPC_CRYPTO
2052         struct tipc_ehdr *ehdr;
2053
2054         /* Check if message must be decrypted first */
2055         if (TIPC_SKB_CB(skb)->decrypted || !tipc_ehdr_validate(skb))
2056                 goto rcv;
2057
2058         ehdr = (struct tipc_ehdr *)skb->data;
2059         if (likely(ehdr->user != LINK_CONFIG)) {
2060                 n = tipc_node_find(net, ntohl(ehdr->addr));
2061                 if (unlikely(!n))
2062                         goto discard;
2063         } else {
2064                 n = tipc_node_find_by_id(net, ehdr->id);
2065         }
2066         tipc_crypto_rcv(net, (n) ? n->crypto_rx : NULL, &skb, b);
2067         if (!skb)
2068                 return;
2069
2070 rcv:
2071 #endif
2072         /* Ensure message is well-formed before touching the header */
2073         if (unlikely(!tipc_msg_validate(&skb)))
2074                 goto discard;
2075         __skb_queue_head_init(&xmitq);
2076         hdr = buf_msg(skb);
2077         usr = msg_user(hdr);
2078         bc_ack = msg_bcast_ack(hdr);
2079
2080         /* Handle arrival of discovery or broadcast packet */
2081         if (unlikely(msg_non_seq(hdr))) {
2082                 if (unlikely(usr == LINK_CONFIG))
2083                         return tipc_disc_rcv(net, skb, b);
2084                 else
2085                         return tipc_node_bc_rcv(net, skb, bearer_id);
2086         }
2087
2088         /* Discard unicast link messages destined for another node */
2089         if (unlikely(!msg_short(hdr) && (msg_destnode(hdr) != self)))
2090                 goto discard;
2091
2092         /* Locate neighboring node that sent packet */
2093         n = tipc_node_find(net, msg_prevnode(hdr));
2094         if (unlikely(!n))
2095                 goto discard;
2096         le = &n->links[bearer_id];
2097
2098         /* Ensure broadcast reception is in synch with peer's send state */
2099         if (unlikely(usr == LINK_PROTOCOL)) {
2100                 if (unlikely(skb_linearize(skb))) {
2101                         tipc_node_put(n);
2102                         goto discard;
2103                 }
2104                 hdr = buf_msg(skb);
2105                 tipc_node_bc_sync_rcv(n, hdr, bearer_id, &xmitq);
2106         } else if (unlikely(tipc_link_acked(n->bc_entry.link) != bc_ack)) {
2107                 tipc_bcast_ack_rcv(net, n->bc_entry.link, hdr);
2108         }
2109
2110         /* Receive packet directly if conditions permit */
2111         tipc_node_read_lock(n);
2112         if (likely((n->state == SELF_UP_PEER_UP) && (usr != TUNNEL_PROTOCOL))) {
2113                 spin_lock_bh(&le->lock);
2114                 if (le->link) {
2115                         rc = tipc_link_rcv(le->link, skb, &xmitq);
2116                         skb = NULL;
2117                 }
2118                 spin_unlock_bh(&le->lock);
2119         }
2120         tipc_node_read_unlock(n);
2121
2122         /* Check/update node state before receiving */
2123         if (unlikely(skb)) {
2124                 if (unlikely(skb_linearize(skb)))
2125                         goto out_node_put;
2126                 tipc_node_write_lock(n);
2127                 if (tipc_node_check_state(n, skb, bearer_id, &xmitq)) {
2128                         if (le->link) {
2129                                 rc = tipc_link_rcv(le->link, skb, &xmitq);
2130                                 skb = NULL;
2131                         }
2132                 }
2133                 tipc_node_write_unlock(n);
2134         }
2135
2136         if (unlikely(rc & TIPC_LINK_UP_EVT))
2137                 tipc_node_link_up(n, bearer_id, &xmitq);
2138
2139         if (unlikely(rc & TIPC_LINK_DOWN_EVT))
2140                 tipc_node_link_down(n, bearer_id, false);
2141
2142         if (unlikely(!skb_queue_empty(&n->bc_entry.namedq)))
2143                 tipc_named_rcv(net, &n->bc_entry.namedq,
2144                                &n->bc_entry.named_rcv_nxt,
2145                                &n->bc_entry.named_open);
2146
2147         if (unlikely(!skb_queue_empty(&n->bc_entry.inputq1)))
2148                 tipc_node_mcast_rcv(n);
2149
2150         if (!skb_queue_empty(&le->inputq))
2151                 tipc_sk_rcv(net, &le->inputq);
2152
2153         if (!skb_queue_empty(&xmitq))
2154                 tipc_bearer_xmit(net, bearer_id, &xmitq, &le->maddr, n);
2155
2156 out_node_put:
2157         tipc_node_put(n);
2158 discard:
2159         kfree_skb(skb);
2160 }
2161
2162 void tipc_node_apply_property(struct net *net, struct tipc_bearer *b,
2163                               int prop)
2164 {
2165         struct tipc_net *tn = tipc_net(net);
2166         int bearer_id = b->identity;
2167         struct sk_buff_head xmitq;
2168         struct tipc_link_entry *e;
2169         struct tipc_node *n;
2170
2171         __skb_queue_head_init(&xmitq);
2172
2173         rcu_read_lock();
2174
2175         list_for_each_entry_rcu(n, &tn->node_list, list) {
2176                 tipc_node_write_lock(n);
2177                 e = &n->links[bearer_id];
2178                 if (e->link) {
2179                         if (prop == TIPC_NLA_PROP_TOL)
2180                                 tipc_link_set_tolerance(e->link, b->tolerance,
2181                                                         &xmitq);
2182                         else if (prop == TIPC_NLA_PROP_MTU)
2183                                 tipc_link_set_mtu(e->link, b->mtu);
2184
2185                         /* Update MTU for node link entry */
2186                         e->mtu = tipc_link_mss(e->link);
2187                 }
2188
2189                 tipc_node_write_unlock(n);
2190                 tipc_bearer_xmit(net, bearer_id, &xmitq, &e->maddr, NULL);
2191         }
2192
2193         rcu_read_unlock();
2194 }
2195
2196 int tipc_nl_peer_rm(struct sk_buff *skb, struct genl_info *info)
2197 {
2198         struct net *net = sock_net(skb->sk);
2199         struct tipc_net *tn = net_generic(net, tipc_net_id);
2200         struct nlattr *attrs[TIPC_NLA_NET_MAX + 1];
2201         struct tipc_node *peer, *temp_node;
2202         u32 addr;
2203         int err;
2204
2205         /* We identify the peer by its net */
2206         if (!info->attrs[TIPC_NLA_NET])
2207                 return -EINVAL;
2208
2209         err = nla_parse_nested_deprecated(attrs, TIPC_NLA_NET_MAX,
2210                                           info->attrs[TIPC_NLA_NET],
2211                                           tipc_nl_net_policy, info->extack);
2212         if (err)
2213                 return err;
2214
2215         if (!attrs[TIPC_NLA_NET_ADDR])
2216                 return -EINVAL;
2217
2218         addr = nla_get_u32(attrs[TIPC_NLA_NET_ADDR]);
2219
2220         if (in_own_node(net, addr))
2221                 return -ENOTSUPP;
2222
2223         spin_lock_bh(&tn->node_list_lock);
2224         peer = tipc_node_find(net, addr);
2225         if (!peer) {
2226                 spin_unlock_bh(&tn->node_list_lock);
2227                 return -ENXIO;
2228         }
2229
2230         tipc_node_write_lock(peer);
2231         if (peer->state != SELF_DOWN_PEER_DOWN &&
2232             peer->state != SELF_DOWN_PEER_LEAVING) {
2233                 tipc_node_write_unlock(peer);
2234                 err = -EBUSY;
2235                 goto err_out;
2236         }
2237
2238         tipc_node_clear_links(peer);
2239         tipc_node_write_unlock(peer);
2240         tipc_node_delete(peer);
2241
2242         /* Calculate cluster capabilities */
2243         tn->capabilities = TIPC_NODE_CAPABILITIES;
2244         list_for_each_entry_rcu(temp_node, &tn->node_list, list) {
2245                 tn->capabilities &= temp_node->capabilities;
2246         }
2247         tipc_bcast_toggle_rcast(net, (tn->capabilities & TIPC_BCAST_RCAST));
2248         err = 0;
2249 err_out:
2250         tipc_node_put(peer);
2251         spin_unlock_bh(&tn->node_list_lock);
2252
2253         return err;
2254 }
2255
2256 int tipc_nl_node_dump(struct sk_buff *skb, struct netlink_callback *cb)
2257 {
2258         int err;
2259         struct net *net = sock_net(skb->sk);
2260         struct tipc_net *tn = net_generic(net, tipc_net_id);
2261         int done = cb->args[0];
2262         int last_addr = cb->args[1];
2263         struct tipc_node *node;
2264         struct tipc_nl_msg msg;
2265
2266         if (done)
2267                 return 0;
2268
2269         msg.skb = skb;
2270         msg.portid = NETLINK_CB(cb->skb).portid;
2271         msg.seq = cb->nlh->nlmsg_seq;
2272
2273         rcu_read_lock();
2274         if (last_addr) {
2275                 node = tipc_node_find(net, last_addr);
2276                 if (!node) {
2277                         rcu_read_unlock();
2278                         /* We never set seq or call nl_dump_check_consistent()
2279                          * this means that setting prev_seq here will cause the
2280                          * consistence check to fail in the netlink callback
2281                          * handler. Resulting in the NLMSG_DONE message having
2282                          * the NLM_F_DUMP_INTR flag set if the node state
2283                          * changed while we released the lock.
2284                          */
2285                         cb->prev_seq = 1;
2286                         return -EPIPE;
2287                 }
2288                 tipc_node_put(node);
2289         }
2290
2291         list_for_each_entry_rcu(node, &tn->node_list, list) {
2292                 if (node->preliminary)
2293                         continue;
2294                 if (last_addr) {
2295                         if (node->addr == last_addr)
2296                                 last_addr = 0;
2297                         else
2298                                 continue;
2299                 }
2300
2301                 tipc_node_read_lock(node);
2302                 err = __tipc_nl_add_node(&msg, node);
2303                 if (err) {
2304                         last_addr = node->addr;
2305                         tipc_node_read_unlock(node);
2306                         goto out;
2307                 }
2308
2309                 tipc_node_read_unlock(node);
2310         }
2311         done = 1;
2312 out:
2313         cb->args[0] = done;
2314         cb->args[1] = last_addr;
2315         rcu_read_unlock();
2316
2317         return skb->len;
2318 }
2319
2320 /* tipc_node_find_by_name - locate owner node of link by link's name
2321  * @net: the applicable net namespace
2322  * @name: pointer to link name string
2323  * @bearer_id: pointer to index in 'node->links' array where the link was found.
2324  *
2325  * Returns pointer to node owning the link, or 0 if no matching link is found.
2326  */
2327 static struct tipc_node *tipc_node_find_by_name(struct net *net,
2328                                                 const char *link_name,
2329                                                 unsigned int *bearer_id)
2330 {
2331         struct tipc_net *tn = net_generic(net, tipc_net_id);
2332         struct tipc_link *l;
2333         struct tipc_node *n;
2334         struct tipc_node *found_node = NULL;
2335         int i;
2336
2337         *bearer_id = 0;
2338         rcu_read_lock();
2339         list_for_each_entry_rcu(n, &tn->node_list, list) {
2340                 tipc_node_read_lock(n);
2341                 for (i = 0; i < MAX_BEARERS; i++) {
2342                         l = n->links[i].link;
2343                         if (l && !strcmp(tipc_link_name(l), link_name)) {
2344                                 *bearer_id = i;
2345                                 found_node = n;
2346                                 break;
2347                         }
2348                 }
2349                 tipc_node_read_unlock(n);
2350                 if (found_node)
2351                         break;
2352         }
2353         rcu_read_unlock();
2354
2355         return found_node;
2356 }
2357
2358 int tipc_nl_node_set_link(struct sk_buff *skb, struct genl_info *info)
2359 {
2360         int err;
2361         int res = 0;
2362         int bearer_id;
2363         char *name;
2364         struct tipc_link *link;
2365         struct tipc_node *node;
2366         struct sk_buff_head xmitq;
2367         struct nlattr *attrs[TIPC_NLA_LINK_MAX + 1];
2368         struct net *net = sock_net(skb->sk);
2369
2370         __skb_queue_head_init(&xmitq);
2371
2372         if (!info->attrs[TIPC_NLA_LINK])
2373                 return -EINVAL;
2374
2375         err = nla_parse_nested_deprecated(attrs, TIPC_NLA_LINK_MAX,
2376                                           info->attrs[TIPC_NLA_LINK],
2377                                           tipc_nl_link_policy, info->extack);
2378         if (err)
2379                 return err;
2380
2381         if (!attrs[TIPC_NLA_LINK_NAME])
2382                 return -EINVAL;
2383
2384         name = nla_data(attrs[TIPC_NLA_LINK_NAME]);
2385
2386         if (strcmp(name, tipc_bclink_name) == 0)
2387                 return tipc_nl_bc_link_set(net, attrs);
2388
2389         node = tipc_node_find_by_name(net, name, &bearer_id);
2390         if (!node)
2391                 return -EINVAL;
2392
2393         tipc_node_read_lock(node);
2394
2395         link = node->links[bearer_id].link;
2396         if (!link) {
2397                 res = -EINVAL;
2398                 goto out;
2399         }
2400
2401         if (attrs[TIPC_NLA_LINK_PROP]) {
2402                 struct nlattr *props[TIPC_NLA_PROP_MAX + 1];
2403
2404                 err = tipc_nl_parse_link_prop(attrs[TIPC_NLA_LINK_PROP], props);
2405                 if (err) {
2406                         res = err;
2407                         goto out;
2408                 }
2409
2410                 if (props[TIPC_NLA_PROP_TOL]) {
2411                         u32 tol;
2412
2413                         tol = nla_get_u32(props[TIPC_NLA_PROP_TOL]);
2414                         tipc_link_set_tolerance(link, tol, &xmitq);
2415                 }
2416                 if (props[TIPC_NLA_PROP_PRIO]) {
2417                         u32 prio;
2418
2419                         prio = nla_get_u32(props[TIPC_NLA_PROP_PRIO]);
2420                         tipc_link_set_prio(link, prio, &xmitq);
2421                 }
2422                 if (props[TIPC_NLA_PROP_WIN]) {
2423                         u32 max_win;
2424
2425                         max_win = nla_get_u32(props[TIPC_NLA_PROP_WIN]);
2426                         tipc_link_set_queue_limits(link,
2427                                                    tipc_link_min_win(link),
2428                                                    max_win);
2429                 }
2430         }
2431
2432 out:
2433         tipc_node_read_unlock(node);
2434         tipc_bearer_xmit(net, bearer_id, &xmitq, &node->links[bearer_id].maddr,
2435                          NULL);
2436         return res;
2437 }
2438
2439 int tipc_nl_node_get_link(struct sk_buff *skb, struct genl_info *info)
2440 {
2441         struct net *net = genl_info_net(info);
2442         struct nlattr *attrs[TIPC_NLA_LINK_MAX + 1];
2443         struct tipc_nl_msg msg;
2444         char *name;
2445         int err;
2446
2447         msg.portid = info->snd_portid;
2448         msg.seq = info->snd_seq;
2449
2450         if (!info->attrs[TIPC_NLA_LINK])
2451                 return -EINVAL;
2452
2453         err = nla_parse_nested_deprecated(attrs, TIPC_NLA_LINK_MAX,
2454                                           info->attrs[TIPC_NLA_LINK],
2455                                           tipc_nl_link_policy, info->extack);
2456         if (err)
2457                 return err;
2458
2459         if (!attrs[TIPC_NLA_LINK_NAME])
2460                 return -EINVAL;
2461
2462         name = nla_data(attrs[TIPC_NLA_LINK_NAME]);
2463
2464         msg.skb = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
2465         if (!msg.skb)
2466                 return -ENOMEM;
2467
2468         if (strcmp(name, tipc_bclink_name) == 0) {
2469                 err = tipc_nl_add_bc_link(net, &msg, tipc_net(net)->bcl);
2470                 if (err)
2471                         goto err_free;
2472         } else {
2473                 int bearer_id;
2474                 struct tipc_node *node;
2475                 struct tipc_link *link;
2476
2477                 node = tipc_node_find_by_name(net, name, &bearer_id);
2478                 if (!node) {
2479                         err = -EINVAL;
2480                         goto err_free;
2481                 }
2482
2483                 tipc_node_read_lock(node);
2484                 link = node->links[bearer_id].link;
2485                 if (!link) {
2486                         tipc_node_read_unlock(node);
2487                         err = -EINVAL;
2488                         goto err_free;
2489                 }
2490
2491                 err = __tipc_nl_add_link(net, &msg, link, 0);
2492                 tipc_node_read_unlock(node);
2493                 if (err)
2494                         goto err_free;
2495         }
2496
2497         return genlmsg_reply(msg.skb, info);
2498
2499 err_free:
2500         nlmsg_free(msg.skb);
2501         return err;
2502 }
2503
2504 int tipc_nl_node_reset_link_stats(struct sk_buff *skb, struct genl_info *info)
2505 {
2506         int err;
2507         char *link_name;
2508         unsigned int bearer_id;
2509         struct tipc_link *link;
2510         struct tipc_node *node;
2511         struct nlattr *attrs[TIPC_NLA_LINK_MAX + 1];
2512         struct net *net = sock_net(skb->sk);
2513         struct tipc_net *tn = tipc_net(net);
2514         struct tipc_link_entry *le;
2515
2516         if (!info->attrs[TIPC_NLA_LINK])
2517                 return -EINVAL;
2518
2519         err = nla_parse_nested_deprecated(attrs, TIPC_NLA_LINK_MAX,
2520                                           info->attrs[TIPC_NLA_LINK],
2521                                           tipc_nl_link_policy, info->extack);
2522         if (err)
2523                 return err;
2524
2525         if (!attrs[TIPC_NLA_LINK_NAME])
2526                 return -EINVAL;
2527
2528         link_name = nla_data(attrs[TIPC_NLA_LINK_NAME]);
2529
2530         err = -EINVAL;
2531         if (!strcmp(link_name, tipc_bclink_name)) {
2532                 err = tipc_bclink_reset_stats(net, tipc_bc_sndlink(net));
2533                 if (err)
2534                         return err;
2535                 return 0;
2536         } else if (strstr(link_name, tipc_bclink_name)) {
2537                 rcu_read_lock();
2538                 list_for_each_entry_rcu(node, &tn->node_list, list) {
2539                         tipc_node_read_lock(node);
2540                         link = node->bc_entry.link;
2541                         if (link && !strcmp(link_name, tipc_link_name(link))) {
2542                                 err = tipc_bclink_reset_stats(net, link);
2543                                 tipc_node_read_unlock(node);
2544                                 break;
2545                         }
2546                         tipc_node_read_unlock(node);
2547                 }
2548                 rcu_read_unlock();
2549                 return err;
2550         }
2551
2552         node = tipc_node_find_by_name(net, link_name, &bearer_id);
2553         if (!node)
2554                 return -EINVAL;
2555
2556         le = &node->links[bearer_id];
2557         tipc_node_read_lock(node);
2558         spin_lock_bh(&le->lock);
2559         link = node->links[bearer_id].link;
2560         if (!link) {
2561                 spin_unlock_bh(&le->lock);
2562                 tipc_node_read_unlock(node);
2563                 return -EINVAL;
2564         }
2565         tipc_link_reset_stats(link);
2566         spin_unlock_bh(&le->lock);
2567         tipc_node_read_unlock(node);
2568         return 0;
2569 }
2570
2571 /* Caller should hold node lock  */
2572 static int __tipc_nl_add_node_links(struct net *net, struct tipc_nl_msg *msg,
2573                                     struct tipc_node *node, u32 *prev_link,
2574                                     bool bc_link)
2575 {
2576         u32 i;
2577         int err;
2578
2579         for (i = *prev_link; i < MAX_BEARERS; i++) {
2580                 *prev_link = i;
2581
2582                 if (!node->links[i].link)
2583                         continue;
2584
2585                 err = __tipc_nl_add_link(net, msg,
2586                                          node->links[i].link, NLM_F_MULTI);
2587                 if (err)
2588                         return err;
2589         }
2590
2591         if (bc_link) {
2592                 *prev_link = i;
2593                 err = tipc_nl_add_bc_link(net, msg, node->bc_entry.link);
2594                 if (err)
2595                         return err;
2596         }
2597
2598         *prev_link = 0;
2599
2600         return 0;
2601 }
2602
2603 int tipc_nl_node_dump_link(struct sk_buff *skb, struct netlink_callback *cb)
2604 {
2605         struct net *net = sock_net(skb->sk);
2606         struct nlattr **attrs = genl_dumpit_info(cb)->attrs;
2607         struct nlattr *link[TIPC_NLA_LINK_MAX + 1];
2608         struct tipc_net *tn = net_generic(net, tipc_net_id);
2609         struct tipc_node *node;
2610         struct tipc_nl_msg msg;
2611         u32 prev_node = cb->args[0];
2612         u32 prev_link = cb->args[1];
2613         int done = cb->args[2];
2614         bool bc_link = cb->args[3];
2615         int err;
2616
2617         if (done)
2618                 return 0;
2619
2620         if (!prev_node) {
2621                 /* Check if broadcast-receiver links dumping is needed */
2622                 if (attrs && attrs[TIPC_NLA_LINK]) {
2623                         err = nla_parse_nested_deprecated(link,
2624                                                           TIPC_NLA_LINK_MAX,
2625                                                           attrs[TIPC_NLA_LINK],
2626                                                           tipc_nl_link_policy,
2627                                                           NULL);
2628                         if (unlikely(err))
2629                                 return err;
2630                         if (unlikely(!link[TIPC_NLA_LINK_BROADCAST]))
2631                                 return -EINVAL;
2632                         bc_link = true;
2633                 }
2634         }
2635
2636         msg.skb = skb;
2637         msg.portid = NETLINK_CB(cb->skb).portid;
2638         msg.seq = cb->nlh->nlmsg_seq;
2639
2640         rcu_read_lock();
2641         if (prev_node) {
2642                 node = tipc_node_find(net, prev_node);
2643                 if (!node) {
2644                         /* We never set seq or call nl_dump_check_consistent()
2645                          * this means that setting prev_seq here will cause the
2646                          * consistence check to fail in the netlink callback
2647                          * handler. Resulting in the last NLMSG_DONE message
2648                          * having the NLM_F_DUMP_INTR flag set.
2649                          */
2650                         cb->prev_seq = 1;
2651                         goto out;
2652                 }
2653                 tipc_node_put(node);
2654
2655                 list_for_each_entry_continue_rcu(node, &tn->node_list,
2656                                                  list) {
2657                         tipc_node_read_lock(node);
2658                         err = __tipc_nl_add_node_links(net, &msg, node,
2659                                                        &prev_link, bc_link);
2660                         tipc_node_read_unlock(node);
2661                         if (err)
2662                                 goto out;
2663
2664                         prev_node = node->addr;
2665                 }
2666         } else {
2667                 err = tipc_nl_add_bc_link(net, &msg, tn->bcl);
2668                 if (err)
2669                         goto out;
2670
2671                 list_for_each_entry_rcu(node, &tn->node_list, list) {
2672                         tipc_node_read_lock(node);
2673                         err = __tipc_nl_add_node_links(net, &msg, node,
2674                                                        &prev_link, bc_link);
2675                         tipc_node_read_unlock(node);
2676                         if (err)
2677                                 goto out;
2678
2679                         prev_node = node->addr;
2680                 }
2681         }
2682         done = 1;
2683 out:
2684         rcu_read_unlock();
2685
2686         cb->args[0] = prev_node;
2687         cb->args[1] = prev_link;
2688         cb->args[2] = done;
2689         cb->args[3] = bc_link;
2690
2691         return skb->len;
2692 }
2693
2694 int tipc_nl_node_set_monitor(struct sk_buff *skb, struct genl_info *info)
2695 {
2696         struct nlattr *attrs[TIPC_NLA_MON_MAX + 1];
2697         struct net *net = sock_net(skb->sk);
2698         int err;
2699
2700         if (!info->attrs[TIPC_NLA_MON])
2701                 return -EINVAL;
2702
2703         err = nla_parse_nested_deprecated(attrs, TIPC_NLA_MON_MAX,
2704                                           info->attrs[TIPC_NLA_MON],
2705                                           tipc_nl_monitor_policy,
2706                                           info->extack);
2707         if (err)
2708                 return err;
2709
2710         if (attrs[TIPC_NLA_MON_ACTIVATION_THRESHOLD]) {
2711                 u32 val;
2712
2713                 val = nla_get_u32(attrs[TIPC_NLA_MON_ACTIVATION_THRESHOLD]);
2714                 err = tipc_nl_monitor_set_threshold(net, val);
2715                 if (err)
2716                         return err;
2717         }
2718
2719         return 0;
2720 }
2721
2722 static int __tipc_nl_add_monitor_prop(struct net *net, struct tipc_nl_msg *msg)
2723 {
2724         struct nlattr *attrs;
2725         void *hdr;
2726         u32 val;
2727
2728         hdr = genlmsg_put(msg->skb, msg->portid, msg->seq, &tipc_genl_family,
2729                           0, TIPC_NL_MON_GET);
2730         if (!hdr)
2731                 return -EMSGSIZE;
2732
2733         attrs = nla_nest_start_noflag(msg->skb, TIPC_NLA_MON);
2734         if (!attrs)
2735                 goto msg_full;
2736
2737         val = tipc_nl_monitor_get_threshold(net);
2738
2739         if (nla_put_u32(msg->skb, TIPC_NLA_MON_ACTIVATION_THRESHOLD, val))
2740                 goto attr_msg_full;
2741
2742         nla_nest_end(msg->skb, attrs);
2743         genlmsg_end(msg->skb, hdr);
2744
2745         return 0;
2746
2747 attr_msg_full:
2748         nla_nest_cancel(msg->skb, attrs);
2749 msg_full:
2750         genlmsg_cancel(msg->skb, hdr);
2751
2752         return -EMSGSIZE;
2753 }
2754
2755 int tipc_nl_node_get_monitor(struct sk_buff *skb, struct genl_info *info)
2756 {
2757         struct net *net = sock_net(skb->sk);
2758         struct tipc_nl_msg msg;
2759         int err;
2760
2761         msg.skb = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
2762         if (!msg.skb)
2763                 return -ENOMEM;
2764         msg.portid = info->snd_portid;
2765         msg.seq = info->snd_seq;
2766
2767         err = __tipc_nl_add_monitor_prop(net, &msg);
2768         if (err) {
2769                 nlmsg_free(msg.skb);
2770                 return err;
2771         }
2772
2773         return genlmsg_reply(msg.skb, info);
2774 }
2775
2776 int tipc_nl_node_dump_monitor(struct sk_buff *skb, struct netlink_callback *cb)
2777 {
2778         struct net *net = sock_net(skb->sk);
2779         u32 prev_bearer = cb->args[0];
2780         struct tipc_nl_msg msg;
2781         int bearer_id;
2782         int err;
2783
2784         if (prev_bearer == MAX_BEARERS)
2785                 return 0;
2786
2787         msg.skb = skb;
2788         msg.portid = NETLINK_CB(cb->skb).portid;
2789         msg.seq = cb->nlh->nlmsg_seq;
2790
2791         rtnl_lock();
2792         for (bearer_id = prev_bearer; bearer_id < MAX_BEARERS; bearer_id++) {
2793                 err = __tipc_nl_add_monitor(net, &msg, bearer_id);
2794                 if (err)
2795                         break;
2796         }
2797         rtnl_unlock();
2798         cb->args[0] = bearer_id;
2799
2800         return skb->len;
2801 }
2802
2803 int tipc_nl_node_dump_monitor_peer(struct sk_buff *skb,
2804                                    struct netlink_callback *cb)
2805 {
2806         struct net *net = sock_net(skb->sk);
2807         u32 prev_node = cb->args[1];
2808         u32 bearer_id = cb->args[2];
2809         int done = cb->args[0];
2810         struct tipc_nl_msg msg;
2811         int err;
2812
2813         if (!prev_node) {
2814                 struct nlattr **attrs = genl_dumpit_info(cb)->attrs;
2815                 struct nlattr *mon[TIPC_NLA_MON_MAX + 1];
2816
2817                 if (!attrs[TIPC_NLA_MON])
2818                         return -EINVAL;
2819
2820                 err = nla_parse_nested_deprecated(mon, TIPC_NLA_MON_MAX,
2821                                                   attrs[TIPC_NLA_MON],
2822                                                   tipc_nl_monitor_policy,
2823                                                   NULL);
2824                 if (err)
2825                         return err;
2826
2827                 if (!mon[TIPC_NLA_MON_REF])
2828                         return -EINVAL;
2829
2830                 bearer_id = nla_get_u32(mon[TIPC_NLA_MON_REF]);
2831
2832                 if (bearer_id >= MAX_BEARERS)
2833                         return -EINVAL;
2834         }
2835
2836         if (done)
2837                 return 0;
2838
2839         msg.skb = skb;
2840         msg.portid = NETLINK_CB(cb->skb).portid;
2841         msg.seq = cb->nlh->nlmsg_seq;
2842
2843         rtnl_lock();
2844         err = tipc_nl_add_monitor_peer(net, &msg, bearer_id, &prev_node);
2845         if (!err)
2846                 done = 1;
2847
2848         rtnl_unlock();
2849         cb->args[0] = done;
2850         cb->args[1] = prev_node;
2851         cb->args[2] = bearer_id;
2852
2853         return skb->len;
2854 }
2855
2856 #ifdef CONFIG_TIPC_CRYPTO
2857 static int tipc_nl_retrieve_key(struct nlattr **attrs,
2858                                 struct tipc_aead_key **key)
2859 {
2860         struct nlattr *attr = attrs[TIPC_NLA_NODE_KEY];
2861
2862         if (!attr)
2863                 return -ENODATA;
2864
2865         *key = (struct tipc_aead_key *)nla_data(attr);
2866         if (nla_len(attr) < tipc_aead_key_size(*key))
2867                 return -EINVAL;
2868
2869         return 0;
2870 }
2871
2872 static int tipc_nl_retrieve_nodeid(struct nlattr **attrs, u8 **node_id)
2873 {
2874         struct nlattr *attr = attrs[TIPC_NLA_NODE_ID];
2875
2876         if (!attr)
2877                 return -ENODATA;
2878
2879         if (nla_len(attr) < TIPC_NODEID_LEN)
2880                 return -EINVAL;
2881
2882         *node_id = (u8 *)nla_data(attr);
2883         return 0;
2884 }
2885
2886 static int tipc_nl_retrieve_rekeying(struct nlattr **attrs, u32 *intv)
2887 {
2888         struct nlattr *attr = attrs[TIPC_NLA_NODE_REKEYING];
2889
2890         if (!attr)
2891                 return -ENODATA;
2892
2893         *intv = nla_get_u32(attr);
2894         return 0;
2895 }
2896
2897 static int __tipc_nl_node_set_key(struct sk_buff *skb, struct genl_info *info)
2898 {
2899         struct nlattr *attrs[TIPC_NLA_NODE_MAX + 1];
2900         struct net *net = sock_net(skb->sk);
2901         struct tipc_crypto *tx = tipc_net(net)->crypto_tx, *c = tx;
2902         struct tipc_node *n = NULL;
2903         struct tipc_aead_key *ukey;
2904         bool rekeying = true, master_key = false;
2905         u8 *id, *own_id, mode;
2906         u32 intv = 0;
2907         int rc = 0;
2908
2909         if (!info->attrs[TIPC_NLA_NODE])
2910                 return -EINVAL;
2911
2912         rc = nla_parse_nested(attrs, TIPC_NLA_NODE_MAX,
2913                               info->attrs[TIPC_NLA_NODE],
2914                               tipc_nl_node_policy, info->extack);
2915         if (rc)
2916                 return rc;
2917
2918         own_id = tipc_own_id(net);
2919         if (!own_id) {
2920                 GENL_SET_ERR_MSG(info, "not found own node identity (set id?)");
2921                 return -EPERM;
2922         }
2923
2924         rc = tipc_nl_retrieve_rekeying(attrs, &intv);
2925         if (rc == -ENODATA)
2926                 rekeying = false;
2927
2928         rc = tipc_nl_retrieve_key(attrs, &ukey);
2929         if (rc == -ENODATA && rekeying)
2930                 goto rekeying;
2931         else if (rc)
2932                 return rc;
2933
2934         rc = tipc_aead_key_validate(ukey, info);
2935         if (rc)
2936                 return rc;
2937
2938         rc = tipc_nl_retrieve_nodeid(attrs, &id);
2939         switch (rc) {
2940         case -ENODATA:
2941                 mode = CLUSTER_KEY;
2942                 master_key = !!(attrs[TIPC_NLA_NODE_KEY_MASTER]);
2943                 break;
2944         case 0:
2945                 mode = PER_NODE_KEY;
2946                 if (memcmp(id, own_id, NODE_ID_LEN)) {
2947                         n = tipc_node_find_by_id(net, id) ?:
2948                                 tipc_node_create(net, 0, id, 0xffffu, 0, true);
2949                         if (unlikely(!n))
2950                                 return -ENOMEM;
2951                         c = n->crypto_rx;
2952                 }
2953                 break;
2954         default:
2955                 return rc;
2956         }
2957
2958         /* Initiate the TX/RX key */
2959         rc = tipc_crypto_key_init(c, ukey, mode, master_key);
2960         if (n)
2961                 tipc_node_put(n);
2962
2963         if (unlikely(rc < 0)) {
2964                 GENL_SET_ERR_MSG(info, "unable to initiate or attach new key");
2965                 return rc;
2966         } else if (c == tx) {
2967                 /* Distribute TX key but not master one */
2968                 if (!master_key && tipc_crypto_key_distr(tx, rc, NULL))
2969                         GENL_SET_ERR_MSG(info, "failed to replicate new key");
2970 rekeying:
2971                 /* Schedule TX rekeying if needed */
2972                 tipc_crypto_rekeying_sched(tx, rekeying, intv);
2973         }
2974
2975         return 0;
2976 }
2977
2978 int tipc_nl_node_set_key(struct sk_buff *skb, struct genl_info *info)
2979 {
2980         int err;
2981
2982         rtnl_lock();
2983         err = __tipc_nl_node_set_key(skb, info);
2984         rtnl_unlock();
2985
2986         return err;
2987 }
2988
2989 static int __tipc_nl_node_flush_key(struct sk_buff *skb,
2990                                     struct genl_info *info)
2991 {
2992         struct net *net = sock_net(skb->sk);
2993         struct tipc_net *tn = tipc_net(net);
2994         struct tipc_node *n;
2995
2996         tipc_crypto_key_flush(tn->crypto_tx);
2997         rcu_read_lock();
2998         list_for_each_entry_rcu(n, &tn->node_list, list)
2999                 tipc_crypto_key_flush(n->crypto_rx);
3000         rcu_read_unlock();
3001
3002         return 0;
3003 }
3004
3005 int tipc_nl_node_flush_key(struct sk_buff *skb, struct genl_info *info)
3006 {
3007         int err;
3008
3009         rtnl_lock();
3010         err = __tipc_nl_node_flush_key(skb, info);
3011         rtnl_unlock();
3012
3013         return err;
3014 }
3015 #endif
3016
3017 /**
3018  * tipc_node_dump - dump TIPC node data
3019  * @n: tipc node to be dumped
3020  * @more: dump more?
3021  *        - false: dump only tipc node data
3022  *        - true: dump node link data as well
3023  * @buf: returned buffer of dump data in format
3024  */
3025 int tipc_node_dump(struct tipc_node *n, bool more, char *buf)
3026 {
3027         int i = 0;
3028         size_t sz = (more) ? NODE_LMAX : NODE_LMIN;
3029
3030         if (!n) {
3031                 i += scnprintf(buf, sz, "node data: (null)\n");
3032                 return i;
3033         }
3034
3035         i += scnprintf(buf, sz, "node data: %x", n->addr);
3036         i += scnprintf(buf + i, sz - i, " %x", n->state);
3037         i += scnprintf(buf + i, sz - i, " %d", n->active_links[0]);
3038         i += scnprintf(buf + i, sz - i, " %d", n->active_links[1]);
3039         i += scnprintf(buf + i, sz - i, " %x", n->action_flags);
3040         i += scnprintf(buf + i, sz - i, " %u", n->failover_sent);
3041         i += scnprintf(buf + i, sz - i, " %u", n->sync_point);
3042         i += scnprintf(buf + i, sz - i, " %d", n->link_cnt);
3043         i += scnprintf(buf + i, sz - i, " %u", n->working_links);
3044         i += scnprintf(buf + i, sz - i, " %x", n->capabilities);
3045         i += scnprintf(buf + i, sz - i, " %lu\n", n->keepalive_intv);
3046
3047         if (!more)
3048                 return i;
3049
3050         i += scnprintf(buf + i, sz - i, "link_entry[0]:\n");
3051         i += scnprintf(buf + i, sz - i, " mtu: %u\n", n->links[0].mtu);
3052         i += scnprintf(buf + i, sz - i, " media: ");
3053         i += tipc_media_addr_printf(buf + i, sz - i, &n->links[0].maddr);
3054         i += scnprintf(buf + i, sz - i, "\n");
3055         i += tipc_link_dump(n->links[0].link, TIPC_DUMP_NONE, buf + i);
3056         i += scnprintf(buf + i, sz - i, " inputq: ");
3057         i += tipc_list_dump(&n->links[0].inputq, false, buf + i);
3058
3059         i += scnprintf(buf + i, sz - i, "link_entry[1]:\n");
3060         i += scnprintf(buf + i, sz - i, " mtu: %u\n", n->links[1].mtu);
3061         i += scnprintf(buf + i, sz - i, " media: ");
3062         i += tipc_media_addr_printf(buf + i, sz - i, &n->links[1].maddr);
3063         i += scnprintf(buf + i, sz - i, "\n");
3064         i += tipc_link_dump(n->links[1].link, TIPC_DUMP_NONE, buf + i);
3065         i += scnprintf(buf + i, sz - i, " inputq: ");
3066         i += tipc_list_dump(&n->links[1].inputq, false, buf + i);
3067
3068         i += scnprintf(buf + i, sz - i, "bclink:\n ");
3069         i += tipc_link_dump(n->bc_entry.link, TIPC_DUMP_NONE, buf + i);
3070
3071         return i;
3072 }
3073
3074 void tipc_node_pre_cleanup_net(struct net *exit_net)
3075 {
3076         struct tipc_node *n;
3077         struct tipc_net *tn;
3078         struct net *tmp;
3079
3080         rcu_read_lock();
3081         for_each_net_rcu(tmp) {
3082                 if (tmp == exit_net)
3083                         continue;
3084                 tn = tipc_net(tmp);
3085                 if (!tn)
3086                         continue;
3087                 spin_lock_bh(&tn->node_list_lock);
3088                 list_for_each_entry_rcu(n, &tn->node_list, list) {
3089                         if (!n->peer_net)
3090                                 continue;
3091                         if (n->peer_net != exit_net)
3092                                 continue;
3093                         tipc_node_write_lock(n);
3094                         n->peer_net = NULL;
3095                         n->peer_hash_mix = 0;
3096                         tipc_node_write_unlock_fast(n);
3097                         break;
3098                 }
3099                 spin_unlock_bh(&tn->node_list_lock);
3100         }
3101         rcu_read_unlock();
3102 }