blob: 383f87bc10615ed74111a53a8cb8d6bf08c0ec92 [file] [log] [blame]
Per Lidenb97bf3f2006-01-02 19:04:38 +01001/*
2 * net/tipc/bcast.c: TIPC broadcast code
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09003 *
Jon Maloy4c94cc22017-11-30 16:47:25 +01004 * Copyright (c) 2004-2006, 2014-2017, Ericsson AB
Per Lidenb97bf3f2006-01-02 19:04:38 +01005 * Copyright (c) 2004, Intel Corporation.
Allan Stephens2d627b92011-01-07 13:00:11 -05006 * Copyright (c) 2005, 2010-2011, Wind River Systems
Per Lidenb97bf3f2006-01-02 19:04:38 +01007 * All rights reserved.
8 *
Per Liden9ea1fd32006-01-11 13:30:43 +01009 * Redistribution and use in source and binary forms, with or without
Per Lidenb97bf3f2006-01-02 19:04:38 +010010 * modification, are permitted provided that the following conditions are met:
11 *
Per Liden9ea1fd32006-01-11 13:30:43 +010012 * 1. Redistributions of source code must retain the above copyright
13 * notice, this list of conditions and the following disclaimer.
14 * 2. Redistributions in binary form must reproduce the above copyright
15 * notice, this list of conditions and the following disclaimer in the
16 * documentation and/or other materials provided with the distribution.
17 * 3. Neither the names of the copyright holders nor the names of its
18 * contributors may be used to endorse or promote products derived from
19 * this software without specific prior written permission.
Per Lidenb97bf3f2006-01-02 19:04:38 +010020 *
Per Liden9ea1fd32006-01-11 13:30:43 +010021 * Alternatively, this software may be distributed under the terms of the
22 * GNU General Public License ("GPL") version 2 as published by the Free
23 * Software Foundation.
24 *
25 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
26 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
27 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
28 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
29 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
30 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
31 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
32 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
33 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
34 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
Per Lidenb97bf3f2006-01-02 19:04:38 +010035 * POSSIBILITY OF SUCH DAMAGE.
36 */
37
Jon Paul Maloy6beb19a2015-10-22 08:51:33 -040038#include <linux/tipc_config.h>
Jon Paul Maloy078bec82014-07-16 20:41:00 -040039#include "socket.h"
40#include "msg.h"
Per Lidenb97bf3f2006-01-02 19:04:38 +010041#include "bcast.h"
Jon Paul Maloy6beb19a2015-10-22 08:51:33 -040042#include "link.h"
Jon Paul Maloy2ae0b8a2017-01-18 13:50:51 -050043#include "name_table.h"
Per Lidenb97bf3f2006-01-02 19:04:38 +010044
Jon Maloy4c94cc22017-11-30 16:47:25 +010045#define BCLINK_WIN_DEFAULT 50 /* bcast link window size (default) */
46#define BCLINK_WIN_MIN 32 /* bcast minimum link window size */
Allan Stephensc47e9b92011-10-24 10:29:26 -040047
Allan Stephens3aec9cc2010-05-11 14:30:07 +000048const char tipc_bclink_name[] = "broadcast-link";
Tuong Liena91d55d2020-05-26 16:38:36 +070049unsigned long sysctl_tipc_bc_retruni __read_mostly;
Per Lidenb97bf3f2006-01-02 19:04:38 +010050
Jon Paul Maloy6beb19a2015-10-22 08:51:33 -040051/**
Jon Paul Maloy2af5ae32015-10-22 08:51:48 -040052 * struct tipc_bc_base - base structure for keeping broadcast send state
Jon Paul Maloyb06b2812015-10-22 08:51:42 -040053 * @link: broadcast send link structure
Jon Paul Maloy2af5ae32015-10-22 08:51:48 -040054 * @inputq: data input queue; will only carry SOCK_WAKEUP messages
Zhenbo Gao9cc1bf32018-09-03 16:36:45 +080055 * @dests: array keeping number of reachable destinations per bearer
Jon Paul Maloy2af5ae32015-10-22 08:51:48 -040056 * @primary_bearer: a bearer having links to all broadcast destinations, if any
Jon Paul Maloy99999742017-01-18 13:50:50 -050057 * @bcast_support: indicates if primary bearer, if any, supports broadcast
Hoang Le02ec6ca2019-03-19 18:49:48 +070058 * @force_bcast: forces broadcast for multicast traffic
Jon Paul Maloy01fd12b2017-01-18 13:50:53 -050059 * @rcast_support: indicates if all peer nodes support replicast
Hoang Le02ec6ca2019-03-19 18:49:48 +070060 * @force_rcast: forces replicast for multicast traffic
Jon Paul Maloy01fd12b2017-01-18 13:50:53 -050061 * @rc_ratio: dest count as percentage of cluster size where send method changes
Zhenbo Gao9cc1bf32018-09-03 16:36:45 +080062 * @bc_threshold: calculated from rc_ratio; if dests > threshold use broadcast
Jon Paul Maloy6beb19a2015-10-22 08:51:33 -040063 */
64struct tipc_bc_base {
Jon Paul Maloy32301902015-10-22 08:51:37 -040065 struct tipc_link *link;
Jon Paul Maloy6beb19a2015-10-22 08:51:33 -040066 struct sk_buff_head inputq;
Jon Paul Maloyb06b2812015-10-22 08:51:42 -040067 int dests[MAX_BEARERS];
68 int primary_bearer;
Jon Paul Maloy99999742017-01-18 13:50:50 -050069 bool bcast_support;
Hoang Le02ec6ca2019-03-19 18:49:48 +070070 bool force_bcast;
Jon Paul Maloy01fd12b2017-01-18 13:50:53 -050071 bool rcast_support;
Hoang Le02ec6ca2019-03-19 18:49:48 +070072 bool force_rcast;
Jon Paul Maloy01fd12b2017-01-18 13:50:53 -050073 int rc_ratio;
74 int bc_threshold;
Jon Paul Maloy6beb19a2015-10-22 08:51:33 -040075};
76
Jon Paul Maloy5fd9fd62015-10-22 08:51:35 -040077static struct tipc_bc_base *tipc_bc_base(struct net *net)
78{
79 return tipc_net(net)->bcbase;
80}
81
Jon Maloy4c94cc22017-11-30 16:47:25 +010082/* tipc_bcast_get_mtu(): -get the MTU currently used by broadcast link
83 * Note: the MTU is decremented to give room for a tunnel header, in
84 * case the message needs to be sent as replicast
85 */
Jon Paul Maloy959e1782015-10-22 08:51:43 -040086int tipc_bcast_get_mtu(struct net *net)
Jon Paul Maloy078bec82014-07-16 20:41:00 -040087{
Tuong Lienfc1b6d62019-11-08 12:05:11 +070088 return tipc_link_mss(tipc_bc_sndlink(net));
Jon Paul Maloy078bec82014-07-16 20:41:00 -040089}
90
Hoang Leba5f6a82019-11-21 10:01:09 +070091void tipc_bcast_toggle_rcast(struct net *net, bool supp)
Jon Paul Maloy01fd12b2017-01-18 13:50:53 -050092{
Hoang Leba5f6a82019-11-21 10:01:09 +070093 tipc_bc_base(net)->rcast_support = supp;
Jon Paul Maloy01fd12b2017-01-18 13:50:53 -050094}
95
96static void tipc_bcbase_calc_bc_threshold(struct net *net)
97{
98 struct tipc_bc_base *bb = tipc_bc_base(net);
99 int cluster_size = tipc_link_bc_peers(tipc_bc_sndlink(net));
100
101 bb->bc_threshold = 1 + (cluster_size * bb->rc_ratio / 100);
102}
103
Jon Paul Maloyb06b2812015-10-22 08:51:42 -0400104/* tipc_bcbase_select_primary(): find a bearer with links to all destinations,
105 * if any, and make it primary bearer
106 */
107static void tipc_bcbase_select_primary(struct net *net)
108{
109 struct tipc_bc_base *bb = tipc_bc_base(net);
110 int all_dests = tipc_link_bc_peers(bb->link);
Jon Paul Maloy99999742017-01-18 13:50:50 -0500111 int i, mtu, prim;
Jon Paul Maloyb06b2812015-10-22 08:51:42 -0400112
113 bb->primary_bearer = INVALID_BEARER_ID;
Jon Paul Maloy99999742017-01-18 13:50:50 -0500114 bb->bcast_support = true;
Jon Paul Maloyb06b2812015-10-22 08:51:42 -0400115
116 if (!all_dests)
117 return;
118
119 for (i = 0; i < MAX_BEARERS; i++) {
Jon Paul Maloy959e1782015-10-22 08:51:43 -0400120 if (!bb->dests[i])
121 continue;
122
123 mtu = tipc_bearer_mtu(net, i);
124 if (mtu < tipc_link_mtu(bb->link))
125 tipc_link_set_mtu(bb->link, mtu);
Jon Paul Maloy99999742017-01-18 13:50:50 -0500126 bb->bcast_support &= tipc_bearer_bcast_support(net, i);
Jon Paul Maloyb06b2812015-10-22 08:51:42 -0400127 if (bb->dests[i] < all_dests)
128 continue;
129
130 bb->primary_bearer = i;
131
132 /* Reduce risk that all nodes select same primary */
133 if ((i ^ tipc_own_addr(net)) & 1)
134 break;
135 }
Jon Paul Maloy99999742017-01-18 13:50:50 -0500136 prim = bb->primary_bearer;
137 if (prim != INVALID_BEARER_ID)
138 bb->bcast_support = tipc_bearer_bcast_support(net, prim);
Jon Paul Maloyb06b2812015-10-22 08:51:42 -0400139}
140
141void tipc_bcast_inc_bearer_dst_cnt(struct net *net, int bearer_id)
142{
143 struct tipc_bc_base *bb = tipc_bc_base(net);
144
145 tipc_bcast_lock(net);
146 bb->dests[bearer_id]++;
147 tipc_bcbase_select_primary(net);
148 tipc_bcast_unlock(net);
149}
150
151void tipc_bcast_dec_bearer_dst_cnt(struct net *net, int bearer_id)
152{
153 struct tipc_bc_base *bb = tipc_bc_base(net);
154
155 tipc_bcast_lock(net);
156 bb->dests[bearer_id]--;
157 tipc_bcbase_select_primary(net);
158 tipc_bcast_unlock(net);
159}
160
Jon Paul Maloyb06b2812015-10-22 08:51:42 -0400161/* tipc_bcbase_xmit - broadcast a packet queue across one or more bearers
162 *
163 * Note that number of reachable destinations, as indicated in the dests[]
164 * array, may transitionally differ from the number of destinations indicated
165 * in each sent buffer. We can sustain this. Excess destination nodes will
166 * drop and never acknowledge the unexpected packets, and missing destinations
167 * will either require retransmission (if they are just about to be added to
168 * the bearer), or be removed from the buffer's 'ackers' counter (if they
169 * just went down)
170 */
171static void tipc_bcbase_xmit(struct net *net, struct sk_buff_head *xmitq)
172{
173 int bearer_id;
174 struct tipc_bc_base *bb = tipc_bc_base(net);
175 struct sk_buff *skb, *_skb;
176 struct sk_buff_head _xmitq;
177
178 if (skb_queue_empty(xmitq))
179 return;
180
181 /* The typical case: at least one bearer has links to all nodes */
182 bearer_id = bb->primary_bearer;
183 if (bearer_id >= 0) {
184 tipc_bearer_bc_xmit(net, bearer_id, xmitq);
185 return;
186 }
187
188 /* We have to transmit across all bearers */
Jon Maloye654f9f2019-08-15 16:42:50 +0200189 __skb_queue_head_init(&_xmitq);
Jon Paul Maloyb06b2812015-10-22 08:51:42 -0400190 for (bearer_id = 0; bearer_id < MAX_BEARERS; bearer_id++) {
191 if (!bb->dests[bearer_id])
192 continue;
193
194 skb_queue_walk(xmitq, skb) {
195 _skb = pskb_copy_for_clone(skb, GFP_ATOMIC);
196 if (!_skb)
197 break;
198 __skb_queue_tail(&_xmitq, _skb);
199 }
200 tipc_bearer_bc_xmit(net, bearer_id, &_xmitq);
201 }
202 __skb_queue_purge(xmitq);
203 __skb_queue_purge(&_xmitq);
204}
205
Jon Paul Maloy01fd12b2017-01-18 13:50:53 -0500206static void tipc_bcast_select_xmit_method(struct net *net, int dests,
207 struct tipc_mc_method *method)
208{
209 struct tipc_bc_base *bb = tipc_bc_base(net);
210 unsigned long exp = method->expires;
211
212 /* Broadcast supported by used bearer/bearers? */
213 if (!bb->bcast_support) {
214 method->rcast = true;
215 return;
216 }
217 /* Any destinations which don't support replicast ? */
218 if (!bb->rcast_support) {
219 method->rcast = false;
220 return;
221 }
222 /* Can current method be changed ? */
223 method->expires = jiffies + TIPC_METHOD_EXPIRE;
Hoang Lec55c8ed2019-03-19 18:49:50 +0700224 if (method->mandatory)
Jon Paul Maloy01fd12b2017-01-18 13:50:53 -0500225 return;
226
Hoang Lec55c8ed2019-03-19 18:49:50 +0700227 if (!(tipc_net(net)->capabilities & TIPC_MCAST_RBCTL) &&
228 time_before(jiffies, exp))
229 return;
230
231 /* Configuration as force 'broadcast' method */
232 if (bb->force_bcast) {
233 method->rcast = false;
234 return;
235 }
236 /* Configuration as force 'replicast' method */
237 if (bb->force_rcast) {
238 method->rcast = true;
239 return;
240 }
241 /* Configuration as 'autoselect' or default method */
Jon Paul Maloy01fd12b2017-01-18 13:50:53 -0500242 /* Determine method to use now */
243 method->rcast = dests <= bb->bc_threshold;
244}
245
Jon Paul Maloya853e4c2017-01-18 13:50:52 -0500246/* tipc_bcast_xmit - broadcast the buffer chain to all external nodes
Ying Xuef2f98002015-01-09 15:27:05 +0800247 * @net: the applicable net namespace
Jon Paul Maloya853e4c2017-01-18 13:50:52 -0500248 * @pkts: chain of buffers containing message
249 * @cong_link_cnt: set to 1 if broadcast link is congested, otherwise 0
Jon Paul Maloy365ad352017-01-03 10:55:11 -0500250 * Consumes the buffer chain.
Jon Paul Maloya853e4c2017-01-18 13:50:52 -0500251 * Returns 0 if success, otherwise errno: -EHOSTUNREACH,-EMSGSIZE
Jon Paul Maloy078bec82014-07-16 20:41:00 -0400252 */
Jon Paul Maloya853e4c2017-01-18 13:50:52 -0500253static int tipc_bcast_xmit(struct net *net, struct sk_buff_head *pkts,
254 u16 *cong_link_cnt)
Jon Paul Maloy078bec82014-07-16 20:41:00 -0400255{
Jon Paul Maloy2f566122015-10-22 08:51:39 -0400256 struct tipc_link *l = tipc_bc_sndlink(net);
Jon Paul Maloya853e4c2017-01-18 13:50:52 -0500257 struct sk_buff_head xmitq;
Jon Paul Maloy078bec82014-07-16 20:41:00 -0400258 int rc = 0;
Jon Paul Maloy078bec82014-07-16 20:41:00 -0400259
Jon Maloye654f9f2019-08-15 16:42:50 +0200260 __skb_queue_head_init(&xmitq);
Jon Paul Maloy2f566122015-10-22 08:51:39 -0400261 tipc_bcast_lock(net);
262 if (tipc_link_bc_peers(l))
Jon Paul Maloya853e4c2017-01-18 13:50:52 -0500263 rc = tipc_link_xmit(l, pkts, &xmitq);
Jon Paul Maloy2f566122015-10-22 08:51:39 -0400264 tipc_bcast_unlock(net);
Jon Paul Maloya853e4c2017-01-18 13:50:52 -0500265 tipc_bcbase_xmit(net, &xmitq);
266 __skb_queue_purge(pkts);
267 if (rc == -ELINKCONG) {
268 *cong_link_cnt = 1;
269 rc = 0;
270 }
271 return rc;
272}
Ying Xue58dc55f2014-11-26 11:41:52 +0800273
Jon Paul Maloya853e4c2017-01-18 13:50:52 -0500274/* tipc_rcast_xmit - replicate and send a message to given destination nodes
275 * @net: the applicable net namespace
276 * @pkts: chain of buffers containing message
277 * @dests: list of destination nodes
278 * @cong_link_cnt: returns number of congested links
279 * @cong_links: returns identities of congested links
280 * Returns 0 if success, otherwise errno
281 */
282static int tipc_rcast_xmit(struct net *net, struct sk_buff_head *pkts,
283 struct tipc_nlist *dests, u16 *cong_link_cnt)
284{
Jon Maloya80ae532017-10-13 11:04:22 +0200285 struct tipc_dest *dst, *tmp;
Jon Paul Maloya853e4c2017-01-18 13:50:52 -0500286 struct sk_buff_head _pkts;
Jon Maloya80ae532017-10-13 11:04:22 +0200287 u32 dnode, selector;
Jon Paul Maloya853e4c2017-01-18 13:50:52 -0500288
289 selector = msg_link_selector(buf_msg(skb_peek(pkts)));
Jon Maloye654f9f2019-08-15 16:42:50 +0200290 __skb_queue_head_init(&_pkts);
Jon Paul Maloya853e4c2017-01-18 13:50:52 -0500291
Jon Maloya80ae532017-10-13 11:04:22 +0200292 list_for_each_entry_safe(dst, tmp, &dests->list, list) {
293 dnode = dst->node;
294 if (!tipc_msg_pskb_copy(dnode, pkts, &_pkts))
Jon Paul Maloya853e4c2017-01-18 13:50:52 -0500295 return -ENOMEM;
296
297 /* Any other return value than -ELINKCONG is ignored */
Jon Maloya80ae532017-10-13 11:04:22 +0200298 if (tipc_node_xmit(net, &_pkts, dnode, selector) == -ELINKCONG)
Jon Paul Maloya853e4c2017-01-18 13:50:52 -0500299 (*cong_link_cnt)++;
300 }
301 return 0;
302}
303
Hoang Lec55c8ed2019-03-19 18:49:50 +0700304/* tipc_mcast_send_sync - deliver a dummy message with SYN bit
305 * @net: the applicable net namespace
306 * @skb: socket buffer to copy
307 * @method: send method to be used
308 * @dests: destination nodes for message.
Hoang Lec55c8ed2019-03-19 18:49:50 +0700309 * Returns 0 if success, otherwise errno
310 */
311static int tipc_mcast_send_sync(struct net *net, struct sk_buff *skb,
312 struct tipc_mc_method *method,
Tuong Liendca4a172019-12-10 15:21:03 +0700313 struct tipc_nlist *dests)
Hoang Lec55c8ed2019-03-19 18:49:50 +0700314{
315 struct tipc_msg *hdr, *_hdr;
316 struct sk_buff_head tmpq;
317 struct sk_buff *_skb;
Tuong Liendca4a172019-12-10 15:21:03 +0700318 u16 cong_link_cnt;
319 int rc = 0;
Hoang Lec55c8ed2019-03-19 18:49:50 +0700320
321 /* Is a cluster supporting with new capabilities ? */
322 if (!(tipc_net(net)->capabilities & TIPC_MCAST_RBCTL))
323 return 0;
324
325 hdr = buf_msg(skb);
326 if (msg_user(hdr) == MSG_FRAGMENTER)
Jon Maloya7dc51a2019-06-25 19:37:00 +0200327 hdr = msg_inner_hdr(hdr);
Hoang Lec55c8ed2019-03-19 18:49:50 +0700328 if (msg_type(hdr) != TIPC_MCAST_MSG)
329 return 0;
330
331 /* Allocate dummy message */
332 _skb = tipc_buf_acquire(MCAST_H_SIZE, GFP_KERNEL);
Wei Yongjun6da88a82019-03-25 06:31:09 +0000333 if (!_skb)
Hoang Lec55c8ed2019-03-19 18:49:50 +0700334 return -ENOMEM;
335
336 /* Preparing for 'synching' header */
337 msg_set_syn(hdr, 1);
338
339 /* Copy skb's header into a dummy header */
340 skb_copy_to_linear_data(_skb, hdr, MCAST_H_SIZE);
341 skb_orphan(_skb);
342
343 /* Reverse method for dummy message */
344 _hdr = buf_msg(_skb);
345 msg_set_size(_hdr, MCAST_H_SIZE);
346 msg_set_is_rcast(_hdr, !msg_is_rcast(hdr));
Tuong Liendca4a172019-12-10 15:21:03 +0700347 msg_set_errcode(_hdr, TIPC_ERR_NO_PORT);
Hoang Lec55c8ed2019-03-19 18:49:50 +0700348
Jon Maloye654f9f2019-08-15 16:42:50 +0200349 __skb_queue_head_init(&tmpq);
Hoang Lec55c8ed2019-03-19 18:49:50 +0700350 __skb_queue_tail(&tmpq, _skb);
351 if (method->rcast)
Tuong Liendca4a172019-12-10 15:21:03 +0700352 rc = tipc_bcast_xmit(net, &tmpq, &cong_link_cnt);
Hoang Lec55c8ed2019-03-19 18:49:50 +0700353 else
Tuong Liendca4a172019-12-10 15:21:03 +0700354 rc = tipc_rcast_xmit(net, &tmpq, dests, &cong_link_cnt);
Hoang Lec55c8ed2019-03-19 18:49:50 +0700355
356 /* This queue should normally be empty by now */
357 __skb_queue_purge(&tmpq);
358
Tuong Liendca4a172019-12-10 15:21:03 +0700359 return rc;
Hoang Lec55c8ed2019-03-19 18:49:50 +0700360}
361
Jon Paul Maloya853e4c2017-01-18 13:50:52 -0500362/* tipc_mcast_xmit - deliver message to indicated destination nodes
363 * and to identified node local sockets
364 * @net: the applicable net namespace
365 * @pkts: chain of buffers containing message
Jon Paul Maloy01fd12b2017-01-18 13:50:53 -0500366 * @method: send method to be used
367 * @dests: destination nodes for message.
Jon Paul Maloya853e4c2017-01-18 13:50:52 -0500368 * @cong_link_cnt: returns number of encountered congested destination links
Jon Paul Maloya853e4c2017-01-18 13:50:52 -0500369 * Consumes buffer chain.
370 * Returns 0 if success, otherwise errno
371 */
372int tipc_mcast_xmit(struct net *net, struct sk_buff_head *pkts,
Jon Paul Maloy01fd12b2017-01-18 13:50:53 -0500373 struct tipc_mc_method *method, struct tipc_nlist *dests,
374 u16 *cong_link_cnt)
Jon Paul Maloya853e4c2017-01-18 13:50:52 -0500375{
Jon Paul Maloya853e4c2017-01-18 13:50:52 -0500376 struct sk_buff_head inputq, localq;
Hoang Lec55c8ed2019-03-19 18:49:50 +0700377 bool rcast = method->rcast;
378 struct tipc_msg *hdr;
379 struct sk_buff *skb;
Jon Paul Maloya853e4c2017-01-18 13:50:52 -0500380 int rc = 0;
381
382 skb_queue_head_init(&inputq);
Jon Maloye654f9f2019-08-15 16:42:50 +0200383 __skb_queue_head_init(&localq);
Jon Paul Maloya853e4c2017-01-18 13:50:52 -0500384
385 /* Clone packets before they are consumed by next call */
386 if (dests->local && !tipc_msg_reassemble(pkts, &localq)) {
387 rc = -ENOMEM;
388 goto exit;
Jon Paul Maloycb1b7282015-02-05 08:36:44 -0500389 }
Jon Paul Maloy01fd12b2017-01-18 13:50:53 -0500390 /* Send according to determined transmit method */
Jon Paul Maloya853e4c2017-01-18 13:50:52 -0500391 if (dests->remote) {
Jon Paul Maloy01fd12b2017-01-18 13:50:53 -0500392 tipc_bcast_select_xmit_method(net, dests->remote, method);
Hoang Lec55c8ed2019-03-19 18:49:50 +0700393
394 skb = skb_peek(pkts);
395 hdr = buf_msg(skb);
396 if (msg_user(hdr) == MSG_FRAGMENTER)
Jon Maloya7dc51a2019-06-25 19:37:00 +0200397 hdr = msg_inner_hdr(hdr);
Hoang Lec55c8ed2019-03-19 18:49:50 +0700398 msg_set_is_rcast(hdr, method->rcast);
399
400 /* Switch method ? */
Tuong Liendca4a172019-12-10 15:21:03 +0700401 if (rcast != method->rcast) {
402 rc = tipc_mcast_send_sync(net, skb, method, dests);
403 if (unlikely(rc)) {
404 pr_err("Unable to send SYN: method %d, rc %d\n",
405 rcast, rc);
406 goto exit;
407 }
408 }
Hoang Lec55c8ed2019-03-19 18:49:50 +0700409
Jon Paul Maloy01fd12b2017-01-18 13:50:53 -0500410 if (method->rcast)
Jon Paul Maloya853e4c2017-01-18 13:50:52 -0500411 rc = tipc_rcast_xmit(net, pkts, dests, cong_link_cnt);
412 else
413 rc = tipc_bcast_xmit(net, pkts, cong_link_cnt);
414 }
415
John Rutherford6c9081a2019-08-07 12:52:29 +1000416 if (dests->local) {
417 tipc_loopback_trace(net, &localq);
Jon Paul Maloya853e4c2017-01-18 13:50:52 -0500418 tipc_sk_mcast_rcv(net, &localq, &inputq);
John Rutherford6c9081a2019-08-07 12:52:29 +1000419 }
Jon Paul Maloya853e4c2017-01-18 13:50:52 -0500420exit:
Jon Paul Maloy01fd12b2017-01-18 13:50:53 -0500421 /* This queue should normally be empty by now */
Jon Paul Maloya853e4c2017-01-18 13:50:52 -0500422 __skb_queue_purge(pkts);
Jon Paul Maloy365ad352017-01-03 10:55:11 -0500423 return rc;
Jon Paul Maloy078bec82014-07-16 20:41:00 -0400424}
Jon Paul Maloy52666982015-10-22 08:51:41 -0400425
426/* tipc_bcast_rcv - receive a broadcast packet, and deliver to rcv link
427 *
428 * RCU is locked, no other locks set
429 */
430int tipc_bcast_rcv(struct net *net, struct tipc_link *l, struct sk_buff *skb)
431{
432 struct tipc_msg *hdr = buf_msg(skb);
433 struct sk_buff_head *inputq = &tipc_bc_base(net)->inputq;
434 struct sk_buff_head xmitq;
435 int rc;
436
437 __skb_queue_head_init(&xmitq);
438
439 if (msg_mc_netid(hdr) != tipc_netid(net) || !tipc_link_is_up(l)) {
440 kfree_skb(skb);
441 return 0;
442 }
443
444 tipc_bcast_lock(net);
445 if (msg_user(hdr) == BCAST_PROTOCOL)
446 rc = tipc_link_bc_nack_rcv(l, skb, &xmitq);
447 else
448 rc = tipc_link_rcv(l, skb, NULL);
449 tipc_bcast_unlock(net);
450
Jon Paul Maloyb06b2812015-10-22 08:51:42 -0400451 tipc_bcbase_xmit(net, &xmitq);
Jon Paul Maloy52666982015-10-22 08:51:41 -0400452
453 /* Any socket wakeup messages ? */
454 if (!skb_queue_empty(inputq))
455 tipc_sk_rcv(net, inputq);
456
457 return rc;
458}
459
460/* tipc_bcast_ack_rcv - receive and handle a broadcast acknowledge
461 *
462 * RCU is locked, no other locks set
463 */
Jon Paul Maloy06bd2b12016-10-27 18:51:55 -0400464void tipc_bcast_ack_rcv(struct net *net, struct tipc_link *l,
465 struct tipc_msg *hdr)
Jon Paul Maloy52666982015-10-22 08:51:41 -0400466{
467 struct sk_buff_head *inputq = &tipc_bc_base(net)->inputq;
Jon Paul Maloy06bd2b12016-10-27 18:51:55 -0400468 u16 acked = msg_bcast_ack(hdr);
Jon Paul Maloy52666982015-10-22 08:51:41 -0400469 struct sk_buff_head xmitq;
470
Jon Paul Maloy06bd2b12016-10-27 18:51:55 -0400471 /* Ignore bc acks sent by peer before bcast synch point was received */
472 if (msg_bc_ack_invalid(hdr))
473 return;
474
Jon Paul Maloy52666982015-10-22 08:51:41 -0400475 __skb_queue_head_init(&xmitq);
476
477 tipc_bcast_lock(net);
Tuong Liena91d55d2020-05-26 16:38:36 +0700478 tipc_link_bc_ack_rcv(l, acked, 0, NULL, &xmitq, NULL);
Jon Paul Maloy52666982015-10-22 08:51:41 -0400479 tipc_bcast_unlock(net);
480
Jon Paul Maloyb06b2812015-10-22 08:51:42 -0400481 tipc_bcbase_xmit(net, &xmitq);
Jon Paul Maloy52666982015-10-22 08:51:41 -0400482
483 /* Any socket wakeup messages ? */
484 if (!skb_queue_empty(inputq))
485 tipc_sk_rcv(net, inputq);
486}
487
488/* tipc_bcast_synch_rcv - check and update rcv link with peer's send state
489 *
490 * RCU is locked, no other locks set
491 */
Jon Paul Maloy02d11ca2016-09-01 13:52:49 -0400492int tipc_bcast_sync_rcv(struct net *net, struct tipc_link *l,
Tuong Liena91d55d2020-05-26 16:38:36 +0700493 struct tipc_msg *hdr,
494 struct sk_buff_head *retrq)
Jon Paul Maloy52666982015-10-22 08:51:41 -0400495{
496 struct sk_buff_head *inputq = &tipc_bc_base(net)->inputq;
Tuong Liend7626b52020-05-26 16:38:34 +0700497 struct tipc_gap_ack_blks *ga;
Jon Paul Maloy52666982015-10-22 08:51:41 -0400498 struct sk_buff_head xmitq;
Jon Paul Maloy02d11ca2016-09-01 13:52:49 -0400499 int rc = 0;
Jon Paul Maloy52666982015-10-22 08:51:41 -0400500
501 __skb_queue_head_init(&xmitq);
502
503 tipc_bcast_lock(net);
Jon Paul Maloy06bd2b12016-10-27 18:51:55 -0400504 if (msg_type(hdr) != STATE_MSG) {
505 tipc_link_bc_init_rcv(l, hdr);
506 } else if (!msg_bc_ack_invalid(hdr)) {
Tuong Liend7626b52020-05-26 16:38:34 +0700507 tipc_get_gap_ack_blks(&ga, l, hdr, false);
Tuong Liena91d55d2020-05-26 16:38:36 +0700508 if (!sysctl_tipc_bc_retruni)
509 retrq = &xmitq;
Tuong Liend7626b52020-05-26 16:38:34 +0700510 rc = tipc_link_bc_ack_rcv(l, msg_bcast_ack(hdr),
Tuong Liena91d55d2020-05-26 16:38:36 +0700511 msg_bc_gap(hdr), ga, &xmitq,
512 retrq);
Tuong Liend7626b52020-05-26 16:38:34 +0700513 rc |= tipc_link_bc_sync_rcv(l, hdr, &xmitq);
Jon Paul Maloy52666982015-10-22 08:51:41 -0400514 }
515 tipc_bcast_unlock(net);
516
Jon Paul Maloyb06b2812015-10-22 08:51:42 -0400517 tipc_bcbase_xmit(net, &xmitq);
Jon Paul Maloy52666982015-10-22 08:51:41 -0400518
519 /* Any socket wakeup messages ? */
520 if (!skb_queue_empty(inputq))
521 tipc_sk_rcv(net, inputq);
Jon Paul Maloy02d11ca2016-09-01 13:52:49 -0400522 return rc;
Jon Paul Maloy52666982015-10-22 08:51:41 -0400523}
524
525/* tipc_bcast_add_peer - add a peer node to broadcast link and bearer
526 *
527 * RCU is locked, node lock is set
528 */
Jon Paul Maloyb06b2812015-10-22 08:51:42 -0400529void tipc_bcast_add_peer(struct net *net, struct tipc_link *uc_l,
Jon Paul Maloy52666982015-10-22 08:51:41 -0400530 struct sk_buff_head *xmitq)
531{
Jon Paul Maloy52666982015-10-22 08:51:41 -0400532 struct tipc_link *snd_l = tipc_bc_sndlink(net);
533
Jon Paul Maloyb06b2812015-10-22 08:51:42 -0400534 tipc_bcast_lock(net);
Jon Paul Maloy52666982015-10-22 08:51:41 -0400535 tipc_link_add_bc_peer(snd_l, uc_l, xmitq);
Jon Paul Maloyb06b2812015-10-22 08:51:42 -0400536 tipc_bcbase_select_primary(net);
Jon Paul Maloy01fd12b2017-01-18 13:50:53 -0500537 tipc_bcbase_calc_bc_threshold(net);
Jon Paul Maloyb06b2812015-10-22 08:51:42 -0400538 tipc_bcast_unlock(net);
Jon Paul Maloy52666982015-10-22 08:51:41 -0400539}
540
541/* tipc_bcast_remove_peer - remove a peer node from broadcast link and bearer
542 *
543 * RCU is locked, node lock is set
544 */
Jon Paul Maloyb06b2812015-10-22 08:51:42 -0400545void tipc_bcast_remove_peer(struct net *net, struct tipc_link *rcv_l)
Jon Paul Maloy52666982015-10-22 08:51:41 -0400546{
Jon Paul Maloy52666982015-10-22 08:51:41 -0400547 struct tipc_link *snd_l = tipc_bc_sndlink(net);
Jon Paul Maloyb06b2812015-10-22 08:51:42 -0400548 struct sk_buff_head *inputq = &tipc_bc_base(net)->inputq;
Jon Paul Maloy52666982015-10-22 08:51:41 -0400549 struct sk_buff_head xmitq;
550
551 __skb_queue_head_init(&xmitq);
552
Jon Paul Maloyb06b2812015-10-22 08:51:42 -0400553 tipc_bcast_lock(net);
Jon Paul Maloy52666982015-10-22 08:51:41 -0400554 tipc_link_remove_bc_peer(snd_l, rcv_l, &xmitq);
Jon Paul Maloyb06b2812015-10-22 08:51:42 -0400555 tipc_bcbase_select_primary(net);
Jon Paul Maloy01fd12b2017-01-18 13:50:53 -0500556 tipc_bcbase_calc_bc_threshold(net);
Jon Paul Maloyb06b2812015-10-22 08:51:42 -0400557 tipc_bcast_unlock(net);
Jon Paul Maloy52666982015-10-22 08:51:41 -0400558
Jon Paul Maloyb06b2812015-10-22 08:51:42 -0400559 tipc_bcbase_xmit(net, &xmitq);
Jon Paul Maloy52666982015-10-22 08:51:41 -0400560
561 /* Any socket wakeup messages ? */
562 if (!skb_queue_empty(inputq))
563 tipc_sk_rcv(net, inputq);
564}
565
Tuong Lien03b6fef2020-05-26 16:38:37 +0700566int tipc_bclink_reset_stats(struct net *net, struct tipc_link *l)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100567{
Jon Paul Maloy38206d52015-11-19 14:30:46 -0500568 if (!l)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100569 return -ENOPROTOOPT;
570
Jon Paul Maloy2af5ae32015-10-22 08:51:48 -0400571 tipc_bcast_lock(net);
Jon Paul Maloy38206d52015-11-19 14:30:46 -0500572 tipc_link_reset_stats(l);
Jon Paul Maloy2af5ae32015-10-22 08:51:48 -0400573 tipc_bcast_unlock(net);
Allan Stephens0e35fd52008-07-14 22:44:01 -0700574 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100575}
576
Jon Maloy16ad3f42019-12-10 00:52:46 +0100577static int tipc_bc_link_set_queue_limits(struct net *net, u32 max_win)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100578{
Jon Paul Maloy2af5ae32015-10-22 08:51:48 -0400579 struct tipc_link *l = tipc_bc_sndlink(net);
Ying Xue1da46562015-01-09 15:27:07 +0800580
Jon Paul Maloy2af5ae32015-10-22 08:51:48 -0400581 if (!l)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100582 return -ENOPROTOOPT;
Jon Maloy16ad3f42019-12-10 00:52:46 +0100583 if (max_win < BCLINK_WIN_MIN)
584 max_win = BCLINK_WIN_MIN;
585 if (max_win > TIPC_MAX_LINK_WIN)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100586 return -EINVAL;
Jon Paul Maloy2af5ae32015-10-22 08:51:48 -0400587 tipc_bcast_lock(net);
Jon Maloy16ad3f42019-12-10 00:52:46 +0100588 tipc_link_set_queue_limits(l, BCLINK_WIN_MIN, max_win);
Jon Paul Maloy2af5ae32015-10-22 08:51:48 -0400589 tipc_bcast_unlock(net);
Allan Stephens0e35fd52008-07-14 22:44:01 -0700590 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100591}
592
Hoang Le02ec6ca2019-03-19 18:49:48 +0700593static int tipc_bc_link_set_broadcast_mode(struct net *net, u32 bc_mode)
594{
595 struct tipc_bc_base *bb = tipc_bc_base(net);
596
597 switch (bc_mode) {
598 case BCLINK_MODE_BCAST:
599 if (!bb->bcast_support)
600 return -ENOPROTOOPT;
601
602 bb->force_bcast = true;
603 bb->force_rcast = false;
604 break;
605 case BCLINK_MODE_RCAST:
606 if (!bb->rcast_support)
607 return -ENOPROTOOPT;
608
609 bb->force_bcast = false;
610 bb->force_rcast = true;
611 break;
612 case BCLINK_MODE_SEL:
613 if (!bb->bcast_support || !bb->rcast_support)
614 return -ENOPROTOOPT;
615
616 bb->force_bcast = false;
617 bb->force_rcast = false;
618 break;
619 default:
620 return -EINVAL;
621 }
622
623 return 0;
624}
625
626static int tipc_bc_link_set_broadcast_ratio(struct net *net, u32 bc_ratio)
627{
628 struct tipc_bc_base *bb = tipc_bc_base(net);
629
630 if (!bb->bcast_support || !bb->rcast_support)
631 return -ENOPROTOOPT;
632
633 if (bc_ratio > 100 || bc_ratio <= 0)
634 return -EINVAL;
635
636 bb->rc_ratio = bc_ratio;
637 tipc_bcast_lock(net);
638 tipc_bcbase_calc_bc_threshold(net);
639 tipc_bcast_unlock(net);
640
641 return 0;
642}
643
Richard Alpe670f4f82015-05-06 13:58:55 +0200644int tipc_nl_bc_link_set(struct net *net, struct nlattr *attrs[])
645{
646 int err;
647 u32 win;
Hoang Le02ec6ca2019-03-19 18:49:48 +0700648 u32 bc_mode;
649 u32 bc_ratio;
Richard Alpe670f4f82015-05-06 13:58:55 +0200650 struct nlattr *props[TIPC_NLA_PROP_MAX + 1];
651
652 if (!attrs[TIPC_NLA_LINK_PROP])
653 return -EINVAL;
654
655 err = tipc_nl_parse_link_prop(attrs[TIPC_NLA_LINK_PROP], props);
656 if (err)
657 return err;
658
Hoang Le02ec6ca2019-03-19 18:49:48 +0700659 if (!props[TIPC_NLA_PROP_WIN] &&
660 !props[TIPC_NLA_PROP_BROADCAST] &&
661 !props[TIPC_NLA_PROP_BROADCAST_RATIO]) {
Richard Alpe670f4f82015-05-06 13:58:55 +0200662 return -EOPNOTSUPP;
Hoang Le02ec6ca2019-03-19 18:49:48 +0700663 }
Richard Alpe670f4f82015-05-06 13:58:55 +0200664
Hoang Le02ec6ca2019-03-19 18:49:48 +0700665 if (props[TIPC_NLA_PROP_BROADCAST]) {
666 bc_mode = nla_get_u32(props[TIPC_NLA_PROP_BROADCAST]);
667 err = tipc_bc_link_set_broadcast_mode(net, bc_mode);
668 }
Richard Alpe670f4f82015-05-06 13:58:55 +0200669
Hoang Le02ec6ca2019-03-19 18:49:48 +0700670 if (!err && props[TIPC_NLA_PROP_BROADCAST_RATIO]) {
671 bc_ratio = nla_get_u32(props[TIPC_NLA_PROP_BROADCAST_RATIO]);
672 err = tipc_bc_link_set_broadcast_ratio(net, bc_ratio);
673 }
674
675 if (!err && props[TIPC_NLA_PROP_WIN]) {
676 win = nla_get_u32(props[TIPC_NLA_PROP_WIN]);
677 err = tipc_bc_link_set_queue_limits(net, win);
678 }
679
680 return err;
Richard Alpe670f4f82015-05-06 13:58:55 +0200681}
682
Jon Paul Maloy6beb19a2015-10-22 08:51:33 -0400683int tipc_bcast_init(struct net *net)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100684{
Jon Paul Maloy32301902015-10-22 08:51:37 -0400685 struct tipc_net *tn = tipc_net(net);
Jon Paul Maloy32301902015-10-22 08:51:37 -0400686 struct tipc_bc_base *bb = NULL;
687 struct tipc_link *l = NULL;
Ying Xue7f9f95d2015-01-09 15:27:06 +0800688
Jia-Ju Baia0732542018-07-27 17:31:35 +0800689 bb = kzalloc(sizeof(*bb), GFP_KERNEL);
Jon Paul Maloy32301902015-10-22 08:51:37 -0400690 if (!bb)
691 goto enomem;
692 tn->bcbase = bb;
Jon Paul Maloy00435502015-10-22 08:51:34 -0400693 spin_lock_init(&tipc_net(net)->bclock);
Jon Paul Maloy5fd9fd62015-10-22 08:51:35 -0400694
Tuong Lien03b6fef2020-05-26 16:38:37 +0700695 if (!tipc_link_bc_create(net, 0, 0, NULL,
Jon Maloy4c94cc22017-11-30 16:47:25 +0100696 FB_MTU,
Jon Paul Maloy32301902015-10-22 08:51:37 -0400697 BCLINK_WIN_DEFAULT,
Jon Maloy16ad3f42019-12-10 00:52:46 +0100698 BCLINK_WIN_DEFAULT,
Jon Paul Maloyfd556f22015-10-22 08:51:40 -0400699 0,
Jon Paul Maloy32301902015-10-22 08:51:37 -0400700 &bb->inputq,
Jon Paul Maloy2af5ae32015-10-22 08:51:48 -0400701 NULL,
Jon Paul Maloy52666982015-10-22 08:51:41 -0400702 NULL,
Jon Paul Maloy32301902015-10-22 08:51:37 -0400703 &l))
704 goto enomem;
705 bb->link = l;
706 tn->bcl = l;
Hoang Le02ec6ca2019-03-19 18:49:48 +0700707 bb->rc_ratio = 10;
Jon Paul Maloy01fd12b2017-01-18 13:50:53 -0500708 bb->rcast_support = true;
Ying Xueeb8b00f2014-05-05 08:56:16 +0800709 return 0;
Jon Paul Maloy32301902015-10-22 08:51:37 -0400710enomem:
Jon Paul Maloy32301902015-10-22 08:51:37 -0400711 kfree(bb);
712 kfree(l);
713 return -ENOMEM;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100714}
715
Jon Paul Maloy6beb19a2015-10-22 08:51:33 -0400716void tipc_bcast_stop(struct net *net)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100717{
Ying Xue7f9f95d2015-01-09 15:27:06 +0800718 struct tipc_net *tn = net_generic(net, tipc_net_id);
719
Ying Xueeb8b00f2014-05-05 08:56:16 +0800720 synchronize_net();
Jon Paul Maloy6beb19a2015-10-22 08:51:33 -0400721 kfree(tn->bcbase);
Jon Paul Maloy32301902015-10-22 08:51:37 -0400722 kfree(tn->bcl);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100723}
Jon Paul Maloy2ae0b8a2017-01-18 13:50:51 -0500724
725void tipc_nlist_init(struct tipc_nlist *nl, u32 self)
726{
727 memset(nl, 0, sizeof(*nl));
728 INIT_LIST_HEAD(&nl->list);
729 nl->self = self;
730}
731
732void tipc_nlist_add(struct tipc_nlist *nl, u32 node)
733{
734 if (node == nl->self)
735 nl->local = true;
Jon Maloya80ae532017-10-13 11:04:22 +0200736 else if (tipc_dest_push(&nl->list, node, 0))
Jon Paul Maloy2ae0b8a2017-01-18 13:50:51 -0500737 nl->remote++;
738}
739
740void tipc_nlist_del(struct tipc_nlist *nl, u32 node)
741{
742 if (node == nl->self)
743 nl->local = false;
Jon Maloya80ae532017-10-13 11:04:22 +0200744 else if (tipc_dest_del(&nl->list, node, 0))
Jon Paul Maloy2ae0b8a2017-01-18 13:50:51 -0500745 nl->remote--;
746}
747
748void tipc_nlist_purge(struct tipc_nlist *nl)
749{
Jon Maloya80ae532017-10-13 11:04:22 +0200750 tipc_dest_list_purge(&nl->list);
Jon Paul Maloy2ae0b8a2017-01-18 13:50:51 -0500751 nl->remote = 0;
Gustavo A. R. Silvac9efb152018-03-05 15:56:14 -0600752 nl->local = false;
Jon Paul Maloy2ae0b8a2017-01-18 13:50:51 -0500753}
Hoang Le02ec6ca2019-03-19 18:49:48 +0700754
755u32 tipc_bcast_get_broadcast_mode(struct net *net)
756{
757 struct tipc_bc_base *bb = tipc_bc_base(net);
758
759 if (bb->force_bcast)
760 return BCLINK_MODE_BCAST;
761
762 if (bb->force_rcast)
763 return BCLINK_MODE_RCAST;
764
765 if (bb->bcast_support && bb->rcast_support)
766 return BCLINK_MODE_SEL;
767
768 return 0;
769}
770
771u32 tipc_bcast_get_broadcast_ratio(struct net *net)
772{
773 struct tipc_bc_base *bb = tipc_bc_base(net);
774
775 return bb->rc_ratio;
776}
Hoang Lec55c8ed2019-03-19 18:49:50 +0700777
Hoang Le08e046c2019-03-21 17:25:18 +0700778void tipc_mcast_filter_msg(struct net *net, struct sk_buff_head *defq,
Hoang Lec55c8ed2019-03-19 18:49:50 +0700779 struct sk_buff_head *inputq)
780{
781 struct sk_buff *skb, *_skb, *tmp;
782 struct tipc_msg *hdr, *_hdr;
783 bool match = false;
784 u32 node, port;
785
786 skb = skb_peek(inputq);
Hoang Lee1279ff2019-04-03 13:05:04 +0700787 if (!skb)
788 return;
789
Hoang Lec55c8ed2019-03-19 18:49:50 +0700790 hdr = buf_msg(skb);
791
792 if (likely(!msg_is_syn(hdr) && skb_queue_empty(defq)))
793 return;
794
795 node = msg_orignode(hdr);
Hoang Le08e046c2019-03-21 17:25:18 +0700796 if (node == tipc_own_addr(net))
797 return;
798
Hoang Lec55c8ed2019-03-19 18:49:50 +0700799 port = msg_origport(hdr);
800
801 /* Has the twin SYN message already arrived ? */
802 skb_queue_walk(defq, _skb) {
803 _hdr = buf_msg(_skb);
804 if (msg_orignode(_hdr) != node)
805 continue;
806 if (msg_origport(_hdr) != port)
807 continue;
808 match = true;
809 break;
810 }
811
812 if (!match) {
813 if (!msg_is_syn(hdr))
814 return;
815 __skb_dequeue(inputq);
816 __skb_queue_tail(defq, skb);
817 return;
818 }
819
820 /* Deliver non-SYN message from other link, otherwise queue it */
821 if (!msg_is_syn(hdr)) {
822 if (msg_is_rcast(hdr) != msg_is_rcast(_hdr))
823 return;
824 __skb_dequeue(inputq);
825 __skb_queue_tail(defq, skb);
826 return;
827 }
828
829 /* Queue non-SYN/SYN message from same link */
830 if (msg_is_rcast(hdr) == msg_is_rcast(_hdr)) {
831 __skb_dequeue(inputq);
832 __skb_queue_tail(defq, skb);
833 return;
834 }
835
836 /* Matching SYN messages => return the one with data, if any */
837 __skb_unlink(_skb, defq);
838 if (msg_data_sz(hdr)) {
839 kfree_skb(_skb);
840 } else {
841 __skb_dequeue(inputq);
842 kfree_skb(skb);
843 __skb_queue_tail(inputq, _skb);
844 }
845
846 /* Deliver subsequent non-SYN messages from same peer */
847 skb_queue_walk_safe(defq, _skb, tmp) {
848 _hdr = buf_msg(_skb);
849 if (msg_orignode(_hdr) != node)
850 continue;
851 if (msg_origport(_hdr) != port)
852 continue;
853 if (msg_is_syn(_hdr))
854 break;
855 __skb_unlink(_skb, defq);
856 __skb_queue_tail(inputq, _skb);
857 }
858}