blob: 4fb4ae0a75ed82d171aac3c78eda0f1a080e2f47 [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);
Paul Gortmakera18c4bc2011-12-29 20:58:42 -050080static void link_recv_proto_msg(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);
Allan Stephens23dd4cc2011-01-07 11:43:40 -050084static int link_send_sections_long(struct tipc_port *sender,
Per Lidenb97bf3f2006-01-02 19:04:38 +010085 struct iovec const *msg_sect,
Ying Xue9446b872013-10-18 07:23:15 +020086 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);
Paul Gortmakera18c4bc2011-12-29 20:58:42 -050090static int link_send_long_buf(struct tipc_link *l_ptr, struct sk_buff *buf);
Jon Maloyc64f7a62012-11-16 13:51:31 +080091static void tipc_link_send_sync(struct tipc_link *l);
92static void tipc_link_recv_sync(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 Stephensf882cb762011-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)) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900515 tipc_link_send_proto_msg(l_ptr, STATE_MSG,
Per Liden4323add2006-01-18 00:38:21 +0100516 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) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900519 tipc_link_send_proto_msg(l_ptr, STATE_MSG,
Per Liden4323add2006-01-18 00:38:21 +0100520 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;
Per Liden4323add2006-01-18 00:38:21 +0100528 tipc_link_send_proto_msg(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;
Per Liden4323add2006-01-18 00:38:21 +0100538 tipc_link_send_proto_msg(l_ptr, ACTIVATE_MSG, 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100539 l_ptr->fsm_msg_cnt++;
540 link_set_timer(l_ptr, cont_intv);
541 break;
542 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400543 pr_err("%s%u in WW state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100544 }
545 break;
546 case WORKING_UNKNOWN:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100547 switch (event) {
548 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100549 case ACTIVATE_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100550 l_ptr->state = WORKING_WORKING;
551 l_ptr->fsm_msg_cnt = 0;
552 link_set_timer(l_ptr, cont_intv);
553 break;
554 case RESET_MSG:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400555 pr_info("%s<%s>, requested by peer while probing\n",
556 link_rst_msg, l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100557 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100558 l_ptr->state = RESET_RESET;
559 l_ptr->fsm_msg_cnt = 0;
Per Liden4323add2006-01-18 00:38:21 +0100560 tipc_link_send_proto_msg(l_ptr, ACTIVATE_MSG, 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100561 l_ptr->fsm_msg_cnt++;
562 link_set_timer(l_ptr, cont_intv);
563 break;
564 case TIMEOUT_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100565 if (l_ptr->next_in_no != l_ptr->checkpoint) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100566 l_ptr->state = WORKING_WORKING;
567 l_ptr->fsm_msg_cnt = 0;
568 l_ptr->checkpoint = l_ptr->next_in_no;
Per Liden4323add2006-01-18 00:38:21 +0100569 if (tipc_bclink_acks_missing(l_ptr->owner)) {
570 tipc_link_send_proto_msg(l_ptr, STATE_MSG,
571 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100572 l_ptr->fsm_msg_cnt++;
573 }
574 link_set_timer(l_ptr, cont_intv);
575 } else if (l_ptr->fsm_msg_cnt < l_ptr->abort_limit) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900576 tipc_link_send_proto_msg(l_ptr, STATE_MSG,
Per Liden4323add2006-01-18 00:38:21 +0100577 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100578 l_ptr->fsm_msg_cnt++;
579 link_set_timer(l_ptr, cont_intv / 4);
580 } else { /* Link has failed */
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400581 pr_warn("%s<%s>, peer not responding\n",
582 link_rst_msg, l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100583 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100584 l_ptr->state = RESET_UNKNOWN;
585 l_ptr->fsm_msg_cnt = 0;
Per Liden4323add2006-01-18 00:38:21 +0100586 tipc_link_send_proto_msg(l_ptr, RESET_MSG,
587 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100588 l_ptr->fsm_msg_cnt++;
589 link_set_timer(l_ptr, cont_intv);
590 }
591 break;
592 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400593 pr_err("%s%u in WU state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100594 }
595 break;
596 case RESET_UNKNOWN:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100597 switch (event) {
598 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100599 break;
600 case ACTIVATE_MSG:
601 other = l_ptr->owner->active_links[0];
Allan Stephens8d64a5b2010-12-31 18:59:27 +0000602 if (other && link_working_unknown(other))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100603 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100604 l_ptr->state = WORKING_WORKING;
605 l_ptr->fsm_msg_cnt = 0;
606 link_activate(l_ptr);
Per Liden4323add2006-01-18 00:38:21 +0100607 tipc_link_send_proto_msg(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100608 l_ptr->fsm_msg_cnt++;
Jon Maloyc64f7a62012-11-16 13:51:31 +0800609 if (l_ptr->owner->working_links == 1)
610 tipc_link_send_sync(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100611 link_set_timer(l_ptr, cont_intv);
612 break;
613 case RESET_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100614 l_ptr->state = RESET_RESET;
615 l_ptr->fsm_msg_cnt = 0;
Per Liden4323add2006-01-18 00:38:21 +0100616 tipc_link_send_proto_msg(l_ptr, ACTIVATE_MSG, 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100617 l_ptr->fsm_msg_cnt++;
618 link_set_timer(l_ptr, cont_intv);
619 break;
620 case STARTING_EVT:
Ying Xue135daee2014-02-13 17:29:08 -0500621 l_ptr->flags |= LINK_STARTED;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100622 /* fall through */
623 case TIMEOUT_EVT:
Per Liden4323add2006-01-18 00:38:21 +0100624 tipc_link_send_proto_msg(l_ptr, RESET_MSG, 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100625 l_ptr->fsm_msg_cnt++;
626 link_set_timer(l_ptr, cont_intv);
627 break;
628 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400629 pr_err("%s%u in RU state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100630 }
631 break;
632 case RESET_RESET:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100633 switch (event) {
634 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100635 case ACTIVATE_MSG:
636 other = l_ptr->owner->active_links[0];
Allan Stephens8d64a5b2010-12-31 18:59:27 +0000637 if (other && link_working_unknown(other))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100638 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100639 l_ptr->state = WORKING_WORKING;
640 l_ptr->fsm_msg_cnt = 0;
641 link_activate(l_ptr);
Per Liden4323add2006-01-18 00:38:21 +0100642 tipc_link_send_proto_msg(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100643 l_ptr->fsm_msg_cnt++;
Jon Maloyc64f7a62012-11-16 13:51:31 +0800644 if (l_ptr->owner->working_links == 1)
645 tipc_link_send_sync(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100646 link_set_timer(l_ptr, cont_intv);
647 break;
648 case RESET_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100649 break;
650 case TIMEOUT_EVT:
Per Liden4323add2006-01-18 00:38:21 +0100651 tipc_link_send_proto_msg(l_ptr, ACTIVATE_MSG, 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100652 l_ptr->fsm_msg_cnt++;
653 link_set_timer(l_ptr, cont_intv);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100654 break;
655 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400656 pr_err("%s%u in RR state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100657 }
658 break;
659 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400660 pr_err("Unknown link state %u/%u\n", l_ptr->state, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100661 }
662}
663
664/*
665 * link_bundle_buf(): Append contents of a buffer to
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900666 * the tail of an existing one.
Per Lidenb97bf3f2006-01-02 19:04:38 +0100667 */
Paul Gortmakerae8509c2013-06-17 10:54:47 -0400668static int link_bundle_buf(struct tipc_link *l_ptr, struct sk_buff *bundler,
Per Lidenb97bf3f2006-01-02 19:04:38 +0100669 struct sk_buff *buf)
670{
671 struct tipc_msg *bundler_msg = buf_msg(bundler);
672 struct tipc_msg *msg = buf_msg(buf);
673 u32 size = msg_size(msg);
Allan Stephense49060c2006-06-29 12:32:46 -0700674 u32 bundle_size = msg_size(bundler_msg);
675 u32 to_pos = align(bundle_size);
676 u32 pad = to_pos - bundle_size;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100677
678 if (msg_user(bundler_msg) != MSG_BUNDLER)
679 return 0;
680 if (msg_type(bundler_msg) != OPEN_MSG)
681 return 0;
Allan Stephense49060c2006-06-29 12:32:46 -0700682 if (skb_tailroom(bundler) < (pad + size))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100683 return 0;
Allan Stephens15e979d2010-05-11 14:30:10 +0000684 if (l_ptr->max_pkt < (to_pos + size))
Allan Stephens863fae62006-07-03 19:39:36 -0700685 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100686
Allan Stephense49060c2006-06-29 12:32:46 -0700687 skb_put(bundler, pad + size);
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -0300688 skb_copy_to_linear_data_offset(bundler, to_pos, buf->data, size);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100689 msg_set_size(bundler_msg, to_pos + size);
690 msg_set_msgcnt(bundler_msg, msg_msgcnt(bundler_msg) + 1);
Allan Stephens5f6d9122011-11-04 13:24:29 -0400691 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100692 l_ptr->stats.sent_bundled++;
693 return 1;
694}
695
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500696static void link_add_to_outqueue(struct tipc_link *l_ptr,
Sam Ravnborg05790c62006-03-20 22:37:04 -0800697 struct sk_buff *buf,
698 struct tipc_msg *msg)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100699{
700 u32 ack = mod(l_ptr->next_in_no - 1);
701 u32 seqno = mod(l_ptr->next_out_no++);
702
703 msg_set_word(msg, 2, ((ack << 16) | seqno));
704 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
705 buf->next = NULL;
706 if (l_ptr->first_out) {
707 l_ptr->last_out->next = buf;
708 l_ptr->last_out = buf;
709 } else
710 l_ptr->first_out = l_ptr->last_out = buf;
Allan Stephens9bd80b62011-01-18 15:02:50 -0500711
Per Lidenb97bf3f2006-01-02 19:04:38 +0100712 l_ptr->out_queue_size++;
Allan Stephens9bd80b62011-01-18 15:02:50 -0500713 if (l_ptr->out_queue_size > l_ptr->stats.max_queue_sz)
714 l_ptr->stats.max_queue_sz = l_ptr->out_queue_size;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100715}
716
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500717static void link_add_chain_to_outqueue(struct tipc_link *l_ptr,
Allan Stephensdc63d912011-04-21 11:50:42 -0400718 struct sk_buff *buf_chain,
719 u32 long_msgno)
720{
721 struct sk_buff *buf;
722 struct tipc_msg *msg;
723
724 if (!l_ptr->next_out)
725 l_ptr->next_out = buf_chain;
726 while (buf_chain) {
727 buf = buf_chain;
728 buf_chain = buf_chain->next;
729
730 msg = buf_msg(buf);
731 msg_set_long_msgno(msg, long_msgno);
732 link_add_to_outqueue(l_ptr, buf, msg);
733 }
734}
735
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900736/*
737 * tipc_link_send_buf() is the 'full path' for messages, called from
Per Lidenb97bf3f2006-01-02 19:04:38 +0100738 * inside TIPC when the 'fast path' in tipc_send_buf
739 * has failed, and from link_send()
740 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500741int tipc_link_send_buf(struct tipc_link *l_ptr, struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100742{
743 struct tipc_msg *msg = buf_msg(buf);
744 u32 size = msg_size(msg);
745 u32 dsz = msg_data_sz(msg);
746 u32 queue_size = l_ptr->out_queue_size;
Allan Stephensc68ca7b2010-05-11 14:30:12 +0000747 u32 imp = tipc_msg_tot_importance(msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100748 u32 queue_limit = l_ptr->queue_limit[imp];
Allan Stephens15e979d2010-05-11 14:30:10 +0000749 u32 max_packet = l_ptr->max_pkt;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100750
Per Lidenb97bf3f2006-01-02 19:04:38 +0100751 /* Match msg importance against queue limits: */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100752 if (unlikely(queue_size >= queue_limit)) {
753 if (imp <= TIPC_CRITICAL_IMPORTANCE) {
Allan Stephensbebc55a2011-04-19 10:17:58 -0400754 link_schedule_port(l_ptr, msg_origport(msg), size);
Allan Stephens5f6d9122011-11-04 13:24:29 -0400755 kfree_skb(buf);
Allan Stephensbebc55a2011-04-19 10:17:58 -0400756 return -ELINKCONG;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100757 }
Allan Stephens5f6d9122011-11-04 13:24:29 -0400758 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100759 if (imp > CONN_MANAGER) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400760 pr_warn("%s<%s>, send queue full", link_rst_msg,
761 l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100762 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100763 }
764 return dsz;
765 }
766
767 /* Fragmentation needed ? */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100768 if (size > max_packet)
stephen hemminger31e3c3f2010-10-13 13:20:35 +0000769 return link_send_long_buf(l_ptr, buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100770
Paul Gortmaker617d3c72012-04-30 15:29:02 -0400771 /* Packet can be queued or sent. */
Erik Hugne512137e2013-12-06 10:08:00 -0500772 if (likely(!link_congested(l_ptr))) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100773 link_add_to_outqueue(l_ptr, buf, msg);
774
Ying Xue3c294cb2012-11-15 11:34:45 +0800775 tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr);
776 l_ptr->unacked_window = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100777 return dsz;
778 }
Paul Gortmaker617d3c72012-04-30 15:29:02 -0400779 /* Congestion: can message be bundled ? */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100780 if ((msg_user(msg) != CHANGEOVER_PROTOCOL) &&
781 (msg_user(msg) != MSG_FRAGMENTER)) {
782
783 /* Try adding message to an existing bundle */
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900784 if (l_ptr->next_out &&
Ying Xue3c294cb2012-11-15 11:34:45 +0800785 link_bundle_buf(l_ptr, l_ptr->last_out, buf))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100786 return dsz;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100787
788 /* Try creating a new bundle */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100789 if (size <= max_packet * 2 / 3) {
stephen hemminger31e3c3f2010-10-13 13:20:35 +0000790 struct sk_buff *bundler = tipc_buf_acquire(max_packet);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100791 struct tipc_msg bundler_hdr;
792
793 if (bundler) {
Allan Stephensc68ca7b2010-05-11 14:30:12 +0000794 tipc_msg_init(&bundler_hdr, MSG_BUNDLER, OPEN_MSG,
Allan Stephens75715212008-06-04 17:37:34 -0700795 INT_H_SIZE, l_ptr->addr);
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -0300796 skb_copy_to_linear_data(bundler, &bundler_hdr,
797 INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100798 skb_trim(bundler, INT_H_SIZE);
799 link_bundle_buf(l_ptr, bundler, buf);
800 buf = bundler;
801 msg = buf_msg(buf);
802 l_ptr->stats.sent_bundles++;
803 }
804 }
805 }
806 if (!l_ptr->next_out)
807 l_ptr->next_out = buf;
808 link_add_to_outqueue(l_ptr, buf, msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100809 return dsz;
810}
811
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900812/*
813 * tipc_link_send(): same as tipc_link_send_buf(), but the link to use has
Per Lidenb97bf3f2006-01-02 19:04:38 +0100814 * not been selected yet, and the the owner node is not locked
815 * Called by TIPC internal users, e.g. the name distributor
816 */
Per Liden4323add2006-01-18 00:38:21 +0100817int tipc_link_send(struct sk_buff *buf, u32 dest, u32 selector)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100818{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500819 struct tipc_link *l_ptr;
David S. Miller6c000552008-09-02 23:38:32 -0700820 struct tipc_node *n_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100821 int res = -ELINKCONG;
822
Per Liden4323add2006-01-18 00:38:21 +0100823 read_lock_bh(&tipc_net_lock);
Allan Stephens51a8e4d2010-12-31 18:59:18 +0000824 n_ptr = tipc_node_find(dest);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100825 if (n_ptr) {
Per Liden4323add2006-01-18 00:38:21 +0100826 tipc_node_lock(n_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100827 l_ptr = n_ptr->active_links[selector & 1];
Allan Stephensa0168922010-12-31 18:59:35 +0000828 if (l_ptr)
Per Liden4323add2006-01-18 00:38:21 +0100829 res = tipc_link_send_buf(l_ptr, buf);
Allan Stephensa0168922010-12-31 18:59:35 +0000830 else
Allan Stephens5f6d9122011-11-04 13:24:29 -0400831 kfree_skb(buf);
Per Liden4323add2006-01-18 00:38:21 +0100832 tipc_node_unlock(n_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100833 } else {
Allan Stephens5f6d9122011-11-04 13:24:29 -0400834 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100835 }
Per Liden4323add2006-01-18 00:38:21 +0100836 read_unlock_bh(&tipc_net_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100837 return res;
838}
839
Jon Maloyc64f7a62012-11-16 13:51:31 +0800840/*
841 * tipc_link_send_sync - synchronize broadcast link endpoints.
842 *
843 * Give a newly added peer node the sequence number where it should
844 * start receiving and acking broadcast packets.
845 *
846 * Called with node locked
847 */
848static void tipc_link_send_sync(struct tipc_link *l)
849{
850 struct sk_buff *buf;
851 struct tipc_msg *msg;
852
853 buf = tipc_buf_acquire(INT_H_SIZE);
854 if (!buf)
855 return;
856
857 msg = buf_msg(buf);
858 tipc_msg_init(msg, BCAST_PROTOCOL, STATE_MSG, INT_H_SIZE, l->addr);
859 msg_set_last_bcast(msg, l->owner->bclink.acked);
860 link_add_chain_to_outqueue(l, buf, 0);
861 tipc_link_push_queue(l);
862}
863
864/*
865 * tipc_link_recv_sync - synchronize broadcast link endpoints.
866 * Receive the sequence number where we should start receiving and
867 * acking broadcast packets from a newly added peer node, and open
868 * up for reception of such packets.
869 *
870 * Called with node locked
871 */
872static void tipc_link_recv_sync(struct tipc_node *n, struct sk_buff *buf)
873{
874 struct tipc_msg *msg = buf_msg(buf);
875
876 n->bclink.last_sent = n->bclink.last_in = msg_last_bcast(msg);
877 n->bclink.recv_permitted = true;
878 kfree_skb(buf);
879}
880
881/*
Allan Stephens9aa88c22011-05-31 13:38:02 -0400882 * tipc_link_send_names - send name table entries to new neighbor
883 *
884 * Send routine for bulk delivery of name table messages when contact
885 * with a new neighbor occurs. No link congestion checking is performed
886 * because name table messages *must* be delivered. The messages must be
887 * small enough not to require fragmentation.
888 * Called without any locks held.
889 */
Allan Stephens9aa88c22011-05-31 13:38:02 -0400890void tipc_link_send_names(struct list_head *message_list, u32 dest)
891{
892 struct tipc_node *n_ptr;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500893 struct tipc_link *l_ptr;
Allan Stephens9aa88c22011-05-31 13:38:02 -0400894 struct sk_buff *buf;
895 struct sk_buff *temp_buf;
896
897 if (list_empty(message_list))
898 return;
899
900 read_lock_bh(&tipc_net_lock);
901 n_ptr = tipc_node_find(dest);
902 if (n_ptr) {
903 tipc_node_lock(n_ptr);
904 l_ptr = n_ptr->active_links[0];
905 if (l_ptr) {
906 /* convert circular list to linear list */
907 ((struct sk_buff *)message_list->prev)->next = NULL;
908 link_add_chain_to_outqueue(l_ptr,
909 (struct sk_buff *)message_list->next, 0);
910 tipc_link_push_queue(l_ptr);
911 INIT_LIST_HEAD(message_list);
912 }
913 tipc_node_unlock(n_ptr);
914 }
915 read_unlock_bh(&tipc_net_lock);
916
917 /* discard the messages if they couldn't be sent */
Allan Stephens9aa88c22011-05-31 13:38:02 -0400918 list_for_each_safe(buf, temp_buf, ((struct sk_buff *)message_list)) {
919 list_del((struct list_head *)buf);
Allan Stephens5f6d9122011-11-04 13:24:29 -0400920 kfree_skb(buf);
Allan Stephens9aa88c22011-05-31 13:38:02 -0400921 }
922}
923
924/*
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900925 * link_send_buf_fast: Entry for data messages where the
Per Lidenb97bf3f2006-01-02 19:04:38 +0100926 * destination link is known and the header is complete,
927 * inclusive total message length. Very time critical.
928 * Link is locked. Returns user data length.
929 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500930static int link_send_buf_fast(struct tipc_link *l_ptr, struct sk_buff *buf,
Sam Ravnborg05790c62006-03-20 22:37:04 -0800931 u32 *used_max_pkt)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100932{
933 struct tipc_msg *msg = buf_msg(buf);
934 int res = msg_data_sz(msg);
935
936 if (likely(!link_congested(l_ptr))) {
Allan Stephens15e979d2010-05-11 14:30:10 +0000937 if (likely(msg_size(msg) <= l_ptr->max_pkt)) {
Erik Hugne512137e2013-12-06 10:08:00 -0500938 link_add_to_outqueue(l_ptr, buf, msg);
939 tipc_bearer_send(l_ptr->b_ptr, buf,
940 &l_ptr->media_addr);
941 l_ptr->unacked_window = 0;
942 return res;
943 }
944 else
Allan Stephens15e979d2010-05-11 14:30:10 +0000945 *used_max_pkt = l_ptr->max_pkt;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100946 }
Per Liden4323add2006-01-18 00:38:21 +0100947 return tipc_link_send_buf(l_ptr, buf); /* All other cases */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100948}
949
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900950/*
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900951 * tipc_link_send_sections_fast: Entry for messages where the
Per Lidenb97bf3f2006-01-02 19:04:38 +0100952 * destination processor is known and the header is complete,
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900953 * except for total message length.
Per Lidenb97bf3f2006-01-02 19:04:38 +0100954 * Returns user data length or errno.
955 */
Allan Stephens23dd4cc2011-01-07 11:43:40 -0500956int tipc_link_send_sections_fast(struct tipc_port *sender,
Per Liden4323add2006-01-18 00:38:21 +0100957 struct iovec const *msg_sect,
Ying Xue9446b872013-10-18 07:23:15 +0200958 unsigned int len, u32 destaddr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100959{
Allan Stephens23dd4cc2011-01-07 11:43:40 -0500960 struct tipc_msg *hdr = &sender->phdr;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500961 struct tipc_link *l_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100962 struct sk_buff *buf;
David S. Miller6c000552008-09-02 23:38:32 -0700963 struct tipc_node *node;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100964 int res;
965 u32 selector = msg_origport(hdr) & 1;
966
Per Lidenb97bf3f2006-01-02 19:04:38 +0100967again:
968 /*
969 * Try building message using port's max_pkt hint.
970 * (Must not hold any locks while building message.)
971 */
Ying Xue9446b872013-10-18 07:23:15 +0200972 res = tipc_msg_build(hdr, msg_sect, len, sender->max_pkt, &buf);
Ying Xue7410f962013-06-17 10:54:49 -0400973 /* Exit if build request was invalid */
974 if (unlikely(res < 0))
975 return res;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100976
Per Liden4323add2006-01-18 00:38:21 +0100977 read_lock_bh(&tipc_net_lock);
Allan Stephens51a8e4d2010-12-31 18:59:18 +0000978 node = tipc_node_find(destaddr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100979 if (likely(node)) {
Per Liden4323add2006-01-18 00:38:21 +0100980 tipc_node_lock(node);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100981 l_ptr = node->active_links[selector];
982 if (likely(l_ptr)) {
983 if (likely(buf)) {
984 res = link_send_buf_fast(l_ptr, buf,
Allan Stephens23dd4cc2011-01-07 11:43:40 -0500985 &sender->max_pkt);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100986exit:
Per Liden4323add2006-01-18 00:38:21 +0100987 tipc_node_unlock(node);
988 read_unlock_bh(&tipc_net_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100989 return res;
990 }
991
Per Lidenb97bf3f2006-01-02 19:04:38 +0100992 /* Exit if link (or bearer) is congested */
Erik Hugne512137e2013-12-06 10:08:00 -0500993 if (link_congested(l_ptr)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100994 res = link_schedule_port(l_ptr,
Allan Stephens23dd4cc2011-01-07 11:43:40 -0500995 sender->ref, res);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100996 goto exit;
997 }
998
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900999 /*
Per Lidenb97bf3f2006-01-02 19:04:38 +01001000 * Message size exceeds max_pkt hint; update hint,
1001 * then re-try fast path or fragment the message
1002 */
Allan Stephens23dd4cc2011-01-07 11:43:40 -05001003 sender->max_pkt = l_ptr->max_pkt;
Per Liden4323add2006-01-18 00:38:21 +01001004 tipc_node_unlock(node);
1005 read_unlock_bh(&tipc_net_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001006
1007
Allan Stephens23dd4cc2011-01-07 11:43:40 -05001008 if ((msg_hdr_sz(hdr) + res) <= sender->max_pkt)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001009 goto again;
1010
Ying Xue9446b872013-10-18 07:23:15 +02001011 return link_send_sections_long(sender, msg_sect, len,
Allan Stephens26896902011-04-21 10:42:07 -05001012 destaddr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001013 }
Per Liden4323add2006-01-18 00:38:21 +01001014 tipc_node_unlock(node);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001015 }
Per Liden4323add2006-01-18 00:38:21 +01001016 read_unlock_bh(&tipc_net_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001017
1018 /* Couldn't find a link to the destination node */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001019 if (buf)
1020 return tipc_reject_msg(buf, TIPC_ERR_NO_NODE);
1021 if (res >= 0)
Ying Xue9446b872013-10-18 07:23:15 +02001022 return tipc_port_reject_sections(sender, hdr, msg_sect,
1023 len, TIPC_ERR_NO_NODE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001024 return res;
1025}
1026
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001027/*
1028 * link_send_sections_long(): Entry for long messages where the
Per Lidenb97bf3f2006-01-02 19:04:38 +01001029 * destination node is known and the header is complete,
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001030 * inclusive total message length.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001031 * Link and bearer congestion status have been checked to be ok,
1032 * and are ignored if they change.
1033 *
1034 * Note that fragments do not use the full link MTU so that they won't have
1035 * to undergo refragmentation if link changeover causes them to be sent
1036 * over another link with an additional tunnel header added as prefix.
1037 * (Refragmentation will still occur if the other link has a smaller MTU.)
1038 *
1039 * Returns user data length or errno.
1040 */
Allan Stephens23dd4cc2011-01-07 11:43:40 -05001041static int link_send_sections_long(struct tipc_port *sender,
Per Lidenb97bf3f2006-01-02 19:04:38 +01001042 struct iovec const *msg_sect,
Ying Xue9446b872013-10-18 07:23:15 +02001043 unsigned int len, u32 destaddr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001044{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001045 struct tipc_link *l_ptr;
David S. Miller6c000552008-09-02 23:38:32 -07001046 struct tipc_node *node;
Allan Stephens23dd4cc2011-01-07 11:43:40 -05001047 struct tipc_msg *hdr = &sender->phdr;
Ying Xue9446b872013-10-18 07:23:15 +02001048 u32 dsz = len;
Allan Stephens0e659672010-12-31 18:59:32 +00001049 u32 max_pkt, fragm_sz, rest;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001050 struct tipc_msg fragm_hdr;
Allan Stephens0e659672010-12-31 18:59:32 +00001051 struct sk_buff *buf, *buf_chain, *prev;
1052 u32 fragm_crs, fragm_rest, hsz, sect_rest;
Ying Xue40682432013-10-18 07:23:16 +02001053 const unchar __user *sect_crs;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001054 int curr_sect;
1055 u32 fragm_no;
Ying Xue126c0522013-06-17 10:54:50 -04001056 int res = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001057
1058again:
1059 fragm_no = 1;
Allan Stephens23dd4cc2011-01-07 11:43:40 -05001060 max_pkt = sender->max_pkt - INT_H_SIZE;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001061 /* leave room for tunnel header in case of link changeover */
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001062 fragm_sz = max_pkt - INT_H_SIZE;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001063 /* leave room for fragmentation header in each fragment */
1064 rest = dsz;
1065 fragm_crs = 0;
1066 fragm_rest = 0;
1067 sect_rest = 0;
Sam Ravnborg1fc54d82006-03-20 22:36:47 -08001068 sect_crs = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001069 curr_sect = -1;
1070
Paul Gortmaker617d3c72012-04-30 15:29:02 -04001071 /* Prepare reusable fragment header */
Allan Stephensc68ca7b2010-05-11 14:30:12 +00001072 tipc_msg_init(&fragm_hdr, MSG_FRAGMENTER, FIRST_FRAGMENT,
Allan Stephens75715212008-06-04 17:37:34 -07001073 INT_H_SIZE, msg_destnode(hdr));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001074 msg_set_size(&fragm_hdr, max_pkt);
1075 msg_set_fragm_no(&fragm_hdr, 1);
1076
Paul Gortmaker617d3c72012-04-30 15:29:02 -04001077 /* Prepare header of first fragment */
stephen hemminger31e3c3f2010-10-13 13:20:35 +00001078 buf_chain = buf = tipc_buf_acquire(max_pkt);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001079 if (!buf)
1080 return -ENOMEM;
1081 buf->next = NULL;
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03001082 skb_copy_to_linear_data(buf, &fragm_hdr, INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001083 hsz = msg_hdr_sz(hdr);
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03001084 skb_copy_to_linear_data_offset(buf, INT_H_SIZE, hdr, hsz);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001085
Paul Gortmaker617d3c72012-04-30 15:29:02 -04001086 /* Chop up message */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001087 fragm_crs = INT_H_SIZE + hsz;
1088 fragm_rest = fragm_sz - hsz;
1089
1090 do { /* For all sections */
1091 u32 sz;
1092
1093 if (!sect_rest) {
1094 sect_rest = msg_sect[++curr_sect].iov_len;
Ying Xue40682432013-10-18 07:23:16 +02001095 sect_crs = msg_sect[curr_sect].iov_base;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001096 }
1097
1098 if (sect_rest < fragm_rest)
1099 sz = sect_rest;
1100 else
1101 sz = fragm_rest;
1102
Ying Xuef1733d72013-06-17 10:54:43 -04001103 if (copy_from_user(buf->data + fragm_crs, sect_crs, sz)) {
Ying Xue126c0522013-06-17 10:54:50 -04001104 res = -EFAULT;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001105error:
Ying Xued77b3832013-12-10 20:45:38 -08001106 kfree_skb_list(buf_chain);
Ying Xue126c0522013-06-17 10:54:50 -04001107 return res;
Ying Xuef1733d72013-06-17 10:54:43 -04001108 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001109 sect_crs += sz;
1110 sect_rest -= sz;
1111 fragm_crs += sz;
1112 fragm_rest -= sz;
1113 rest -= sz;
1114
1115 if (!fragm_rest && rest) {
1116
1117 /* Initiate new fragment: */
1118 if (rest <= fragm_sz) {
1119 fragm_sz = rest;
Allan Stephens0e659672010-12-31 18:59:32 +00001120 msg_set_type(&fragm_hdr, LAST_FRAGMENT);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001121 } else {
1122 msg_set_type(&fragm_hdr, FRAGMENT);
1123 }
1124 msg_set_size(&fragm_hdr, fragm_sz + INT_H_SIZE);
1125 msg_set_fragm_no(&fragm_hdr, ++fragm_no);
1126 prev = buf;
stephen hemminger31e3c3f2010-10-13 13:20:35 +00001127 buf = tipc_buf_acquire(fragm_sz + INT_H_SIZE);
Ying Xue126c0522013-06-17 10:54:50 -04001128 if (!buf) {
1129 res = -ENOMEM;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001130 goto error;
Ying Xue126c0522013-06-17 10:54:50 -04001131 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001132
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001133 buf->next = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001134 prev->next = buf;
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03001135 skb_copy_to_linear_data(buf, &fragm_hdr, INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001136 fragm_crs = INT_H_SIZE;
1137 fragm_rest = fragm_sz;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001138 }
Allan Stephens0e659672010-12-31 18:59:32 +00001139 } while (rest > 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001140
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001141 /*
Per Lidenb97bf3f2006-01-02 19:04:38 +01001142 * Now we have a buffer chain. Select a link and check
1143 * that packet size is still OK
1144 */
Allan Stephens51a8e4d2010-12-31 18:59:18 +00001145 node = tipc_node_find(destaddr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001146 if (likely(node)) {
Per Liden4323add2006-01-18 00:38:21 +01001147 tipc_node_lock(node);
Allan Stephens23dd4cc2011-01-07 11:43:40 -05001148 l_ptr = node->active_links[sender->ref & 1];
Per Lidenb97bf3f2006-01-02 19:04:38 +01001149 if (!l_ptr) {
Per Liden4323add2006-01-18 00:38:21 +01001150 tipc_node_unlock(node);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001151 goto reject;
1152 }
Allan Stephens15e979d2010-05-11 14:30:10 +00001153 if (l_ptr->max_pkt < max_pkt) {
Allan Stephens23dd4cc2011-01-07 11:43:40 -05001154 sender->max_pkt = l_ptr->max_pkt;
Per Liden4323add2006-01-18 00:38:21 +01001155 tipc_node_unlock(node);
Ying Xued77b3832013-12-10 20:45:38 -08001156 kfree_skb_list(buf_chain);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001157 goto again;
1158 }
1159 } else {
1160reject:
Ying Xued77b3832013-12-10 20:45:38 -08001161 kfree_skb_list(buf_chain);
Ying Xue9446b872013-10-18 07:23:15 +02001162 return tipc_port_reject_sections(sender, hdr, msg_sect,
1163 len, TIPC_ERR_NO_NODE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001164 }
1165
Allan Stephensdc63d912011-04-21 11:50:42 -04001166 /* Append chain of fragments to send queue & send them */
Allan Stephense0f08592011-04-17 11:44:24 -04001167 l_ptr->long_msg_seq_no++;
Allan Stephensdc63d912011-04-21 11:50:42 -04001168 link_add_chain_to_outqueue(l_ptr, buf_chain, l_ptr->long_msg_seq_no);
1169 l_ptr->stats.sent_fragments += fragm_no;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001170 l_ptr->stats.sent_fragmented++;
Per Liden4323add2006-01-18 00:38:21 +01001171 tipc_link_push_queue(l_ptr);
1172 tipc_node_unlock(node);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001173 return dsz;
1174}
1175
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001176/*
Per Liden4323add2006-01-18 00:38:21 +01001177 * tipc_link_push_packet: Push one unsent packet to the media
Per Lidenb97bf3f2006-01-02 19:04:38 +01001178 */
stephen hemminger98056962014-01-04 13:47:48 -08001179static u32 tipc_link_push_packet(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001180{
1181 struct sk_buff *buf = l_ptr->first_out;
1182 u32 r_q_size = l_ptr->retransm_queue_size;
1183 u32 r_q_head = l_ptr->retransm_queue_head;
1184
1185 /* Step to position where retransmission failed, if any, */
1186 /* consider that buffers may have been released in meantime */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001187 if (r_q_size && buf) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001188 u32 last = lesser(mod(r_q_head + r_q_size),
Per Lidenb97bf3f2006-01-02 19:04:38 +01001189 link_last_sent(l_ptr));
Allan Stephensf9057302011-10-24 16:03:12 -04001190 u32 first = buf_seqno(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001191
1192 while (buf && less(first, r_q_head)) {
1193 first = mod(first + 1);
1194 buf = buf->next;
1195 }
1196 l_ptr->retransm_queue_head = r_q_head = first;
1197 l_ptr->retransm_queue_size = r_q_size = mod(last - first);
1198 }
1199
1200 /* Continue retransmission now, if there is anything: */
Neil Hormanca509102010-03-15 07:58:45 +00001201 if (r_q_size && buf) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001202 msg_set_ack(buf_msg(buf), mod(l_ptr->next_in_no - 1));
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001203 msg_set_bcast_ack(buf_msg(buf), l_ptr->owner->bclink.last_in);
Ying Xue3c294cb2012-11-15 11:34:45 +08001204 tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr);
1205 l_ptr->retransm_queue_head = mod(++r_q_head);
1206 l_ptr->retransm_queue_size = --r_q_size;
1207 l_ptr->stats.retransmitted++;
1208 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001209 }
1210
1211 /* Send deferred protocol message, if any: */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001212 buf = l_ptr->proto_msg_queue;
1213 if (buf) {
1214 msg_set_ack(buf_msg(buf), mod(l_ptr->next_in_no - 1));
Allan Stephens0e659672010-12-31 18:59:32 +00001215 msg_set_bcast_ack(buf_msg(buf), l_ptr->owner->bclink.last_in);
Ying Xue3c294cb2012-11-15 11:34:45 +08001216 tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr);
1217 l_ptr->unacked_window = 0;
1218 kfree_skb(buf);
1219 l_ptr->proto_msg_queue = NULL;
1220 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001221 }
1222
1223 /* Send one deferred data message, if send window not full: */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001224 buf = l_ptr->next_out;
1225 if (buf) {
1226 struct tipc_msg *msg = buf_msg(buf);
1227 u32 next = msg_seqno(msg);
Allan Stephensf9057302011-10-24 16:03:12 -04001228 u32 first = buf_seqno(l_ptr->first_out);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001229
1230 if (mod(next - first) < l_ptr->queue_limit[0]) {
1231 msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001232 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Ying Xue3c294cb2012-11-15 11:34:45 +08001233 tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr);
1234 if (msg_user(msg) == MSG_BUNDLER)
1235 msg_set_type(msg, CLOSED_MSG);
1236 l_ptr->next_out = buf->next;
1237 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001238 }
1239 }
Ying Xue3c294cb2012-11-15 11:34:45 +08001240 return 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001241}
1242
1243/*
1244 * push_queue(): push out the unsent messages of a link where
1245 * congestion has abated. Node is locked
1246 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001247void tipc_link_push_queue(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001248{
1249 u32 res;
1250
Per Lidenb97bf3f2006-01-02 19:04:38 +01001251 do {
Per Liden4323add2006-01-18 00:38:21 +01001252 res = tipc_link_push_packet(l_ptr);
Allan Stephens0e35fd52008-07-14 22:44:01 -07001253 } while (!res);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001254}
1255
Allan Stephensd356eeb2006-06-25 23:40:01 -07001256static void link_reset_all(unsigned long addr)
1257{
David S. Miller6c000552008-09-02 23:38:32 -07001258 struct tipc_node *n_ptr;
Allan Stephensd356eeb2006-06-25 23:40:01 -07001259 char addr_string[16];
1260 u32 i;
1261
1262 read_lock_bh(&tipc_net_lock);
1263 n_ptr = tipc_node_find((u32)addr);
1264 if (!n_ptr) {
1265 read_unlock_bh(&tipc_net_lock);
1266 return; /* node no longer exists */
1267 }
1268
1269 tipc_node_lock(n_ptr);
1270
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001271 pr_warn("Resetting all links to %s\n",
1272 tipc_addr_string_fill(addr_string, n_ptr->addr));
Allan Stephensd356eeb2006-06-25 23:40:01 -07001273
1274 for (i = 0; i < MAX_BEARERS; i++) {
1275 if (n_ptr->links[i]) {
Allan Stephens8d64a5b2010-12-31 18:59:27 +00001276 link_print(n_ptr->links[i], "Resetting link\n");
Allan Stephensd356eeb2006-06-25 23:40:01 -07001277 tipc_link_reset(n_ptr->links[i]);
1278 }
1279 }
1280
1281 tipc_node_unlock(n_ptr);
1282 read_unlock_bh(&tipc_net_lock);
1283}
1284
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001285static void link_retransmit_failure(struct tipc_link *l_ptr,
Paul Gortmakerae8509c2013-06-17 10:54:47 -04001286 struct sk_buff *buf)
Allan Stephensd356eeb2006-06-25 23:40:01 -07001287{
1288 struct tipc_msg *msg = buf_msg(buf);
1289
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001290 pr_warn("Retransmission failure on link <%s>\n", l_ptr->name);
Allan Stephensd356eeb2006-06-25 23:40:01 -07001291
1292 if (l_ptr->addr) {
Allan Stephensd356eeb2006-06-25 23:40:01 -07001293 /* Handle failure on standard link */
Allan Stephens8d64a5b2010-12-31 18:59:27 +00001294 link_print(l_ptr, "Resetting link\n");
Allan Stephensd356eeb2006-06-25 23:40:01 -07001295 tipc_link_reset(l_ptr);
1296
1297 } else {
Allan Stephensd356eeb2006-06-25 23:40:01 -07001298 /* Handle failure on broadcast link */
David S. Miller6c000552008-09-02 23:38:32 -07001299 struct tipc_node *n_ptr;
Allan Stephensd356eeb2006-06-25 23:40:01 -07001300 char addr_string[16];
1301
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001302 pr_info("Msg seq number: %u, ", msg_seqno(msg));
1303 pr_cont("Outstanding acks: %lu\n",
1304 (unsigned long) TIPC_SKB_CB(buf)->handle);
Jeff Garzik617dbea2006-10-03 16:25:34 -07001305
Allan Stephens01d83ed2011-01-18 13:53:16 -05001306 n_ptr = tipc_bclink_retransmit_to();
Allan Stephensd356eeb2006-06-25 23:40:01 -07001307 tipc_node_lock(n_ptr);
1308
Allan Stephensc68ca7b2010-05-11 14:30:12 +00001309 tipc_addr_string_fill(addr_string, n_ptr->addr);
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001310 pr_info("Broadcast link info for %s\n", addr_string);
Ying Xue389dd9b2012-11-16 13:51:30 +08001311 pr_info("Reception permitted: %d, Acked: %u\n",
1312 n_ptr->bclink.recv_permitted,
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001313 n_ptr->bclink.acked);
1314 pr_info("Last in: %u, Oos state: %u, Last sent: %u\n",
1315 n_ptr->bclink.last_in,
1316 n_ptr->bclink.oos_state,
1317 n_ptr->bclink.last_sent);
Allan Stephensd356eeb2006-06-25 23:40:01 -07001318
1319 tipc_k_signal((Handler)link_reset_all, (unsigned long)n_ptr->addr);
1320
1321 tipc_node_unlock(n_ptr);
1322
1323 l_ptr->stale_count = 0;
1324 }
1325}
1326
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001327void tipc_link_retransmit(struct tipc_link *l_ptr, struct sk_buff *buf,
Per Liden4323add2006-01-18 00:38:21 +01001328 u32 retransmits)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001329{
1330 struct tipc_msg *msg;
1331
Allan Stephensd356eeb2006-06-25 23:40:01 -07001332 if (!buf)
1333 return;
1334
1335 msg = buf_msg(buf);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001336
Erik Hugne512137e2013-12-06 10:08:00 -05001337 /* Detect repeated retransmit failures */
1338 if (l_ptr->last_retransmitted == msg_seqno(msg)) {
1339 if (++l_ptr->stale_count > 100) {
1340 link_retransmit_failure(l_ptr, buf);
1341 return;
Allan Stephensd356eeb2006-06-25 23:40:01 -07001342 }
1343 } else {
Erik Hugne512137e2013-12-06 10:08:00 -05001344 l_ptr->last_retransmitted = msg_seqno(msg);
1345 l_ptr->stale_count = 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001346 }
Allan Stephensd356eeb2006-06-25 23:40:01 -07001347
Neil Hormanca509102010-03-15 07:58:45 +00001348 while (retransmits && (buf != l_ptr->next_out) && buf) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001349 msg = buf_msg(buf);
1350 msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001351 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Ying Xue3c294cb2012-11-15 11:34:45 +08001352 tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr);
1353 buf = buf->next;
1354 retransmits--;
1355 l_ptr->stats.retransmitted++;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001356 }
Allan Stephensd356eeb2006-06-25 23:40:01 -07001357
Per Lidenb97bf3f2006-01-02 19:04:38 +01001358 l_ptr->retransm_queue_head = l_ptr->retransm_queue_size = 0;
1359}
1360
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001361/**
Per Lidenb97bf3f2006-01-02 19:04:38 +01001362 * link_insert_deferred_queue - insert deferred messages back into receive chain
1363 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001364static struct sk_buff *link_insert_deferred_queue(struct tipc_link *l_ptr,
Per Lidenb97bf3f2006-01-02 19:04:38 +01001365 struct sk_buff *buf)
1366{
1367 u32 seq_no;
1368
1369 if (l_ptr->oldest_deferred_in == NULL)
1370 return buf;
1371
Allan Stephensf9057302011-10-24 16:03:12 -04001372 seq_no = buf_seqno(l_ptr->oldest_deferred_in);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001373 if (seq_no == mod(l_ptr->next_in_no)) {
1374 l_ptr->newest_deferred_in->next = buf;
1375 buf = l_ptr->oldest_deferred_in;
1376 l_ptr->oldest_deferred_in = NULL;
1377 l_ptr->deferred_inqueue_sz = 0;
1378 }
1379 return buf;
1380}
1381
Allan Stephens85035562008-04-15 19:04:54 -07001382/**
1383 * link_recv_buf_validate - validate basic format of received message
1384 *
1385 * This routine ensures a TIPC message has an acceptable header, and at least
1386 * as much data as the header indicates it should. The routine also ensures
1387 * that the entire message header is stored in the main fragment of the message
1388 * buffer, to simplify future access to message header fields.
1389 *
1390 * Note: Having extra info present in the message header or data areas is OK.
1391 * TIPC will ignore the excess, under the assumption that it is optional info
1392 * introduced by a later release of the protocol.
1393 */
Allan Stephens85035562008-04-15 19:04:54 -07001394static int link_recv_buf_validate(struct sk_buff *buf)
1395{
1396 static u32 min_data_hdr_size[8] = {
Allan Stephens741d9eb2011-05-31 15:03:18 -04001397 SHORT_H_SIZE, MCAST_H_SIZE, NAMED_H_SIZE, BASIC_H_SIZE,
Allan Stephens85035562008-04-15 19:04:54 -07001398 MAX_H_SIZE, MAX_H_SIZE, MAX_H_SIZE, MAX_H_SIZE
1399 };
1400
1401 struct tipc_msg *msg;
1402 u32 tipc_hdr[2];
1403 u32 size;
1404 u32 hdr_size;
1405 u32 min_hdr_size;
1406
1407 if (unlikely(buf->len < MIN_H_SIZE))
1408 return 0;
1409
1410 msg = skb_header_pointer(buf, 0, sizeof(tipc_hdr), tipc_hdr);
1411 if (msg == NULL)
1412 return 0;
1413
1414 if (unlikely(msg_version(msg) != TIPC_VERSION))
1415 return 0;
1416
1417 size = msg_size(msg);
1418 hdr_size = msg_hdr_sz(msg);
1419 min_hdr_size = msg_isdata(msg) ?
1420 min_data_hdr_size[msg_type(msg)] : INT_H_SIZE;
1421
1422 if (unlikely((hdr_size < min_hdr_size) ||
1423 (size < hdr_size) ||
1424 (buf->len < size) ||
1425 (size - hdr_size > TIPC_MAX_USER_MSG_SIZE)))
1426 return 0;
1427
1428 return pskb_may_pull(buf, hdr_size);
1429}
1430
Allan Stephensb02b69c2010-08-17 11:00:07 +00001431/**
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001432 * tipc_rcv - process TIPC packets/messages arriving from off-node
Allan Stephensb02b69c2010-08-17 11:00:07 +00001433 * @head: pointer to message buffer chain
1434 * @tb_ptr: pointer to bearer message arrived on
1435 *
1436 * Invoked with no locks held. Bearer pointer must point to a valid bearer
1437 * structure (i.e. cannot be NULL), but bearer can be inactive.
1438 */
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001439void tipc_rcv(struct sk_buff *head, struct tipc_bearer *b_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001440{
Per Liden4323add2006-01-18 00:38:21 +01001441 read_lock_bh(&tipc_net_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001442 while (head) {
David S. Miller6c000552008-09-02 23:38:32 -07001443 struct tipc_node *n_ptr;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001444 struct tipc_link *l_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001445 struct sk_buff *crs;
1446 struct sk_buff *buf = head;
Allan Stephens85035562008-04-15 19:04:54 -07001447 struct tipc_msg *msg;
1448 u32 seq_no;
1449 u32 ackd;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001450 u32 released = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001451
Per Lidenb97bf3f2006-01-02 19:04:38 +01001452 head = head->next;
Erik Hugne732256b2014-01-07 15:51:36 -05001453 buf->next = NULL;
Allan Stephens85035562008-04-15 19:04:54 -07001454
Allan Stephensb02b69c2010-08-17 11:00:07 +00001455 /* Ensure bearer is still enabled */
Allan Stephensb02b69c2010-08-17 11:00:07 +00001456 if (unlikely(!b_ptr->active))
Ying Xue3af390e2013-10-30 11:26:57 +08001457 goto discard;
Allan Stephensb02b69c2010-08-17 11:00:07 +00001458
Allan Stephens85035562008-04-15 19:04:54 -07001459 /* Ensure message is well-formed */
Allan Stephens85035562008-04-15 19:04:54 -07001460 if (unlikely(!link_recv_buf_validate(buf)))
Ying Xue3af390e2013-10-30 11:26:57 +08001461 goto discard;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001462
Allan Stephensfe13dda2008-04-15 19:03:23 -07001463 /* Ensure message data is a single contiguous unit */
Allan Stephens5f6d9122011-11-04 13:24:29 -04001464 if (unlikely(skb_linearize(buf)))
Ying Xue3af390e2013-10-30 11:26:57 +08001465 goto discard;
Allan Stephensfe13dda2008-04-15 19:03:23 -07001466
Allan Stephens85035562008-04-15 19:04:54 -07001467 /* Handle arrival of a non-unicast link message */
Allan Stephens85035562008-04-15 19:04:54 -07001468 msg = buf_msg(buf);
1469
Per Lidenb97bf3f2006-01-02 19:04:38 +01001470 if (unlikely(msg_non_seq(msg))) {
Allan Stephens1265a022008-06-04 17:32:35 -07001471 if (msg_user(msg) == LINK_CONFIG)
1472 tipc_disc_recv_msg(buf, b_ptr);
1473 else
1474 tipc_bclink_recv_pkt(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001475 continue;
1476 }
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001477
Allan Stephensed33a9c2011-04-05 15:15:04 -04001478 /* Discard unicast link messages destined for another node */
Allan Stephens26008242006-06-25 23:39:31 -07001479 if (unlikely(!msg_short(msg) &&
1480 (msg_destnode(msg) != tipc_own_addr)))
Ying Xue3af390e2013-10-30 11:26:57 +08001481 goto discard;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001482
Allan Stephens5a68d5e2010-08-17 11:00:16 +00001483 /* Locate neighboring node that sent message */
Per Liden4323add2006-01-18 00:38:21 +01001484 n_ptr = tipc_node_find(msg_prevnode(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001485 if (unlikely(!n_ptr))
Ying Xue3af390e2013-10-30 11:26:57 +08001486 goto discard;
Per Liden4323add2006-01-18 00:38:21 +01001487 tipc_node_lock(n_ptr);
Allan Stephens85035562008-04-15 19:04:54 -07001488
Allan Stephens5a68d5e2010-08-17 11:00:16 +00001489 /* Locate unicast link endpoint that should handle message */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001490 l_ptr = n_ptr->links[b_ptr->identity];
Ying Xue3af390e2013-10-30 11:26:57 +08001491 if (unlikely(!l_ptr))
1492 goto unlock_discard;
Allan Stephens85035562008-04-15 19:04:54 -07001493
Allan Stephensb4b56102011-05-27 11:00:51 -04001494 /* Verify that communication with node is currently allowed */
Allan Stephensb4b56102011-05-27 11:00:51 -04001495 if ((n_ptr->block_setup & WAIT_PEER_DOWN) &&
1496 msg_user(msg) == LINK_PROTOCOL &&
1497 (msg_type(msg) == RESET_MSG ||
Jon Paul Maloya5377832014-02-13 17:29:15 -05001498 msg_type(msg) == ACTIVATE_MSG) &&
Allan Stephensb4b56102011-05-27 11:00:51 -04001499 !msg_redundant_link(msg))
1500 n_ptr->block_setup &= ~WAIT_PEER_DOWN;
1501
Ying Xue3af390e2013-10-30 11:26:57 +08001502 if (n_ptr->block_setup)
1503 goto unlock_discard;
Allan Stephensb4b56102011-05-27 11:00:51 -04001504
Allan Stephens85035562008-04-15 19:04:54 -07001505 /* Validate message sequence number info */
Allan Stephens85035562008-04-15 19:04:54 -07001506 seq_no = msg_seqno(msg);
1507 ackd = msg_ack(msg);
1508
1509 /* Release acked messages */
Ying Xue389dd9b2012-11-16 13:51:30 +08001510 if (n_ptr->bclink.recv_permitted)
Allan Stephens365595912011-10-24 15:26:24 -04001511 tipc_bclink_acknowledge(n_ptr, msg_bcast_ack(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001512
1513 crs = l_ptr->first_out;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001514 while ((crs != l_ptr->next_out) &&
Allan Stephensf9057302011-10-24 16:03:12 -04001515 less_eq(buf_seqno(crs), ackd)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001516 struct sk_buff *next = crs->next;
Allan Stephens5f6d9122011-11-04 13:24:29 -04001517 kfree_skb(crs);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001518 crs = next;
1519 released++;
1520 }
1521 if (released) {
1522 l_ptr->first_out = crs;
1523 l_ptr->out_queue_size -= released;
1524 }
Allan Stephens85035562008-04-15 19:04:54 -07001525
1526 /* Try sending any messages link endpoint has pending */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001527 if (unlikely(l_ptr->next_out))
Per Liden4323add2006-01-18 00:38:21 +01001528 tipc_link_push_queue(l_ptr);
Jon Paul Maloya5377832014-02-13 17:29:15 -05001529
Per Lidenb97bf3f2006-01-02 19:04:38 +01001530 if (unlikely(!list_empty(&l_ptr->waiting_ports)))
Per Liden4323add2006-01-18 00:38:21 +01001531 tipc_link_wakeup_ports(l_ptr, 0);
Jon Paul Maloya5377832014-02-13 17:29:15 -05001532
Per Lidenb97bf3f2006-01-02 19:04:38 +01001533 if (unlikely(++l_ptr->unacked_window >= TIPC_MIN_LINK_WIN)) {
1534 l_ptr->stats.sent_acks++;
Jon Paul Maloya5377832014-02-13 17:29:15 -05001535 tipc_link_send_proto_msg(l_ptr, STATE_MSG,
1536 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001537 }
1538
Jon Paul Maloya5377832014-02-13 17:29:15 -05001539 /* Process the incoming packet */
Ying Xue3af390e2013-10-30 11:26:57 +08001540 if (unlikely(!link_working_working(l_ptr))) {
1541 if (msg_user(msg) == LINK_PROTOCOL) {
1542 link_recv_proto_msg(l_ptr, buf);
1543 head = link_insert_deferred_queue(l_ptr, head);
Per Liden4323add2006-01-18 00:38:21 +01001544 tipc_node_unlock(n_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001545 continue;
1546 }
Ying Xue3af390e2013-10-30 11:26:57 +08001547
1548 /* Traffic message. Conditionally activate link */
1549 link_state_event(l_ptr, TRAFFIC_MSG_EVT);
1550
1551 if (link_working_working(l_ptr)) {
1552 /* Re-insert buffer in front of queue */
1553 buf->next = head;
1554 head = buf;
1555 tipc_node_unlock(n_ptr);
1556 continue;
1557 }
1558 goto unlock_discard;
1559 }
1560
1561 /* Link is now in state WORKING_WORKING */
1562 if (unlikely(seq_no != mod(l_ptr->next_in_no))) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001563 link_handle_out_of_seq_msg(l_ptr, buf);
1564 head = link_insert_deferred_queue(l_ptr, head);
Per Liden4323add2006-01-18 00:38:21 +01001565 tipc_node_unlock(n_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001566 continue;
1567 }
Ying Xue3af390e2013-10-30 11:26:57 +08001568 l_ptr->next_in_no++;
1569 if (unlikely(l_ptr->oldest_deferred_in))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001570 head = link_insert_deferred_queue(l_ptr, head);
Jon Paul Maloya5377832014-02-13 17:29:15 -05001571
1572 /* Deliver packet/message to correct user: */
1573 if (unlikely(msg_user(msg) == CHANGEOVER_PROTOCOL)) {
1574 if (!tipc_link_tunnel_rcv(n_ptr, &buf)) {
1575 tipc_node_unlock(n_ptr);
1576 continue;
1577 }
1578 msg = buf_msg(buf);
1579 } else if (msg_user(msg) == MSG_FRAGMENTER) {
1580 int rc;
1581
1582 l_ptr->stats.recv_fragments++;
1583 rc = tipc_link_frag_rcv(&l_ptr->reasm_head,
1584 &l_ptr->reasm_tail,
1585 &buf);
1586 if (rc == LINK_REASM_COMPLETE) {
1587 l_ptr->stats.recv_fragmented++;
1588 msg = buf_msg(buf);
1589 } else {
1590 if (rc == LINK_REASM_ERROR)
1591 tipc_link_reset(l_ptr);
1592 tipc_node_unlock(n_ptr);
1593 continue;
1594 }
1595 }
1596
1597 switch (msg_user(msg)) {
1598 case TIPC_LOW_IMPORTANCE:
1599 case TIPC_MEDIUM_IMPORTANCE:
1600 case TIPC_HIGH_IMPORTANCE:
1601 case TIPC_CRITICAL_IMPORTANCE:
Per Liden4323add2006-01-18 00:38:21 +01001602 tipc_node_unlock(n_ptr);
Ying Xue3af390e2013-10-30 11:26:57 +08001603 tipc_port_recv_msg(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001604 continue;
Ying Xue3af390e2013-10-30 11:26:57 +08001605 case MSG_BUNDLER:
1606 l_ptr->stats.recv_bundles++;
1607 l_ptr->stats.recv_bundled += msg_msgcnt(msg);
1608 tipc_node_unlock(n_ptr);
1609 tipc_link_recv_bundle(buf);
1610 continue;
1611 case NAME_DISTRIBUTOR:
1612 n_ptr->bclink.recv_permitted = true;
1613 tipc_node_unlock(n_ptr);
1614 tipc_named_recv(buf);
1615 continue;
Ying Xue3af390e2013-10-30 11:26:57 +08001616 case CONN_MANAGER:
1617 tipc_node_unlock(n_ptr);
1618 tipc_port_recv_proto_msg(buf);
1619 continue;
Jon Paul Maloya5377832014-02-13 17:29:15 -05001620 case BCAST_PROTOCOL:
1621 tipc_link_recv_sync(n_ptr, buf);
1622 break;
Ying Xue3af390e2013-10-30 11:26:57 +08001623 default:
1624 kfree_skb(buf);
Ying Xue3af390e2013-10-30 11:26:57 +08001625 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001626 }
Per Liden4323add2006-01-18 00:38:21 +01001627 tipc_node_unlock(n_ptr);
Ying Xue3af390e2013-10-30 11:26:57 +08001628 continue;
1629unlock_discard:
Ying Xue3af390e2013-10-30 11:26:57 +08001630 tipc_node_unlock(n_ptr);
1631discard:
Allan Stephens5f6d9122011-11-04 13:24:29 -04001632 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001633 }
Per Liden4323add2006-01-18 00:38:21 +01001634 read_unlock_bh(&tipc_net_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001635}
1636
Ben Hutchings2c530402012-07-10 10:55:09 +00001637/**
Allan Stephens8809b252011-10-25 10:44:35 -04001638 * tipc_link_defer_pkt - Add out-of-sequence message to deferred reception queue
1639 *
1640 * Returns increase in queue length (i.e. 0 or 1)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001641 */
Allan Stephens8809b252011-10-25 10:44:35 -04001642u32 tipc_link_defer_pkt(struct sk_buff **head, struct sk_buff **tail,
Per Liden4323add2006-01-18 00:38:21 +01001643 struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001644{
Allan Stephens8809b252011-10-25 10:44:35 -04001645 struct sk_buff *queue_buf;
1646 struct sk_buff **prev;
Allan Stephensf9057302011-10-24 16:03:12 -04001647 u32 seq_no = buf_seqno(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001648
1649 buf->next = NULL;
1650
1651 /* Empty queue ? */
1652 if (*head == NULL) {
1653 *head = *tail = buf;
1654 return 1;
1655 }
1656
1657 /* Last ? */
Allan Stephensf9057302011-10-24 16:03:12 -04001658 if (less(buf_seqno(*tail), seq_no)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001659 (*tail)->next = buf;
1660 *tail = buf;
1661 return 1;
1662 }
1663
Allan Stephens8809b252011-10-25 10:44:35 -04001664 /* Locate insertion point in queue, then insert; discard if duplicate */
1665 prev = head;
1666 queue_buf = *head;
1667 for (;;) {
1668 u32 curr_seqno = buf_seqno(queue_buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001669
Allan Stephens8809b252011-10-25 10:44:35 -04001670 if (seq_no == curr_seqno) {
Allan Stephens5f6d9122011-11-04 13:24:29 -04001671 kfree_skb(buf);
Allan Stephens8809b252011-10-25 10:44:35 -04001672 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001673 }
Allan Stephens8809b252011-10-25 10:44:35 -04001674
1675 if (less(seq_no, curr_seqno))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001676 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001677
Allan Stephens8809b252011-10-25 10:44:35 -04001678 prev = &queue_buf->next;
1679 queue_buf = queue_buf->next;
1680 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001681
Allan Stephens8809b252011-10-25 10:44:35 -04001682 buf->next = queue_buf;
1683 *prev = buf;
1684 return 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001685}
1686
Allan Stephens8809b252011-10-25 10:44:35 -04001687/*
Per Lidenb97bf3f2006-01-02 19:04:38 +01001688 * link_handle_out_of_seq_msg - handle arrival of out-of-sequence packet
1689 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001690static void link_handle_out_of_seq_msg(struct tipc_link *l_ptr,
Per Lidenb97bf3f2006-01-02 19:04:38 +01001691 struct sk_buff *buf)
1692{
Allan Stephensf9057302011-10-24 16:03:12 -04001693 u32 seq_no = buf_seqno(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001694
1695 if (likely(msg_user(buf_msg(buf)) == LINK_PROTOCOL)) {
1696 link_recv_proto_msg(l_ptr, buf);
1697 return;
1698 }
1699
Per Lidenb97bf3f2006-01-02 19:04:38 +01001700 /* Record OOS packet arrival (force mismatch on next timeout) */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001701 l_ptr->checkpoint--;
1702
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001703 /*
Per Lidenb97bf3f2006-01-02 19:04:38 +01001704 * Discard packet if a duplicate; otherwise add it to deferred queue
1705 * and notify peer of gap as per protocol specification
1706 */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001707 if (less(seq_no, mod(l_ptr->next_in_no))) {
1708 l_ptr->stats.duplicates++;
Allan Stephens5f6d9122011-11-04 13:24:29 -04001709 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001710 return;
1711 }
1712
Per Liden4323add2006-01-18 00:38:21 +01001713 if (tipc_link_defer_pkt(&l_ptr->oldest_deferred_in,
1714 &l_ptr->newest_deferred_in, buf)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001715 l_ptr->deferred_inqueue_sz++;
1716 l_ptr->stats.deferred_recv++;
1717 if ((l_ptr->deferred_inqueue_sz % 16) == 1)
Per Liden4323add2006-01-18 00:38:21 +01001718 tipc_link_send_proto_msg(l_ptr, STATE_MSG, 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001719 } else
1720 l_ptr->stats.duplicates++;
1721}
1722
1723/*
1724 * Send protocol message to the other endpoint.
1725 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001726void tipc_link_send_proto_msg(struct tipc_link *l_ptr, u32 msg_typ,
Paul Gortmakerae8509c2013-06-17 10:54:47 -04001727 int probe_msg, u32 gap, u32 tolerance,
1728 u32 priority, u32 ack_mtu)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001729{
Sam Ravnborg1fc54d82006-03-20 22:36:47 -08001730 struct sk_buff *buf = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001731 struct tipc_msg *msg = l_ptr->pmsg;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001732 u32 msg_size = sizeof(l_ptr->proto_msg);
Allan Stephens75f0aa42011-02-28 15:30:20 -05001733 int r_flag;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001734
Allan Stephens92d2c902011-10-25 11:20:26 -04001735 /* Discard any previous message that was deferred due to congestion */
Allan Stephens92d2c902011-10-25 11:20:26 -04001736 if (l_ptr->proto_msg_queue) {
Allan Stephens5f6d9122011-11-04 13:24:29 -04001737 kfree_skb(l_ptr->proto_msg_queue);
Allan Stephens92d2c902011-10-25 11:20:26 -04001738 l_ptr->proto_msg_queue = NULL;
1739 }
1740
Ying Xue77a7e072013-12-10 20:45:44 -08001741 /* Don't send protocol message during link changeover */
1742 if (l_ptr->exp_msg_count)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001743 return;
Allan Stephensb4b56102011-05-27 11:00:51 -04001744
1745 /* Abort non-RESET send if communication with node is prohibited */
Allan Stephensb4b56102011-05-27 11:00:51 -04001746 if ((l_ptr->owner->block_setup) && (msg_typ != RESET_MSG))
1747 return;
1748
Allan Stephens92d2c902011-10-25 11:20:26 -04001749 /* Create protocol message with "out-of-sequence" sequence number */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001750 msg_set_type(msg, msg_typ);
1751 msg_set_net_plane(msg, l_ptr->b_ptr->net_plane);
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001752 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Per Liden4323add2006-01-18 00:38:21 +01001753 msg_set_last_bcast(msg, tipc_bclink_get_last_sent());
Per Lidenb97bf3f2006-01-02 19:04:38 +01001754
1755 if (msg_typ == STATE_MSG) {
1756 u32 next_sent = mod(l_ptr->next_out_no);
1757
Per Liden4323add2006-01-18 00:38:21 +01001758 if (!tipc_link_is_up(l_ptr))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001759 return;
1760 if (l_ptr->next_out)
Allan Stephensf9057302011-10-24 16:03:12 -04001761 next_sent = buf_seqno(l_ptr->next_out);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001762 msg_set_next_sent(msg, next_sent);
1763 if (l_ptr->oldest_deferred_in) {
Allan Stephensf9057302011-10-24 16:03:12 -04001764 u32 rec = buf_seqno(l_ptr->oldest_deferred_in);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001765 gap = mod(rec - mod(l_ptr->next_in_no));
1766 }
1767 msg_set_seq_gap(msg, gap);
1768 if (gap)
1769 l_ptr->stats.sent_nacks++;
1770 msg_set_link_tolerance(msg, tolerance);
1771 msg_set_linkprio(msg, priority);
1772 msg_set_max_pkt(msg, ack_mtu);
1773 msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
1774 msg_set_probe(msg, probe_msg != 0);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001775 if (probe_msg) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001776 u32 mtu = l_ptr->max_pkt;
1777
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001778 if ((mtu < l_ptr->max_pkt_target) &&
Per Lidenb97bf3f2006-01-02 19:04:38 +01001779 link_working_working(l_ptr) &&
1780 l_ptr->fsm_msg_cnt) {
1781 msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001782 if (l_ptr->max_pkt_probes == 10) {
1783 l_ptr->max_pkt_target = (msg_size - 4);
1784 l_ptr->max_pkt_probes = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001785 msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001786 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001787 l_ptr->max_pkt_probes++;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001788 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001789
1790 l_ptr->stats.sent_probes++;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001791 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001792 l_ptr->stats.sent_states++;
1793 } else { /* RESET_MSG or ACTIVATE_MSG */
1794 msg_set_ack(msg, mod(l_ptr->reset_checkpoint - 1));
1795 msg_set_seq_gap(msg, 0);
1796 msg_set_next_sent(msg, 1);
Allan Stephensf23d9bf2011-01-18 15:15:34 -05001797 msg_set_probe(msg, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001798 msg_set_link_tolerance(msg, l_ptr->tolerance);
1799 msg_set_linkprio(msg, l_ptr->priority);
1800 msg_set_max_pkt(msg, l_ptr->max_pkt_target);
1801 }
1802
Allan Stephens75f0aa42011-02-28 15:30:20 -05001803 r_flag = (l_ptr->owner->working_links > tipc_link_is_up(l_ptr));
1804 msg_set_redundant_link(msg, r_flag);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001805 msg_set_linkprio(msg, l_ptr->priority);
Allan Stephens92d2c902011-10-25 11:20:26 -04001806 msg_set_size(msg, msg_size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001807
1808 msg_set_seqno(msg, mod(l_ptr->next_out_no + (0xffff/2)));
1809
stephen hemminger31e3c3f2010-10-13 13:20:35 +00001810 buf = tipc_buf_acquire(msg_size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001811 if (!buf)
1812 return;
1813
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03001814 skb_copy_to_linear_data(buf, msg, sizeof(l_ptr->proto_msg));
Ying Xue796c75d2013-06-17 10:54:48 -04001815 buf->priority = TC_PRIO_CONTROL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001816
Ying Xue3c294cb2012-11-15 11:34:45 +08001817 tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr);
Allan Stephens92d2c902011-10-25 11:20:26 -04001818 l_ptr->unacked_window = 0;
Allan Stephens5f6d9122011-11-04 13:24:29 -04001819 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001820}
1821
1822/*
1823 * Receive protocol message :
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001824 * Note that network plane id propagates through the network, and may
1825 * change at any time. The node with lowest address rules
Per Lidenb97bf3f2006-01-02 19:04:38 +01001826 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001827static void link_recv_proto_msg(struct tipc_link *l_ptr, struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001828{
1829 u32 rec_gap = 0;
1830 u32 max_pkt_info;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001831 u32 max_pkt_ack;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001832 u32 msg_tol;
1833 struct tipc_msg *msg = buf_msg(buf);
1834
Ying Xue77a7e072013-12-10 20:45:44 -08001835 /* Discard protocol message during link changeover */
1836 if (l_ptr->exp_msg_count)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001837 goto exit;
1838
1839 /* record unnumbered packet arrival (force mismatch on next timeout) */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001840 l_ptr->checkpoint--;
1841
1842 if (l_ptr->b_ptr->net_plane != msg_net_plane(msg))
1843 if (tipc_own_addr > msg_prevnode(msg))
1844 l_ptr->b_ptr->net_plane = msg_net_plane(msg);
1845
Per Lidenb97bf3f2006-01-02 19:04:38 +01001846 switch (msg_type(msg)) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001847
Per Lidenb97bf3f2006-01-02 19:04:38 +01001848 case RESET_MSG:
Allan Stephensa686e682008-06-04 17:29:39 -07001849 if (!link_working_unknown(l_ptr) &&
1850 (l_ptr->peer_session != INVALID_SESSION)) {
Allan Stephens641c2182011-04-07 09:54:43 -04001851 if (less_eq(msg_session(msg), l_ptr->peer_session))
1852 break; /* duplicate or old reset: ignore */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001853 }
Allan Stephensb4b56102011-05-27 11:00:51 -04001854
1855 if (!msg_redundant_link(msg) && (link_working_working(l_ptr) ||
1856 link_working_unknown(l_ptr))) {
1857 /*
1858 * peer has lost contact -- don't allow peer's links
1859 * to reactivate before we recognize loss & clean up
1860 */
1861 l_ptr->owner->block_setup = WAIT_NODE_DOWN;
1862 }
1863
Allan Stephens47361c82011-10-26 10:55:16 -04001864 link_state_event(l_ptr, RESET_MSG);
1865
Per Lidenb97bf3f2006-01-02 19:04:38 +01001866 /* fall thru' */
1867 case ACTIVATE_MSG:
1868 /* Update link settings according other endpoint's values */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001869 strcpy((strrchr(l_ptr->name, ':') + 1), (char *)msg_data(msg));
1870
Allan Stephens2db99832010-12-31 18:59:33 +00001871 msg_tol = msg_link_tolerance(msg);
1872 if (msg_tol > l_ptr->tolerance)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001873 link_set_supervision_props(l_ptr, msg_tol);
1874
1875 if (msg_linkprio(msg) > l_ptr->priority)
1876 l_ptr->priority = msg_linkprio(msg);
1877
1878 max_pkt_info = msg_max_pkt(msg);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001879 if (max_pkt_info) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001880 if (max_pkt_info < l_ptr->max_pkt_target)
1881 l_ptr->max_pkt_target = max_pkt_info;
1882 if (l_ptr->max_pkt > l_ptr->max_pkt_target)
1883 l_ptr->max_pkt = l_ptr->max_pkt_target;
1884 } else {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001885 l_ptr->max_pkt = l_ptr->max_pkt_target;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001886 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001887
Allan Stephens4d753132011-10-25 12:19:05 -04001888 /* Synchronize broadcast link info, if not done previously */
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001889 if (!tipc_node_is_up(l_ptr->owner)) {
1890 l_ptr->owner->bclink.last_sent =
1891 l_ptr->owner->bclink.last_in =
1892 msg_last_bcast(msg);
1893 l_ptr->owner->bclink.oos_state = 0;
1894 }
Allan Stephens4d753132011-10-25 12:19:05 -04001895
Per Lidenb97bf3f2006-01-02 19:04:38 +01001896 l_ptr->peer_session = msg_session(msg);
1897 l_ptr->peer_bearer_id = msg_bearer_id(msg);
Allan Stephens47361c82011-10-26 10:55:16 -04001898
1899 if (msg_type(msg) == ACTIVATE_MSG)
1900 link_state_event(l_ptr, ACTIVATE_MSG);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001901 break;
1902 case STATE_MSG:
1903
Allan Stephens2db99832010-12-31 18:59:33 +00001904 msg_tol = msg_link_tolerance(msg);
1905 if (msg_tol)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001906 link_set_supervision_props(l_ptr, msg_tol);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001907
1908 if (msg_linkprio(msg) &&
Per Lidenb97bf3f2006-01-02 19:04:38 +01001909 (msg_linkprio(msg) != l_ptr->priority)) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001910 pr_warn("%s<%s>, priority change %u->%u\n",
1911 link_rst_msg, l_ptr->name, l_ptr->priority,
1912 msg_linkprio(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001913 l_ptr->priority = msg_linkprio(msg);
Per Liden4323add2006-01-18 00:38:21 +01001914 tipc_link_reset(l_ptr); /* Enforce change to take effect */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001915 break;
1916 }
1917 link_state_event(l_ptr, TRAFFIC_MSG_EVT);
1918 l_ptr->stats.recv_states++;
1919 if (link_reset_unknown(l_ptr))
1920 break;
1921
1922 if (less_eq(mod(l_ptr->next_in_no), msg_next_sent(msg))) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001923 rec_gap = mod(msg_next_sent(msg) -
Per Lidenb97bf3f2006-01-02 19:04:38 +01001924 mod(l_ptr->next_in_no));
1925 }
1926
1927 max_pkt_ack = msg_max_pkt(msg);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001928 if (max_pkt_ack > l_ptr->max_pkt) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001929 l_ptr->max_pkt = max_pkt_ack;
1930 l_ptr->max_pkt_probes = 0;
1931 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001932
1933 max_pkt_ack = 0;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001934 if (msg_probe(msg)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001935 l_ptr->stats.recv_probes++;
Allan Stephensa0168922010-12-31 18:59:35 +00001936 if (msg_size(msg) > sizeof(l_ptr->proto_msg))
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001937 max_pkt_ack = msg_size(msg);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001938 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001939
1940 /* Protocol message before retransmits, reduce loss risk */
Ying Xue389dd9b2012-11-16 13:51:30 +08001941 if (l_ptr->owner->bclink.recv_permitted)
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001942 tipc_bclink_update_link_state(l_ptr->owner,
1943 msg_last_bcast(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001944
1945 if (rec_gap || (msg_probe(msg))) {
Per Liden4323add2006-01-18 00:38:21 +01001946 tipc_link_send_proto_msg(l_ptr, STATE_MSG,
1947 0, rec_gap, 0, 0, max_pkt_ack);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001948 }
1949 if (msg_seq_gap(msg)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001950 l_ptr->stats.recv_nacks++;
Per Liden4323add2006-01-18 00:38:21 +01001951 tipc_link_retransmit(l_ptr, l_ptr->first_out,
1952 msg_seq_gap(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001953 }
1954 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001955 }
1956exit:
Allan Stephens5f6d9122011-11-04 13:24:29 -04001957 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001958}
1959
1960
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001961/* tipc_link_tunnel_xmit(): Tunnel one packet via a link belonging to
1962 * a different bearer. Owner node is locked.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001963 */
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001964static void tipc_link_tunnel_xmit(struct tipc_link *l_ptr,
1965 struct tipc_msg *tunnel_hdr,
1966 struct tipc_msg *msg,
1967 u32 selector)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001968{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001969 struct tipc_link *tunnel;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001970 struct sk_buff *buf;
1971 u32 length = msg_size(msg);
1972
1973 tunnel = l_ptr->owner->active_links[selector & 1];
Allan Stephens5392d642006-06-25 23:52:50 -07001974 if (!tipc_link_is_up(tunnel)) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001975 pr_warn("%stunnel link no longer available\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001976 return;
Allan Stephens5392d642006-06-25 23:52:50 -07001977 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001978 msg_set_size(tunnel_hdr, length + INT_H_SIZE);
stephen hemminger31e3c3f2010-10-13 13:20:35 +00001979 buf = tipc_buf_acquire(length + INT_H_SIZE);
Allan Stephens5392d642006-06-25 23:52:50 -07001980 if (!buf) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001981 pr_warn("%sunable to send tunnel msg\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001982 return;
Allan Stephens5392d642006-06-25 23:52:50 -07001983 }
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03001984 skb_copy_to_linear_data(buf, tunnel_hdr, INT_H_SIZE);
1985 skb_copy_to_linear_data_offset(buf, INT_H_SIZE, msg, length);
Per Liden4323add2006-01-18 00:38:21 +01001986 tipc_link_send_buf(tunnel, buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001987}
1988
1989
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001990/* tipc_link_failover_send_queue(): A link has gone down, but a second
1991 * link is still active. We can do failover. Tunnel the failing link's
1992 * whole send queue via the remaining link. This way, we don't lose
1993 * any packets, and sequence order is preserved for subsequent traffic
1994 * sent over the remaining link. Owner node is locked.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001995 */
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001996void tipc_link_failover_send_queue(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001997{
1998 u32 msgcount = l_ptr->out_queue_size;
1999 struct sk_buff *crs = l_ptr->first_out;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002000 struct tipc_link *tunnel = l_ptr->owner->active_links[0];
Per Lidenb97bf3f2006-01-02 19:04:38 +01002001 struct tipc_msg tunnel_hdr;
Allan Stephens5392d642006-06-25 23:52:50 -07002002 int split_bundles;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002003
2004 if (!tunnel)
2005 return;
2006
Allan Stephensc68ca7b2010-05-11 14:30:12 +00002007 tipc_msg_init(&tunnel_hdr, CHANGEOVER_PROTOCOL,
Allan Stephens75715212008-06-04 17:37:34 -07002008 ORIGINAL_MSG, INT_H_SIZE, l_ptr->addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002009 msg_set_bearer_id(&tunnel_hdr, l_ptr->peer_bearer_id);
2010 msg_set_msgcnt(&tunnel_hdr, msgcount);
Allan Stephensf1310722006-06-25 23:51:37 -07002011
Per Lidenb97bf3f2006-01-02 19:04:38 +01002012 if (!l_ptr->first_out) {
2013 struct sk_buff *buf;
2014
stephen hemminger31e3c3f2010-10-13 13:20:35 +00002015 buf = tipc_buf_acquire(INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002016 if (buf) {
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03002017 skb_copy_to_linear_data(buf, &tunnel_hdr, INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002018 msg_set_size(&tunnel_hdr, INT_H_SIZE);
Per Liden4323add2006-01-18 00:38:21 +01002019 tipc_link_send_buf(tunnel, buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002020 } else {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04002021 pr_warn("%sunable to send changeover msg\n",
2022 link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002023 }
2024 return;
2025 }
Allan Stephensf1310722006-06-25 23:51:37 -07002026
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002027 split_bundles = (l_ptr->owner->active_links[0] !=
Allan Stephens5392d642006-06-25 23:52:50 -07002028 l_ptr->owner->active_links[1]);
2029
Per Lidenb97bf3f2006-01-02 19:04:38 +01002030 while (crs) {
2031 struct tipc_msg *msg = buf_msg(crs);
2032
2033 if ((msg_user(msg) == MSG_BUNDLER) && split_bundles) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01002034 struct tipc_msg *m = msg_get_wrapped(msg);
Allan Stephens0e659672010-12-31 18:59:32 +00002035 unchar *pos = (unchar *)m;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002036
Florian Westphald788d802007-08-02 19:28:06 -07002037 msgcount = msg_msgcnt(msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002038 while (msgcount--) {
Allan Stephens0e659672010-12-31 18:59:32 +00002039 msg_set_seqno(m, msg_seqno(msg));
Jon Paul Maloy170b3922014-01-07 17:02:41 -05002040 tipc_link_tunnel_xmit(l_ptr, &tunnel_hdr, m,
2041 msg_link_selector(m));
Per Lidenb97bf3f2006-01-02 19:04:38 +01002042 pos += align(msg_size(m));
2043 m = (struct tipc_msg *)pos;
2044 }
2045 } else {
Jon Paul Maloy170b3922014-01-07 17:02:41 -05002046 tipc_link_tunnel_xmit(l_ptr, &tunnel_hdr, msg,
2047 msg_link_selector(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01002048 }
2049 crs = crs->next;
2050 }
2051}
2052
Jon Paul Maloy170b3922014-01-07 17:02:41 -05002053/* tipc_link_dup_send_queue(): A second link has become active. Tunnel a
2054 * duplicate of the first link's send queue via the new link. This way, we
2055 * are guaranteed that currently queued packets from a socket are delivered
2056 * before future traffic from the same socket, even if this is using the
2057 * new link. The last arriving copy of each duplicate packet is dropped at
2058 * the receiving end by the regular protocol check, so packet cardinality
2059 * and sequence order is preserved per sender/receiver socket pair.
2060 * Owner node is locked.
2061 */
2062void tipc_link_dup_send_queue(struct tipc_link *l_ptr,
2063 struct tipc_link *tunnel)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002064{
2065 struct sk_buff *iter;
2066 struct tipc_msg tunnel_hdr;
2067
Allan Stephensc68ca7b2010-05-11 14:30:12 +00002068 tipc_msg_init(&tunnel_hdr, CHANGEOVER_PROTOCOL,
Allan Stephens75715212008-06-04 17:37:34 -07002069 DUPLICATE_MSG, INT_H_SIZE, l_ptr->addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002070 msg_set_msgcnt(&tunnel_hdr, l_ptr->out_queue_size);
2071 msg_set_bearer_id(&tunnel_hdr, l_ptr->peer_bearer_id);
2072 iter = l_ptr->first_out;
2073 while (iter) {
2074 struct sk_buff *outbuf;
2075 struct tipc_msg *msg = buf_msg(iter);
2076 u32 length = msg_size(msg);
2077
2078 if (msg_user(msg) == MSG_BUNDLER)
2079 msg_set_type(msg, CLOSED_MSG);
2080 msg_set_ack(msg, mod(l_ptr->next_in_no - 1)); /* Update */
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002081 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002082 msg_set_size(&tunnel_hdr, length + INT_H_SIZE);
stephen hemminger31e3c3f2010-10-13 13:20:35 +00002083 outbuf = tipc_buf_acquire(length + INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002084 if (outbuf == NULL) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04002085 pr_warn("%sunable to send duplicate msg\n",
2086 link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002087 return;
2088 }
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03002089 skb_copy_to_linear_data(outbuf, &tunnel_hdr, INT_H_SIZE);
2090 skb_copy_to_linear_data_offset(outbuf, INT_H_SIZE, iter->data,
2091 length);
Per Liden4323add2006-01-18 00:38:21 +01002092 tipc_link_send_buf(tunnel, outbuf);
2093 if (!tipc_link_is_up(l_ptr))
Per Lidenb97bf3f2006-01-02 19:04:38 +01002094 return;
2095 iter = iter->next;
2096 }
2097}
2098
Per Lidenb97bf3f2006-01-02 19:04:38 +01002099/**
2100 * buf_extract - extracts embedded TIPC message from another message
2101 * @skb: encapsulating message buffer
2102 * @from_pos: offset to extract from
2103 *
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002104 * Returns a new message buffer containing an embedded message. The
Per Lidenb97bf3f2006-01-02 19:04:38 +01002105 * encapsulating message itself is left unchanged.
2106 */
Per Lidenb97bf3f2006-01-02 19:04:38 +01002107static struct sk_buff *buf_extract(struct sk_buff *skb, u32 from_pos)
2108{
2109 struct tipc_msg *msg = (struct tipc_msg *)(skb->data + from_pos);
2110 u32 size = msg_size(msg);
2111 struct sk_buff *eb;
2112
stephen hemminger31e3c3f2010-10-13 13:20:35 +00002113 eb = tipc_buf_acquire(size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002114 if (eb)
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03002115 skb_copy_to_linear_data(eb, msg, size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002116 return eb;
2117}
2118
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05002119
2120
2121/* tipc_link_dup_rcv(): Receive a tunnelled DUPLICATE_MSG packet.
2122 * Owner node is locked.
2123 */
2124static void tipc_link_dup_rcv(struct tipc_link *l_ptr,
2125 struct sk_buff *t_buf)
2126{
2127 struct sk_buff *buf;
2128
2129 if (!tipc_link_is_up(l_ptr))
2130 return;
2131
2132 buf = buf_extract(t_buf, INT_H_SIZE);
2133 if (buf == NULL) {
2134 pr_warn("%sfailed to extract inner dup pkt\n", link_co_err);
2135 return;
2136 }
2137
2138 /* Add buffer to deferred queue, if applicable: */
2139 link_handle_out_of_seq_msg(l_ptr, buf);
2140}
2141
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05002142/* tipc_link_failover_rcv(): Receive a tunnelled ORIGINAL_MSG packet
2143 * Owner node is locked.
2144 */
2145static struct sk_buff *tipc_link_failover_rcv(struct tipc_link *l_ptr,
2146 struct sk_buff *t_buf)
2147{
2148 struct tipc_msg *t_msg = buf_msg(t_buf);
2149 struct sk_buff *buf = NULL;
2150 struct tipc_msg *msg;
2151
2152 if (tipc_link_is_up(l_ptr))
2153 tipc_link_reset(l_ptr);
2154
2155 /* First failover packet? */
2156 if (l_ptr->exp_msg_count == START_CHANGEOVER)
2157 l_ptr->exp_msg_count = msg_msgcnt(t_msg);
2158
2159 /* Should there be an inner packet? */
2160 if (l_ptr->exp_msg_count) {
2161 l_ptr->exp_msg_count--;
2162 buf = buf_extract(t_buf, INT_H_SIZE);
2163 if (buf == NULL) {
2164 pr_warn("%sno inner failover pkt\n", link_co_err);
2165 goto exit;
2166 }
2167 msg = buf_msg(buf);
2168
2169 if (less(msg_seqno(msg), l_ptr->reset_checkpoint)) {
2170 kfree_skb(buf);
2171 buf = NULL;
2172 goto exit;
2173 }
2174 if (msg_user(msg) == MSG_FRAGMENTER) {
2175 l_ptr->stats.recv_fragments++;
2176 tipc_link_frag_rcv(&l_ptr->reasm_head,
2177 &l_ptr->reasm_tail,
2178 &buf);
2179 }
2180 }
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05002181exit:
Jon Paul Maloy7d339392014-02-13 17:29:16 -05002182 if ((l_ptr->exp_msg_count == 0) && (l_ptr->flags & LINK_STOPPED)) {
2183 tipc_node_detach_link(l_ptr->owner, l_ptr);
2184 kfree(l_ptr);
2185 }
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05002186 return buf;
2187}
2188
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05002189/* tipc_link_tunnel_rcv(): Receive a tunnelled packet, sent
Jon Paul Maloy170b3922014-01-07 17:02:41 -05002190 * via other link as result of a failover (ORIGINAL_MSG) or
2191 * a new active link (DUPLICATE_MSG). Failover packets are
2192 * returned to the active link for delivery upwards.
2193 * Owner node is locked.
Per Lidenb97bf3f2006-01-02 19:04:38 +01002194 */
Jon Paul Maloy3bb53382014-02-13 17:29:12 -05002195static int tipc_link_tunnel_rcv(struct tipc_node *n_ptr,
Jon Paul Maloy170b3922014-01-07 17:02:41 -05002196 struct sk_buff **buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002197{
Jon Paul Maloy02842f72014-02-13 17:29:14 -05002198 struct sk_buff *t_buf = *buf;
2199 struct tipc_link *l_ptr;
2200 struct tipc_msg *t_msg = buf_msg(t_buf);
2201 u32 bearer_id = msg_bearer_id(t_msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002202
Jon Paul Maloy1e9d47a2014-02-13 17:29:13 -05002203 *buf = NULL;
2204
Dan Carpentercb4b102f2013-05-06 08:28:41 +00002205 if (bearer_id >= MAX_BEARERS)
2206 goto exit;
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05002207
Jon Paul Maloy02842f72014-02-13 17:29:14 -05002208 l_ptr = n_ptr->links[bearer_id];
2209 if (!l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002210 goto exit;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002211
Jon Paul Maloy02842f72014-02-13 17:29:14 -05002212 if (msg_type(t_msg) == DUPLICATE_MSG)
2213 tipc_link_dup_rcv(l_ptr, t_buf);
2214 else if (msg_type(t_msg) == ORIGINAL_MSG)
2215 *buf = tipc_link_failover_rcv(l_ptr, t_buf);
Jon Paul Maloy1e9d47a2014-02-13 17:29:13 -05002216 else
2217 pr_warn("%sunknown tunnel pkt received\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002218exit:
Jon Paul Maloy02842f72014-02-13 17:29:14 -05002219 kfree_skb(t_buf);
Jon Paul Maloy1e9d47a2014-02-13 17:29:13 -05002220 return *buf != NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002221}
2222
2223/*
2224 * Bundler functionality:
2225 */
Per Liden4323add2006-01-18 00:38:21 +01002226void tipc_link_recv_bundle(struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002227{
2228 u32 msgcount = msg_msgcnt(buf_msg(buf));
2229 u32 pos = INT_H_SIZE;
2230 struct sk_buff *obuf;
2231
Per Lidenb97bf3f2006-01-02 19:04:38 +01002232 while (msgcount--) {
2233 obuf = buf_extract(buf, pos);
2234 if (obuf == NULL) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04002235 pr_warn("Link unable to unbundle message(s)\n");
Allan Stephensa10bd922006-06-25 23:52:17 -07002236 break;
Stephen Hemminger3ff50b72007-04-20 17:09:22 -07002237 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01002238 pos += align(msg_size(buf_msg(obuf)));
Per Liden4323add2006-01-18 00:38:21 +01002239 tipc_net_route_msg(obuf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002240 }
Allan Stephens5f6d9122011-11-04 13:24:29 -04002241 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002242}
2243
2244/*
2245 * Fragmentation/defragmentation:
2246 */
2247
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002248/*
stephen hemminger31e3c3f2010-10-13 13:20:35 +00002249 * link_send_long_buf: Entry for buffers needing fragmentation.
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002250 * The buffer is complete, inclusive total message length.
Per Lidenb97bf3f2006-01-02 19:04:38 +01002251 * Returns user data length.
2252 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002253static int link_send_long_buf(struct tipc_link *l_ptr, struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002254{
Allan Stephens77561552011-04-17 13:06:23 -04002255 struct sk_buff *buf_chain = NULL;
2256 struct sk_buff *buf_chain_tail = (struct sk_buff *)&buf_chain;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002257 struct tipc_msg *inmsg = buf_msg(buf);
2258 struct tipc_msg fragm_hdr;
2259 u32 insize = msg_size(inmsg);
2260 u32 dsz = msg_data_sz(inmsg);
2261 unchar *crs = buf->data;
2262 u32 rest = insize;
Allan Stephens15e979d2010-05-11 14:30:10 +00002263 u32 pack_sz = l_ptr->max_pkt;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002264 u32 fragm_sz = pack_sz - INT_H_SIZE;
Allan Stephens77561552011-04-17 13:06:23 -04002265 u32 fragm_no = 0;
Allan Stephens9c396a72008-06-04 17:36:58 -07002266 u32 destaddr;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002267
2268 if (msg_short(inmsg))
2269 destaddr = l_ptr->addr;
Allan Stephens9c396a72008-06-04 17:36:58 -07002270 else
2271 destaddr = msg_destnode(inmsg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002272
Per Lidenb97bf3f2006-01-02 19:04:38 +01002273 /* Prepare reusable fragment header: */
Allan Stephensc68ca7b2010-05-11 14:30:12 +00002274 tipc_msg_init(&fragm_hdr, MSG_FRAGMENTER, FIRST_FRAGMENT,
Allan Stephens75715212008-06-04 17:37:34 -07002275 INT_H_SIZE, destaddr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002276
2277 /* Chop up message: */
Per Lidenb97bf3f2006-01-02 19:04:38 +01002278 while (rest > 0) {
2279 struct sk_buff *fragm;
2280
2281 if (rest <= fragm_sz) {
2282 fragm_sz = rest;
2283 msg_set_type(&fragm_hdr, LAST_FRAGMENT);
2284 }
stephen hemminger31e3c3f2010-10-13 13:20:35 +00002285 fragm = tipc_buf_acquire(fragm_sz + INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002286 if (fragm == NULL) {
Allan Stephens5f6d9122011-11-04 13:24:29 -04002287 kfree_skb(buf);
Ying Xued77b3832013-12-10 20:45:38 -08002288 kfree_skb_list(buf_chain);
Allan Stephens77561552011-04-17 13:06:23 -04002289 return -ENOMEM;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002290 }
2291 msg_set_size(&fragm_hdr, fragm_sz + INT_H_SIZE);
Allan Stephens77561552011-04-17 13:06:23 -04002292 fragm_no++;
2293 msg_set_fragm_no(&fragm_hdr, fragm_no);
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03002294 skb_copy_to_linear_data(fragm, &fragm_hdr, INT_H_SIZE);
2295 skb_copy_to_linear_data_offset(fragm, INT_H_SIZE, crs,
2296 fragm_sz);
Allan Stephens77561552011-04-17 13:06:23 -04002297 buf_chain_tail->next = fragm;
2298 buf_chain_tail = fragm;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002299
Per Lidenb97bf3f2006-01-02 19:04:38 +01002300 rest -= fragm_sz;
2301 crs += fragm_sz;
2302 msg_set_type(&fragm_hdr, FRAGMENT);
2303 }
Allan Stephens5f6d9122011-11-04 13:24:29 -04002304 kfree_skb(buf);
Allan Stephens77561552011-04-17 13:06:23 -04002305
2306 /* Append chain of fragments to send queue & send them */
Allan Stephens77561552011-04-17 13:06:23 -04002307 l_ptr->long_msg_seq_no++;
2308 link_add_chain_to_outqueue(l_ptr, buf_chain, l_ptr->long_msg_seq_no);
2309 l_ptr->stats.sent_fragments += fragm_no;
2310 l_ptr->stats.sent_fragmented++;
2311 tipc_link_push_queue(l_ptr);
2312
Per Lidenb97bf3f2006-01-02 19:04:38 +01002313 return dsz;
2314}
2315
Jon Paul Maloy03b92012014-02-13 17:29:05 -05002316/* tipc_link_frag_rcv(): Called with node lock on. Returns
Per Lidenb97bf3f2006-01-02 19:04:38 +01002317 * the reassembled buffer if message is complete.
2318 */
Jon Paul Maloy03b92012014-02-13 17:29:05 -05002319int tipc_link_frag_rcv(struct sk_buff **head, struct sk_buff **tail,
2320 struct sk_buff **fbuf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002321{
Erik Hugne40ba3cd2013-11-06 09:28:06 +01002322 struct sk_buff *frag = *fbuf;
2323 struct tipc_msg *msg = buf_msg(frag);
2324 u32 fragid = msg_type(msg);
2325 bool headstolen;
2326 int delta;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002327
Erik Hugne40ba3cd2013-11-06 09:28:06 +01002328 skb_pull(frag, msg_hdr_sz(msg));
2329 if (fragid == FIRST_FRAGMENT) {
2330 if (*head || skb_unclone(frag, GFP_ATOMIC))
2331 goto out_free;
2332 *head = frag;
2333 skb_frag_list_init(*head);
Jon Paul Maloy03b92012014-02-13 17:29:05 -05002334 *fbuf = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002335 return 0;
Erik Hugne3db0a192013-11-13 09:35:11 +01002336 } else if (*head &&
2337 skb_try_coalesce(*head, frag, &headstolen, &delta)) {
Erik Hugne40ba3cd2013-11-06 09:28:06 +01002338 kfree_skb_partial(frag, headstolen);
2339 } else {
2340 if (!*head)
2341 goto out_free;
2342 if (!skb_has_frag_list(*head))
2343 skb_shinfo(*head)->frag_list = frag;
2344 else
2345 (*tail)->next = frag;
2346 *tail = frag;
2347 (*head)->truesize += frag->truesize;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002348 }
Erik Hugne40ba3cd2013-11-06 09:28:06 +01002349 if (fragid == LAST_FRAGMENT) {
2350 *fbuf = *head;
2351 *tail = *head = NULL;
2352 return LINK_REASM_COMPLETE;
2353 }
Jon Paul Maloy03b92012014-02-13 17:29:05 -05002354 *fbuf = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002355 return 0;
Erik Hugne40ba3cd2013-11-06 09:28:06 +01002356out_free:
2357 pr_warn_ratelimited("Link unable to reassemble fragmented message\n");
2358 kfree_skb(*fbuf);
Jon Paul Maloy03b92012014-02-13 17:29:05 -05002359 *fbuf = NULL;
Erik Hugne40ba3cd2013-11-06 09:28:06 +01002360 return LINK_REASM_ERROR;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002361}
2362
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002363static void link_set_supervision_props(struct tipc_link *l_ptr, u32 tolerance)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002364{
Allan Stephens5413b4c2011-01-18 13:24:55 -05002365 if ((tolerance < TIPC_MIN_LINK_TOL) || (tolerance > TIPC_MAX_LINK_TOL))
2366 return;
2367
Per Lidenb97bf3f2006-01-02 19:04:38 +01002368 l_ptr->tolerance = tolerance;
2369 l_ptr->continuity_interval =
2370 ((tolerance / 4) > 500) ? 500 : tolerance / 4;
2371 l_ptr->abort_limit = tolerance / (l_ptr->continuity_interval / 4);
2372}
2373
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002374void tipc_link_set_queue_limits(struct tipc_link *l_ptr, u32 window)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002375{
2376 /* Data messages from this node, inclusive FIRST_FRAGM */
Allan Stephens06d82c92008-03-06 15:06:55 -08002377 l_ptr->queue_limit[TIPC_LOW_IMPORTANCE] = window;
2378 l_ptr->queue_limit[TIPC_MEDIUM_IMPORTANCE] = (window / 3) * 4;
2379 l_ptr->queue_limit[TIPC_HIGH_IMPORTANCE] = (window / 3) * 5;
2380 l_ptr->queue_limit[TIPC_CRITICAL_IMPORTANCE] = (window / 3) * 6;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002381 /* Transiting data messages,inclusive FIRST_FRAGM */
Allan Stephens06d82c92008-03-06 15:06:55 -08002382 l_ptr->queue_limit[TIPC_LOW_IMPORTANCE + 4] = 300;
2383 l_ptr->queue_limit[TIPC_MEDIUM_IMPORTANCE + 4] = 600;
2384 l_ptr->queue_limit[TIPC_HIGH_IMPORTANCE + 4] = 900;
2385 l_ptr->queue_limit[TIPC_CRITICAL_IMPORTANCE + 4] = 1200;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002386 l_ptr->queue_limit[CONN_MANAGER] = 1200;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002387 l_ptr->queue_limit[CHANGEOVER_PROTOCOL] = 2500;
2388 l_ptr->queue_limit[NAME_DISTRIBUTOR] = 3000;
2389 /* FRAGMENT and LAST_FRAGMENT packets */
2390 l_ptr->queue_limit[MSG_FRAGMENTER] = 4000;
2391}
2392
Jon Paul Maloye099e862014-02-13 17:29:18 -05002393/* tipc_link_find_owner - locate owner node of link by link's name
2394 * @name: pointer to link name string
2395 * @bearer_id: pointer to index in 'node->links' array where the link was found.
Per Liden4323add2006-01-18 00:38:21 +01002396 * Caller must hold 'tipc_net_lock' to ensure node and bearer are not deleted;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002397 * this also prevents link deletion.
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002398 *
Jon Paul Maloye099e862014-02-13 17:29:18 -05002399 * Returns pointer to node owning the link, or 0 if no matching link is found.
Per Lidenb97bf3f2006-01-02 19:04:38 +01002400 */
Jon Paul Maloye099e862014-02-13 17:29:18 -05002401static struct tipc_node *tipc_link_find_owner(const char *link_name,
2402 unsigned int *bearer_id)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002403{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002404 struct tipc_link *l_ptr;
Erik Hugnebbfbe472013-10-18 07:23:21 +02002405 struct tipc_node *n_ptr;
Jon Paul Maloye099e862014-02-13 17:29:18 -05002406 struct tipc_node *tmp_n_ptr;
2407 struct tipc_node *found_node = 0;
2408
Erik Hugnebbfbe472013-10-18 07:23:21 +02002409 int i;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002410
Jon Paul Maloye099e862014-02-13 17:29:18 -05002411 *bearer_id = 0;
2412 list_for_each_entry_safe(n_ptr, tmp_n_ptr, &tipc_node_list, list) {
2413 spin_lock(&n_ptr->lock);
Erik Hugnebbfbe472013-10-18 07:23:21 +02002414 for (i = 0; i < MAX_BEARERS; i++) {
2415 l_ptr = n_ptr->links[i];
Jon Paul Maloye099e862014-02-13 17:29:18 -05002416 if (l_ptr && !strcmp(l_ptr->name, link_name)) {
2417 *bearer_id = i;
2418 found_node = n_ptr;
2419 break;
2420 }
Erik Hugnebbfbe472013-10-18 07:23:21 +02002421 }
Jon Paul Maloye099e862014-02-13 17:29:18 -05002422 spin_unlock(&n_ptr->lock);
2423 if (found_node)
2424 break;
Erik Hugnebbfbe472013-10-18 07:23:21 +02002425 }
Jon Paul Maloye099e862014-02-13 17:29:18 -05002426 return found_node;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002427}
2428
Allan Stephens5c216e12011-10-18 11:34:29 -04002429/**
2430 * link_value_is_valid -- validate proposed link tolerance/priority/window
2431 *
Ben Hutchings2c530402012-07-10 10:55:09 +00002432 * @cmd: value type (TIPC_CMD_SET_LINK_*)
2433 * @new_value: the new value
Allan Stephens5c216e12011-10-18 11:34:29 -04002434 *
2435 * Returns 1 if value is within range, 0 if not.
2436 */
Allan Stephens5c216e12011-10-18 11:34:29 -04002437static int link_value_is_valid(u16 cmd, u32 new_value)
2438{
2439 switch (cmd) {
2440 case TIPC_CMD_SET_LINK_TOL:
2441 return (new_value >= TIPC_MIN_LINK_TOL) &&
2442 (new_value <= TIPC_MAX_LINK_TOL);
2443 case TIPC_CMD_SET_LINK_PRI:
2444 return (new_value <= TIPC_MAX_LINK_PRI);
2445 case TIPC_CMD_SET_LINK_WINDOW:
2446 return (new_value >= TIPC_MIN_LINK_WIN) &&
2447 (new_value <= TIPC_MAX_LINK_WIN);
2448 }
2449 return 0;
2450}
2451
Allan Stephens5c216e12011-10-18 11:34:29 -04002452/**
2453 * link_cmd_set_value - change priority/tolerance/window for link/bearer/media
Ben Hutchings2c530402012-07-10 10:55:09 +00002454 * @name: ptr to link, bearer, or media name
2455 * @new_value: new value of link, bearer, or media setting
2456 * @cmd: which link, bearer, or media attribute to set (TIPC_CMD_SET_LINK_*)
Allan Stephens5c216e12011-10-18 11:34:29 -04002457 *
2458 * Caller must hold 'tipc_net_lock' to ensure link/bearer/media is not deleted.
2459 *
2460 * Returns 0 if value updated and negative value on error.
2461 */
Allan Stephens5c216e12011-10-18 11:34:29 -04002462static int link_cmd_set_value(const char *name, u32 new_value, u16 cmd)
2463{
2464 struct tipc_node *node;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002465 struct tipc_link *l_ptr;
Allan Stephens5c216e12011-10-18 11:34:29 -04002466 struct tipc_bearer *b_ptr;
Paul Gortmaker358a0d12011-12-29 20:19:42 -05002467 struct tipc_media *m_ptr;
Jon Paul Maloye099e862014-02-13 17:29:18 -05002468 int bearer_id;
Ying Xue636c0372013-10-18 07:23:20 +02002469 int res = 0;
Allan Stephens5c216e12011-10-18 11:34:29 -04002470
Jon Paul Maloye099e862014-02-13 17:29:18 -05002471 node = tipc_link_find_owner(name, &bearer_id);
2472 if (node) {
Allan Stephens5c216e12011-10-18 11:34:29 -04002473 tipc_node_lock(node);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002474 l_ptr = node->links[bearer_id];
2475
2476 if (l_ptr) {
2477 switch (cmd) {
2478 case TIPC_CMD_SET_LINK_TOL:
2479 link_set_supervision_props(l_ptr, new_value);
2480 tipc_link_send_proto_msg(l_ptr, STATE_MSG, 0,
2481 0, new_value, 0, 0);
2482 break;
2483 case TIPC_CMD_SET_LINK_PRI:
2484 l_ptr->priority = new_value;
2485 tipc_link_send_proto_msg(l_ptr, STATE_MSG, 0,
2486 0, 0, new_value, 0);
2487 break;
2488 case TIPC_CMD_SET_LINK_WINDOW:
2489 tipc_link_set_queue_limits(l_ptr, new_value);
2490 break;
2491 default:
2492 res = -EINVAL;
2493 break;
2494 }
Allan Stephens5c216e12011-10-18 11:34:29 -04002495 }
2496 tipc_node_unlock(node);
Ying Xue636c0372013-10-18 07:23:20 +02002497 return res;
Allan Stephens5c216e12011-10-18 11:34:29 -04002498 }
2499
2500 b_ptr = tipc_bearer_find(name);
2501 if (b_ptr) {
2502 switch (cmd) {
2503 case TIPC_CMD_SET_LINK_TOL:
2504 b_ptr->tolerance = new_value;
Ying Xue636c0372013-10-18 07:23:20 +02002505 break;
Allan Stephens5c216e12011-10-18 11:34:29 -04002506 case TIPC_CMD_SET_LINK_PRI:
2507 b_ptr->priority = new_value;
Ying Xue636c0372013-10-18 07:23:20 +02002508 break;
Allan Stephens5c216e12011-10-18 11:34:29 -04002509 case TIPC_CMD_SET_LINK_WINDOW:
2510 b_ptr->window = new_value;
Ying Xue636c0372013-10-18 07:23:20 +02002511 break;
2512 default:
2513 res = -EINVAL;
2514 break;
Allan Stephens5c216e12011-10-18 11:34:29 -04002515 }
Ying Xue636c0372013-10-18 07:23:20 +02002516 return res;
Allan Stephens5c216e12011-10-18 11:34:29 -04002517 }
2518
2519 m_ptr = tipc_media_find(name);
2520 if (!m_ptr)
2521 return -ENODEV;
2522 switch (cmd) {
2523 case TIPC_CMD_SET_LINK_TOL:
2524 m_ptr->tolerance = new_value;
Ying Xue636c0372013-10-18 07:23:20 +02002525 break;
Allan Stephens5c216e12011-10-18 11:34:29 -04002526 case TIPC_CMD_SET_LINK_PRI:
2527 m_ptr->priority = new_value;
Ying Xue636c0372013-10-18 07:23:20 +02002528 break;
Allan Stephens5c216e12011-10-18 11:34:29 -04002529 case TIPC_CMD_SET_LINK_WINDOW:
2530 m_ptr->window = new_value;
Ying Xue636c0372013-10-18 07:23:20 +02002531 break;
2532 default:
2533 res = -EINVAL;
2534 break;
Allan Stephens5c216e12011-10-18 11:34:29 -04002535 }
Ying Xue636c0372013-10-18 07:23:20 +02002536 return res;
Allan Stephens5c216e12011-10-18 11:34:29 -04002537}
2538
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002539struct sk_buff *tipc_link_cmd_config(const void *req_tlv_area, int req_tlv_space,
Per Liden4323add2006-01-18 00:38:21 +01002540 u16 cmd)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002541{
2542 struct tipc_link_config *args;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002543 u32 new_value;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002544 int res;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002545
2546 if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_LINK_CONFIG))
Per Liden4323add2006-01-18 00:38:21 +01002547 return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002548
2549 args = (struct tipc_link_config *)TLV_DATA(req_tlv_area);
2550 new_value = ntohl(args->value);
2551
Allan Stephens5c216e12011-10-18 11:34:29 -04002552 if (!link_value_is_valid(cmd, new_value))
2553 return tipc_cfg_reply_error_string(
2554 "cannot change, value invalid");
2555
Per Liden4323add2006-01-18 00:38:21 +01002556 if (!strcmp(args->name, tipc_bclink_name)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01002557 if ((cmd == TIPC_CMD_SET_LINK_WINDOW) &&
Per Liden4323add2006-01-18 00:38:21 +01002558 (tipc_bclink_set_queue_limits(new_value) == 0))
2559 return tipc_cfg_reply_none();
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002560 return tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED
Per Liden4323add2006-01-18 00:38:21 +01002561 " (cannot change setting on broadcast link)");
Per Lidenb97bf3f2006-01-02 19:04:38 +01002562 }
2563
Per Liden4323add2006-01-18 00:38:21 +01002564 read_lock_bh(&tipc_net_lock);
Allan Stephens5c216e12011-10-18 11:34:29 -04002565 res = link_cmd_set_value(args->name, new_value, cmd);
Per Liden4323add2006-01-18 00:38:21 +01002566 read_unlock_bh(&tipc_net_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002567 if (res)
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002568 return tipc_cfg_reply_error_string("cannot change link setting");
Per Lidenb97bf3f2006-01-02 19:04:38 +01002569
Per Liden4323add2006-01-18 00:38:21 +01002570 return tipc_cfg_reply_none();
Per Lidenb97bf3f2006-01-02 19:04:38 +01002571}
2572
2573/**
2574 * link_reset_statistics - reset link statistics
2575 * @l_ptr: pointer to link
2576 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002577static void link_reset_statistics(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002578{
2579 memset(&l_ptr->stats, 0, sizeof(l_ptr->stats));
2580 l_ptr->stats.sent_info = l_ptr->next_out_no;
2581 l_ptr->stats.recv_info = l_ptr->next_in_no;
2582}
2583
Per Liden4323add2006-01-18 00:38:21 +01002584struct sk_buff *tipc_link_cmd_reset_stats(const void *req_tlv_area, int req_tlv_space)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002585{
2586 char *link_name;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002587 struct tipc_link *l_ptr;
David S. Miller6c000552008-09-02 23:38:32 -07002588 struct tipc_node *node;
Jon Paul Maloye099e862014-02-13 17:29:18 -05002589 unsigned int bearer_id;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002590
2591 if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_LINK_NAME))
Per Liden4323add2006-01-18 00:38:21 +01002592 return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002593
2594 link_name = (char *)TLV_DATA(req_tlv_area);
Per Liden4323add2006-01-18 00:38:21 +01002595 if (!strcmp(link_name, tipc_bclink_name)) {
2596 if (tipc_bclink_reset_stats())
2597 return tipc_cfg_reply_error_string("link not found");
2598 return tipc_cfg_reply_none();
Per Lidenb97bf3f2006-01-02 19:04:38 +01002599 }
Per Liden4323add2006-01-18 00:38:21 +01002600 read_lock_bh(&tipc_net_lock);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002601 node = tipc_link_find_owner(link_name, &bearer_id);
2602 if (!node) {
Per Liden4323add2006-01-18 00:38:21 +01002603 read_unlock_bh(&tipc_net_lock);
2604 return tipc_cfg_reply_error_string("link not found");
Per Lidenb97bf3f2006-01-02 19:04:38 +01002605 }
Jon Paul Maloye099e862014-02-13 17:29:18 -05002606 spin_lock(&node->lock);
2607 l_ptr = node->links[bearer_id];
2608 if (!l_ptr) {
2609 tipc_node_unlock(node);
2610 read_unlock_bh(&tipc_net_lock);
2611 return tipc_cfg_reply_error_string("link not found");
2612 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01002613 link_reset_statistics(l_ptr);
Per Liden4323add2006-01-18 00:38:21 +01002614 tipc_node_unlock(node);
2615 read_unlock_bh(&tipc_net_lock);
2616 return tipc_cfg_reply_none();
Per Lidenb97bf3f2006-01-02 19:04:38 +01002617}
2618
2619/**
2620 * percent - convert count to a percentage of total (rounding up or down)
2621 */
Per Lidenb97bf3f2006-01-02 19:04:38 +01002622static u32 percent(u32 count, u32 total)
2623{
2624 return (count * 100 + (total / 2)) / total;
2625}
2626
2627/**
Per Liden4323add2006-01-18 00:38:21 +01002628 * tipc_link_stats - print link statistics
Per Lidenb97bf3f2006-01-02 19:04:38 +01002629 * @name: link name
2630 * @buf: print buffer area
2631 * @buf_size: size of print buffer area
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002632 *
Per Lidenb97bf3f2006-01-02 19:04:38 +01002633 * Returns length of print buffer data string (or 0 if error)
2634 */
Per Liden4323add2006-01-18 00:38:21 +01002635static int tipc_link_stats(const char *name, char *buf, const u32 buf_size)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002636{
Erik Hugnedc1aed32012-06-29 00:50:23 -04002637 struct tipc_link *l;
2638 struct tipc_stats *s;
David S. Miller6c000552008-09-02 23:38:32 -07002639 struct tipc_node *node;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002640 char *status;
2641 u32 profile_total = 0;
Jon Paul Maloye099e862014-02-13 17:29:18 -05002642 unsigned int bearer_id;
Erik Hugnedc1aed32012-06-29 00:50:23 -04002643 int ret;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002644
Per Liden4323add2006-01-18 00:38:21 +01002645 if (!strcmp(name, tipc_bclink_name))
2646 return tipc_bclink_stats(buf, buf_size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002647
Per Liden4323add2006-01-18 00:38:21 +01002648 read_lock_bh(&tipc_net_lock);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002649 node = tipc_link_find_owner(name, &bearer_id);
2650 if (!node) {
Per Liden4323add2006-01-18 00:38:21 +01002651 read_unlock_bh(&tipc_net_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002652 return 0;
2653 }
Per Liden4323add2006-01-18 00:38:21 +01002654 tipc_node_lock(node);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002655
2656 l = node->links[bearer_id];
2657 if (!l) {
2658 tipc_node_unlock(node);
2659 read_unlock_bh(&tipc_net_lock);
2660 return 0;
2661 }
2662
Erik Hugnedc1aed32012-06-29 00:50:23 -04002663 s = &l->stats;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002664
Erik Hugnedc1aed32012-06-29 00:50:23 -04002665 if (tipc_link_is_active(l))
Per Lidenb97bf3f2006-01-02 19:04:38 +01002666 status = "ACTIVE";
Erik Hugnedc1aed32012-06-29 00:50:23 -04002667 else if (tipc_link_is_up(l))
Per Lidenb97bf3f2006-01-02 19:04:38 +01002668 status = "STANDBY";
2669 else
2670 status = "DEFUNCT";
Erik Hugnedc1aed32012-06-29 00:50:23 -04002671
2672 ret = tipc_snprintf(buf, buf_size, "Link <%s>\n"
2673 " %s MTU:%u Priority:%u Tolerance:%u ms"
2674 " Window:%u packets\n",
2675 l->name, status, l->max_pkt, l->priority,
2676 l->tolerance, l->queue_limit[0]);
2677
2678 ret += tipc_snprintf(buf + ret, buf_size - ret,
2679 " RX packets:%u fragments:%u/%u bundles:%u/%u\n",
2680 l->next_in_no - s->recv_info, s->recv_fragments,
2681 s->recv_fragmented, s->recv_bundles,
2682 s->recv_bundled);
2683
2684 ret += tipc_snprintf(buf + ret, buf_size - ret,
2685 " TX packets:%u fragments:%u/%u bundles:%u/%u\n",
2686 l->next_out_no - s->sent_info, s->sent_fragments,
2687 s->sent_fragmented, s->sent_bundles,
2688 s->sent_bundled);
2689
2690 profile_total = s->msg_length_counts;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002691 if (!profile_total)
2692 profile_total = 1;
Erik Hugnedc1aed32012-06-29 00:50:23 -04002693
2694 ret += tipc_snprintf(buf + ret, buf_size - ret,
2695 " TX profile sample:%u packets average:%u octets\n"
2696 " 0-64:%u%% -256:%u%% -1024:%u%% -4096:%u%% "
2697 "-16384:%u%% -32768:%u%% -66000:%u%%\n",
2698 s->msg_length_counts,
2699 s->msg_lengths_total / profile_total,
2700 percent(s->msg_length_profile[0], profile_total),
2701 percent(s->msg_length_profile[1], profile_total),
2702 percent(s->msg_length_profile[2], profile_total),
2703 percent(s->msg_length_profile[3], profile_total),
2704 percent(s->msg_length_profile[4], profile_total),
2705 percent(s->msg_length_profile[5], profile_total),
2706 percent(s->msg_length_profile[6], profile_total));
2707
2708 ret += tipc_snprintf(buf + ret, buf_size - ret,
2709 " RX states:%u probes:%u naks:%u defs:%u"
2710 " dups:%u\n", s->recv_states, s->recv_probes,
2711 s->recv_nacks, s->deferred_recv, s->duplicates);
2712
2713 ret += tipc_snprintf(buf + ret, buf_size - ret,
2714 " TX states:%u probes:%u naks:%u acks:%u"
2715 " dups:%u\n", s->sent_states, s->sent_probes,
2716 s->sent_nacks, s->sent_acks, s->retransmitted);
2717
2718 ret += tipc_snprintf(buf + ret, buf_size - ret,
Ying Xue3c294cb2012-11-15 11:34:45 +08002719 " Congestion link:%u Send queue"
2720 " max:%u avg:%u\n", s->link_congs,
Erik Hugnedc1aed32012-06-29 00:50:23 -04002721 s->max_queue_sz, s->queue_sz_counts ?
2722 (s->accu_queue_sz / s->queue_sz_counts) : 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002723
Per Liden4323add2006-01-18 00:38:21 +01002724 tipc_node_unlock(node);
2725 read_unlock_bh(&tipc_net_lock);
Erik Hugnedc1aed32012-06-29 00:50:23 -04002726 return ret;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002727}
2728
Per Liden4323add2006-01-18 00:38:21 +01002729struct sk_buff *tipc_link_cmd_show_stats(const void *req_tlv_area, int req_tlv_space)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002730{
2731 struct sk_buff *buf;
2732 struct tlv_desc *rep_tlv;
2733 int str_len;
Erik Hugnedc1aed32012-06-29 00:50:23 -04002734 int pb_len;
2735 char *pb;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002736
2737 if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_LINK_NAME))
Per Liden4323add2006-01-18 00:38:21 +01002738 return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002739
Erik Hugnedc1aed32012-06-29 00:50:23 -04002740 buf = tipc_cfg_reply_alloc(TLV_SPACE(ULTRA_STRING_MAX_LEN));
Per Lidenb97bf3f2006-01-02 19:04:38 +01002741 if (!buf)
2742 return NULL;
2743
2744 rep_tlv = (struct tlv_desc *)buf->data;
Erik Hugnedc1aed32012-06-29 00:50:23 -04002745 pb = TLV_DATA(rep_tlv);
2746 pb_len = ULTRA_STRING_MAX_LEN;
Per Liden4323add2006-01-18 00:38:21 +01002747 str_len = tipc_link_stats((char *)TLV_DATA(req_tlv_area),
Erik Hugnedc1aed32012-06-29 00:50:23 -04002748 pb, pb_len);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002749 if (!str_len) {
Allan Stephens5f6d9122011-11-04 13:24:29 -04002750 kfree_skb(buf);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002751 return tipc_cfg_reply_error_string("link not found");
Per Lidenb97bf3f2006-01-02 19:04:38 +01002752 }
Erik Hugnedc1aed32012-06-29 00:50:23 -04002753 str_len += 1; /* for "\0" */
Per Lidenb97bf3f2006-01-02 19:04:38 +01002754 skb_put(buf, TLV_SPACE(str_len));
2755 TLV_SET(rep_tlv, TIPC_TLV_ULTRA_STRING, NULL, str_len);
2756
2757 return buf;
2758}
2759
Per Lidenb97bf3f2006-01-02 19:04:38 +01002760/**
Per Liden4323add2006-01-18 00:38:21 +01002761 * tipc_link_get_max_pkt - get maximum packet size to use when sending to destination
Per Lidenb97bf3f2006-01-02 19:04:38 +01002762 * @dest: network address of destination node
2763 * @selector: used to select from set of active links
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002764 *
Per Lidenb97bf3f2006-01-02 19:04:38 +01002765 * If no active link can be found, uses default maximum packet size.
2766 */
Per Liden4323add2006-01-18 00:38:21 +01002767u32 tipc_link_get_max_pkt(u32 dest, u32 selector)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002768{
David S. Miller6c000552008-09-02 23:38:32 -07002769 struct tipc_node *n_ptr;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002770 struct tipc_link *l_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002771 u32 res = MAX_PKT_DEFAULT;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002772
Per Lidenb97bf3f2006-01-02 19:04:38 +01002773 if (dest == tipc_own_addr)
2774 return MAX_MSG_SIZE;
2775
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002776 read_lock_bh(&tipc_net_lock);
Allan Stephens51a8e4d2010-12-31 18:59:18 +00002777 n_ptr = tipc_node_find(dest);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002778 if (n_ptr) {
Per Liden4323add2006-01-18 00:38:21 +01002779 tipc_node_lock(n_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002780 l_ptr = n_ptr->active_links[selector & 1];
2781 if (l_ptr)
Allan Stephens15e979d2010-05-11 14:30:10 +00002782 res = l_ptr->max_pkt;
Per Liden4323add2006-01-18 00:38:21 +01002783 tipc_node_unlock(n_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002784 }
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002785 read_unlock_bh(&tipc_net_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002786 return res;
2787}
2788
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002789static void link_print(struct tipc_link *l_ptr, const char *str)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002790{
Paul Gortmaker5deedde2012-07-11 19:27:56 -04002791 pr_info("%s Link %x<%s>:", str, l_ptr->addr, l_ptr->b_ptr->name);
Allan Stephens8d64a5b2010-12-31 18:59:27 +00002792
Per Lidenb97bf3f2006-01-02 19:04:38 +01002793 if (link_working_unknown(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04002794 pr_cont(":WU\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00002795 else if (link_reset_reset(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04002796 pr_cont(":RR\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00002797 else if (link_reset_unknown(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04002798 pr_cont(":RU\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00002799 else if (link_working_working(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04002800 pr_cont(":WW\n");
2801 else
2802 pr_cont("\n");
Per Lidenb97bf3f2006-01-02 19:04:38 +01002803}