blob: 6cf7938784c64d972befb2a8c5acdd89996d3be3 [file] [log] [blame]
Per Lidenb97bf3f2006-01-02 19:04:38 +01001/*
2 * net/tipc/link.c: TIPC link code
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09003 *
Jon Paul Maloy170b3922014-01-07 17:02:41 -05004 * Copyright (c) 1996-2007, 2012-2014, Ericsson AB
Ying Xue198d73b2013-06-17 10:54:42 -04005 * Copyright (c) 2004-2007, 2010-2013, 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"
Per Lidenb97bf3f2006-01-02 19:04:38 +010038#include "link.h"
Per Lidenb97bf3f2006-01-02 19:04:38 +010039#include "port.h"
Per Lidenb97bf3f2006-01-02 19:04:38 +010040#include "name_distr.h"
Per Lidenb97bf3f2006-01-02 19:04:38 +010041#include "discover.h"
42#include "config.h"
Per Lidenb97bf3f2006-01-02 19:04:38 +010043
Ying Xue796c75d2013-06-17 10:54:48 -040044#include <linux/pkt_sched.h>
45
Erik Hugne2cf8aa12012-06-29 00:16:37 -040046/*
47 * Error message prefixes
48 */
49static const char *link_co_err = "Link changeover error, ";
50static const char *link_rst_msg = "Resetting link ";
51static const char *link_unk_evt = "Unknown link event ";
Per Lidenb97bf3f2006-01-02 19:04:38 +010052
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +090053/*
Allan Stephensa686e682008-06-04 17:29:39 -070054 * Out-of-range value for link session numbers
55 */
Allan Stephensa686e682008-06-04 17:29:39 -070056#define INVALID_SESSION 0x10000
57
58/*
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +090059 * Link state events:
Per Lidenb97bf3f2006-01-02 19:04:38 +010060 */
Per Lidenb97bf3f2006-01-02 19:04:38 +010061#define STARTING_EVT 856384768 /* link processing trigger */
62#define TRAFFIC_MSG_EVT 560815u /* rx'd ??? */
63#define TIMEOUT_EVT 560817u /* link timer expired */
64
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +090065/*
66 * The following two 'message types' is really just implementation
67 * data conveniently stored in the message header.
Per Lidenb97bf3f2006-01-02 19:04:38 +010068 * They must not be considered part of the protocol
69 */
70#define OPEN_MSG 0
71#define CLOSED_MSG 1
72
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +090073/*
Per Lidenb97bf3f2006-01-02 19:04:38 +010074 * State value stored in 'exp_msg_count'
75 */
Per Lidenb97bf3f2006-01-02 19:04:38 +010076#define START_CHANGEOVER 100000u
77
Paul Gortmakera18c4bc2011-12-29 20:58:42 -050078static void link_handle_out_of_seq_msg(struct tipc_link *l_ptr,
Per Lidenb97bf3f2006-01-02 19:04:38 +010079 struct sk_buff *buf);
Ying Xue247f0f32014-02-18 16:06:46 +080080static void tipc_link_proto_rcv(struct tipc_link *l_ptr, struct sk_buff *buf);
Jon Paul Maloy3bb53382014-02-13 17:29:12 -050081static int tipc_link_tunnel_rcv(struct tipc_node *n_ptr,
Jon Paul Maloy170b3922014-01-07 17:02:41 -050082 struct sk_buff **buf);
Paul Gortmakera18c4bc2011-12-29 20:58:42 -050083static void link_set_supervision_props(struct tipc_link *l_ptr, u32 tolerance);
Ying Xue247f0f32014-02-18 16:06:46 +080084static int tipc_link_iovec_long_xmit(struct tipc_port *sender,
85 struct iovec const *msg_sect,
86 unsigned int len, u32 destnode);
Paul Gortmakera18c4bc2011-12-29 20:58:42 -050087static void link_state_event(struct tipc_link *l_ptr, u32 event);
88static void link_reset_statistics(struct tipc_link *l_ptr);
89static void link_print(struct tipc_link *l_ptr, const char *str);
Ying Xue247f0f32014-02-18 16:06:46 +080090static int tipc_link_frag_xmit(struct tipc_link *l_ptr, struct sk_buff *buf);
91static void tipc_link_sync_xmit(struct tipc_link *l);
92static void tipc_link_sync_rcv(struct tipc_node *n, struct sk_buff *buf);
stephen hemminger31e3c3f2010-10-13 13:20:35 +000093
Per Lidenb97bf3f2006-01-02 19:04:38 +010094/*
Sam Ravnborg05790c62006-03-20 22:37:04 -080095 * Simple link routines
Per Lidenb97bf3f2006-01-02 19:04:38 +010096 */
Sam Ravnborg05790c62006-03-20 22:37:04 -080097static unsigned int align(unsigned int i)
Per Lidenb97bf3f2006-01-02 19:04:38 +010098{
99 return (i + 3) & ~3u;
100}
101
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500102static void link_init_max_pkt(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100103{
Ying Xue7a2f7d12014-04-21 10:55:46 +0800104 struct tipc_bearer *b_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100105 u32 max_pkt;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900106
Ying Xue7a2f7d12014-04-21 10:55:46 +0800107 rcu_read_lock();
108 b_ptr = rcu_dereference_rtnl(bearer_list[l_ptr->bearer_id]);
109 if (!b_ptr) {
110 rcu_read_unlock();
111 return;
112 }
113 max_pkt = (b_ptr->mtu & ~3);
114 rcu_read_unlock();
115
Per Lidenb97bf3f2006-01-02 19:04:38 +0100116 if (max_pkt > MAX_MSG_SIZE)
117 max_pkt = MAX_MSG_SIZE;
118
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900119 l_ptr->max_pkt_target = max_pkt;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100120 if (l_ptr->max_pkt_target < MAX_PKT_DEFAULT)
121 l_ptr->max_pkt = l_ptr->max_pkt_target;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900122 else
Per Lidenb97bf3f2006-01-02 19:04:38 +0100123 l_ptr->max_pkt = MAX_PKT_DEFAULT;
124
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900125 l_ptr->max_pkt_probes = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100126}
127
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500128static u32 link_next_sent(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100129{
130 if (l_ptr->next_out)
Allan Stephensf9057302011-10-24 16:03:12 -0400131 return buf_seqno(l_ptr->next_out);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100132 return mod(l_ptr->next_out_no);
133}
134
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500135static u32 link_last_sent(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100136{
137 return mod(link_next_sent(l_ptr) - 1);
138}
139
140/*
Sam Ravnborg05790c62006-03-20 22:37:04 -0800141 * Simple non-static link routines (i.e. referenced outside this file)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100142 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500143int tipc_link_is_up(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100144{
145 if (!l_ptr)
146 return 0;
Eric Dumazeta02cec22010-09-22 20:43:57 +0000147 return link_working_working(l_ptr) || link_working_unknown(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100148}
149
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500150int tipc_link_is_active(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100151{
Eric Dumazeta02cec22010-09-22 20:43:57 +0000152 return (l_ptr->owner->active_links[0] == l_ptr) ||
153 (l_ptr->owner->active_links[1] == l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100154}
155
156/**
Per Lidenb97bf3f2006-01-02 19:04:38 +0100157 * link_timeout - handle expiration of link timer
158 * @l_ptr: pointer to link
Per Lidenb97bf3f2006-01-02 19:04:38 +0100159 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500160static void link_timeout(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100161{
Per Liden4323add2006-01-18 00:38:21 +0100162 tipc_node_lock(l_ptr->owner);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100163
164 /* update counters used in statistical profiling of send traffic */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100165 l_ptr->stats.accu_queue_sz += l_ptr->out_queue_size;
166 l_ptr->stats.queue_sz_counts++;
167
Per Lidenb97bf3f2006-01-02 19:04:38 +0100168 if (l_ptr->first_out) {
169 struct tipc_msg *msg = buf_msg(l_ptr->first_out);
170 u32 length = msg_size(msg);
171
Joe Perchesf64f9e72009-11-29 16:55:45 -0800172 if ((msg_user(msg) == MSG_FRAGMENTER) &&
173 (msg_type(msg) == FIRST_FRAGMENT)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100174 length = msg_size(msg_get_wrapped(msg));
175 }
176 if (length) {
177 l_ptr->stats.msg_lengths_total += length;
178 l_ptr->stats.msg_length_counts++;
179 if (length <= 64)
180 l_ptr->stats.msg_length_profile[0]++;
181 else if (length <= 256)
182 l_ptr->stats.msg_length_profile[1]++;
183 else if (length <= 1024)
184 l_ptr->stats.msg_length_profile[2]++;
185 else if (length <= 4096)
186 l_ptr->stats.msg_length_profile[3]++;
187 else if (length <= 16384)
188 l_ptr->stats.msg_length_profile[4]++;
189 else if (length <= 32768)
190 l_ptr->stats.msg_length_profile[5]++;
191 else
192 l_ptr->stats.msg_length_profile[6]++;
193 }
194 }
195
196 /* do all other link processing performed on a periodic basis */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100197
198 link_state_event(l_ptr, TIMEOUT_EVT);
199
200 if (l_ptr->next_out)
Per Liden4323add2006-01-18 00:38:21 +0100201 tipc_link_push_queue(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100202
Per Liden4323add2006-01-18 00:38:21 +0100203 tipc_node_unlock(l_ptr->owner);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100204}
205
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500206static void link_set_timer(struct tipc_link *l_ptr, u32 time)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100207{
208 k_start_timer(&l_ptr->timer, time);
209}
210
211/**
Per Liden4323add2006-01-18 00:38:21 +0100212 * tipc_link_create - create a new link
Allan Stephens37b9c082011-02-28 11:32:27 -0500213 * @n_ptr: pointer to associated node
Per Lidenb97bf3f2006-01-02 19:04:38 +0100214 * @b_ptr: pointer to associated bearer
Per Lidenb97bf3f2006-01-02 19:04:38 +0100215 * @media_addr: media address to use when sending messages over link
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900216 *
Per Lidenb97bf3f2006-01-02 19:04:38 +0100217 * Returns pointer to link.
218 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500219struct tipc_link *tipc_link_create(struct tipc_node *n_ptr,
Ying Xuec61dd612014-02-13 17:29:09 -0500220 struct tipc_bearer *b_ptr,
221 const struct tipc_media_addr *media_addr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100222{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500223 struct tipc_link *l_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100224 struct tipc_msg *msg;
225 char *if_name;
Allan Stephens37b9c082011-02-28 11:32:27 -0500226 char addr_string[16];
227 u32 peer = n_ptr->addr;
228
229 if (n_ptr->link_cnt >= 2) {
230 tipc_addr_string_fill(addr_string, n_ptr->addr);
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400231 pr_err("Attempt to establish third link to %s\n", addr_string);
Allan Stephens37b9c082011-02-28 11:32:27 -0500232 return NULL;
233 }
234
235 if (n_ptr->links[b_ptr->identity]) {
236 tipc_addr_string_fill(addr_string, n_ptr->addr);
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400237 pr_err("Attempt to establish second link on <%s> to %s\n",
238 b_ptr->name, addr_string);
Allan Stephens37b9c082011-02-28 11:32:27 -0500239 return NULL;
240 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100241
Panagiotis Issaris0da974f2006-07-21 14:51:30 -0700242 l_ptr = kzalloc(sizeof(*l_ptr), GFP_ATOMIC);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100243 if (!l_ptr) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400244 pr_warn("Link creation failed, no memory\n");
Per Lidenb97bf3f2006-01-02 19:04:38 +0100245 return NULL;
246 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100247
248 l_ptr->addr = peer;
Allan Stephens2d627b92011-01-07 13:00:11 -0500249 if_name = strchr(b_ptr->name, ':') + 1;
Allan Stephens062b4c92011-04-07 09:28:47 -0400250 sprintf(l_ptr->name, "%u.%u.%u:%s-%u.%u.%u:unknown",
Per Lidenb97bf3f2006-01-02 19:04:38 +0100251 tipc_zone(tipc_own_addr), tipc_cluster(tipc_own_addr),
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900252 tipc_node(tipc_own_addr),
Per Lidenb97bf3f2006-01-02 19:04:38 +0100253 if_name,
254 tipc_zone(peer), tipc_cluster(peer), tipc_node(peer));
Allan Stephens062b4c92011-04-07 09:28:47 -0400255 /* note: peer i/f name is updated by reset/activate message */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100256 memcpy(&l_ptr->media_addr, media_addr, sizeof(*media_addr));
Allan Stephens37b9c082011-02-28 11:32:27 -0500257 l_ptr->owner = n_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100258 l_ptr->checkpoint = 1;
Allan Stephensf882cb72011-04-07 09:43:27 -0400259 l_ptr->peer_session = INVALID_SESSION;
Ying Xue7a2f7d12014-04-21 10:55:46 +0800260 l_ptr->bearer_id = b_ptr->identity;
Allan Stephens5c216e12011-10-18 11:34:29 -0400261 link_set_supervision_props(l_ptr, b_ptr->tolerance);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100262 l_ptr->state = RESET_UNKNOWN;
263
264 l_ptr->pmsg = (struct tipc_msg *)&l_ptr->proto_msg;
265 msg = l_ptr->pmsg;
Allan Stephensc68ca7b2010-05-11 14:30:12 +0000266 tipc_msg_init(msg, LINK_PROTOCOL, RESET_MSG, INT_H_SIZE, l_ptr->addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100267 msg_set_size(msg, sizeof(l_ptr->proto_msg));
Allan Stephensa686e682008-06-04 17:29:39 -0700268 msg_set_session(msg, (tipc_random & 0xffff));
Per Lidenb97bf3f2006-01-02 19:04:38 +0100269 msg_set_bearer_id(msg, b_ptr->identity);
270 strcpy((char *)msg_data(msg), if_name);
271
272 l_ptr->priority = b_ptr->priority;
Allan Stephens5c216e12011-10-18 11:34:29 -0400273 tipc_link_set_queue_limits(l_ptr, b_ptr->window);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100274
Ying Xue7a2f7d12014-04-21 10:55:46 +0800275 l_ptr->net_plane = b_ptr->net_plane;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100276 link_init_max_pkt(l_ptr);
277
278 l_ptr->next_out_no = 1;
279 INIT_LIST_HEAD(&l_ptr->waiting_ports);
280
281 link_reset_statistics(l_ptr);
282
Allan Stephens37b9c082011-02-28 11:32:27 -0500283 tipc_node_attach_link(n_ptr, l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100284
Jon Paul Maloy170b3922014-01-07 17:02:41 -0500285 k_init_timer(&l_ptr->timer, (Handler)link_timeout,
286 (unsigned long)l_ptr);
Jon Paul Maloy581465f2014-01-07 17:02:44 -0500287
288 link_state_event(l_ptr, STARTING_EVT);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100289
Per Lidenb97bf3f2006-01-02 19:04:38 +0100290 return l_ptr;
291}
292
Jon Paul Maloy7d339392014-02-13 17:29:16 -0500293void tipc_link_delete_list(unsigned int bearer_id, bool shutting_down)
Ying Xue8d8439b2014-02-13 17:29:07 -0500294{
295 struct tipc_link *l_ptr;
Ying Xuec61dd612014-02-13 17:29:09 -0500296 struct tipc_node *n_ptr;
Ying Xue8d8439b2014-02-13 17:29:07 -0500297
Ying Xue6c7a7622014-03-27 12:54:37 +0800298 rcu_read_lock();
299 list_for_each_entry_rcu(n_ptr, &tipc_node_list, list) {
Ying Xue5356f3d2014-05-05 08:56:09 +0800300 tipc_node_lock(n_ptr);
Ying Xuec61dd612014-02-13 17:29:09 -0500301 l_ptr = n_ptr->links[bearer_id];
302 if (l_ptr) {
303 tipc_link_reset(l_ptr);
Jon Paul Maloy7d339392014-02-13 17:29:16 -0500304 if (shutting_down || !tipc_node_is_up(n_ptr)) {
305 tipc_node_detach_link(l_ptr->owner, l_ptr);
306 tipc_link_reset_fragments(l_ptr);
Ying Xue5356f3d2014-05-05 08:56:09 +0800307 tipc_node_unlock(n_ptr);
Ying Xuec61dd612014-02-13 17:29:09 -0500308
Jon Paul Maloy7d339392014-02-13 17:29:16 -0500309 /* Nobody else can access this link now: */
310 del_timer_sync(&l_ptr->timer);
311 kfree(l_ptr);
312 } else {
313 /* Detach/delete when failover is finished: */
314 l_ptr->flags |= LINK_STOPPED;
Ying Xue5356f3d2014-05-05 08:56:09 +0800315 tipc_node_unlock(n_ptr);
Jon Paul Maloy7d339392014-02-13 17:29:16 -0500316 del_timer_sync(&l_ptr->timer);
317 }
Ying Xuec61dd612014-02-13 17:29:09 -0500318 continue;
319 }
Ying Xue5356f3d2014-05-05 08:56:09 +0800320 tipc_node_unlock(n_ptr);
Ying Xue8d8439b2014-02-13 17:29:07 -0500321 }
Ying Xue6c7a7622014-03-27 12:54:37 +0800322 rcu_read_unlock();
Ying Xue8d8439b2014-02-13 17:29:07 -0500323}
Per Lidenb97bf3f2006-01-02 19:04:38 +0100324
325/**
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900326 * link_schedule_port - schedule port for deferred sending
Per Lidenb97bf3f2006-01-02 19:04:38 +0100327 * @l_ptr: pointer to link
328 * @origport: reference to sending port
329 * @sz: amount of data to be sent
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900330 *
331 * Schedules port for renewed sending of messages after link congestion
Per Lidenb97bf3f2006-01-02 19:04:38 +0100332 * has abated.
333 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500334static int link_schedule_port(struct tipc_link *l_ptr, u32 origport, u32 sz)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100335{
Allan Stephens23dd4cc2011-01-07 11:43:40 -0500336 struct tipc_port *p_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100337
Per Liden4323add2006-01-18 00:38:21 +0100338 spin_lock_bh(&tipc_port_list_lock);
339 p_ptr = tipc_port_lock(origport);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100340 if (p_ptr) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100341 if (!list_empty(&p_ptr->wait_list))
342 goto exit;
Allan Stephens23dd4cc2011-01-07 11:43:40 -0500343 p_ptr->congested = 1;
Allan Stephens15e979d2010-05-11 14:30:10 +0000344 p_ptr->waiting_pkts = 1 + ((sz - 1) / l_ptr->max_pkt);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100345 list_add_tail(&p_ptr->wait_list, &l_ptr->waiting_ports);
346 l_ptr->stats.link_congs++;
347exit:
Per Liden4323add2006-01-18 00:38:21 +0100348 tipc_port_unlock(p_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100349 }
Per Liden4323add2006-01-18 00:38:21 +0100350 spin_unlock_bh(&tipc_port_list_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100351 return -ELINKCONG;
352}
353
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500354void tipc_link_wakeup_ports(struct tipc_link *l_ptr, int all)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100355{
Allan Stephens23dd4cc2011-01-07 11:43:40 -0500356 struct tipc_port *p_ptr;
357 struct tipc_port *temp_p_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100358 int win = l_ptr->queue_limit[0] - l_ptr->out_queue_size;
359
360 if (all)
361 win = 100000;
362 if (win <= 0)
363 return;
Per Liden4323add2006-01-18 00:38:21 +0100364 if (!spin_trylock_bh(&tipc_port_list_lock))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100365 return;
366 if (link_congested(l_ptr))
367 goto exit;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900368 list_for_each_entry_safe(p_ptr, temp_p_ptr, &l_ptr->waiting_ports,
Per Lidenb97bf3f2006-01-02 19:04:38 +0100369 wait_list) {
370 if (win <= 0)
371 break;
372 list_del_init(&p_ptr->wait_list);
Allan Stephens23dd4cc2011-01-07 11:43:40 -0500373 spin_lock_bh(p_ptr->lock);
374 p_ptr->congested = 0;
Jon Paul Maloy24be34b2014-03-12 11:31:10 -0400375 tipc_port_wakeup(p_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100376 win -= p_ptr->waiting_pkts;
Allan Stephens23dd4cc2011-01-07 11:43:40 -0500377 spin_unlock_bh(p_ptr->lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100378 }
379
380exit:
Per Liden4323add2006-01-18 00:38:21 +0100381 spin_unlock_bh(&tipc_port_list_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100382}
383
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900384/**
Per Lidenb97bf3f2006-01-02 19:04:38 +0100385 * link_release_outqueue - purge link's outbound message queue
386 * @l_ptr: pointer to link
387 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500388static void link_release_outqueue(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100389{
Ying Xued77b3832013-12-10 20:45:38 -0800390 kfree_skb_list(l_ptr->first_out);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100391 l_ptr->first_out = NULL;
392 l_ptr->out_queue_size = 0;
393}
394
395/**
Per Liden4323add2006-01-18 00:38:21 +0100396 * tipc_link_reset_fragments - purge link's inbound message fragments queue
Per Lidenb97bf3f2006-01-02 19:04:38 +0100397 * @l_ptr: pointer to link
398 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500399void tipc_link_reset_fragments(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100400{
Erik Hugne40ba3cd2013-11-06 09:28:06 +0100401 kfree_skb(l_ptr->reasm_head);
402 l_ptr->reasm_head = NULL;
403 l_ptr->reasm_tail = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100404}
405
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900406/**
Jon Paul Maloy581465f2014-01-07 17:02:44 -0500407 * tipc_link_purge_queues - purge all pkt queues associated with link
Per Lidenb97bf3f2006-01-02 19:04:38 +0100408 * @l_ptr: pointer to link
409 */
Jon Paul Maloy581465f2014-01-07 17:02:44 -0500410void tipc_link_purge_queues(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100411{
Ying Xued77b3832013-12-10 20:45:38 -0800412 kfree_skb_list(l_ptr->oldest_deferred_in);
413 kfree_skb_list(l_ptr->first_out);
Per Liden4323add2006-01-18 00:38:21 +0100414 tipc_link_reset_fragments(l_ptr);
Allan Stephens5f6d9122011-11-04 13:24:29 -0400415 kfree_skb(l_ptr->proto_msg_queue);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100416 l_ptr->proto_msg_queue = NULL;
417}
418
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500419void tipc_link_reset(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100420{
Per Lidenb97bf3f2006-01-02 19:04:38 +0100421 u32 prev_state = l_ptr->state;
422 u32 checkpoint = l_ptr->next_in_no;
Allan Stephens5392d642006-06-25 23:52:50 -0700423 int was_active_link = tipc_link_is_active(l_ptr);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900424
Allan Stephensa686e682008-06-04 17:29:39 -0700425 msg_set_session(l_ptr->pmsg, ((msg_session(l_ptr->pmsg) + 1) & 0xffff));
Per Lidenb97bf3f2006-01-02 19:04:38 +0100426
Allan Stephensa686e682008-06-04 17:29:39 -0700427 /* Link is down, accept any session */
428 l_ptr->peer_session = INVALID_SESSION;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100429
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900430 /* Prepare for max packet size negotiation */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100431 link_init_max_pkt(l_ptr);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900432
Per Lidenb97bf3f2006-01-02 19:04:38 +0100433 l_ptr->state = RESET_UNKNOWN;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100434
435 if ((prev_state == RESET_UNKNOWN) || (prev_state == RESET_RESET))
436 return;
437
Per Liden4323add2006-01-18 00:38:21 +0100438 tipc_node_link_down(l_ptr->owner, l_ptr);
Ying Xue7a2f7d12014-04-21 10:55:46 +0800439 tipc_bearer_remove_dest(l_ptr->bearer_id, l_ptr->addr);
Paul Gortmaker7368ddf2010-10-12 14:25:58 +0000440
Jon Paul Maloyb9d4c332014-01-07 17:02:42 -0500441 if (was_active_link && tipc_node_active_links(l_ptr->owner)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100442 l_ptr->reset_checkpoint = checkpoint;
443 l_ptr->exp_msg_count = START_CHANGEOVER;
444 }
445
446 /* Clean up all queues: */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100447 link_release_outqueue(l_ptr);
Allan Stephens5f6d9122011-11-04 13:24:29 -0400448 kfree_skb(l_ptr->proto_msg_queue);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100449 l_ptr->proto_msg_queue = NULL;
Ying Xued77b3832013-12-10 20:45:38 -0800450 kfree_skb_list(l_ptr->oldest_deferred_in);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100451 if (!list_empty(&l_ptr->waiting_ports))
Per Liden4323add2006-01-18 00:38:21 +0100452 tipc_link_wakeup_ports(l_ptr, 1);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100453
454 l_ptr->retransm_queue_head = 0;
455 l_ptr->retransm_queue_size = 0;
456 l_ptr->last_out = NULL;
457 l_ptr->first_out = NULL;
458 l_ptr->next_out = NULL;
459 l_ptr->unacked_window = 0;
460 l_ptr->checkpoint = 1;
461 l_ptr->next_out_no = 1;
462 l_ptr->deferred_inqueue_sz = 0;
463 l_ptr->oldest_deferred_in = NULL;
464 l_ptr->newest_deferred_in = NULL;
465 l_ptr->fsm_msg_cnt = 0;
466 l_ptr->stale_count = 0;
467 link_reset_statistics(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100468}
469
Ying Xuec61dd612014-02-13 17:29:09 -0500470void tipc_link_reset_list(unsigned int bearer_id)
Ying Xuee0ca2c32014-02-13 17:29:06 -0500471{
472 struct tipc_link *l_ptr;
Ying Xuec61dd612014-02-13 17:29:09 -0500473 struct tipc_node *n_ptr;
Ying Xuee0ca2c32014-02-13 17:29:06 -0500474
Ying Xue6c7a7622014-03-27 12:54:37 +0800475 rcu_read_lock();
476 list_for_each_entry_rcu(n_ptr, &tipc_node_list, list) {
Ying Xue5356f3d2014-05-05 08:56:09 +0800477 tipc_node_lock(n_ptr);
Ying Xuec61dd612014-02-13 17:29:09 -0500478 l_ptr = n_ptr->links[bearer_id];
479 if (l_ptr)
480 tipc_link_reset(l_ptr);
Ying Xue5356f3d2014-05-05 08:56:09 +0800481 tipc_node_unlock(n_ptr);
Ying Xuee0ca2c32014-02-13 17:29:06 -0500482 }
Ying Xue6c7a7622014-03-27 12:54:37 +0800483 rcu_read_unlock();
Ying Xuee0ca2c32014-02-13 17:29:06 -0500484}
Per Lidenb97bf3f2006-01-02 19:04:38 +0100485
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500486static void link_activate(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100487{
Allan Stephens5392d642006-06-25 23:52:50 -0700488 l_ptr->next_in_no = l_ptr->stats.recv_info = 1;
Per Liden4323add2006-01-18 00:38:21 +0100489 tipc_node_link_up(l_ptr->owner, l_ptr);
Ying Xue7a2f7d12014-04-21 10:55:46 +0800490 tipc_bearer_add_dest(l_ptr->bearer_id, l_ptr->addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100491}
492
493/**
494 * link_state_event - link finite state machine
495 * @l_ptr: pointer to link
496 * @event: state machine event to process
497 */
Eric Dumazet95c96172012-04-15 05:58:06 +0000498static void link_state_event(struct tipc_link *l_ptr, unsigned int event)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100499{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500500 struct tipc_link *other;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100501 u32 cont_intv = l_ptr->continuity_interval;
502
Jon Paul Maloy7d339392014-02-13 17:29:16 -0500503 if (l_ptr->flags & LINK_STOPPED)
504 return;
505
Ying Xue135daee2014-02-13 17:29:08 -0500506 if (!(l_ptr->flags & LINK_STARTED) && (event != STARTING_EVT))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100507 return; /* Not yet. */
508
Ying Xue77a7e072013-12-10 20:45:44 -0800509 /* Check whether changeover is going on */
510 if (l_ptr->exp_msg_count) {
Allan Stephensa0168922010-12-31 18:59:35 +0000511 if (event == TIMEOUT_EVT)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100512 link_set_timer(l_ptr, cont_intv);
Ying Xue77a7e072013-12-10 20:45:44 -0800513 return;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100514 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100515
516 switch (l_ptr->state) {
517 case WORKING_WORKING:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100518 switch (event) {
519 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100520 case ACTIVATE_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100521 break;
522 case TIMEOUT_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100523 if (l_ptr->next_in_no != l_ptr->checkpoint) {
524 l_ptr->checkpoint = l_ptr->next_in_no;
Per Liden4323add2006-01-18 00:38:21 +0100525 if (tipc_bclink_acks_missing(l_ptr->owner)) {
Ying Xue247f0f32014-02-18 16:06:46 +0800526 tipc_link_proto_xmit(l_ptr, STATE_MSG,
527 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100528 l_ptr->fsm_msg_cnt++;
529 } else if (l_ptr->max_pkt < l_ptr->max_pkt_target) {
Ying Xue247f0f32014-02-18 16:06:46 +0800530 tipc_link_proto_xmit(l_ptr, STATE_MSG,
531 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100532 l_ptr->fsm_msg_cnt++;
533 }
534 link_set_timer(l_ptr, cont_intv);
535 break;
536 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100537 l_ptr->state = WORKING_UNKNOWN;
538 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800539 tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100540 l_ptr->fsm_msg_cnt++;
541 link_set_timer(l_ptr, cont_intv / 4);
542 break;
543 case RESET_MSG:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400544 pr_info("%s<%s>, requested by peer\n", link_rst_msg,
545 l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100546 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100547 l_ptr->state = RESET_RESET;
548 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800549 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
550 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100551 l_ptr->fsm_msg_cnt++;
552 link_set_timer(l_ptr, cont_intv);
553 break;
554 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400555 pr_err("%s%u in WW state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100556 }
557 break;
558 case WORKING_UNKNOWN:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100559 switch (event) {
560 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100561 case ACTIVATE_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100562 l_ptr->state = WORKING_WORKING;
563 l_ptr->fsm_msg_cnt = 0;
564 link_set_timer(l_ptr, cont_intv);
565 break;
566 case RESET_MSG:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400567 pr_info("%s<%s>, requested by peer while probing\n",
568 link_rst_msg, l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100569 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100570 l_ptr->state = RESET_RESET;
571 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800572 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
573 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100574 l_ptr->fsm_msg_cnt++;
575 link_set_timer(l_ptr, cont_intv);
576 break;
577 case TIMEOUT_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100578 if (l_ptr->next_in_no != l_ptr->checkpoint) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100579 l_ptr->state = WORKING_WORKING;
580 l_ptr->fsm_msg_cnt = 0;
581 l_ptr->checkpoint = l_ptr->next_in_no;
Per Liden4323add2006-01-18 00:38:21 +0100582 if (tipc_bclink_acks_missing(l_ptr->owner)) {
Ying Xue247f0f32014-02-18 16:06:46 +0800583 tipc_link_proto_xmit(l_ptr, STATE_MSG,
584 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100585 l_ptr->fsm_msg_cnt++;
586 }
587 link_set_timer(l_ptr, cont_intv);
588 } else if (l_ptr->fsm_msg_cnt < l_ptr->abort_limit) {
Ying Xue247f0f32014-02-18 16:06:46 +0800589 tipc_link_proto_xmit(l_ptr, STATE_MSG,
590 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100591 l_ptr->fsm_msg_cnt++;
592 link_set_timer(l_ptr, cont_intv / 4);
593 } else { /* Link has failed */
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400594 pr_warn("%s<%s>, peer not responding\n",
595 link_rst_msg, l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100596 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100597 l_ptr->state = RESET_UNKNOWN;
598 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800599 tipc_link_proto_xmit(l_ptr, RESET_MSG,
600 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100601 l_ptr->fsm_msg_cnt++;
602 link_set_timer(l_ptr, cont_intv);
603 }
604 break;
605 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400606 pr_err("%s%u in WU state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100607 }
608 break;
609 case RESET_UNKNOWN:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100610 switch (event) {
611 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100612 break;
613 case ACTIVATE_MSG:
614 other = l_ptr->owner->active_links[0];
Allan Stephens8d64a5b2010-12-31 18:59:27 +0000615 if (other && link_working_unknown(other))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100616 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100617 l_ptr->state = WORKING_WORKING;
618 l_ptr->fsm_msg_cnt = 0;
619 link_activate(l_ptr);
Ying Xue247f0f32014-02-18 16:06:46 +0800620 tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100621 l_ptr->fsm_msg_cnt++;
Jon Maloyc64f7a62012-11-16 13:51:31 +0800622 if (l_ptr->owner->working_links == 1)
Ying Xue247f0f32014-02-18 16:06:46 +0800623 tipc_link_sync_xmit(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100624 link_set_timer(l_ptr, cont_intv);
625 break;
626 case RESET_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100627 l_ptr->state = RESET_RESET;
628 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800629 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
630 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100631 l_ptr->fsm_msg_cnt++;
632 link_set_timer(l_ptr, cont_intv);
633 break;
634 case STARTING_EVT:
Ying Xue135daee2014-02-13 17:29:08 -0500635 l_ptr->flags |= LINK_STARTED;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100636 /* fall through */
637 case TIMEOUT_EVT:
Ying Xue247f0f32014-02-18 16:06:46 +0800638 tipc_link_proto_xmit(l_ptr, RESET_MSG, 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100639 l_ptr->fsm_msg_cnt++;
640 link_set_timer(l_ptr, cont_intv);
641 break;
642 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400643 pr_err("%s%u in RU state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100644 }
645 break;
646 case RESET_RESET:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100647 switch (event) {
648 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100649 case ACTIVATE_MSG:
650 other = l_ptr->owner->active_links[0];
Allan Stephens8d64a5b2010-12-31 18:59:27 +0000651 if (other && link_working_unknown(other))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100652 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100653 l_ptr->state = WORKING_WORKING;
654 l_ptr->fsm_msg_cnt = 0;
655 link_activate(l_ptr);
Ying Xue247f0f32014-02-18 16:06:46 +0800656 tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100657 l_ptr->fsm_msg_cnt++;
Jon Maloyc64f7a62012-11-16 13:51:31 +0800658 if (l_ptr->owner->working_links == 1)
Ying Xue247f0f32014-02-18 16:06:46 +0800659 tipc_link_sync_xmit(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100660 link_set_timer(l_ptr, cont_intv);
661 break;
662 case RESET_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100663 break;
664 case TIMEOUT_EVT:
Ying Xue247f0f32014-02-18 16:06:46 +0800665 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
666 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100667 l_ptr->fsm_msg_cnt++;
668 link_set_timer(l_ptr, cont_intv);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100669 break;
670 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400671 pr_err("%s%u in RR state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100672 }
673 break;
674 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400675 pr_err("Unknown link state %u/%u\n", l_ptr->state, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100676 }
677}
678
679/*
680 * link_bundle_buf(): Append contents of a buffer to
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900681 * the tail of an existing one.
Per Lidenb97bf3f2006-01-02 19:04:38 +0100682 */
Paul Gortmakerae8509c2013-06-17 10:54:47 -0400683static int link_bundle_buf(struct tipc_link *l_ptr, struct sk_buff *bundler,
Per Lidenb97bf3f2006-01-02 19:04:38 +0100684 struct sk_buff *buf)
685{
686 struct tipc_msg *bundler_msg = buf_msg(bundler);
687 struct tipc_msg *msg = buf_msg(buf);
688 u32 size = msg_size(msg);
Allan Stephense49060c2006-06-29 12:32:46 -0700689 u32 bundle_size = msg_size(bundler_msg);
690 u32 to_pos = align(bundle_size);
691 u32 pad = to_pos - bundle_size;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100692
693 if (msg_user(bundler_msg) != MSG_BUNDLER)
694 return 0;
695 if (msg_type(bundler_msg) != OPEN_MSG)
696 return 0;
Allan Stephense49060c2006-06-29 12:32:46 -0700697 if (skb_tailroom(bundler) < (pad + size))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100698 return 0;
Allan Stephens15e979d2010-05-11 14:30:10 +0000699 if (l_ptr->max_pkt < (to_pos + size))
Allan Stephens863fae62006-07-03 19:39:36 -0700700 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100701
Allan Stephense49060c2006-06-29 12:32:46 -0700702 skb_put(bundler, pad + size);
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -0300703 skb_copy_to_linear_data_offset(bundler, to_pos, buf->data, size);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100704 msg_set_size(bundler_msg, to_pos + size);
705 msg_set_msgcnt(bundler_msg, msg_msgcnt(bundler_msg) + 1);
Allan Stephens5f6d9122011-11-04 13:24:29 -0400706 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100707 l_ptr->stats.sent_bundled++;
708 return 1;
709}
710
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500711static void link_add_to_outqueue(struct tipc_link *l_ptr,
Sam Ravnborg05790c62006-03-20 22:37:04 -0800712 struct sk_buff *buf,
713 struct tipc_msg *msg)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100714{
715 u32 ack = mod(l_ptr->next_in_no - 1);
716 u32 seqno = mod(l_ptr->next_out_no++);
717
718 msg_set_word(msg, 2, ((ack << 16) | seqno));
719 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
720 buf->next = NULL;
721 if (l_ptr->first_out) {
722 l_ptr->last_out->next = buf;
723 l_ptr->last_out = buf;
724 } else
725 l_ptr->first_out = l_ptr->last_out = buf;
Allan Stephens9bd80b62011-01-18 15:02:50 -0500726
Per Lidenb97bf3f2006-01-02 19:04:38 +0100727 l_ptr->out_queue_size++;
Allan Stephens9bd80b62011-01-18 15:02:50 -0500728 if (l_ptr->out_queue_size > l_ptr->stats.max_queue_sz)
729 l_ptr->stats.max_queue_sz = l_ptr->out_queue_size;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100730}
731
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500732static void link_add_chain_to_outqueue(struct tipc_link *l_ptr,
Allan Stephensdc63d912011-04-21 11:50:42 -0400733 struct sk_buff *buf_chain,
734 u32 long_msgno)
735{
736 struct sk_buff *buf;
737 struct tipc_msg *msg;
738
739 if (!l_ptr->next_out)
740 l_ptr->next_out = buf_chain;
741 while (buf_chain) {
742 buf = buf_chain;
743 buf_chain = buf_chain->next;
744
745 msg = buf_msg(buf);
746 msg_set_long_msgno(msg, long_msgno);
747 link_add_to_outqueue(l_ptr, buf, msg);
748 }
749}
750
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900751/*
Ying Xue247f0f32014-02-18 16:06:46 +0800752 * tipc_link_xmit() is the 'full path' for messages, called from
753 * inside TIPC when the 'fast path' in tipc_send_xmit
Per Lidenb97bf3f2006-01-02 19:04:38 +0100754 * has failed, and from link_send()
755 */
Ying Xue247f0f32014-02-18 16:06:46 +0800756int __tipc_link_xmit(struct tipc_link *l_ptr, struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100757{
758 struct tipc_msg *msg = buf_msg(buf);
759 u32 size = msg_size(msg);
760 u32 dsz = msg_data_sz(msg);
761 u32 queue_size = l_ptr->out_queue_size;
Allan Stephensc68ca7b2010-05-11 14:30:12 +0000762 u32 imp = tipc_msg_tot_importance(msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100763 u32 queue_limit = l_ptr->queue_limit[imp];
Allan Stephens15e979d2010-05-11 14:30:10 +0000764 u32 max_packet = l_ptr->max_pkt;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100765
Per Lidenb97bf3f2006-01-02 19:04:38 +0100766 /* Match msg importance against queue limits: */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100767 if (unlikely(queue_size >= queue_limit)) {
768 if (imp <= TIPC_CRITICAL_IMPORTANCE) {
Allan Stephensbebc55a2011-04-19 10:17:58 -0400769 link_schedule_port(l_ptr, msg_origport(msg), size);
Allan Stephens5f6d9122011-11-04 13:24:29 -0400770 kfree_skb(buf);
Allan Stephensbebc55a2011-04-19 10:17:58 -0400771 return -ELINKCONG;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100772 }
Allan Stephens5f6d9122011-11-04 13:24:29 -0400773 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100774 if (imp > CONN_MANAGER) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400775 pr_warn("%s<%s>, send queue full", link_rst_msg,
776 l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100777 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100778 }
779 return dsz;
780 }
781
782 /* Fragmentation needed ? */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100783 if (size > max_packet)
Ying Xue247f0f32014-02-18 16:06:46 +0800784 return tipc_link_frag_xmit(l_ptr, buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100785
Paul Gortmaker617d3c72012-04-30 15:29:02 -0400786 /* Packet can be queued or sent. */
Erik Hugne512137e2013-12-06 10:08:00 -0500787 if (likely(!link_congested(l_ptr))) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100788 link_add_to_outqueue(l_ptr, buf, msg);
789
Ying Xue7a2f7d12014-04-21 10:55:46 +0800790 tipc_bearer_send(l_ptr->bearer_id, buf, &l_ptr->media_addr);
Ying Xue3c294cb2012-11-15 11:34:45 +0800791 l_ptr->unacked_window = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100792 return dsz;
793 }
Paul Gortmaker617d3c72012-04-30 15:29:02 -0400794 /* Congestion: can message be bundled ? */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100795 if ((msg_user(msg) != CHANGEOVER_PROTOCOL) &&
796 (msg_user(msg) != MSG_FRAGMENTER)) {
797
798 /* Try adding message to an existing bundle */
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900799 if (l_ptr->next_out &&
Ying Xue3c294cb2012-11-15 11:34:45 +0800800 link_bundle_buf(l_ptr, l_ptr->last_out, buf))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100801 return dsz;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100802
803 /* Try creating a new bundle */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100804 if (size <= max_packet * 2 / 3) {
stephen hemminger31e3c3f2010-10-13 13:20:35 +0000805 struct sk_buff *bundler = tipc_buf_acquire(max_packet);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100806 struct tipc_msg bundler_hdr;
807
808 if (bundler) {
Allan Stephensc68ca7b2010-05-11 14:30:12 +0000809 tipc_msg_init(&bundler_hdr, MSG_BUNDLER, OPEN_MSG,
Allan Stephens75715212008-06-04 17:37:34 -0700810 INT_H_SIZE, l_ptr->addr);
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -0300811 skb_copy_to_linear_data(bundler, &bundler_hdr,
812 INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100813 skb_trim(bundler, INT_H_SIZE);
814 link_bundle_buf(l_ptr, bundler, buf);
815 buf = bundler;
816 msg = buf_msg(buf);
817 l_ptr->stats.sent_bundles++;
818 }
819 }
820 }
821 if (!l_ptr->next_out)
822 l_ptr->next_out = buf;
823 link_add_to_outqueue(l_ptr, buf, msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100824 return dsz;
825}
826
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900827/*
Ying Xue247f0f32014-02-18 16:06:46 +0800828 * tipc_link_xmit(): same as __tipc_link_xmit(), but the link to use
829 * has not been selected yet, and the the owner node is not locked
Per Lidenb97bf3f2006-01-02 19:04:38 +0100830 * Called by TIPC internal users, e.g. the name distributor
831 */
Ying Xue247f0f32014-02-18 16:06:46 +0800832int tipc_link_xmit(struct sk_buff *buf, u32 dest, u32 selector)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100833{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500834 struct tipc_link *l_ptr;
David S. Miller6c000552008-09-02 23:38:32 -0700835 struct tipc_node *n_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100836 int res = -ELINKCONG;
837
Allan Stephens51a8e4d2010-12-31 18:59:18 +0000838 n_ptr = tipc_node_find(dest);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100839 if (n_ptr) {
Per Liden4323add2006-01-18 00:38:21 +0100840 tipc_node_lock(n_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100841 l_ptr = n_ptr->active_links[selector & 1];
Allan Stephensa0168922010-12-31 18:59:35 +0000842 if (l_ptr)
Ying Xue247f0f32014-02-18 16:06:46 +0800843 res = __tipc_link_xmit(l_ptr, buf);
Allan Stephensa0168922010-12-31 18:59:35 +0000844 else
Allan Stephens5f6d9122011-11-04 13:24:29 -0400845 kfree_skb(buf);
Per Liden4323add2006-01-18 00:38:21 +0100846 tipc_node_unlock(n_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100847 } else {
Allan Stephens5f6d9122011-11-04 13:24:29 -0400848 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100849 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100850 return res;
851}
852
Jon Maloyc64f7a62012-11-16 13:51:31 +0800853/*
Ying Xue247f0f32014-02-18 16:06:46 +0800854 * tipc_link_sync_xmit - synchronize broadcast link endpoints.
Jon Maloyc64f7a62012-11-16 13:51:31 +0800855 *
856 * Give a newly added peer node the sequence number where it should
857 * start receiving and acking broadcast packets.
858 *
859 * Called with node locked
860 */
Ying Xue247f0f32014-02-18 16:06:46 +0800861static void tipc_link_sync_xmit(struct tipc_link *l)
Jon Maloyc64f7a62012-11-16 13:51:31 +0800862{
863 struct sk_buff *buf;
864 struct tipc_msg *msg;
865
866 buf = tipc_buf_acquire(INT_H_SIZE);
867 if (!buf)
868 return;
869
870 msg = buf_msg(buf);
871 tipc_msg_init(msg, BCAST_PROTOCOL, STATE_MSG, INT_H_SIZE, l->addr);
872 msg_set_last_bcast(msg, l->owner->bclink.acked);
873 link_add_chain_to_outqueue(l, buf, 0);
874 tipc_link_push_queue(l);
875}
876
877/*
Ying Xue247f0f32014-02-18 16:06:46 +0800878 * tipc_link_sync_rcv - synchronize broadcast link endpoints.
Jon Maloyc64f7a62012-11-16 13:51:31 +0800879 * Receive the sequence number where we should start receiving and
880 * acking broadcast packets from a newly added peer node, and open
881 * up for reception of such packets.
882 *
883 * Called with node locked
884 */
Ying Xue247f0f32014-02-18 16:06:46 +0800885static void tipc_link_sync_rcv(struct tipc_node *n, struct sk_buff *buf)
Jon Maloyc64f7a62012-11-16 13:51:31 +0800886{
887 struct tipc_msg *msg = buf_msg(buf);
888
889 n->bclink.last_sent = n->bclink.last_in = msg_last_bcast(msg);
890 n->bclink.recv_permitted = true;
891 kfree_skb(buf);
892}
893
894/*
Ying Xue247f0f32014-02-18 16:06:46 +0800895 * tipc_link_names_xmit - send name table entries to new neighbor
Allan Stephens9aa88c22011-05-31 13:38:02 -0400896 *
897 * Send routine for bulk delivery of name table messages when contact
898 * with a new neighbor occurs. No link congestion checking is performed
899 * because name table messages *must* be delivered. The messages must be
900 * small enough not to require fragmentation.
901 * Called without any locks held.
902 */
Ying Xue247f0f32014-02-18 16:06:46 +0800903void tipc_link_names_xmit(struct list_head *message_list, u32 dest)
Allan Stephens9aa88c22011-05-31 13:38:02 -0400904{
905 struct tipc_node *n_ptr;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500906 struct tipc_link *l_ptr;
Allan Stephens9aa88c22011-05-31 13:38:02 -0400907 struct sk_buff *buf;
908 struct sk_buff *temp_buf;
909
910 if (list_empty(message_list))
911 return;
912
Allan Stephens9aa88c22011-05-31 13:38:02 -0400913 n_ptr = tipc_node_find(dest);
914 if (n_ptr) {
915 tipc_node_lock(n_ptr);
916 l_ptr = n_ptr->active_links[0];
917 if (l_ptr) {
918 /* convert circular list to linear list */
919 ((struct sk_buff *)message_list->prev)->next = NULL;
920 link_add_chain_to_outqueue(l_ptr,
921 (struct sk_buff *)message_list->next, 0);
922 tipc_link_push_queue(l_ptr);
923 INIT_LIST_HEAD(message_list);
924 }
925 tipc_node_unlock(n_ptr);
926 }
Allan Stephens9aa88c22011-05-31 13:38:02 -0400927
928 /* discard the messages if they couldn't be sent */
Allan Stephens9aa88c22011-05-31 13:38:02 -0400929 list_for_each_safe(buf, temp_buf, ((struct sk_buff *)message_list)) {
930 list_del((struct list_head *)buf);
Allan Stephens5f6d9122011-11-04 13:24:29 -0400931 kfree_skb(buf);
Allan Stephens9aa88c22011-05-31 13:38:02 -0400932 }
933}
934
935/*
Ying Xue247f0f32014-02-18 16:06:46 +0800936 * tipc_link_xmit_fast: Entry for data messages where the
Per Lidenb97bf3f2006-01-02 19:04:38 +0100937 * destination link is known and the header is complete,
938 * inclusive total message length. Very time critical.
939 * Link is locked. Returns user data length.
940 */
Ying Xue247f0f32014-02-18 16:06:46 +0800941static int tipc_link_xmit_fast(struct tipc_link *l_ptr, struct sk_buff *buf,
942 u32 *used_max_pkt)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100943{
944 struct tipc_msg *msg = buf_msg(buf);
945 int res = msg_data_sz(msg);
946
947 if (likely(!link_congested(l_ptr))) {
Allan Stephens15e979d2010-05-11 14:30:10 +0000948 if (likely(msg_size(msg) <= l_ptr->max_pkt)) {
Erik Hugne512137e2013-12-06 10:08:00 -0500949 link_add_to_outqueue(l_ptr, buf, msg);
Ying Xue7a2f7d12014-04-21 10:55:46 +0800950 tipc_bearer_send(l_ptr->bearer_id, buf,
Erik Hugne512137e2013-12-06 10:08:00 -0500951 &l_ptr->media_addr);
952 l_ptr->unacked_window = 0;
953 return res;
954 }
955 else
Allan Stephens15e979d2010-05-11 14:30:10 +0000956 *used_max_pkt = l_ptr->max_pkt;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100957 }
Ying Xue247f0f32014-02-18 16:06:46 +0800958 return __tipc_link_xmit(l_ptr, buf); /* All other cases */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100959}
960
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900961/*
Ying Xue247f0f32014-02-18 16:06:46 +0800962 * tipc_link_iovec_xmit_fast: Entry for messages where the
Per Lidenb97bf3f2006-01-02 19:04:38 +0100963 * destination processor is known and the header is complete,
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900964 * except for total message length.
Per Lidenb97bf3f2006-01-02 19:04:38 +0100965 * Returns user data length or errno.
966 */
Ying Xue247f0f32014-02-18 16:06:46 +0800967int tipc_link_iovec_xmit_fast(struct tipc_port *sender,
968 struct iovec const *msg_sect,
969 unsigned int len, u32 destaddr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100970{
Allan Stephens23dd4cc2011-01-07 11:43:40 -0500971 struct tipc_msg *hdr = &sender->phdr;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500972 struct tipc_link *l_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100973 struct sk_buff *buf;
David S. Miller6c000552008-09-02 23:38:32 -0700974 struct tipc_node *node;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100975 int res;
976 u32 selector = msg_origport(hdr) & 1;
977
Per Lidenb97bf3f2006-01-02 19:04:38 +0100978again:
979 /*
980 * Try building message using port's max_pkt hint.
981 * (Must not hold any locks while building message.)
982 */
Ying Xue9446b872013-10-18 07:23:15 +0200983 res = tipc_msg_build(hdr, msg_sect, len, sender->max_pkt, &buf);
Ying Xue7410f962013-06-17 10:54:49 -0400984 /* Exit if build request was invalid */
985 if (unlikely(res < 0))
986 return res;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100987
Allan Stephens51a8e4d2010-12-31 18:59:18 +0000988 node = tipc_node_find(destaddr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100989 if (likely(node)) {
Per Liden4323add2006-01-18 00:38:21 +0100990 tipc_node_lock(node);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100991 l_ptr = node->active_links[selector];
992 if (likely(l_ptr)) {
993 if (likely(buf)) {
Ying Xue247f0f32014-02-18 16:06:46 +0800994 res = tipc_link_xmit_fast(l_ptr, buf,
995 &sender->max_pkt);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100996exit:
Per Liden4323add2006-01-18 00:38:21 +0100997 tipc_node_unlock(node);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100998 return res;
999 }
1000
Per Lidenb97bf3f2006-01-02 19:04:38 +01001001 /* Exit if link (or bearer) is congested */
Erik Hugne512137e2013-12-06 10:08:00 -05001002 if (link_congested(l_ptr)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001003 res = link_schedule_port(l_ptr,
Allan Stephens23dd4cc2011-01-07 11:43:40 -05001004 sender->ref, res);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001005 goto exit;
1006 }
1007
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001008 /*
Per Lidenb97bf3f2006-01-02 19:04:38 +01001009 * Message size exceeds max_pkt hint; update hint,
1010 * then re-try fast path or fragment the message
1011 */
Allan Stephens23dd4cc2011-01-07 11:43:40 -05001012 sender->max_pkt = l_ptr->max_pkt;
Per Liden4323add2006-01-18 00:38:21 +01001013 tipc_node_unlock(node);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001014
1015
Allan Stephens23dd4cc2011-01-07 11:43:40 -05001016 if ((msg_hdr_sz(hdr) + res) <= sender->max_pkt)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001017 goto again;
1018
Ying Xue247f0f32014-02-18 16:06:46 +08001019 return tipc_link_iovec_long_xmit(sender, msg_sect,
1020 len, destaddr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001021 }
Per Liden4323add2006-01-18 00:38:21 +01001022 tipc_node_unlock(node);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001023 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001024
1025 /* Couldn't find a link to the destination node */
Erik Hugne63fa01c2014-02-19 08:37:58 +01001026 kfree_skb(buf);
1027 tipc_port_iovec_reject(sender, hdr, msg_sect, len, TIPC_ERR_NO_NODE);
1028 return -ENETUNREACH;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001029}
1030
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001031/*
Ying Xue247f0f32014-02-18 16:06:46 +08001032 * tipc_link_iovec_long_xmit(): Entry for long messages where the
Per Lidenb97bf3f2006-01-02 19:04:38 +01001033 * destination node is known and the header is complete,
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001034 * inclusive total message length.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001035 * Link and bearer congestion status have been checked to be ok,
1036 * and are ignored if they change.
1037 *
1038 * Note that fragments do not use the full link MTU so that they won't have
1039 * to undergo refragmentation if link changeover causes them to be sent
1040 * over another link with an additional tunnel header added as prefix.
1041 * (Refragmentation will still occur if the other link has a smaller MTU.)
1042 *
1043 * Returns user data length or errno.
1044 */
Ying Xue247f0f32014-02-18 16:06:46 +08001045static int tipc_link_iovec_long_xmit(struct tipc_port *sender,
1046 struct iovec const *msg_sect,
1047 unsigned int len, u32 destaddr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001048{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001049 struct tipc_link *l_ptr;
David S. Miller6c000552008-09-02 23:38:32 -07001050 struct tipc_node *node;
Allan Stephens23dd4cc2011-01-07 11:43:40 -05001051 struct tipc_msg *hdr = &sender->phdr;
Ying Xue9446b872013-10-18 07:23:15 +02001052 u32 dsz = len;
Allan Stephens0e659672010-12-31 18:59:32 +00001053 u32 max_pkt, fragm_sz, rest;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001054 struct tipc_msg fragm_hdr;
Allan Stephens0e659672010-12-31 18:59:32 +00001055 struct sk_buff *buf, *buf_chain, *prev;
1056 u32 fragm_crs, fragm_rest, hsz, sect_rest;
Ying Xue40682432013-10-18 07:23:16 +02001057 const unchar __user *sect_crs;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001058 int curr_sect;
1059 u32 fragm_no;
Ying Xue126c0522013-06-17 10:54:50 -04001060 int res = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001061
1062again:
1063 fragm_no = 1;
Allan Stephens23dd4cc2011-01-07 11:43:40 -05001064 max_pkt = sender->max_pkt - INT_H_SIZE;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001065 /* leave room for tunnel header in case of link changeover */
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001066 fragm_sz = max_pkt - INT_H_SIZE;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001067 /* leave room for fragmentation header in each fragment */
1068 rest = dsz;
1069 fragm_crs = 0;
1070 fragm_rest = 0;
1071 sect_rest = 0;
Sam Ravnborg1fc54d82006-03-20 22:36:47 -08001072 sect_crs = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001073 curr_sect = -1;
1074
Paul Gortmaker617d3c72012-04-30 15:29:02 -04001075 /* Prepare reusable fragment header */
Allan Stephensc68ca7b2010-05-11 14:30:12 +00001076 tipc_msg_init(&fragm_hdr, MSG_FRAGMENTER, FIRST_FRAGMENT,
Allan Stephens75715212008-06-04 17:37:34 -07001077 INT_H_SIZE, msg_destnode(hdr));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001078 msg_set_size(&fragm_hdr, max_pkt);
1079 msg_set_fragm_no(&fragm_hdr, 1);
1080
Paul Gortmaker617d3c72012-04-30 15:29:02 -04001081 /* Prepare header of first fragment */
stephen hemminger31e3c3f2010-10-13 13:20:35 +00001082 buf_chain = buf = tipc_buf_acquire(max_pkt);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001083 if (!buf)
1084 return -ENOMEM;
1085 buf->next = NULL;
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03001086 skb_copy_to_linear_data(buf, &fragm_hdr, INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001087 hsz = msg_hdr_sz(hdr);
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03001088 skb_copy_to_linear_data_offset(buf, INT_H_SIZE, hdr, hsz);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001089
Paul Gortmaker617d3c72012-04-30 15:29:02 -04001090 /* Chop up message */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001091 fragm_crs = INT_H_SIZE + hsz;
1092 fragm_rest = fragm_sz - hsz;
1093
1094 do { /* For all sections */
1095 u32 sz;
1096
1097 if (!sect_rest) {
1098 sect_rest = msg_sect[++curr_sect].iov_len;
Ying Xue40682432013-10-18 07:23:16 +02001099 sect_crs = msg_sect[curr_sect].iov_base;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001100 }
1101
1102 if (sect_rest < fragm_rest)
1103 sz = sect_rest;
1104 else
1105 sz = fragm_rest;
1106
Ying Xuef1733d72013-06-17 10:54:43 -04001107 if (copy_from_user(buf->data + fragm_crs, sect_crs, sz)) {
Ying Xue126c0522013-06-17 10:54:50 -04001108 res = -EFAULT;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001109error:
Ying Xued77b3832013-12-10 20:45:38 -08001110 kfree_skb_list(buf_chain);
Ying Xue126c0522013-06-17 10:54:50 -04001111 return res;
Ying Xuef1733d72013-06-17 10:54:43 -04001112 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001113 sect_crs += sz;
1114 sect_rest -= sz;
1115 fragm_crs += sz;
1116 fragm_rest -= sz;
1117 rest -= sz;
1118
1119 if (!fragm_rest && rest) {
1120
1121 /* Initiate new fragment: */
1122 if (rest <= fragm_sz) {
1123 fragm_sz = rest;
Allan Stephens0e659672010-12-31 18:59:32 +00001124 msg_set_type(&fragm_hdr, LAST_FRAGMENT);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001125 } else {
1126 msg_set_type(&fragm_hdr, FRAGMENT);
1127 }
1128 msg_set_size(&fragm_hdr, fragm_sz + INT_H_SIZE);
1129 msg_set_fragm_no(&fragm_hdr, ++fragm_no);
1130 prev = buf;
stephen hemminger31e3c3f2010-10-13 13:20:35 +00001131 buf = tipc_buf_acquire(fragm_sz + INT_H_SIZE);
Ying Xue126c0522013-06-17 10:54:50 -04001132 if (!buf) {
1133 res = -ENOMEM;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001134 goto error;
Ying Xue126c0522013-06-17 10:54:50 -04001135 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001136
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001137 buf->next = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001138 prev->next = buf;
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03001139 skb_copy_to_linear_data(buf, &fragm_hdr, INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001140 fragm_crs = INT_H_SIZE;
1141 fragm_rest = fragm_sz;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001142 }
Allan Stephens0e659672010-12-31 18:59:32 +00001143 } while (rest > 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001144
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001145 /*
Per Lidenb97bf3f2006-01-02 19:04:38 +01001146 * Now we have a buffer chain. Select a link and check
1147 * that packet size is still OK
1148 */
Allan Stephens51a8e4d2010-12-31 18:59:18 +00001149 node = tipc_node_find(destaddr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001150 if (likely(node)) {
Per Liden4323add2006-01-18 00:38:21 +01001151 tipc_node_lock(node);
Allan Stephens23dd4cc2011-01-07 11:43:40 -05001152 l_ptr = node->active_links[sender->ref & 1];
Per Lidenb97bf3f2006-01-02 19:04:38 +01001153 if (!l_ptr) {
Per Liden4323add2006-01-18 00:38:21 +01001154 tipc_node_unlock(node);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001155 goto reject;
1156 }
Allan Stephens15e979d2010-05-11 14:30:10 +00001157 if (l_ptr->max_pkt < max_pkt) {
Allan Stephens23dd4cc2011-01-07 11:43:40 -05001158 sender->max_pkt = l_ptr->max_pkt;
Per Liden4323add2006-01-18 00:38:21 +01001159 tipc_node_unlock(node);
Ying Xued77b3832013-12-10 20:45:38 -08001160 kfree_skb_list(buf_chain);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001161 goto again;
1162 }
1163 } else {
1164reject:
Ying Xued77b3832013-12-10 20:45:38 -08001165 kfree_skb_list(buf_chain);
Erik Hugne63fa01c2014-02-19 08:37:58 +01001166 tipc_port_iovec_reject(sender, hdr, msg_sect, len,
1167 TIPC_ERR_NO_NODE);
1168 return -ENETUNREACH;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001169 }
1170
Allan Stephensdc63d912011-04-21 11:50:42 -04001171 /* Append chain of fragments to send queue & send them */
Allan Stephense0f08592011-04-17 11:44:24 -04001172 l_ptr->long_msg_seq_no++;
Allan Stephensdc63d912011-04-21 11:50:42 -04001173 link_add_chain_to_outqueue(l_ptr, buf_chain, l_ptr->long_msg_seq_no);
1174 l_ptr->stats.sent_fragments += fragm_no;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001175 l_ptr->stats.sent_fragmented++;
Per Liden4323add2006-01-18 00:38:21 +01001176 tipc_link_push_queue(l_ptr);
1177 tipc_node_unlock(node);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001178 return dsz;
1179}
1180
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001181/*
Per Liden4323add2006-01-18 00:38:21 +01001182 * tipc_link_push_packet: Push one unsent packet to the media
Per Lidenb97bf3f2006-01-02 19:04:38 +01001183 */
stephen hemminger98056962014-01-04 13:47:48 -08001184static u32 tipc_link_push_packet(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001185{
1186 struct sk_buff *buf = l_ptr->first_out;
1187 u32 r_q_size = l_ptr->retransm_queue_size;
1188 u32 r_q_head = l_ptr->retransm_queue_head;
1189
1190 /* Step to position where retransmission failed, if any, */
1191 /* consider that buffers may have been released in meantime */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001192 if (r_q_size && buf) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001193 u32 last = lesser(mod(r_q_head + r_q_size),
Per Lidenb97bf3f2006-01-02 19:04:38 +01001194 link_last_sent(l_ptr));
Allan Stephensf9057302011-10-24 16:03:12 -04001195 u32 first = buf_seqno(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001196
1197 while (buf && less(first, r_q_head)) {
1198 first = mod(first + 1);
1199 buf = buf->next;
1200 }
1201 l_ptr->retransm_queue_head = r_q_head = first;
1202 l_ptr->retransm_queue_size = r_q_size = mod(last - first);
1203 }
1204
1205 /* Continue retransmission now, if there is anything: */
Neil Hormanca509102010-03-15 07:58:45 +00001206 if (r_q_size && buf) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001207 msg_set_ack(buf_msg(buf), mod(l_ptr->next_in_no - 1));
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001208 msg_set_bcast_ack(buf_msg(buf), l_ptr->owner->bclink.last_in);
Ying Xue7a2f7d12014-04-21 10:55:46 +08001209 tipc_bearer_send(l_ptr->bearer_id, buf, &l_ptr->media_addr);
Ying Xue3c294cb2012-11-15 11:34:45 +08001210 l_ptr->retransm_queue_head = mod(++r_q_head);
1211 l_ptr->retransm_queue_size = --r_q_size;
1212 l_ptr->stats.retransmitted++;
1213 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001214 }
1215
1216 /* Send deferred protocol message, if any: */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001217 buf = l_ptr->proto_msg_queue;
1218 if (buf) {
1219 msg_set_ack(buf_msg(buf), mod(l_ptr->next_in_no - 1));
Allan Stephens0e659672010-12-31 18:59:32 +00001220 msg_set_bcast_ack(buf_msg(buf), l_ptr->owner->bclink.last_in);
Ying Xue7a2f7d12014-04-21 10:55:46 +08001221 tipc_bearer_send(l_ptr->bearer_id, buf, &l_ptr->media_addr);
Ying Xue3c294cb2012-11-15 11:34:45 +08001222 l_ptr->unacked_window = 0;
1223 kfree_skb(buf);
1224 l_ptr->proto_msg_queue = NULL;
1225 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001226 }
1227
1228 /* Send one deferred data message, if send window not full: */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001229 buf = l_ptr->next_out;
1230 if (buf) {
1231 struct tipc_msg *msg = buf_msg(buf);
1232 u32 next = msg_seqno(msg);
Allan Stephensf9057302011-10-24 16:03:12 -04001233 u32 first = buf_seqno(l_ptr->first_out);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001234
1235 if (mod(next - first) < l_ptr->queue_limit[0]) {
1236 msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001237 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Ying Xue7a2f7d12014-04-21 10:55:46 +08001238 tipc_bearer_send(l_ptr->bearer_id, buf,
1239 &l_ptr->media_addr);
Ying Xue3c294cb2012-11-15 11:34:45 +08001240 if (msg_user(msg) == MSG_BUNDLER)
1241 msg_set_type(msg, CLOSED_MSG);
1242 l_ptr->next_out = buf->next;
1243 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001244 }
1245 }
Ying Xue3c294cb2012-11-15 11:34:45 +08001246 return 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001247}
1248
1249/*
1250 * push_queue(): push out the unsent messages of a link where
1251 * congestion has abated. Node is locked
1252 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001253void tipc_link_push_queue(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001254{
1255 u32 res;
1256
Per Lidenb97bf3f2006-01-02 19:04:38 +01001257 do {
Per Liden4323add2006-01-18 00:38:21 +01001258 res = tipc_link_push_packet(l_ptr);
Allan Stephens0e35fd52008-07-14 22:44:01 -07001259 } while (!res);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001260}
1261
Ying Xue3f5a12b2014-05-05 08:56:17 +08001262void tipc_link_reset_all(struct tipc_node *node)
Allan Stephensd356eeb2006-06-25 23:40:01 -07001263{
Allan Stephensd356eeb2006-06-25 23:40:01 -07001264 char addr_string[16];
1265 u32 i;
1266
Ying Xue3f5a12b2014-05-05 08:56:17 +08001267 tipc_node_lock(node);
Allan Stephensd356eeb2006-06-25 23:40:01 -07001268
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001269 pr_warn("Resetting all links to %s\n",
Ying Xue3f5a12b2014-05-05 08:56:17 +08001270 tipc_addr_string_fill(addr_string, node->addr));
Allan Stephensd356eeb2006-06-25 23:40:01 -07001271
1272 for (i = 0; i < MAX_BEARERS; i++) {
Ying Xue3f5a12b2014-05-05 08:56:17 +08001273 if (node->links[i]) {
1274 link_print(node->links[i], "Resetting link\n");
1275 tipc_link_reset(node->links[i]);
Allan Stephensd356eeb2006-06-25 23:40:01 -07001276 }
1277 }
1278
Ying Xue3f5a12b2014-05-05 08:56:17 +08001279 tipc_node_unlock(node);
Allan Stephensd356eeb2006-06-25 23:40:01 -07001280}
1281
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001282static void link_retransmit_failure(struct tipc_link *l_ptr,
Paul Gortmakerae8509c2013-06-17 10:54:47 -04001283 struct sk_buff *buf)
Allan Stephensd356eeb2006-06-25 23:40:01 -07001284{
1285 struct tipc_msg *msg = buf_msg(buf);
1286
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001287 pr_warn("Retransmission failure on link <%s>\n", l_ptr->name);
Allan Stephensd356eeb2006-06-25 23:40:01 -07001288
1289 if (l_ptr->addr) {
Allan Stephensd356eeb2006-06-25 23:40:01 -07001290 /* Handle failure on standard link */
Allan Stephens8d64a5b2010-12-31 18:59:27 +00001291 link_print(l_ptr, "Resetting link\n");
Allan Stephensd356eeb2006-06-25 23:40:01 -07001292 tipc_link_reset(l_ptr);
1293
1294 } else {
Allan Stephensd356eeb2006-06-25 23:40:01 -07001295 /* Handle failure on broadcast link */
David S. Miller6c000552008-09-02 23:38:32 -07001296 struct tipc_node *n_ptr;
Allan Stephensd356eeb2006-06-25 23:40:01 -07001297 char addr_string[16];
1298
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001299 pr_info("Msg seq number: %u, ", msg_seqno(msg));
1300 pr_cont("Outstanding acks: %lu\n",
1301 (unsigned long) TIPC_SKB_CB(buf)->handle);
Jeff Garzik617dbea2006-10-03 16:25:34 -07001302
Allan Stephens01d83ed2011-01-18 13:53:16 -05001303 n_ptr = tipc_bclink_retransmit_to();
Allan Stephensd356eeb2006-06-25 23:40:01 -07001304 tipc_node_lock(n_ptr);
1305
Allan Stephensc68ca7b2010-05-11 14:30:12 +00001306 tipc_addr_string_fill(addr_string, n_ptr->addr);
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001307 pr_info("Broadcast link info for %s\n", addr_string);
Ying Xue389dd9b2012-11-16 13:51:30 +08001308 pr_info("Reception permitted: %d, Acked: %u\n",
1309 n_ptr->bclink.recv_permitted,
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001310 n_ptr->bclink.acked);
1311 pr_info("Last in: %u, Oos state: %u, Last sent: %u\n",
1312 n_ptr->bclink.last_in,
1313 n_ptr->bclink.oos_state,
1314 n_ptr->bclink.last_sent);
Allan Stephensd356eeb2006-06-25 23:40:01 -07001315
Allan Stephensd356eeb2006-06-25 23:40:01 -07001316 tipc_node_unlock(n_ptr);
1317
Ying Xue3f5a12b2014-05-05 08:56:17 +08001318 tipc_bclink_set_flags(TIPC_BCLINK_RESET);
Allan Stephensd356eeb2006-06-25 23:40:01 -07001319 l_ptr->stale_count = 0;
1320 }
1321}
1322
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001323void tipc_link_retransmit(struct tipc_link *l_ptr, struct sk_buff *buf,
Per Liden4323add2006-01-18 00:38:21 +01001324 u32 retransmits)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001325{
1326 struct tipc_msg *msg;
1327
Allan Stephensd356eeb2006-06-25 23:40:01 -07001328 if (!buf)
1329 return;
1330
1331 msg = buf_msg(buf);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001332
Erik Hugne512137e2013-12-06 10:08:00 -05001333 /* Detect repeated retransmit failures */
1334 if (l_ptr->last_retransmitted == msg_seqno(msg)) {
1335 if (++l_ptr->stale_count > 100) {
1336 link_retransmit_failure(l_ptr, buf);
1337 return;
Allan Stephensd356eeb2006-06-25 23:40:01 -07001338 }
1339 } else {
Erik Hugne512137e2013-12-06 10:08:00 -05001340 l_ptr->last_retransmitted = msg_seqno(msg);
1341 l_ptr->stale_count = 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001342 }
Allan Stephensd356eeb2006-06-25 23:40:01 -07001343
Neil Hormanca509102010-03-15 07:58:45 +00001344 while (retransmits && (buf != l_ptr->next_out) && buf) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001345 msg = buf_msg(buf);
1346 msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001347 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Ying Xue7a2f7d12014-04-21 10:55:46 +08001348 tipc_bearer_send(l_ptr->bearer_id, buf, &l_ptr->media_addr);
Ying Xue3c294cb2012-11-15 11:34:45 +08001349 buf = buf->next;
1350 retransmits--;
1351 l_ptr->stats.retransmitted++;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001352 }
Allan Stephensd356eeb2006-06-25 23:40:01 -07001353
Per Lidenb97bf3f2006-01-02 19:04:38 +01001354 l_ptr->retransm_queue_head = l_ptr->retransm_queue_size = 0;
1355}
1356
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001357/**
Per Lidenb97bf3f2006-01-02 19:04:38 +01001358 * link_insert_deferred_queue - insert deferred messages back into receive chain
1359 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001360static struct sk_buff *link_insert_deferred_queue(struct tipc_link *l_ptr,
Per Lidenb97bf3f2006-01-02 19:04:38 +01001361 struct sk_buff *buf)
1362{
1363 u32 seq_no;
1364
1365 if (l_ptr->oldest_deferred_in == NULL)
1366 return buf;
1367
Allan Stephensf9057302011-10-24 16:03:12 -04001368 seq_no = buf_seqno(l_ptr->oldest_deferred_in);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001369 if (seq_no == mod(l_ptr->next_in_no)) {
1370 l_ptr->newest_deferred_in->next = buf;
1371 buf = l_ptr->oldest_deferred_in;
1372 l_ptr->oldest_deferred_in = NULL;
1373 l_ptr->deferred_inqueue_sz = 0;
1374 }
1375 return buf;
1376}
1377
Allan Stephens85035562008-04-15 19:04:54 -07001378/**
1379 * link_recv_buf_validate - validate basic format of received message
1380 *
1381 * This routine ensures a TIPC message has an acceptable header, and at least
1382 * as much data as the header indicates it should. The routine also ensures
1383 * that the entire message header is stored in the main fragment of the message
1384 * buffer, to simplify future access to message header fields.
1385 *
1386 * Note: Having extra info present in the message header or data areas is OK.
1387 * TIPC will ignore the excess, under the assumption that it is optional info
1388 * introduced by a later release of the protocol.
1389 */
Allan Stephens85035562008-04-15 19:04:54 -07001390static int link_recv_buf_validate(struct sk_buff *buf)
1391{
1392 static u32 min_data_hdr_size[8] = {
Allan Stephens741d9eb2011-05-31 15:03:18 -04001393 SHORT_H_SIZE, MCAST_H_SIZE, NAMED_H_SIZE, BASIC_H_SIZE,
Allan Stephens85035562008-04-15 19:04:54 -07001394 MAX_H_SIZE, MAX_H_SIZE, MAX_H_SIZE, MAX_H_SIZE
1395 };
1396
1397 struct tipc_msg *msg;
1398 u32 tipc_hdr[2];
1399 u32 size;
1400 u32 hdr_size;
1401 u32 min_hdr_size;
1402
Erik Hugne64380a02014-02-11 11:38:26 +01001403 /* If this packet comes from the defer queue, the skb has already
1404 * been validated
1405 */
1406 if (unlikely(TIPC_SKB_CB(buf)->deferred))
1407 return 1;
1408
Allan Stephens85035562008-04-15 19:04:54 -07001409 if (unlikely(buf->len < MIN_H_SIZE))
1410 return 0;
1411
1412 msg = skb_header_pointer(buf, 0, sizeof(tipc_hdr), tipc_hdr);
1413 if (msg == NULL)
1414 return 0;
1415
1416 if (unlikely(msg_version(msg) != TIPC_VERSION))
1417 return 0;
1418
1419 size = msg_size(msg);
1420 hdr_size = msg_hdr_sz(msg);
1421 min_hdr_size = msg_isdata(msg) ?
1422 min_data_hdr_size[msg_type(msg)] : INT_H_SIZE;
1423
1424 if (unlikely((hdr_size < min_hdr_size) ||
1425 (size < hdr_size) ||
1426 (buf->len < size) ||
1427 (size - hdr_size > TIPC_MAX_USER_MSG_SIZE)))
1428 return 0;
1429
1430 return pskb_may_pull(buf, hdr_size);
1431}
1432
Allan Stephensb02b69c2010-08-17 11:00:07 +00001433/**
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001434 * tipc_rcv - process TIPC packets/messages arriving from off-node
Allan Stephensb02b69c2010-08-17 11:00:07 +00001435 * @head: pointer to message buffer chain
Ying Xue7a2f7d12014-04-21 10:55:46 +08001436 * @b_ptr: pointer to bearer message arrived on
Allan Stephensb02b69c2010-08-17 11:00:07 +00001437 *
1438 * Invoked with no locks held. Bearer pointer must point to a valid bearer
1439 * structure (i.e. cannot be NULL), but bearer can be inactive.
1440 */
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001441void tipc_rcv(struct sk_buff *head, struct tipc_bearer *b_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001442{
Per Lidenb97bf3f2006-01-02 19:04:38 +01001443 while (head) {
David S. Miller6c000552008-09-02 23:38:32 -07001444 struct tipc_node *n_ptr;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001445 struct tipc_link *l_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001446 struct sk_buff *crs;
1447 struct sk_buff *buf = head;
Allan Stephens85035562008-04-15 19:04:54 -07001448 struct tipc_msg *msg;
1449 u32 seq_no;
1450 u32 ackd;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001451 u32 released = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001452
Per Lidenb97bf3f2006-01-02 19:04:38 +01001453 head = head->next;
Erik Hugne732256b2014-01-07 15:51:36 -05001454 buf->next = NULL;
Allan Stephens85035562008-04-15 19:04:54 -07001455
1456 /* Ensure message is well-formed */
Allan Stephens85035562008-04-15 19:04:54 -07001457 if (unlikely(!link_recv_buf_validate(buf)))
Ying Xue3af390e2013-10-30 11:26:57 +08001458 goto discard;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001459
Allan Stephensfe13dda2008-04-15 19:03:23 -07001460 /* Ensure message data is a single contiguous unit */
Allan Stephens5f6d9122011-11-04 13:24:29 -04001461 if (unlikely(skb_linearize(buf)))
Ying Xue3af390e2013-10-30 11:26:57 +08001462 goto discard;
Allan Stephensfe13dda2008-04-15 19:03:23 -07001463
Allan Stephens85035562008-04-15 19:04:54 -07001464 /* Handle arrival of a non-unicast link message */
Allan Stephens85035562008-04-15 19:04:54 -07001465 msg = buf_msg(buf);
1466
Per Lidenb97bf3f2006-01-02 19:04:38 +01001467 if (unlikely(msg_non_seq(msg))) {
Allan Stephens1265a022008-06-04 17:32:35 -07001468 if (msg_user(msg) == LINK_CONFIG)
Ying Xue247f0f32014-02-18 16:06:46 +08001469 tipc_disc_rcv(buf, b_ptr);
Allan Stephens1265a022008-06-04 17:32:35 -07001470 else
Ying Xue247f0f32014-02-18 16:06:46 +08001471 tipc_bclink_rcv(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001472 continue;
1473 }
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001474
Allan Stephensed33a9c2011-04-05 15:15:04 -04001475 /* Discard unicast link messages destined for another node */
Allan Stephens26008242006-06-25 23:39:31 -07001476 if (unlikely(!msg_short(msg) &&
1477 (msg_destnode(msg) != tipc_own_addr)))
Ying Xue3af390e2013-10-30 11:26:57 +08001478 goto discard;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001479
Allan Stephens5a68d5e2010-08-17 11:00:16 +00001480 /* Locate neighboring node that sent message */
Per Liden4323add2006-01-18 00:38:21 +01001481 n_ptr = tipc_node_find(msg_prevnode(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001482 if (unlikely(!n_ptr))
Ying Xue3af390e2013-10-30 11:26:57 +08001483 goto discard;
Per Liden4323add2006-01-18 00:38:21 +01001484 tipc_node_lock(n_ptr);
Allan Stephens85035562008-04-15 19:04:54 -07001485
Allan Stephens5a68d5e2010-08-17 11:00:16 +00001486 /* Locate unicast link endpoint that should handle message */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001487 l_ptr = n_ptr->links[b_ptr->identity];
Ying Xue3af390e2013-10-30 11:26:57 +08001488 if (unlikely(!l_ptr))
1489 goto unlock_discard;
Allan Stephens85035562008-04-15 19:04:54 -07001490
Allan Stephensb4b56102011-05-27 11:00:51 -04001491 /* Verify that communication with node is currently allowed */
Ying Xueaecb9bb2014-05-08 08:54:39 +08001492 if ((n_ptr->action_flags & TIPC_WAIT_PEER_LINKS_DOWN) &&
Ying Xue10f465c2014-05-05 08:56:11 +08001493 msg_user(msg) == LINK_PROTOCOL &&
1494 (msg_type(msg) == RESET_MSG ||
1495 msg_type(msg) == ACTIVATE_MSG) &&
1496 !msg_redundant_link(msg))
Ying Xueaecb9bb2014-05-08 08:54:39 +08001497 n_ptr->action_flags &= ~TIPC_WAIT_PEER_LINKS_DOWN;
Allan Stephensb4b56102011-05-27 11:00:51 -04001498
Ying Xue10f465c2014-05-05 08:56:11 +08001499 if (tipc_node_blocked(n_ptr))
Ying Xue3af390e2013-10-30 11:26:57 +08001500 goto unlock_discard;
Allan Stephensb4b56102011-05-27 11:00:51 -04001501
Allan Stephens85035562008-04-15 19:04:54 -07001502 /* Validate message sequence number info */
Allan Stephens85035562008-04-15 19:04:54 -07001503 seq_no = msg_seqno(msg);
1504 ackd = msg_ack(msg);
1505
1506 /* Release acked messages */
Ying Xue389dd9b2012-11-16 13:51:30 +08001507 if (n_ptr->bclink.recv_permitted)
Allan Stephens365595912011-10-24 15:26:24 -04001508 tipc_bclink_acknowledge(n_ptr, msg_bcast_ack(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001509
1510 crs = l_ptr->first_out;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001511 while ((crs != l_ptr->next_out) &&
Allan Stephensf9057302011-10-24 16:03:12 -04001512 less_eq(buf_seqno(crs), ackd)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001513 struct sk_buff *next = crs->next;
Allan Stephens5f6d9122011-11-04 13:24:29 -04001514 kfree_skb(crs);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001515 crs = next;
1516 released++;
1517 }
1518 if (released) {
1519 l_ptr->first_out = crs;
1520 l_ptr->out_queue_size -= released;
1521 }
Allan Stephens85035562008-04-15 19:04:54 -07001522
1523 /* Try sending any messages link endpoint has pending */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001524 if (unlikely(l_ptr->next_out))
Per Liden4323add2006-01-18 00:38:21 +01001525 tipc_link_push_queue(l_ptr);
Jon Paul Maloya5377832014-02-13 17:29:15 -05001526
Per Lidenb97bf3f2006-01-02 19:04:38 +01001527 if (unlikely(!list_empty(&l_ptr->waiting_ports)))
Per Liden4323add2006-01-18 00:38:21 +01001528 tipc_link_wakeup_ports(l_ptr, 0);
Jon Paul Maloya5377832014-02-13 17:29:15 -05001529
Per Lidenb97bf3f2006-01-02 19:04:38 +01001530 if (unlikely(++l_ptr->unacked_window >= TIPC_MIN_LINK_WIN)) {
1531 l_ptr->stats.sent_acks++;
Ying Xue247f0f32014-02-18 16:06:46 +08001532 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001533 }
1534
Jon Paul Maloya5377832014-02-13 17:29:15 -05001535 /* Process the incoming packet */
Ying Xue3af390e2013-10-30 11:26:57 +08001536 if (unlikely(!link_working_working(l_ptr))) {
1537 if (msg_user(msg) == LINK_PROTOCOL) {
Ying Xue247f0f32014-02-18 16:06:46 +08001538 tipc_link_proto_rcv(l_ptr, buf);
Ying Xue3af390e2013-10-30 11:26:57 +08001539 head = link_insert_deferred_queue(l_ptr, head);
Per Liden4323add2006-01-18 00:38:21 +01001540 tipc_node_unlock(n_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001541 continue;
1542 }
Ying Xue3af390e2013-10-30 11:26:57 +08001543
1544 /* Traffic message. Conditionally activate link */
1545 link_state_event(l_ptr, TRAFFIC_MSG_EVT);
1546
1547 if (link_working_working(l_ptr)) {
1548 /* Re-insert buffer in front of queue */
1549 buf->next = head;
1550 head = buf;
1551 tipc_node_unlock(n_ptr);
1552 continue;
1553 }
1554 goto unlock_discard;
1555 }
1556
1557 /* Link is now in state WORKING_WORKING */
1558 if (unlikely(seq_no != mod(l_ptr->next_in_no))) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001559 link_handle_out_of_seq_msg(l_ptr, buf);
1560 head = link_insert_deferred_queue(l_ptr, head);
Per Liden4323add2006-01-18 00:38:21 +01001561 tipc_node_unlock(n_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001562 continue;
1563 }
Ying Xue3af390e2013-10-30 11:26:57 +08001564 l_ptr->next_in_no++;
1565 if (unlikely(l_ptr->oldest_deferred_in))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001566 head = link_insert_deferred_queue(l_ptr, head);
Jon Paul Maloya5377832014-02-13 17:29:15 -05001567
1568 /* Deliver packet/message to correct user: */
1569 if (unlikely(msg_user(msg) == CHANGEOVER_PROTOCOL)) {
1570 if (!tipc_link_tunnel_rcv(n_ptr, &buf)) {
1571 tipc_node_unlock(n_ptr);
1572 continue;
1573 }
1574 msg = buf_msg(buf);
1575 } else if (msg_user(msg) == MSG_FRAGMENTER) {
1576 int rc;
1577
1578 l_ptr->stats.recv_fragments++;
1579 rc = tipc_link_frag_rcv(&l_ptr->reasm_head,
1580 &l_ptr->reasm_tail,
1581 &buf);
1582 if (rc == LINK_REASM_COMPLETE) {
1583 l_ptr->stats.recv_fragmented++;
1584 msg = buf_msg(buf);
1585 } else {
1586 if (rc == LINK_REASM_ERROR)
1587 tipc_link_reset(l_ptr);
1588 tipc_node_unlock(n_ptr);
1589 continue;
1590 }
1591 }
1592
1593 switch (msg_user(msg)) {
1594 case TIPC_LOW_IMPORTANCE:
1595 case TIPC_MEDIUM_IMPORTANCE:
1596 case TIPC_HIGH_IMPORTANCE:
1597 case TIPC_CRITICAL_IMPORTANCE:
Per Liden4323add2006-01-18 00:38:21 +01001598 tipc_node_unlock(n_ptr);
Ying Xue247f0f32014-02-18 16:06:46 +08001599 tipc_port_rcv(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001600 continue;
Ying Xue3af390e2013-10-30 11:26:57 +08001601 case MSG_BUNDLER:
1602 l_ptr->stats.recv_bundles++;
1603 l_ptr->stats.recv_bundled += msg_msgcnt(msg);
1604 tipc_node_unlock(n_ptr);
Ying Xue247f0f32014-02-18 16:06:46 +08001605 tipc_link_bundle_rcv(buf);
Ying Xue3af390e2013-10-30 11:26:57 +08001606 continue;
1607 case NAME_DISTRIBUTOR:
1608 n_ptr->bclink.recv_permitted = true;
1609 tipc_node_unlock(n_ptr);
Ying Xue247f0f32014-02-18 16:06:46 +08001610 tipc_named_rcv(buf);
Ying Xue3af390e2013-10-30 11:26:57 +08001611 continue;
Ying Xue3af390e2013-10-30 11:26:57 +08001612 case CONN_MANAGER:
1613 tipc_node_unlock(n_ptr);
Ying Xue247f0f32014-02-18 16:06:46 +08001614 tipc_port_proto_rcv(buf);
Ying Xue3af390e2013-10-30 11:26:57 +08001615 continue;
Jon Paul Maloya5377832014-02-13 17:29:15 -05001616 case BCAST_PROTOCOL:
Ying Xue247f0f32014-02-18 16:06:46 +08001617 tipc_link_sync_rcv(n_ptr, buf);
Jon Paul Maloya5377832014-02-13 17:29:15 -05001618 break;
Ying Xue3af390e2013-10-30 11:26:57 +08001619 default:
1620 kfree_skb(buf);
Ying Xue3af390e2013-10-30 11:26:57 +08001621 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001622 }
Per Liden4323add2006-01-18 00:38:21 +01001623 tipc_node_unlock(n_ptr);
Ying Xue3af390e2013-10-30 11:26:57 +08001624 continue;
1625unlock_discard:
Ying Xue3af390e2013-10-30 11:26:57 +08001626 tipc_node_unlock(n_ptr);
1627discard:
Allan Stephens5f6d9122011-11-04 13:24:29 -04001628 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001629 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001630}
1631
Ben Hutchings2c530402012-07-10 10:55:09 +00001632/**
Allan Stephens8809b252011-10-25 10:44:35 -04001633 * tipc_link_defer_pkt - Add out-of-sequence message to deferred reception queue
1634 *
1635 * Returns increase in queue length (i.e. 0 or 1)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001636 */
Allan Stephens8809b252011-10-25 10:44:35 -04001637u32 tipc_link_defer_pkt(struct sk_buff **head, struct sk_buff **tail,
Per Liden4323add2006-01-18 00:38:21 +01001638 struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001639{
Allan Stephens8809b252011-10-25 10:44:35 -04001640 struct sk_buff *queue_buf;
1641 struct sk_buff **prev;
Allan Stephensf9057302011-10-24 16:03:12 -04001642 u32 seq_no = buf_seqno(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001643
1644 buf->next = NULL;
1645
1646 /* Empty queue ? */
1647 if (*head == NULL) {
1648 *head = *tail = buf;
1649 return 1;
1650 }
1651
1652 /* Last ? */
Allan Stephensf9057302011-10-24 16:03:12 -04001653 if (less(buf_seqno(*tail), seq_no)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001654 (*tail)->next = buf;
1655 *tail = buf;
1656 return 1;
1657 }
1658
Allan Stephens8809b252011-10-25 10:44:35 -04001659 /* Locate insertion point in queue, then insert; discard if duplicate */
1660 prev = head;
1661 queue_buf = *head;
1662 for (;;) {
1663 u32 curr_seqno = buf_seqno(queue_buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001664
Allan Stephens8809b252011-10-25 10:44:35 -04001665 if (seq_no == curr_seqno) {
Allan Stephens5f6d9122011-11-04 13:24:29 -04001666 kfree_skb(buf);
Allan Stephens8809b252011-10-25 10:44:35 -04001667 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001668 }
Allan Stephens8809b252011-10-25 10:44:35 -04001669
1670 if (less(seq_no, curr_seqno))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001671 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001672
Allan Stephens8809b252011-10-25 10:44:35 -04001673 prev = &queue_buf->next;
1674 queue_buf = queue_buf->next;
1675 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001676
Allan Stephens8809b252011-10-25 10:44:35 -04001677 buf->next = queue_buf;
1678 *prev = buf;
1679 return 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001680}
1681
Allan Stephens8809b252011-10-25 10:44:35 -04001682/*
Per Lidenb97bf3f2006-01-02 19:04:38 +01001683 * link_handle_out_of_seq_msg - handle arrival of out-of-sequence packet
1684 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001685static void link_handle_out_of_seq_msg(struct tipc_link *l_ptr,
Per Lidenb97bf3f2006-01-02 19:04:38 +01001686 struct sk_buff *buf)
1687{
Allan Stephensf9057302011-10-24 16:03:12 -04001688 u32 seq_no = buf_seqno(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001689
1690 if (likely(msg_user(buf_msg(buf)) == LINK_PROTOCOL)) {
Ying Xue247f0f32014-02-18 16:06:46 +08001691 tipc_link_proto_rcv(l_ptr, buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001692 return;
1693 }
1694
Per Lidenb97bf3f2006-01-02 19:04:38 +01001695 /* Record OOS packet arrival (force mismatch on next timeout) */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001696 l_ptr->checkpoint--;
1697
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001698 /*
Per Lidenb97bf3f2006-01-02 19:04:38 +01001699 * Discard packet if a duplicate; otherwise add it to deferred queue
1700 * and notify peer of gap as per protocol specification
1701 */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001702 if (less(seq_no, mod(l_ptr->next_in_no))) {
1703 l_ptr->stats.duplicates++;
Allan Stephens5f6d9122011-11-04 13:24:29 -04001704 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001705 return;
1706 }
1707
Per Liden4323add2006-01-18 00:38:21 +01001708 if (tipc_link_defer_pkt(&l_ptr->oldest_deferred_in,
1709 &l_ptr->newest_deferred_in, buf)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001710 l_ptr->deferred_inqueue_sz++;
1711 l_ptr->stats.deferred_recv++;
Erik Hugne64380a02014-02-11 11:38:26 +01001712 TIPC_SKB_CB(buf)->deferred = true;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001713 if ((l_ptr->deferred_inqueue_sz % 16) == 1)
Ying Xue247f0f32014-02-18 16:06:46 +08001714 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001715 } else
1716 l_ptr->stats.duplicates++;
1717}
1718
1719/*
1720 * Send protocol message to the other endpoint.
1721 */
Ying Xue247f0f32014-02-18 16:06:46 +08001722void tipc_link_proto_xmit(struct tipc_link *l_ptr, u32 msg_typ, int probe_msg,
1723 u32 gap, u32 tolerance, u32 priority, u32 ack_mtu)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001724{
Sam Ravnborg1fc54d82006-03-20 22:36:47 -08001725 struct sk_buff *buf = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001726 struct tipc_msg *msg = l_ptr->pmsg;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001727 u32 msg_size = sizeof(l_ptr->proto_msg);
Allan Stephens75f0aa42011-02-28 15:30:20 -05001728 int r_flag;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001729
Allan Stephens92d2c902011-10-25 11:20:26 -04001730 /* Discard any previous message that was deferred due to congestion */
Allan Stephens92d2c902011-10-25 11:20:26 -04001731 if (l_ptr->proto_msg_queue) {
Allan Stephens5f6d9122011-11-04 13:24:29 -04001732 kfree_skb(l_ptr->proto_msg_queue);
Allan Stephens92d2c902011-10-25 11:20:26 -04001733 l_ptr->proto_msg_queue = NULL;
1734 }
1735
Ying Xue77a7e072013-12-10 20:45:44 -08001736 /* Don't send protocol message during link changeover */
1737 if (l_ptr->exp_msg_count)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001738 return;
Allan Stephensb4b56102011-05-27 11:00:51 -04001739
1740 /* Abort non-RESET send if communication with node is prohibited */
Ying Xue10f465c2014-05-05 08:56:11 +08001741 if ((tipc_node_blocked(l_ptr->owner)) && (msg_typ != RESET_MSG))
Allan Stephensb4b56102011-05-27 11:00:51 -04001742 return;
1743
Allan Stephens92d2c902011-10-25 11:20:26 -04001744 /* Create protocol message with "out-of-sequence" sequence number */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001745 msg_set_type(msg, msg_typ);
Ying Xue7a2f7d12014-04-21 10:55:46 +08001746 msg_set_net_plane(msg, l_ptr->net_plane);
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001747 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Per Liden4323add2006-01-18 00:38:21 +01001748 msg_set_last_bcast(msg, tipc_bclink_get_last_sent());
Per Lidenb97bf3f2006-01-02 19:04:38 +01001749
1750 if (msg_typ == STATE_MSG) {
1751 u32 next_sent = mod(l_ptr->next_out_no);
1752
Per Liden4323add2006-01-18 00:38:21 +01001753 if (!tipc_link_is_up(l_ptr))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001754 return;
1755 if (l_ptr->next_out)
Allan Stephensf9057302011-10-24 16:03:12 -04001756 next_sent = buf_seqno(l_ptr->next_out);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001757 msg_set_next_sent(msg, next_sent);
1758 if (l_ptr->oldest_deferred_in) {
Allan Stephensf9057302011-10-24 16:03:12 -04001759 u32 rec = buf_seqno(l_ptr->oldest_deferred_in);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001760 gap = mod(rec - mod(l_ptr->next_in_no));
1761 }
1762 msg_set_seq_gap(msg, gap);
1763 if (gap)
1764 l_ptr->stats.sent_nacks++;
1765 msg_set_link_tolerance(msg, tolerance);
1766 msg_set_linkprio(msg, priority);
1767 msg_set_max_pkt(msg, ack_mtu);
1768 msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
1769 msg_set_probe(msg, probe_msg != 0);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001770 if (probe_msg) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001771 u32 mtu = l_ptr->max_pkt;
1772
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001773 if ((mtu < l_ptr->max_pkt_target) &&
Per Lidenb97bf3f2006-01-02 19:04:38 +01001774 link_working_working(l_ptr) &&
1775 l_ptr->fsm_msg_cnt) {
1776 msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001777 if (l_ptr->max_pkt_probes == 10) {
1778 l_ptr->max_pkt_target = (msg_size - 4);
1779 l_ptr->max_pkt_probes = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001780 msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001781 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001782 l_ptr->max_pkt_probes++;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001783 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001784
1785 l_ptr->stats.sent_probes++;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001786 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001787 l_ptr->stats.sent_states++;
1788 } else { /* RESET_MSG or ACTIVATE_MSG */
1789 msg_set_ack(msg, mod(l_ptr->reset_checkpoint - 1));
1790 msg_set_seq_gap(msg, 0);
1791 msg_set_next_sent(msg, 1);
Allan Stephensf23d9bf2011-01-18 15:15:34 -05001792 msg_set_probe(msg, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001793 msg_set_link_tolerance(msg, l_ptr->tolerance);
1794 msg_set_linkprio(msg, l_ptr->priority);
1795 msg_set_max_pkt(msg, l_ptr->max_pkt_target);
1796 }
1797
Allan Stephens75f0aa42011-02-28 15:30:20 -05001798 r_flag = (l_ptr->owner->working_links > tipc_link_is_up(l_ptr));
1799 msg_set_redundant_link(msg, r_flag);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001800 msg_set_linkprio(msg, l_ptr->priority);
Allan Stephens92d2c902011-10-25 11:20:26 -04001801 msg_set_size(msg, msg_size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001802
1803 msg_set_seqno(msg, mod(l_ptr->next_out_no + (0xffff/2)));
1804
stephen hemminger31e3c3f2010-10-13 13:20:35 +00001805 buf = tipc_buf_acquire(msg_size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001806 if (!buf)
1807 return;
1808
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03001809 skb_copy_to_linear_data(buf, msg, sizeof(l_ptr->proto_msg));
Ying Xue796c75d2013-06-17 10:54:48 -04001810 buf->priority = TC_PRIO_CONTROL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001811
Ying Xue7a2f7d12014-04-21 10:55:46 +08001812 tipc_bearer_send(l_ptr->bearer_id, buf, &l_ptr->media_addr);
Allan Stephens92d2c902011-10-25 11:20:26 -04001813 l_ptr->unacked_window = 0;
Allan Stephens5f6d9122011-11-04 13:24:29 -04001814 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001815}
1816
1817/*
1818 * Receive protocol message :
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001819 * Note that network plane id propagates through the network, and may
1820 * change at any time. The node with lowest address rules
Per Lidenb97bf3f2006-01-02 19:04:38 +01001821 */
Ying Xue247f0f32014-02-18 16:06:46 +08001822static void tipc_link_proto_rcv(struct tipc_link *l_ptr, struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001823{
1824 u32 rec_gap = 0;
1825 u32 max_pkt_info;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001826 u32 max_pkt_ack;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001827 u32 msg_tol;
1828 struct tipc_msg *msg = buf_msg(buf);
1829
Ying Xue77a7e072013-12-10 20:45:44 -08001830 /* Discard protocol message during link changeover */
1831 if (l_ptr->exp_msg_count)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001832 goto exit;
1833
Ying Xue7a2f7d12014-04-21 10:55:46 +08001834 if (l_ptr->net_plane != msg_net_plane(msg))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001835 if (tipc_own_addr > msg_prevnode(msg))
Ying Xue7a2f7d12014-04-21 10:55:46 +08001836 l_ptr->net_plane = msg_net_plane(msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001837
Per Lidenb97bf3f2006-01-02 19:04:38 +01001838 switch (msg_type(msg)) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001839
Per Lidenb97bf3f2006-01-02 19:04:38 +01001840 case RESET_MSG:
Allan Stephensa686e682008-06-04 17:29:39 -07001841 if (!link_working_unknown(l_ptr) &&
1842 (l_ptr->peer_session != INVALID_SESSION)) {
Allan Stephens641c2182011-04-07 09:54:43 -04001843 if (less_eq(msg_session(msg), l_ptr->peer_session))
1844 break; /* duplicate or old reset: ignore */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001845 }
Allan Stephensb4b56102011-05-27 11:00:51 -04001846
1847 if (!msg_redundant_link(msg) && (link_working_working(l_ptr) ||
1848 link_working_unknown(l_ptr))) {
1849 /*
1850 * peer has lost contact -- don't allow peer's links
1851 * to reactivate before we recognize loss & clean up
1852 */
Ying Xueca9cf062014-05-08 08:54:40 +08001853 l_ptr->owner->action_flags |= TIPC_WAIT_OWN_LINKS_DOWN;
Allan Stephensb4b56102011-05-27 11:00:51 -04001854 }
1855
Allan Stephens47361c82011-10-26 10:55:16 -04001856 link_state_event(l_ptr, RESET_MSG);
1857
Per Lidenb97bf3f2006-01-02 19:04:38 +01001858 /* fall thru' */
1859 case ACTIVATE_MSG:
1860 /* Update link settings according other endpoint's values */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001861 strcpy((strrchr(l_ptr->name, ':') + 1), (char *)msg_data(msg));
1862
Allan Stephens2db99832010-12-31 18:59:33 +00001863 msg_tol = msg_link_tolerance(msg);
1864 if (msg_tol > l_ptr->tolerance)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001865 link_set_supervision_props(l_ptr, msg_tol);
1866
1867 if (msg_linkprio(msg) > l_ptr->priority)
1868 l_ptr->priority = msg_linkprio(msg);
1869
1870 max_pkt_info = msg_max_pkt(msg);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001871 if (max_pkt_info) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001872 if (max_pkt_info < l_ptr->max_pkt_target)
1873 l_ptr->max_pkt_target = max_pkt_info;
1874 if (l_ptr->max_pkt > l_ptr->max_pkt_target)
1875 l_ptr->max_pkt = l_ptr->max_pkt_target;
1876 } else {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001877 l_ptr->max_pkt = l_ptr->max_pkt_target;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001878 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001879
Allan Stephens4d753132011-10-25 12:19:05 -04001880 /* Synchronize broadcast link info, if not done previously */
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001881 if (!tipc_node_is_up(l_ptr->owner)) {
1882 l_ptr->owner->bclink.last_sent =
1883 l_ptr->owner->bclink.last_in =
1884 msg_last_bcast(msg);
1885 l_ptr->owner->bclink.oos_state = 0;
1886 }
Allan Stephens4d753132011-10-25 12:19:05 -04001887
Per Lidenb97bf3f2006-01-02 19:04:38 +01001888 l_ptr->peer_session = msg_session(msg);
1889 l_ptr->peer_bearer_id = msg_bearer_id(msg);
Allan Stephens47361c82011-10-26 10:55:16 -04001890
1891 if (msg_type(msg) == ACTIVATE_MSG)
1892 link_state_event(l_ptr, ACTIVATE_MSG);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001893 break;
1894 case STATE_MSG:
1895
Allan Stephens2db99832010-12-31 18:59:33 +00001896 msg_tol = msg_link_tolerance(msg);
1897 if (msg_tol)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001898 link_set_supervision_props(l_ptr, msg_tol);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001899
1900 if (msg_linkprio(msg) &&
Per Lidenb97bf3f2006-01-02 19:04:38 +01001901 (msg_linkprio(msg) != l_ptr->priority)) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001902 pr_warn("%s<%s>, priority change %u->%u\n",
1903 link_rst_msg, l_ptr->name, l_ptr->priority,
1904 msg_linkprio(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001905 l_ptr->priority = msg_linkprio(msg);
Per Liden4323add2006-01-18 00:38:21 +01001906 tipc_link_reset(l_ptr); /* Enforce change to take effect */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001907 break;
1908 }
Jon Paul Maloyec37dcd2014-05-14 05:39:10 -04001909
1910 /* Record reception; force mismatch at next timeout: */
1911 l_ptr->checkpoint--;
1912
Per Lidenb97bf3f2006-01-02 19:04:38 +01001913 link_state_event(l_ptr, TRAFFIC_MSG_EVT);
1914 l_ptr->stats.recv_states++;
1915 if (link_reset_unknown(l_ptr))
1916 break;
1917
1918 if (less_eq(mod(l_ptr->next_in_no), msg_next_sent(msg))) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001919 rec_gap = mod(msg_next_sent(msg) -
Per Lidenb97bf3f2006-01-02 19:04:38 +01001920 mod(l_ptr->next_in_no));
1921 }
1922
1923 max_pkt_ack = msg_max_pkt(msg);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001924 if (max_pkt_ack > l_ptr->max_pkt) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001925 l_ptr->max_pkt = max_pkt_ack;
1926 l_ptr->max_pkt_probes = 0;
1927 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001928
1929 max_pkt_ack = 0;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001930 if (msg_probe(msg)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001931 l_ptr->stats.recv_probes++;
Allan Stephensa0168922010-12-31 18:59:35 +00001932 if (msg_size(msg) > sizeof(l_ptr->proto_msg))
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001933 max_pkt_ack = msg_size(msg);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001934 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001935
1936 /* Protocol message before retransmits, reduce loss risk */
Ying Xue389dd9b2012-11-16 13:51:30 +08001937 if (l_ptr->owner->bclink.recv_permitted)
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001938 tipc_bclink_update_link_state(l_ptr->owner,
1939 msg_last_bcast(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001940
1941 if (rec_gap || (msg_probe(msg))) {
Ying Xue247f0f32014-02-18 16:06:46 +08001942 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, rec_gap, 0,
1943 0, max_pkt_ack);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001944 }
1945 if (msg_seq_gap(msg)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001946 l_ptr->stats.recv_nacks++;
Per Liden4323add2006-01-18 00:38:21 +01001947 tipc_link_retransmit(l_ptr, l_ptr->first_out,
1948 msg_seq_gap(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001949 }
1950 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001951 }
1952exit:
Allan Stephens5f6d9122011-11-04 13:24:29 -04001953 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001954}
1955
1956
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001957/* tipc_link_tunnel_xmit(): Tunnel one packet via a link belonging to
1958 * a different bearer. Owner node is locked.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001959 */
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001960static void tipc_link_tunnel_xmit(struct tipc_link *l_ptr,
1961 struct tipc_msg *tunnel_hdr,
1962 struct tipc_msg *msg,
1963 u32 selector)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001964{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001965 struct tipc_link *tunnel;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001966 struct sk_buff *buf;
1967 u32 length = msg_size(msg);
1968
1969 tunnel = l_ptr->owner->active_links[selector & 1];
Allan Stephens5392d642006-06-25 23:52:50 -07001970 if (!tipc_link_is_up(tunnel)) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001971 pr_warn("%stunnel link no longer available\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001972 return;
Allan Stephens5392d642006-06-25 23:52:50 -07001973 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001974 msg_set_size(tunnel_hdr, length + INT_H_SIZE);
stephen hemminger31e3c3f2010-10-13 13:20:35 +00001975 buf = tipc_buf_acquire(length + INT_H_SIZE);
Allan Stephens5392d642006-06-25 23:52:50 -07001976 if (!buf) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001977 pr_warn("%sunable to send tunnel msg\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001978 return;
Allan Stephens5392d642006-06-25 23:52:50 -07001979 }
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03001980 skb_copy_to_linear_data(buf, tunnel_hdr, INT_H_SIZE);
1981 skb_copy_to_linear_data_offset(buf, INT_H_SIZE, msg, length);
Ying Xue247f0f32014-02-18 16:06:46 +08001982 __tipc_link_xmit(tunnel, buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001983}
1984
1985
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001986/* tipc_link_failover_send_queue(): A link has gone down, but a second
1987 * link is still active. We can do failover. Tunnel the failing link's
1988 * whole send queue via the remaining link. This way, we don't lose
1989 * any packets, and sequence order is preserved for subsequent traffic
1990 * sent over the remaining link. Owner node is locked.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001991 */
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001992void tipc_link_failover_send_queue(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001993{
1994 u32 msgcount = l_ptr->out_queue_size;
1995 struct sk_buff *crs = l_ptr->first_out;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001996 struct tipc_link *tunnel = l_ptr->owner->active_links[0];
Per Lidenb97bf3f2006-01-02 19:04:38 +01001997 struct tipc_msg tunnel_hdr;
Allan Stephens5392d642006-06-25 23:52:50 -07001998 int split_bundles;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001999
2000 if (!tunnel)
2001 return;
2002
Allan Stephensc68ca7b2010-05-11 14:30:12 +00002003 tipc_msg_init(&tunnel_hdr, CHANGEOVER_PROTOCOL,
Allan Stephens75715212008-06-04 17:37:34 -07002004 ORIGINAL_MSG, INT_H_SIZE, l_ptr->addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002005 msg_set_bearer_id(&tunnel_hdr, l_ptr->peer_bearer_id);
2006 msg_set_msgcnt(&tunnel_hdr, msgcount);
Allan Stephensf1310722006-06-25 23:51:37 -07002007
Per Lidenb97bf3f2006-01-02 19:04:38 +01002008 if (!l_ptr->first_out) {
2009 struct sk_buff *buf;
2010
stephen hemminger31e3c3f2010-10-13 13:20:35 +00002011 buf = tipc_buf_acquire(INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002012 if (buf) {
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03002013 skb_copy_to_linear_data(buf, &tunnel_hdr, INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002014 msg_set_size(&tunnel_hdr, INT_H_SIZE);
Ying Xue247f0f32014-02-18 16:06:46 +08002015 __tipc_link_xmit(tunnel, buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002016 } else {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04002017 pr_warn("%sunable to send changeover msg\n",
2018 link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002019 }
2020 return;
2021 }
Allan Stephensf1310722006-06-25 23:51:37 -07002022
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002023 split_bundles = (l_ptr->owner->active_links[0] !=
Allan Stephens5392d642006-06-25 23:52:50 -07002024 l_ptr->owner->active_links[1]);
2025
Per Lidenb97bf3f2006-01-02 19:04:38 +01002026 while (crs) {
2027 struct tipc_msg *msg = buf_msg(crs);
2028
2029 if ((msg_user(msg) == MSG_BUNDLER) && split_bundles) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01002030 struct tipc_msg *m = msg_get_wrapped(msg);
Allan Stephens0e659672010-12-31 18:59:32 +00002031 unchar *pos = (unchar *)m;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002032
Florian Westphald788d802007-08-02 19:28:06 -07002033 msgcount = msg_msgcnt(msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002034 while (msgcount--) {
Allan Stephens0e659672010-12-31 18:59:32 +00002035 msg_set_seqno(m, msg_seqno(msg));
Jon Paul Maloy170b3922014-01-07 17:02:41 -05002036 tipc_link_tunnel_xmit(l_ptr, &tunnel_hdr, m,
2037 msg_link_selector(m));
Per Lidenb97bf3f2006-01-02 19:04:38 +01002038 pos += align(msg_size(m));
2039 m = (struct tipc_msg *)pos;
2040 }
2041 } else {
Jon Paul Maloy170b3922014-01-07 17:02:41 -05002042 tipc_link_tunnel_xmit(l_ptr, &tunnel_hdr, msg,
2043 msg_link_selector(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01002044 }
2045 crs = crs->next;
2046 }
2047}
2048
Ying Xue247f0f32014-02-18 16:06:46 +08002049/* tipc_link_dup_queue_xmit(): A second link has become active. Tunnel a
Jon Paul Maloy170b3922014-01-07 17:02:41 -05002050 * duplicate of the first link's send queue via the new link. This way, we
2051 * are guaranteed that currently queued packets from a socket are delivered
2052 * before future traffic from the same socket, even if this is using the
2053 * new link. The last arriving copy of each duplicate packet is dropped at
2054 * the receiving end by the regular protocol check, so packet cardinality
2055 * and sequence order is preserved per sender/receiver socket pair.
2056 * Owner node is locked.
2057 */
Ying Xue247f0f32014-02-18 16:06:46 +08002058void tipc_link_dup_queue_xmit(struct tipc_link *l_ptr,
Jon Paul Maloy170b3922014-01-07 17:02:41 -05002059 struct tipc_link *tunnel)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002060{
2061 struct sk_buff *iter;
2062 struct tipc_msg tunnel_hdr;
2063
Allan Stephensc68ca7b2010-05-11 14:30:12 +00002064 tipc_msg_init(&tunnel_hdr, CHANGEOVER_PROTOCOL,
Allan Stephens75715212008-06-04 17:37:34 -07002065 DUPLICATE_MSG, INT_H_SIZE, l_ptr->addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002066 msg_set_msgcnt(&tunnel_hdr, l_ptr->out_queue_size);
2067 msg_set_bearer_id(&tunnel_hdr, l_ptr->peer_bearer_id);
2068 iter = l_ptr->first_out;
2069 while (iter) {
2070 struct sk_buff *outbuf;
2071 struct tipc_msg *msg = buf_msg(iter);
2072 u32 length = msg_size(msg);
2073
2074 if (msg_user(msg) == MSG_BUNDLER)
2075 msg_set_type(msg, CLOSED_MSG);
2076 msg_set_ack(msg, mod(l_ptr->next_in_no - 1)); /* Update */
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002077 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002078 msg_set_size(&tunnel_hdr, length + INT_H_SIZE);
stephen hemminger31e3c3f2010-10-13 13:20:35 +00002079 outbuf = tipc_buf_acquire(length + INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002080 if (outbuf == NULL) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04002081 pr_warn("%sunable to send duplicate msg\n",
2082 link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002083 return;
2084 }
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03002085 skb_copy_to_linear_data(outbuf, &tunnel_hdr, INT_H_SIZE);
2086 skb_copy_to_linear_data_offset(outbuf, INT_H_SIZE, iter->data,
2087 length);
Ying Xue247f0f32014-02-18 16:06:46 +08002088 __tipc_link_xmit(tunnel, outbuf);
Per Liden4323add2006-01-18 00:38:21 +01002089 if (!tipc_link_is_up(l_ptr))
Per Lidenb97bf3f2006-01-02 19:04:38 +01002090 return;
2091 iter = iter->next;
2092 }
2093}
2094
Per Lidenb97bf3f2006-01-02 19:04:38 +01002095/**
2096 * buf_extract - extracts embedded TIPC message from another message
2097 * @skb: encapsulating message buffer
2098 * @from_pos: offset to extract from
2099 *
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002100 * Returns a new message buffer containing an embedded message. The
Per Lidenb97bf3f2006-01-02 19:04:38 +01002101 * encapsulating message itself is left unchanged.
2102 */
Per Lidenb97bf3f2006-01-02 19:04:38 +01002103static struct sk_buff *buf_extract(struct sk_buff *skb, u32 from_pos)
2104{
2105 struct tipc_msg *msg = (struct tipc_msg *)(skb->data + from_pos);
2106 u32 size = msg_size(msg);
2107 struct sk_buff *eb;
2108
stephen hemminger31e3c3f2010-10-13 13:20:35 +00002109 eb = tipc_buf_acquire(size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002110 if (eb)
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03002111 skb_copy_to_linear_data(eb, msg, size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002112 return eb;
2113}
2114
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05002115
2116
2117/* tipc_link_dup_rcv(): Receive a tunnelled DUPLICATE_MSG packet.
2118 * Owner node is locked.
2119 */
2120static void tipc_link_dup_rcv(struct tipc_link *l_ptr,
2121 struct sk_buff *t_buf)
2122{
2123 struct sk_buff *buf;
2124
2125 if (!tipc_link_is_up(l_ptr))
2126 return;
2127
2128 buf = buf_extract(t_buf, INT_H_SIZE);
2129 if (buf == NULL) {
2130 pr_warn("%sfailed to extract inner dup pkt\n", link_co_err);
2131 return;
2132 }
2133
2134 /* Add buffer to deferred queue, if applicable: */
2135 link_handle_out_of_seq_msg(l_ptr, buf);
2136}
2137
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05002138/* tipc_link_failover_rcv(): Receive a tunnelled ORIGINAL_MSG packet
2139 * Owner node is locked.
2140 */
2141static struct sk_buff *tipc_link_failover_rcv(struct tipc_link *l_ptr,
2142 struct sk_buff *t_buf)
2143{
2144 struct tipc_msg *t_msg = buf_msg(t_buf);
2145 struct sk_buff *buf = NULL;
2146 struct tipc_msg *msg;
2147
2148 if (tipc_link_is_up(l_ptr))
2149 tipc_link_reset(l_ptr);
2150
2151 /* First failover packet? */
2152 if (l_ptr->exp_msg_count == START_CHANGEOVER)
2153 l_ptr->exp_msg_count = msg_msgcnt(t_msg);
2154
2155 /* Should there be an inner packet? */
2156 if (l_ptr->exp_msg_count) {
2157 l_ptr->exp_msg_count--;
2158 buf = buf_extract(t_buf, INT_H_SIZE);
2159 if (buf == NULL) {
2160 pr_warn("%sno inner failover pkt\n", link_co_err);
2161 goto exit;
2162 }
2163 msg = buf_msg(buf);
2164
2165 if (less(msg_seqno(msg), l_ptr->reset_checkpoint)) {
2166 kfree_skb(buf);
2167 buf = NULL;
2168 goto exit;
2169 }
2170 if (msg_user(msg) == MSG_FRAGMENTER) {
2171 l_ptr->stats.recv_fragments++;
2172 tipc_link_frag_rcv(&l_ptr->reasm_head,
2173 &l_ptr->reasm_tail,
2174 &buf);
2175 }
2176 }
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05002177exit:
Jon Paul Maloy7d339392014-02-13 17:29:16 -05002178 if ((l_ptr->exp_msg_count == 0) && (l_ptr->flags & LINK_STOPPED)) {
2179 tipc_node_detach_link(l_ptr->owner, l_ptr);
2180 kfree(l_ptr);
2181 }
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05002182 return buf;
2183}
2184
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05002185/* tipc_link_tunnel_rcv(): Receive a tunnelled packet, sent
Jon Paul Maloy170b3922014-01-07 17:02:41 -05002186 * via other link as result of a failover (ORIGINAL_MSG) or
2187 * a new active link (DUPLICATE_MSG). Failover packets are
2188 * returned to the active link for delivery upwards.
2189 * Owner node is locked.
Per Lidenb97bf3f2006-01-02 19:04:38 +01002190 */
Jon Paul Maloy3bb53382014-02-13 17:29:12 -05002191static int tipc_link_tunnel_rcv(struct tipc_node *n_ptr,
Jon Paul Maloy170b3922014-01-07 17:02:41 -05002192 struct sk_buff **buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002193{
Jon Paul Maloy02842f72014-02-13 17:29:14 -05002194 struct sk_buff *t_buf = *buf;
2195 struct tipc_link *l_ptr;
2196 struct tipc_msg *t_msg = buf_msg(t_buf);
2197 u32 bearer_id = msg_bearer_id(t_msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002198
Jon Paul Maloy1e9d47a2014-02-13 17:29:13 -05002199 *buf = NULL;
2200
Dan Carpentercb4b102f2013-05-06 08:28:41 +00002201 if (bearer_id >= MAX_BEARERS)
2202 goto exit;
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05002203
Jon Paul Maloy02842f72014-02-13 17:29:14 -05002204 l_ptr = n_ptr->links[bearer_id];
2205 if (!l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002206 goto exit;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002207
Jon Paul Maloy02842f72014-02-13 17:29:14 -05002208 if (msg_type(t_msg) == DUPLICATE_MSG)
2209 tipc_link_dup_rcv(l_ptr, t_buf);
2210 else if (msg_type(t_msg) == ORIGINAL_MSG)
2211 *buf = tipc_link_failover_rcv(l_ptr, t_buf);
Jon Paul Maloy1e9d47a2014-02-13 17:29:13 -05002212 else
2213 pr_warn("%sunknown tunnel pkt received\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002214exit:
Jon Paul Maloy02842f72014-02-13 17:29:14 -05002215 kfree_skb(t_buf);
Jon Paul Maloy1e9d47a2014-02-13 17:29:13 -05002216 return *buf != NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002217}
2218
2219/*
2220 * Bundler functionality:
2221 */
Ying Xue247f0f32014-02-18 16:06:46 +08002222void tipc_link_bundle_rcv(struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002223{
2224 u32 msgcount = msg_msgcnt(buf_msg(buf));
2225 u32 pos = INT_H_SIZE;
2226 struct sk_buff *obuf;
2227
Per Lidenb97bf3f2006-01-02 19:04:38 +01002228 while (msgcount--) {
2229 obuf = buf_extract(buf, pos);
2230 if (obuf == NULL) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04002231 pr_warn("Link unable to unbundle message(s)\n");
Allan Stephensa10bd922006-06-25 23:52:17 -07002232 break;
Stephen Hemminger3ff50b72007-04-20 17:09:22 -07002233 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01002234 pos += align(msg_size(buf_msg(obuf)));
Per Liden4323add2006-01-18 00:38:21 +01002235 tipc_net_route_msg(obuf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002236 }
Allan Stephens5f6d9122011-11-04 13:24:29 -04002237 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002238}
2239
2240/*
2241 * Fragmentation/defragmentation:
2242 */
2243
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002244/*
Ying Xue247f0f32014-02-18 16:06:46 +08002245 * tipc_link_frag_xmit: Entry for buffers needing fragmentation.
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002246 * The buffer is complete, inclusive total message length.
Per Lidenb97bf3f2006-01-02 19:04:38 +01002247 * Returns user data length.
2248 */
Ying Xue247f0f32014-02-18 16:06:46 +08002249static int tipc_link_frag_xmit(struct tipc_link *l_ptr, struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002250{
Allan Stephens77561552011-04-17 13:06:23 -04002251 struct sk_buff *buf_chain = NULL;
2252 struct sk_buff *buf_chain_tail = (struct sk_buff *)&buf_chain;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002253 struct tipc_msg *inmsg = buf_msg(buf);
2254 struct tipc_msg fragm_hdr;
2255 u32 insize = msg_size(inmsg);
2256 u32 dsz = msg_data_sz(inmsg);
2257 unchar *crs = buf->data;
2258 u32 rest = insize;
Allan Stephens15e979d2010-05-11 14:30:10 +00002259 u32 pack_sz = l_ptr->max_pkt;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002260 u32 fragm_sz = pack_sz - INT_H_SIZE;
Allan Stephens77561552011-04-17 13:06:23 -04002261 u32 fragm_no = 0;
Allan Stephens9c396a72008-06-04 17:36:58 -07002262 u32 destaddr;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002263
2264 if (msg_short(inmsg))
2265 destaddr = l_ptr->addr;
Allan Stephens9c396a72008-06-04 17:36:58 -07002266 else
2267 destaddr = msg_destnode(inmsg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002268
Per Lidenb97bf3f2006-01-02 19:04:38 +01002269 /* Prepare reusable fragment header: */
Allan Stephensc68ca7b2010-05-11 14:30:12 +00002270 tipc_msg_init(&fragm_hdr, MSG_FRAGMENTER, FIRST_FRAGMENT,
Allan Stephens75715212008-06-04 17:37:34 -07002271 INT_H_SIZE, destaddr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002272
2273 /* Chop up message: */
Per Lidenb97bf3f2006-01-02 19:04:38 +01002274 while (rest > 0) {
2275 struct sk_buff *fragm;
2276
2277 if (rest <= fragm_sz) {
2278 fragm_sz = rest;
2279 msg_set_type(&fragm_hdr, LAST_FRAGMENT);
2280 }
stephen hemminger31e3c3f2010-10-13 13:20:35 +00002281 fragm = tipc_buf_acquire(fragm_sz + INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002282 if (fragm == NULL) {
Allan Stephens5f6d9122011-11-04 13:24:29 -04002283 kfree_skb(buf);
Ying Xued77b3832013-12-10 20:45:38 -08002284 kfree_skb_list(buf_chain);
Allan Stephens77561552011-04-17 13:06:23 -04002285 return -ENOMEM;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002286 }
2287 msg_set_size(&fragm_hdr, fragm_sz + INT_H_SIZE);
Allan Stephens77561552011-04-17 13:06:23 -04002288 fragm_no++;
2289 msg_set_fragm_no(&fragm_hdr, fragm_no);
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03002290 skb_copy_to_linear_data(fragm, &fragm_hdr, INT_H_SIZE);
2291 skb_copy_to_linear_data_offset(fragm, INT_H_SIZE, crs,
2292 fragm_sz);
Allan Stephens77561552011-04-17 13:06:23 -04002293 buf_chain_tail->next = fragm;
2294 buf_chain_tail = fragm;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002295
Per Lidenb97bf3f2006-01-02 19:04:38 +01002296 rest -= fragm_sz;
2297 crs += fragm_sz;
2298 msg_set_type(&fragm_hdr, FRAGMENT);
2299 }
Allan Stephens5f6d9122011-11-04 13:24:29 -04002300 kfree_skb(buf);
Allan Stephens77561552011-04-17 13:06:23 -04002301
2302 /* Append chain of fragments to send queue & send them */
Allan Stephens77561552011-04-17 13:06:23 -04002303 l_ptr->long_msg_seq_no++;
2304 link_add_chain_to_outqueue(l_ptr, buf_chain, l_ptr->long_msg_seq_no);
2305 l_ptr->stats.sent_fragments += fragm_no;
2306 l_ptr->stats.sent_fragmented++;
2307 tipc_link_push_queue(l_ptr);
2308
Per Lidenb97bf3f2006-01-02 19:04:38 +01002309 return dsz;
2310}
2311
Jon Paul Maloy03b92012014-02-13 17:29:05 -05002312/* tipc_link_frag_rcv(): Called with node lock on. Returns
Per Lidenb97bf3f2006-01-02 19:04:38 +01002313 * the reassembled buffer if message is complete.
2314 */
Jon Paul Maloy03b92012014-02-13 17:29:05 -05002315int tipc_link_frag_rcv(struct sk_buff **head, struct sk_buff **tail,
2316 struct sk_buff **fbuf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002317{
Erik Hugne40ba3cd2013-11-06 09:28:06 +01002318 struct sk_buff *frag = *fbuf;
2319 struct tipc_msg *msg = buf_msg(frag);
2320 u32 fragid = msg_type(msg);
2321 bool headstolen;
2322 int delta;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002323
Erik Hugne40ba3cd2013-11-06 09:28:06 +01002324 skb_pull(frag, msg_hdr_sz(msg));
2325 if (fragid == FIRST_FRAGMENT) {
2326 if (*head || skb_unclone(frag, GFP_ATOMIC))
2327 goto out_free;
2328 *head = frag;
2329 skb_frag_list_init(*head);
Jon Paul Maloy03b92012014-02-13 17:29:05 -05002330 *fbuf = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002331 return 0;
Erik Hugne3db0a192013-11-13 09:35:11 +01002332 } else if (*head &&
2333 skb_try_coalesce(*head, frag, &headstolen, &delta)) {
Erik Hugne40ba3cd2013-11-06 09:28:06 +01002334 kfree_skb_partial(frag, headstolen);
2335 } else {
2336 if (!*head)
2337 goto out_free;
2338 if (!skb_has_frag_list(*head))
2339 skb_shinfo(*head)->frag_list = frag;
2340 else
2341 (*tail)->next = frag;
2342 *tail = frag;
2343 (*head)->truesize += frag->truesize;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002344 }
Erik Hugne40ba3cd2013-11-06 09:28:06 +01002345 if (fragid == LAST_FRAGMENT) {
2346 *fbuf = *head;
2347 *tail = *head = NULL;
2348 return LINK_REASM_COMPLETE;
2349 }
Jon Paul Maloy03b92012014-02-13 17:29:05 -05002350 *fbuf = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002351 return 0;
Erik Hugne40ba3cd2013-11-06 09:28:06 +01002352out_free:
2353 pr_warn_ratelimited("Link unable to reassemble fragmented message\n");
2354 kfree_skb(*fbuf);
Jon Paul Maloy03b92012014-02-13 17:29:05 -05002355 *fbuf = NULL;
Erik Hugne40ba3cd2013-11-06 09:28:06 +01002356 return LINK_REASM_ERROR;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002357}
2358
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002359static void link_set_supervision_props(struct tipc_link *l_ptr, u32 tolerance)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002360{
Allan Stephens5413b4c2011-01-18 13:24:55 -05002361 if ((tolerance < TIPC_MIN_LINK_TOL) || (tolerance > TIPC_MAX_LINK_TOL))
2362 return;
2363
Per Lidenb97bf3f2006-01-02 19:04:38 +01002364 l_ptr->tolerance = tolerance;
2365 l_ptr->continuity_interval =
2366 ((tolerance / 4) > 500) ? 500 : tolerance / 4;
2367 l_ptr->abort_limit = tolerance / (l_ptr->continuity_interval / 4);
2368}
2369
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002370void tipc_link_set_queue_limits(struct tipc_link *l_ptr, u32 window)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002371{
2372 /* Data messages from this node, inclusive FIRST_FRAGM */
Allan Stephens06d82c92008-03-06 15:06:55 -08002373 l_ptr->queue_limit[TIPC_LOW_IMPORTANCE] = window;
2374 l_ptr->queue_limit[TIPC_MEDIUM_IMPORTANCE] = (window / 3) * 4;
2375 l_ptr->queue_limit[TIPC_HIGH_IMPORTANCE] = (window / 3) * 5;
2376 l_ptr->queue_limit[TIPC_CRITICAL_IMPORTANCE] = (window / 3) * 6;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002377 /* Transiting data messages,inclusive FIRST_FRAGM */
Allan Stephens06d82c92008-03-06 15:06:55 -08002378 l_ptr->queue_limit[TIPC_LOW_IMPORTANCE + 4] = 300;
2379 l_ptr->queue_limit[TIPC_MEDIUM_IMPORTANCE + 4] = 600;
2380 l_ptr->queue_limit[TIPC_HIGH_IMPORTANCE + 4] = 900;
2381 l_ptr->queue_limit[TIPC_CRITICAL_IMPORTANCE + 4] = 1200;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002382 l_ptr->queue_limit[CONN_MANAGER] = 1200;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002383 l_ptr->queue_limit[CHANGEOVER_PROTOCOL] = 2500;
2384 l_ptr->queue_limit[NAME_DISTRIBUTOR] = 3000;
2385 /* FRAGMENT and LAST_FRAGMENT packets */
2386 l_ptr->queue_limit[MSG_FRAGMENTER] = 4000;
2387}
2388
Jon Paul Maloye099e862014-02-13 17:29:18 -05002389/* tipc_link_find_owner - locate owner node of link by link's name
2390 * @name: pointer to link name string
2391 * @bearer_id: pointer to index in 'node->links' array where the link was found.
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002392 *
Jon Paul Maloye099e862014-02-13 17:29:18 -05002393 * Returns pointer to node owning the link, or 0 if no matching link is found.
Per Lidenb97bf3f2006-01-02 19:04:38 +01002394 */
Jon Paul Maloye099e862014-02-13 17:29:18 -05002395static struct tipc_node *tipc_link_find_owner(const char *link_name,
2396 unsigned int *bearer_id)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002397{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002398 struct tipc_link *l_ptr;
Erik Hugnebbfbe472013-10-18 07:23:21 +02002399 struct tipc_node *n_ptr;
Jon Paul Maloye099e862014-02-13 17:29:18 -05002400 struct tipc_node *found_node = 0;
Erik Hugnebbfbe472013-10-18 07:23:21 +02002401 int i;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002402
Jon Paul Maloye099e862014-02-13 17:29:18 -05002403 *bearer_id = 0;
Ying Xue6c7a7622014-03-27 12:54:37 +08002404 rcu_read_lock();
2405 list_for_each_entry_rcu(n_ptr, &tipc_node_list, list) {
Jon Paul Maloya11607f2014-02-14 16:40:44 -05002406 tipc_node_lock(n_ptr);
Erik Hugnebbfbe472013-10-18 07:23:21 +02002407 for (i = 0; i < MAX_BEARERS; i++) {
2408 l_ptr = n_ptr->links[i];
Jon Paul Maloye099e862014-02-13 17:29:18 -05002409 if (l_ptr && !strcmp(l_ptr->name, link_name)) {
2410 *bearer_id = i;
2411 found_node = n_ptr;
2412 break;
2413 }
Erik Hugnebbfbe472013-10-18 07:23:21 +02002414 }
Jon Paul Maloya11607f2014-02-14 16:40:44 -05002415 tipc_node_unlock(n_ptr);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002416 if (found_node)
2417 break;
Erik Hugnebbfbe472013-10-18 07:23:21 +02002418 }
Ying Xue6c7a7622014-03-27 12:54:37 +08002419 rcu_read_unlock();
2420
Jon Paul Maloye099e862014-02-13 17:29:18 -05002421 return found_node;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002422}
2423
Allan Stephens5c216e12011-10-18 11:34:29 -04002424/**
2425 * link_value_is_valid -- validate proposed link tolerance/priority/window
2426 *
Ben Hutchings2c530402012-07-10 10:55:09 +00002427 * @cmd: value type (TIPC_CMD_SET_LINK_*)
2428 * @new_value: the new value
Allan Stephens5c216e12011-10-18 11:34:29 -04002429 *
2430 * Returns 1 if value is within range, 0 if not.
2431 */
Allan Stephens5c216e12011-10-18 11:34:29 -04002432static int link_value_is_valid(u16 cmd, u32 new_value)
2433{
2434 switch (cmd) {
2435 case TIPC_CMD_SET_LINK_TOL:
2436 return (new_value >= TIPC_MIN_LINK_TOL) &&
2437 (new_value <= TIPC_MAX_LINK_TOL);
2438 case TIPC_CMD_SET_LINK_PRI:
2439 return (new_value <= TIPC_MAX_LINK_PRI);
2440 case TIPC_CMD_SET_LINK_WINDOW:
2441 return (new_value >= TIPC_MIN_LINK_WIN) &&
2442 (new_value <= TIPC_MAX_LINK_WIN);
2443 }
2444 return 0;
2445}
2446
Allan Stephens5c216e12011-10-18 11:34:29 -04002447/**
2448 * link_cmd_set_value - change priority/tolerance/window for link/bearer/media
Ben Hutchings2c530402012-07-10 10:55:09 +00002449 * @name: ptr to link, bearer, or media name
2450 * @new_value: new value of link, bearer, or media setting
2451 * @cmd: which link, bearer, or media attribute to set (TIPC_CMD_SET_LINK_*)
Allan Stephens5c216e12011-10-18 11:34:29 -04002452 *
Ying Xue7216cd92014-04-21 10:55:48 +08002453 * Caller must hold RTNL lock to ensure link/bearer/media is not deleted.
Allan Stephens5c216e12011-10-18 11:34:29 -04002454 *
2455 * Returns 0 if value updated and negative value on error.
2456 */
Allan Stephens5c216e12011-10-18 11:34:29 -04002457static int link_cmd_set_value(const char *name, u32 new_value, u16 cmd)
2458{
2459 struct tipc_node *node;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002460 struct tipc_link *l_ptr;
Allan Stephens5c216e12011-10-18 11:34:29 -04002461 struct tipc_bearer *b_ptr;
Paul Gortmaker358a0d12011-12-29 20:19:42 -05002462 struct tipc_media *m_ptr;
Jon Paul Maloye099e862014-02-13 17:29:18 -05002463 int bearer_id;
Ying Xue636c0372013-10-18 07:23:20 +02002464 int res = 0;
Allan Stephens5c216e12011-10-18 11:34:29 -04002465
Jon Paul Maloye099e862014-02-13 17:29:18 -05002466 node = tipc_link_find_owner(name, &bearer_id);
2467 if (node) {
Allan Stephens5c216e12011-10-18 11:34:29 -04002468 tipc_node_lock(node);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002469 l_ptr = node->links[bearer_id];
2470
2471 if (l_ptr) {
2472 switch (cmd) {
2473 case TIPC_CMD_SET_LINK_TOL:
2474 link_set_supervision_props(l_ptr, new_value);
Ying Xue247f0f32014-02-18 16:06:46 +08002475 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0,
2476 new_value, 0, 0);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002477 break;
2478 case TIPC_CMD_SET_LINK_PRI:
2479 l_ptr->priority = new_value;
Ying Xue247f0f32014-02-18 16:06:46 +08002480 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0,
2481 0, new_value, 0);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002482 break;
2483 case TIPC_CMD_SET_LINK_WINDOW:
2484 tipc_link_set_queue_limits(l_ptr, new_value);
2485 break;
2486 default:
2487 res = -EINVAL;
2488 break;
2489 }
Allan Stephens5c216e12011-10-18 11:34:29 -04002490 }
2491 tipc_node_unlock(node);
Ying Xue636c0372013-10-18 07:23:20 +02002492 return res;
Allan Stephens5c216e12011-10-18 11:34:29 -04002493 }
2494
2495 b_ptr = tipc_bearer_find(name);
2496 if (b_ptr) {
2497 switch (cmd) {
2498 case TIPC_CMD_SET_LINK_TOL:
2499 b_ptr->tolerance = new_value;
Ying Xue636c0372013-10-18 07:23:20 +02002500 break;
Allan Stephens5c216e12011-10-18 11:34:29 -04002501 case TIPC_CMD_SET_LINK_PRI:
2502 b_ptr->priority = new_value;
Ying Xue636c0372013-10-18 07:23:20 +02002503 break;
Allan Stephens5c216e12011-10-18 11:34:29 -04002504 case TIPC_CMD_SET_LINK_WINDOW:
2505 b_ptr->window = new_value;
Ying Xue636c0372013-10-18 07:23:20 +02002506 break;
2507 default:
2508 res = -EINVAL;
2509 break;
Allan Stephens5c216e12011-10-18 11:34:29 -04002510 }
Ying Xue636c0372013-10-18 07:23:20 +02002511 return res;
Allan Stephens5c216e12011-10-18 11:34:29 -04002512 }
2513
2514 m_ptr = tipc_media_find(name);
2515 if (!m_ptr)
2516 return -ENODEV;
2517 switch (cmd) {
2518 case TIPC_CMD_SET_LINK_TOL:
2519 m_ptr->tolerance = new_value;
Ying Xue636c0372013-10-18 07:23:20 +02002520 break;
Allan Stephens5c216e12011-10-18 11:34:29 -04002521 case TIPC_CMD_SET_LINK_PRI:
2522 m_ptr->priority = new_value;
Ying Xue636c0372013-10-18 07:23:20 +02002523 break;
Allan Stephens5c216e12011-10-18 11:34:29 -04002524 case TIPC_CMD_SET_LINK_WINDOW:
2525 m_ptr->window = new_value;
Ying Xue636c0372013-10-18 07:23:20 +02002526 break;
2527 default:
2528 res = -EINVAL;
2529 break;
Allan Stephens5c216e12011-10-18 11:34:29 -04002530 }
Ying Xue636c0372013-10-18 07:23:20 +02002531 return res;
Allan Stephens5c216e12011-10-18 11:34:29 -04002532}
2533
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002534struct sk_buff *tipc_link_cmd_config(const void *req_tlv_area, int req_tlv_space,
Per Liden4323add2006-01-18 00:38:21 +01002535 u16 cmd)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002536{
2537 struct tipc_link_config *args;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002538 u32 new_value;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002539 int res;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002540
2541 if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_LINK_CONFIG))
Per Liden4323add2006-01-18 00:38:21 +01002542 return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002543
2544 args = (struct tipc_link_config *)TLV_DATA(req_tlv_area);
2545 new_value = ntohl(args->value);
2546
Allan Stephens5c216e12011-10-18 11:34:29 -04002547 if (!link_value_is_valid(cmd, new_value))
2548 return tipc_cfg_reply_error_string(
2549 "cannot change, value invalid");
2550
Per Liden4323add2006-01-18 00:38:21 +01002551 if (!strcmp(args->name, tipc_bclink_name)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01002552 if ((cmd == TIPC_CMD_SET_LINK_WINDOW) &&
Per Liden4323add2006-01-18 00:38:21 +01002553 (tipc_bclink_set_queue_limits(new_value) == 0))
2554 return tipc_cfg_reply_none();
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002555 return tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED
Per Liden4323add2006-01-18 00:38:21 +01002556 " (cannot change setting on broadcast link)");
Per Lidenb97bf3f2006-01-02 19:04:38 +01002557 }
2558
Allan Stephens5c216e12011-10-18 11:34:29 -04002559 res = link_cmd_set_value(args->name, new_value, cmd);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002560 if (res)
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002561 return tipc_cfg_reply_error_string("cannot change link setting");
Per Lidenb97bf3f2006-01-02 19:04:38 +01002562
Per Liden4323add2006-01-18 00:38:21 +01002563 return tipc_cfg_reply_none();
Per Lidenb97bf3f2006-01-02 19:04:38 +01002564}
2565
2566/**
2567 * link_reset_statistics - reset link statistics
2568 * @l_ptr: pointer to link
2569 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002570static void link_reset_statistics(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002571{
2572 memset(&l_ptr->stats, 0, sizeof(l_ptr->stats));
2573 l_ptr->stats.sent_info = l_ptr->next_out_no;
2574 l_ptr->stats.recv_info = l_ptr->next_in_no;
2575}
2576
Per Liden4323add2006-01-18 00:38:21 +01002577struct sk_buff *tipc_link_cmd_reset_stats(const void *req_tlv_area, int req_tlv_space)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002578{
2579 char *link_name;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002580 struct tipc_link *l_ptr;
David S. Miller6c000552008-09-02 23:38:32 -07002581 struct tipc_node *node;
Jon Paul Maloye099e862014-02-13 17:29:18 -05002582 unsigned int bearer_id;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002583
2584 if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_LINK_NAME))
Per Liden4323add2006-01-18 00:38:21 +01002585 return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002586
2587 link_name = (char *)TLV_DATA(req_tlv_area);
Per Liden4323add2006-01-18 00:38:21 +01002588 if (!strcmp(link_name, tipc_bclink_name)) {
2589 if (tipc_bclink_reset_stats())
2590 return tipc_cfg_reply_error_string("link not found");
2591 return tipc_cfg_reply_none();
Per Lidenb97bf3f2006-01-02 19:04:38 +01002592 }
Jon Paul Maloye099e862014-02-13 17:29:18 -05002593 node = tipc_link_find_owner(link_name, &bearer_id);
Ying Xue7216cd92014-04-21 10:55:48 +08002594 if (!node)
Per Liden4323add2006-01-18 00:38:21 +01002595 return tipc_cfg_reply_error_string("link not found");
Ying Xue7216cd92014-04-21 10:55:48 +08002596
Jon Paul Maloya11607f2014-02-14 16:40:44 -05002597 tipc_node_lock(node);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002598 l_ptr = node->links[bearer_id];
2599 if (!l_ptr) {
2600 tipc_node_unlock(node);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002601 return tipc_cfg_reply_error_string("link not found");
2602 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01002603 link_reset_statistics(l_ptr);
Per Liden4323add2006-01-18 00:38:21 +01002604 tipc_node_unlock(node);
Per Liden4323add2006-01-18 00:38:21 +01002605 return tipc_cfg_reply_none();
Per Lidenb97bf3f2006-01-02 19:04:38 +01002606}
2607
2608/**
2609 * percent - convert count to a percentage of total (rounding up or down)
2610 */
Per Lidenb97bf3f2006-01-02 19:04:38 +01002611static u32 percent(u32 count, u32 total)
2612{
2613 return (count * 100 + (total / 2)) / total;
2614}
2615
2616/**
Per Liden4323add2006-01-18 00:38:21 +01002617 * tipc_link_stats - print link statistics
Per Lidenb97bf3f2006-01-02 19:04:38 +01002618 * @name: link name
2619 * @buf: print buffer area
2620 * @buf_size: size of print buffer area
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002621 *
Per Lidenb97bf3f2006-01-02 19:04:38 +01002622 * Returns length of print buffer data string (or 0 if error)
2623 */
Per Liden4323add2006-01-18 00:38:21 +01002624static int tipc_link_stats(const char *name, char *buf, const u32 buf_size)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002625{
Erik Hugnedc1aed32012-06-29 00:50:23 -04002626 struct tipc_link *l;
2627 struct tipc_stats *s;
David S. Miller6c000552008-09-02 23:38:32 -07002628 struct tipc_node *node;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002629 char *status;
2630 u32 profile_total = 0;
Jon Paul Maloye099e862014-02-13 17:29:18 -05002631 unsigned int bearer_id;
Erik Hugnedc1aed32012-06-29 00:50:23 -04002632 int ret;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002633
Per Liden4323add2006-01-18 00:38:21 +01002634 if (!strcmp(name, tipc_bclink_name))
2635 return tipc_bclink_stats(buf, buf_size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002636
Jon Paul Maloye099e862014-02-13 17:29:18 -05002637 node = tipc_link_find_owner(name, &bearer_id);
Ying Xue7216cd92014-04-21 10:55:48 +08002638 if (!node)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002639 return 0;
Ying Xue7216cd92014-04-21 10:55:48 +08002640
Per Liden4323add2006-01-18 00:38:21 +01002641 tipc_node_lock(node);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002642
2643 l = node->links[bearer_id];
2644 if (!l) {
2645 tipc_node_unlock(node);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002646 return 0;
2647 }
2648
Erik Hugnedc1aed32012-06-29 00:50:23 -04002649 s = &l->stats;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002650
Erik Hugnedc1aed32012-06-29 00:50:23 -04002651 if (tipc_link_is_active(l))
Per Lidenb97bf3f2006-01-02 19:04:38 +01002652 status = "ACTIVE";
Erik Hugnedc1aed32012-06-29 00:50:23 -04002653 else if (tipc_link_is_up(l))
Per Lidenb97bf3f2006-01-02 19:04:38 +01002654 status = "STANDBY";
2655 else
2656 status = "DEFUNCT";
Erik Hugnedc1aed32012-06-29 00:50:23 -04002657
2658 ret = tipc_snprintf(buf, buf_size, "Link <%s>\n"
2659 " %s MTU:%u Priority:%u Tolerance:%u ms"
2660 " Window:%u packets\n",
2661 l->name, status, l->max_pkt, l->priority,
2662 l->tolerance, l->queue_limit[0]);
2663
2664 ret += tipc_snprintf(buf + ret, buf_size - ret,
2665 " RX packets:%u fragments:%u/%u bundles:%u/%u\n",
2666 l->next_in_no - s->recv_info, s->recv_fragments,
2667 s->recv_fragmented, s->recv_bundles,
2668 s->recv_bundled);
2669
2670 ret += tipc_snprintf(buf + ret, buf_size - ret,
2671 " TX packets:%u fragments:%u/%u bundles:%u/%u\n",
2672 l->next_out_no - s->sent_info, s->sent_fragments,
2673 s->sent_fragmented, s->sent_bundles,
2674 s->sent_bundled);
2675
2676 profile_total = s->msg_length_counts;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002677 if (!profile_total)
2678 profile_total = 1;
Erik Hugnedc1aed32012-06-29 00:50:23 -04002679
2680 ret += tipc_snprintf(buf + ret, buf_size - ret,
2681 " TX profile sample:%u packets average:%u octets\n"
2682 " 0-64:%u%% -256:%u%% -1024:%u%% -4096:%u%% "
2683 "-16384:%u%% -32768:%u%% -66000:%u%%\n",
2684 s->msg_length_counts,
2685 s->msg_lengths_total / profile_total,
2686 percent(s->msg_length_profile[0], profile_total),
2687 percent(s->msg_length_profile[1], profile_total),
2688 percent(s->msg_length_profile[2], profile_total),
2689 percent(s->msg_length_profile[3], profile_total),
2690 percent(s->msg_length_profile[4], profile_total),
2691 percent(s->msg_length_profile[5], profile_total),
2692 percent(s->msg_length_profile[6], profile_total));
2693
2694 ret += tipc_snprintf(buf + ret, buf_size - ret,
2695 " RX states:%u probes:%u naks:%u defs:%u"
2696 " dups:%u\n", s->recv_states, s->recv_probes,
2697 s->recv_nacks, s->deferred_recv, s->duplicates);
2698
2699 ret += tipc_snprintf(buf + ret, buf_size - ret,
2700 " TX states:%u probes:%u naks:%u acks:%u"
2701 " dups:%u\n", s->sent_states, s->sent_probes,
2702 s->sent_nacks, s->sent_acks, s->retransmitted);
2703
2704 ret += tipc_snprintf(buf + ret, buf_size - ret,
Ying Xue3c294cb2012-11-15 11:34:45 +08002705 " Congestion link:%u Send queue"
2706 " max:%u avg:%u\n", s->link_congs,
Erik Hugnedc1aed32012-06-29 00:50:23 -04002707 s->max_queue_sz, s->queue_sz_counts ?
2708 (s->accu_queue_sz / s->queue_sz_counts) : 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002709
Per Liden4323add2006-01-18 00:38:21 +01002710 tipc_node_unlock(node);
Erik Hugnedc1aed32012-06-29 00:50:23 -04002711 return ret;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002712}
2713
Per Liden4323add2006-01-18 00:38:21 +01002714struct sk_buff *tipc_link_cmd_show_stats(const void *req_tlv_area, int req_tlv_space)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002715{
2716 struct sk_buff *buf;
2717 struct tlv_desc *rep_tlv;
2718 int str_len;
Erik Hugnedc1aed32012-06-29 00:50:23 -04002719 int pb_len;
2720 char *pb;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002721
2722 if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_LINK_NAME))
Per Liden4323add2006-01-18 00:38:21 +01002723 return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002724
Erik Hugnedc1aed32012-06-29 00:50:23 -04002725 buf = tipc_cfg_reply_alloc(TLV_SPACE(ULTRA_STRING_MAX_LEN));
Per Lidenb97bf3f2006-01-02 19:04:38 +01002726 if (!buf)
2727 return NULL;
2728
2729 rep_tlv = (struct tlv_desc *)buf->data;
Erik Hugnedc1aed32012-06-29 00:50:23 -04002730 pb = TLV_DATA(rep_tlv);
2731 pb_len = ULTRA_STRING_MAX_LEN;
Per Liden4323add2006-01-18 00:38:21 +01002732 str_len = tipc_link_stats((char *)TLV_DATA(req_tlv_area),
Erik Hugnedc1aed32012-06-29 00:50:23 -04002733 pb, pb_len);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002734 if (!str_len) {
Allan Stephens5f6d9122011-11-04 13:24:29 -04002735 kfree_skb(buf);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002736 return tipc_cfg_reply_error_string("link not found");
Per Lidenb97bf3f2006-01-02 19:04:38 +01002737 }
Erik Hugnedc1aed32012-06-29 00:50:23 -04002738 str_len += 1; /* for "\0" */
Per Lidenb97bf3f2006-01-02 19:04:38 +01002739 skb_put(buf, TLV_SPACE(str_len));
2740 TLV_SET(rep_tlv, TIPC_TLV_ULTRA_STRING, NULL, str_len);
2741
2742 return buf;
2743}
2744
Per Lidenb97bf3f2006-01-02 19:04:38 +01002745/**
Per Liden4323add2006-01-18 00:38:21 +01002746 * tipc_link_get_max_pkt - get maximum packet size to use when sending to destination
Per Lidenb97bf3f2006-01-02 19:04:38 +01002747 * @dest: network address of destination node
2748 * @selector: used to select from set of active links
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002749 *
Per Lidenb97bf3f2006-01-02 19:04:38 +01002750 * If no active link can be found, uses default maximum packet size.
2751 */
Per Liden4323add2006-01-18 00:38:21 +01002752u32 tipc_link_get_max_pkt(u32 dest, u32 selector)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002753{
David S. Miller6c000552008-09-02 23:38:32 -07002754 struct tipc_node *n_ptr;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002755 struct tipc_link *l_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002756 u32 res = MAX_PKT_DEFAULT;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002757
Per Lidenb97bf3f2006-01-02 19:04:38 +01002758 if (dest == tipc_own_addr)
2759 return MAX_MSG_SIZE;
2760
Allan Stephens51a8e4d2010-12-31 18:59:18 +00002761 n_ptr = tipc_node_find(dest);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002762 if (n_ptr) {
Per Liden4323add2006-01-18 00:38:21 +01002763 tipc_node_lock(n_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002764 l_ptr = n_ptr->active_links[selector & 1];
2765 if (l_ptr)
Allan Stephens15e979d2010-05-11 14:30:10 +00002766 res = l_ptr->max_pkt;
Per Liden4323add2006-01-18 00:38:21 +01002767 tipc_node_unlock(n_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002768 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01002769 return res;
2770}
2771
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002772static void link_print(struct tipc_link *l_ptr, const char *str)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002773{
Ying Xue7a2f7d12014-04-21 10:55:46 +08002774 struct tipc_bearer *b_ptr;
2775
2776 rcu_read_lock();
2777 b_ptr = rcu_dereference_rtnl(bearer_list[l_ptr->bearer_id]);
2778 if (b_ptr)
2779 pr_info("%s Link %x<%s>:", str, l_ptr->addr, b_ptr->name);
2780 rcu_read_unlock();
Allan Stephens8d64a5b2010-12-31 18:59:27 +00002781
Per Lidenb97bf3f2006-01-02 19:04:38 +01002782 if (link_working_unknown(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04002783 pr_cont(":WU\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00002784 else if (link_reset_reset(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04002785 pr_cont(":RR\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00002786 else if (link_reset_unknown(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04002787 pr_cont(":RU\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00002788 else if (link_working_working(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04002789 pr_cont(":WW\n");
2790 else
2791 pr_cont("\n");
Per Lidenb97bf3f2006-01-02 19:04:38 +01002792}