blob: e4f233d58d35c1d3f49be32787f7fac471ab9040 [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{
104 u32 max_pkt;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900105
Allan Stephens2d627b92011-01-07 13:00:11 -0500106 max_pkt = (l_ptr->b_ptr->mtu & ~3);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100107 if (max_pkt > MAX_MSG_SIZE)
108 max_pkt = MAX_MSG_SIZE;
109
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900110 l_ptr->max_pkt_target = max_pkt;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100111 if (l_ptr->max_pkt_target < MAX_PKT_DEFAULT)
112 l_ptr->max_pkt = l_ptr->max_pkt_target;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900113 else
Per Lidenb97bf3f2006-01-02 19:04:38 +0100114 l_ptr->max_pkt = MAX_PKT_DEFAULT;
115
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900116 l_ptr->max_pkt_probes = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100117}
118
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500119static u32 link_next_sent(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100120{
121 if (l_ptr->next_out)
Allan Stephensf9057302011-10-24 16:03:12 -0400122 return buf_seqno(l_ptr->next_out);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100123 return mod(l_ptr->next_out_no);
124}
125
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500126static u32 link_last_sent(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100127{
128 return mod(link_next_sent(l_ptr) - 1);
129}
130
131/*
Sam Ravnborg05790c62006-03-20 22:37:04 -0800132 * Simple non-static link routines (i.e. referenced outside this file)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100133 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500134int tipc_link_is_up(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100135{
136 if (!l_ptr)
137 return 0;
Eric Dumazeta02cec22010-09-22 20:43:57 +0000138 return link_working_working(l_ptr) || link_working_unknown(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100139}
140
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500141int tipc_link_is_active(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100142{
Eric Dumazeta02cec22010-09-22 20:43:57 +0000143 return (l_ptr->owner->active_links[0] == l_ptr) ||
144 (l_ptr->owner->active_links[1] == l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100145}
146
147/**
Per Lidenb97bf3f2006-01-02 19:04:38 +0100148 * link_timeout - handle expiration of link timer
149 * @l_ptr: pointer to link
Per Lidenb97bf3f2006-01-02 19:04:38 +0100150 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500151static void link_timeout(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100152{
Per Liden4323add2006-01-18 00:38:21 +0100153 tipc_node_lock(l_ptr->owner);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100154
155 /* update counters used in statistical profiling of send traffic */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100156 l_ptr->stats.accu_queue_sz += l_ptr->out_queue_size;
157 l_ptr->stats.queue_sz_counts++;
158
Per Lidenb97bf3f2006-01-02 19:04:38 +0100159 if (l_ptr->first_out) {
160 struct tipc_msg *msg = buf_msg(l_ptr->first_out);
161 u32 length = msg_size(msg);
162
Joe Perchesf64f9e72009-11-29 16:55:45 -0800163 if ((msg_user(msg) == MSG_FRAGMENTER) &&
164 (msg_type(msg) == FIRST_FRAGMENT)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100165 length = msg_size(msg_get_wrapped(msg));
166 }
167 if (length) {
168 l_ptr->stats.msg_lengths_total += length;
169 l_ptr->stats.msg_length_counts++;
170 if (length <= 64)
171 l_ptr->stats.msg_length_profile[0]++;
172 else if (length <= 256)
173 l_ptr->stats.msg_length_profile[1]++;
174 else if (length <= 1024)
175 l_ptr->stats.msg_length_profile[2]++;
176 else if (length <= 4096)
177 l_ptr->stats.msg_length_profile[3]++;
178 else if (length <= 16384)
179 l_ptr->stats.msg_length_profile[4]++;
180 else if (length <= 32768)
181 l_ptr->stats.msg_length_profile[5]++;
182 else
183 l_ptr->stats.msg_length_profile[6]++;
184 }
185 }
186
187 /* do all other link processing performed on a periodic basis */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100188
189 link_state_event(l_ptr, TIMEOUT_EVT);
190
191 if (l_ptr->next_out)
Per Liden4323add2006-01-18 00:38:21 +0100192 tipc_link_push_queue(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100193
Per Liden4323add2006-01-18 00:38:21 +0100194 tipc_node_unlock(l_ptr->owner);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100195}
196
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500197static void link_set_timer(struct tipc_link *l_ptr, u32 time)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100198{
199 k_start_timer(&l_ptr->timer, time);
200}
201
202/**
Per Liden4323add2006-01-18 00:38:21 +0100203 * tipc_link_create - create a new link
Allan Stephens37b9c082011-02-28 11:32:27 -0500204 * @n_ptr: pointer to associated node
Per Lidenb97bf3f2006-01-02 19:04:38 +0100205 * @b_ptr: pointer to associated bearer
Per Lidenb97bf3f2006-01-02 19:04:38 +0100206 * @media_addr: media address to use when sending messages over link
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900207 *
Per Lidenb97bf3f2006-01-02 19:04:38 +0100208 * Returns pointer to link.
209 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500210struct tipc_link *tipc_link_create(struct tipc_node *n_ptr,
Ying Xuec61dd612014-02-13 17:29:09 -0500211 struct tipc_bearer *b_ptr,
212 const struct tipc_media_addr *media_addr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100213{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500214 struct tipc_link *l_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100215 struct tipc_msg *msg;
216 char *if_name;
Allan Stephens37b9c082011-02-28 11:32:27 -0500217 char addr_string[16];
218 u32 peer = n_ptr->addr;
219
220 if (n_ptr->link_cnt >= 2) {
221 tipc_addr_string_fill(addr_string, n_ptr->addr);
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400222 pr_err("Attempt to establish third link to %s\n", addr_string);
Allan Stephens37b9c082011-02-28 11:32:27 -0500223 return NULL;
224 }
225
226 if (n_ptr->links[b_ptr->identity]) {
227 tipc_addr_string_fill(addr_string, n_ptr->addr);
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400228 pr_err("Attempt to establish second link on <%s> to %s\n",
229 b_ptr->name, addr_string);
Allan Stephens37b9c082011-02-28 11:32:27 -0500230 return NULL;
231 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100232
Panagiotis Issaris0da974f2006-07-21 14:51:30 -0700233 l_ptr = kzalloc(sizeof(*l_ptr), GFP_ATOMIC);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100234 if (!l_ptr) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400235 pr_warn("Link creation failed, no memory\n");
Per Lidenb97bf3f2006-01-02 19:04:38 +0100236 return NULL;
237 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100238
239 l_ptr->addr = peer;
Allan Stephens2d627b92011-01-07 13:00:11 -0500240 if_name = strchr(b_ptr->name, ':') + 1;
Allan Stephens062b4c92011-04-07 09:28:47 -0400241 sprintf(l_ptr->name, "%u.%u.%u:%s-%u.%u.%u:unknown",
Per Lidenb97bf3f2006-01-02 19:04:38 +0100242 tipc_zone(tipc_own_addr), tipc_cluster(tipc_own_addr),
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900243 tipc_node(tipc_own_addr),
Per Lidenb97bf3f2006-01-02 19:04:38 +0100244 if_name,
245 tipc_zone(peer), tipc_cluster(peer), tipc_node(peer));
Allan Stephens062b4c92011-04-07 09:28:47 -0400246 /* note: peer i/f name is updated by reset/activate message */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100247 memcpy(&l_ptr->media_addr, media_addr, sizeof(*media_addr));
Allan Stephens37b9c082011-02-28 11:32:27 -0500248 l_ptr->owner = n_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100249 l_ptr->checkpoint = 1;
Allan Stephensf882cb72011-04-07 09:43:27 -0400250 l_ptr->peer_session = INVALID_SESSION;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100251 l_ptr->b_ptr = b_ptr;
Allan Stephens5c216e12011-10-18 11:34:29 -0400252 link_set_supervision_props(l_ptr, b_ptr->tolerance);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100253 l_ptr->state = RESET_UNKNOWN;
254
255 l_ptr->pmsg = (struct tipc_msg *)&l_ptr->proto_msg;
256 msg = l_ptr->pmsg;
Allan Stephensc68ca7b2010-05-11 14:30:12 +0000257 tipc_msg_init(msg, LINK_PROTOCOL, RESET_MSG, INT_H_SIZE, l_ptr->addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100258 msg_set_size(msg, sizeof(l_ptr->proto_msg));
Allan Stephensa686e682008-06-04 17:29:39 -0700259 msg_set_session(msg, (tipc_random & 0xffff));
Per Lidenb97bf3f2006-01-02 19:04:38 +0100260 msg_set_bearer_id(msg, b_ptr->identity);
261 strcpy((char *)msg_data(msg), if_name);
262
263 l_ptr->priority = b_ptr->priority;
Allan Stephens5c216e12011-10-18 11:34:29 -0400264 tipc_link_set_queue_limits(l_ptr, b_ptr->window);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100265
266 link_init_max_pkt(l_ptr);
267
268 l_ptr->next_out_no = 1;
269 INIT_LIST_HEAD(&l_ptr->waiting_ports);
270
271 link_reset_statistics(l_ptr);
272
Allan Stephens37b9c082011-02-28 11:32:27 -0500273 tipc_node_attach_link(n_ptr, l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100274
Jon Paul Maloy170b3922014-01-07 17:02:41 -0500275 k_init_timer(&l_ptr->timer, (Handler)link_timeout,
276 (unsigned long)l_ptr);
Jon Paul Maloy581465f2014-01-07 17:02:44 -0500277
278 link_state_event(l_ptr, STARTING_EVT);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100279
Per Lidenb97bf3f2006-01-02 19:04:38 +0100280 return l_ptr;
281}
282
Per Lidenb97bf3f2006-01-02 19:04:38 +0100283
Jon Paul Maloy7d339392014-02-13 17:29:16 -0500284void tipc_link_delete_list(unsigned int bearer_id, bool shutting_down)
Ying Xue8d8439b2014-02-13 17:29:07 -0500285{
286 struct tipc_link *l_ptr;
Ying Xuec61dd612014-02-13 17:29:09 -0500287 struct tipc_node *n_ptr;
Ying Xue8d8439b2014-02-13 17:29:07 -0500288
Ying Xuec61dd612014-02-13 17:29:09 -0500289 list_for_each_entry(n_ptr, &tipc_node_list, list) {
290 spin_lock_bh(&n_ptr->lock);
291 l_ptr = n_ptr->links[bearer_id];
292 if (l_ptr) {
293 tipc_link_reset(l_ptr);
Jon Paul Maloy7d339392014-02-13 17:29:16 -0500294 if (shutting_down || !tipc_node_is_up(n_ptr)) {
295 tipc_node_detach_link(l_ptr->owner, l_ptr);
296 tipc_link_reset_fragments(l_ptr);
297 spin_unlock_bh(&n_ptr->lock);
Ying Xuec61dd612014-02-13 17:29:09 -0500298
Jon Paul Maloy7d339392014-02-13 17:29:16 -0500299 /* Nobody else can access this link now: */
300 del_timer_sync(&l_ptr->timer);
301 kfree(l_ptr);
302 } else {
303 /* Detach/delete when failover is finished: */
304 l_ptr->flags |= LINK_STOPPED;
305 spin_unlock_bh(&n_ptr->lock);
306 del_timer_sync(&l_ptr->timer);
307 }
Ying Xuec61dd612014-02-13 17:29:09 -0500308 continue;
309 }
310 spin_unlock_bh(&n_ptr->lock);
Ying Xue8d8439b2014-02-13 17:29:07 -0500311 }
312}
Per Lidenb97bf3f2006-01-02 19:04:38 +0100313
314/**
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900315 * link_schedule_port - schedule port for deferred sending
Per Lidenb97bf3f2006-01-02 19:04:38 +0100316 * @l_ptr: pointer to link
317 * @origport: reference to sending port
318 * @sz: amount of data to be sent
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900319 *
320 * Schedules port for renewed sending of messages after link congestion
Per Lidenb97bf3f2006-01-02 19:04:38 +0100321 * has abated.
322 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500323static int link_schedule_port(struct tipc_link *l_ptr, u32 origport, u32 sz)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100324{
Allan Stephens23dd4cc2011-01-07 11:43:40 -0500325 struct tipc_port *p_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100326
Per Liden4323add2006-01-18 00:38:21 +0100327 spin_lock_bh(&tipc_port_list_lock);
328 p_ptr = tipc_port_lock(origport);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100329 if (p_ptr) {
330 if (!p_ptr->wakeup)
331 goto exit;
332 if (!list_empty(&p_ptr->wait_list))
333 goto exit;
Allan Stephens23dd4cc2011-01-07 11:43:40 -0500334 p_ptr->congested = 1;
Allan Stephens15e979d2010-05-11 14:30:10 +0000335 p_ptr->waiting_pkts = 1 + ((sz - 1) / l_ptr->max_pkt);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100336 list_add_tail(&p_ptr->wait_list, &l_ptr->waiting_ports);
337 l_ptr->stats.link_congs++;
338exit:
Per Liden4323add2006-01-18 00:38:21 +0100339 tipc_port_unlock(p_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100340 }
Per Liden4323add2006-01-18 00:38:21 +0100341 spin_unlock_bh(&tipc_port_list_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100342 return -ELINKCONG;
343}
344
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500345void tipc_link_wakeup_ports(struct tipc_link *l_ptr, int all)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100346{
Allan Stephens23dd4cc2011-01-07 11:43:40 -0500347 struct tipc_port *p_ptr;
348 struct tipc_port *temp_p_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100349 int win = l_ptr->queue_limit[0] - l_ptr->out_queue_size;
350
351 if (all)
352 win = 100000;
353 if (win <= 0)
354 return;
Per Liden4323add2006-01-18 00:38:21 +0100355 if (!spin_trylock_bh(&tipc_port_list_lock))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100356 return;
357 if (link_congested(l_ptr))
358 goto exit;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900359 list_for_each_entry_safe(p_ptr, temp_p_ptr, &l_ptr->waiting_ports,
Per Lidenb97bf3f2006-01-02 19:04:38 +0100360 wait_list) {
361 if (win <= 0)
362 break;
363 list_del_init(&p_ptr->wait_list);
Allan Stephens23dd4cc2011-01-07 11:43:40 -0500364 spin_lock_bh(p_ptr->lock);
365 p_ptr->congested = 0;
366 p_ptr->wakeup(p_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100367 win -= p_ptr->waiting_pkts;
Allan Stephens23dd4cc2011-01-07 11:43:40 -0500368 spin_unlock_bh(p_ptr->lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100369 }
370
371exit:
Per Liden4323add2006-01-18 00:38:21 +0100372 spin_unlock_bh(&tipc_port_list_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100373}
374
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900375/**
Per Lidenb97bf3f2006-01-02 19:04:38 +0100376 * link_release_outqueue - purge link's outbound message queue
377 * @l_ptr: pointer to link
378 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500379static void link_release_outqueue(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100380{
Ying Xued77b3832013-12-10 20:45:38 -0800381 kfree_skb_list(l_ptr->first_out);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100382 l_ptr->first_out = NULL;
383 l_ptr->out_queue_size = 0;
384}
385
386/**
Per Liden4323add2006-01-18 00:38:21 +0100387 * tipc_link_reset_fragments - purge link's inbound message fragments queue
Per Lidenb97bf3f2006-01-02 19:04:38 +0100388 * @l_ptr: pointer to link
389 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500390void tipc_link_reset_fragments(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100391{
Erik Hugne40ba3cd2013-11-06 09:28:06 +0100392 kfree_skb(l_ptr->reasm_head);
393 l_ptr->reasm_head = NULL;
394 l_ptr->reasm_tail = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100395}
396
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900397/**
Jon Paul Maloy581465f2014-01-07 17:02:44 -0500398 * tipc_link_purge_queues - purge all pkt queues associated with link
Per Lidenb97bf3f2006-01-02 19:04:38 +0100399 * @l_ptr: pointer to link
400 */
Jon Paul Maloy581465f2014-01-07 17:02:44 -0500401void tipc_link_purge_queues(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100402{
Ying Xued77b3832013-12-10 20:45:38 -0800403 kfree_skb_list(l_ptr->oldest_deferred_in);
404 kfree_skb_list(l_ptr->first_out);
Per Liden4323add2006-01-18 00:38:21 +0100405 tipc_link_reset_fragments(l_ptr);
Allan Stephens5f6d9122011-11-04 13:24:29 -0400406 kfree_skb(l_ptr->proto_msg_queue);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100407 l_ptr->proto_msg_queue = NULL;
408}
409
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500410void tipc_link_reset(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100411{
Per Lidenb97bf3f2006-01-02 19:04:38 +0100412 u32 prev_state = l_ptr->state;
413 u32 checkpoint = l_ptr->next_in_no;
Allan Stephens5392d642006-06-25 23:52:50 -0700414 int was_active_link = tipc_link_is_active(l_ptr);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900415
Allan Stephensa686e682008-06-04 17:29:39 -0700416 msg_set_session(l_ptr->pmsg, ((msg_session(l_ptr->pmsg) + 1) & 0xffff));
Per Lidenb97bf3f2006-01-02 19:04:38 +0100417
Allan Stephensa686e682008-06-04 17:29:39 -0700418 /* Link is down, accept any session */
419 l_ptr->peer_session = INVALID_SESSION;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100420
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900421 /* Prepare for max packet size negotiation */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100422 link_init_max_pkt(l_ptr);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900423
Per Lidenb97bf3f2006-01-02 19:04:38 +0100424 l_ptr->state = RESET_UNKNOWN;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100425
426 if ((prev_state == RESET_UNKNOWN) || (prev_state == RESET_RESET))
427 return;
428
Per Liden4323add2006-01-18 00:38:21 +0100429 tipc_node_link_down(l_ptr->owner, l_ptr);
430 tipc_bearer_remove_dest(l_ptr->b_ptr, l_ptr->addr);
Paul Gortmaker7368ddf2010-10-12 14:25:58 +0000431
Jon Paul Maloyb9d4c332014-01-07 17:02:42 -0500432 if (was_active_link && tipc_node_active_links(l_ptr->owner)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100433 l_ptr->reset_checkpoint = checkpoint;
434 l_ptr->exp_msg_count = START_CHANGEOVER;
435 }
436
437 /* Clean up all queues: */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100438 link_release_outqueue(l_ptr);
Allan Stephens5f6d9122011-11-04 13:24:29 -0400439 kfree_skb(l_ptr->proto_msg_queue);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100440 l_ptr->proto_msg_queue = NULL;
Ying Xued77b3832013-12-10 20:45:38 -0800441 kfree_skb_list(l_ptr->oldest_deferred_in);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100442 if (!list_empty(&l_ptr->waiting_ports))
Per Liden4323add2006-01-18 00:38:21 +0100443 tipc_link_wakeup_ports(l_ptr, 1);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100444
445 l_ptr->retransm_queue_head = 0;
446 l_ptr->retransm_queue_size = 0;
447 l_ptr->last_out = NULL;
448 l_ptr->first_out = NULL;
449 l_ptr->next_out = NULL;
450 l_ptr->unacked_window = 0;
451 l_ptr->checkpoint = 1;
452 l_ptr->next_out_no = 1;
453 l_ptr->deferred_inqueue_sz = 0;
454 l_ptr->oldest_deferred_in = NULL;
455 l_ptr->newest_deferred_in = NULL;
456 l_ptr->fsm_msg_cnt = 0;
457 l_ptr->stale_count = 0;
458 link_reset_statistics(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100459}
460
Ying Xuec61dd612014-02-13 17:29:09 -0500461void tipc_link_reset_list(unsigned int bearer_id)
Ying Xuee0ca2c32014-02-13 17:29:06 -0500462{
463 struct tipc_link *l_ptr;
Ying Xuec61dd612014-02-13 17:29:09 -0500464 struct tipc_node *n_ptr;
Ying Xuee0ca2c32014-02-13 17:29:06 -0500465
Ying Xuec61dd612014-02-13 17:29:09 -0500466 list_for_each_entry(n_ptr, &tipc_node_list, list) {
Ying Xuee0ca2c32014-02-13 17:29:06 -0500467 spin_lock_bh(&n_ptr->lock);
Ying Xuec61dd612014-02-13 17:29:09 -0500468 l_ptr = n_ptr->links[bearer_id];
469 if (l_ptr)
470 tipc_link_reset(l_ptr);
Ying Xuee0ca2c32014-02-13 17:29:06 -0500471 spin_unlock_bh(&n_ptr->lock);
472 }
473}
Per Lidenb97bf3f2006-01-02 19:04:38 +0100474
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500475static void link_activate(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100476{
Allan Stephens5392d642006-06-25 23:52:50 -0700477 l_ptr->next_in_no = l_ptr->stats.recv_info = 1;
Per Liden4323add2006-01-18 00:38:21 +0100478 tipc_node_link_up(l_ptr->owner, l_ptr);
479 tipc_bearer_add_dest(l_ptr->b_ptr, l_ptr->addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100480}
481
482/**
483 * link_state_event - link finite state machine
484 * @l_ptr: pointer to link
485 * @event: state machine event to process
486 */
Eric Dumazet95c96172012-04-15 05:58:06 +0000487static void link_state_event(struct tipc_link *l_ptr, unsigned int event)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100488{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500489 struct tipc_link *other;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100490 u32 cont_intv = l_ptr->continuity_interval;
491
Jon Paul Maloy7d339392014-02-13 17:29:16 -0500492 if (l_ptr->flags & LINK_STOPPED)
493 return;
494
Ying Xue135daee2014-02-13 17:29:08 -0500495 if (!(l_ptr->flags & LINK_STARTED) && (event != STARTING_EVT))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100496 return; /* Not yet. */
497
Ying Xue77a7e072013-12-10 20:45:44 -0800498 /* Check whether changeover is going on */
499 if (l_ptr->exp_msg_count) {
Allan Stephensa0168922010-12-31 18:59:35 +0000500 if (event == TIMEOUT_EVT)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100501 link_set_timer(l_ptr, cont_intv);
Ying Xue77a7e072013-12-10 20:45:44 -0800502 return;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100503 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100504
505 switch (l_ptr->state) {
506 case WORKING_WORKING:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100507 switch (event) {
508 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100509 case ACTIVATE_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100510 break;
511 case TIMEOUT_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100512 if (l_ptr->next_in_no != l_ptr->checkpoint) {
513 l_ptr->checkpoint = l_ptr->next_in_no;
Per Liden4323add2006-01-18 00:38:21 +0100514 if (tipc_bclink_acks_missing(l_ptr->owner)) {
Ying Xue247f0f32014-02-18 16:06:46 +0800515 tipc_link_proto_xmit(l_ptr, STATE_MSG,
516 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100517 l_ptr->fsm_msg_cnt++;
518 } else if (l_ptr->max_pkt < l_ptr->max_pkt_target) {
Ying Xue247f0f32014-02-18 16:06:46 +0800519 tipc_link_proto_xmit(l_ptr, STATE_MSG,
520 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100521 l_ptr->fsm_msg_cnt++;
522 }
523 link_set_timer(l_ptr, cont_intv);
524 break;
525 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100526 l_ptr->state = WORKING_UNKNOWN;
527 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800528 tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100529 l_ptr->fsm_msg_cnt++;
530 link_set_timer(l_ptr, cont_intv / 4);
531 break;
532 case RESET_MSG:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400533 pr_info("%s<%s>, requested by peer\n", link_rst_msg,
534 l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100535 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100536 l_ptr->state = RESET_RESET;
537 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800538 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
539 0, 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);
542 break;
543 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400544 pr_err("%s%u in WW state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100545 }
546 break;
547 case WORKING_UNKNOWN:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100548 switch (event) {
549 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100550 case ACTIVATE_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100551 l_ptr->state = WORKING_WORKING;
552 l_ptr->fsm_msg_cnt = 0;
553 link_set_timer(l_ptr, cont_intv);
554 break;
555 case RESET_MSG:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400556 pr_info("%s<%s>, requested by peer while probing\n",
557 link_rst_msg, l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100558 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100559 l_ptr->state = RESET_RESET;
560 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800561 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
562 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100563 l_ptr->fsm_msg_cnt++;
564 link_set_timer(l_ptr, cont_intv);
565 break;
566 case TIMEOUT_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100567 if (l_ptr->next_in_no != l_ptr->checkpoint) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100568 l_ptr->state = WORKING_WORKING;
569 l_ptr->fsm_msg_cnt = 0;
570 l_ptr->checkpoint = l_ptr->next_in_no;
Per Liden4323add2006-01-18 00:38:21 +0100571 if (tipc_bclink_acks_missing(l_ptr->owner)) {
Ying Xue247f0f32014-02-18 16:06:46 +0800572 tipc_link_proto_xmit(l_ptr, STATE_MSG,
573 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100574 l_ptr->fsm_msg_cnt++;
575 }
576 link_set_timer(l_ptr, cont_intv);
577 } else if (l_ptr->fsm_msg_cnt < l_ptr->abort_limit) {
Ying Xue247f0f32014-02-18 16:06:46 +0800578 tipc_link_proto_xmit(l_ptr, STATE_MSG,
579 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100580 l_ptr->fsm_msg_cnt++;
581 link_set_timer(l_ptr, cont_intv / 4);
582 } else { /* Link has failed */
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400583 pr_warn("%s<%s>, peer not responding\n",
584 link_rst_msg, l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100585 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100586 l_ptr->state = RESET_UNKNOWN;
587 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800588 tipc_link_proto_xmit(l_ptr, RESET_MSG,
589 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100590 l_ptr->fsm_msg_cnt++;
591 link_set_timer(l_ptr, cont_intv);
592 }
593 break;
594 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400595 pr_err("%s%u in WU state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100596 }
597 break;
598 case RESET_UNKNOWN:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100599 switch (event) {
600 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100601 break;
602 case ACTIVATE_MSG:
603 other = l_ptr->owner->active_links[0];
Allan Stephens8d64a5b2010-12-31 18:59:27 +0000604 if (other && link_working_unknown(other))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100605 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100606 l_ptr->state = WORKING_WORKING;
607 l_ptr->fsm_msg_cnt = 0;
608 link_activate(l_ptr);
Ying Xue247f0f32014-02-18 16:06:46 +0800609 tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100610 l_ptr->fsm_msg_cnt++;
Jon Maloyc64f7a62012-11-16 13:51:31 +0800611 if (l_ptr->owner->working_links == 1)
Ying Xue247f0f32014-02-18 16:06:46 +0800612 tipc_link_sync_xmit(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100613 link_set_timer(l_ptr, cont_intv);
614 break;
615 case RESET_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100616 l_ptr->state = RESET_RESET;
617 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800618 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
619 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100620 l_ptr->fsm_msg_cnt++;
621 link_set_timer(l_ptr, cont_intv);
622 break;
623 case STARTING_EVT:
Ying Xue135daee2014-02-13 17:29:08 -0500624 l_ptr->flags |= LINK_STARTED;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100625 /* fall through */
626 case TIMEOUT_EVT:
Ying Xue247f0f32014-02-18 16:06:46 +0800627 tipc_link_proto_xmit(l_ptr, RESET_MSG, 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100628 l_ptr->fsm_msg_cnt++;
629 link_set_timer(l_ptr, cont_intv);
630 break;
631 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400632 pr_err("%s%u in RU state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100633 }
634 break;
635 case RESET_RESET:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100636 switch (event) {
637 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100638 case ACTIVATE_MSG:
639 other = l_ptr->owner->active_links[0];
Allan Stephens8d64a5b2010-12-31 18:59:27 +0000640 if (other && link_working_unknown(other))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100641 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100642 l_ptr->state = WORKING_WORKING;
643 l_ptr->fsm_msg_cnt = 0;
644 link_activate(l_ptr);
Ying Xue247f0f32014-02-18 16:06:46 +0800645 tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100646 l_ptr->fsm_msg_cnt++;
Jon Maloyc64f7a62012-11-16 13:51:31 +0800647 if (l_ptr->owner->working_links == 1)
Ying Xue247f0f32014-02-18 16:06:46 +0800648 tipc_link_sync_xmit(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100649 link_set_timer(l_ptr, cont_intv);
650 break;
651 case RESET_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100652 break;
653 case TIMEOUT_EVT:
Ying Xue247f0f32014-02-18 16:06:46 +0800654 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
655 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100656 l_ptr->fsm_msg_cnt++;
657 link_set_timer(l_ptr, cont_intv);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100658 break;
659 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400660 pr_err("%s%u in RR state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100661 }
662 break;
663 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400664 pr_err("Unknown link state %u/%u\n", l_ptr->state, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100665 }
666}
667
668/*
669 * link_bundle_buf(): Append contents of a buffer to
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900670 * the tail of an existing one.
Per Lidenb97bf3f2006-01-02 19:04:38 +0100671 */
Paul Gortmakerae8509c2013-06-17 10:54:47 -0400672static int link_bundle_buf(struct tipc_link *l_ptr, struct sk_buff *bundler,
Per Lidenb97bf3f2006-01-02 19:04:38 +0100673 struct sk_buff *buf)
674{
675 struct tipc_msg *bundler_msg = buf_msg(bundler);
676 struct tipc_msg *msg = buf_msg(buf);
677 u32 size = msg_size(msg);
Allan Stephense49060c2006-06-29 12:32:46 -0700678 u32 bundle_size = msg_size(bundler_msg);
679 u32 to_pos = align(bundle_size);
680 u32 pad = to_pos - bundle_size;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100681
682 if (msg_user(bundler_msg) != MSG_BUNDLER)
683 return 0;
684 if (msg_type(bundler_msg) != OPEN_MSG)
685 return 0;
Allan Stephense49060c2006-06-29 12:32:46 -0700686 if (skb_tailroom(bundler) < (pad + size))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100687 return 0;
Allan Stephens15e979d2010-05-11 14:30:10 +0000688 if (l_ptr->max_pkt < (to_pos + size))
Allan Stephens863fae62006-07-03 19:39:36 -0700689 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100690
Allan Stephense49060c2006-06-29 12:32:46 -0700691 skb_put(bundler, pad + size);
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -0300692 skb_copy_to_linear_data_offset(bundler, to_pos, buf->data, size);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100693 msg_set_size(bundler_msg, to_pos + size);
694 msg_set_msgcnt(bundler_msg, msg_msgcnt(bundler_msg) + 1);
Allan Stephens5f6d9122011-11-04 13:24:29 -0400695 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100696 l_ptr->stats.sent_bundled++;
697 return 1;
698}
699
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500700static void link_add_to_outqueue(struct tipc_link *l_ptr,
Sam Ravnborg05790c62006-03-20 22:37:04 -0800701 struct sk_buff *buf,
702 struct tipc_msg *msg)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100703{
704 u32 ack = mod(l_ptr->next_in_no - 1);
705 u32 seqno = mod(l_ptr->next_out_no++);
706
707 msg_set_word(msg, 2, ((ack << 16) | seqno));
708 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
709 buf->next = NULL;
710 if (l_ptr->first_out) {
711 l_ptr->last_out->next = buf;
712 l_ptr->last_out = buf;
713 } else
714 l_ptr->first_out = l_ptr->last_out = buf;
Allan Stephens9bd80b62011-01-18 15:02:50 -0500715
Per Lidenb97bf3f2006-01-02 19:04:38 +0100716 l_ptr->out_queue_size++;
Allan Stephens9bd80b62011-01-18 15:02:50 -0500717 if (l_ptr->out_queue_size > l_ptr->stats.max_queue_sz)
718 l_ptr->stats.max_queue_sz = l_ptr->out_queue_size;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100719}
720
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500721static void link_add_chain_to_outqueue(struct tipc_link *l_ptr,
Allan Stephensdc63d912011-04-21 11:50:42 -0400722 struct sk_buff *buf_chain,
723 u32 long_msgno)
724{
725 struct sk_buff *buf;
726 struct tipc_msg *msg;
727
728 if (!l_ptr->next_out)
729 l_ptr->next_out = buf_chain;
730 while (buf_chain) {
731 buf = buf_chain;
732 buf_chain = buf_chain->next;
733
734 msg = buf_msg(buf);
735 msg_set_long_msgno(msg, long_msgno);
736 link_add_to_outqueue(l_ptr, buf, msg);
737 }
738}
739
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900740/*
Ying Xue247f0f32014-02-18 16:06:46 +0800741 * tipc_link_xmit() is the 'full path' for messages, called from
742 * inside TIPC when the 'fast path' in tipc_send_xmit
Per Lidenb97bf3f2006-01-02 19:04:38 +0100743 * has failed, and from link_send()
744 */
Ying Xue247f0f32014-02-18 16:06:46 +0800745int __tipc_link_xmit(struct tipc_link *l_ptr, struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100746{
747 struct tipc_msg *msg = buf_msg(buf);
748 u32 size = msg_size(msg);
749 u32 dsz = msg_data_sz(msg);
750 u32 queue_size = l_ptr->out_queue_size;
Allan Stephensc68ca7b2010-05-11 14:30:12 +0000751 u32 imp = tipc_msg_tot_importance(msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100752 u32 queue_limit = l_ptr->queue_limit[imp];
Allan Stephens15e979d2010-05-11 14:30:10 +0000753 u32 max_packet = l_ptr->max_pkt;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100754
Per Lidenb97bf3f2006-01-02 19:04:38 +0100755 /* Match msg importance against queue limits: */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100756 if (unlikely(queue_size >= queue_limit)) {
757 if (imp <= TIPC_CRITICAL_IMPORTANCE) {
Allan Stephensbebc55a2011-04-19 10:17:58 -0400758 link_schedule_port(l_ptr, msg_origport(msg), size);
Allan Stephens5f6d9122011-11-04 13:24:29 -0400759 kfree_skb(buf);
Allan Stephensbebc55a2011-04-19 10:17:58 -0400760 return -ELINKCONG;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100761 }
Allan Stephens5f6d9122011-11-04 13:24:29 -0400762 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100763 if (imp > CONN_MANAGER) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400764 pr_warn("%s<%s>, send queue full", link_rst_msg,
765 l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100766 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100767 }
768 return dsz;
769 }
770
771 /* Fragmentation needed ? */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100772 if (size > max_packet)
Ying Xue247f0f32014-02-18 16:06:46 +0800773 return tipc_link_frag_xmit(l_ptr, buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100774
Paul Gortmaker617d3c72012-04-30 15:29:02 -0400775 /* Packet can be queued or sent. */
Erik Hugne512137e2013-12-06 10:08:00 -0500776 if (likely(!link_congested(l_ptr))) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100777 link_add_to_outqueue(l_ptr, buf, msg);
778
Ying Xue3c294cb2012-11-15 11:34:45 +0800779 tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr);
780 l_ptr->unacked_window = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100781 return dsz;
782 }
Paul Gortmaker617d3c72012-04-30 15:29:02 -0400783 /* Congestion: can message be bundled ? */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100784 if ((msg_user(msg) != CHANGEOVER_PROTOCOL) &&
785 (msg_user(msg) != MSG_FRAGMENTER)) {
786
787 /* Try adding message to an existing bundle */
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900788 if (l_ptr->next_out &&
Ying Xue3c294cb2012-11-15 11:34:45 +0800789 link_bundle_buf(l_ptr, l_ptr->last_out, buf))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100790 return dsz;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100791
792 /* Try creating a new bundle */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100793 if (size <= max_packet * 2 / 3) {
stephen hemminger31e3c3f2010-10-13 13:20:35 +0000794 struct sk_buff *bundler = tipc_buf_acquire(max_packet);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100795 struct tipc_msg bundler_hdr;
796
797 if (bundler) {
Allan Stephensc68ca7b2010-05-11 14:30:12 +0000798 tipc_msg_init(&bundler_hdr, MSG_BUNDLER, OPEN_MSG,
Allan Stephens75715212008-06-04 17:37:34 -0700799 INT_H_SIZE, l_ptr->addr);
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -0300800 skb_copy_to_linear_data(bundler, &bundler_hdr,
801 INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100802 skb_trim(bundler, INT_H_SIZE);
803 link_bundle_buf(l_ptr, bundler, buf);
804 buf = bundler;
805 msg = buf_msg(buf);
806 l_ptr->stats.sent_bundles++;
807 }
808 }
809 }
810 if (!l_ptr->next_out)
811 l_ptr->next_out = buf;
812 link_add_to_outqueue(l_ptr, buf, msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100813 return dsz;
814}
815
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900816/*
Ying Xue247f0f32014-02-18 16:06:46 +0800817 * tipc_link_xmit(): same as __tipc_link_xmit(), but the link to use
818 * has not been selected yet, and the the owner node is not locked
Per Lidenb97bf3f2006-01-02 19:04:38 +0100819 * Called by TIPC internal users, e.g. the name distributor
820 */
Ying Xue247f0f32014-02-18 16:06:46 +0800821int tipc_link_xmit(struct sk_buff *buf, u32 dest, u32 selector)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100822{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500823 struct tipc_link *l_ptr;
David S. Miller6c000552008-09-02 23:38:32 -0700824 struct tipc_node *n_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100825 int res = -ELINKCONG;
826
Per Liden4323add2006-01-18 00:38:21 +0100827 read_lock_bh(&tipc_net_lock);
Allan Stephens51a8e4d2010-12-31 18:59:18 +0000828 n_ptr = tipc_node_find(dest);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100829 if (n_ptr) {
Per Liden4323add2006-01-18 00:38:21 +0100830 tipc_node_lock(n_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100831 l_ptr = n_ptr->active_links[selector & 1];
Allan Stephensa0168922010-12-31 18:59:35 +0000832 if (l_ptr)
Ying Xue247f0f32014-02-18 16:06:46 +0800833 res = __tipc_link_xmit(l_ptr, buf);
Allan Stephensa0168922010-12-31 18:59:35 +0000834 else
Allan Stephens5f6d9122011-11-04 13:24:29 -0400835 kfree_skb(buf);
Per Liden4323add2006-01-18 00:38:21 +0100836 tipc_node_unlock(n_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100837 } else {
Allan Stephens5f6d9122011-11-04 13:24:29 -0400838 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100839 }
Per Liden4323add2006-01-18 00:38:21 +0100840 read_unlock_bh(&tipc_net_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100841 return res;
842}
843
Jon Maloyc64f7a62012-11-16 13:51:31 +0800844/*
Ying Xue247f0f32014-02-18 16:06:46 +0800845 * tipc_link_sync_xmit - synchronize broadcast link endpoints.
Jon Maloyc64f7a62012-11-16 13:51:31 +0800846 *
847 * Give a newly added peer node the sequence number where it should
848 * start receiving and acking broadcast packets.
849 *
850 * Called with node locked
851 */
Ying Xue247f0f32014-02-18 16:06:46 +0800852static void tipc_link_sync_xmit(struct tipc_link *l)
Jon Maloyc64f7a62012-11-16 13:51:31 +0800853{
854 struct sk_buff *buf;
855 struct tipc_msg *msg;
856
857 buf = tipc_buf_acquire(INT_H_SIZE);
858 if (!buf)
859 return;
860
861 msg = buf_msg(buf);
862 tipc_msg_init(msg, BCAST_PROTOCOL, STATE_MSG, INT_H_SIZE, l->addr);
863 msg_set_last_bcast(msg, l->owner->bclink.acked);
864 link_add_chain_to_outqueue(l, buf, 0);
865 tipc_link_push_queue(l);
866}
867
868/*
Ying Xue247f0f32014-02-18 16:06:46 +0800869 * tipc_link_sync_rcv - synchronize broadcast link endpoints.
Jon Maloyc64f7a62012-11-16 13:51:31 +0800870 * Receive the sequence number where we should start receiving and
871 * acking broadcast packets from a newly added peer node, and open
872 * up for reception of such packets.
873 *
874 * Called with node locked
875 */
Ying Xue247f0f32014-02-18 16:06:46 +0800876static void tipc_link_sync_rcv(struct tipc_node *n, struct sk_buff *buf)
Jon Maloyc64f7a62012-11-16 13:51:31 +0800877{
878 struct tipc_msg *msg = buf_msg(buf);
879
880 n->bclink.last_sent = n->bclink.last_in = msg_last_bcast(msg);
881 n->bclink.recv_permitted = true;
882 kfree_skb(buf);
883}
884
885/*
Ying Xue247f0f32014-02-18 16:06:46 +0800886 * tipc_link_names_xmit - send name table entries to new neighbor
Allan Stephens9aa88c22011-05-31 13:38:02 -0400887 *
888 * Send routine for bulk delivery of name table messages when contact
889 * with a new neighbor occurs. No link congestion checking is performed
890 * because name table messages *must* be delivered. The messages must be
891 * small enough not to require fragmentation.
892 * Called without any locks held.
893 */
Ying Xue247f0f32014-02-18 16:06:46 +0800894void tipc_link_names_xmit(struct list_head *message_list, u32 dest)
Allan Stephens9aa88c22011-05-31 13:38:02 -0400895{
896 struct tipc_node *n_ptr;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500897 struct tipc_link *l_ptr;
Allan Stephens9aa88c22011-05-31 13:38:02 -0400898 struct sk_buff *buf;
899 struct sk_buff *temp_buf;
900
901 if (list_empty(message_list))
902 return;
903
904 read_lock_bh(&tipc_net_lock);
905 n_ptr = tipc_node_find(dest);
906 if (n_ptr) {
907 tipc_node_lock(n_ptr);
908 l_ptr = n_ptr->active_links[0];
909 if (l_ptr) {
910 /* convert circular list to linear list */
911 ((struct sk_buff *)message_list->prev)->next = NULL;
912 link_add_chain_to_outqueue(l_ptr,
913 (struct sk_buff *)message_list->next, 0);
914 tipc_link_push_queue(l_ptr);
915 INIT_LIST_HEAD(message_list);
916 }
917 tipc_node_unlock(n_ptr);
918 }
919 read_unlock_bh(&tipc_net_lock);
920
921 /* discard the messages if they couldn't be sent */
Allan Stephens9aa88c22011-05-31 13:38:02 -0400922 list_for_each_safe(buf, temp_buf, ((struct sk_buff *)message_list)) {
923 list_del((struct list_head *)buf);
Allan Stephens5f6d9122011-11-04 13:24:29 -0400924 kfree_skb(buf);
Allan Stephens9aa88c22011-05-31 13:38:02 -0400925 }
926}
927
928/*
Ying Xue247f0f32014-02-18 16:06:46 +0800929 * tipc_link_xmit_fast: Entry for data messages where the
Per Lidenb97bf3f2006-01-02 19:04:38 +0100930 * destination link is known and the header is complete,
931 * inclusive total message length. Very time critical.
932 * Link is locked. Returns user data length.
933 */
Ying Xue247f0f32014-02-18 16:06:46 +0800934static int tipc_link_xmit_fast(struct tipc_link *l_ptr, struct sk_buff *buf,
935 u32 *used_max_pkt)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100936{
937 struct tipc_msg *msg = buf_msg(buf);
938 int res = msg_data_sz(msg);
939
940 if (likely(!link_congested(l_ptr))) {
Allan Stephens15e979d2010-05-11 14:30:10 +0000941 if (likely(msg_size(msg) <= l_ptr->max_pkt)) {
Erik Hugne512137e2013-12-06 10:08:00 -0500942 link_add_to_outqueue(l_ptr, buf, msg);
943 tipc_bearer_send(l_ptr->b_ptr, buf,
944 &l_ptr->media_addr);
945 l_ptr->unacked_window = 0;
946 return res;
947 }
948 else
Allan Stephens15e979d2010-05-11 14:30:10 +0000949 *used_max_pkt = l_ptr->max_pkt;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100950 }
Ying Xue247f0f32014-02-18 16:06:46 +0800951 return __tipc_link_xmit(l_ptr, buf); /* All other cases */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100952}
953
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900954/*
Ying Xue247f0f32014-02-18 16:06:46 +0800955 * tipc_link_iovec_xmit_fast: Entry for messages where the
Per Lidenb97bf3f2006-01-02 19:04:38 +0100956 * destination processor is known and the header is complete,
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900957 * except for total message length.
Per Lidenb97bf3f2006-01-02 19:04:38 +0100958 * Returns user data length or errno.
959 */
Ying Xue247f0f32014-02-18 16:06:46 +0800960int tipc_link_iovec_xmit_fast(struct tipc_port *sender,
961 struct iovec const *msg_sect,
962 unsigned int len, u32 destaddr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100963{
Allan Stephens23dd4cc2011-01-07 11:43:40 -0500964 struct tipc_msg *hdr = &sender->phdr;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500965 struct tipc_link *l_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100966 struct sk_buff *buf;
David S. Miller6c000552008-09-02 23:38:32 -0700967 struct tipc_node *node;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100968 int res;
969 u32 selector = msg_origport(hdr) & 1;
970
Per Lidenb97bf3f2006-01-02 19:04:38 +0100971again:
972 /*
973 * Try building message using port's max_pkt hint.
974 * (Must not hold any locks while building message.)
975 */
Ying Xue9446b872013-10-18 07:23:15 +0200976 res = tipc_msg_build(hdr, msg_sect, len, sender->max_pkt, &buf);
Ying Xue7410f962013-06-17 10:54:49 -0400977 /* Exit if build request was invalid */
978 if (unlikely(res < 0))
979 return res;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100980
Per Liden4323add2006-01-18 00:38:21 +0100981 read_lock_bh(&tipc_net_lock);
Allan Stephens51a8e4d2010-12-31 18:59:18 +0000982 node = tipc_node_find(destaddr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100983 if (likely(node)) {
Per Liden4323add2006-01-18 00:38:21 +0100984 tipc_node_lock(node);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100985 l_ptr = node->active_links[selector];
986 if (likely(l_ptr)) {
987 if (likely(buf)) {
Ying Xue247f0f32014-02-18 16:06:46 +0800988 res = tipc_link_xmit_fast(l_ptr, buf,
989 &sender->max_pkt);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100990exit:
Per Liden4323add2006-01-18 00:38:21 +0100991 tipc_node_unlock(node);
992 read_unlock_bh(&tipc_net_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100993 return res;
994 }
995
Per Lidenb97bf3f2006-01-02 19:04:38 +0100996 /* Exit if link (or bearer) is congested */
Erik Hugne512137e2013-12-06 10:08:00 -0500997 if (link_congested(l_ptr)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100998 res = link_schedule_port(l_ptr,
Allan Stephens23dd4cc2011-01-07 11:43:40 -0500999 sender->ref, res);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001000 goto exit;
1001 }
1002
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001003 /*
Per Lidenb97bf3f2006-01-02 19:04:38 +01001004 * Message size exceeds max_pkt hint; update hint,
1005 * then re-try fast path or fragment the message
1006 */
Allan Stephens23dd4cc2011-01-07 11:43:40 -05001007 sender->max_pkt = l_ptr->max_pkt;
Per Liden4323add2006-01-18 00:38:21 +01001008 tipc_node_unlock(node);
1009 read_unlock_bh(&tipc_net_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001010
1011
Allan Stephens23dd4cc2011-01-07 11:43:40 -05001012 if ((msg_hdr_sz(hdr) + res) <= sender->max_pkt)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001013 goto again;
1014
Ying Xue247f0f32014-02-18 16:06:46 +08001015 return tipc_link_iovec_long_xmit(sender, msg_sect,
1016 len, destaddr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001017 }
Per Liden4323add2006-01-18 00:38:21 +01001018 tipc_node_unlock(node);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001019 }
Per Liden4323add2006-01-18 00:38:21 +01001020 read_unlock_bh(&tipc_net_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001021
1022 /* Couldn't find a link to the destination node */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001023 if (buf)
1024 return tipc_reject_msg(buf, TIPC_ERR_NO_NODE);
1025 if (res >= 0)
Ying Xue247f0f32014-02-18 16:06:46 +08001026 return tipc_port_iovec_reject(sender, hdr, msg_sect, len,
1027 TIPC_ERR_NO_NODE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001028 return res;
1029}
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);
Ying Xue247f0f32014-02-18 16:06:46 +08001166 return tipc_port_iovec_reject(sender, hdr, msg_sect,
1167 len, TIPC_ERR_NO_NODE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001168 }
1169
Allan Stephensdc63d912011-04-21 11:50:42 -04001170 /* Append chain of fragments to send queue & send them */
Allan Stephense0f08592011-04-17 11:44:24 -04001171 l_ptr->long_msg_seq_no++;
Allan Stephensdc63d912011-04-21 11:50:42 -04001172 link_add_chain_to_outqueue(l_ptr, buf_chain, l_ptr->long_msg_seq_no);
1173 l_ptr->stats.sent_fragments += fragm_no;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001174 l_ptr->stats.sent_fragmented++;
Per Liden4323add2006-01-18 00:38:21 +01001175 tipc_link_push_queue(l_ptr);
1176 tipc_node_unlock(node);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001177 return dsz;
1178}
1179
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001180/*
Per Liden4323add2006-01-18 00:38:21 +01001181 * tipc_link_push_packet: Push one unsent packet to the media
Per Lidenb97bf3f2006-01-02 19:04:38 +01001182 */
stephen hemminger98056962014-01-04 13:47:48 -08001183static u32 tipc_link_push_packet(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001184{
1185 struct sk_buff *buf = l_ptr->first_out;
1186 u32 r_q_size = l_ptr->retransm_queue_size;
1187 u32 r_q_head = l_ptr->retransm_queue_head;
1188
1189 /* Step to position where retransmission failed, if any, */
1190 /* consider that buffers may have been released in meantime */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001191 if (r_q_size && buf) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001192 u32 last = lesser(mod(r_q_head + r_q_size),
Per Lidenb97bf3f2006-01-02 19:04:38 +01001193 link_last_sent(l_ptr));
Allan Stephensf9057302011-10-24 16:03:12 -04001194 u32 first = buf_seqno(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001195
1196 while (buf && less(first, r_q_head)) {
1197 first = mod(first + 1);
1198 buf = buf->next;
1199 }
1200 l_ptr->retransm_queue_head = r_q_head = first;
1201 l_ptr->retransm_queue_size = r_q_size = mod(last - first);
1202 }
1203
1204 /* Continue retransmission now, if there is anything: */
Neil Hormanca509102010-03-15 07:58:45 +00001205 if (r_q_size && buf) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001206 msg_set_ack(buf_msg(buf), mod(l_ptr->next_in_no - 1));
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001207 msg_set_bcast_ack(buf_msg(buf), l_ptr->owner->bclink.last_in);
Ying Xue3c294cb2012-11-15 11:34:45 +08001208 tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr);
1209 l_ptr->retransm_queue_head = mod(++r_q_head);
1210 l_ptr->retransm_queue_size = --r_q_size;
1211 l_ptr->stats.retransmitted++;
1212 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001213 }
1214
1215 /* Send deferred protocol message, if any: */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001216 buf = l_ptr->proto_msg_queue;
1217 if (buf) {
1218 msg_set_ack(buf_msg(buf), mod(l_ptr->next_in_no - 1));
Allan Stephens0e659672010-12-31 18:59:32 +00001219 msg_set_bcast_ack(buf_msg(buf), l_ptr->owner->bclink.last_in);
Ying Xue3c294cb2012-11-15 11:34:45 +08001220 tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr);
1221 l_ptr->unacked_window = 0;
1222 kfree_skb(buf);
1223 l_ptr->proto_msg_queue = NULL;
1224 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001225 }
1226
1227 /* Send one deferred data message, if send window not full: */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001228 buf = l_ptr->next_out;
1229 if (buf) {
1230 struct tipc_msg *msg = buf_msg(buf);
1231 u32 next = msg_seqno(msg);
Allan Stephensf9057302011-10-24 16:03:12 -04001232 u32 first = buf_seqno(l_ptr->first_out);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001233
1234 if (mod(next - first) < l_ptr->queue_limit[0]) {
1235 msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001236 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Ying Xue3c294cb2012-11-15 11:34:45 +08001237 tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr);
1238 if (msg_user(msg) == MSG_BUNDLER)
1239 msg_set_type(msg, CLOSED_MSG);
1240 l_ptr->next_out = buf->next;
1241 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001242 }
1243 }
Ying Xue3c294cb2012-11-15 11:34:45 +08001244 return 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001245}
1246
1247/*
1248 * push_queue(): push out the unsent messages of a link where
1249 * congestion has abated. Node is locked
1250 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001251void tipc_link_push_queue(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001252{
1253 u32 res;
1254
Per Lidenb97bf3f2006-01-02 19:04:38 +01001255 do {
Per Liden4323add2006-01-18 00:38:21 +01001256 res = tipc_link_push_packet(l_ptr);
Allan Stephens0e35fd52008-07-14 22:44:01 -07001257 } while (!res);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001258}
1259
Allan Stephensd356eeb2006-06-25 23:40:01 -07001260static void link_reset_all(unsigned long addr)
1261{
David S. Miller6c000552008-09-02 23:38:32 -07001262 struct tipc_node *n_ptr;
Allan Stephensd356eeb2006-06-25 23:40:01 -07001263 char addr_string[16];
1264 u32 i;
1265
1266 read_lock_bh(&tipc_net_lock);
1267 n_ptr = tipc_node_find((u32)addr);
1268 if (!n_ptr) {
1269 read_unlock_bh(&tipc_net_lock);
1270 return; /* node no longer exists */
1271 }
1272
1273 tipc_node_lock(n_ptr);
1274
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001275 pr_warn("Resetting all links to %s\n",
1276 tipc_addr_string_fill(addr_string, n_ptr->addr));
Allan Stephensd356eeb2006-06-25 23:40:01 -07001277
1278 for (i = 0; i < MAX_BEARERS; i++) {
1279 if (n_ptr->links[i]) {
Allan Stephens8d64a5b2010-12-31 18:59:27 +00001280 link_print(n_ptr->links[i], "Resetting link\n");
Allan Stephensd356eeb2006-06-25 23:40:01 -07001281 tipc_link_reset(n_ptr->links[i]);
1282 }
1283 }
1284
1285 tipc_node_unlock(n_ptr);
1286 read_unlock_bh(&tipc_net_lock);
1287}
1288
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001289static void link_retransmit_failure(struct tipc_link *l_ptr,
Paul Gortmakerae8509c2013-06-17 10:54:47 -04001290 struct sk_buff *buf)
Allan Stephensd356eeb2006-06-25 23:40:01 -07001291{
1292 struct tipc_msg *msg = buf_msg(buf);
1293
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001294 pr_warn("Retransmission failure on link <%s>\n", l_ptr->name);
Allan Stephensd356eeb2006-06-25 23:40:01 -07001295
1296 if (l_ptr->addr) {
Allan Stephensd356eeb2006-06-25 23:40:01 -07001297 /* Handle failure on standard link */
Allan Stephens8d64a5b2010-12-31 18:59:27 +00001298 link_print(l_ptr, "Resetting link\n");
Allan Stephensd356eeb2006-06-25 23:40:01 -07001299 tipc_link_reset(l_ptr);
1300
1301 } else {
Allan Stephensd356eeb2006-06-25 23:40:01 -07001302 /* Handle failure on broadcast link */
David S. Miller6c000552008-09-02 23:38:32 -07001303 struct tipc_node *n_ptr;
Allan Stephensd356eeb2006-06-25 23:40:01 -07001304 char addr_string[16];
1305
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001306 pr_info("Msg seq number: %u, ", msg_seqno(msg));
1307 pr_cont("Outstanding acks: %lu\n",
1308 (unsigned long) TIPC_SKB_CB(buf)->handle);
Jeff Garzik617dbea2006-10-03 16:25:34 -07001309
Allan Stephens01d83ed2011-01-18 13:53:16 -05001310 n_ptr = tipc_bclink_retransmit_to();
Allan Stephensd356eeb2006-06-25 23:40:01 -07001311 tipc_node_lock(n_ptr);
1312
Allan Stephensc68ca7b2010-05-11 14:30:12 +00001313 tipc_addr_string_fill(addr_string, n_ptr->addr);
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001314 pr_info("Broadcast link info for %s\n", addr_string);
Ying Xue389dd9b2012-11-16 13:51:30 +08001315 pr_info("Reception permitted: %d, Acked: %u\n",
1316 n_ptr->bclink.recv_permitted,
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001317 n_ptr->bclink.acked);
1318 pr_info("Last in: %u, Oos state: %u, Last sent: %u\n",
1319 n_ptr->bclink.last_in,
1320 n_ptr->bclink.oos_state,
1321 n_ptr->bclink.last_sent);
Allan Stephensd356eeb2006-06-25 23:40:01 -07001322
1323 tipc_k_signal((Handler)link_reset_all, (unsigned long)n_ptr->addr);
1324
1325 tipc_node_unlock(n_ptr);
1326
1327 l_ptr->stale_count = 0;
1328 }
1329}
1330
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001331void tipc_link_retransmit(struct tipc_link *l_ptr, struct sk_buff *buf,
Per Liden4323add2006-01-18 00:38:21 +01001332 u32 retransmits)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001333{
1334 struct tipc_msg *msg;
1335
Allan Stephensd356eeb2006-06-25 23:40:01 -07001336 if (!buf)
1337 return;
1338
1339 msg = buf_msg(buf);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001340
Erik Hugne512137e2013-12-06 10:08:00 -05001341 /* Detect repeated retransmit failures */
1342 if (l_ptr->last_retransmitted == msg_seqno(msg)) {
1343 if (++l_ptr->stale_count > 100) {
1344 link_retransmit_failure(l_ptr, buf);
1345 return;
Allan Stephensd356eeb2006-06-25 23:40:01 -07001346 }
1347 } else {
Erik Hugne512137e2013-12-06 10:08:00 -05001348 l_ptr->last_retransmitted = msg_seqno(msg);
1349 l_ptr->stale_count = 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001350 }
Allan Stephensd356eeb2006-06-25 23:40:01 -07001351
Neil Hormanca509102010-03-15 07:58:45 +00001352 while (retransmits && (buf != l_ptr->next_out) && buf) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001353 msg = buf_msg(buf);
1354 msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001355 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Ying Xue3c294cb2012-11-15 11:34:45 +08001356 tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr);
1357 buf = buf->next;
1358 retransmits--;
1359 l_ptr->stats.retransmitted++;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001360 }
Allan Stephensd356eeb2006-06-25 23:40:01 -07001361
Per Lidenb97bf3f2006-01-02 19:04:38 +01001362 l_ptr->retransm_queue_head = l_ptr->retransm_queue_size = 0;
1363}
1364
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001365/**
Per Lidenb97bf3f2006-01-02 19:04:38 +01001366 * link_insert_deferred_queue - insert deferred messages back into receive chain
1367 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001368static struct sk_buff *link_insert_deferred_queue(struct tipc_link *l_ptr,
Per Lidenb97bf3f2006-01-02 19:04:38 +01001369 struct sk_buff *buf)
1370{
1371 u32 seq_no;
1372
1373 if (l_ptr->oldest_deferred_in == NULL)
1374 return buf;
1375
Allan Stephensf9057302011-10-24 16:03:12 -04001376 seq_no = buf_seqno(l_ptr->oldest_deferred_in);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001377 if (seq_no == mod(l_ptr->next_in_no)) {
1378 l_ptr->newest_deferred_in->next = buf;
1379 buf = l_ptr->oldest_deferred_in;
1380 l_ptr->oldest_deferred_in = NULL;
1381 l_ptr->deferred_inqueue_sz = 0;
1382 }
1383 return buf;
1384}
1385
Allan Stephens85035562008-04-15 19:04:54 -07001386/**
1387 * link_recv_buf_validate - validate basic format of received message
1388 *
1389 * This routine ensures a TIPC message has an acceptable header, and at least
1390 * as much data as the header indicates it should. The routine also ensures
1391 * that the entire message header is stored in the main fragment of the message
1392 * buffer, to simplify future access to message header fields.
1393 *
1394 * Note: Having extra info present in the message header or data areas is OK.
1395 * TIPC will ignore the excess, under the assumption that it is optional info
1396 * introduced by a later release of the protocol.
1397 */
Allan Stephens85035562008-04-15 19:04:54 -07001398static int link_recv_buf_validate(struct sk_buff *buf)
1399{
1400 static u32 min_data_hdr_size[8] = {
Allan Stephens741d9eb2011-05-31 15:03:18 -04001401 SHORT_H_SIZE, MCAST_H_SIZE, NAMED_H_SIZE, BASIC_H_SIZE,
Allan Stephens85035562008-04-15 19:04:54 -07001402 MAX_H_SIZE, MAX_H_SIZE, MAX_H_SIZE, MAX_H_SIZE
1403 };
1404
1405 struct tipc_msg *msg;
1406 u32 tipc_hdr[2];
1407 u32 size;
1408 u32 hdr_size;
1409 u32 min_hdr_size;
1410
1411 if (unlikely(buf->len < MIN_H_SIZE))
1412 return 0;
1413
1414 msg = skb_header_pointer(buf, 0, sizeof(tipc_hdr), tipc_hdr);
1415 if (msg == NULL)
1416 return 0;
1417
1418 if (unlikely(msg_version(msg) != TIPC_VERSION))
1419 return 0;
1420
1421 size = msg_size(msg);
1422 hdr_size = msg_hdr_sz(msg);
1423 min_hdr_size = msg_isdata(msg) ?
1424 min_data_hdr_size[msg_type(msg)] : INT_H_SIZE;
1425
1426 if (unlikely((hdr_size < min_hdr_size) ||
1427 (size < hdr_size) ||
1428 (buf->len < size) ||
1429 (size - hdr_size > TIPC_MAX_USER_MSG_SIZE)))
1430 return 0;
1431
1432 return pskb_may_pull(buf, hdr_size);
1433}
1434
Allan Stephensb02b69c2010-08-17 11:00:07 +00001435/**
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001436 * tipc_rcv - process TIPC packets/messages arriving from off-node
Allan Stephensb02b69c2010-08-17 11:00:07 +00001437 * @head: pointer to message buffer chain
1438 * @tb_ptr: pointer to bearer message arrived on
1439 *
1440 * Invoked with no locks held. Bearer pointer must point to a valid bearer
1441 * structure (i.e. cannot be NULL), but bearer can be inactive.
1442 */
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001443void tipc_rcv(struct sk_buff *head, struct tipc_bearer *b_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001444{
Per Liden4323add2006-01-18 00:38:21 +01001445 read_lock_bh(&tipc_net_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001446 while (head) {
David S. Miller6c000552008-09-02 23:38:32 -07001447 struct tipc_node *n_ptr;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001448 struct tipc_link *l_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001449 struct sk_buff *crs;
1450 struct sk_buff *buf = head;
Allan Stephens85035562008-04-15 19:04:54 -07001451 struct tipc_msg *msg;
1452 u32 seq_no;
1453 u32 ackd;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001454 u32 released = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001455
Per Lidenb97bf3f2006-01-02 19:04:38 +01001456 head = head->next;
Erik Hugne732256b2014-01-07 15:51:36 -05001457 buf->next = NULL;
Allan Stephens85035562008-04-15 19:04:54 -07001458
Allan Stephensb02b69c2010-08-17 11:00:07 +00001459 /* Ensure bearer is still enabled */
Allan Stephensb02b69c2010-08-17 11:00:07 +00001460 if (unlikely(!b_ptr->active))
Ying Xue3af390e2013-10-30 11:26:57 +08001461 goto discard;
Allan Stephensb02b69c2010-08-17 11:00:07 +00001462
Allan Stephens85035562008-04-15 19:04:54 -07001463 /* Ensure message is well-formed */
Allan Stephens85035562008-04-15 19:04:54 -07001464 if (unlikely(!link_recv_buf_validate(buf)))
Ying Xue3af390e2013-10-30 11:26:57 +08001465 goto discard;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001466
Allan Stephensfe13dda2008-04-15 19:03:23 -07001467 /* Ensure message data is a single contiguous unit */
Allan Stephens5f6d9122011-11-04 13:24:29 -04001468 if (unlikely(skb_linearize(buf)))
Ying Xue3af390e2013-10-30 11:26:57 +08001469 goto discard;
Allan Stephensfe13dda2008-04-15 19:03:23 -07001470
Allan Stephens85035562008-04-15 19:04:54 -07001471 /* Handle arrival of a non-unicast link message */
Allan Stephens85035562008-04-15 19:04:54 -07001472 msg = buf_msg(buf);
1473
Per Lidenb97bf3f2006-01-02 19:04:38 +01001474 if (unlikely(msg_non_seq(msg))) {
Allan Stephens1265a022008-06-04 17:32:35 -07001475 if (msg_user(msg) == LINK_CONFIG)
Ying Xue247f0f32014-02-18 16:06:46 +08001476 tipc_disc_rcv(buf, b_ptr);
Allan Stephens1265a022008-06-04 17:32:35 -07001477 else
Ying Xue247f0f32014-02-18 16:06:46 +08001478 tipc_bclink_rcv(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001479 continue;
1480 }
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001481
Allan Stephensed33a9c2011-04-05 15:15:04 -04001482 /* Discard unicast link messages destined for another node */
Allan Stephens26008242006-06-25 23:39:31 -07001483 if (unlikely(!msg_short(msg) &&
1484 (msg_destnode(msg) != tipc_own_addr)))
Ying Xue3af390e2013-10-30 11:26:57 +08001485 goto discard;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001486
Allan Stephens5a68d5e2010-08-17 11:00:16 +00001487 /* Locate neighboring node that sent message */
Per Liden4323add2006-01-18 00:38:21 +01001488 n_ptr = tipc_node_find(msg_prevnode(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001489 if (unlikely(!n_ptr))
Ying Xue3af390e2013-10-30 11:26:57 +08001490 goto discard;
Per Liden4323add2006-01-18 00:38:21 +01001491 tipc_node_lock(n_ptr);
Allan Stephens85035562008-04-15 19:04:54 -07001492
Allan Stephens5a68d5e2010-08-17 11:00:16 +00001493 /* Locate unicast link endpoint that should handle message */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001494 l_ptr = n_ptr->links[b_ptr->identity];
Ying Xue3af390e2013-10-30 11:26:57 +08001495 if (unlikely(!l_ptr))
1496 goto unlock_discard;
Allan Stephens85035562008-04-15 19:04:54 -07001497
Allan Stephensb4b56102011-05-27 11:00:51 -04001498 /* Verify that communication with node is currently allowed */
Allan Stephensb4b56102011-05-27 11:00:51 -04001499 if ((n_ptr->block_setup & WAIT_PEER_DOWN) &&
1500 msg_user(msg) == LINK_PROTOCOL &&
1501 (msg_type(msg) == RESET_MSG ||
Jon Paul Maloya5377832014-02-13 17:29:15 -05001502 msg_type(msg) == ACTIVATE_MSG) &&
Allan Stephensb4b56102011-05-27 11:00:51 -04001503 !msg_redundant_link(msg))
1504 n_ptr->block_setup &= ~WAIT_PEER_DOWN;
1505
Ying Xue3af390e2013-10-30 11:26:57 +08001506 if (n_ptr->block_setup)
1507 goto unlock_discard;
Allan Stephensb4b56102011-05-27 11:00:51 -04001508
Allan Stephens85035562008-04-15 19:04:54 -07001509 /* Validate message sequence number info */
Allan Stephens85035562008-04-15 19:04:54 -07001510 seq_no = msg_seqno(msg);
1511 ackd = msg_ack(msg);
1512
1513 /* Release acked messages */
Ying Xue389dd9b2012-11-16 13:51:30 +08001514 if (n_ptr->bclink.recv_permitted)
Allan Stephens365595912011-10-24 15:26:24 -04001515 tipc_bclink_acknowledge(n_ptr, msg_bcast_ack(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001516
1517 crs = l_ptr->first_out;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001518 while ((crs != l_ptr->next_out) &&
Allan Stephensf9057302011-10-24 16:03:12 -04001519 less_eq(buf_seqno(crs), ackd)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001520 struct sk_buff *next = crs->next;
Allan Stephens5f6d9122011-11-04 13:24:29 -04001521 kfree_skb(crs);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001522 crs = next;
1523 released++;
1524 }
1525 if (released) {
1526 l_ptr->first_out = crs;
1527 l_ptr->out_queue_size -= released;
1528 }
Allan Stephens85035562008-04-15 19:04:54 -07001529
1530 /* Try sending any messages link endpoint has pending */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001531 if (unlikely(l_ptr->next_out))
Per Liden4323add2006-01-18 00:38:21 +01001532 tipc_link_push_queue(l_ptr);
Jon Paul Maloya5377832014-02-13 17:29:15 -05001533
Per Lidenb97bf3f2006-01-02 19:04:38 +01001534 if (unlikely(!list_empty(&l_ptr->waiting_ports)))
Per Liden4323add2006-01-18 00:38:21 +01001535 tipc_link_wakeup_ports(l_ptr, 0);
Jon Paul Maloya5377832014-02-13 17:29:15 -05001536
Per Lidenb97bf3f2006-01-02 19:04:38 +01001537 if (unlikely(++l_ptr->unacked_window >= TIPC_MIN_LINK_WIN)) {
1538 l_ptr->stats.sent_acks++;
Ying Xue247f0f32014-02-18 16:06:46 +08001539 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001540 }
1541
Jon Paul Maloya5377832014-02-13 17:29:15 -05001542 /* Process the incoming packet */
Ying Xue3af390e2013-10-30 11:26:57 +08001543 if (unlikely(!link_working_working(l_ptr))) {
1544 if (msg_user(msg) == LINK_PROTOCOL) {
Ying Xue247f0f32014-02-18 16:06:46 +08001545 tipc_link_proto_rcv(l_ptr, buf);
Ying Xue3af390e2013-10-30 11:26:57 +08001546 head = link_insert_deferred_queue(l_ptr, head);
Per Liden4323add2006-01-18 00:38:21 +01001547 tipc_node_unlock(n_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001548 continue;
1549 }
Ying Xue3af390e2013-10-30 11:26:57 +08001550
1551 /* Traffic message. Conditionally activate link */
1552 link_state_event(l_ptr, TRAFFIC_MSG_EVT);
1553
1554 if (link_working_working(l_ptr)) {
1555 /* Re-insert buffer in front of queue */
1556 buf->next = head;
1557 head = buf;
1558 tipc_node_unlock(n_ptr);
1559 continue;
1560 }
1561 goto unlock_discard;
1562 }
1563
1564 /* Link is now in state WORKING_WORKING */
1565 if (unlikely(seq_no != mod(l_ptr->next_in_no))) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001566 link_handle_out_of_seq_msg(l_ptr, buf);
1567 head = link_insert_deferred_queue(l_ptr, head);
Per Liden4323add2006-01-18 00:38:21 +01001568 tipc_node_unlock(n_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001569 continue;
1570 }
Ying Xue3af390e2013-10-30 11:26:57 +08001571 l_ptr->next_in_no++;
1572 if (unlikely(l_ptr->oldest_deferred_in))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001573 head = link_insert_deferred_queue(l_ptr, head);
Jon Paul Maloya5377832014-02-13 17:29:15 -05001574
1575 /* Deliver packet/message to correct user: */
1576 if (unlikely(msg_user(msg) == CHANGEOVER_PROTOCOL)) {
1577 if (!tipc_link_tunnel_rcv(n_ptr, &buf)) {
1578 tipc_node_unlock(n_ptr);
1579 continue;
1580 }
1581 msg = buf_msg(buf);
1582 } else if (msg_user(msg) == MSG_FRAGMENTER) {
1583 int rc;
1584
1585 l_ptr->stats.recv_fragments++;
1586 rc = tipc_link_frag_rcv(&l_ptr->reasm_head,
1587 &l_ptr->reasm_tail,
1588 &buf);
1589 if (rc == LINK_REASM_COMPLETE) {
1590 l_ptr->stats.recv_fragmented++;
1591 msg = buf_msg(buf);
1592 } else {
1593 if (rc == LINK_REASM_ERROR)
1594 tipc_link_reset(l_ptr);
1595 tipc_node_unlock(n_ptr);
1596 continue;
1597 }
1598 }
1599
1600 switch (msg_user(msg)) {
1601 case TIPC_LOW_IMPORTANCE:
1602 case TIPC_MEDIUM_IMPORTANCE:
1603 case TIPC_HIGH_IMPORTANCE:
1604 case TIPC_CRITICAL_IMPORTANCE:
Per Liden4323add2006-01-18 00:38:21 +01001605 tipc_node_unlock(n_ptr);
Ying Xue247f0f32014-02-18 16:06:46 +08001606 tipc_port_rcv(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001607 continue;
Ying Xue3af390e2013-10-30 11:26:57 +08001608 case MSG_BUNDLER:
1609 l_ptr->stats.recv_bundles++;
1610 l_ptr->stats.recv_bundled += msg_msgcnt(msg);
1611 tipc_node_unlock(n_ptr);
Ying Xue247f0f32014-02-18 16:06:46 +08001612 tipc_link_bundle_rcv(buf);
Ying Xue3af390e2013-10-30 11:26:57 +08001613 continue;
1614 case NAME_DISTRIBUTOR:
1615 n_ptr->bclink.recv_permitted = true;
1616 tipc_node_unlock(n_ptr);
Ying Xue247f0f32014-02-18 16:06:46 +08001617 tipc_named_rcv(buf);
Ying Xue3af390e2013-10-30 11:26:57 +08001618 continue;
Ying Xue3af390e2013-10-30 11:26:57 +08001619 case CONN_MANAGER:
1620 tipc_node_unlock(n_ptr);
Ying Xue247f0f32014-02-18 16:06:46 +08001621 tipc_port_proto_rcv(buf);
Ying Xue3af390e2013-10-30 11:26:57 +08001622 continue;
Jon Paul Maloya5377832014-02-13 17:29:15 -05001623 case BCAST_PROTOCOL:
Ying Xue247f0f32014-02-18 16:06:46 +08001624 tipc_link_sync_rcv(n_ptr, buf);
Jon Paul Maloya5377832014-02-13 17:29:15 -05001625 break;
Ying Xue3af390e2013-10-30 11:26:57 +08001626 default:
1627 kfree_skb(buf);
Ying Xue3af390e2013-10-30 11:26:57 +08001628 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001629 }
Per Liden4323add2006-01-18 00:38:21 +01001630 tipc_node_unlock(n_ptr);
Ying Xue3af390e2013-10-30 11:26:57 +08001631 continue;
1632unlock_discard:
Ying Xue3af390e2013-10-30 11:26:57 +08001633 tipc_node_unlock(n_ptr);
1634discard:
Allan Stephens5f6d9122011-11-04 13:24:29 -04001635 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001636 }
Per Liden4323add2006-01-18 00:38:21 +01001637 read_unlock_bh(&tipc_net_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001638}
1639
Ben Hutchings2c530402012-07-10 10:55:09 +00001640/**
Allan Stephens8809b252011-10-25 10:44:35 -04001641 * tipc_link_defer_pkt - Add out-of-sequence message to deferred reception queue
1642 *
1643 * Returns increase in queue length (i.e. 0 or 1)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001644 */
Allan Stephens8809b252011-10-25 10:44:35 -04001645u32 tipc_link_defer_pkt(struct sk_buff **head, struct sk_buff **tail,
Per Liden4323add2006-01-18 00:38:21 +01001646 struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001647{
Allan Stephens8809b252011-10-25 10:44:35 -04001648 struct sk_buff *queue_buf;
1649 struct sk_buff **prev;
Allan Stephensf9057302011-10-24 16:03:12 -04001650 u32 seq_no = buf_seqno(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001651
1652 buf->next = NULL;
1653
1654 /* Empty queue ? */
1655 if (*head == NULL) {
1656 *head = *tail = buf;
1657 return 1;
1658 }
1659
1660 /* Last ? */
Allan Stephensf9057302011-10-24 16:03:12 -04001661 if (less(buf_seqno(*tail), seq_no)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001662 (*tail)->next = buf;
1663 *tail = buf;
1664 return 1;
1665 }
1666
Allan Stephens8809b252011-10-25 10:44:35 -04001667 /* Locate insertion point in queue, then insert; discard if duplicate */
1668 prev = head;
1669 queue_buf = *head;
1670 for (;;) {
1671 u32 curr_seqno = buf_seqno(queue_buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001672
Allan Stephens8809b252011-10-25 10:44:35 -04001673 if (seq_no == curr_seqno) {
Allan Stephens5f6d9122011-11-04 13:24:29 -04001674 kfree_skb(buf);
Allan Stephens8809b252011-10-25 10:44:35 -04001675 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001676 }
Allan Stephens8809b252011-10-25 10:44:35 -04001677
1678 if (less(seq_no, curr_seqno))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001679 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001680
Allan Stephens8809b252011-10-25 10:44:35 -04001681 prev = &queue_buf->next;
1682 queue_buf = queue_buf->next;
1683 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001684
Allan Stephens8809b252011-10-25 10:44:35 -04001685 buf->next = queue_buf;
1686 *prev = buf;
1687 return 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001688}
1689
Allan Stephens8809b252011-10-25 10:44:35 -04001690/*
Per Lidenb97bf3f2006-01-02 19:04:38 +01001691 * link_handle_out_of_seq_msg - handle arrival of out-of-sequence packet
1692 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001693static void link_handle_out_of_seq_msg(struct tipc_link *l_ptr,
Per Lidenb97bf3f2006-01-02 19:04:38 +01001694 struct sk_buff *buf)
1695{
Allan Stephensf9057302011-10-24 16:03:12 -04001696 u32 seq_no = buf_seqno(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001697
1698 if (likely(msg_user(buf_msg(buf)) == LINK_PROTOCOL)) {
Ying Xue247f0f32014-02-18 16:06:46 +08001699 tipc_link_proto_rcv(l_ptr, buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001700 return;
1701 }
1702
Per Lidenb97bf3f2006-01-02 19:04:38 +01001703 /* Record OOS packet arrival (force mismatch on next timeout) */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001704 l_ptr->checkpoint--;
1705
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001706 /*
Per Lidenb97bf3f2006-01-02 19:04:38 +01001707 * Discard packet if a duplicate; otherwise add it to deferred queue
1708 * and notify peer of gap as per protocol specification
1709 */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001710 if (less(seq_no, mod(l_ptr->next_in_no))) {
1711 l_ptr->stats.duplicates++;
Allan Stephens5f6d9122011-11-04 13:24:29 -04001712 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001713 return;
1714 }
1715
Per Liden4323add2006-01-18 00:38:21 +01001716 if (tipc_link_defer_pkt(&l_ptr->oldest_deferred_in,
1717 &l_ptr->newest_deferred_in, buf)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001718 l_ptr->deferred_inqueue_sz++;
1719 l_ptr->stats.deferred_recv++;
1720 if ((l_ptr->deferred_inqueue_sz % 16) == 1)
Ying Xue247f0f32014-02-18 16:06:46 +08001721 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001722 } else
1723 l_ptr->stats.duplicates++;
1724}
1725
1726/*
1727 * Send protocol message to the other endpoint.
1728 */
Ying Xue247f0f32014-02-18 16:06:46 +08001729void tipc_link_proto_xmit(struct tipc_link *l_ptr, u32 msg_typ, int probe_msg,
1730 u32 gap, u32 tolerance, u32 priority, u32 ack_mtu)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001731{
Sam Ravnborg1fc54d82006-03-20 22:36:47 -08001732 struct sk_buff *buf = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001733 struct tipc_msg *msg = l_ptr->pmsg;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001734 u32 msg_size = sizeof(l_ptr->proto_msg);
Allan Stephens75f0aa42011-02-28 15:30:20 -05001735 int r_flag;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001736
Allan Stephens92d2c902011-10-25 11:20:26 -04001737 /* Discard any previous message that was deferred due to congestion */
Allan Stephens92d2c902011-10-25 11:20:26 -04001738 if (l_ptr->proto_msg_queue) {
Allan Stephens5f6d9122011-11-04 13:24:29 -04001739 kfree_skb(l_ptr->proto_msg_queue);
Allan Stephens92d2c902011-10-25 11:20:26 -04001740 l_ptr->proto_msg_queue = NULL;
1741 }
1742
Ying Xue77a7e072013-12-10 20:45:44 -08001743 /* Don't send protocol message during link changeover */
1744 if (l_ptr->exp_msg_count)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001745 return;
Allan Stephensb4b56102011-05-27 11:00:51 -04001746
1747 /* Abort non-RESET send if communication with node is prohibited */
Allan Stephensb4b56102011-05-27 11:00:51 -04001748 if ((l_ptr->owner->block_setup) && (msg_typ != RESET_MSG))
1749 return;
1750
Allan Stephens92d2c902011-10-25 11:20:26 -04001751 /* Create protocol message with "out-of-sequence" sequence number */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001752 msg_set_type(msg, msg_typ);
1753 msg_set_net_plane(msg, l_ptr->b_ptr->net_plane);
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001754 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Per Liden4323add2006-01-18 00:38:21 +01001755 msg_set_last_bcast(msg, tipc_bclink_get_last_sent());
Per Lidenb97bf3f2006-01-02 19:04:38 +01001756
1757 if (msg_typ == STATE_MSG) {
1758 u32 next_sent = mod(l_ptr->next_out_no);
1759
Per Liden4323add2006-01-18 00:38:21 +01001760 if (!tipc_link_is_up(l_ptr))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001761 return;
1762 if (l_ptr->next_out)
Allan Stephensf9057302011-10-24 16:03:12 -04001763 next_sent = buf_seqno(l_ptr->next_out);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001764 msg_set_next_sent(msg, next_sent);
1765 if (l_ptr->oldest_deferred_in) {
Allan Stephensf9057302011-10-24 16:03:12 -04001766 u32 rec = buf_seqno(l_ptr->oldest_deferred_in);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001767 gap = mod(rec - mod(l_ptr->next_in_no));
1768 }
1769 msg_set_seq_gap(msg, gap);
1770 if (gap)
1771 l_ptr->stats.sent_nacks++;
1772 msg_set_link_tolerance(msg, tolerance);
1773 msg_set_linkprio(msg, priority);
1774 msg_set_max_pkt(msg, ack_mtu);
1775 msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
1776 msg_set_probe(msg, probe_msg != 0);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001777 if (probe_msg) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001778 u32 mtu = l_ptr->max_pkt;
1779
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001780 if ((mtu < l_ptr->max_pkt_target) &&
Per Lidenb97bf3f2006-01-02 19:04:38 +01001781 link_working_working(l_ptr) &&
1782 l_ptr->fsm_msg_cnt) {
1783 msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001784 if (l_ptr->max_pkt_probes == 10) {
1785 l_ptr->max_pkt_target = (msg_size - 4);
1786 l_ptr->max_pkt_probes = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001787 msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001788 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001789 l_ptr->max_pkt_probes++;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001790 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001791
1792 l_ptr->stats.sent_probes++;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001793 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001794 l_ptr->stats.sent_states++;
1795 } else { /* RESET_MSG or ACTIVATE_MSG */
1796 msg_set_ack(msg, mod(l_ptr->reset_checkpoint - 1));
1797 msg_set_seq_gap(msg, 0);
1798 msg_set_next_sent(msg, 1);
Allan Stephensf23d9bf2011-01-18 15:15:34 -05001799 msg_set_probe(msg, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001800 msg_set_link_tolerance(msg, l_ptr->tolerance);
1801 msg_set_linkprio(msg, l_ptr->priority);
1802 msg_set_max_pkt(msg, l_ptr->max_pkt_target);
1803 }
1804
Allan Stephens75f0aa42011-02-28 15:30:20 -05001805 r_flag = (l_ptr->owner->working_links > tipc_link_is_up(l_ptr));
1806 msg_set_redundant_link(msg, r_flag);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001807 msg_set_linkprio(msg, l_ptr->priority);
Allan Stephens92d2c902011-10-25 11:20:26 -04001808 msg_set_size(msg, msg_size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001809
1810 msg_set_seqno(msg, mod(l_ptr->next_out_no + (0xffff/2)));
1811
stephen hemminger31e3c3f2010-10-13 13:20:35 +00001812 buf = tipc_buf_acquire(msg_size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001813 if (!buf)
1814 return;
1815
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03001816 skb_copy_to_linear_data(buf, msg, sizeof(l_ptr->proto_msg));
Ying Xue796c75d2013-06-17 10:54:48 -04001817 buf->priority = TC_PRIO_CONTROL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001818
Ying Xue3c294cb2012-11-15 11:34:45 +08001819 tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr);
Allan Stephens92d2c902011-10-25 11:20:26 -04001820 l_ptr->unacked_window = 0;
Allan Stephens5f6d9122011-11-04 13:24:29 -04001821 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001822}
1823
1824/*
1825 * Receive protocol message :
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001826 * Note that network plane id propagates through the network, and may
1827 * change at any time. The node with lowest address rules
Per Lidenb97bf3f2006-01-02 19:04:38 +01001828 */
Ying Xue247f0f32014-02-18 16:06:46 +08001829static void tipc_link_proto_rcv(struct tipc_link *l_ptr, struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001830{
1831 u32 rec_gap = 0;
1832 u32 max_pkt_info;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001833 u32 max_pkt_ack;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001834 u32 msg_tol;
1835 struct tipc_msg *msg = buf_msg(buf);
1836
Ying Xue77a7e072013-12-10 20:45:44 -08001837 /* Discard protocol message during link changeover */
1838 if (l_ptr->exp_msg_count)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001839 goto exit;
1840
1841 /* record unnumbered packet arrival (force mismatch on next timeout) */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001842 l_ptr->checkpoint--;
1843
1844 if (l_ptr->b_ptr->net_plane != msg_net_plane(msg))
1845 if (tipc_own_addr > msg_prevnode(msg))
1846 l_ptr->b_ptr->net_plane = msg_net_plane(msg);
1847
Per Lidenb97bf3f2006-01-02 19:04:38 +01001848 switch (msg_type(msg)) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001849
Per Lidenb97bf3f2006-01-02 19:04:38 +01001850 case RESET_MSG:
Allan Stephensa686e682008-06-04 17:29:39 -07001851 if (!link_working_unknown(l_ptr) &&
1852 (l_ptr->peer_session != INVALID_SESSION)) {
Allan Stephens641c2182011-04-07 09:54:43 -04001853 if (less_eq(msg_session(msg), l_ptr->peer_session))
1854 break; /* duplicate or old reset: ignore */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001855 }
Allan Stephensb4b56102011-05-27 11:00:51 -04001856
1857 if (!msg_redundant_link(msg) && (link_working_working(l_ptr) ||
1858 link_working_unknown(l_ptr))) {
1859 /*
1860 * peer has lost contact -- don't allow peer's links
1861 * to reactivate before we recognize loss & clean up
1862 */
1863 l_ptr->owner->block_setup = WAIT_NODE_DOWN;
1864 }
1865
Allan Stephens47361c82011-10-26 10:55:16 -04001866 link_state_event(l_ptr, RESET_MSG);
1867
Per Lidenb97bf3f2006-01-02 19:04:38 +01001868 /* fall thru' */
1869 case ACTIVATE_MSG:
1870 /* Update link settings according other endpoint's values */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001871 strcpy((strrchr(l_ptr->name, ':') + 1), (char *)msg_data(msg));
1872
Allan Stephens2db99832010-12-31 18:59:33 +00001873 msg_tol = msg_link_tolerance(msg);
1874 if (msg_tol > l_ptr->tolerance)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001875 link_set_supervision_props(l_ptr, msg_tol);
1876
1877 if (msg_linkprio(msg) > l_ptr->priority)
1878 l_ptr->priority = msg_linkprio(msg);
1879
1880 max_pkt_info = msg_max_pkt(msg);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001881 if (max_pkt_info) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001882 if (max_pkt_info < l_ptr->max_pkt_target)
1883 l_ptr->max_pkt_target = max_pkt_info;
1884 if (l_ptr->max_pkt > l_ptr->max_pkt_target)
1885 l_ptr->max_pkt = l_ptr->max_pkt_target;
1886 } else {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001887 l_ptr->max_pkt = l_ptr->max_pkt_target;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001888 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001889
Allan Stephens4d753132011-10-25 12:19:05 -04001890 /* Synchronize broadcast link info, if not done previously */
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001891 if (!tipc_node_is_up(l_ptr->owner)) {
1892 l_ptr->owner->bclink.last_sent =
1893 l_ptr->owner->bclink.last_in =
1894 msg_last_bcast(msg);
1895 l_ptr->owner->bclink.oos_state = 0;
1896 }
Allan Stephens4d753132011-10-25 12:19:05 -04001897
Per Lidenb97bf3f2006-01-02 19:04:38 +01001898 l_ptr->peer_session = msg_session(msg);
1899 l_ptr->peer_bearer_id = msg_bearer_id(msg);
Allan Stephens47361c82011-10-26 10:55:16 -04001900
1901 if (msg_type(msg) == ACTIVATE_MSG)
1902 link_state_event(l_ptr, ACTIVATE_MSG);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001903 break;
1904 case STATE_MSG:
1905
Allan Stephens2db99832010-12-31 18:59:33 +00001906 msg_tol = msg_link_tolerance(msg);
1907 if (msg_tol)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001908 link_set_supervision_props(l_ptr, msg_tol);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001909
1910 if (msg_linkprio(msg) &&
Per Lidenb97bf3f2006-01-02 19:04:38 +01001911 (msg_linkprio(msg) != l_ptr->priority)) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001912 pr_warn("%s<%s>, priority change %u->%u\n",
1913 link_rst_msg, l_ptr->name, l_ptr->priority,
1914 msg_linkprio(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001915 l_ptr->priority = msg_linkprio(msg);
Per Liden4323add2006-01-18 00:38:21 +01001916 tipc_link_reset(l_ptr); /* Enforce change to take effect */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001917 break;
1918 }
1919 link_state_event(l_ptr, TRAFFIC_MSG_EVT);
1920 l_ptr->stats.recv_states++;
1921 if (link_reset_unknown(l_ptr))
1922 break;
1923
1924 if (less_eq(mod(l_ptr->next_in_no), msg_next_sent(msg))) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001925 rec_gap = mod(msg_next_sent(msg) -
Per Lidenb97bf3f2006-01-02 19:04:38 +01001926 mod(l_ptr->next_in_no));
1927 }
1928
1929 max_pkt_ack = msg_max_pkt(msg);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001930 if (max_pkt_ack > l_ptr->max_pkt) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001931 l_ptr->max_pkt = max_pkt_ack;
1932 l_ptr->max_pkt_probes = 0;
1933 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001934
1935 max_pkt_ack = 0;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001936 if (msg_probe(msg)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001937 l_ptr->stats.recv_probes++;
Allan Stephensa0168922010-12-31 18:59:35 +00001938 if (msg_size(msg) > sizeof(l_ptr->proto_msg))
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001939 max_pkt_ack = msg_size(msg);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001940 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001941
1942 /* Protocol message before retransmits, reduce loss risk */
Ying Xue389dd9b2012-11-16 13:51:30 +08001943 if (l_ptr->owner->bclink.recv_permitted)
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001944 tipc_bclink_update_link_state(l_ptr->owner,
1945 msg_last_bcast(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001946
1947 if (rec_gap || (msg_probe(msg))) {
Ying Xue247f0f32014-02-18 16:06:46 +08001948 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, rec_gap, 0,
1949 0, max_pkt_ack);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001950 }
1951 if (msg_seq_gap(msg)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001952 l_ptr->stats.recv_nacks++;
Per Liden4323add2006-01-18 00:38:21 +01001953 tipc_link_retransmit(l_ptr, l_ptr->first_out,
1954 msg_seq_gap(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001955 }
1956 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001957 }
1958exit:
Allan Stephens5f6d9122011-11-04 13:24:29 -04001959 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001960}
1961
1962
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001963/* tipc_link_tunnel_xmit(): Tunnel one packet via a link belonging to
1964 * a different bearer. Owner node is locked.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001965 */
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001966static void tipc_link_tunnel_xmit(struct tipc_link *l_ptr,
1967 struct tipc_msg *tunnel_hdr,
1968 struct tipc_msg *msg,
1969 u32 selector)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001970{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001971 struct tipc_link *tunnel;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001972 struct sk_buff *buf;
1973 u32 length = msg_size(msg);
1974
1975 tunnel = l_ptr->owner->active_links[selector & 1];
Allan Stephens5392d642006-06-25 23:52:50 -07001976 if (!tipc_link_is_up(tunnel)) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001977 pr_warn("%stunnel link no longer available\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001978 return;
Allan Stephens5392d642006-06-25 23:52:50 -07001979 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001980 msg_set_size(tunnel_hdr, length + INT_H_SIZE);
stephen hemminger31e3c3f2010-10-13 13:20:35 +00001981 buf = tipc_buf_acquire(length + INT_H_SIZE);
Allan Stephens5392d642006-06-25 23:52:50 -07001982 if (!buf) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001983 pr_warn("%sunable to send tunnel msg\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001984 return;
Allan Stephens5392d642006-06-25 23:52:50 -07001985 }
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03001986 skb_copy_to_linear_data(buf, tunnel_hdr, INT_H_SIZE);
1987 skb_copy_to_linear_data_offset(buf, INT_H_SIZE, msg, length);
Ying Xue247f0f32014-02-18 16:06:46 +08001988 __tipc_link_xmit(tunnel, buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001989}
1990
1991
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001992/* tipc_link_failover_send_queue(): A link has gone down, but a second
1993 * link is still active. We can do failover. Tunnel the failing link's
1994 * whole send queue via the remaining link. This way, we don't lose
1995 * any packets, and sequence order is preserved for subsequent traffic
1996 * sent over the remaining link. Owner node is locked.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001997 */
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001998void tipc_link_failover_send_queue(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001999{
2000 u32 msgcount = l_ptr->out_queue_size;
2001 struct sk_buff *crs = l_ptr->first_out;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002002 struct tipc_link *tunnel = l_ptr->owner->active_links[0];
Per Lidenb97bf3f2006-01-02 19:04:38 +01002003 struct tipc_msg tunnel_hdr;
Allan Stephens5392d642006-06-25 23:52:50 -07002004 int split_bundles;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002005
2006 if (!tunnel)
2007 return;
2008
Allan Stephensc68ca7b2010-05-11 14:30:12 +00002009 tipc_msg_init(&tunnel_hdr, CHANGEOVER_PROTOCOL,
Allan Stephens75715212008-06-04 17:37:34 -07002010 ORIGINAL_MSG, INT_H_SIZE, l_ptr->addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002011 msg_set_bearer_id(&tunnel_hdr, l_ptr->peer_bearer_id);
2012 msg_set_msgcnt(&tunnel_hdr, msgcount);
Allan Stephensf1310722006-06-25 23:51:37 -07002013
Per Lidenb97bf3f2006-01-02 19:04:38 +01002014 if (!l_ptr->first_out) {
2015 struct sk_buff *buf;
2016
stephen hemminger31e3c3f2010-10-13 13:20:35 +00002017 buf = tipc_buf_acquire(INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002018 if (buf) {
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03002019 skb_copy_to_linear_data(buf, &tunnel_hdr, INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002020 msg_set_size(&tunnel_hdr, INT_H_SIZE);
Ying Xue247f0f32014-02-18 16:06:46 +08002021 __tipc_link_xmit(tunnel, buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002022 } else {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04002023 pr_warn("%sunable to send changeover msg\n",
2024 link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002025 }
2026 return;
2027 }
Allan Stephensf1310722006-06-25 23:51:37 -07002028
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002029 split_bundles = (l_ptr->owner->active_links[0] !=
Allan Stephens5392d642006-06-25 23:52:50 -07002030 l_ptr->owner->active_links[1]);
2031
Per Lidenb97bf3f2006-01-02 19:04:38 +01002032 while (crs) {
2033 struct tipc_msg *msg = buf_msg(crs);
2034
2035 if ((msg_user(msg) == MSG_BUNDLER) && split_bundles) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01002036 struct tipc_msg *m = msg_get_wrapped(msg);
Allan Stephens0e659672010-12-31 18:59:32 +00002037 unchar *pos = (unchar *)m;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002038
Florian Westphald788d802007-08-02 19:28:06 -07002039 msgcount = msg_msgcnt(msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002040 while (msgcount--) {
Allan Stephens0e659672010-12-31 18:59:32 +00002041 msg_set_seqno(m, msg_seqno(msg));
Jon Paul Maloy170b3922014-01-07 17:02:41 -05002042 tipc_link_tunnel_xmit(l_ptr, &tunnel_hdr, m,
2043 msg_link_selector(m));
Per Lidenb97bf3f2006-01-02 19:04:38 +01002044 pos += align(msg_size(m));
2045 m = (struct tipc_msg *)pos;
2046 }
2047 } else {
Jon Paul Maloy170b3922014-01-07 17:02:41 -05002048 tipc_link_tunnel_xmit(l_ptr, &tunnel_hdr, msg,
2049 msg_link_selector(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01002050 }
2051 crs = crs->next;
2052 }
2053}
2054
Ying Xue247f0f32014-02-18 16:06:46 +08002055/* tipc_link_dup_queue_xmit(): A second link has become active. Tunnel a
Jon Paul Maloy170b3922014-01-07 17:02:41 -05002056 * duplicate of the first link's send queue via the new link. This way, we
2057 * are guaranteed that currently queued packets from a socket are delivered
2058 * before future traffic from the same socket, even if this is using the
2059 * new link. The last arriving copy of each duplicate packet is dropped at
2060 * the receiving end by the regular protocol check, so packet cardinality
2061 * and sequence order is preserved per sender/receiver socket pair.
2062 * Owner node is locked.
2063 */
Ying Xue247f0f32014-02-18 16:06:46 +08002064void tipc_link_dup_queue_xmit(struct tipc_link *l_ptr,
Jon Paul Maloy170b3922014-01-07 17:02:41 -05002065 struct tipc_link *tunnel)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002066{
2067 struct sk_buff *iter;
2068 struct tipc_msg tunnel_hdr;
2069
Allan Stephensc68ca7b2010-05-11 14:30:12 +00002070 tipc_msg_init(&tunnel_hdr, CHANGEOVER_PROTOCOL,
Allan Stephens75715212008-06-04 17:37:34 -07002071 DUPLICATE_MSG, INT_H_SIZE, l_ptr->addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002072 msg_set_msgcnt(&tunnel_hdr, l_ptr->out_queue_size);
2073 msg_set_bearer_id(&tunnel_hdr, l_ptr->peer_bearer_id);
2074 iter = l_ptr->first_out;
2075 while (iter) {
2076 struct sk_buff *outbuf;
2077 struct tipc_msg *msg = buf_msg(iter);
2078 u32 length = msg_size(msg);
2079
2080 if (msg_user(msg) == MSG_BUNDLER)
2081 msg_set_type(msg, CLOSED_MSG);
2082 msg_set_ack(msg, mod(l_ptr->next_in_no - 1)); /* Update */
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002083 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002084 msg_set_size(&tunnel_hdr, length + INT_H_SIZE);
stephen hemminger31e3c3f2010-10-13 13:20:35 +00002085 outbuf = tipc_buf_acquire(length + INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002086 if (outbuf == NULL) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04002087 pr_warn("%sunable to send duplicate msg\n",
2088 link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002089 return;
2090 }
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03002091 skb_copy_to_linear_data(outbuf, &tunnel_hdr, INT_H_SIZE);
2092 skb_copy_to_linear_data_offset(outbuf, INT_H_SIZE, iter->data,
2093 length);
Ying Xue247f0f32014-02-18 16:06:46 +08002094 __tipc_link_xmit(tunnel, outbuf);
Per Liden4323add2006-01-18 00:38:21 +01002095 if (!tipc_link_is_up(l_ptr))
Per Lidenb97bf3f2006-01-02 19:04:38 +01002096 return;
2097 iter = iter->next;
2098 }
2099}
2100
Per Lidenb97bf3f2006-01-02 19:04:38 +01002101/**
2102 * buf_extract - extracts embedded TIPC message from another message
2103 * @skb: encapsulating message buffer
2104 * @from_pos: offset to extract from
2105 *
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002106 * Returns a new message buffer containing an embedded message. The
Per Lidenb97bf3f2006-01-02 19:04:38 +01002107 * encapsulating message itself is left unchanged.
2108 */
Per Lidenb97bf3f2006-01-02 19:04:38 +01002109static struct sk_buff *buf_extract(struct sk_buff *skb, u32 from_pos)
2110{
2111 struct tipc_msg *msg = (struct tipc_msg *)(skb->data + from_pos);
2112 u32 size = msg_size(msg);
2113 struct sk_buff *eb;
2114
stephen hemminger31e3c3f2010-10-13 13:20:35 +00002115 eb = tipc_buf_acquire(size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002116 if (eb)
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03002117 skb_copy_to_linear_data(eb, msg, size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002118 return eb;
2119}
2120
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05002121
2122
2123/* tipc_link_dup_rcv(): Receive a tunnelled DUPLICATE_MSG packet.
2124 * Owner node is locked.
2125 */
2126static void tipc_link_dup_rcv(struct tipc_link *l_ptr,
2127 struct sk_buff *t_buf)
2128{
2129 struct sk_buff *buf;
2130
2131 if (!tipc_link_is_up(l_ptr))
2132 return;
2133
2134 buf = buf_extract(t_buf, INT_H_SIZE);
2135 if (buf == NULL) {
2136 pr_warn("%sfailed to extract inner dup pkt\n", link_co_err);
2137 return;
2138 }
2139
2140 /* Add buffer to deferred queue, if applicable: */
2141 link_handle_out_of_seq_msg(l_ptr, buf);
2142}
2143
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05002144/* tipc_link_failover_rcv(): Receive a tunnelled ORIGINAL_MSG packet
2145 * Owner node is locked.
2146 */
2147static struct sk_buff *tipc_link_failover_rcv(struct tipc_link *l_ptr,
2148 struct sk_buff *t_buf)
2149{
2150 struct tipc_msg *t_msg = buf_msg(t_buf);
2151 struct sk_buff *buf = NULL;
2152 struct tipc_msg *msg;
2153
2154 if (tipc_link_is_up(l_ptr))
2155 tipc_link_reset(l_ptr);
2156
2157 /* First failover packet? */
2158 if (l_ptr->exp_msg_count == START_CHANGEOVER)
2159 l_ptr->exp_msg_count = msg_msgcnt(t_msg);
2160
2161 /* Should there be an inner packet? */
2162 if (l_ptr->exp_msg_count) {
2163 l_ptr->exp_msg_count--;
2164 buf = buf_extract(t_buf, INT_H_SIZE);
2165 if (buf == NULL) {
2166 pr_warn("%sno inner failover pkt\n", link_co_err);
2167 goto exit;
2168 }
2169 msg = buf_msg(buf);
2170
2171 if (less(msg_seqno(msg), l_ptr->reset_checkpoint)) {
2172 kfree_skb(buf);
2173 buf = NULL;
2174 goto exit;
2175 }
2176 if (msg_user(msg) == MSG_FRAGMENTER) {
2177 l_ptr->stats.recv_fragments++;
2178 tipc_link_frag_rcv(&l_ptr->reasm_head,
2179 &l_ptr->reasm_tail,
2180 &buf);
2181 }
2182 }
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05002183exit:
Jon Paul Maloy7d339392014-02-13 17:29:16 -05002184 if ((l_ptr->exp_msg_count == 0) && (l_ptr->flags & LINK_STOPPED)) {
2185 tipc_node_detach_link(l_ptr->owner, l_ptr);
2186 kfree(l_ptr);
2187 }
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05002188 return buf;
2189}
2190
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05002191/* tipc_link_tunnel_rcv(): Receive a tunnelled packet, sent
Jon Paul Maloy170b3922014-01-07 17:02:41 -05002192 * via other link as result of a failover (ORIGINAL_MSG) or
2193 * a new active link (DUPLICATE_MSG). Failover packets are
2194 * returned to the active link for delivery upwards.
2195 * Owner node is locked.
Per Lidenb97bf3f2006-01-02 19:04:38 +01002196 */
Jon Paul Maloy3bb53382014-02-13 17:29:12 -05002197static int tipc_link_tunnel_rcv(struct tipc_node *n_ptr,
Jon Paul Maloy170b3922014-01-07 17:02:41 -05002198 struct sk_buff **buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002199{
Jon Paul Maloy02842f72014-02-13 17:29:14 -05002200 struct sk_buff *t_buf = *buf;
2201 struct tipc_link *l_ptr;
2202 struct tipc_msg *t_msg = buf_msg(t_buf);
2203 u32 bearer_id = msg_bearer_id(t_msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002204
Jon Paul Maloy1e9d47a2014-02-13 17:29:13 -05002205 *buf = NULL;
2206
Dan Carpentercb4b102f2013-05-06 08:28:41 +00002207 if (bearer_id >= MAX_BEARERS)
2208 goto exit;
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05002209
Jon Paul Maloy02842f72014-02-13 17:29:14 -05002210 l_ptr = n_ptr->links[bearer_id];
2211 if (!l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002212 goto exit;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002213
Jon Paul Maloy02842f72014-02-13 17:29:14 -05002214 if (msg_type(t_msg) == DUPLICATE_MSG)
2215 tipc_link_dup_rcv(l_ptr, t_buf);
2216 else if (msg_type(t_msg) == ORIGINAL_MSG)
2217 *buf = tipc_link_failover_rcv(l_ptr, t_buf);
Jon Paul Maloy1e9d47a2014-02-13 17:29:13 -05002218 else
2219 pr_warn("%sunknown tunnel pkt received\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002220exit:
Jon Paul Maloy02842f72014-02-13 17:29:14 -05002221 kfree_skb(t_buf);
Jon Paul Maloy1e9d47a2014-02-13 17:29:13 -05002222 return *buf != NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002223}
2224
2225/*
2226 * Bundler functionality:
2227 */
Ying Xue247f0f32014-02-18 16:06:46 +08002228void tipc_link_bundle_rcv(struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002229{
2230 u32 msgcount = msg_msgcnt(buf_msg(buf));
2231 u32 pos = INT_H_SIZE;
2232 struct sk_buff *obuf;
2233
Per Lidenb97bf3f2006-01-02 19:04:38 +01002234 while (msgcount--) {
2235 obuf = buf_extract(buf, pos);
2236 if (obuf == NULL) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04002237 pr_warn("Link unable to unbundle message(s)\n");
Allan Stephensa10bd922006-06-25 23:52:17 -07002238 break;
Stephen Hemminger3ff50b72007-04-20 17:09:22 -07002239 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01002240 pos += align(msg_size(buf_msg(obuf)));
Per Liden4323add2006-01-18 00:38:21 +01002241 tipc_net_route_msg(obuf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002242 }
Allan Stephens5f6d9122011-11-04 13:24:29 -04002243 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002244}
2245
2246/*
2247 * Fragmentation/defragmentation:
2248 */
2249
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002250/*
Ying Xue247f0f32014-02-18 16:06:46 +08002251 * tipc_link_frag_xmit: Entry for buffers needing fragmentation.
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002252 * The buffer is complete, inclusive total message length.
Per Lidenb97bf3f2006-01-02 19:04:38 +01002253 * Returns user data length.
2254 */
Ying Xue247f0f32014-02-18 16:06:46 +08002255static int tipc_link_frag_xmit(struct tipc_link *l_ptr, struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002256{
Allan Stephens77561552011-04-17 13:06:23 -04002257 struct sk_buff *buf_chain = NULL;
2258 struct sk_buff *buf_chain_tail = (struct sk_buff *)&buf_chain;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002259 struct tipc_msg *inmsg = buf_msg(buf);
2260 struct tipc_msg fragm_hdr;
2261 u32 insize = msg_size(inmsg);
2262 u32 dsz = msg_data_sz(inmsg);
2263 unchar *crs = buf->data;
2264 u32 rest = insize;
Allan Stephens15e979d2010-05-11 14:30:10 +00002265 u32 pack_sz = l_ptr->max_pkt;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002266 u32 fragm_sz = pack_sz - INT_H_SIZE;
Allan Stephens77561552011-04-17 13:06:23 -04002267 u32 fragm_no = 0;
Allan Stephens9c396a72008-06-04 17:36:58 -07002268 u32 destaddr;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002269
2270 if (msg_short(inmsg))
2271 destaddr = l_ptr->addr;
Allan Stephens9c396a72008-06-04 17:36:58 -07002272 else
2273 destaddr = msg_destnode(inmsg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002274
Per Lidenb97bf3f2006-01-02 19:04:38 +01002275 /* Prepare reusable fragment header: */
Allan Stephensc68ca7b2010-05-11 14:30:12 +00002276 tipc_msg_init(&fragm_hdr, MSG_FRAGMENTER, FIRST_FRAGMENT,
Allan Stephens75715212008-06-04 17:37:34 -07002277 INT_H_SIZE, destaddr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002278
2279 /* Chop up message: */
Per Lidenb97bf3f2006-01-02 19:04:38 +01002280 while (rest > 0) {
2281 struct sk_buff *fragm;
2282
2283 if (rest <= fragm_sz) {
2284 fragm_sz = rest;
2285 msg_set_type(&fragm_hdr, LAST_FRAGMENT);
2286 }
stephen hemminger31e3c3f2010-10-13 13:20:35 +00002287 fragm = tipc_buf_acquire(fragm_sz + INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002288 if (fragm == NULL) {
Allan Stephens5f6d9122011-11-04 13:24:29 -04002289 kfree_skb(buf);
Ying Xued77b3832013-12-10 20:45:38 -08002290 kfree_skb_list(buf_chain);
Allan Stephens77561552011-04-17 13:06:23 -04002291 return -ENOMEM;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002292 }
2293 msg_set_size(&fragm_hdr, fragm_sz + INT_H_SIZE);
Allan Stephens77561552011-04-17 13:06:23 -04002294 fragm_no++;
2295 msg_set_fragm_no(&fragm_hdr, fragm_no);
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03002296 skb_copy_to_linear_data(fragm, &fragm_hdr, INT_H_SIZE);
2297 skb_copy_to_linear_data_offset(fragm, INT_H_SIZE, crs,
2298 fragm_sz);
Allan Stephens77561552011-04-17 13:06:23 -04002299 buf_chain_tail->next = fragm;
2300 buf_chain_tail = fragm;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002301
Per Lidenb97bf3f2006-01-02 19:04:38 +01002302 rest -= fragm_sz;
2303 crs += fragm_sz;
2304 msg_set_type(&fragm_hdr, FRAGMENT);
2305 }
Allan Stephens5f6d9122011-11-04 13:24:29 -04002306 kfree_skb(buf);
Allan Stephens77561552011-04-17 13:06:23 -04002307
2308 /* Append chain of fragments to send queue & send them */
Allan Stephens77561552011-04-17 13:06:23 -04002309 l_ptr->long_msg_seq_no++;
2310 link_add_chain_to_outqueue(l_ptr, buf_chain, l_ptr->long_msg_seq_no);
2311 l_ptr->stats.sent_fragments += fragm_no;
2312 l_ptr->stats.sent_fragmented++;
2313 tipc_link_push_queue(l_ptr);
2314
Per Lidenb97bf3f2006-01-02 19:04:38 +01002315 return dsz;
2316}
2317
Jon Paul Maloy03b92012014-02-13 17:29:05 -05002318/* tipc_link_frag_rcv(): Called with node lock on. Returns
Per Lidenb97bf3f2006-01-02 19:04:38 +01002319 * the reassembled buffer if message is complete.
2320 */
Jon Paul Maloy03b92012014-02-13 17:29:05 -05002321int tipc_link_frag_rcv(struct sk_buff **head, struct sk_buff **tail,
2322 struct sk_buff **fbuf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002323{
Erik Hugne40ba3cd2013-11-06 09:28:06 +01002324 struct sk_buff *frag = *fbuf;
2325 struct tipc_msg *msg = buf_msg(frag);
2326 u32 fragid = msg_type(msg);
2327 bool headstolen;
2328 int delta;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002329
Erik Hugne40ba3cd2013-11-06 09:28:06 +01002330 skb_pull(frag, msg_hdr_sz(msg));
2331 if (fragid == FIRST_FRAGMENT) {
2332 if (*head || skb_unclone(frag, GFP_ATOMIC))
2333 goto out_free;
2334 *head = frag;
2335 skb_frag_list_init(*head);
Jon Paul Maloy03b92012014-02-13 17:29:05 -05002336 *fbuf = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002337 return 0;
Erik Hugne3db0a192013-11-13 09:35:11 +01002338 } else if (*head &&
2339 skb_try_coalesce(*head, frag, &headstolen, &delta)) {
Erik Hugne40ba3cd2013-11-06 09:28:06 +01002340 kfree_skb_partial(frag, headstolen);
2341 } else {
2342 if (!*head)
2343 goto out_free;
2344 if (!skb_has_frag_list(*head))
2345 skb_shinfo(*head)->frag_list = frag;
2346 else
2347 (*tail)->next = frag;
2348 *tail = frag;
2349 (*head)->truesize += frag->truesize;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002350 }
Erik Hugne40ba3cd2013-11-06 09:28:06 +01002351 if (fragid == LAST_FRAGMENT) {
2352 *fbuf = *head;
2353 *tail = *head = NULL;
2354 return LINK_REASM_COMPLETE;
2355 }
Jon Paul Maloy03b92012014-02-13 17:29:05 -05002356 *fbuf = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002357 return 0;
Erik Hugne40ba3cd2013-11-06 09:28:06 +01002358out_free:
2359 pr_warn_ratelimited("Link unable to reassemble fragmented message\n");
2360 kfree_skb(*fbuf);
Jon Paul Maloy03b92012014-02-13 17:29:05 -05002361 *fbuf = NULL;
Erik Hugne40ba3cd2013-11-06 09:28:06 +01002362 return LINK_REASM_ERROR;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002363}
2364
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002365static void link_set_supervision_props(struct tipc_link *l_ptr, u32 tolerance)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002366{
Allan Stephens5413b4c2011-01-18 13:24:55 -05002367 if ((tolerance < TIPC_MIN_LINK_TOL) || (tolerance > TIPC_MAX_LINK_TOL))
2368 return;
2369
Per Lidenb97bf3f2006-01-02 19:04:38 +01002370 l_ptr->tolerance = tolerance;
2371 l_ptr->continuity_interval =
2372 ((tolerance / 4) > 500) ? 500 : tolerance / 4;
2373 l_ptr->abort_limit = tolerance / (l_ptr->continuity_interval / 4);
2374}
2375
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002376void tipc_link_set_queue_limits(struct tipc_link *l_ptr, u32 window)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002377{
2378 /* Data messages from this node, inclusive FIRST_FRAGM */
Allan Stephens06d82c92008-03-06 15:06:55 -08002379 l_ptr->queue_limit[TIPC_LOW_IMPORTANCE] = window;
2380 l_ptr->queue_limit[TIPC_MEDIUM_IMPORTANCE] = (window / 3) * 4;
2381 l_ptr->queue_limit[TIPC_HIGH_IMPORTANCE] = (window / 3) * 5;
2382 l_ptr->queue_limit[TIPC_CRITICAL_IMPORTANCE] = (window / 3) * 6;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002383 /* Transiting data messages,inclusive FIRST_FRAGM */
Allan Stephens06d82c92008-03-06 15:06:55 -08002384 l_ptr->queue_limit[TIPC_LOW_IMPORTANCE + 4] = 300;
2385 l_ptr->queue_limit[TIPC_MEDIUM_IMPORTANCE + 4] = 600;
2386 l_ptr->queue_limit[TIPC_HIGH_IMPORTANCE + 4] = 900;
2387 l_ptr->queue_limit[TIPC_CRITICAL_IMPORTANCE + 4] = 1200;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002388 l_ptr->queue_limit[CONN_MANAGER] = 1200;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002389 l_ptr->queue_limit[CHANGEOVER_PROTOCOL] = 2500;
2390 l_ptr->queue_limit[NAME_DISTRIBUTOR] = 3000;
2391 /* FRAGMENT and LAST_FRAGMENT packets */
2392 l_ptr->queue_limit[MSG_FRAGMENTER] = 4000;
2393}
2394
Jon Paul Maloye099e862014-02-13 17:29:18 -05002395/* tipc_link_find_owner - locate owner node of link by link's name
2396 * @name: pointer to link name string
2397 * @bearer_id: pointer to index in 'node->links' array where the link was found.
Per Liden4323add2006-01-18 00:38:21 +01002398 * Caller must hold 'tipc_net_lock' to ensure node and bearer are not deleted;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002399 * this also prevents link deletion.
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002400 *
Jon Paul Maloye099e862014-02-13 17:29:18 -05002401 * Returns pointer to node owning the link, or 0 if no matching link is found.
Per Lidenb97bf3f2006-01-02 19:04:38 +01002402 */
Jon Paul Maloye099e862014-02-13 17:29:18 -05002403static struct tipc_node *tipc_link_find_owner(const char *link_name,
2404 unsigned int *bearer_id)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002405{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002406 struct tipc_link *l_ptr;
Erik Hugnebbfbe472013-10-18 07:23:21 +02002407 struct tipc_node *n_ptr;
Jon Paul Maloye099e862014-02-13 17:29:18 -05002408 struct tipc_node *tmp_n_ptr;
2409 struct tipc_node *found_node = 0;
2410
Erik Hugnebbfbe472013-10-18 07:23:21 +02002411 int i;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002412
Jon Paul Maloye099e862014-02-13 17:29:18 -05002413 *bearer_id = 0;
2414 list_for_each_entry_safe(n_ptr, tmp_n_ptr, &tipc_node_list, list) {
Jon Paul Maloya11607f2014-02-14 16:40:44 -05002415 tipc_node_lock(n_ptr);
Erik Hugnebbfbe472013-10-18 07:23:21 +02002416 for (i = 0; i < MAX_BEARERS; i++) {
2417 l_ptr = n_ptr->links[i];
Jon Paul Maloye099e862014-02-13 17:29:18 -05002418 if (l_ptr && !strcmp(l_ptr->name, link_name)) {
2419 *bearer_id = i;
2420 found_node = n_ptr;
2421 break;
2422 }
Erik Hugnebbfbe472013-10-18 07:23:21 +02002423 }
Jon Paul Maloya11607f2014-02-14 16:40:44 -05002424 tipc_node_unlock(n_ptr);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002425 if (found_node)
2426 break;
Erik Hugnebbfbe472013-10-18 07:23:21 +02002427 }
Jon Paul Maloye099e862014-02-13 17:29:18 -05002428 return found_node;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002429}
2430
Allan Stephens5c216e12011-10-18 11:34:29 -04002431/**
2432 * link_value_is_valid -- validate proposed link tolerance/priority/window
2433 *
Ben Hutchings2c530402012-07-10 10:55:09 +00002434 * @cmd: value type (TIPC_CMD_SET_LINK_*)
2435 * @new_value: the new value
Allan Stephens5c216e12011-10-18 11:34:29 -04002436 *
2437 * Returns 1 if value is within range, 0 if not.
2438 */
Allan Stephens5c216e12011-10-18 11:34:29 -04002439static int link_value_is_valid(u16 cmd, u32 new_value)
2440{
2441 switch (cmd) {
2442 case TIPC_CMD_SET_LINK_TOL:
2443 return (new_value >= TIPC_MIN_LINK_TOL) &&
2444 (new_value <= TIPC_MAX_LINK_TOL);
2445 case TIPC_CMD_SET_LINK_PRI:
2446 return (new_value <= TIPC_MAX_LINK_PRI);
2447 case TIPC_CMD_SET_LINK_WINDOW:
2448 return (new_value >= TIPC_MIN_LINK_WIN) &&
2449 (new_value <= TIPC_MAX_LINK_WIN);
2450 }
2451 return 0;
2452}
2453
Allan Stephens5c216e12011-10-18 11:34:29 -04002454/**
2455 * link_cmd_set_value - change priority/tolerance/window for link/bearer/media
Ben Hutchings2c530402012-07-10 10:55:09 +00002456 * @name: ptr to link, bearer, or media name
2457 * @new_value: new value of link, bearer, or media setting
2458 * @cmd: which link, bearer, or media attribute to set (TIPC_CMD_SET_LINK_*)
Allan Stephens5c216e12011-10-18 11:34:29 -04002459 *
2460 * Caller must hold 'tipc_net_lock' to ensure link/bearer/media is not deleted.
2461 *
2462 * Returns 0 if value updated and negative value on error.
2463 */
Allan Stephens5c216e12011-10-18 11:34:29 -04002464static int link_cmd_set_value(const char *name, u32 new_value, u16 cmd)
2465{
2466 struct tipc_node *node;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002467 struct tipc_link *l_ptr;
Allan Stephens5c216e12011-10-18 11:34:29 -04002468 struct tipc_bearer *b_ptr;
Paul Gortmaker358a0d12011-12-29 20:19:42 -05002469 struct tipc_media *m_ptr;
Jon Paul Maloye099e862014-02-13 17:29:18 -05002470 int bearer_id;
Ying Xue636c0372013-10-18 07:23:20 +02002471 int res = 0;
Allan Stephens5c216e12011-10-18 11:34:29 -04002472
Jon Paul Maloye099e862014-02-13 17:29:18 -05002473 node = tipc_link_find_owner(name, &bearer_id);
2474 if (node) {
Allan Stephens5c216e12011-10-18 11:34:29 -04002475 tipc_node_lock(node);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002476 l_ptr = node->links[bearer_id];
2477
2478 if (l_ptr) {
2479 switch (cmd) {
2480 case TIPC_CMD_SET_LINK_TOL:
2481 link_set_supervision_props(l_ptr, new_value);
Ying Xue247f0f32014-02-18 16:06:46 +08002482 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0,
2483 new_value, 0, 0);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002484 break;
2485 case TIPC_CMD_SET_LINK_PRI:
2486 l_ptr->priority = new_value;
Ying Xue247f0f32014-02-18 16:06:46 +08002487 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0,
2488 0, new_value, 0);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002489 break;
2490 case TIPC_CMD_SET_LINK_WINDOW:
2491 tipc_link_set_queue_limits(l_ptr, new_value);
2492 break;
2493 default:
2494 res = -EINVAL;
2495 break;
2496 }
Allan Stephens5c216e12011-10-18 11:34:29 -04002497 }
2498 tipc_node_unlock(node);
Ying Xue636c0372013-10-18 07:23:20 +02002499 return res;
Allan Stephens5c216e12011-10-18 11:34:29 -04002500 }
2501
2502 b_ptr = tipc_bearer_find(name);
2503 if (b_ptr) {
2504 switch (cmd) {
2505 case TIPC_CMD_SET_LINK_TOL:
2506 b_ptr->tolerance = new_value;
Ying Xue636c0372013-10-18 07:23:20 +02002507 break;
Allan Stephens5c216e12011-10-18 11:34:29 -04002508 case TIPC_CMD_SET_LINK_PRI:
2509 b_ptr->priority = new_value;
Ying Xue636c0372013-10-18 07:23:20 +02002510 break;
Allan Stephens5c216e12011-10-18 11:34:29 -04002511 case TIPC_CMD_SET_LINK_WINDOW:
2512 b_ptr->window = new_value;
Ying Xue636c0372013-10-18 07:23:20 +02002513 break;
2514 default:
2515 res = -EINVAL;
2516 break;
Allan Stephens5c216e12011-10-18 11:34:29 -04002517 }
Ying Xue636c0372013-10-18 07:23:20 +02002518 return res;
Allan Stephens5c216e12011-10-18 11:34:29 -04002519 }
2520
2521 m_ptr = tipc_media_find(name);
2522 if (!m_ptr)
2523 return -ENODEV;
2524 switch (cmd) {
2525 case TIPC_CMD_SET_LINK_TOL:
2526 m_ptr->tolerance = new_value;
Ying Xue636c0372013-10-18 07:23:20 +02002527 break;
Allan Stephens5c216e12011-10-18 11:34:29 -04002528 case TIPC_CMD_SET_LINK_PRI:
2529 m_ptr->priority = new_value;
Ying Xue636c0372013-10-18 07:23:20 +02002530 break;
Allan Stephens5c216e12011-10-18 11:34:29 -04002531 case TIPC_CMD_SET_LINK_WINDOW:
2532 m_ptr->window = new_value;
Ying Xue636c0372013-10-18 07:23:20 +02002533 break;
2534 default:
2535 res = -EINVAL;
2536 break;
Allan Stephens5c216e12011-10-18 11:34:29 -04002537 }
Ying Xue636c0372013-10-18 07:23:20 +02002538 return res;
Allan Stephens5c216e12011-10-18 11:34:29 -04002539}
2540
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002541struct sk_buff *tipc_link_cmd_config(const void *req_tlv_area, int req_tlv_space,
Per Liden4323add2006-01-18 00:38:21 +01002542 u16 cmd)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002543{
2544 struct tipc_link_config *args;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002545 u32 new_value;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002546 int res;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002547
2548 if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_LINK_CONFIG))
Per Liden4323add2006-01-18 00:38:21 +01002549 return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002550
2551 args = (struct tipc_link_config *)TLV_DATA(req_tlv_area);
2552 new_value = ntohl(args->value);
2553
Allan Stephens5c216e12011-10-18 11:34:29 -04002554 if (!link_value_is_valid(cmd, new_value))
2555 return tipc_cfg_reply_error_string(
2556 "cannot change, value invalid");
2557
Per Liden4323add2006-01-18 00:38:21 +01002558 if (!strcmp(args->name, tipc_bclink_name)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01002559 if ((cmd == TIPC_CMD_SET_LINK_WINDOW) &&
Per Liden4323add2006-01-18 00:38:21 +01002560 (tipc_bclink_set_queue_limits(new_value) == 0))
2561 return tipc_cfg_reply_none();
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002562 return tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED
Per Liden4323add2006-01-18 00:38:21 +01002563 " (cannot change setting on broadcast link)");
Per Lidenb97bf3f2006-01-02 19:04:38 +01002564 }
2565
Per Liden4323add2006-01-18 00:38:21 +01002566 read_lock_bh(&tipc_net_lock);
Allan Stephens5c216e12011-10-18 11:34:29 -04002567 res = link_cmd_set_value(args->name, new_value, cmd);
Per Liden4323add2006-01-18 00:38:21 +01002568 read_unlock_bh(&tipc_net_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002569 if (res)
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002570 return tipc_cfg_reply_error_string("cannot change link setting");
Per Lidenb97bf3f2006-01-02 19:04:38 +01002571
Per Liden4323add2006-01-18 00:38:21 +01002572 return tipc_cfg_reply_none();
Per Lidenb97bf3f2006-01-02 19:04:38 +01002573}
2574
2575/**
2576 * link_reset_statistics - reset link statistics
2577 * @l_ptr: pointer to link
2578 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002579static void link_reset_statistics(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002580{
2581 memset(&l_ptr->stats, 0, sizeof(l_ptr->stats));
2582 l_ptr->stats.sent_info = l_ptr->next_out_no;
2583 l_ptr->stats.recv_info = l_ptr->next_in_no;
2584}
2585
Per Liden4323add2006-01-18 00:38:21 +01002586struct sk_buff *tipc_link_cmd_reset_stats(const void *req_tlv_area, int req_tlv_space)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002587{
2588 char *link_name;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002589 struct tipc_link *l_ptr;
David S. Miller6c000552008-09-02 23:38:32 -07002590 struct tipc_node *node;
Jon Paul Maloye099e862014-02-13 17:29:18 -05002591 unsigned int bearer_id;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002592
2593 if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_LINK_NAME))
Per Liden4323add2006-01-18 00:38:21 +01002594 return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002595
2596 link_name = (char *)TLV_DATA(req_tlv_area);
Per Liden4323add2006-01-18 00:38:21 +01002597 if (!strcmp(link_name, tipc_bclink_name)) {
2598 if (tipc_bclink_reset_stats())
2599 return tipc_cfg_reply_error_string("link not found");
2600 return tipc_cfg_reply_none();
Per Lidenb97bf3f2006-01-02 19:04:38 +01002601 }
Per Liden4323add2006-01-18 00:38:21 +01002602 read_lock_bh(&tipc_net_lock);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002603 node = tipc_link_find_owner(link_name, &bearer_id);
2604 if (!node) {
Per Liden4323add2006-01-18 00:38:21 +01002605 read_unlock_bh(&tipc_net_lock);
2606 return tipc_cfg_reply_error_string("link not found");
Per Lidenb97bf3f2006-01-02 19:04:38 +01002607 }
Jon Paul Maloya11607f2014-02-14 16:40:44 -05002608 tipc_node_lock(node);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002609 l_ptr = node->links[bearer_id];
2610 if (!l_ptr) {
2611 tipc_node_unlock(node);
2612 read_unlock_bh(&tipc_net_lock);
2613 return tipc_cfg_reply_error_string("link not found");
2614 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01002615 link_reset_statistics(l_ptr);
Per Liden4323add2006-01-18 00:38:21 +01002616 tipc_node_unlock(node);
2617 read_unlock_bh(&tipc_net_lock);
2618 return tipc_cfg_reply_none();
Per Lidenb97bf3f2006-01-02 19:04:38 +01002619}
2620
2621/**
2622 * percent - convert count to a percentage of total (rounding up or down)
2623 */
Per Lidenb97bf3f2006-01-02 19:04:38 +01002624static u32 percent(u32 count, u32 total)
2625{
2626 return (count * 100 + (total / 2)) / total;
2627}
2628
2629/**
Per Liden4323add2006-01-18 00:38:21 +01002630 * tipc_link_stats - print link statistics
Per Lidenb97bf3f2006-01-02 19:04:38 +01002631 * @name: link name
2632 * @buf: print buffer area
2633 * @buf_size: size of print buffer area
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002634 *
Per Lidenb97bf3f2006-01-02 19:04:38 +01002635 * Returns length of print buffer data string (or 0 if error)
2636 */
Per Liden4323add2006-01-18 00:38:21 +01002637static int tipc_link_stats(const char *name, char *buf, const u32 buf_size)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002638{
Erik Hugnedc1aed32012-06-29 00:50:23 -04002639 struct tipc_link *l;
2640 struct tipc_stats *s;
David S. Miller6c000552008-09-02 23:38:32 -07002641 struct tipc_node *node;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002642 char *status;
2643 u32 profile_total = 0;
Jon Paul Maloye099e862014-02-13 17:29:18 -05002644 unsigned int bearer_id;
Erik Hugnedc1aed32012-06-29 00:50:23 -04002645 int ret;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002646
Per Liden4323add2006-01-18 00:38:21 +01002647 if (!strcmp(name, tipc_bclink_name))
2648 return tipc_bclink_stats(buf, buf_size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002649
Per Liden4323add2006-01-18 00:38:21 +01002650 read_lock_bh(&tipc_net_lock);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002651 node = tipc_link_find_owner(name, &bearer_id);
2652 if (!node) {
Per Liden4323add2006-01-18 00:38:21 +01002653 read_unlock_bh(&tipc_net_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002654 return 0;
2655 }
Per Liden4323add2006-01-18 00:38:21 +01002656 tipc_node_lock(node);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002657
2658 l = node->links[bearer_id];
2659 if (!l) {
2660 tipc_node_unlock(node);
2661 read_unlock_bh(&tipc_net_lock);
2662 return 0;
2663 }
2664
Erik Hugnedc1aed32012-06-29 00:50:23 -04002665 s = &l->stats;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002666
Erik Hugnedc1aed32012-06-29 00:50:23 -04002667 if (tipc_link_is_active(l))
Per Lidenb97bf3f2006-01-02 19:04:38 +01002668 status = "ACTIVE";
Erik Hugnedc1aed32012-06-29 00:50:23 -04002669 else if (tipc_link_is_up(l))
Per Lidenb97bf3f2006-01-02 19:04:38 +01002670 status = "STANDBY";
2671 else
2672 status = "DEFUNCT";
Erik Hugnedc1aed32012-06-29 00:50:23 -04002673
2674 ret = tipc_snprintf(buf, buf_size, "Link <%s>\n"
2675 " %s MTU:%u Priority:%u Tolerance:%u ms"
2676 " Window:%u packets\n",
2677 l->name, status, l->max_pkt, l->priority,
2678 l->tolerance, l->queue_limit[0]);
2679
2680 ret += tipc_snprintf(buf + ret, buf_size - ret,
2681 " RX packets:%u fragments:%u/%u bundles:%u/%u\n",
2682 l->next_in_no - s->recv_info, s->recv_fragments,
2683 s->recv_fragmented, s->recv_bundles,
2684 s->recv_bundled);
2685
2686 ret += tipc_snprintf(buf + ret, buf_size - ret,
2687 " TX packets:%u fragments:%u/%u bundles:%u/%u\n",
2688 l->next_out_no - s->sent_info, s->sent_fragments,
2689 s->sent_fragmented, s->sent_bundles,
2690 s->sent_bundled);
2691
2692 profile_total = s->msg_length_counts;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002693 if (!profile_total)
2694 profile_total = 1;
Erik Hugnedc1aed32012-06-29 00:50:23 -04002695
2696 ret += tipc_snprintf(buf + ret, buf_size - ret,
2697 " TX profile sample:%u packets average:%u octets\n"
2698 " 0-64:%u%% -256:%u%% -1024:%u%% -4096:%u%% "
2699 "-16384:%u%% -32768:%u%% -66000:%u%%\n",
2700 s->msg_length_counts,
2701 s->msg_lengths_total / profile_total,
2702 percent(s->msg_length_profile[0], profile_total),
2703 percent(s->msg_length_profile[1], profile_total),
2704 percent(s->msg_length_profile[2], profile_total),
2705 percent(s->msg_length_profile[3], profile_total),
2706 percent(s->msg_length_profile[4], profile_total),
2707 percent(s->msg_length_profile[5], profile_total),
2708 percent(s->msg_length_profile[6], profile_total));
2709
2710 ret += tipc_snprintf(buf + ret, buf_size - ret,
2711 " RX states:%u probes:%u naks:%u defs:%u"
2712 " dups:%u\n", s->recv_states, s->recv_probes,
2713 s->recv_nacks, s->deferred_recv, s->duplicates);
2714
2715 ret += tipc_snprintf(buf + ret, buf_size - ret,
2716 " TX states:%u probes:%u naks:%u acks:%u"
2717 " dups:%u\n", s->sent_states, s->sent_probes,
2718 s->sent_nacks, s->sent_acks, s->retransmitted);
2719
2720 ret += tipc_snprintf(buf + ret, buf_size - ret,
Ying Xue3c294cb2012-11-15 11:34:45 +08002721 " Congestion link:%u Send queue"
2722 " max:%u avg:%u\n", s->link_congs,
Erik Hugnedc1aed32012-06-29 00:50:23 -04002723 s->max_queue_sz, s->queue_sz_counts ?
2724 (s->accu_queue_sz / s->queue_sz_counts) : 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002725
Per Liden4323add2006-01-18 00:38:21 +01002726 tipc_node_unlock(node);
2727 read_unlock_bh(&tipc_net_lock);
Erik Hugnedc1aed32012-06-29 00:50:23 -04002728 return ret;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002729}
2730
Per Liden4323add2006-01-18 00:38:21 +01002731struct sk_buff *tipc_link_cmd_show_stats(const void *req_tlv_area, int req_tlv_space)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002732{
2733 struct sk_buff *buf;
2734 struct tlv_desc *rep_tlv;
2735 int str_len;
Erik Hugnedc1aed32012-06-29 00:50:23 -04002736 int pb_len;
2737 char *pb;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002738
2739 if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_LINK_NAME))
Per Liden4323add2006-01-18 00:38:21 +01002740 return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002741
Erik Hugnedc1aed32012-06-29 00:50:23 -04002742 buf = tipc_cfg_reply_alloc(TLV_SPACE(ULTRA_STRING_MAX_LEN));
Per Lidenb97bf3f2006-01-02 19:04:38 +01002743 if (!buf)
2744 return NULL;
2745
2746 rep_tlv = (struct tlv_desc *)buf->data;
Erik Hugnedc1aed32012-06-29 00:50:23 -04002747 pb = TLV_DATA(rep_tlv);
2748 pb_len = ULTRA_STRING_MAX_LEN;
Per Liden4323add2006-01-18 00:38:21 +01002749 str_len = tipc_link_stats((char *)TLV_DATA(req_tlv_area),
Erik Hugnedc1aed32012-06-29 00:50:23 -04002750 pb, pb_len);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002751 if (!str_len) {
Allan Stephens5f6d9122011-11-04 13:24:29 -04002752 kfree_skb(buf);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002753 return tipc_cfg_reply_error_string("link not found");
Per Lidenb97bf3f2006-01-02 19:04:38 +01002754 }
Erik Hugnedc1aed32012-06-29 00:50:23 -04002755 str_len += 1; /* for "\0" */
Per Lidenb97bf3f2006-01-02 19:04:38 +01002756 skb_put(buf, TLV_SPACE(str_len));
2757 TLV_SET(rep_tlv, TIPC_TLV_ULTRA_STRING, NULL, str_len);
2758
2759 return buf;
2760}
2761
Per Lidenb97bf3f2006-01-02 19:04:38 +01002762/**
Per Liden4323add2006-01-18 00:38:21 +01002763 * tipc_link_get_max_pkt - get maximum packet size to use when sending to destination
Per Lidenb97bf3f2006-01-02 19:04:38 +01002764 * @dest: network address of destination node
2765 * @selector: used to select from set of active links
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002766 *
Per Lidenb97bf3f2006-01-02 19:04:38 +01002767 * If no active link can be found, uses default maximum packet size.
2768 */
Per Liden4323add2006-01-18 00:38:21 +01002769u32 tipc_link_get_max_pkt(u32 dest, u32 selector)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002770{
David S. Miller6c000552008-09-02 23:38:32 -07002771 struct tipc_node *n_ptr;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002772 struct tipc_link *l_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002773 u32 res = MAX_PKT_DEFAULT;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002774
Per Lidenb97bf3f2006-01-02 19:04:38 +01002775 if (dest == tipc_own_addr)
2776 return MAX_MSG_SIZE;
2777
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002778 read_lock_bh(&tipc_net_lock);
Allan Stephens51a8e4d2010-12-31 18:59:18 +00002779 n_ptr = tipc_node_find(dest);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002780 if (n_ptr) {
Per Liden4323add2006-01-18 00:38:21 +01002781 tipc_node_lock(n_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002782 l_ptr = n_ptr->active_links[selector & 1];
2783 if (l_ptr)
Allan Stephens15e979d2010-05-11 14:30:10 +00002784 res = l_ptr->max_pkt;
Per Liden4323add2006-01-18 00:38:21 +01002785 tipc_node_unlock(n_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002786 }
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002787 read_unlock_bh(&tipc_net_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002788 return res;
2789}
2790
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002791static void link_print(struct tipc_link *l_ptr, const char *str)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002792{
Paul Gortmaker5deedde2012-07-11 19:27:56 -04002793 pr_info("%s Link %x<%s>:", str, l_ptr->addr, l_ptr->b_ptr->name);
Allan Stephens8d64a5b2010-12-31 18:59:27 +00002794
Per Lidenb97bf3f2006-01-02 19:04:38 +01002795 if (link_working_unknown(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04002796 pr_cont(":WU\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00002797 else if (link_reset_reset(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04002798 pr_cont(":RR\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00002799 else if (link_reset_unknown(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04002800 pr_cont(":RU\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00002801 else if (link_working_working(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04002802 pr_cont(":WW\n");
2803 else
2804 pr_cont("\n");
Per Lidenb97bf3f2006-01-02 19:04:38 +01002805}