blob: 21974191e425a78453fb05926b2302893731a5b4 [file] [log] [blame]
Per Lidenb97bf3f2006-01-02 19:04:38 +01001/*
2 * net/tipc/node.c: TIPC node management routines
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09003 *
Jon Paul Maloy60020e12016-05-02 11:58:46 -04004 * Copyright (c) 2000-2006, 2012-2016, Ericsson AB
Ying Xue46651c52014-03-27 12:54:36 +08005 * Copyright (c) 2005-2006, 2010-2014, Wind River Systems
Per Lidenb97bf3f2006-01-02 19:04:38 +01006 * All rights reserved.
7 *
Per Liden9ea1fd32006-01-11 13:30:43 +01008 * Redistribution and use in source and binary forms, with or without
Per Lidenb97bf3f2006-01-02 19:04:38 +01009 * modification, are permitted provided that the following conditions are met:
10 *
Per Liden9ea1fd32006-01-11 13:30:43 +010011 * 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.
Per Lidenb97bf3f2006-01-02 19:04:38 +010019 *
Per Liden9ea1fd32006-01-11 13:30:43 +010020 * 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
Per Lidenb97bf3f2006-01-02 19:04:38 +010034 * POSSIBILITY OF SUCH DAMAGE.
35 */
36
37#include "core.h"
Richard Alpe22ae7cf2015-02-09 09:50:18 +010038#include "link.h"
Per Lidenb97bf3f2006-01-02 19:04:38 +010039#include "node.h"
Per Lidenb97bf3f2006-01-02 19:04:38 +010040#include "name_distr.h"
Jon Paul Maloy50100a52014-08-22 18:09:07 -040041#include "socket.h"
Jon Paul Maloya6bf70f2015-05-14 10:46:13 -040042#include "bcast.h"
Jon Paul Maloy35c55c92016-06-13 20:46:22 -040043#include "monitor.h"
Jon Paul Maloyd9992972015-07-16 16:54:31 -040044#include "discover.h"
Richard Alpe49cc66e2016-03-04 17:04:42 +010045#include "netlink.h"
Jon Paul Maloyc8199302015-10-15 14:52:46 -040046
Jon Paul Maloy5be9c082015-11-19 14:30:45 -050047#define INVALID_NODE_SIG 0x10000
48
Jon Paul Maloy5be9c082015-11-19 14:30:45 -050049/* Flags used to take different actions according to flag type
50 * TIPC_NOTIFY_NODE_DOWN: notify node is down
51 * TIPC_NOTIFY_NODE_UP: notify node is up
52 * TIPC_DISTRIBUTE_NAME: publish or withdraw link state name type
53 */
54enum {
55 TIPC_NOTIFY_NODE_DOWN = (1 << 3),
56 TIPC_NOTIFY_NODE_UP = (1 << 4),
57 TIPC_NOTIFY_LINK_UP = (1 << 6),
58 TIPC_NOTIFY_LINK_DOWN = (1 << 7)
59};
60
61struct tipc_link_entry {
62 struct tipc_link *link;
63 spinlock_t lock; /* per link */
64 u32 mtu;
65 struct sk_buff_head inputq;
66 struct tipc_media_addr maddr;
67};
68
69struct tipc_bclink_entry {
70 struct tipc_link *link;
71 struct sk_buff_head inputq1;
72 struct sk_buff_head arrvq;
73 struct sk_buff_head inputq2;
74 struct sk_buff_head namedq;
75};
76
77/**
78 * struct tipc_node - TIPC node structure
79 * @addr: network address of node
80 * @ref: reference counter to node object
81 * @lock: rwlock governing access to structure
82 * @net: the applicable net namespace
83 * @hash: links to adjacent nodes in unsorted hash chain
84 * @inputq: pointer to input queue containing messages for msg event
85 * @namedq: pointer to name table input queue with name table messages
86 * @active_links: bearer ids of active links, used as index into links[] array
87 * @links: array containing references to all links to node
88 * @action_flags: bit mask of different types of node actions
89 * @state: connectivity state vs peer node
90 * @sync_point: sequence number where synch/failover is finished
91 * @list: links to adjacent nodes in sorted list of cluster's nodes
92 * @working_links: number of working links to node (both active and standby)
93 * @link_cnt: number of links to node
94 * @capabilities: bitmap, indicating peer node's functional capabilities
95 * @signature: node instance identifier
96 * @link_id: local and remote bearer ids of changing link, if any
97 * @publ_list: list of publications
98 * @rcu: rcu struct for tipc_node
99 */
100struct tipc_node {
101 u32 addr;
102 struct kref kref;
103 rwlock_t lock;
104 struct net *net;
105 struct hlist_node hash;
106 int active_links[2];
107 struct tipc_link_entry links[MAX_BEARERS];
108 struct tipc_bclink_entry bc_entry;
109 int action_flags;
110 struct list_head list;
111 int state;
112 u16 sync_point;
113 int link_cnt;
114 u16 working_links;
115 u16 capabilities;
116 u32 signature;
117 u32 link_id;
118 struct list_head publ_list;
119 struct list_head conn_sks;
120 unsigned long keepalive_intv;
121 struct timer_list timer;
122 struct rcu_head rcu;
123};
124
Jon Paul Maloy6e498152015-07-30 18:24:19 -0400125/* Node FSM states and events:
126 */
127enum {
128 SELF_DOWN_PEER_DOWN = 0xdd,
129 SELF_UP_PEER_UP = 0xaa,
130 SELF_DOWN_PEER_LEAVING = 0xd1,
131 SELF_UP_PEER_COMING = 0xac,
132 SELF_COMING_PEER_UP = 0xca,
133 SELF_LEAVING_PEER_DOWN = 0x1d,
134 NODE_FAILINGOVER = 0xf0,
135 NODE_SYNCHING = 0xcc
136};
137
138enum {
139 SELF_ESTABL_CONTACT_EVT = 0xece,
140 SELF_LOST_CONTACT_EVT = 0x1ce,
141 PEER_ESTABL_CONTACT_EVT = 0x9ece,
142 PEER_LOST_CONTACT_EVT = 0x91ce,
143 NODE_FAILOVER_BEGIN_EVT = 0xfbe,
144 NODE_FAILOVER_END_EVT = 0xfee,
145 NODE_SYNCH_BEGIN_EVT = 0xcbe,
146 NODE_SYNCH_END_EVT = 0xcee
147};
148
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400149static void __tipc_node_link_down(struct tipc_node *n, int *bearer_id,
150 struct sk_buff_head *xmitq,
151 struct tipc_media_addr **maddr);
152static void tipc_node_link_down(struct tipc_node *n, int bearer_id,
153 bool delete);
154static void node_lost_contact(struct tipc_node *n, struct sk_buff_head *inputq);
Ying Xue8a0f6eb2015-03-26 18:10:24 +0800155static void tipc_node_delete(struct tipc_node *node);
Jon Paul Maloy8a1577c2015-07-16 16:54:29 -0400156static void tipc_node_timeout(unsigned long data);
Jon Paul Maloyd9992972015-07-16 16:54:31 -0400157static void tipc_node_fsm_evt(struct tipc_node *n, int evt);
Jon Paul Maloy5be9c082015-11-19 14:30:45 -0500158static struct tipc_node *tipc_node_find(struct net *net, u32 addr);
159static void tipc_node_put(struct tipc_node *node);
160static bool tipc_node_is_up(struct tipc_node *n);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100161
Jon Paul Maloy02be61a2014-08-22 18:09:08 -0400162struct tipc_sock_conn {
163 u32 port;
164 u32 peer_port;
165 u32 peer_node;
166 struct list_head list;
167};
168
Jon Paul Maloy5be9c082015-11-19 14:30:45 -0500169static struct tipc_link *node_active_link(struct tipc_node *n, int sel)
170{
171 int bearer_id = n->active_links[sel & 1];
172
173 if (unlikely(bearer_id == INVALID_BEARER_ID))
174 return NULL;
175
176 return n->links[bearer_id].link;
177}
178
179int tipc_node_get_mtu(struct net *net, u32 addr, u32 sel)
180{
181 struct tipc_node *n;
182 int bearer_id;
183 unsigned int mtu = MAX_MSG_SIZE;
184
185 n = tipc_node_find(net, addr);
186 if (unlikely(!n))
187 return mtu;
188
189 bearer_id = n->active_links[sel & 1];
190 if (likely(bearer_id != INVALID_BEARER_ID))
191 mtu = n->links[bearer_id].mtu;
192 tipc_node_put(n);
193 return mtu;
194}
Jon Paul Maloy60020e12016-05-02 11:58:46 -0400195
196u16 tipc_node_get_capabilities(struct net *net, u32 addr)
197{
198 struct tipc_node *n;
199 u16 caps;
200
201 n = tipc_node_find(net, addr);
202 if (unlikely(!n))
203 return TIPC_NODE_CAPABILITIES;
204 caps = n->capabilities;
205 tipc_node_put(n);
206 return caps;
207}
208
Ying Xue8a0f6eb2015-03-26 18:10:24 +0800209static void tipc_node_kref_release(struct kref *kref)
210{
Jon Paul Maloyd25a01252016-02-24 11:10:48 -0500211 struct tipc_node *n = container_of(kref, struct tipc_node, kref);
Ying Xue8a0f6eb2015-03-26 18:10:24 +0800212
Jon Paul Maloyd25a01252016-02-24 11:10:48 -0500213 kfree(n->bc_entry.link);
214 kfree_rcu(n, rcu);
Ying Xue8a0f6eb2015-03-26 18:10:24 +0800215}
216
Jon Paul Maloy5be9c082015-11-19 14:30:45 -0500217static void tipc_node_put(struct tipc_node *node)
Ying Xue8a0f6eb2015-03-26 18:10:24 +0800218{
219 kref_put(&node->kref, tipc_node_kref_release);
220}
221
222static void tipc_node_get(struct tipc_node *node)
223{
224 kref_get(&node->kref);
225}
226
Allan Stephensa635b462011-11-04 11:54:43 -0400227/*
Allan Stephens672d99e2011-02-25 18:42:52 -0500228 * tipc_node_find - locate specified node object, if it exists
229 */
Jon Paul Maloy5be9c082015-11-19 14:30:45 -0500230static struct tipc_node *tipc_node_find(struct net *net, u32 addr)
Allan Stephens672d99e2011-02-25 18:42:52 -0500231{
Jon Paul Maloyb1709972016-02-24 11:00:19 -0500232 struct tipc_net *tn = tipc_net(net);
Allan Stephens672d99e2011-02-25 18:42:52 -0500233 struct tipc_node *node;
Jon Paul Maloyb1709972016-02-24 11:00:19 -0500234 unsigned int thash = tipc_hashfn(addr);
Allan Stephens672d99e2011-02-25 18:42:52 -0500235
Ying Xue34747532015-01-09 15:27:10 +0800236 if (unlikely(!in_own_cluster_exact(net, addr)))
Allan Stephens672d99e2011-02-25 18:42:52 -0500237 return NULL;
238
Ying Xue6c7a7622014-03-27 12:54:37 +0800239 rcu_read_lock();
Jon Paul Maloyb1709972016-02-24 11:00:19 -0500240 hlist_for_each_entry_rcu(node, &tn->node_htable[thash], hash) {
241 if (node->addr != addr)
242 continue;
243 if (!kref_get_unless_zero(&node->kref))
244 node = NULL;
245 break;
Allan Stephens672d99e2011-02-25 18:42:52 -0500246 }
Ying Xue6c7a7622014-03-27 12:54:37 +0800247 rcu_read_unlock();
Jon Paul Maloyb1709972016-02-24 11:00:19 -0500248 return node;
Allan Stephens672d99e2011-02-25 18:42:52 -0500249}
250
Jon Paul Maloy5be9c082015-11-19 14:30:45 -0500251static void tipc_node_read_lock(struct tipc_node *n)
Jon Paul Maloy5405ff62015-11-19 14:30:44 -0500252{
253 read_lock_bh(&n->lock);
254}
255
Jon Paul Maloy5be9c082015-11-19 14:30:45 -0500256static void tipc_node_read_unlock(struct tipc_node *n)
Jon Paul Maloy5405ff62015-11-19 14:30:44 -0500257{
258 read_unlock_bh(&n->lock);
259}
260
261static void tipc_node_write_lock(struct tipc_node *n)
262{
263 write_lock_bh(&n->lock);
264}
265
266static void tipc_node_write_unlock(struct tipc_node *n)
267{
268 struct net *net = n->net;
269 u32 addr = 0;
270 u32 flags = n->action_flags;
271 u32 link_id = 0;
Jon Paul Maloy35c55c92016-06-13 20:46:22 -0400272 u32 bearer_id;
Jon Paul Maloy5405ff62015-11-19 14:30:44 -0500273 struct list_head *publ_list;
274
275 if (likely(!flags)) {
276 write_unlock_bh(&n->lock);
277 return;
278 }
279
280 addr = n->addr;
281 link_id = n->link_id;
Jon Paul Maloy35c55c92016-06-13 20:46:22 -0400282 bearer_id = link_id & 0xffff;
Jon Paul Maloy5405ff62015-11-19 14:30:44 -0500283 publ_list = &n->publ_list;
284
285 n->action_flags &= ~(TIPC_NOTIFY_NODE_DOWN | TIPC_NOTIFY_NODE_UP |
286 TIPC_NOTIFY_LINK_DOWN | TIPC_NOTIFY_LINK_UP);
287
288 write_unlock_bh(&n->lock);
289
290 if (flags & TIPC_NOTIFY_NODE_DOWN)
291 tipc_publ_notify(net, publ_list, addr);
292
293 if (flags & TIPC_NOTIFY_NODE_UP)
294 tipc_named_node_up(net, addr);
295
Jon Paul Maloy35c55c92016-06-13 20:46:22 -0400296 if (flags & TIPC_NOTIFY_LINK_UP) {
297 tipc_mon_peer_up(net, addr, bearer_id);
Jon Paul Maloy5405ff62015-11-19 14:30:44 -0500298 tipc_nametbl_publish(net, TIPC_LINK_STATE, addr, addr,
299 TIPC_NODE_SCOPE, link_id, addr);
Jon Paul Maloy35c55c92016-06-13 20:46:22 -0400300 }
301 if (flags & TIPC_NOTIFY_LINK_DOWN) {
302 tipc_mon_peer_down(net, addr, bearer_id);
Jon Paul Maloy5405ff62015-11-19 14:30:44 -0500303 tipc_nametbl_withdraw(net, TIPC_LINK_STATE, addr,
304 link_id, addr);
Jon Paul Maloy35c55c92016-06-13 20:46:22 -0400305 }
Jon Paul Maloy5405ff62015-11-19 14:30:44 -0500306}
307
Jon Paul Maloycf148812015-07-30 18:24:22 -0400308struct tipc_node *tipc_node_create(struct net *net, u32 addr, u16 capabilities)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100309{
Ying Xuef2f98002015-01-09 15:27:05 +0800310 struct tipc_net *tn = net_generic(net, tipc_net_id);
Jon Paul Maloy1a906322015-11-19 14:30:47 -0500311 struct tipc_node *n, *temp_node;
Jon Paul Maloy5405ff62015-11-19 14:30:44 -0500312 int i;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100313
Ying Xuef2f98002015-01-09 15:27:05 +0800314 spin_lock_bh(&tn->node_list_lock);
Jon Paul Maloy1a906322015-11-19 14:30:47 -0500315 n = tipc_node_find(net, addr);
Jon Paul Maloy60020e12016-05-02 11:58:46 -0400316 if (n) {
317 /* Same node may come back with new capabilities */
318 n->capabilities = capabilities;
Jon Paul Maloyb45db712015-02-03 08:59:19 -0500319 goto exit;
Jon Paul Maloy60020e12016-05-02 11:58:46 -0400320 }
Jon Paul Maloy1a906322015-11-19 14:30:47 -0500321 n = kzalloc(sizeof(*n), GFP_ATOMIC);
322 if (!n) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400323 pr_warn("Node creation failed, no memory\n");
Jon Paul Maloyb45db712015-02-03 08:59:19 -0500324 goto exit;
Allan Stephensa10bd922006-06-25 23:52:17 -0700325 }
Jon Paul Maloy1a906322015-11-19 14:30:47 -0500326 n->addr = addr;
327 n->net = net;
328 n->capabilities = capabilities;
329 kref_init(&n->kref);
330 rwlock_init(&n->lock);
331 INIT_HLIST_NODE(&n->hash);
332 INIT_LIST_HEAD(&n->list);
333 INIT_LIST_HEAD(&n->publ_list);
334 INIT_LIST_HEAD(&n->conn_sks);
335 skb_queue_head_init(&n->bc_entry.namedq);
336 skb_queue_head_init(&n->bc_entry.inputq1);
337 __skb_queue_head_init(&n->bc_entry.arrvq);
338 skb_queue_head_init(&n->bc_entry.inputq2);
Jon Paul Maloy5405ff62015-11-19 14:30:44 -0500339 for (i = 0; i < MAX_BEARERS; i++)
Jon Paul Maloy1a906322015-11-19 14:30:47 -0500340 spin_lock_init(&n->links[i].lock);
Jon Paul Maloy1a906322015-11-19 14:30:47 -0500341 n->state = SELF_DOWN_PEER_LEAVING;
342 n->signature = INVALID_NODE_SIG;
343 n->active_links[0] = INVALID_BEARER_ID;
344 n->active_links[1] = INVALID_BEARER_ID;
345 if (!tipc_link_bc_create(net, tipc_own_addr(net), n->addr,
Jon Paul Maloy38206d52015-11-19 14:30:46 -0500346 U16_MAX,
347 tipc_link_window(tipc_bc_sndlink(net)),
Jon Paul Maloy1a906322015-11-19 14:30:47 -0500348 n->capabilities,
349 &n->bc_entry.inputq1,
350 &n->bc_entry.namedq,
Jon Paul Maloy52666982015-10-22 08:51:41 -0400351 tipc_bc_sndlink(net),
Jon Paul Maloy1a906322015-11-19 14:30:47 -0500352 &n->bc_entry.link)) {
Jon Paul Maloy52666982015-10-22 08:51:41 -0400353 pr_warn("Broadcast rcv link creation failed, no memory\n");
Jon Paul Maloy1a906322015-11-19 14:30:47 -0500354 kfree(n);
355 n = NULL;
Jon Paul Maloy52666982015-10-22 08:51:41 -0400356 goto exit;
357 }
Jon Paul Maloy1a906322015-11-19 14:30:47 -0500358 tipc_node_get(n);
359 setup_timer(&n->timer, tipc_node_timeout, (unsigned long)n);
360 n->keepalive_intv = U32_MAX;
Jon Paul Maloyd5c91fb2016-02-10 16:14:57 -0500361 hlist_add_head_rcu(&n->hash, &tn->node_htable[tipc_hashfn(addr)]);
362 list_for_each_entry_rcu(temp_node, &tn->node_list, list) {
363 if (n->addr < temp_node->addr)
364 break;
365 }
366 list_add_tail_rcu(&n->list, &temp_node->list);
Jon Paul Maloyb45db712015-02-03 08:59:19 -0500367exit:
Ying Xuef2f98002015-01-09 15:27:05 +0800368 spin_unlock_bh(&tn->node_list_lock);
Jon Paul Maloy1a906322015-11-19 14:30:47 -0500369 return n;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100370}
371
Jon Paul Maloy8a1577c2015-07-16 16:54:29 -0400372static void tipc_node_calculate_timer(struct tipc_node *n, struct tipc_link *l)
373{
Jon Paul Maloy38206d52015-11-19 14:30:46 -0500374 unsigned long tol = tipc_link_tolerance(l);
Jon Paul Maloy8a1577c2015-07-16 16:54:29 -0400375 unsigned long intv = ((tol / 4) > 500) ? 500 : tol / 4;
Jon Paul Maloy8a1577c2015-07-16 16:54:29 -0400376
377 /* Link with lowest tolerance determines timer interval */
Jon Paul Maloy5ca509f2016-06-08 12:00:05 -0400378 if (intv < n->keepalive_intv)
379 n->keepalive_intv = intv;
Jon Paul Maloy8a1577c2015-07-16 16:54:29 -0400380
Jon Paul Maloy5ca509f2016-06-08 12:00:05 -0400381 /* Ensure link's abort limit corresponds to current tolerance */
382 tipc_link_set_abort_limit(l, tol / n->keepalive_intv);
Jon Paul Maloy8a1577c2015-07-16 16:54:29 -0400383}
384
Ying Xue8a0f6eb2015-03-26 18:10:24 +0800385static void tipc_node_delete(struct tipc_node *node)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100386{
Ying Xue8a0f6eb2015-03-26 18:10:24 +0800387 list_del_rcu(&node->list);
388 hlist_del_rcu(&node->hash);
Jon Paul Maloyd25a01252016-02-24 11:10:48 -0500389 tipc_node_put(node);
390
391 del_timer_sync(&node->timer);
392 tipc_node_put(node);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100393}
394
Ying Xuef2f98002015-01-09 15:27:05 +0800395void tipc_node_stop(struct net *net)
Ying Xue46651c52014-03-27 12:54:36 +0800396{
Jon Paul Maloyd25a01252016-02-24 11:10:48 -0500397 struct tipc_net *tn = tipc_net(net);
Ying Xue46651c52014-03-27 12:54:36 +0800398 struct tipc_node *node, *t_node;
399
Ying Xuef2f98002015-01-09 15:27:05 +0800400 spin_lock_bh(&tn->node_list_lock);
Jon Paul Maloyd25a01252016-02-24 11:10:48 -0500401 list_for_each_entry_safe(node, t_node, &tn->node_list, list)
402 tipc_node_delete(node);
Ying Xuef2f98002015-01-09 15:27:05 +0800403 spin_unlock_bh(&tn->node_list_lock);
Ying Xue46651c52014-03-27 12:54:36 +0800404}
405
Jon Paul Maloy1d7e1c22015-11-19 14:30:42 -0500406void tipc_node_subscribe(struct net *net, struct list_head *subscr, u32 addr)
407{
408 struct tipc_node *n;
409
410 if (in_own_node(net, addr))
411 return;
412
413 n = tipc_node_find(net, addr);
414 if (!n) {
415 pr_warn("Node subscribe rejected, unknown node 0x%x\n", addr);
416 return;
417 }
Jon Paul Maloy5405ff62015-11-19 14:30:44 -0500418 tipc_node_write_lock(n);
Jon Paul Maloy1d7e1c22015-11-19 14:30:42 -0500419 list_add_tail(subscr, &n->publ_list);
Jon Paul Maloy5405ff62015-11-19 14:30:44 -0500420 tipc_node_write_unlock(n);
Jon Paul Maloy1d7e1c22015-11-19 14:30:42 -0500421 tipc_node_put(n);
422}
423
424void tipc_node_unsubscribe(struct net *net, struct list_head *subscr, u32 addr)
425{
426 struct tipc_node *n;
427
428 if (in_own_node(net, addr))
429 return;
430
431 n = tipc_node_find(net, addr);
432 if (!n) {
433 pr_warn("Node unsubscribe rejected, unknown node 0x%x\n", addr);
434 return;
435 }
Jon Paul Maloy5405ff62015-11-19 14:30:44 -0500436 tipc_node_write_lock(n);
Jon Paul Maloy1d7e1c22015-11-19 14:30:42 -0500437 list_del_init(subscr);
Jon Paul Maloy5405ff62015-11-19 14:30:44 -0500438 tipc_node_write_unlock(n);
Jon Paul Maloy1d7e1c22015-11-19 14:30:42 -0500439 tipc_node_put(n);
440}
441
Ying Xuef2f98002015-01-09 15:27:05 +0800442int tipc_node_add_conn(struct net *net, u32 dnode, u32 port, u32 peer_port)
Jon Paul Maloy02be61a2014-08-22 18:09:08 -0400443{
444 struct tipc_node *node;
445 struct tipc_sock_conn *conn;
Ying Xue8a0f6eb2015-03-26 18:10:24 +0800446 int err = 0;
Jon Paul Maloy02be61a2014-08-22 18:09:08 -0400447
Ying Xue34747532015-01-09 15:27:10 +0800448 if (in_own_node(net, dnode))
Jon Paul Maloy02be61a2014-08-22 18:09:08 -0400449 return 0;
450
Ying Xuef2f98002015-01-09 15:27:05 +0800451 node = tipc_node_find(net, dnode);
Jon Paul Maloy02be61a2014-08-22 18:09:08 -0400452 if (!node) {
453 pr_warn("Connecting sock to node 0x%x failed\n", dnode);
454 return -EHOSTUNREACH;
455 }
456 conn = kmalloc(sizeof(*conn), GFP_ATOMIC);
Ying Xue8a0f6eb2015-03-26 18:10:24 +0800457 if (!conn) {
458 err = -EHOSTUNREACH;
459 goto exit;
460 }
Jon Paul Maloy02be61a2014-08-22 18:09:08 -0400461 conn->peer_node = dnode;
462 conn->port = port;
463 conn->peer_port = peer_port;
464
Jon Paul Maloy5405ff62015-11-19 14:30:44 -0500465 tipc_node_write_lock(node);
Jon Paul Maloy02be61a2014-08-22 18:09:08 -0400466 list_add_tail(&conn->list, &node->conn_sks);
Jon Paul Maloy5405ff62015-11-19 14:30:44 -0500467 tipc_node_write_unlock(node);
Ying Xue8a0f6eb2015-03-26 18:10:24 +0800468exit:
469 tipc_node_put(node);
470 return err;
Jon Paul Maloy02be61a2014-08-22 18:09:08 -0400471}
472
Ying Xuef2f98002015-01-09 15:27:05 +0800473void tipc_node_remove_conn(struct net *net, u32 dnode, u32 port)
Jon Paul Maloy02be61a2014-08-22 18:09:08 -0400474{
475 struct tipc_node *node;
476 struct tipc_sock_conn *conn, *safe;
477
Ying Xue34747532015-01-09 15:27:10 +0800478 if (in_own_node(net, dnode))
Jon Paul Maloy02be61a2014-08-22 18:09:08 -0400479 return;
480
Ying Xuef2f98002015-01-09 15:27:05 +0800481 node = tipc_node_find(net, dnode);
Jon Paul Maloy02be61a2014-08-22 18:09:08 -0400482 if (!node)
483 return;
484
Jon Paul Maloy5405ff62015-11-19 14:30:44 -0500485 tipc_node_write_lock(node);
Jon Paul Maloy02be61a2014-08-22 18:09:08 -0400486 list_for_each_entry_safe(conn, safe, &node->conn_sks, list) {
487 if (port != conn->port)
488 continue;
489 list_del(&conn->list);
490 kfree(conn);
491 }
Jon Paul Maloy5405ff62015-11-19 14:30:44 -0500492 tipc_node_write_unlock(node);
Ying Xue8a0f6eb2015-03-26 18:10:24 +0800493 tipc_node_put(node);
Jon Paul Maloy02be61a2014-08-22 18:09:08 -0400494}
495
Jon Paul Maloy8a1577c2015-07-16 16:54:29 -0400496/* tipc_node_timeout - handle expiration of node timer
497 */
498static void tipc_node_timeout(unsigned long data)
499{
500 struct tipc_node *n = (struct tipc_node *)data;
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400501 struct tipc_link_entry *le;
Jon Paul Maloy8a1577c2015-07-16 16:54:29 -0400502 struct sk_buff_head xmitq;
Jon Paul Maloy8a1577c2015-07-16 16:54:29 -0400503 int bearer_id;
504 int rc = 0;
505
506 __skb_queue_head_init(&xmitq);
507
508 for (bearer_id = 0; bearer_id < MAX_BEARERS; bearer_id++) {
Jon Paul Maloy5405ff62015-11-19 14:30:44 -0500509 tipc_node_read_lock(n);
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400510 le = &n->links[bearer_id];
Jon Paul Maloy2312bf62015-11-19 14:30:43 -0500511 spin_lock_bh(&le->lock);
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400512 if (le->link) {
Jon Paul Maloy8a1577c2015-07-16 16:54:29 -0400513 /* Link tolerance may change asynchronously: */
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400514 tipc_node_calculate_timer(n, le->link);
515 rc = tipc_link_timeout(le->link, &xmitq);
Jon Paul Maloy8a1577c2015-07-16 16:54:29 -0400516 }
Jon Paul Maloy2312bf62015-11-19 14:30:43 -0500517 spin_unlock_bh(&le->lock);
Jon Paul Maloy5405ff62015-11-19 14:30:44 -0500518 tipc_node_read_unlock(n);
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400519 tipc_bearer_xmit(n->net, bearer_id, &xmitq, &le->maddr);
520 if (rc & TIPC_LINK_DOWN_EVT)
521 tipc_node_link_down(n, bearer_id, false);
Jon Paul Maloy8a1577c2015-07-16 16:54:29 -0400522 }
Jon Paul Maloy5ca509f2016-06-08 12:00:05 -0400523 mod_timer(&n->timer, jiffies + msecs_to_jiffies(n->keepalive_intv));
Jon Paul Maloy8a1577c2015-07-16 16:54:29 -0400524}
525
Per Lidenb97bf3f2006-01-02 19:04:38 +0100526/**
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400527 * __tipc_node_link_up - handle addition of link
528 * Node lock must be held by caller
Per Lidenb97bf3f2006-01-02 19:04:38 +0100529 * Link becomes active (alone or shared) or standby, depending on its priority.
530 */
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400531static void __tipc_node_link_up(struct tipc_node *n, int bearer_id,
532 struct sk_buff_head *xmitq)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100533{
Jon Paul Maloy36e78a42015-07-16 16:54:22 -0400534 int *slot0 = &n->active_links[0];
535 int *slot1 = &n->active_links[1];
Jon Paul Maloy6e498152015-07-30 18:24:19 -0400536 struct tipc_link *ol = node_active_link(n, 0);
537 struct tipc_link *nl = n->links[bearer_id].link;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100538
Jon Paul Maloye7142c32016-05-11 19:15:45 -0400539 if (!nl || tipc_link_is_up(nl))
Jon Paul Maloy73f646c2015-10-15 14:52:44 -0400540 return;
541
542 tipc_link_fsm_evt(nl, LINK_ESTABLISH_EVT);
543 if (!tipc_link_is_up(nl))
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400544 return;
545
Jon Paul Maloy9d13ec62015-07-16 16:54:19 -0400546 n->working_links++;
547 n->action_flags |= TIPC_NOTIFY_LINK_UP;
Jon Paul Maloy38206d52015-11-19 14:30:46 -0500548 n->link_id = tipc_link_id(nl);
Jon Paul Maloy6e498152015-07-30 18:24:19 -0400549
550 /* Leave room for tunnel header when returning 'mtu' to users: */
Jon Paul Maloy38206d52015-11-19 14:30:46 -0500551 n->links[bearer_id].mtu = tipc_link_mtu(nl) - INT_H_SIZE;
Ying Xue7b8613e2014-10-20 14:44:25 +0800552
Jon Paul Maloycbeb83c2015-07-30 18:24:15 -0400553 tipc_bearer_add_dest(n->net, bearer_id, n->addr);
Jon Paul Maloyb06b2812015-10-22 08:51:42 -0400554 tipc_bcast_inc_bearer_dst_cnt(n->net, bearer_id);
Jon Paul Maloycbeb83c2015-07-30 18:24:15 -0400555
Erik Hugne3fa9cac2015-01-22 17:10:31 +0100556 pr_debug("Established link <%s> on network plane %c\n",
Jon Paul Maloy38206d52015-11-19 14:30:46 -0500557 tipc_link_name(nl), tipc_link_plane(nl));
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900558
Jon Paul Maloy34b9cd62016-04-15 13:33:07 -0400559 /* Ensure that a STATE message goes first */
560 tipc_link_build_state_msg(nl, xmitq);
561
Jon Paul Maloy6e498152015-07-30 18:24:19 -0400562 /* First link? => give it both slots */
563 if (!ol) {
Jon Paul Maloy36e78a42015-07-16 16:54:22 -0400564 *slot0 = bearer_id;
565 *slot1 = bearer_id;
Jon Paul Maloy52666982015-10-22 08:51:41 -0400566 tipc_node_fsm_evt(n, SELF_ESTABL_CONTACT_EVT);
567 n->action_flags |= TIPC_NOTIFY_NODE_UP;
Jon Paul Maloydef22c42016-04-28 20:16:08 -0400568 tipc_link_set_active(nl, true);
Jon Paul Maloyb06b2812015-10-22 08:51:42 -0400569 tipc_bcast_add_peer(n->net, nl, xmitq);
Jon Paul Maloy9d13ec62015-07-16 16:54:19 -0400570 return;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100571 }
Jon Paul Maloy36e78a42015-07-16 16:54:22 -0400572
Jon Paul Maloy6e498152015-07-30 18:24:19 -0400573 /* Second link => redistribute slots */
Jon Paul Maloy38206d52015-11-19 14:30:46 -0500574 if (tipc_link_prio(nl) > tipc_link_prio(ol)) {
575 pr_debug("Old link <%s> becomes standby\n", tipc_link_name(ol));
Jon Paul Maloy36e78a42015-07-16 16:54:22 -0400576 *slot0 = bearer_id;
Jon Paul Maloy6e498152015-07-30 18:24:19 -0400577 *slot1 = bearer_id;
Jon Paul Maloyc72fa872015-10-22 08:51:46 -0400578 tipc_link_set_active(nl, true);
579 tipc_link_set_active(ol, false);
Jon Paul Maloy38206d52015-11-19 14:30:46 -0500580 } else if (tipc_link_prio(nl) == tipc_link_prio(ol)) {
Jon Paul Maloyc72fa872015-10-22 08:51:46 -0400581 tipc_link_set_active(nl, true);
Jon Paul Maloyc49a0a82015-10-22 08:51:47 -0400582 *slot1 = bearer_id;
Jon Paul Maloy6e498152015-07-30 18:24:19 -0400583 } else {
Jon Paul Maloy38206d52015-11-19 14:30:46 -0500584 pr_debug("New link <%s> is standby\n", tipc_link_name(nl));
Per Lidenb97bf3f2006-01-02 19:04:38 +0100585 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100586
Jon Paul Maloy6e498152015-07-30 18:24:19 -0400587 /* Prepare synchronization with first link */
588 tipc_link_tnl_prepare(ol, nl, SYNCH_MSG, xmitq);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100589}
590
591/**
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400592 * tipc_node_link_up - handle addition of link
593 *
594 * Link becomes active (alone or shared) or standby, depending on its priority.
Per Lidenb97bf3f2006-01-02 19:04:38 +0100595 */
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400596static void tipc_node_link_up(struct tipc_node *n, int bearer_id,
597 struct sk_buff_head *xmitq)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100598{
Jon Paul Maloyde7e07f2016-04-15 13:33:06 -0400599 struct tipc_media_addr *maddr;
600
Jon Paul Maloy5405ff62015-11-19 14:30:44 -0500601 tipc_node_write_lock(n);
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400602 __tipc_node_link_up(n, bearer_id, xmitq);
Jon Paul Maloyde7e07f2016-04-15 13:33:06 -0400603 maddr = &n->links[bearer_id].maddr;
604 tipc_bearer_xmit(n->net, bearer_id, xmitq, maddr);
Jon Paul Maloy5405ff62015-11-19 14:30:44 -0500605 tipc_node_write_unlock(n);
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400606}
607
608/**
609 * __tipc_node_link_down - handle loss of link
610 */
611static void __tipc_node_link_down(struct tipc_node *n, int *bearer_id,
612 struct sk_buff_head *xmitq,
613 struct tipc_media_addr **maddr)
614{
615 struct tipc_link_entry *le = &n->links[*bearer_id];
Jon Paul Maloy36e78a42015-07-16 16:54:22 -0400616 int *slot0 = &n->active_links[0];
617 int *slot1 = &n->active_links[1];
Jon Paul Maloy38206d52015-11-19 14:30:46 -0500618 int i, highest = 0, prio;
Jon Paul Maloy6e498152015-07-30 18:24:19 -0400619 struct tipc_link *l, *_l, *tnl;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100620
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400621 l = n->links[*bearer_id].link;
Jon Paul Maloy662921c2015-07-30 18:24:21 -0400622 if (!l || tipc_link_is_reset(l))
Jon Paul Maloy655fb242015-07-30 18:24:17 -0400623 return;
624
Jon Paul Maloy9d13ec62015-07-16 16:54:19 -0400625 n->working_links--;
626 n->action_flags |= TIPC_NOTIFY_LINK_DOWN;
Jon Paul Maloy38206d52015-11-19 14:30:46 -0500627 n->link_id = tipc_link_id(l);
Allan Stephens5392d642006-06-25 23:52:50 -0700628
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400629 tipc_bearer_remove_dest(n->net, *bearer_id, n->addr);
Jon Paul Maloy655fb242015-07-30 18:24:17 -0400630
Erik Hugne3fa9cac2015-01-22 17:10:31 +0100631 pr_debug("Lost link <%s> on network plane %c\n",
Jon Paul Maloy38206d52015-11-19 14:30:46 -0500632 tipc_link_name(l), tipc_link_plane(l));
Per Lidenb97bf3f2006-01-02 19:04:38 +0100633
Jon Paul Maloy36e78a42015-07-16 16:54:22 -0400634 /* Select new active link if any available */
635 *slot0 = INVALID_BEARER_ID;
636 *slot1 = INVALID_BEARER_ID;
637 for (i = 0; i < MAX_BEARERS; i++) {
638 _l = n->links[i].link;
639 if (!_l || !tipc_link_is_up(_l))
640 continue;
Jon Paul Maloy655fb242015-07-30 18:24:17 -0400641 if (_l == l)
642 continue;
Jon Paul Maloy38206d52015-11-19 14:30:46 -0500643 prio = tipc_link_prio(_l);
644 if (prio < highest)
Jon Paul Maloy36e78a42015-07-16 16:54:22 -0400645 continue;
Jon Paul Maloy38206d52015-11-19 14:30:46 -0500646 if (prio > highest) {
647 highest = prio;
Jon Paul Maloy36e78a42015-07-16 16:54:22 -0400648 *slot0 = i;
649 *slot1 = i;
650 continue;
651 }
652 *slot1 = i;
653 }
Jon Paul Maloy655fb242015-07-30 18:24:17 -0400654
Jon Paul Maloy6e498152015-07-30 18:24:19 -0400655 if (!tipc_node_is_up(n)) {
Jon Paul Maloyc8199302015-10-15 14:52:46 -0400656 if (tipc_link_peer_is_down(l))
657 tipc_node_fsm_evt(n, PEER_LOST_CONTACT_EVT);
658 tipc_node_fsm_evt(n, SELF_LOST_CONTACT_EVT);
659 tipc_link_fsm_evt(l, LINK_RESET_EVT);
Jon Paul Maloy6e498152015-07-30 18:24:19 -0400660 tipc_link_reset(l);
Jon Paul Maloy282b3a02015-10-15 14:52:45 -0400661 tipc_link_build_reset_msg(l, xmitq);
662 *maddr = &n->links[*bearer_id].maddr;
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400663 node_lost_contact(n, &le->inputq);
Jon Paul Maloyb06b2812015-10-22 08:51:42 -0400664 tipc_bcast_dec_bearer_dst_cnt(n->net, *bearer_id);
Jon Paul Maloy6e498152015-07-30 18:24:19 -0400665 return;
666 }
Jon Paul Maloyb06b2812015-10-22 08:51:42 -0400667 tipc_bcast_dec_bearer_dst_cnt(n->net, *bearer_id);
Jon Paul Maloy6e498152015-07-30 18:24:19 -0400668
669 /* There is still a working link => initiate failover */
Jon Paul Maloy38206d52015-11-19 14:30:46 -0500670 *bearer_id = n->active_links[0];
671 tnl = n->links[*bearer_id].link;
Jon Paul Maloy5ae2f8e2015-08-20 02:12:55 -0400672 tipc_link_fsm_evt(tnl, LINK_SYNCH_END_EVT);
673 tipc_node_fsm_evt(n, NODE_SYNCH_END_EVT);
Jon Paul Maloy38206d52015-11-19 14:30:46 -0500674 n->sync_point = tipc_link_rcv_nxt(tnl) + (U16_MAX / 2 - 1);
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400675 tipc_link_tnl_prepare(l, tnl, FAILOVER_MSG, xmitq);
Jon Paul Maloy6e498152015-07-30 18:24:19 -0400676 tipc_link_reset(l);
Jon Paul Maloyc8199302015-10-15 14:52:46 -0400677 tipc_link_fsm_evt(l, LINK_RESET_EVT);
Jon Paul Maloy662921c2015-07-30 18:24:21 -0400678 tipc_link_fsm_evt(l, LINK_FAILOVER_BEGIN_EVT);
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400679 tipc_node_fsm_evt(n, NODE_FAILOVER_BEGIN_EVT);
Jon Paul Maloy38206d52015-11-19 14:30:46 -0500680 *maddr = &n->links[*bearer_id].maddr;
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400681}
682
683static void tipc_node_link_down(struct tipc_node *n, int bearer_id, bool delete)
684{
685 struct tipc_link_entry *le = &n->links[bearer_id];
Jon Paul Maloy73f646c2015-10-15 14:52:44 -0400686 struct tipc_link *l = le->link;
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400687 struct tipc_media_addr *maddr;
688 struct sk_buff_head xmitq;
Jon Paul Maloy35c55c92016-06-13 20:46:22 -0400689 int old_bearer_id = bearer_id;
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400690
Jon Paul Maloy73f646c2015-10-15 14:52:44 -0400691 if (!l)
692 return;
693
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400694 __skb_queue_head_init(&xmitq);
695
Jon Paul Maloy5405ff62015-11-19 14:30:44 -0500696 tipc_node_write_lock(n);
Jon Paul Maloy73f646c2015-10-15 14:52:44 -0400697 if (!tipc_link_is_establishing(l)) {
698 __tipc_node_link_down(n, &bearer_id, &xmitq, &maddr);
699 if (delete) {
700 kfree(l);
701 le->link = NULL;
702 n->link_cnt--;
703 }
704 } else {
705 /* Defuse pending tipc_node_link_up() */
706 tipc_link_fsm_evt(l, LINK_RESET_EVT);
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400707 }
Jon Paul Maloy5405ff62015-11-19 14:30:44 -0500708 tipc_node_write_unlock(n);
Jon Paul Maloy35c55c92016-06-13 20:46:22 -0400709 if (delete)
710 tipc_mon_remove_peer(n->net, n->addr, old_bearer_id);
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400711 tipc_bearer_xmit(n->net, bearer_id, &xmitq, maddr);
712 tipc_sk_rcv(n->net, &le->inputq);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100713}
714
Jon Paul Maloy5be9c082015-11-19 14:30:45 -0500715static bool tipc_node_is_up(struct tipc_node *n)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100716{
Jon Paul Maloy36e78a42015-07-16 16:54:22 -0400717 return n->active_links[0] != INVALID_BEARER_ID;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100718}
719
Jon Paul Maloycf148812015-07-30 18:24:22 -0400720void tipc_node_check_dest(struct net *net, u32 onode,
721 struct tipc_bearer *b,
722 u16 capabilities, u32 signature,
723 struct tipc_media_addr *maddr,
724 bool *respond, bool *dupl_addr)
Jon Paul Maloyd3a43b92015-07-16 16:54:20 -0400725{
Jon Paul Maloycf148812015-07-30 18:24:22 -0400726 struct tipc_node *n;
727 struct tipc_link *l;
Jon Paul Maloy440d8962015-07-30 18:24:26 -0400728 struct tipc_link_entry *le;
Jon Paul Maloycf148812015-07-30 18:24:22 -0400729 bool addr_match = false;
730 bool sign_match = false;
731 bool link_up = false;
732 bool accept_addr = false;
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400733 bool reset = true;
Jon Paul Maloy0e054982015-10-22 08:51:36 -0400734 char *if_name;
Jon Paul Maloy5ca509f2016-06-08 12:00:05 -0400735 unsigned long intv;
Jon Paul Maloy440d8962015-07-30 18:24:26 -0400736
Jon Paul Maloycf148812015-07-30 18:24:22 -0400737 *dupl_addr = false;
738 *respond = false;
Jon Paul Maloyd3a43b92015-07-16 16:54:20 -0400739
Jon Paul Maloycf148812015-07-30 18:24:22 -0400740 n = tipc_node_create(net, onode, capabilities);
741 if (!n)
742 return;
Jon Paul Maloyd3a43b92015-07-16 16:54:20 -0400743
Jon Paul Maloy5405ff62015-11-19 14:30:44 -0500744 tipc_node_write_lock(n);
Jon Paul Maloycf148812015-07-30 18:24:22 -0400745
Jon Paul Maloy440d8962015-07-30 18:24:26 -0400746 le = &n->links[b->identity];
Jon Paul Maloycf148812015-07-30 18:24:22 -0400747
748 /* Prepare to validate requesting node's signature and media address */
Jon Paul Maloy440d8962015-07-30 18:24:26 -0400749 l = le->link;
Jon Paul Maloycf148812015-07-30 18:24:22 -0400750 link_up = l && tipc_link_is_up(l);
Jon Paul Maloy440d8962015-07-30 18:24:26 -0400751 addr_match = l && !memcmp(&le->maddr, maddr, sizeof(*maddr));
Jon Paul Maloycf148812015-07-30 18:24:22 -0400752 sign_match = (signature == n->signature);
753
754 /* These three flags give us eight permutations: */
755
756 if (sign_match && addr_match && link_up) {
757 /* All is fine. Do nothing. */
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400758 reset = false;
Jon Paul Maloycf148812015-07-30 18:24:22 -0400759 } else if (sign_match && addr_match && !link_up) {
760 /* Respond. The link will come up in due time */
761 *respond = true;
762 } else if (sign_match && !addr_match && link_up) {
763 /* Peer has changed i/f address without rebooting.
764 * If so, the link will reset soon, and the next
765 * discovery will be accepted. So we can ignore it.
766 * It may also be an cloned or malicious peer having
767 * chosen the same node address and signature as an
768 * existing one.
769 * Ignore requests until the link goes down, if ever.
770 */
771 *dupl_addr = true;
772 } else if (sign_match && !addr_match && !link_up) {
773 /* Peer link has changed i/f address without rebooting.
774 * It may also be a cloned or malicious peer; we can't
775 * distinguish between the two.
776 * The signature is correct, so we must accept.
777 */
778 accept_addr = true;
779 *respond = true;
780 } else if (!sign_match && addr_match && link_up) {
781 /* Peer node rebooted. Two possibilities:
782 * - Delayed re-discovery; this link endpoint has already
783 * reset and re-established contact with the peer, before
784 * receiving a discovery message from that node.
785 * (The peer happened to receive one from this node first).
786 * - The peer came back so fast that our side has not
787 * discovered it yet. Probing from this side will soon
788 * reset the link, since there can be no working link
789 * endpoint at the peer end, and the link will re-establish.
790 * Accept the signature, since it comes from a known peer.
791 */
792 n->signature = signature;
793 } else if (!sign_match && addr_match && !link_up) {
794 /* The peer node has rebooted.
795 * Accept signature, since it is a known peer.
796 */
797 n->signature = signature;
798 *respond = true;
799 } else if (!sign_match && !addr_match && link_up) {
800 /* Peer rebooted with new address, or a new/duplicate peer.
801 * Ignore until the link goes down, if ever.
802 */
803 *dupl_addr = true;
804 } else if (!sign_match && !addr_match && !link_up) {
805 /* Peer rebooted with new address, or it is a new peer.
806 * Accept signature and address.
807 */
808 n->signature = signature;
809 accept_addr = true;
810 *respond = true;
811 }
812
813 if (!accept_addr)
814 goto exit;
815
816 /* Now create new link if not already existing */
Jon Paul Maloy8a1577c2015-07-16 16:54:29 -0400817 if (!l) {
Jon Paul Maloy440d8962015-07-30 18:24:26 -0400818 if (n->link_cnt == 2) {
819 pr_warn("Cannot establish 3rd link to %x\n", n->addr);
820 goto exit;
821 }
Jon Paul Maloy0e054982015-10-22 08:51:36 -0400822 if_name = strchr(b->name, ':') + 1;
Jon Paul Maloyc72fa872015-10-22 08:51:46 -0400823 if (!tipc_link_create(net, if_name, b->identity, b->tolerance,
Jon Paul Maloy0e054982015-10-22 08:51:36 -0400824 b->net_plane, b->mtu, b->priority,
825 b->window, mod(tipc_net(net)->random),
Jon Paul Maloyfd556f22015-10-22 08:51:40 -0400826 tipc_own_addr(net), onode,
Jon Paul Maloy2af5ae32015-10-22 08:51:48 -0400827 n->capabilities,
Jon Paul Maloy52666982015-10-22 08:51:41 -0400828 tipc_bc_sndlink(n->net), n->bc_entry.link,
829 &le->inputq,
830 &n->bc_entry.namedq, &l)) {
Jon Paul Maloycf148812015-07-30 18:24:22 -0400831 *respond = false;
832 goto exit;
833 }
Jon Paul Maloy440d8962015-07-30 18:24:26 -0400834 tipc_link_reset(l);
Jon Paul Maloyc8199302015-10-15 14:52:46 -0400835 tipc_link_fsm_evt(l, LINK_RESET_EVT);
Jon Paul Maloy17b20632015-08-20 02:12:54 -0400836 if (n->state == NODE_FAILINGOVER)
837 tipc_link_fsm_evt(l, LINK_FAILOVER_BEGIN_EVT);
Jon Paul Maloy440d8962015-07-30 18:24:26 -0400838 le->link = l;
839 n->link_cnt++;
Jon Paul Maloy8a1577c2015-07-16 16:54:29 -0400840 tipc_node_calculate_timer(n, l);
Jon Paul Maloy5ca509f2016-06-08 12:00:05 -0400841 if (n->link_cnt == 1) {
842 intv = jiffies + msecs_to_jiffies(n->keepalive_intv);
843 if (!mod_timer(&n->timer, intv))
Jon Paul Maloy8a1577c2015-07-16 16:54:29 -0400844 tipc_node_get(n);
Jon Paul Maloy5ca509f2016-06-08 12:00:05 -0400845 }
Jon Paul Maloy8a1577c2015-07-16 16:54:29 -0400846 }
Jon Paul Maloy440d8962015-07-30 18:24:26 -0400847 memcpy(&le->maddr, maddr, sizeof(*maddr));
Jon Paul Maloycf148812015-07-30 18:24:22 -0400848exit:
Jon Paul Maloy5405ff62015-11-19 14:30:44 -0500849 tipc_node_write_unlock(n);
Richard Alpe2837f392016-03-03 14:20:41 +0100850 if (reset && l && !tipc_link_is_reset(l))
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400851 tipc_node_link_down(n, b->identity, false);
Jon Paul Maloycf148812015-07-30 18:24:22 -0400852 tipc_node_put(n);
Jon Paul Maloyd3a43b92015-07-16 16:54:20 -0400853}
854
Jon Paul Maloy6144a992015-07-30 18:24:16 -0400855void tipc_node_delete_links(struct net *net, int bearer_id)
856{
857 struct tipc_net *tn = net_generic(net, tipc_net_id);
Jon Paul Maloy6144a992015-07-30 18:24:16 -0400858 struct tipc_node *n;
859
860 rcu_read_lock();
861 list_for_each_entry_rcu(n, &tn->node_list, list) {
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400862 tipc_node_link_down(n, bearer_id, true);
Jon Paul Maloy6144a992015-07-30 18:24:16 -0400863 }
864 rcu_read_unlock();
865}
866
867static void tipc_node_reset_links(struct tipc_node *n)
868{
869 char addr_string[16];
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400870 int i;
Jon Paul Maloy6144a992015-07-30 18:24:16 -0400871
872 pr_warn("Resetting all links to %s\n",
873 tipc_addr_string_fill(addr_string, n->addr));
874
875 for (i = 0; i < MAX_BEARERS; i++) {
Jon Paul Maloy598411d2015-07-30 18:24:23 -0400876 tipc_node_link_down(n, i, false);
Jon Paul Maloy6144a992015-07-30 18:24:16 -0400877 }
Jon Paul Maloy6144a992015-07-30 18:24:16 -0400878}
879
Jon Paul Maloy1a20cc22015-07-16 16:54:30 -0400880/* tipc_node_fsm_evt - node finite state machine
881 * Determines when contact is allowed with peer node
882 */
Jon Paul Maloyd9992972015-07-16 16:54:31 -0400883static void tipc_node_fsm_evt(struct tipc_node *n, int evt)
Jon Paul Maloy1a20cc22015-07-16 16:54:30 -0400884{
885 int state = n->state;
886
887 switch (state) {
888 case SELF_DOWN_PEER_DOWN:
889 switch (evt) {
890 case SELF_ESTABL_CONTACT_EVT:
891 state = SELF_UP_PEER_COMING;
892 break;
893 case PEER_ESTABL_CONTACT_EVT:
894 state = SELF_COMING_PEER_UP;
895 break;
896 case SELF_LOST_CONTACT_EVT:
897 case PEER_LOST_CONTACT_EVT:
898 break;
Jon Paul Maloy66996b62015-07-30 18:24:18 -0400899 case NODE_SYNCH_END_EVT:
900 case NODE_SYNCH_BEGIN_EVT:
901 case NODE_FAILOVER_BEGIN_EVT:
902 case NODE_FAILOVER_END_EVT:
Jon Paul Maloy1a20cc22015-07-16 16:54:30 -0400903 default:
Jon Paul Maloy66996b62015-07-30 18:24:18 -0400904 goto illegal_evt;
Jon Paul Maloy1a20cc22015-07-16 16:54:30 -0400905 }
906 break;
907 case SELF_UP_PEER_UP:
908 switch (evt) {
909 case SELF_LOST_CONTACT_EVT:
910 state = SELF_DOWN_PEER_LEAVING;
911 break;
912 case PEER_LOST_CONTACT_EVT:
913 state = SELF_LEAVING_PEER_DOWN;
914 break;
Jon Paul Maloy66996b62015-07-30 18:24:18 -0400915 case NODE_SYNCH_BEGIN_EVT:
916 state = NODE_SYNCHING;
917 break;
918 case NODE_FAILOVER_BEGIN_EVT:
919 state = NODE_FAILINGOVER;
920 break;
Jon Paul Maloy1a20cc22015-07-16 16:54:30 -0400921 case SELF_ESTABL_CONTACT_EVT:
922 case PEER_ESTABL_CONTACT_EVT:
Jon Paul Maloy66996b62015-07-30 18:24:18 -0400923 case NODE_SYNCH_END_EVT:
924 case NODE_FAILOVER_END_EVT:
Jon Paul Maloy1a20cc22015-07-16 16:54:30 -0400925 break;
926 default:
Jon Paul Maloy66996b62015-07-30 18:24:18 -0400927 goto illegal_evt;
Jon Paul Maloy1a20cc22015-07-16 16:54:30 -0400928 }
929 break;
930 case SELF_DOWN_PEER_LEAVING:
931 switch (evt) {
932 case PEER_LOST_CONTACT_EVT:
933 state = SELF_DOWN_PEER_DOWN;
934 break;
935 case SELF_ESTABL_CONTACT_EVT:
936 case PEER_ESTABL_CONTACT_EVT:
937 case SELF_LOST_CONTACT_EVT:
938 break;
Jon Paul Maloy66996b62015-07-30 18:24:18 -0400939 case NODE_SYNCH_END_EVT:
940 case NODE_SYNCH_BEGIN_EVT:
941 case NODE_FAILOVER_BEGIN_EVT:
942 case NODE_FAILOVER_END_EVT:
Jon Paul Maloy1a20cc22015-07-16 16:54:30 -0400943 default:
Jon Paul Maloy66996b62015-07-30 18:24:18 -0400944 goto illegal_evt;
Jon Paul Maloy1a20cc22015-07-16 16:54:30 -0400945 }
946 break;
947 case SELF_UP_PEER_COMING:
948 switch (evt) {
949 case PEER_ESTABL_CONTACT_EVT:
950 state = SELF_UP_PEER_UP;
951 break;
952 case SELF_LOST_CONTACT_EVT:
Jon Paul Maloyc4282ca2016-06-08 12:00:04 -0400953 state = SELF_DOWN_PEER_DOWN;
Jon Paul Maloy1a20cc22015-07-16 16:54:30 -0400954 break;
955 case SELF_ESTABL_CONTACT_EVT:
956 case PEER_LOST_CONTACT_EVT:
Jon Paul Maloy66996b62015-07-30 18:24:18 -0400957 case NODE_SYNCH_END_EVT:
Jon Paul Maloy66996b62015-07-30 18:24:18 -0400958 case NODE_FAILOVER_BEGIN_EVT:
Jon Paul Maloy73f646c2015-10-15 14:52:44 -0400959 break;
960 case NODE_SYNCH_BEGIN_EVT:
Jon Paul Maloy66996b62015-07-30 18:24:18 -0400961 case NODE_FAILOVER_END_EVT:
Jon Paul Maloy1a20cc22015-07-16 16:54:30 -0400962 default:
Jon Paul Maloy66996b62015-07-30 18:24:18 -0400963 goto illegal_evt;
Jon Paul Maloy1a20cc22015-07-16 16:54:30 -0400964 }
965 break;
966 case SELF_COMING_PEER_UP:
967 switch (evt) {
968 case SELF_ESTABL_CONTACT_EVT:
969 state = SELF_UP_PEER_UP;
970 break;
971 case PEER_LOST_CONTACT_EVT:
Jon Paul Maloyc4282ca2016-06-08 12:00:04 -0400972 state = SELF_DOWN_PEER_DOWN;
Jon Paul Maloy1a20cc22015-07-16 16:54:30 -0400973 break;
974 case SELF_LOST_CONTACT_EVT:
975 case PEER_ESTABL_CONTACT_EVT:
976 break;
Jon Paul Maloy66996b62015-07-30 18:24:18 -0400977 case NODE_SYNCH_END_EVT:
978 case NODE_SYNCH_BEGIN_EVT:
979 case NODE_FAILOVER_BEGIN_EVT:
980 case NODE_FAILOVER_END_EVT:
Jon Paul Maloy1a20cc22015-07-16 16:54:30 -0400981 default:
Jon Paul Maloy66996b62015-07-30 18:24:18 -0400982 goto illegal_evt;
Jon Paul Maloy1a20cc22015-07-16 16:54:30 -0400983 }
984 break;
985 case SELF_LEAVING_PEER_DOWN:
986 switch (evt) {
987 case SELF_LOST_CONTACT_EVT:
988 state = SELF_DOWN_PEER_DOWN;
989 break;
990 case SELF_ESTABL_CONTACT_EVT:
991 case PEER_ESTABL_CONTACT_EVT:
992 case PEER_LOST_CONTACT_EVT:
993 break;
Jon Paul Maloy66996b62015-07-30 18:24:18 -0400994 case NODE_SYNCH_END_EVT:
995 case NODE_SYNCH_BEGIN_EVT:
996 case NODE_FAILOVER_BEGIN_EVT:
997 case NODE_FAILOVER_END_EVT:
Jon Paul Maloy1a20cc22015-07-16 16:54:30 -0400998 default:
Jon Paul Maloy66996b62015-07-30 18:24:18 -0400999 goto illegal_evt;
1000 }
1001 break;
1002 case NODE_FAILINGOVER:
1003 switch (evt) {
1004 case SELF_LOST_CONTACT_EVT:
1005 state = SELF_DOWN_PEER_LEAVING;
1006 break;
1007 case PEER_LOST_CONTACT_EVT:
1008 state = SELF_LEAVING_PEER_DOWN;
1009 break;
1010 case NODE_FAILOVER_END_EVT:
1011 state = SELF_UP_PEER_UP;
1012 break;
1013 case NODE_FAILOVER_BEGIN_EVT:
1014 case SELF_ESTABL_CONTACT_EVT:
1015 case PEER_ESTABL_CONTACT_EVT:
1016 break;
1017 case NODE_SYNCH_BEGIN_EVT:
1018 case NODE_SYNCH_END_EVT:
1019 default:
1020 goto illegal_evt;
1021 }
1022 break;
1023 case NODE_SYNCHING:
1024 switch (evt) {
1025 case SELF_LOST_CONTACT_EVT:
1026 state = SELF_DOWN_PEER_LEAVING;
1027 break;
1028 case PEER_LOST_CONTACT_EVT:
1029 state = SELF_LEAVING_PEER_DOWN;
1030 break;
1031 case NODE_SYNCH_END_EVT:
1032 state = SELF_UP_PEER_UP;
1033 break;
1034 case NODE_FAILOVER_BEGIN_EVT:
1035 state = NODE_FAILINGOVER;
1036 break;
1037 case NODE_SYNCH_BEGIN_EVT:
1038 case SELF_ESTABL_CONTACT_EVT:
1039 case PEER_ESTABL_CONTACT_EVT:
1040 break;
1041 case NODE_FAILOVER_END_EVT:
1042 default:
1043 goto illegal_evt;
Jon Paul Maloy1a20cc22015-07-16 16:54:30 -04001044 }
1045 break;
1046 default:
1047 pr_err("Unknown node fsm state %x\n", state);
1048 break;
1049 }
Jon Paul Maloy1a20cc22015-07-16 16:54:30 -04001050 n->state = state;
Jon Paul Maloy66996b62015-07-30 18:24:18 -04001051 return;
1052
1053illegal_evt:
1054 pr_err("Illegal node fsm evt %x in state %x\n", evt, state);
Jon Paul Maloy1a20cc22015-07-16 16:54:30 -04001055}
1056
Jon Paul Maloy52666982015-10-22 08:51:41 -04001057static void node_lost_contact(struct tipc_node *n,
Jon Paul Maloy598411d2015-07-30 18:24:23 -04001058 struct sk_buff_head *inputq)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001059{
Per Lidenb97bf3f2006-01-02 19:04:38 +01001060 char addr_string[16];
Jon Paul Maloy708ac322015-02-05 08:36:42 -05001061 struct tipc_sock_conn *conn, *safe;
Jon Paul Maloy598411d2015-07-30 18:24:23 -04001062 struct tipc_link *l;
Jon Paul Maloy52666982015-10-22 08:51:41 -04001063 struct list_head *conns = &n->conn_sks;
Jon Paul Maloy708ac322015-02-05 08:36:42 -05001064 struct sk_buff *skb;
Jon Paul Maloy708ac322015-02-05 08:36:42 -05001065 uint i;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001066
Erik Hugne3fa9cac2015-01-22 17:10:31 +01001067 pr_debug("Lost contact with %s\n",
Jon Paul Maloy52666982015-10-22 08:51:41 -04001068 tipc_addr_string_fill(addr_string, n->addr));
Allan Stephensc5bd4d82011-04-07 11:58:08 -04001069
Jon Paul Maloy52666982015-10-22 08:51:41 -04001070 /* Clean up broadcast state */
Jon Paul Maloyb06b2812015-10-22 08:51:42 -04001071 tipc_bcast_remove_peer(n->net, n->bc_entry.link);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001072
Jon Paul Maloydff29b12015-04-02 09:33:01 -04001073 /* Abort any ongoing link failover */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001074 for (i = 0; i < MAX_BEARERS; i++) {
Jon Paul Maloy52666982015-10-22 08:51:41 -04001075 l = n->links[i].link;
Jon Paul Maloy598411d2015-07-30 18:24:23 -04001076 if (l)
1077 tipc_link_fsm_evt(l, LINK_FAILOVER_END_EVT);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001078 }
Jon Paul Maloy598411d2015-07-30 18:24:23 -04001079
Jon Paul Maloy708ac322015-02-05 08:36:42 -05001080 /* Notify publications from this node */
Jon Paul Maloy52666982015-10-22 08:51:41 -04001081 n->action_flags |= TIPC_NOTIFY_NODE_DOWN;
Jon Paul Maloy708ac322015-02-05 08:36:42 -05001082
1083 /* Notify sockets connected to node */
1084 list_for_each_entry_safe(conn, safe, conns, list) {
1085 skb = tipc_msg_create(TIPC_CRITICAL_IMPORTANCE, TIPC_CONN_MSG,
Jon Paul Maloy52666982015-10-22 08:51:41 -04001086 SHORT_H_SIZE, 0, tipc_own_addr(n->net),
Jon Paul Maloy708ac322015-02-05 08:36:42 -05001087 conn->peer_node, conn->port,
1088 conn->peer_port, TIPC_ERR_NO_NODE);
Jon Paul Maloy23d83352015-07-30 18:24:24 -04001089 if (likely(skb))
Jon Paul Maloy598411d2015-07-30 18:24:23 -04001090 skb_queue_tail(inputq, skb);
Jon Paul Maloy708ac322015-02-05 08:36:42 -05001091 list_del(&conn->list);
1092 kfree(conn);
1093 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001094}
1095
Erik Hugne78acb1f2014-04-24 16:26:47 +02001096/**
1097 * tipc_node_get_linkname - get the name of a link
1098 *
1099 * @bearer_id: id of the bearer
1100 * @node: peer node address
1101 * @linkname: link name output buffer
1102 *
1103 * Returns 0 on success
1104 */
Ying Xuef2f98002015-01-09 15:27:05 +08001105int tipc_node_get_linkname(struct net *net, u32 bearer_id, u32 addr,
1106 char *linkname, size_t len)
Erik Hugne78acb1f2014-04-24 16:26:47 +02001107{
1108 struct tipc_link *link;
Ying Xue8a0f6eb2015-03-26 18:10:24 +08001109 int err = -EINVAL;
Ying Xuef2f98002015-01-09 15:27:05 +08001110 struct tipc_node *node = tipc_node_find(net, addr);
Erik Hugne78acb1f2014-04-24 16:26:47 +02001111
Ying Xue8a0f6eb2015-03-26 18:10:24 +08001112 if (!node)
1113 return err;
1114
1115 if (bearer_id >= MAX_BEARERS)
1116 goto exit;
1117
Jon Paul Maloy5405ff62015-11-19 14:30:44 -05001118 tipc_node_read_lock(node);
Jon Paul Maloy9d13ec62015-07-16 16:54:19 -04001119 link = node->links[bearer_id].link;
Erik Hugne78acb1f2014-04-24 16:26:47 +02001120 if (link) {
Jon Paul Maloy38206d52015-11-19 14:30:46 -05001121 strncpy(linkname, tipc_link_name(link), len);
Ying Xue8a0f6eb2015-03-26 18:10:24 +08001122 err = 0;
Erik Hugne78acb1f2014-04-24 16:26:47 +02001123 }
Ying Xue8a0f6eb2015-03-26 18:10:24 +08001124exit:
Jon Paul Maloy5405ff62015-11-19 14:30:44 -05001125 tipc_node_read_unlock(node);
Ying Xue8a0f6eb2015-03-26 18:10:24 +08001126 tipc_node_put(node);
1127 return err;
Erik Hugne78acb1f2014-04-24 16:26:47 +02001128}
Ying Xue9db9fdd2014-05-05 08:56:12 +08001129
Richard Alpe3e4b6ab2014-11-20 10:29:17 +01001130/* Caller should hold node lock for the passed node */
Richard Alped8182802014-11-24 11:10:29 +01001131static int __tipc_nl_add_node(struct tipc_nl_msg *msg, struct tipc_node *node)
Richard Alpe3e4b6ab2014-11-20 10:29:17 +01001132{
1133 void *hdr;
1134 struct nlattr *attrs;
1135
Richard Alpebfb3e5d2015-02-09 09:50:03 +01001136 hdr = genlmsg_put(msg->skb, msg->portid, msg->seq, &tipc_genl_family,
Richard Alpe3e4b6ab2014-11-20 10:29:17 +01001137 NLM_F_MULTI, TIPC_NL_NODE_GET);
1138 if (!hdr)
1139 return -EMSGSIZE;
1140
1141 attrs = nla_nest_start(msg->skb, TIPC_NLA_NODE);
1142 if (!attrs)
1143 goto msg_full;
1144
1145 if (nla_put_u32(msg->skb, TIPC_NLA_NODE_ADDR, node->addr))
1146 goto attr_msg_full;
1147 if (tipc_node_is_up(node))
1148 if (nla_put_flag(msg->skb, TIPC_NLA_NODE_UP))
1149 goto attr_msg_full;
1150
1151 nla_nest_end(msg->skb, attrs);
1152 genlmsg_end(msg->skb, hdr);
1153
1154 return 0;
1155
1156attr_msg_full:
1157 nla_nest_cancel(msg->skb, attrs);
1158msg_full:
1159 genlmsg_cancel(msg->skb, hdr);
1160
1161 return -EMSGSIZE;
1162}
1163
Jon Paul Maloyaf9b0282015-07-16 16:54:24 -04001164/**
1165 * tipc_node_xmit() is the general link level function for message sending
1166 * @net: the applicable net namespace
1167 * @list: chain of buffers containing message
1168 * @dnode: address of destination node
1169 * @selector: a number used for deterministic link selection
1170 * Consumes the buffer chain, except when returning -ELINKCONG
Richard Alpe4952cd32016-02-11 10:43:15 +01001171 * Returns 0 if success, otherwise: -ELINKCONG,-EHOSTUNREACH,-EMSGSIZE,-ENOBUF
Jon Paul Maloyaf9b0282015-07-16 16:54:24 -04001172 */
1173int tipc_node_xmit(struct net *net, struct sk_buff_head *list,
1174 u32 dnode, int selector)
1175{
Jon Paul Maloy5405ff62015-11-19 14:30:44 -05001176 struct tipc_link_entry *le = NULL;
Jon Paul Maloyaf9b0282015-07-16 16:54:24 -04001177 struct tipc_node *n;
1178 struct sk_buff_head xmitq;
Richard Alpe4952cd32016-02-11 10:43:15 +01001179 int bearer_id;
1180 int rc;
Jon Paul Maloyaf9b0282015-07-16 16:54:24 -04001181
Richard Alpe4952cd32016-02-11 10:43:15 +01001182 if (in_own_node(net, dnode)) {
Jon Paul Maloydc8d1eb2015-12-02 15:19:37 -05001183 tipc_sk_rcv(net, list);
1184 return 0;
1185 }
Richard Alpe4952cd32016-02-11 10:43:15 +01001186
1187 n = tipc_node_find(net, dnode);
1188 if (unlikely(!n)) {
1189 skb_queue_purge(list);
1190 return -EHOSTUNREACH;
1191 }
1192
1193 tipc_node_read_lock(n);
1194 bearer_id = n->active_links[selector & 1];
1195 if (unlikely(bearer_id == INVALID_BEARER_ID)) {
1196 tipc_node_read_unlock(n);
1197 tipc_node_put(n);
1198 skb_queue_purge(list);
1199 return -EHOSTUNREACH;
1200 }
1201
1202 __skb_queue_head_init(&xmitq);
1203 le = &n->links[bearer_id];
1204 spin_lock_bh(&le->lock);
1205 rc = tipc_link_xmit(le->link, list, &xmitq);
1206 spin_unlock_bh(&le->lock);
1207 tipc_node_read_unlock(n);
1208
1209 if (likely(rc == 0))
1210 tipc_bearer_xmit(net, bearer_id, &xmitq, &le->maddr);
1211 else if (rc == -ENOBUFS)
1212 tipc_node_link_down(n, bearer_id, false);
1213
1214 tipc_node_put(n);
1215
Jon Paul Maloydc8d1eb2015-12-02 15:19:37 -05001216 return rc;
Jon Paul Maloyaf9b0282015-07-16 16:54:24 -04001217}
1218
1219/* tipc_node_xmit_skb(): send single buffer to destination
1220 * Buffers sent via this functon are generally TIPC_SYSTEM_IMPORTANCE
1221 * messages, which will not be rejected
1222 * The only exception is datagram messages rerouted after secondary
1223 * lookup, which are rare and safe to dispose of anyway.
1224 * TODO: Return real return value, and let callers use
1225 * tipc_wait_for_sendpkt() where applicable
1226 */
1227int tipc_node_xmit_skb(struct net *net, struct sk_buff *skb, u32 dnode,
1228 u32 selector)
1229{
1230 struct sk_buff_head head;
1231 int rc;
1232
1233 skb_queue_head_init(&head);
1234 __skb_queue_tail(&head, skb);
1235 rc = tipc_node_xmit(net, &head, dnode, selector);
1236 if (rc == -ELINKCONG)
1237 kfree_skb(skb);
1238 return 0;
1239}
1240
Jon Paul Maloy1d7e1c22015-11-19 14:30:42 -05001241void tipc_node_broadcast(struct net *net, struct sk_buff *skb)
1242{
1243 struct sk_buff *txskb;
1244 struct tipc_node *n;
1245 u32 dst;
1246
1247 rcu_read_lock();
1248 list_for_each_entry_rcu(n, tipc_nodes(net), list) {
1249 dst = n->addr;
1250 if (in_own_node(net, dst))
1251 continue;
1252 if (!tipc_node_is_up(n))
1253 continue;
1254 txskb = pskb_copy(skb, GFP_ATOMIC);
1255 if (!txskb)
1256 break;
1257 msg_set_destnode(buf_msg(txskb), dst);
1258 tipc_node_xmit_skb(net, txskb, dst, 0);
1259 }
1260 rcu_read_unlock();
1261
1262 kfree_skb(skb);
1263}
1264
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001265/**
Jon Paul Maloy52666982015-10-22 08:51:41 -04001266 * tipc_node_bc_rcv - process TIPC broadcast packet arriving from off-node
1267 * @net: the applicable net namespace
1268 * @skb: TIPC packet
1269 * @bearer_id: id of bearer message arrived on
1270 *
1271 * Invoked with no locks held.
1272 */
Wu Fengguang742e0382015-10-24 22:56:01 +08001273static void tipc_node_bc_rcv(struct net *net, struct sk_buff *skb, int bearer_id)
Jon Paul Maloy52666982015-10-22 08:51:41 -04001274{
1275 int rc;
1276 struct sk_buff_head xmitq;
1277 struct tipc_bclink_entry *be;
1278 struct tipc_link_entry *le;
1279 struct tipc_msg *hdr = buf_msg(skb);
1280 int usr = msg_user(hdr);
1281 u32 dnode = msg_destnode(hdr);
1282 struct tipc_node *n;
1283
1284 __skb_queue_head_init(&xmitq);
1285
1286 /* If NACK for other node, let rcv link for that node peek into it */
1287 if ((usr == BCAST_PROTOCOL) && (dnode != tipc_own_addr(net)))
1288 n = tipc_node_find(net, dnode);
1289 else
1290 n = tipc_node_find(net, msg_prevnode(hdr));
1291 if (!n) {
1292 kfree_skb(skb);
1293 return;
1294 }
1295 be = &n->bc_entry;
1296 le = &n->links[bearer_id];
1297
1298 rc = tipc_bcast_rcv(net, be->link, skb);
1299
Jon Paul Maloy52666982015-10-22 08:51:41 -04001300 /* Broadcast ACKs are sent on a unicast link */
1301 if (rc & TIPC_LINK_SND_BC_ACK) {
Jon Paul Maloy5405ff62015-11-19 14:30:44 -05001302 tipc_node_read_lock(n);
Jon Paul Maloy34b9cd62016-04-15 13:33:07 -04001303 tipc_link_build_state_msg(le->link, &xmitq);
Jon Paul Maloy5405ff62015-11-19 14:30:44 -05001304 tipc_node_read_unlock(n);
Jon Paul Maloy52666982015-10-22 08:51:41 -04001305 }
1306
1307 if (!skb_queue_empty(&xmitq))
1308 tipc_bearer_xmit(net, bearer_id, &xmitq, &le->maddr);
1309
1310 /* Deliver. 'arrvq' is under inputq2's lock protection */
1311 if (!skb_queue_empty(&be->inputq1)) {
1312 spin_lock_bh(&be->inputq2.lock);
1313 spin_lock_bh(&be->inputq1.lock);
1314 skb_queue_splice_tail_init(&be->inputq1, &be->arrvq);
1315 spin_unlock_bh(&be->inputq1.lock);
1316 spin_unlock_bh(&be->inputq2.lock);
1317 tipc_sk_mcast_rcv(net, &be->arrvq, &be->inputq2);
1318 }
Jon Paul Maloy1fc07f32016-07-11 16:08:37 -04001319
1320 if (rc & TIPC_LINK_DOWN_EVT) {
1321 /* Reception reassembly failure => reset all links to peer */
1322 if (!tipc_link_is_up(be->link))
1323 tipc_node_reset_links(n);
1324
1325 /* Retransmission failure => reset all links to all peers */
1326 if (!tipc_link_is_up(tipc_bc_sndlink(net)))
1327 tipc_bearer_reset_all(net);
1328 }
1329
Jon Paul Maloy52666982015-10-22 08:51:41 -04001330 tipc_node_put(n);
1331}
1332
1333/**
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001334 * tipc_node_check_state - check and if necessary update node state
1335 * @skb: TIPC packet
1336 * @bearer_id: identity of bearer delivering the packet
1337 * Returns true if state is ok, otherwise consumes buffer and returns false
Jon Paul Maloy6144a992015-07-30 18:24:16 -04001338 */
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001339static bool tipc_node_check_state(struct tipc_node *n, struct sk_buff *skb,
Jon Paul Maloy662921c2015-07-30 18:24:21 -04001340 int bearer_id, struct sk_buff_head *xmitq)
Jon Paul Maloy6144a992015-07-30 18:24:16 -04001341{
Jon Paul Maloy6144a992015-07-30 18:24:16 -04001342 struct tipc_msg *hdr = buf_msg(skb);
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001343 int usr = msg_user(hdr);
1344 int mtyp = msg_type(hdr);
Jon Paul Maloy6144a992015-07-30 18:24:16 -04001345 u16 oseqno = msg_seqno(hdr);
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001346 u16 iseqno = msg_seqno(msg_get_wrapped(hdr));
1347 u16 exp_pkts = msg_msgcnt(hdr);
Jon Paul Maloy38206d52015-11-19 14:30:46 -05001348 u16 rcv_nxt, syncpt, dlv_nxt, inputq_len;
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001349 int state = n->state;
Jon Paul Maloy2be80c22015-08-20 02:12:56 -04001350 struct tipc_link *l, *tnl, *pl = NULL;
Jon Paul Maloy598411d2015-07-30 18:24:23 -04001351 struct tipc_media_addr *maddr;
Jon Paul Maloy38206d52015-11-19 14:30:46 -05001352 int pb_id;
Jon Paul Maloy6144a992015-07-30 18:24:16 -04001353
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001354 l = n->links[bearer_id].link;
1355 if (!l)
1356 return false;
Jon Paul Maloy38206d52015-11-19 14:30:46 -05001357 rcv_nxt = tipc_link_rcv_nxt(l);
Jon Paul Maloy6144a992015-07-30 18:24:16 -04001358
Jon Paul Maloy6144a992015-07-30 18:24:16 -04001359
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001360 if (likely((state == SELF_UP_PEER_UP) && (usr != TUNNEL_PROTOCOL)))
1361 return true;
Jon Paul Maloy6144a992015-07-30 18:24:16 -04001362
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001363 /* Find parallel link, if any */
Jon Paul Maloy38206d52015-11-19 14:30:46 -05001364 for (pb_id = 0; pb_id < MAX_BEARERS; pb_id++) {
1365 if ((pb_id != bearer_id) && n->links[pb_id].link) {
1366 pl = n->links[pb_id].link;
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001367 break;
Jon Paul Maloy6144a992015-07-30 18:24:16 -04001368 }
1369 }
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001370
Jon Paul Maloy5405ff62015-11-19 14:30:44 -05001371 /* Check and update node accesibility if applicable */
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001372 if (state == SELF_UP_PEER_COMING) {
1373 if (!tipc_link_is_up(l))
1374 return true;
1375 if (!msg_peer_link_is_up(hdr))
1376 return true;
1377 tipc_node_fsm_evt(n, PEER_ESTABL_CONTACT_EVT);
1378 }
1379
1380 if (state == SELF_DOWN_PEER_LEAVING) {
1381 if (msg_peer_node_is_up(hdr))
1382 return false;
1383 tipc_node_fsm_evt(n, PEER_LOST_CONTACT_EVT);
Jon Paul Maloy5c10e972015-11-19 14:30:41 -05001384 return true;
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001385 }
1386
Jon Paul Maloy5405ff62015-11-19 14:30:44 -05001387 if (state == SELF_LEAVING_PEER_DOWN)
1388 return false;
1389
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001390 /* Ignore duplicate packets */
Jon Paul Maloy0f8b8e22015-10-13 12:41:51 -04001391 if ((usr != LINK_PROTOCOL) && less(oseqno, rcv_nxt))
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001392 return true;
1393
1394 /* Initiate or update failover mode if applicable */
1395 if ((usr == TUNNEL_PROTOCOL) && (mtyp == FAILOVER_MSG)) {
1396 syncpt = oseqno + exp_pkts - 1;
Jon Paul Maloy598411d2015-07-30 18:24:23 -04001397 if (pl && tipc_link_is_up(pl)) {
Jon Paul Maloy598411d2015-07-30 18:24:23 -04001398 __tipc_node_link_down(n, &pb_id, xmitq, &maddr);
Jon Paul Maloy38206d52015-11-19 14:30:46 -05001399 tipc_skb_queue_splice_tail_init(tipc_link_inputq(pl),
1400 tipc_link_inputq(l));
Jon Paul Maloy598411d2015-07-30 18:24:23 -04001401 }
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001402 /* If pkts arrive out of order, use lowest calculated syncpt */
1403 if (less(syncpt, n->sync_point))
1404 n->sync_point = syncpt;
1405 }
1406
1407 /* Open parallel link when tunnel link reaches synch point */
Jon Paul Maloy17b20632015-08-20 02:12:54 -04001408 if ((n->state == NODE_FAILINGOVER) && tipc_link_is_up(l)) {
Jon Paul Maloy662921c2015-07-30 18:24:21 -04001409 if (!more(rcv_nxt, n->sync_point))
1410 return true;
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001411 tipc_node_fsm_evt(n, NODE_FAILOVER_END_EVT);
1412 if (pl)
Jon Paul Maloy662921c2015-07-30 18:24:21 -04001413 tipc_link_fsm_evt(pl, LINK_FAILOVER_END_EVT);
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001414 return true;
1415 }
1416
Jon Paul Maloy5ae2f8e2015-08-20 02:12:55 -04001417 /* No synching needed if only one link */
1418 if (!pl || !tipc_link_is_up(pl))
1419 return true;
1420
Jon Paul Maloy0f8b8e22015-10-13 12:41:51 -04001421 /* Initiate synch mode if applicable */
1422 if ((usr == TUNNEL_PROTOCOL) && (mtyp == SYNCH_MSG) && (oseqno == 1)) {
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001423 syncpt = iseqno + exp_pkts - 1;
Jon Paul Maloy662921c2015-07-30 18:24:21 -04001424 if (!tipc_link_is_up(l)) {
1425 tipc_link_fsm_evt(l, LINK_ESTABLISH_EVT);
Jon Paul Maloy598411d2015-07-30 18:24:23 -04001426 __tipc_node_link_up(n, bearer_id, xmitq);
Jon Paul Maloy662921c2015-07-30 18:24:21 -04001427 }
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001428 if (n->state == SELF_UP_PEER_UP) {
1429 n->sync_point = syncpt;
Jon Paul Maloy662921c2015-07-30 18:24:21 -04001430 tipc_link_fsm_evt(l, LINK_SYNCH_BEGIN_EVT);
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001431 tipc_node_fsm_evt(n, NODE_SYNCH_BEGIN_EVT);
1432 }
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001433 }
1434
1435 /* Open tunnel link when parallel link reaches synch point */
Jon Paul Maloy5c10e972015-11-19 14:30:41 -05001436 if (n->state == NODE_SYNCHING) {
Jon Paul Maloy2be80c22015-08-20 02:12:56 -04001437 if (tipc_link_is_synching(l)) {
1438 tnl = l;
1439 } else {
1440 tnl = pl;
1441 pl = l;
1442 }
Jon Paul Maloy38206d52015-11-19 14:30:46 -05001443 inputq_len = skb_queue_len(tipc_link_inputq(pl));
1444 dlv_nxt = tipc_link_rcv_nxt(pl) - inputq_len;
Jon Paul Maloy5ae2f8e2015-08-20 02:12:55 -04001445 if (more(dlv_nxt, n->sync_point)) {
Jon Paul Maloy2be80c22015-08-20 02:12:56 -04001446 tipc_link_fsm_evt(tnl, LINK_SYNCH_END_EVT);
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001447 tipc_node_fsm_evt(n, NODE_SYNCH_END_EVT);
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001448 return true;
1449 }
Jon Paul Maloy2be80c22015-08-20 02:12:56 -04001450 if (l == pl)
1451 return true;
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001452 if ((usr == TUNNEL_PROTOCOL) && (mtyp == SYNCH_MSG))
1453 return true;
1454 if (usr == LINK_PROTOCOL)
1455 return true;
1456 return false;
1457 }
1458 return true;
Jon Paul Maloy6144a992015-07-30 18:24:16 -04001459}
1460
Jon Paul Maloyd9992972015-07-16 16:54:31 -04001461/**
1462 * tipc_rcv - process TIPC packets/messages arriving from off-node
1463 * @net: the applicable net namespace
1464 * @skb: TIPC packet
1465 * @bearer: pointer to bearer message arrived on
1466 *
1467 * Invoked with no locks held. Bearer pointer must point to a valid bearer
1468 * structure (i.e. cannot be NULL), but bearer can be inactive.
1469 */
1470void tipc_rcv(struct net *net, struct sk_buff *skb, struct tipc_bearer *b)
1471{
1472 struct sk_buff_head xmitq;
1473 struct tipc_node *n;
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001474 struct tipc_msg *hdr = buf_msg(skb);
1475 int usr = msg_user(hdr);
Jon Paul Maloyd9992972015-07-16 16:54:31 -04001476 int bearer_id = b->identity;
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001477 struct tipc_link_entry *le;
Jon Paul Maloy52666982015-10-22 08:51:41 -04001478 u16 bc_ack = msg_bcast_ack(hdr);
Hamish Martinefe79052016-04-29 10:40:24 -04001479 u32 self = tipc_own_addr(net);
Jon Paul Maloyd9992972015-07-16 16:54:31 -04001480 int rc = 0;
1481
1482 __skb_queue_head_init(&xmitq);
1483
1484 /* Ensure message is well-formed */
1485 if (unlikely(!tipc_msg_validate(skb)))
1486 goto discard;
1487
Jon Paul Maloy52666982015-10-22 08:51:41 -04001488 /* Handle arrival of discovery or broadcast packet */
Jon Paul Maloyd9992972015-07-16 16:54:31 -04001489 if (unlikely(msg_non_seq(hdr))) {
Jon Paul Maloy52666982015-10-22 08:51:41 -04001490 if (unlikely(usr == LINK_CONFIG))
1491 return tipc_disc_rcv(net, skb, b);
Jon Paul Maloyd9992972015-07-16 16:54:31 -04001492 else
Jon Paul Maloy52666982015-10-22 08:51:41 -04001493 return tipc_node_bc_rcv(net, skb, bearer_id);
Jon Paul Maloyd9992972015-07-16 16:54:31 -04001494 }
1495
Hamish Martinefe79052016-04-29 10:40:24 -04001496 /* Discard unicast link messages destined for another node */
1497 if (unlikely(!msg_short(hdr) && (msg_destnode(hdr) != self)))
1498 goto discard;
1499
Jon Paul Maloyd9992972015-07-16 16:54:31 -04001500 /* Locate neighboring node that sent packet */
1501 n = tipc_node_find(net, msg_prevnode(hdr));
1502 if (unlikely(!n))
1503 goto discard;
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001504 le = &n->links[bearer_id];
1505
Jon Paul Maloy52666982015-10-22 08:51:41 -04001506 /* Ensure broadcast reception is in synch with peer's send state */
1507 if (unlikely(usr == LINK_PROTOCOL))
1508 tipc_bcast_sync_rcv(net, n->bc_entry.link, hdr);
Jon Paul Maloy38206d52015-11-19 14:30:46 -05001509 else if (unlikely(tipc_link_acked(n->bc_entry.link) != bc_ack))
Jon Paul Maloy52666982015-10-22 08:51:41 -04001510 tipc_bcast_ack_rcv(net, n->bc_entry.link, bc_ack);
1511
Jon Paul Maloy5405ff62015-11-19 14:30:44 -05001512 /* Receive packet directly if conditions permit */
1513 tipc_node_read_lock(n);
1514 if (likely((n->state == SELF_UP_PEER_UP) && (usr != TUNNEL_PROTOCOL))) {
Jon Paul Maloy2312bf62015-11-19 14:30:43 -05001515 spin_lock_bh(&le->lock);
Jon Paul Maloy5405ff62015-11-19 14:30:44 -05001516 if (le->link) {
1517 rc = tipc_link_rcv(le->link, skb, &xmitq);
1518 skb = NULL;
1519 }
Jon Paul Maloy2312bf62015-11-19 14:30:43 -05001520 spin_unlock_bh(&le->lock);
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001521 }
Jon Paul Maloy5405ff62015-11-19 14:30:44 -05001522 tipc_node_read_unlock(n);
1523
1524 /* Check/update node state before receiving */
1525 if (unlikely(skb)) {
1526 tipc_node_write_lock(n);
1527 if (tipc_node_check_state(n, skb, bearer_id, &xmitq)) {
1528 if (le->link) {
1529 rc = tipc_link_rcv(le->link, skb, &xmitq);
1530 skb = NULL;
1531 }
1532 }
1533 tipc_node_write_unlock(n);
1534 }
Jon Paul Maloyd9992972015-07-16 16:54:31 -04001535
1536 if (unlikely(rc & TIPC_LINK_UP_EVT))
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001537 tipc_node_link_up(n, bearer_id, &xmitq);
1538
Jon Paul Maloyd9992972015-07-16 16:54:31 -04001539 if (unlikely(rc & TIPC_LINK_DOWN_EVT))
Jon Paul Maloy598411d2015-07-30 18:24:23 -04001540 tipc_node_link_down(n, bearer_id, false);
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001541
Jon Paul Maloy52666982015-10-22 08:51:41 -04001542 if (unlikely(!skb_queue_empty(&n->bc_entry.namedq)))
1543 tipc_named_rcv(net, &n->bc_entry.namedq);
Jon Paul Maloy23d83352015-07-30 18:24:24 -04001544
Jon Paul Maloy6e498152015-07-30 18:24:19 -04001545 if (!skb_queue_empty(&le->inputq))
1546 tipc_sk_rcv(net, &le->inputq);
1547
1548 if (!skb_queue_empty(&xmitq))
1549 tipc_bearer_xmit(net, bearer_id, &xmitq, &le->maddr);
1550
Jon Paul Maloyd9992972015-07-16 16:54:31 -04001551 tipc_node_put(n);
1552discard:
1553 kfree_skb(skb);
1554}
1555
Richard Alpe3e4b6ab2014-11-20 10:29:17 +01001556int tipc_nl_node_dump(struct sk_buff *skb, struct netlink_callback *cb)
1557{
1558 int err;
Ying Xuef2f98002015-01-09 15:27:05 +08001559 struct net *net = sock_net(skb->sk);
1560 struct tipc_net *tn = net_generic(net, tipc_net_id);
Richard Alpe3e4b6ab2014-11-20 10:29:17 +01001561 int done = cb->args[0];
1562 int last_addr = cb->args[1];
1563 struct tipc_node *node;
1564 struct tipc_nl_msg msg;
1565
1566 if (done)
1567 return 0;
1568
1569 msg.skb = skb;
1570 msg.portid = NETLINK_CB(cb->skb).portid;
1571 msg.seq = cb->nlh->nlmsg_seq;
1572
1573 rcu_read_lock();
Ying Xue8a0f6eb2015-03-26 18:10:24 +08001574 if (last_addr) {
1575 node = tipc_node_find(net, last_addr);
1576 if (!node) {
1577 rcu_read_unlock();
1578 /* We never set seq or call nl_dump_check_consistent()
1579 * this means that setting prev_seq here will cause the
1580 * consistence check to fail in the netlink callback
1581 * handler. Resulting in the NLMSG_DONE message having
1582 * the NLM_F_DUMP_INTR flag set if the node state
1583 * changed while we released the lock.
1584 */
1585 cb->prev_seq = 1;
1586 return -EPIPE;
1587 }
1588 tipc_node_put(node);
Richard Alpe3e4b6ab2014-11-20 10:29:17 +01001589 }
1590
Ying Xuef2f98002015-01-09 15:27:05 +08001591 list_for_each_entry_rcu(node, &tn->node_list, list) {
Richard Alpe3e4b6ab2014-11-20 10:29:17 +01001592 if (last_addr) {
1593 if (node->addr == last_addr)
1594 last_addr = 0;
1595 else
1596 continue;
1597 }
1598
Jon Paul Maloy5405ff62015-11-19 14:30:44 -05001599 tipc_node_read_lock(node);
Richard Alpe3e4b6ab2014-11-20 10:29:17 +01001600 err = __tipc_nl_add_node(&msg, node);
1601 if (err) {
1602 last_addr = node->addr;
Jon Paul Maloy5405ff62015-11-19 14:30:44 -05001603 tipc_node_read_unlock(node);
Richard Alpe3e4b6ab2014-11-20 10:29:17 +01001604 goto out;
1605 }
1606
Jon Paul Maloy5405ff62015-11-19 14:30:44 -05001607 tipc_node_read_unlock(node);
Richard Alpe3e4b6ab2014-11-20 10:29:17 +01001608 }
1609 done = 1;
1610out:
1611 cb->args[0] = done;
1612 cb->args[1] = last_addr;
1613 rcu_read_unlock();
1614
1615 return skb->len;
1616}
Jon Paul Maloy5be9c082015-11-19 14:30:45 -05001617
Jon Paul Maloy38206d52015-11-19 14:30:46 -05001618/* tipc_node_find_by_name - locate owner node of link by link's name
Jon Paul Maloy5be9c082015-11-19 14:30:45 -05001619 * @net: the applicable net namespace
1620 * @name: pointer to link name string
1621 * @bearer_id: pointer to index in 'node->links' array where the link was found.
1622 *
1623 * Returns pointer to node owning the link, or 0 if no matching link is found.
1624 */
Jon Paul Maloy38206d52015-11-19 14:30:46 -05001625static struct tipc_node *tipc_node_find_by_name(struct net *net,
1626 const char *link_name,
1627 unsigned int *bearer_id)
Jon Paul Maloy5be9c082015-11-19 14:30:45 -05001628{
1629 struct tipc_net *tn = net_generic(net, tipc_net_id);
Jon Paul Maloy38206d52015-11-19 14:30:46 -05001630 struct tipc_link *l;
1631 struct tipc_node *n;
Jon Paul Maloy5be9c082015-11-19 14:30:45 -05001632 struct tipc_node *found_node = NULL;
1633 int i;
1634
1635 *bearer_id = 0;
1636 rcu_read_lock();
Jon Paul Maloy38206d52015-11-19 14:30:46 -05001637 list_for_each_entry_rcu(n, &tn->node_list, list) {
1638 tipc_node_read_lock(n);
Jon Paul Maloy5be9c082015-11-19 14:30:45 -05001639 for (i = 0; i < MAX_BEARERS; i++) {
Jon Paul Maloy38206d52015-11-19 14:30:46 -05001640 l = n->links[i].link;
1641 if (l && !strcmp(tipc_link_name(l), link_name)) {
Jon Paul Maloy5be9c082015-11-19 14:30:45 -05001642 *bearer_id = i;
Jon Paul Maloy38206d52015-11-19 14:30:46 -05001643 found_node = n;
Jon Paul Maloy5be9c082015-11-19 14:30:45 -05001644 break;
1645 }
1646 }
Jon Paul Maloy38206d52015-11-19 14:30:46 -05001647 tipc_node_read_unlock(n);
Jon Paul Maloy5be9c082015-11-19 14:30:45 -05001648 if (found_node)
1649 break;
1650 }
1651 rcu_read_unlock();
1652
1653 return found_node;
1654}
1655
1656int tipc_nl_node_set_link(struct sk_buff *skb, struct genl_info *info)
1657{
1658 int err;
1659 int res = 0;
1660 int bearer_id;
1661 char *name;
1662 struct tipc_link *link;
1663 struct tipc_node *node;
Richard Alped01332f2016-02-01 08:19:56 +01001664 struct sk_buff_head xmitq;
Jon Paul Maloy5be9c082015-11-19 14:30:45 -05001665 struct nlattr *attrs[TIPC_NLA_LINK_MAX + 1];
1666 struct net *net = sock_net(skb->sk);
1667
Richard Alped01332f2016-02-01 08:19:56 +01001668 __skb_queue_head_init(&xmitq);
1669
Jon Paul Maloy5be9c082015-11-19 14:30:45 -05001670 if (!info->attrs[TIPC_NLA_LINK])
1671 return -EINVAL;
1672
1673 err = nla_parse_nested(attrs, TIPC_NLA_LINK_MAX,
1674 info->attrs[TIPC_NLA_LINK],
1675 tipc_nl_link_policy);
1676 if (err)
1677 return err;
1678
1679 if (!attrs[TIPC_NLA_LINK_NAME])
1680 return -EINVAL;
1681
1682 name = nla_data(attrs[TIPC_NLA_LINK_NAME]);
1683
1684 if (strcmp(name, tipc_bclink_name) == 0)
1685 return tipc_nl_bc_link_set(net, attrs);
1686
Jon Paul Maloy38206d52015-11-19 14:30:46 -05001687 node = tipc_node_find_by_name(net, name, &bearer_id);
Jon Paul Maloy5be9c082015-11-19 14:30:45 -05001688 if (!node)
1689 return -EINVAL;
1690
1691 tipc_node_read_lock(node);
1692
1693 link = node->links[bearer_id].link;
1694 if (!link) {
1695 res = -EINVAL;
1696 goto out;
1697 }
1698
1699 if (attrs[TIPC_NLA_LINK_PROP]) {
1700 struct nlattr *props[TIPC_NLA_PROP_MAX + 1];
1701
1702 err = tipc_nl_parse_link_prop(attrs[TIPC_NLA_LINK_PROP],
1703 props);
1704 if (err) {
1705 res = err;
1706 goto out;
1707 }
1708
1709 if (props[TIPC_NLA_PROP_TOL]) {
1710 u32 tol;
1711
1712 tol = nla_get_u32(props[TIPC_NLA_PROP_TOL]);
Richard Alped01332f2016-02-01 08:19:56 +01001713 tipc_link_set_tolerance(link, tol, &xmitq);
Jon Paul Maloy5be9c082015-11-19 14:30:45 -05001714 }
1715 if (props[TIPC_NLA_PROP_PRIO]) {
1716 u32 prio;
1717
1718 prio = nla_get_u32(props[TIPC_NLA_PROP_PRIO]);
Richard Alped01332f2016-02-01 08:19:56 +01001719 tipc_link_set_prio(link, prio, &xmitq);
Jon Paul Maloy5be9c082015-11-19 14:30:45 -05001720 }
1721 if (props[TIPC_NLA_PROP_WIN]) {
1722 u32 win;
1723
1724 win = nla_get_u32(props[TIPC_NLA_PROP_WIN]);
1725 tipc_link_set_queue_limits(link, win);
1726 }
1727 }
1728
1729out:
1730 tipc_node_read_unlock(node);
Richard Alped01332f2016-02-01 08:19:56 +01001731 tipc_bearer_xmit(net, bearer_id, &xmitq, &node->links[bearer_id].maddr);
Jon Paul Maloy5be9c082015-11-19 14:30:45 -05001732 return res;
1733}
1734
1735int tipc_nl_node_get_link(struct sk_buff *skb, struct genl_info *info)
1736{
1737 struct net *net = genl_info_net(info);
1738 struct tipc_nl_msg msg;
1739 char *name;
1740 int err;
1741
1742 msg.portid = info->snd_portid;
1743 msg.seq = info->snd_seq;
1744
1745 if (!info->attrs[TIPC_NLA_LINK_NAME])
1746 return -EINVAL;
1747 name = nla_data(info->attrs[TIPC_NLA_LINK_NAME]);
1748
1749 msg.skb = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
1750 if (!msg.skb)
1751 return -ENOMEM;
1752
1753 if (strcmp(name, tipc_bclink_name) == 0) {
1754 err = tipc_nl_add_bc_link(net, &msg);
1755 if (err) {
1756 nlmsg_free(msg.skb);
1757 return err;
1758 }
1759 } else {
1760 int bearer_id;
1761 struct tipc_node *node;
1762 struct tipc_link *link;
1763
Jon Paul Maloy38206d52015-11-19 14:30:46 -05001764 node = tipc_node_find_by_name(net, name, &bearer_id);
Jon Paul Maloy5be9c082015-11-19 14:30:45 -05001765 if (!node)
1766 return -EINVAL;
1767
1768 tipc_node_read_lock(node);
1769 link = node->links[bearer_id].link;
1770 if (!link) {
1771 tipc_node_read_unlock(node);
1772 nlmsg_free(msg.skb);
1773 return -EINVAL;
1774 }
1775
1776 err = __tipc_nl_add_link(net, &msg, link, 0);
1777 tipc_node_read_unlock(node);
1778 if (err) {
1779 nlmsg_free(msg.skb);
1780 return err;
1781 }
1782 }
1783
1784 return genlmsg_reply(msg.skb, info);
1785}
1786
1787int tipc_nl_node_reset_link_stats(struct sk_buff *skb, struct genl_info *info)
1788{
1789 int err;
1790 char *link_name;
1791 unsigned int bearer_id;
1792 struct tipc_link *link;
1793 struct tipc_node *node;
1794 struct nlattr *attrs[TIPC_NLA_LINK_MAX + 1];
1795 struct net *net = sock_net(skb->sk);
1796 struct tipc_link_entry *le;
1797
1798 if (!info->attrs[TIPC_NLA_LINK])
1799 return -EINVAL;
1800
1801 err = nla_parse_nested(attrs, TIPC_NLA_LINK_MAX,
1802 info->attrs[TIPC_NLA_LINK],
1803 tipc_nl_link_policy);
1804 if (err)
1805 return err;
1806
1807 if (!attrs[TIPC_NLA_LINK_NAME])
1808 return -EINVAL;
1809
1810 link_name = nla_data(attrs[TIPC_NLA_LINK_NAME]);
1811
1812 if (strcmp(link_name, tipc_bclink_name) == 0) {
1813 err = tipc_bclink_reset_stats(net);
1814 if (err)
1815 return err;
1816 return 0;
1817 }
1818
Jon Paul Maloy38206d52015-11-19 14:30:46 -05001819 node = tipc_node_find_by_name(net, link_name, &bearer_id);
Jon Paul Maloy5be9c082015-11-19 14:30:45 -05001820 if (!node)
1821 return -EINVAL;
1822
1823 le = &node->links[bearer_id];
1824 tipc_node_read_lock(node);
1825 spin_lock_bh(&le->lock);
1826 link = node->links[bearer_id].link;
1827 if (!link) {
1828 spin_unlock_bh(&le->lock);
1829 tipc_node_read_unlock(node);
1830 return -EINVAL;
1831 }
Jon Paul Maloy38206d52015-11-19 14:30:46 -05001832 tipc_link_reset_stats(link);
Jon Paul Maloy5be9c082015-11-19 14:30:45 -05001833 spin_unlock_bh(&le->lock);
1834 tipc_node_read_unlock(node);
1835 return 0;
1836}
1837
1838/* Caller should hold node lock */
1839static int __tipc_nl_add_node_links(struct net *net, struct tipc_nl_msg *msg,
1840 struct tipc_node *node, u32 *prev_link)
1841{
1842 u32 i;
1843 int err;
1844
1845 for (i = *prev_link; i < MAX_BEARERS; i++) {
1846 *prev_link = i;
1847
1848 if (!node->links[i].link)
1849 continue;
1850
1851 err = __tipc_nl_add_link(net, msg,
1852 node->links[i].link, NLM_F_MULTI);
1853 if (err)
1854 return err;
1855 }
1856 *prev_link = 0;
1857
1858 return 0;
1859}
1860
Jon Paul Maloy38206d52015-11-19 14:30:46 -05001861int tipc_nl_node_dump_link(struct sk_buff *skb, struct netlink_callback *cb)
Jon Paul Maloy5be9c082015-11-19 14:30:45 -05001862{
1863 struct net *net = sock_net(skb->sk);
1864 struct tipc_net *tn = net_generic(net, tipc_net_id);
1865 struct tipc_node *node;
1866 struct tipc_nl_msg msg;
1867 u32 prev_node = cb->args[0];
1868 u32 prev_link = cb->args[1];
1869 int done = cb->args[2];
1870 int err;
1871
1872 if (done)
1873 return 0;
1874
1875 msg.skb = skb;
1876 msg.portid = NETLINK_CB(cb->skb).portid;
1877 msg.seq = cb->nlh->nlmsg_seq;
1878
1879 rcu_read_lock();
1880 if (prev_node) {
1881 node = tipc_node_find(net, prev_node);
1882 if (!node) {
1883 /* We never set seq or call nl_dump_check_consistent()
1884 * this means that setting prev_seq here will cause the
1885 * consistence check to fail in the netlink callback
1886 * handler. Resulting in the last NLMSG_DONE message
1887 * having the NLM_F_DUMP_INTR flag set.
1888 */
1889 cb->prev_seq = 1;
1890 goto out;
1891 }
1892 tipc_node_put(node);
1893
1894 list_for_each_entry_continue_rcu(node, &tn->node_list,
1895 list) {
1896 tipc_node_read_lock(node);
1897 err = __tipc_nl_add_node_links(net, &msg, node,
1898 &prev_link);
1899 tipc_node_read_unlock(node);
1900 if (err)
1901 goto out;
1902
1903 prev_node = node->addr;
1904 }
1905 } else {
1906 err = tipc_nl_add_bc_link(net, &msg);
1907 if (err)
1908 goto out;
1909
1910 list_for_each_entry_rcu(node, &tn->node_list, list) {
1911 tipc_node_read_lock(node);
1912 err = __tipc_nl_add_node_links(net, &msg, node,
1913 &prev_link);
1914 tipc_node_read_unlock(node);
1915 if (err)
1916 goto out;
1917
1918 prev_node = node->addr;
1919 }
1920 }
1921 done = 1;
1922out:
1923 rcu_read_unlock();
1924
1925 cb->args[0] = prev_node;
1926 cb->args[1] = prev_link;
1927 cb->args[2] = done;
1928
1929 return skb->len;
1930}
Parthasarathy Bhuvaragan7b3f5222016-07-26 08:47:19 +02001931
1932int tipc_nl_node_set_monitor(struct sk_buff *skb, struct genl_info *info)
1933{
1934 struct nlattr *attrs[TIPC_NLA_MON_MAX + 1];
1935 struct net *net = sock_net(skb->sk);
1936 int err;
1937
1938 if (!info->attrs[TIPC_NLA_MON])
1939 return -EINVAL;
1940
1941 err = nla_parse_nested(attrs, TIPC_NLA_MON_MAX,
1942 info->attrs[TIPC_NLA_MON],
1943 tipc_nl_monitor_policy);
1944 if (err)
1945 return err;
1946
1947 if (attrs[TIPC_NLA_MON_ACTIVATION_THRESHOLD]) {
1948 u32 val;
1949
1950 val = nla_get_u32(attrs[TIPC_NLA_MON_ACTIVATION_THRESHOLD]);
1951 err = tipc_nl_monitor_set_threshold(net, val);
1952 if (err)
1953 return err;
1954 }
1955
1956 return 0;
1957}
Parthasarathy Bhuvaraganbf1035b2016-07-26 08:47:20 +02001958
1959static int __tipc_nl_add_monitor_prop(struct net *net, struct tipc_nl_msg *msg)
1960{
1961 struct nlattr *attrs;
1962 void *hdr;
1963 u32 val;
1964
1965 hdr = genlmsg_put(msg->skb, msg->portid, msg->seq, &tipc_genl_family,
1966 0, TIPC_NL_MON_GET);
1967 if (!hdr)
1968 return -EMSGSIZE;
1969
1970 attrs = nla_nest_start(msg->skb, TIPC_NLA_MON);
1971 if (!attrs)
1972 goto msg_full;
1973
1974 val = tipc_nl_monitor_get_threshold(net);
1975
1976 if (nla_put_u32(msg->skb, TIPC_NLA_MON_ACTIVATION_THRESHOLD, val))
1977 goto attr_msg_full;
1978
1979 nla_nest_end(msg->skb, attrs);
1980 genlmsg_end(msg->skb, hdr);
1981
1982 return 0;
1983
1984attr_msg_full:
1985 nla_nest_cancel(msg->skb, attrs);
1986msg_full:
1987 genlmsg_cancel(msg->skb, hdr);
1988
1989 return -EMSGSIZE;
1990}
1991
1992int tipc_nl_node_get_monitor(struct sk_buff *skb, struct genl_info *info)
1993{
1994 struct net *net = sock_net(skb->sk);
1995 struct tipc_nl_msg msg;
1996 int err;
1997
1998 msg.skb = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
1999 msg.portid = info->snd_portid;
2000 msg.seq = info->snd_seq;
2001
2002 err = __tipc_nl_add_monitor_prop(net, &msg);
2003 if (err) {
2004 nlmsg_free(msg.skb);
2005 return err;
2006 }
2007
2008 return genlmsg_reply(msg.skb, info);
2009}
Parthasarathy Bhuvaragancf6f7e12016-07-26 08:47:22 +02002010
2011int tipc_nl_node_dump_monitor(struct sk_buff *skb, struct netlink_callback *cb)
2012{
2013 struct net *net = sock_net(skb->sk);
2014 u32 prev_bearer = cb->args[0];
2015 struct tipc_nl_msg msg;
2016 int err;
2017 int i;
2018
2019 if (prev_bearer == MAX_BEARERS)
2020 return 0;
2021
2022 msg.skb = skb;
2023 msg.portid = NETLINK_CB(cb->skb).portid;
2024 msg.seq = cb->nlh->nlmsg_seq;
2025
2026 rtnl_lock();
2027 for (i = prev_bearer; i < MAX_BEARERS; i++) {
2028 prev_bearer = i;
2029 err = __tipc_nl_add_monitor(net, &msg, prev_bearer);
2030 if (err)
2031 goto out;
2032 }
2033
2034out:
2035 rtnl_unlock();
2036 cb->args[0] = prev_bearer;
2037
2038 return skb->len;
2039}
2040
2041int tipc_nl_node_dump_monitor_peer(struct sk_buff *skb,
2042 struct netlink_callback *cb)
2043{
2044 struct net *net = sock_net(skb->sk);
2045 u32 prev_node = cb->args[1];
2046 u32 bearer_id = cb->args[2];
2047 int done = cb->args[0];
2048 struct tipc_nl_msg msg;
2049 int err;
2050
2051 if (!prev_node) {
2052 struct nlattr **attrs;
2053 struct nlattr *mon[TIPC_NLA_MON_MAX + 1];
2054
2055 err = tipc_nlmsg_parse(cb->nlh, &attrs);
2056 if (err)
2057 return err;
2058
2059 if (!attrs[TIPC_NLA_MON])
2060 return -EINVAL;
2061
2062 err = nla_parse_nested(mon, TIPC_NLA_MON_MAX,
2063 attrs[TIPC_NLA_MON],
2064 tipc_nl_monitor_policy);
2065 if (err)
2066 return err;
2067
2068 if (!mon[TIPC_NLA_MON_REF])
2069 return -EINVAL;
2070
2071 bearer_id = nla_get_u32(mon[TIPC_NLA_MON_REF]);
2072
2073 if (bearer_id >= MAX_BEARERS)
2074 return -EINVAL;
2075 }
2076
2077 if (done)
2078 return 0;
2079
2080 msg.skb = skb;
2081 msg.portid = NETLINK_CB(cb->skb).portid;
2082 msg.seq = cb->nlh->nlmsg_seq;
2083
2084 rtnl_lock();
2085 err = tipc_nl_add_monitor_peer(net, &msg, bearer_id, &prev_node);
2086 if (!err)
2087 done = 1;
2088
2089 rtnl_unlock();
2090 cb->args[0] = done;
2091 cb->args[1] = prev_node;
2092 cb->args[2] = bearer_id;
2093
2094 return skb->len;
2095}