blob: be73a1fa7c65c37db44ce78d53144308b10d4055 [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 Maloyc64f7a62012-11-16 13:51:31 +08004 * Copyright (c) 1996-2007, 2012, 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
78/**
Paul Gortmakera18c4bc2011-12-29 20:58:42 -050079 * struct tipc_link_name - deconstructed link name
Per Lidenb97bf3f2006-01-02 19:04:38 +010080 * @addr_local: network address of node at this end
81 * @if_local: name of interface at this end
82 * @addr_peer: network address of node at far end
83 * @if_peer: name of interface at far end
84 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -050085struct tipc_link_name {
Per Lidenb97bf3f2006-01-02 19:04:38 +010086 u32 addr_local;
87 char if_local[TIPC_MAX_IF_NAME];
88 u32 addr_peer;
89 char if_peer[TIPC_MAX_IF_NAME];
90};
91
Paul Gortmakera18c4bc2011-12-29 20:58:42 -050092static void link_handle_out_of_seq_msg(struct tipc_link *l_ptr,
Per Lidenb97bf3f2006-01-02 19:04:38 +010093 struct sk_buff *buf);
Paul Gortmakera18c4bc2011-12-29 20:58:42 -050094static void link_recv_proto_msg(struct tipc_link *l_ptr, struct sk_buff *buf);
95static int link_recv_changeover_msg(struct tipc_link **l_ptr,
96 struct sk_buff **buf);
97static void link_set_supervision_props(struct tipc_link *l_ptr, u32 tolerance);
Allan Stephens23dd4cc2011-01-07 11:43:40 -050098static int link_send_sections_long(struct tipc_port *sender,
Per Lidenb97bf3f2006-01-02 19:04:38 +010099 struct iovec const *msg_sect,
Ying Xue9446b872013-10-18 07:23:15 +0200100 unsigned int len, u32 destnode);
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500101static void link_state_event(struct tipc_link *l_ptr, u32 event);
102static void link_reset_statistics(struct tipc_link *l_ptr);
103static void link_print(struct tipc_link *l_ptr, const char *str);
104static void link_start(struct tipc_link *l_ptr);
105static int link_send_long_buf(struct tipc_link *l_ptr, struct sk_buff *buf);
Jon Maloyc64f7a62012-11-16 13:51:31 +0800106static void tipc_link_send_sync(struct tipc_link *l);
107static void tipc_link_recv_sync(struct tipc_node *n, struct sk_buff *buf);
stephen hemminger31e3c3f2010-10-13 13:20:35 +0000108
Per Lidenb97bf3f2006-01-02 19:04:38 +0100109/*
Sam Ravnborg05790c62006-03-20 22:37:04 -0800110 * Simple link routines
Per Lidenb97bf3f2006-01-02 19:04:38 +0100111 */
Sam Ravnborg05790c62006-03-20 22:37:04 -0800112static unsigned int align(unsigned int i)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100113{
114 return (i + 3) & ~3u;
115}
116
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500117static void link_init_max_pkt(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100118{
119 u32 max_pkt;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900120
Allan Stephens2d627b92011-01-07 13:00:11 -0500121 max_pkt = (l_ptr->b_ptr->mtu & ~3);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100122 if (max_pkt > MAX_MSG_SIZE)
123 max_pkt = MAX_MSG_SIZE;
124
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900125 l_ptr->max_pkt_target = max_pkt;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100126 if (l_ptr->max_pkt_target < MAX_PKT_DEFAULT)
127 l_ptr->max_pkt = l_ptr->max_pkt_target;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900128 else
Per Lidenb97bf3f2006-01-02 19:04:38 +0100129 l_ptr->max_pkt = MAX_PKT_DEFAULT;
130
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900131 l_ptr->max_pkt_probes = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100132}
133
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500134static u32 link_next_sent(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100135{
136 if (l_ptr->next_out)
Allan Stephensf9057302011-10-24 16:03:12 -0400137 return buf_seqno(l_ptr->next_out);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100138 return mod(l_ptr->next_out_no);
139}
140
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500141static u32 link_last_sent(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100142{
143 return mod(link_next_sent(l_ptr) - 1);
144}
145
146/*
Sam Ravnborg05790c62006-03-20 22:37:04 -0800147 * Simple non-static link routines (i.e. referenced outside this file)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100148 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500149int tipc_link_is_up(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100150{
151 if (!l_ptr)
152 return 0;
Eric Dumazeta02cec22010-09-22 20:43:57 +0000153 return link_working_working(l_ptr) || link_working_unknown(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100154}
155
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500156int tipc_link_is_active(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100157{
Eric Dumazeta02cec22010-09-22 20:43:57 +0000158 return (l_ptr->owner->active_links[0] == l_ptr) ||
159 (l_ptr->owner->active_links[1] == l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100160}
161
162/**
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500163 * link_name_validate - validate & (optionally) deconstruct tipc_link name
Ben Hutchings2c530402012-07-10 10:55:09 +0000164 * @name: ptr to link name string
165 * @name_parts: ptr to area for link name components (or NULL if not needed)
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900166 *
Per Lidenb97bf3f2006-01-02 19:04:38 +0100167 * Returns 1 if link name is valid, otherwise 0.
168 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500169static int link_name_validate(const char *name,
170 struct tipc_link_name *name_parts)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100171{
172 char name_copy[TIPC_MAX_LINK_NAME];
173 char *addr_local;
174 char *if_local;
175 char *addr_peer;
176 char *if_peer;
177 char dummy;
178 u32 z_local, c_local, n_local;
179 u32 z_peer, c_peer, n_peer;
180 u32 if_local_len;
181 u32 if_peer_len;
182
183 /* copy link name & ensure length is OK */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100184 name_copy[TIPC_MAX_LINK_NAME - 1] = 0;
185 /* need above in case non-Posix strncpy() doesn't pad with nulls */
186 strncpy(name_copy, name, TIPC_MAX_LINK_NAME);
187 if (name_copy[TIPC_MAX_LINK_NAME - 1] != 0)
188 return 0;
189
190 /* ensure all component parts of link name are present */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100191 addr_local = name_copy;
Allan Stephens2db99832010-12-31 18:59:33 +0000192 if_local = strchr(addr_local, ':');
193 if (if_local == NULL)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100194 return 0;
195 *(if_local++) = 0;
Allan Stephens2db99832010-12-31 18:59:33 +0000196 addr_peer = strchr(if_local, '-');
197 if (addr_peer == NULL)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100198 return 0;
199 *(addr_peer++) = 0;
200 if_local_len = addr_peer - if_local;
Allan Stephens2db99832010-12-31 18:59:33 +0000201 if_peer = strchr(addr_peer, ':');
202 if (if_peer == NULL)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100203 return 0;
204 *(if_peer++) = 0;
205 if_peer_len = strlen(if_peer) + 1;
206
207 /* validate component parts of link name */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100208 if ((sscanf(addr_local, "%u.%u.%u%c",
209 &z_local, &c_local, &n_local, &dummy) != 3) ||
210 (sscanf(addr_peer, "%u.%u.%u%c",
211 &z_peer, &c_peer, &n_peer, &dummy) != 3) ||
212 (z_local > 255) || (c_local > 4095) || (n_local > 4095) ||
213 (z_peer > 255) || (c_peer > 4095) || (n_peer > 4095) ||
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900214 (if_local_len <= 1) || (if_local_len > TIPC_MAX_IF_NAME) ||
Ying Xuefc073932012-08-16 12:09:08 +0000215 (if_peer_len <= 1) || (if_peer_len > TIPC_MAX_IF_NAME))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100216 return 0;
217
218 /* return link name components, if necessary */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100219 if (name_parts) {
220 name_parts->addr_local = tipc_addr(z_local, c_local, n_local);
221 strcpy(name_parts->if_local, if_local);
222 name_parts->addr_peer = tipc_addr(z_peer, c_peer, n_peer);
223 strcpy(name_parts->if_peer, if_peer);
224 }
225 return 1;
226}
227
228/**
229 * link_timeout - handle expiration of link timer
230 * @l_ptr: pointer to link
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900231 *
Per Liden4323add2006-01-18 00:38:21 +0100232 * This routine must not grab "tipc_net_lock" to avoid a potential deadlock conflict
233 * with tipc_link_delete(). (There is no risk that the node will be deleted by
234 * another thread because tipc_link_delete() always cancels the link timer before
235 * tipc_node_delete() is called.)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100236 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500237static void link_timeout(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100238{
Per Liden4323add2006-01-18 00:38:21 +0100239 tipc_node_lock(l_ptr->owner);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100240
241 /* update counters used in statistical profiling of send traffic */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100242 l_ptr->stats.accu_queue_sz += l_ptr->out_queue_size;
243 l_ptr->stats.queue_sz_counts++;
244
Per Lidenb97bf3f2006-01-02 19:04:38 +0100245 if (l_ptr->first_out) {
246 struct tipc_msg *msg = buf_msg(l_ptr->first_out);
247 u32 length = msg_size(msg);
248
Joe Perchesf64f9e72009-11-29 16:55:45 -0800249 if ((msg_user(msg) == MSG_FRAGMENTER) &&
250 (msg_type(msg) == FIRST_FRAGMENT)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100251 length = msg_size(msg_get_wrapped(msg));
252 }
253 if (length) {
254 l_ptr->stats.msg_lengths_total += length;
255 l_ptr->stats.msg_length_counts++;
256 if (length <= 64)
257 l_ptr->stats.msg_length_profile[0]++;
258 else if (length <= 256)
259 l_ptr->stats.msg_length_profile[1]++;
260 else if (length <= 1024)
261 l_ptr->stats.msg_length_profile[2]++;
262 else if (length <= 4096)
263 l_ptr->stats.msg_length_profile[3]++;
264 else if (length <= 16384)
265 l_ptr->stats.msg_length_profile[4]++;
266 else if (length <= 32768)
267 l_ptr->stats.msg_length_profile[5]++;
268 else
269 l_ptr->stats.msg_length_profile[6]++;
270 }
271 }
272
273 /* do all other link processing performed on a periodic basis */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100274
275 link_state_event(l_ptr, TIMEOUT_EVT);
276
277 if (l_ptr->next_out)
Per Liden4323add2006-01-18 00:38:21 +0100278 tipc_link_push_queue(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100279
Per Liden4323add2006-01-18 00:38:21 +0100280 tipc_node_unlock(l_ptr->owner);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100281}
282
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500283static void link_set_timer(struct tipc_link *l_ptr, u32 time)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100284{
285 k_start_timer(&l_ptr->timer, time);
286}
287
288/**
Per Liden4323add2006-01-18 00:38:21 +0100289 * tipc_link_create - create a new link
Allan Stephens37b9c082011-02-28 11:32:27 -0500290 * @n_ptr: pointer to associated node
Per Lidenb97bf3f2006-01-02 19:04:38 +0100291 * @b_ptr: pointer to associated bearer
Per Lidenb97bf3f2006-01-02 19:04:38 +0100292 * @media_addr: media address to use when sending messages over link
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900293 *
Per Lidenb97bf3f2006-01-02 19:04:38 +0100294 * Returns pointer to link.
295 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500296struct tipc_link *tipc_link_create(struct tipc_node *n_ptr,
Allan Stephens37b9c082011-02-28 11:32:27 -0500297 struct tipc_bearer *b_ptr,
Per Liden4323add2006-01-18 00:38:21 +0100298 const struct tipc_media_addr *media_addr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100299{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500300 struct tipc_link *l_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100301 struct tipc_msg *msg;
302 char *if_name;
Allan Stephens37b9c082011-02-28 11:32:27 -0500303 char addr_string[16];
304 u32 peer = n_ptr->addr;
305
306 if (n_ptr->link_cnt >= 2) {
307 tipc_addr_string_fill(addr_string, n_ptr->addr);
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400308 pr_err("Attempt to establish third link to %s\n", addr_string);
Allan Stephens37b9c082011-02-28 11:32:27 -0500309 return NULL;
310 }
311
312 if (n_ptr->links[b_ptr->identity]) {
313 tipc_addr_string_fill(addr_string, n_ptr->addr);
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400314 pr_err("Attempt to establish second link on <%s> to %s\n",
315 b_ptr->name, addr_string);
Allan Stephens37b9c082011-02-28 11:32:27 -0500316 return NULL;
317 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100318
Panagiotis Issaris0da974f2006-07-21 14:51:30 -0700319 l_ptr = kzalloc(sizeof(*l_ptr), GFP_ATOMIC);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100320 if (!l_ptr) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400321 pr_warn("Link creation failed, no memory\n");
Per Lidenb97bf3f2006-01-02 19:04:38 +0100322 return NULL;
323 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100324
325 l_ptr->addr = peer;
Allan Stephens2d627b92011-01-07 13:00:11 -0500326 if_name = strchr(b_ptr->name, ':') + 1;
Allan Stephens062b4c92011-04-07 09:28:47 -0400327 sprintf(l_ptr->name, "%u.%u.%u:%s-%u.%u.%u:unknown",
Per Lidenb97bf3f2006-01-02 19:04:38 +0100328 tipc_zone(tipc_own_addr), tipc_cluster(tipc_own_addr),
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900329 tipc_node(tipc_own_addr),
Per Lidenb97bf3f2006-01-02 19:04:38 +0100330 if_name,
331 tipc_zone(peer), tipc_cluster(peer), tipc_node(peer));
Allan Stephens062b4c92011-04-07 09:28:47 -0400332 /* note: peer i/f name is updated by reset/activate message */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100333 memcpy(&l_ptr->media_addr, media_addr, sizeof(*media_addr));
Allan Stephens37b9c082011-02-28 11:32:27 -0500334 l_ptr->owner = n_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100335 l_ptr->checkpoint = 1;
Allan Stephensf882cb72011-04-07 09:43:27 -0400336 l_ptr->peer_session = INVALID_SESSION;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100337 l_ptr->b_ptr = b_ptr;
Allan Stephens5c216e12011-10-18 11:34:29 -0400338 link_set_supervision_props(l_ptr, b_ptr->tolerance);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100339 l_ptr->state = RESET_UNKNOWN;
340
341 l_ptr->pmsg = (struct tipc_msg *)&l_ptr->proto_msg;
342 msg = l_ptr->pmsg;
Allan Stephensc68ca7b2010-05-11 14:30:12 +0000343 tipc_msg_init(msg, LINK_PROTOCOL, RESET_MSG, INT_H_SIZE, l_ptr->addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100344 msg_set_size(msg, sizeof(l_ptr->proto_msg));
Allan Stephensa686e682008-06-04 17:29:39 -0700345 msg_set_session(msg, (tipc_random & 0xffff));
Per Lidenb97bf3f2006-01-02 19:04:38 +0100346 msg_set_bearer_id(msg, b_ptr->identity);
347 strcpy((char *)msg_data(msg), if_name);
348
349 l_ptr->priority = b_ptr->priority;
Allan Stephens5c216e12011-10-18 11:34:29 -0400350 tipc_link_set_queue_limits(l_ptr, b_ptr->window);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100351
352 link_init_max_pkt(l_ptr);
353
354 l_ptr->next_out_no = 1;
355 INIT_LIST_HEAD(&l_ptr->waiting_ports);
356
357 link_reset_statistics(l_ptr);
358
Allan Stephens37b9c082011-02-28 11:32:27 -0500359 tipc_node_attach_link(n_ptr, l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100360
Florian Westphal945710652007-07-26 00:05:07 -0700361 k_init_timer(&l_ptr->timer, (Handler)link_timeout, (unsigned long)l_ptr);
362 list_add_tail(&l_ptr->link_list, &b_ptr->links);
stephen hemminger31e3c3f2010-10-13 13:20:35 +0000363 tipc_k_signal((Handler)link_start, (unsigned long)l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100364
Per Lidenb97bf3f2006-01-02 19:04:38 +0100365 return l_ptr;
366}
367
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900368/**
Per Liden4323add2006-01-18 00:38:21 +0100369 * tipc_link_delete - delete a link
Per Lidenb97bf3f2006-01-02 19:04:38 +0100370 * @l_ptr: pointer to link
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900371 *
Per Liden4323add2006-01-18 00:38:21 +0100372 * Note: 'tipc_net_lock' is write_locked, bearer is locked.
Per Lidenb97bf3f2006-01-02 19:04:38 +0100373 * This routine must not grab the node lock until after link timer cancellation
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900374 * to avoid a potential deadlock situation.
Per Lidenb97bf3f2006-01-02 19:04:38 +0100375 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500376void tipc_link_delete(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100377{
378 if (!l_ptr) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400379 pr_err("Attempt to delete non-existent link\n");
Per Lidenb97bf3f2006-01-02 19:04:38 +0100380 return;
381 }
382
Per Lidenb97bf3f2006-01-02 19:04:38 +0100383 k_cancel_timer(&l_ptr->timer);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900384
Per Liden4323add2006-01-18 00:38:21 +0100385 tipc_node_lock(l_ptr->owner);
386 tipc_link_reset(l_ptr);
387 tipc_node_detach_link(l_ptr->owner, l_ptr);
388 tipc_link_stop(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100389 list_del_init(&l_ptr->link_list);
Per Liden4323add2006-01-18 00:38:21 +0100390 tipc_node_unlock(l_ptr->owner);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100391 k_term_timer(&l_ptr->timer);
392 kfree(l_ptr);
393}
394
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500395static void link_start(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100396{
Allan Stephens214dda42011-01-24 16:22:43 -0500397 tipc_node_lock(l_ptr->owner);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100398 link_state_event(l_ptr, STARTING_EVT);
Allan Stephens214dda42011-01-24 16:22:43 -0500399 tipc_node_unlock(l_ptr->owner);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100400}
401
402/**
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900403 * link_schedule_port - schedule port for deferred sending
Per Lidenb97bf3f2006-01-02 19:04:38 +0100404 * @l_ptr: pointer to link
405 * @origport: reference to sending port
406 * @sz: amount of data to be sent
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900407 *
408 * Schedules port for renewed sending of messages after link congestion
Per Lidenb97bf3f2006-01-02 19:04:38 +0100409 * has abated.
410 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500411static int link_schedule_port(struct tipc_link *l_ptr, u32 origport, u32 sz)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100412{
Allan Stephens23dd4cc2011-01-07 11:43:40 -0500413 struct tipc_port *p_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100414
Per Liden4323add2006-01-18 00:38:21 +0100415 spin_lock_bh(&tipc_port_list_lock);
416 p_ptr = tipc_port_lock(origport);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100417 if (p_ptr) {
418 if (!p_ptr->wakeup)
419 goto exit;
420 if (!list_empty(&p_ptr->wait_list))
421 goto exit;
Allan Stephens23dd4cc2011-01-07 11:43:40 -0500422 p_ptr->congested = 1;
Allan Stephens15e979d2010-05-11 14:30:10 +0000423 p_ptr->waiting_pkts = 1 + ((sz - 1) / l_ptr->max_pkt);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100424 list_add_tail(&p_ptr->wait_list, &l_ptr->waiting_ports);
425 l_ptr->stats.link_congs++;
426exit:
Per Liden4323add2006-01-18 00:38:21 +0100427 tipc_port_unlock(p_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100428 }
Per Liden4323add2006-01-18 00:38:21 +0100429 spin_unlock_bh(&tipc_port_list_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100430 return -ELINKCONG;
431}
432
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500433void tipc_link_wakeup_ports(struct tipc_link *l_ptr, int all)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100434{
Allan Stephens23dd4cc2011-01-07 11:43:40 -0500435 struct tipc_port *p_ptr;
436 struct tipc_port *temp_p_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100437 int win = l_ptr->queue_limit[0] - l_ptr->out_queue_size;
438
439 if (all)
440 win = 100000;
441 if (win <= 0)
442 return;
Per Liden4323add2006-01-18 00:38:21 +0100443 if (!spin_trylock_bh(&tipc_port_list_lock))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100444 return;
445 if (link_congested(l_ptr))
446 goto exit;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900447 list_for_each_entry_safe(p_ptr, temp_p_ptr, &l_ptr->waiting_ports,
Per Lidenb97bf3f2006-01-02 19:04:38 +0100448 wait_list) {
449 if (win <= 0)
450 break;
451 list_del_init(&p_ptr->wait_list);
Allan Stephens23dd4cc2011-01-07 11:43:40 -0500452 spin_lock_bh(p_ptr->lock);
453 p_ptr->congested = 0;
454 p_ptr->wakeup(p_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100455 win -= p_ptr->waiting_pkts;
Allan Stephens23dd4cc2011-01-07 11:43:40 -0500456 spin_unlock_bh(p_ptr->lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100457 }
458
459exit:
Per Liden4323add2006-01-18 00:38:21 +0100460 spin_unlock_bh(&tipc_port_list_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100461}
462
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900463/**
Per Lidenb97bf3f2006-01-02 19:04:38 +0100464 * link_release_outqueue - purge link's outbound message queue
465 * @l_ptr: pointer to link
466 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500467static void link_release_outqueue(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100468{
469 struct sk_buff *buf = l_ptr->first_out;
470 struct sk_buff *next;
471
472 while (buf) {
473 next = buf->next;
Allan Stephens5f6d9122011-11-04 13:24:29 -0400474 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100475 buf = next;
476 }
477 l_ptr->first_out = NULL;
478 l_ptr->out_queue_size = 0;
479}
480
481/**
Per Liden4323add2006-01-18 00:38:21 +0100482 * tipc_link_reset_fragments - purge link's inbound message fragments queue
Per Lidenb97bf3f2006-01-02 19:04:38 +0100483 * @l_ptr: pointer to link
484 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500485void tipc_link_reset_fragments(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100486{
487 struct sk_buff *buf = l_ptr->defragm_buf;
488 struct sk_buff *next;
489
490 while (buf) {
491 next = buf->next;
Allan Stephens5f6d9122011-11-04 13:24:29 -0400492 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100493 buf = next;
494 }
495 l_ptr->defragm_buf = NULL;
496}
497
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900498/**
Per Liden4323add2006-01-18 00:38:21 +0100499 * tipc_link_stop - purge all inbound and outbound messages associated with link
Per Lidenb97bf3f2006-01-02 19:04:38 +0100500 * @l_ptr: pointer to link
501 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500502void tipc_link_stop(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100503{
504 struct sk_buff *buf;
505 struct sk_buff *next;
506
507 buf = l_ptr->oldest_deferred_in;
508 while (buf) {
509 next = buf->next;
Allan Stephens5f6d9122011-11-04 13:24:29 -0400510 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100511 buf = next;
512 }
513
514 buf = l_ptr->first_out;
515 while (buf) {
516 next = buf->next;
Allan Stephens5f6d9122011-11-04 13:24:29 -0400517 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100518 buf = next;
519 }
520
Per Liden4323add2006-01-18 00:38:21 +0100521 tipc_link_reset_fragments(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100522
Allan Stephens5f6d9122011-11-04 13:24:29 -0400523 kfree_skb(l_ptr->proto_msg_queue);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100524 l_ptr->proto_msg_queue = NULL;
525}
526
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500527void tipc_link_reset(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100528{
529 struct sk_buff *buf;
530 u32 prev_state = l_ptr->state;
531 u32 checkpoint = l_ptr->next_in_no;
Allan Stephens5392d642006-06-25 23:52:50 -0700532 int was_active_link = tipc_link_is_active(l_ptr);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900533
Allan Stephensa686e682008-06-04 17:29:39 -0700534 msg_set_session(l_ptr->pmsg, ((msg_session(l_ptr->pmsg) + 1) & 0xffff));
Per Lidenb97bf3f2006-01-02 19:04:38 +0100535
Allan Stephensa686e682008-06-04 17:29:39 -0700536 /* Link is down, accept any session */
537 l_ptr->peer_session = INVALID_SESSION;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100538
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900539 /* Prepare for max packet size negotiation */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100540 link_init_max_pkt(l_ptr);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900541
Per Lidenb97bf3f2006-01-02 19:04:38 +0100542 l_ptr->state = RESET_UNKNOWN;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100543
544 if ((prev_state == RESET_UNKNOWN) || (prev_state == RESET_RESET))
545 return;
546
Per Liden4323add2006-01-18 00:38:21 +0100547 tipc_node_link_down(l_ptr->owner, l_ptr);
548 tipc_bearer_remove_dest(l_ptr->b_ptr, l_ptr->addr);
Paul Gortmaker7368ddf2010-10-12 14:25:58 +0000549
Paul Gortmaker8f19afb2011-02-28 11:36:21 -0400550 if (was_active_link && tipc_node_active_links(l_ptr->owner) &&
Per Lidenb97bf3f2006-01-02 19:04:38 +0100551 l_ptr->owner->permit_changeover) {
552 l_ptr->reset_checkpoint = checkpoint;
553 l_ptr->exp_msg_count = START_CHANGEOVER;
554 }
555
556 /* Clean up all queues: */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100557 link_release_outqueue(l_ptr);
Allan Stephens5f6d9122011-11-04 13:24:29 -0400558 kfree_skb(l_ptr->proto_msg_queue);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100559 l_ptr->proto_msg_queue = NULL;
560 buf = l_ptr->oldest_deferred_in;
561 while (buf) {
562 struct sk_buff *next = buf->next;
Allan Stephens5f6d9122011-11-04 13:24:29 -0400563 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100564 buf = next;
565 }
566 if (!list_empty(&l_ptr->waiting_ports))
Per Liden4323add2006-01-18 00:38:21 +0100567 tipc_link_wakeup_ports(l_ptr, 1);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100568
569 l_ptr->retransm_queue_head = 0;
570 l_ptr->retransm_queue_size = 0;
571 l_ptr->last_out = NULL;
572 l_ptr->first_out = NULL;
573 l_ptr->next_out = NULL;
574 l_ptr->unacked_window = 0;
575 l_ptr->checkpoint = 1;
576 l_ptr->next_out_no = 1;
577 l_ptr->deferred_inqueue_sz = 0;
578 l_ptr->oldest_deferred_in = NULL;
579 l_ptr->newest_deferred_in = NULL;
580 l_ptr->fsm_msg_cnt = 0;
581 l_ptr->stale_count = 0;
582 link_reset_statistics(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100583}
584
585
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500586static void link_activate(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100587{
Allan Stephens5392d642006-06-25 23:52:50 -0700588 l_ptr->next_in_no = l_ptr->stats.recv_info = 1;
Per Liden4323add2006-01-18 00:38:21 +0100589 tipc_node_link_up(l_ptr->owner, l_ptr);
590 tipc_bearer_add_dest(l_ptr->b_ptr, l_ptr->addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100591}
592
593/**
594 * link_state_event - link finite state machine
595 * @l_ptr: pointer to link
596 * @event: state machine event to process
597 */
Eric Dumazet95c96172012-04-15 05:58:06 +0000598static void link_state_event(struct tipc_link *l_ptr, unsigned int event)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100599{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500600 struct tipc_link *other;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100601 u32 cont_intv = l_ptr->continuity_interval;
602
603 if (!l_ptr->started && (event != STARTING_EVT))
604 return; /* Not yet. */
605
606 if (link_blocked(l_ptr)) {
Allan Stephensa0168922010-12-31 18:59:35 +0000607 if (event == TIMEOUT_EVT)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100608 link_set_timer(l_ptr, cont_intv);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100609 return; /* Changeover going on */
610 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100611
612 switch (l_ptr->state) {
613 case WORKING_WORKING:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100614 switch (event) {
615 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100616 case ACTIVATE_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100617 break;
618 case TIMEOUT_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100619 if (l_ptr->next_in_no != l_ptr->checkpoint) {
620 l_ptr->checkpoint = l_ptr->next_in_no;
Per Liden4323add2006-01-18 00:38:21 +0100621 if (tipc_bclink_acks_missing(l_ptr->owner)) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900622 tipc_link_send_proto_msg(l_ptr, STATE_MSG,
Per Liden4323add2006-01-18 00:38:21 +0100623 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100624 l_ptr->fsm_msg_cnt++;
625 } else if (l_ptr->max_pkt < l_ptr->max_pkt_target) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900626 tipc_link_send_proto_msg(l_ptr, STATE_MSG,
Per Liden4323add2006-01-18 00:38:21 +0100627 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100628 l_ptr->fsm_msg_cnt++;
629 }
630 link_set_timer(l_ptr, cont_intv);
631 break;
632 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100633 l_ptr->state = WORKING_UNKNOWN;
634 l_ptr->fsm_msg_cnt = 0;
Per Liden4323add2006-01-18 00:38:21 +0100635 tipc_link_send_proto_msg(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100636 l_ptr->fsm_msg_cnt++;
637 link_set_timer(l_ptr, cont_intv / 4);
638 break;
639 case RESET_MSG:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400640 pr_info("%s<%s>, requested by peer\n", link_rst_msg,
641 l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100642 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100643 l_ptr->state = RESET_RESET;
644 l_ptr->fsm_msg_cnt = 0;
Per Liden4323add2006-01-18 00:38:21 +0100645 tipc_link_send_proto_msg(l_ptr, ACTIVATE_MSG, 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100646 l_ptr->fsm_msg_cnt++;
647 link_set_timer(l_ptr, cont_intv);
648 break;
649 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400650 pr_err("%s%u in WW state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100651 }
652 break;
653 case WORKING_UNKNOWN:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100654 switch (event) {
655 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100656 case ACTIVATE_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100657 l_ptr->state = WORKING_WORKING;
658 l_ptr->fsm_msg_cnt = 0;
659 link_set_timer(l_ptr, cont_intv);
660 break;
661 case RESET_MSG:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400662 pr_info("%s<%s>, requested by peer while probing\n",
663 link_rst_msg, l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100664 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100665 l_ptr->state = RESET_RESET;
666 l_ptr->fsm_msg_cnt = 0;
Per Liden4323add2006-01-18 00:38:21 +0100667 tipc_link_send_proto_msg(l_ptr, ACTIVATE_MSG, 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100668 l_ptr->fsm_msg_cnt++;
669 link_set_timer(l_ptr, cont_intv);
670 break;
671 case TIMEOUT_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100672 if (l_ptr->next_in_no != l_ptr->checkpoint) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100673 l_ptr->state = WORKING_WORKING;
674 l_ptr->fsm_msg_cnt = 0;
675 l_ptr->checkpoint = l_ptr->next_in_no;
Per Liden4323add2006-01-18 00:38:21 +0100676 if (tipc_bclink_acks_missing(l_ptr->owner)) {
677 tipc_link_send_proto_msg(l_ptr, STATE_MSG,
678 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100679 l_ptr->fsm_msg_cnt++;
680 }
681 link_set_timer(l_ptr, cont_intv);
682 } else if (l_ptr->fsm_msg_cnt < l_ptr->abort_limit) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900683 tipc_link_send_proto_msg(l_ptr, STATE_MSG,
Per Liden4323add2006-01-18 00:38:21 +0100684 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100685 l_ptr->fsm_msg_cnt++;
686 link_set_timer(l_ptr, cont_intv / 4);
687 } else { /* Link has failed */
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400688 pr_warn("%s<%s>, peer not responding\n",
689 link_rst_msg, l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100690 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100691 l_ptr->state = RESET_UNKNOWN;
692 l_ptr->fsm_msg_cnt = 0;
Per Liden4323add2006-01-18 00:38:21 +0100693 tipc_link_send_proto_msg(l_ptr, RESET_MSG,
694 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100695 l_ptr->fsm_msg_cnt++;
696 link_set_timer(l_ptr, cont_intv);
697 }
698 break;
699 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400700 pr_err("%s%u in WU state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100701 }
702 break;
703 case RESET_UNKNOWN:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100704 switch (event) {
705 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100706 break;
707 case ACTIVATE_MSG:
708 other = l_ptr->owner->active_links[0];
Allan Stephens8d64a5b2010-12-31 18:59:27 +0000709 if (other && link_working_unknown(other))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100710 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100711 l_ptr->state = WORKING_WORKING;
712 l_ptr->fsm_msg_cnt = 0;
713 link_activate(l_ptr);
Per Liden4323add2006-01-18 00:38:21 +0100714 tipc_link_send_proto_msg(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100715 l_ptr->fsm_msg_cnt++;
Jon Maloyc64f7a62012-11-16 13:51:31 +0800716 if (l_ptr->owner->working_links == 1)
717 tipc_link_send_sync(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100718 link_set_timer(l_ptr, cont_intv);
719 break;
720 case RESET_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100721 l_ptr->state = RESET_RESET;
722 l_ptr->fsm_msg_cnt = 0;
Per Liden4323add2006-01-18 00:38:21 +0100723 tipc_link_send_proto_msg(l_ptr, ACTIVATE_MSG, 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100724 l_ptr->fsm_msg_cnt++;
725 link_set_timer(l_ptr, cont_intv);
726 break;
727 case STARTING_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100728 l_ptr->started = 1;
729 /* fall through */
730 case TIMEOUT_EVT:
Per Liden4323add2006-01-18 00:38:21 +0100731 tipc_link_send_proto_msg(l_ptr, RESET_MSG, 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100732 l_ptr->fsm_msg_cnt++;
733 link_set_timer(l_ptr, cont_intv);
734 break;
735 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400736 pr_err("%s%u in RU state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100737 }
738 break;
739 case RESET_RESET:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100740 switch (event) {
741 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100742 case ACTIVATE_MSG:
743 other = l_ptr->owner->active_links[0];
Allan Stephens8d64a5b2010-12-31 18:59:27 +0000744 if (other && link_working_unknown(other))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100745 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100746 l_ptr->state = WORKING_WORKING;
747 l_ptr->fsm_msg_cnt = 0;
748 link_activate(l_ptr);
Per Liden4323add2006-01-18 00:38:21 +0100749 tipc_link_send_proto_msg(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100750 l_ptr->fsm_msg_cnt++;
Jon Maloyc64f7a62012-11-16 13:51:31 +0800751 if (l_ptr->owner->working_links == 1)
752 tipc_link_send_sync(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100753 link_set_timer(l_ptr, cont_intv);
754 break;
755 case RESET_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100756 break;
757 case TIMEOUT_EVT:
Per Liden4323add2006-01-18 00:38:21 +0100758 tipc_link_send_proto_msg(l_ptr, ACTIVATE_MSG, 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100759 l_ptr->fsm_msg_cnt++;
760 link_set_timer(l_ptr, cont_intv);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100761 break;
762 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400763 pr_err("%s%u in RR state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100764 }
765 break;
766 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400767 pr_err("Unknown link state %u/%u\n", l_ptr->state, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100768 }
769}
770
771/*
772 * link_bundle_buf(): Append contents of a buffer to
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900773 * the tail of an existing one.
Per Lidenb97bf3f2006-01-02 19:04:38 +0100774 */
Paul Gortmakerae8509c2013-06-17 10:54:47 -0400775static int link_bundle_buf(struct tipc_link *l_ptr, struct sk_buff *bundler,
Per Lidenb97bf3f2006-01-02 19:04:38 +0100776 struct sk_buff *buf)
777{
778 struct tipc_msg *bundler_msg = buf_msg(bundler);
779 struct tipc_msg *msg = buf_msg(buf);
780 u32 size = msg_size(msg);
Allan Stephense49060c2006-06-29 12:32:46 -0700781 u32 bundle_size = msg_size(bundler_msg);
782 u32 to_pos = align(bundle_size);
783 u32 pad = to_pos - bundle_size;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100784
785 if (msg_user(bundler_msg) != MSG_BUNDLER)
786 return 0;
787 if (msg_type(bundler_msg) != OPEN_MSG)
788 return 0;
Allan Stephense49060c2006-06-29 12:32:46 -0700789 if (skb_tailroom(bundler) < (pad + size))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100790 return 0;
Allan Stephens15e979d2010-05-11 14:30:10 +0000791 if (l_ptr->max_pkt < (to_pos + size))
Allan Stephens863fae62006-07-03 19:39:36 -0700792 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100793
Allan Stephense49060c2006-06-29 12:32:46 -0700794 skb_put(bundler, pad + size);
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -0300795 skb_copy_to_linear_data_offset(bundler, to_pos, buf->data, size);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100796 msg_set_size(bundler_msg, to_pos + size);
797 msg_set_msgcnt(bundler_msg, msg_msgcnt(bundler_msg) + 1);
Allan Stephens5f6d9122011-11-04 13:24:29 -0400798 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100799 l_ptr->stats.sent_bundled++;
800 return 1;
801}
802
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500803static void link_add_to_outqueue(struct tipc_link *l_ptr,
Sam Ravnborg05790c62006-03-20 22:37:04 -0800804 struct sk_buff *buf,
805 struct tipc_msg *msg)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100806{
807 u32 ack = mod(l_ptr->next_in_no - 1);
808 u32 seqno = mod(l_ptr->next_out_no++);
809
810 msg_set_word(msg, 2, ((ack << 16) | seqno));
811 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
812 buf->next = NULL;
813 if (l_ptr->first_out) {
814 l_ptr->last_out->next = buf;
815 l_ptr->last_out = buf;
816 } else
817 l_ptr->first_out = l_ptr->last_out = buf;
Allan Stephens9bd80b62011-01-18 15:02:50 -0500818
Per Lidenb97bf3f2006-01-02 19:04:38 +0100819 l_ptr->out_queue_size++;
Allan Stephens9bd80b62011-01-18 15:02:50 -0500820 if (l_ptr->out_queue_size > l_ptr->stats.max_queue_sz)
821 l_ptr->stats.max_queue_sz = l_ptr->out_queue_size;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100822}
823
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500824static void link_add_chain_to_outqueue(struct tipc_link *l_ptr,
Allan Stephensdc63d912011-04-21 11:50:42 -0400825 struct sk_buff *buf_chain,
826 u32 long_msgno)
827{
828 struct sk_buff *buf;
829 struct tipc_msg *msg;
830
831 if (!l_ptr->next_out)
832 l_ptr->next_out = buf_chain;
833 while (buf_chain) {
834 buf = buf_chain;
835 buf_chain = buf_chain->next;
836
837 msg = buf_msg(buf);
838 msg_set_long_msgno(msg, long_msgno);
839 link_add_to_outqueue(l_ptr, buf, msg);
840 }
841}
842
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900843/*
844 * tipc_link_send_buf() is the 'full path' for messages, called from
Per Lidenb97bf3f2006-01-02 19:04:38 +0100845 * inside TIPC when the 'fast path' in tipc_send_buf
846 * has failed, and from link_send()
847 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500848int tipc_link_send_buf(struct tipc_link *l_ptr, struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100849{
850 struct tipc_msg *msg = buf_msg(buf);
851 u32 size = msg_size(msg);
852 u32 dsz = msg_data_sz(msg);
853 u32 queue_size = l_ptr->out_queue_size;
Allan Stephensc68ca7b2010-05-11 14:30:12 +0000854 u32 imp = tipc_msg_tot_importance(msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100855 u32 queue_limit = l_ptr->queue_limit[imp];
Allan Stephens15e979d2010-05-11 14:30:10 +0000856 u32 max_packet = l_ptr->max_pkt;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100857
Per Lidenb97bf3f2006-01-02 19:04:38 +0100858 /* Match msg importance against queue limits: */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100859 if (unlikely(queue_size >= queue_limit)) {
860 if (imp <= TIPC_CRITICAL_IMPORTANCE) {
Allan Stephensbebc55a2011-04-19 10:17:58 -0400861 link_schedule_port(l_ptr, msg_origport(msg), size);
Allan Stephens5f6d9122011-11-04 13:24:29 -0400862 kfree_skb(buf);
Allan Stephensbebc55a2011-04-19 10:17:58 -0400863 return -ELINKCONG;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100864 }
Allan Stephens5f6d9122011-11-04 13:24:29 -0400865 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100866 if (imp > CONN_MANAGER) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400867 pr_warn("%s<%s>, send queue full", link_rst_msg,
868 l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100869 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100870 }
871 return dsz;
872 }
873
874 /* Fragmentation needed ? */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100875 if (size > max_packet)
stephen hemminger31e3c3f2010-10-13 13:20:35 +0000876 return link_send_long_buf(l_ptr, buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100877
Paul Gortmaker617d3c72012-04-30 15:29:02 -0400878 /* Packet can be queued or sent. */
Ying Xue3c294cb2012-11-15 11:34:45 +0800879 if (likely(!tipc_bearer_blocked(l_ptr->b_ptr) &&
Per Lidenb97bf3f2006-01-02 19:04:38 +0100880 !link_congested(l_ptr))) {
881 link_add_to_outqueue(l_ptr, buf, msg);
882
Ying Xue3c294cb2012-11-15 11:34:45 +0800883 tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr);
884 l_ptr->unacked_window = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100885 return dsz;
886 }
Paul Gortmaker617d3c72012-04-30 15:29:02 -0400887 /* Congestion: can message be bundled ? */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100888 if ((msg_user(msg) != CHANGEOVER_PROTOCOL) &&
889 (msg_user(msg) != MSG_FRAGMENTER)) {
890
891 /* Try adding message to an existing bundle */
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900892 if (l_ptr->next_out &&
Ying Xue3c294cb2012-11-15 11:34:45 +0800893 link_bundle_buf(l_ptr, l_ptr->last_out, buf))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100894 return dsz;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100895
896 /* Try creating a new bundle */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100897 if (size <= max_packet * 2 / 3) {
stephen hemminger31e3c3f2010-10-13 13:20:35 +0000898 struct sk_buff *bundler = tipc_buf_acquire(max_packet);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100899 struct tipc_msg bundler_hdr;
900
901 if (bundler) {
Allan Stephensc68ca7b2010-05-11 14:30:12 +0000902 tipc_msg_init(&bundler_hdr, MSG_BUNDLER, OPEN_MSG,
Allan Stephens75715212008-06-04 17:37:34 -0700903 INT_H_SIZE, l_ptr->addr);
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -0300904 skb_copy_to_linear_data(bundler, &bundler_hdr,
905 INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100906 skb_trim(bundler, INT_H_SIZE);
907 link_bundle_buf(l_ptr, bundler, buf);
908 buf = bundler;
909 msg = buf_msg(buf);
910 l_ptr->stats.sent_bundles++;
911 }
912 }
913 }
914 if (!l_ptr->next_out)
915 l_ptr->next_out = buf;
916 link_add_to_outqueue(l_ptr, buf, msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100917 return dsz;
918}
919
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900920/*
921 * tipc_link_send(): same as tipc_link_send_buf(), but the link to use has
Per Lidenb97bf3f2006-01-02 19:04:38 +0100922 * not been selected yet, and the the owner node is not locked
923 * Called by TIPC internal users, e.g. the name distributor
924 */
Per Liden4323add2006-01-18 00:38:21 +0100925int tipc_link_send(struct sk_buff *buf, u32 dest, u32 selector)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100926{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500927 struct tipc_link *l_ptr;
David S. Miller6c000552008-09-02 23:38:32 -0700928 struct tipc_node *n_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100929 int res = -ELINKCONG;
930
Per Liden4323add2006-01-18 00:38:21 +0100931 read_lock_bh(&tipc_net_lock);
Allan Stephens51a8e4d2010-12-31 18:59:18 +0000932 n_ptr = tipc_node_find(dest);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100933 if (n_ptr) {
Per Liden4323add2006-01-18 00:38:21 +0100934 tipc_node_lock(n_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100935 l_ptr = n_ptr->active_links[selector & 1];
Allan Stephensa0168922010-12-31 18:59:35 +0000936 if (l_ptr)
Per Liden4323add2006-01-18 00:38:21 +0100937 res = tipc_link_send_buf(l_ptr, buf);
Allan Stephensa0168922010-12-31 18:59:35 +0000938 else
Allan Stephens5f6d9122011-11-04 13:24:29 -0400939 kfree_skb(buf);
Per Liden4323add2006-01-18 00:38:21 +0100940 tipc_node_unlock(n_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100941 } else {
Allan Stephens5f6d9122011-11-04 13:24:29 -0400942 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100943 }
Per Liden4323add2006-01-18 00:38:21 +0100944 read_unlock_bh(&tipc_net_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100945 return res;
946}
947
Jon Maloyc64f7a62012-11-16 13:51:31 +0800948/*
949 * tipc_link_send_sync - synchronize broadcast link endpoints.
950 *
951 * Give a newly added peer node the sequence number where it should
952 * start receiving and acking broadcast packets.
953 *
954 * Called with node locked
955 */
956static void tipc_link_send_sync(struct tipc_link *l)
957{
958 struct sk_buff *buf;
959 struct tipc_msg *msg;
960
961 buf = tipc_buf_acquire(INT_H_SIZE);
962 if (!buf)
963 return;
964
965 msg = buf_msg(buf);
966 tipc_msg_init(msg, BCAST_PROTOCOL, STATE_MSG, INT_H_SIZE, l->addr);
967 msg_set_last_bcast(msg, l->owner->bclink.acked);
968 link_add_chain_to_outqueue(l, buf, 0);
969 tipc_link_push_queue(l);
970}
971
972/*
973 * tipc_link_recv_sync - synchronize broadcast link endpoints.
974 * Receive the sequence number where we should start receiving and
975 * acking broadcast packets from a newly added peer node, and open
976 * up for reception of such packets.
977 *
978 * Called with node locked
979 */
980static void tipc_link_recv_sync(struct tipc_node *n, struct sk_buff *buf)
981{
982 struct tipc_msg *msg = buf_msg(buf);
983
984 n->bclink.last_sent = n->bclink.last_in = msg_last_bcast(msg);
985 n->bclink.recv_permitted = true;
986 kfree_skb(buf);
987}
988
989/*
Allan Stephens9aa88c22011-05-31 13:38:02 -0400990 * tipc_link_send_names - send name table entries to new neighbor
991 *
992 * Send routine for bulk delivery of name table messages when contact
993 * with a new neighbor occurs. No link congestion checking is performed
994 * because name table messages *must* be delivered. The messages must be
995 * small enough not to require fragmentation.
996 * Called without any locks held.
997 */
Allan Stephens9aa88c22011-05-31 13:38:02 -0400998void tipc_link_send_names(struct list_head *message_list, u32 dest)
999{
1000 struct tipc_node *n_ptr;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001001 struct tipc_link *l_ptr;
Allan Stephens9aa88c22011-05-31 13:38:02 -04001002 struct sk_buff *buf;
1003 struct sk_buff *temp_buf;
1004
1005 if (list_empty(message_list))
1006 return;
1007
1008 read_lock_bh(&tipc_net_lock);
1009 n_ptr = tipc_node_find(dest);
1010 if (n_ptr) {
1011 tipc_node_lock(n_ptr);
1012 l_ptr = n_ptr->active_links[0];
1013 if (l_ptr) {
1014 /* convert circular list to linear list */
1015 ((struct sk_buff *)message_list->prev)->next = NULL;
1016 link_add_chain_to_outqueue(l_ptr,
1017 (struct sk_buff *)message_list->next, 0);
1018 tipc_link_push_queue(l_ptr);
1019 INIT_LIST_HEAD(message_list);
1020 }
1021 tipc_node_unlock(n_ptr);
1022 }
1023 read_unlock_bh(&tipc_net_lock);
1024
1025 /* discard the messages if they couldn't be sent */
Allan Stephens9aa88c22011-05-31 13:38:02 -04001026 list_for_each_safe(buf, temp_buf, ((struct sk_buff *)message_list)) {
1027 list_del((struct list_head *)buf);
Allan Stephens5f6d9122011-11-04 13:24:29 -04001028 kfree_skb(buf);
Allan Stephens9aa88c22011-05-31 13:38:02 -04001029 }
1030}
1031
1032/*
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001033 * link_send_buf_fast: Entry for data messages where the
Per Lidenb97bf3f2006-01-02 19:04:38 +01001034 * destination link is known and the header is complete,
1035 * inclusive total message length. Very time critical.
1036 * Link is locked. Returns user data length.
1037 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001038static int link_send_buf_fast(struct tipc_link *l_ptr, struct sk_buff *buf,
Sam Ravnborg05790c62006-03-20 22:37:04 -08001039 u32 *used_max_pkt)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001040{
1041 struct tipc_msg *msg = buf_msg(buf);
1042 int res = msg_data_sz(msg);
1043
1044 if (likely(!link_congested(l_ptr))) {
Allan Stephens15e979d2010-05-11 14:30:10 +00001045 if (likely(msg_size(msg) <= l_ptr->max_pkt)) {
Ying Xue3c294cb2012-11-15 11:34:45 +08001046 if (likely(!tipc_bearer_blocked(l_ptr->b_ptr))) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001047 link_add_to_outqueue(l_ptr, buf, msg);
Ying Xue3c294cb2012-11-15 11:34:45 +08001048 tipc_bearer_send(l_ptr->b_ptr, buf,
1049 &l_ptr->media_addr);
1050 l_ptr->unacked_window = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001051 return res;
1052 }
Allan Stephens0e659672010-12-31 18:59:32 +00001053 } else
Allan Stephens15e979d2010-05-11 14:30:10 +00001054 *used_max_pkt = l_ptr->max_pkt;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001055 }
Per Liden4323add2006-01-18 00:38:21 +01001056 return tipc_link_send_buf(l_ptr, buf); /* All other cases */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001057}
1058
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001059/*
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001060 * tipc_link_send_sections_fast: Entry for messages where the
Per Lidenb97bf3f2006-01-02 19:04:38 +01001061 * destination processor is known and the header is complete,
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001062 * except for total message length.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001063 * Returns user data length or errno.
1064 */
Allan Stephens23dd4cc2011-01-07 11:43:40 -05001065int tipc_link_send_sections_fast(struct tipc_port *sender,
Per Liden4323add2006-01-18 00:38:21 +01001066 struct iovec const *msg_sect,
Ying Xue9446b872013-10-18 07:23:15 +02001067 unsigned int len, u32 destaddr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001068{
Allan Stephens23dd4cc2011-01-07 11:43:40 -05001069 struct tipc_msg *hdr = &sender->phdr;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001070 struct tipc_link *l_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001071 struct sk_buff *buf;
David S. Miller6c000552008-09-02 23:38:32 -07001072 struct tipc_node *node;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001073 int res;
1074 u32 selector = msg_origport(hdr) & 1;
1075
Per Lidenb97bf3f2006-01-02 19:04:38 +01001076again:
1077 /*
1078 * Try building message using port's max_pkt hint.
1079 * (Must not hold any locks while building message.)
1080 */
Ying Xue9446b872013-10-18 07:23:15 +02001081 res = tipc_msg_build(hdr, msg_sect, len, sender->max_pkt, &buf);
Ying Xue7410f962013-06-17 10:54:49 -04001082 /* Exit if build request was invalid */
1083 if (unlikely(res < 0))
1084 return res;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001085
Per Liden4323add2006-01-18 00:38:21 +01001086 read_lock_bh(&tipc_net_lock);
Allan Stephens51a8e4d2010-12-31 18:59:18 +00001087 node = tipc_node_find(destaddr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001088 if (likely(node)) {
Per Liden4323add2006-01-18 00:38:21 +01001089 tipc_node_lock(node);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001090 l_ptr = node->active_links[selector];
1091 if (likely(l_ptr)) {
1092 if (likely(buf)) {
1093 res = link_send_buf_fast(l_ptr, buf,
Allan Stephens23dd4cc2011-01-07 11:43:40 -05001094 &sender->max_pkt);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001095exit:
Per Liden4323add2006-01-18 00:38:21 +01001096 tipc_node_unlock(node);
1097 read_unlock_bh(&tipc_net_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001098 return res;
1099 }
1100
Per Lidenb97bf3f2006-01-02 19:04:38 +01001101 /* Exit if link (or bearer) is congested */
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001102 if (link_congested(l_ptr) ||
Ying Xue3c294cb2012-11-15 11:34:45 +08001103 tipc_bearer_blocked(l_ptr->b_ptr)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001104 res = link_schedule_port(l_ptr,
Allan Stephens23dd4cc2011-01-07 11:43:40 -05001105 sender->ref, res);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001106 goto exit;
1107 }
1108
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001109 /*
Per Lidenb97bf3f2006-01-02 19:04:38 +01001110 * Message size exceeds max_pkt hint; update hint,
1111 * then re-try fast path or fragment the message
1112 */
Allan Stephens23dd4cc2011-01-07 11:43:40 -05001113 sender->max_pkt = l_ptr->max_pkt;
Per Liden4323add2006-01-18 00:38:21 +01001114 tipc_node_unlock(node);
1115 read_unlock_bh(&tipc_net_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001116
1117
Allan Stephens23dd4cc2011-01-07 11:43:40 -05001118 if ((msg_hdr_sz(hdr) + res) <= sender->max_pkt)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001119 goto again;
1120
Ying Xue9446b872013-10-18 07:23:15 +02001121 return link_send_sections_long(sender, msg_sect, len,
Allan Stephens26896902011-04-21 10:42:07 -05001122 destaddr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001123 }
Per Liden4323add2006-01-18 00:38:21 +01001124 tipc_node_unlock(node);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001125 }
Per Liden4323add2006-01-18 00:38:21 +01001126 read_unlock_bh(&tipc_net_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001127
1128 /* Couldn't find a link to the destination node */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001129 if (buf)
1130 return tipc_reject_msg(buf, TIPC_ERR_NO_NODE);
1131 if (res >= 0)
Ying Xue9446b872013-10-18 07:23:15 +02001132 return tipc_port_reject_sections(sender, hdr, msg_sect,
1133 len, TIPC_ERR_NO_NODE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001134 return res;
1135}
1136
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001137/*
1138 * link_send_sections_long(): Entry for long messages where the
Per Lidenb97bf3f2006-01-02 19:04:38 +01001139 * destination node is known and the header is complete,
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001140 * inclusive total message length.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001141 * Link and bearer congestion status have been checked to be ok,
1142 * and are ignored if they change.
1143 *
1144 * Note that fragments do not use the full link MTU so that they won't have
1145 * to undergo refragmentation if link changeover causes them to be sent
1146 * over another link with an additional tunnel header added as prefix.
1147 * (Refragmentation will still occur if the other link has a smaller MTU.)
1148 *
1149 * Returns user data length or errno.
1150 */
Allan Stephens23dd4cc2011-01-07 11:43:40 -05001151static int link_send_sections_long(struct tipc_port *sender,
Per Lidenb97bf3f2006-01-02 19:04:38 +01001152 struct iovec const *msg_sect,
Ying Xue9446b872013-10-18 07:23:15 +02001153 unsigned int len, u32 destaddr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001154{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001155 struct tipc_link *l_ptr;
David S. Miller6c000552008-09-02 23:38:32 -07001156 struct tipc_node *node;
Allan Stephens23dd4cc2011-01-07 11:43:40 -05001157 struct tipc_msg *hdr = &sender->phdr;
Ying Xue9446b872013-10-18 07:23:15 +02001158 u32 dsz = len;
Allan Stephens0e659672010-12-31 18:59:32 +00001159 u32 max_pkt, fragm_sz, rest;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001160 struct tipc_msg fragm_hdr;
Allan Stephens0e659672010-12-31 18:59:32 +00001161 struct sk_buff *buf, *buf_chain, *prev;
1162 u32 fragm_crs, fragm_rest, hsz, sect_rest;
Ying Xue40682432013-10-18 07:23:16 +02001163 const unchar __user *sect_crs;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001164 int curr_sect;
1165 u32 fragm_no;
Ying Xue126c0522013-06-17 10:54:50 -04001166 int res = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001167
1168again:
1169 fragm_no = 1;
Allan Stephens23dd4cc2011-01-07 11:43:40 -05001170 max_pkt = sender->max_pkt - INT_H_SIZE;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001171 /* leave room for tunnel header in case of link changeover */
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001172 fragm_sz = max_pkt - INT_H_SIZE;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001173 /* leave room for fragmentation header in each fragment */
1174 rest = dsz;
1175 fragm_crs = 0;
1176 fragm_rest = 0;
1177 sect_rest = 0;
Sam Ravnborg1fc54d82006-03-20 22:36:47 -08001178 sect_crs = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001179 curr_sect = -1;
1180
Paul Gortmaker617d3c72012-04-30 15:29:02 -04001181 /* Prepare reusable fragment header */
Allan Stephensc68ca7b2010-05-11 14:30:12 +00001182 tipc_msg_init(&fragm_hdr, MSG_FRAGMENTER, FIRST_FRAGMENT,
Allan Stephens75715212008-06-04 17:37:34 -07001183 INT_H_SIZE, msg_destnode(hdr));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001184 msg_set_size(&fragm_hdr, max_pkt);
1185 msg_set_fragm_no(&fragm_hdr, 1);
1186
Paul Gortmaker617d3c72012-04-30 15:29:02 -04001187 /* Prepare header of first fragment */
stephen hemminger31e3c3f2010-10-13 13:20:35 +00001188 buf_chain = buf = tipc_buf_acquire(max_pkt);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001189 if (!buf)
1190 return -ENOMEM;
1191 buf->next = NULL;
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03001192 skb_copy_to_linear_data(buf, &fragm_hdr, INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001193 hsz = msg_hdr_sz(hdr);
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03001194 skb_copy_to_linear_data_offset(buf, INT_H_SIZE, hdr, hsz);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001195
Paul Gortmaker617d3c72012-04-30 15:29:02 -04001196 /* Chop up message */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001197 fragm_crs = INT_H_SIZE + hsz;
1198 fragm_rest = fragm_sz - hsz;
1199
1200 do { /* For all sections */
1201 u32 sz;
1202
1203 if (!sect_rest) {
1204 sect_rest = msg_sect[++curr_sect].iov_len;
Ying Xue40682432013-10-18 07:23:16 +02001205 sect_crs = msg_sect[curr_sect].iov_base;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001206 }
1207
1208 if (sect_rest < fragm_rest)
1209 sz = sect_rest;
1210 else
1211 sz = fragm_rest;
1212
Ying Xuef1733d72013-06-17 10:54:43 -04001213 if (copy_from_user(buf->data + fragm_crs, sect_crs, sz)) {
Ying Xue126c0522013-06-17 10:54:50 -04001214 res = -EFAULT;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001215error:
Ying Xuef1733d72013-06-17 10:54:43 -04001216 for (; buf_chain; buf_chain = buf) {
1217 buf = buf_chain->next;
1218 kfree_skb(buf_chain);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001219 }
Ying Xue126c0522013-06-17 10:54:50 -04001220 return res;
Ying Xuef1733d72013-06-17 10:54:43 -04001221 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001222 sect_crs += sz;
1223 sect_rest -= sz;
1224 fragm_crs += sz;
1225 fragm_rest -= sz;
1226 rest -= sz;
1227
1228 if (!fragm_rest && rest) {
1229
1230 /* Initiate new fragment: */
1231 if (rest <= fragm_sz) {
1232 fragm_sz = rest;
Allan Stephens0e659672010-12-31 18:59:32 +00001233 msg_set_type(&fragm_hdr, LAST_FRAGMENT);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001234 } else {
1235 msg_set_type(&fragm_hdr, FRAGMENT);
1236 }
1237 msg_set_size(&fragm_hdr, fragm_sz + INT_H_SIZE);
1238 msg_set_fragm_no(&fragm_hdr, ++fragm_no);
1239 prev = buf;
stephen hemminger31e3c3f2010-10-13 13:20:35 +00001240 buf = tipc_buf_acquire(fragm_sz + INT_H_SIZE);
Ying Xue126c0522013-06-17 10:54:50 -04001241 if (!buf) {
1242 res = -ENOMEM;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001243 goto error;
Ying Xue126c0522013-06-17 10:54:50 -04001244 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001245
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001246 buf->next = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001247 prev->next = buf;
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03001248 skb_copy_to_linear_data(buf, &fragm_hdr, INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001249 fragm_crs = INT_H_SIZE;
1250 fragm_rest = fragm_sz;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001251 }
Allan Stephens0e659672010-12-31 18:59:32 +00001252 } while (rest > 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001253
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001254 /*
Per Lidenb97bf3f2006-01-02 19:04:38 +01001255 * Now we have a buffer chain. Select a link and check
1256 * that packet size is still OK
1257 */
Allan Stephens51a8e4d2010-12-31 18:59:18 +00001258 node = tipc_node_find(destaddr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001259 if (likely(node)) {
Per Liden4323add2006-01-18 00:38:21 +01001260 tipc_node_lock(node);
Allan Stephens23dd4cc2011-01-07 11:43:40 -05001261 l_ptr = node->active_links[sender->ref & 1];
Per Lidenb97bf3f2006-01-02 19:04:38 +01001262 if (!l_ptr) {
Per Liden4323add2006-01-18 00:38:21 +01001263 tipc_node_unlock(node);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001264 goto reject;
1265 }
Allan Stephens15e979d2010-05-11 14:30:10 +00001266 if (l_ptr->max_pkt < max_pkt) {
Allan Stephens23dd4cc2011-01-07 11:43:40 -05001267 sender->max_pkt = l_ptr->max_pkt;
Per Liden4323add2006-01-18 00:38:21 +01001268 tipc_node_unlock(node);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001269 for (; buf_chain; buf_chain = buf) {
1270 buf = buf_chain->next;
Allan Stephens5f6d9122011-11-04 13:24:29 -04001271 kfree_skb(buf_chain);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001272 }
1273 goto again;
1274 }
1275 } else {
1276reject:
1277 for (; buf_chain; buf_chain = buf) {
1278 buf = buf_chain->next;
Allan Stephens5f6d9122011-11-04 13:24:29 -04001279 kfree_skb(buf_chain);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001280 }
Ying Xue9446b872013-10-18 07:23:15 +02001281 return tipc_port_reject_sections(sender, hdr, msg_sect,
1282 len, TIPC_ERR_NO_NODE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001283 }
1284
Allan Stephensdc63d912011-04-21 11:50:42 -04001285 /* Append chain of fragments to send queue & send them */
Allan Stephense0f08592011-04-17 11:44:24 -04001286 l_ptr->long_msg_seq_no++;
Allan Stephensdc63d912011-04-21 11:50:42 -04001287 link_add_chain_to_outqueue(l_ptr, buf_chain, l_ptr->long_msg_seq_no);
1288 l_ptr->stats.sent_fragments += fragm_no;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001289 l_ptr->stats.sent_fragmented++;
Per Liden4323add2006-01-18 00:38:21 +01001290 tipc_link_push_queue(l_ptr);
1291 tipc_node_unlock(node);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001292 return dsz;
1293}
1294
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001295/*
Per Liden4323add2006-01-18 00:38:21 +01001296 * tipc_link_push_packet: Push one unsent packet to the media
Per Lidenb97bf3f2006-01-02 19:04:38 +01001297 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001298u32 tipc_link_push_packet(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001299{
1300 struct sk_buff *buf = l_ptr->first_out;
1301 u32 r_q_size = l_ptr->retransm_queue_size;
1302 u32 r_q_head = l_ptr->retransm_queue_head;
1303
1304 /* Step to position where retransmission failed, if any, */
1305 /* consider that buffers may have been released in meantime */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001306 if (r_q_size && buf) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001307 u32 last = lesser(mod(r_q_head + r_q_size),
Per Lidenb97bf3f2006-01-02 19:04:38 +01001308 link_last_sent(l_ptr));
Allan Stephensf9057302011-10-24 16:03:12 -04001309 u32 first = buf_seqno(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001310
1311 while (buf && less(first, r_q_head)) {
1312 first = mod(first + 1);
1313 buf = buf->next;
1314 }
1315 l_ptr->retransm_queue_head = r_q_head = first;
1316 l_ptr->retransm_queue_size = r_q_size = mod(last - first);
1317 }
1318
1319 /* Continue retransmission now, if there is anything: */
Neil Hormanca509102010-03-15 07:58:45 +00001320 if (r_q_size && buf) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001321 msg_set_ack(buf_msg(buf), mod(l_ptr->next_in_no - 1));
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001322 msg_set_bcast_ack(buf_msg(buf), l_ptr->owner->bclink.last_in);
Ying Xue3c294cb2012-11-15 11:34:45 +08001323 tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr);
1324 l_ptr->retransm_queue_head = mod(++r_q_head);
1325 l_ptr->retransm_queue_size = --r_q_size;
1326 l_ptr->stats.retransmitted++;
1327 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001328 }
1329
1330 /* Send deferred protocol message, if any: */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001331 buf = l_ptr->proto_msg_queue;
1332 if (buf) {
1333 msg_set_ack(buf_msg(buf), mod(l_ptr->next_in_no - 1));
Allan Stephens0e659672010-12-31 18:59:32 +00001334 msg_set_bcast_ack(buf_msg(buf), l_ptr->owner->bclink.last_in);
Ying Xue3c294cb2012-11-15 11:34:45 +08001335 tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr);
1336 l_ptr->unacked_window = 0;
1337 kfree_skb(buf);
1338 l_ptr->proto_msg_queue = NULL;
1339 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001340 }
1341
1342 /* Send one deferred data message, if send window not full: */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001343 buf = l_ptr->next_out;
1344 if (buf) {
1345 struct tipc_msg *msg = buf_msg(buf);
1346 u32 next = msg_seqno(msg);
Allan Stephensf9057302011-10-24 16:03:12 -04001347 u32 first = buf_seqno(l_ptr->first_out);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001348
1349 if (mod(next - first) < l_ptr->queue_limit[0]) {
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 if (msg_user(msg) == MSG_BUNDLER)
1354 msg_set_type(msg, CLOSED_MSG);
1355 l_ptr->next_out = buf->next;
1356 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001357 }
1358 }
Ying Xue3c294cb2012-11-15 11:34:45 +08001359 return 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001360}
1361
1362/*
1363 * push_queue(): push out the unsent messages of a link where
1364 * congestion has abated. Node is locked
1365 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001366void tipc_link_push_queue(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001367{
1368 u32 res;
1369
Ying Xue3c294cb2012-11-15 11:34:45 +08001370 if (tipc_bearer_blocked(l_ptr->b_ptr))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001371 return;
1372
1373 do {
Per Liden4323add2006-01-18 00:38:21 +01001374 res = tipc_link_push_packet(l_ptr);
Allan Stephens0e35fd52008-07-14 22:44:01 -07001375 } while (!res);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001376}
1377
Allan Stephensd356eeb2006-06-25 23:40:01 -07001378static void link_reset_all(unsigned long addr)
1379{
David S. Miller6c000552008-09-02 23:38:32 -07001380 struct tipc_node *n_ptr;
Allan Stephensd356eeb2006-06-25 23:40:01 -07001381 char addr_string[16];
1382 u32 i;
1383
1384 read_lock_bh(&tipc_net_lock);
1385 n_ptr = tipc_node_find((u32)addr);
1386 if (!n_ptr) {
1387 read_unlock_bh(&tipc_net_lock);
1388 return; /* node no longer exists */
1389 }
1390
1391 tipc_node_lock(n_ptr);
1392
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001393 pr_warn("Resetting all links to %s\n",
1394 tipc_addr_string_fill(addr_string, n_ptr->addr));
Allan Stephensd356eeb2006-06-25 23:40:01 -07001395
1396 for (i = 0; i < MAX_BEARERS; i++) {
1397 if (n_ptr->links[i]) {
Allan Stephens8d64a5b2010-12-31 18:59:27 +00001398 link_print(n_ptr->links[i], "Resetting link\n");
Allan Stephensd356eeb2006-06-25 23:40:01 -07001399 tipc_link_reset(n_ptr->links[i]);
1400 }
1401 }
1402
1403 tipc_node_unlock(n_ptr);
1404 read_unlock_bh(&tipc_net_lock);
1405}
1406
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001407static void link_retransmit_failure(struct tipc_link *l_ptr,
Paul Gortmakerae8509c2013-06-17 10:54:47 -04001408 struct sk_buff *buf)
Allan Stephensd356eeb2006-06-25 23:40:01 -07001409{
1410 struct tipc_msg *msg = buf_msg(buf);
1411
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001412 pr_warn("Retransmission failure on link <%s>\n", l_ptr->name);
Allan Stephensd356eeb2006-06-25 23:40:01 -07001413
1414 if (l_ptr->addr) {
Allan Stephensd356eeb2006-06-25 23:40:01 -07001415 /* Handle failure on standard link */
Allan Stephens8d64a5b2010-12-31 18:59:27 +00001416 link_print(l_ptr, "Resetting link\n");
Allan Stephensd356eeb2006-06-25 23:40:01 -07001417 tipc_link_reset(l_ptr);
1418
1419 } else {
Allan Stephensd356eeb2006-06-25 23:40:01 -07001420 /* Handle failure on broadcast link */
David S. Miller6c000552008-09-02 23:38:32 -07001421 struct tipc_node *n_ptr;
Allan Stephensd356eeb2006-06-25 23:40:01 -07001422 char addr_string[16];
1423
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001424 pr_info("Msg seq number: %u, ", msg_seqno(msg));
1425 pr_cont("Outstanding acks: %lu\n",
1426 (unsigned long) TIPC_SKB_CB(buf)->handle);
Jeff Garzik617dbea2006-10-03 16:25:34 -07001427
Allan Stephens01d83ed2011-01-18 13:53:16 -05001428 n_ptr = tipc_bclink_retransmit_to();
Allan Stephensd356eeb2006-06-25 23:40:01 -07001429 tipc_node_lock(n_ptr);
1430
Allan Stephensc68ca7b2010-05-11 14:30:12 +00001431 tipc_addr_string_fill(addr_string, n_ptr->addr);
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001432 pr_info("Broadcast link info for %s\n", addr_string);
Ying Xue389dd9b2012-11-16 13:51:30 +08001433 pr_info("Reception permitted: %d, Acked: %u\n",
1434 n_ptr->bclink.recv_permitted,
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001435 n_ptr->bclink.acked);
1436 pr_info("Last in: %u, Oos state: %u, Last sent: %u\n",
1437 n_ptr->bclink.last_in,
1438 n_ptr->bclink.oos_state,
1439 n_ptr->bclink.last_sent);
Allan Stephensd356eeb2006-06-25 23:40:01 -07001440
1441 tipc_k_signal((Handler)link_reset_all, (unsigned long)n_ptr->addr);
1442
1443 tipc_node_unlock(n_ptr);
1444
1445 l_ptr->stale_count = 0;
1446 }
1447}
1448
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001449void tipc_link_retransmit(struct tipc_link *l_ptr, struct sk_buff *buf,
Per Liden4323add2006-01-18 00:38:21 +01001450 u32 retransmits)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001451{
1452 struct tipc_msg *msg;
1453
Allan Stephensd356eeb2006-06-25 23:40:01 -07001454 if (!buf)
1455 return;
1456
1457 msg = buf_msg(buf);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001458
Ying Xue3c294cb2012-11-15 11:34:45 +08001459 if (tipc_bearer_blocked(l_ptr->b_ptr)) {
Neil Hormanca509102010-03-15 07:58:45 +00001460 if (l_ptr->retransm_queue_size == 0) {
Allan Stephensd356eeb2006-06-25 23:40:01 -07001461 l_ptr->retransm_queue_head = msg_seqno(msg);
1462 l_ptr->retransm_queue_size = retransmits;
Allan Stephensd356eeb2006-06-25 23:40:01 -07001463 } else {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001464 pr_err("Unexpected retransmit on link %s (qsize=%d)\n",
1465 l_ptr->name, l_ptr->retransm_queue_size);
Allan Stephensd356eeb2006-06-25 23:40:01 -07001466 }
Neil Hormanca509102010-03-15 07:58:45 +00001467 return;
Allan Stephensd356eeb2006-06-25 23:40:01 -07001468 } else {
Ying Xue3c294cb2012-11-15 11:34:45 +08001469 /* Detect repeated retransmit failures on unblocked bearer */
Allan Stephensd356eeb2006-06-25 23:40:01 -07001470 if (l_ptr->last_retransmitted == msg_seqno(msg)) {
1471 if (++l_ptr->stale_count > 100) {
1472 link_retransmit_failure(l_ptr, buf);
1473 return;
1474 }
1475 } else {
1476 l_ptr->last_retransmitted = msg_seqno(msg);
1477 l_ptr->stale_count = 1;
1478 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001479 }
Allan Stephensd356eeb2006-06-25 23:40:01 -07001480
Neil Hormanca509102010-03-15 07:58:45 +00001481 while (retransmits && (buf != l_ptr->next_out) && buf) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001482 msg = buf_msg(buf);
1483 msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001484 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Ying Xue3c294cb2012-11-15 11:34:45 +08001485 tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr);
1486 buf = buf->next;
1487 retransmits--;
1488 l_ptr->stats.retransmitted++;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001489 }
Allan Stephensd356eeb2006-06-25 23:40:01 -07001490
Per Lidenb97bf3f2006-01-02 19:04:38 +01001491 l_ptr->retransm_queue_head = l_ptr->retransm_queue_size = 0;
1492}
1493
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001494/**
Per Lidenb97bf3f2006-01-02 19:04:38 +01001495 * link_insert_deferred_queue - insert deferred messages back into receive chain
1496 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001497static struct sk_buff *link_insert_deferred_queue(struct tipc_link *l_ptr,
Per Lidenb97bf3f2006-01-02 19:04:38 +01001498 struct sk_buff *buf)
1499{
1500 u32 seq_no;
1501
1502 if (l_ptr->oldest_deferred_in == NULL)
1503 return buf;
1504
Allan Stephensf9057302011-10-24 16:03:12 -04001505 seq_no = buf_seqno(l_ptr->oldest_deferred_in);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001506 if (seq_no == mod(l_ptr->next_in_no)) {
1507 l_ptr->newest_deferred_in->next = buf;
1508 buf = l_ptr->oldest_deferred_in;
1509 l_ptr->oldest_deferred_in = NULL;
1510 l_ptr->deferred_inqueue_sz = 0;
1511 }
1512 return buf;
1513}
1514
Allan Stephens85035562008-04-15 19:04:54 -07001515/**
1516 * link_recv_buf_validate - validate basic format of received message
1517 *
1518 * This routine ensures a TIPC message has an acceptable header, and at least
1519 * as much data as the header indicates it should. The routine also ensures
1520 * that the entire message header is stored in the main fragment of the message
1521 * buffer, to simplify future access to message header fields.
1522 *
1523 * Note: Having extra info present in the message header or data areas is OK.
1524 * TIPC will ignore the excess, under the assumption that it is optional info
1525 * introduced by a later release of the protocol.
1526 */
Allan Stephens85035562008-04-15 19:04:54 -07001527static int link_recv_buf_validate(struct sk_buff *buf)
1528{
1529 static u32 min_data_hdr_size[8] = {
Allan Stephens741d9eb2011-05-31 15:03:18 -04001530 SHORT_H_SIZE, MCAST_H_SIZE, NAMED_H_SIZE, BASIC_H_SIZE,
Allan Stephens85035562008-04-15 19:04:54 -07001531 MAX_H_SIZE, MAX_H_SIZE, MAX_H_SIZE, MAX_H_SIZE
1532 };
1533
1534 struct tipc_msg *msg;
1535 u32 tipc_hdr[2];
1536 u32 size;
1537 u32 hdr_size;
1538 u32 min_hdr_size;
1539
1540 if (unlikely(buf->len < MIN_H_SIZE))
1541 return 0;
1542
1543 msg = skb_header_pointer(buf, 0, sizeof(tipc_hdr), tipc_hdr);
1544 if (msg == NULL)
1545 return 0;
1546
1547 if (unlikely(msg_version(msg) != TIPC_VERSION))
1548 return 0;
1549
1550 size = msg_size(msg);
1551 hdr_size = msg_hdr_sz(msg);
1552 min_hdr_size = msg_isdata(msg) ?
1553 min_data_hdr_size[msg_type(msg)] : INT_H_SIZE;
1554
1555 if (unlikely((hdr_size < min_hdr_size) ||
1556 (size < hdr_size) ||
1557 (buf->len < size) ||
1558 (size - hdr_size > TIPC_MAX_USER_MSG_SIZE)))
1559 return 0;
1560
1561 return pskb_may_pull(buf, hdr_size);
1562}
1563
Allan Stephensb02b69c2010-08-17 11:00:07 +00001564/**
1565 * tipc_recv_msg - process TIPC messages arriving from off-node
1566 * @head: pointer to message buffer chain
1567 * @tb_ptr: pointer to bearer message arrived on
1568 *
1569 * Invoked with no locks held. Bearer pointer must point to a valid bearer
1570 * structure (i.e. cannot be NULL), but bearer can be inactive.
1571 */
Allan Stephens2d627b92011-01-07 13:00:11 -05001572void tipc_recv_msg(struct sk_buff *head, struct tipc_bearer *b_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001573{
Per Liden4323add2006-01-18 00:38:21 +01001574 read_lock_bh(&tipc_net_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001575 while (head) {
David S. Miller6c000552008-09-02 23:38:32 -07001576 struct tipc_node *n_ptr;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001577 struct tipc_link *l_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001578 struct sk_buff *crs;
1579 struct sk_buff *buf = head;
Allan Stephens85035562008-04-15 19:04:54 -07001580 struct tipc_msg *msg;
1581 u32 seq_no;
1582 u32 ackd;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001583 u32 released = 0;
1584 int type;
1585
Per Lidenb97bf3f2006-01-02 19:04:38 +01001586 head = head->next;
Allan Stephens85035562008-04-15 19:04:54 -07001587
Allan Stephensb02b69c2010-08-17 11:00:07 +00001588 /* Ensure bearer is still enabled */
Allan Stephensb02b69c2010-08-17 11:00:07 +00001589 if (unlikely(!b_ptr->active))
1590 goto cont;
1591
Allan Stephens85035562008-04-15 19:04:54 -07001592 /* Ensure message is well-formed */
Allan Stephens85035562008-04-15 19:04:54 -07001593 if (unlikely(!link_recv_buf_validate(buf)))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001594 goto cont;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001595
Allan Stephensfe13dda2008-04-15 19:03:23 -07001596 /* Ensure message data is a single contiguous unit */
Allan Stephens5f6d9122011-11-04 13:24:29 -04001597 if (unlikely(skb_linearize(buf)))
Allan Stephensfe13dda2008-04-15 19:03:23 -07001598 goto cont;
Allan Stephensfe13dda2008-04-15 19:03:23 -07001599
Allan Stephens85035562008-04-15 19:04:54 -07001600 /* Handle arrival of a non-unicast link message */
Allan Stephens85035562008-04-15 19:04:54 -07001601 msg = buf_msg(buf);
1602
Per Lidenb97bf3f2006-01-02 19:04:38 +01001603 if (unlikely(msg_non_seq(msg))) {
Allan Stephens1265a022008-06-04 17:32:35 -07001604 if (msg_user(msg) == LINK_CONFIG)
1605 tipc_disc_recv_msg(buf, b_ptr);
1606 else
1607 tipc_bclink_recv_pkt(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001608 continue;
1609 }
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001610
Allan Stephensed33a9c2011-04-05 15:15:04 -04001611 /* Discard unicast link messages destined for another node */
Allan Stephens26008242006-06-25 23:39:31 -07001612 if (unlikely(!msg_short(msg) &&
1613 (msg_destnode(msg) != tipc_own_addr)))
1614 goto cont;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001615
Allan Stephens5a68d5e2010-08-17 11:00:16 +00001616 /* Locate neighboring node that sent message */
Per Liden4323add2006-01-18 00:38:21 +01001617 n_ptr = tipc_node_find(msg_prevnode(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001618 if (unlikely(!n_ptr))
1619 goto cont;
Per Liden4323add2006-01-18 00:38:21 +01001620 tipc_node_lock(n_ptr);
Allan Stephens85035562008-04-15 19:04:54 -07001621
Allan Stephens5a68d5e2010-08-17 11:00:16 +00001622 /* Locate unicast link endpoint that should handle message */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001623 l_ptr = n_ptr->links[b_ptr->identity];
1624 if (unlikely(!l_ptr)) {
Per Liden4323add2006-01-18 00:38:21 +01001625 tipc_node_unlock(n_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001626 goto cont;
1627 }
Allan Stephens85035562008-04-15 19:04:54 -07001628
Allan Stephensb4b56102011-05-27 11:00:51 -04001629 /* Verify that communication with node is currently allowed */
Allan Stephensb4b56102011-05-27 11:00:51 -04001630 if ((n_ptr->block_setup & WAIT_PEER_DOWN) &&
1631 msg_user(msg) == LINK_PROTOCOL &&
1632 (msg_type(msg) == RESET_MSG ||
1633 msg_type(msg) == ACTIVATE_MSG) &&
1634 !msg_redundant_link(msg))
1635 n_ptr->block_setup &= ~WAIT_PEER_DOWN;
1636
1637 if (n_ptr->block_setup) {
1638 tipc_node_unlock(n_ptr);
1639 goto cont;
1640 }
1641
Allan Stephens85035562008-04-15 19:04:54 -07001642 /* Validate message sequence number info */
Allan Stephens85035562008-04-15 19:04:54 -07001643 seq_no = msg_seqno(msg);
1644 ackd = msg_ack(msg);
1645
1646 /* Release acked messages */
Ying Xue389dd9b2012-11-16 13:51:30 +08001647 if (n_ptr->bclink.recv_permitted)
Allan Stephens365595912011-10-24 15:26:24 -04001648 tipc_bclink_acknowledge(n_ptr, msg_bcast_ack(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001649
1650 crs = l_ptr->first_out;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001651 while ((crs != l_ptr->next_out) &&
Allan Stephensf9057302011-10-24 16:03:12 -04001652 less_eq(buf_seqno(crs), ackd)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001653 struct sk_buff *next = crs->next;
1654
Allan Stephens5f6d9122011-11-04 13:24:29 -04001655 kfree_skb(crs);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001656 crs = next;
1657 released++;
1658 }
1659 if (released) {
1660 l_ptr->first_out = crs;
1661 l_ptr->out_queue_size -= released;
1662 }
Allan Stephens85035562008-04-15 19:04:54 -07001663
1664 /* Try sending any messages link endpoint has pending */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001665 if (unlikely(l_ptr->next_out))
Per Liden4323add2006-01-18 00:38:21 +01001666 tipc_link_push_queue(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001667 if (unlikely(!list_empty(&l_ptr->waiting_ports)))
Per Liden4323add2006-01-18 00:38:21 +01001668 tipc_link_wakeup_ports(l_ptr, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001669 if (unlikely(++l_ptr->unacked_window >= TIPC_MIN_LINK_WIN)) {
1670 l_ptr->stats.sent_acks++;
Per Liden4323add2006-01-18 00:38:21 +01001671 tipc_link_send_proto_msg(l_ptr, STATE_MSG, 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001672 }
1673
Allan Stephens85035562008-04-15 19:04:54 -07001674 /* Now (finally!) process the incoming message */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001675protocol_check:
1676 if (likely(link_working_working(l_ptr))) {
1677 if (likely(seq_no == mod(l_ptr->next_in_no))) {
1678 l_ptr->next_in_no++;
1679 if (unlikely(l_ptr->oldest_deferred_in))
1680 head = link_insert_deferred_queue(l_ptr,
1681 head);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001682deliver:
Allan Stephensc74a4612011-11-02 15:08:44 -04001683 if (likely(msg_isdata(msg))) {
1684 tipc_node_unlock(n_ptr);
1685 tipc_port_recv_msg(buf);
1686 continue;
1687 }
1688 switch (msg_user(msg)) {
1689 int ret;
1690 case MSG_BUNDLER:
1691 l_ptr->stats.recv_bundles++;
1692 l_ptr->stats.recv_bundled +=
1693 msg_msgcnt(msg);
1694 tipc_node_unlock(n_ptr);
1695 tipc_link_recv_bundle(buf);
1696 continue;
1697 case NAME_DISTRIBUTOR:
Jon Maloyc64f7a62012-11-16 13:51:31 +08001698 n_ptr->bclink.recv_permitted = true;
Allan Stephensc74a4612011-11-02 15:08:44 -04001699 tipc_node_unlock(n_ptr);
1700 tipc_named_recv(buf);
1701 continue;
Jon Maloyc64f7a62012-11-16 13:51:31 +08001702 case BCAST_PROTOCOL:
1703 tipc_link_recv_sync(n_ptr, buf);
1704 tipc_node_unlock(n_ptr);
1705 continue;
Allan Stephensc74a4612011-11-02 15:08:44 -04001706 case CONN_MANAGER:
1707 tipc_node_unlock(n_ptr);
1708 tipc_port_recv_proto_msg(buf);
1709 continue;
1710 case MSG_FRAGMENTER:
1711 l_ptr->stats.recv_fragments++;
1712 ret = tipc_link_recv_fragment(
1713 &l_ptr->defragm_buf,
1714 &buf, &msg);
1715 if (ret == 1) {
1716 l_ptr->stats.recv_fragmented++;
1717 goto deliver;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001718 }
Allan Stephensc74a4612011-11-02 15:08:44 -04001719 if (ret == -1)
1720 l_ptr->next_in_no--;
1721 break;
1722 case CHANGEOVER_PROTOCOL:
1723 type = msg_type(msg);
1724 if (link_recv_changeover_msg(&l_ptr,
1725 &buf)) {
1726 msg = buf_msg(buf);
1727 seq_no = msg_seqno(msg);
1728 if (type == ORIGINAL_MSG)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001729 goto deliver;
Allan Stephensc74a4612011-11-02 15:08:44 -04001730 goto protocol_check;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001731 }
Allan Stephensc74a4612011-11-02 15:08:44 -04001732 break;
1733 default:
Allan Stephens5f6d9122011-11-04 13:24:29 -04001734 kfree_skb(buf);
Allan Stephensc74a4612011-11-02 15:08:44 -04001735 buf = NULL;
1736 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001737 }
Per Liden4323add2006-01-18 00:38:21 +01001738 tipc_node_unlock(n_ptr);
1739 tipc_net_route_msg(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001740 continue;
1741 }
1742 link_handle_out_of_seq_msg(l_ptr, buf);
1743 head = link_insert_deferred_queue(l_ptr, head);
Per Liden4323add2006-01-18 00:38:21 +01001744 tipc_node_unlock(n_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001745 continue;
1746 }
1747
Jon Maloyc64f7a62012-11-16 13:51:31 +08001748 /* Link is not in state WORKING_WORKING */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001749 if (msg_user(msg) == LINK_PROTOCOL) {
1750 link_recv_proto_msg(l_ptr, buf);
1751 head = link_insert_deferred_queue(l_ptr, head);
Per Liden4323add2006-01-18 00:38:21 +01001752 tipc_node_unlock(n_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001753 continue;
1754 }
Jon Maloyc64f7a62012-11-16 13:51:31 +08001755
1756 /* Traffic message. Conditionally activate link */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001757 link_state_event(l_ptr, TRAFFIC_MSG_EVT);
1758
1759 if (link_working_working(l_ptr)) {
Jon Maloyc64f7a62012-11-16 13:51:31 +08001760 /* Re-insert buffer in front of queue */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001761 buf->next = head;
1762 head = buf;
Per Liden4323add2006-01-18 00:38:21 +01001763 tipc_node_unlock(n_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001764 continue;
1765 }
Per Liden4323add2006-01-18 00:38:21 +01001766 tipc_node_unlock(n_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001767cont:
Allan Stephens5f6d9122011-11-04 13:24:29 -04001768 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001769 }
Per Liden4323add2006-01-18 00:38:21 +01001770 read_unlock_bh(&tipc_net_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001771}
1772
Ben Hutchings2c530402012-07-10 10:55:09 +00001773/**
Allan Stephens8809b252011-10-25 10:44:35 -04001774 * tipc_link_defer_pkt - Add out-of-sequence message to deferred reception queue
1775 *
1776 * Returns increase in queue length (i.e. 0 or 1)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001777 */
Allan Stephens8809b252011-10-25 10:44:35 -04001778u32 tipc_link_defer_pkt(struct sk_buff **head, struct sk_buff **tail,
Per Liden4323add2006-01-18 00:38:21 +01001779 struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001780{
Allan Stephens8809b252011-10-25 10:44:35 -04001781 struct sk_buff *queue_buf;
1782 struct sk_buff **prev;
Allan Stephensf9057302011-10-24 16:03:12 -04001783 u32 seq_no = buf_seqno(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001784
1785 buf->next = NULL;
1786
1787 /* Empty queue ? */
1788 if (*head == NULL) {
1789 *head = *tail = buf;
1790 return 1;
1791 }
1792
1793 /* Last ? */
Allan Stephensf9057302011-10-24 16:03:12 -04001794 if (less(buf_seqno(*tail), seq_no)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001795 (*tail)->next = buf;
1796 *tail = buf;
1797 return 1;
1798 }
1799
Allan Stephens8809b252011-10-25 10:44:35 -04001800 /* Locate insertion point in queue, then insert; discard if duplicate */
1801 prev = head;
1802 queue_buf = *head;
1803 for (;;) {
1804 u32 curr_seqno = buf_seqno(queue_buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001805
Allan Stephens8809b252011-10-25 10:44:35 -04001806 if (seq_no == curr_seqno) {
Allan Stephens5f6d9122011-11-04 13:24:29 -04001807 kfree_skb(buf);
Allan Stephens8809b252011-10-25 10:44:35 -04001808 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001809 }
Allan Stephens8809b252011-10-25 10:44:35 -04001810
1811 if (less(seq_no, curr_seqno))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001812 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001813
Allan Stephens8809b252011-10-25 10:44:35 -04001814 prev = &queue_buf->next;
1815 queue_buf = queue_buf->next;
1816 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001817
Allan Stephens8809b252011-10-25 10:44:35 -04001818 buf->next = queue_buf;
1819 *prev = buf;
1820 return 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001821}
1822
Allan Stephens8809b252011-10-25 10:44:35 -04001823/*
Per Lidenb97bf3f2006-01-02 19:04:38 +01001824 * link_handle_out_of_seq_msg - handle arrival of out-of-sequence packet
1825 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001826static void link_handle_out_of_seq_msg(struct tipc_link *l_ptr,
Per Lidenb97bf3f2006-01-02 19:04:38 +01001827 struct sk_buff *buf)
1828{
Allan Stephensf9057302011-10-24 16:03:12 -04001829 u32 seq_no = buf_seqno(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001830
1831 if (likely(msg_user(buf_msg(buf)) == LINK_PROTOCOL)) {
1832 link_recv_proto_msg(l_ptr, buf);
1833 return;
1834 }
1835
Per Lidenb97bf3f2006-01-02 19:04:38 +01001836 /* Record OOS packet arrival (force mismatch on next timeout) */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001837 l_ptr->checkpoint--;
1838
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001839 /*
Per Lidenb97bf3f2006-01-02 19:04:38 +01001840 * Discard packet if a duplicate; otherwise add it to deferred queue
1841 * and notify peer of gap as per protocol specification
1842 */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001843 if (less(seq_no, mod(l_ptr->next_in_no))) {
1844 l_ptr->stats.duplicates++;
Allan Stephens5f6d9122011-11-04 13:24:29 -04001845 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001846 return;
1847 }
1848
Per Liden4323add2006-01-18 00:38:21 +01001849 if (tipc_link_defer_pkt(&l_ptr->oldest_deferred_in,
1850 &l_ptr->newest_deferred_in, buf)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001851 l_ptr->deferred_inqueue_sz++;
1852 l_ptr->stats.deferred_recv++;
1853 if ((l_ptr->deferred_inqueue_sz % 16) == 1)
Per Liden4323add2006-01-18 00:38:21 +01001854 tipc_link_send_proto_msg(l_ptr, STATE_MSG, 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001855 } else
1856 l_ptr->stats.duplicates++;
1857}
1858
1859/*
1860 * Send protocol message to the other endpoint.
1861 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001862void tipc_link_send_proto_msg(struct tipc_link *l_ptr, u32 msg_typ,
Paul Gortmakerae8509c2013-06-17 10:54:47 -04001863 int probe_msg, u32 gap, u32 tolerance,
1864 u32 priority, u32 ack_mtu)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001865{
Sam Ravnborg1fc54d82006-03-20 22:36:47 -08001866 struct sk_buff *buf = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001867 struct tipc_msg *msg = l_ptr->pmsg;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001868 u32 msg_size = sizeof(l_ptr->proto_msg);
Allan Stephens75f0aa42011-02-28 15:30:20 -05001869 int r_flag;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001870
Allan Stephens92d2c902011-10-25 11:20:26 -04001871 /* Discard any previous message that was deferred due to congestion */
Allan Stephens92d2c902011-10-25 11:20:26 -04001872 if (l_ptr->proto_msg_queue) {
Allan Stephens5f6d9122011-11-04 13:24:29 -04001873 kfree_skb(l_ptr->proto_msg_queue);
Allan Stephens92d2c902011-10-25 11:20:26 -04001874 l_ptr->proto_msg_queue = NULL;
1875 }
1876
Per Lidenb97bf3f2006-01-02 19:04:38 +01001877 if (link_blocked(l_ptr))
1878 return;
Allan Stephensb4b56102011-05-27 11:00:51 -04001879
1880 /* Abort non-RESET send if communication with node is prohibited */
Allan Stephensb4b56102011-05-27 11:00:51 -04001881 if ((l_ptr->owner->block_setup) && (msg_typ != RESET_MSG))
1882 return;
1883
Allan Stephens92d2c902011-10-25 11:20:26 -04001884 /* Create protocol message with "out-of-sequence" sequence number */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001885 msg_set_type(msg, msg_typ);
1886 msg_set_net_plane(msg, l_ptr->b_ptr->net_plane);
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001887 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Per Liden4323add2006-01-18 00:38:21 +01001888 msg_set_last_bcast(msg, tipc_bclink_get_last_sent());
Per Lidenb97bf3f2006-01-02 19:04:38 +01001889
1890 if (msg_typ == STATE_MSG) {
1891 u32 next_sent = mod(l_ptr->next_out_no);
1892
Per Liden4323add2006-01-18 00:38:21 +01001893 if (!tipc_link_is_up(l_ptr))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001894 return;
1895 if (l_ptr->next_out)
Allan Stephensf9057302011-10-24 16:03:12 -04001896 next_sent = buf_seqno(l_ptr->next_out);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001897 msg_set_next_sent(msg, next_sent);
1898 if (l_ptr->oldest_deferred_in) {
Allan Stephensf9057302011-10-24 16:03:12 -04001899 u32 rec = buf_seqno(l_ptr->oldest_deferred_in);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001900 gap = mod(rec - mod(l_ptr->next_in_no));
1901 }
1902 msg_set_seq_gap(msg, gap);
1903 if (gap)
1904 l_ptr->stats.sent_nacks++;
1905 msg_set_link_tolerance(msg, tolerance);
1906 msg_set_linkprio(msg, priority);
1907 msg_set_max_pkt(msg, ack_mtu);
1908 msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
1909 msg_set_probe(msg, probe_msg != 0);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001910 if (probe_msg) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001911 u32 mtu = l_ptr->max_pkt;
1912
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001913 if ((mtu < l_ptr->max_pkt_target) &&
Per Lidenb97bf3f2006-01-02 19:04:38 +01001914 link_working_working(l_ptr) &&
1915 l_ptr->fsm_msg_cnt) {
1916 msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001917 if (l_ptr->max_pkt_probes == 10) {
1918 l_ptr->max_pkt_target = (msg_size - 4);
1919 l_ptr->max_pkt_probes = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001920 msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001921 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001922 l_ptr->max_pkt_probes++;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001923 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001924
1925 l_ptr->stats.sent_probes++;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001926 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001927 l_ptr->stats.sent_states++;
1928 } else { /* RESET_MSG or ACTIVATE_MSG */
1929 msg_set_ack(msg, mod(l_ptr->reset_checkpoint - 1));
1930 msg_set_seq_gap(msg, 0);
1931 msg_set_next_sent(msg, 1);
Allan Stephensf23d9bf2011-01-18 15:15:34 -05001932 msg_set_probe(msg, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001933 msg_set_link_tolerance(msg, l_ptr->tolerance);
1934 msg_set_linkprio(msg, l_ptr->priority);
1935 msg_set_max_pkt(msg, l_ptr->max_pkt_target);
1936 }
1937
Allan Stephens75f0aa42011-02-28 15:30:20 -05001938 r_flag = (l_ptr->owner->working_links > tipc_link_is_up(l_ptr));
1939 msg_set_redundant_link(msg, r_flag);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001940 msg_set_linkprio(msg, l_ptr->priority);
Allan Stephens92d2c902011-10-25 11:20:26 -04001941 msg_set_size(msg, msg_size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001942
1943 msg_set_seqno(msg, mod(l_ptr->next_out_no + (0xffff/2)));
1944
stephen hemminger31e3c3f2010-10-13 13:20:35 +00001945 buf = tipc_buf_acquire(msg_size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001946 if (!buf)
1947 return;
1948
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03001949 skb_copy_to_linear_data(buf, msg, sizeof(l_ptr->proto_msg));
Ying Xue796c75d2013-06-17 10:54:48 -04001950 buf->priority = TC_PRIO_CONTROL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001951
Ying Xue3c294cb2012-11-15 11:34:45 +08001952 /* Defer message if bearer is already blocked */
1953 if (tipc_bearer_blocked(l_ptr->b_ptr)) {
Allan Stephens92d2c902011-10-25 11:20:26 -04001954 l_ptr->proto_msg_queue = buf;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001955 return;
1956 }
1957
Ying Xue3c294cb2012-11-15 11:34:45 +08001958 tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr);
Allan Stephens92d2c902011-10-25 11:20:26 -04001959 l_ptr->unacked_window = 0;
Allan Stephens5f6d9122011-11-04 13:24:29 -04001960 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001961}
1962
1963/*
1964 * Receive protocol message :
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001965 * Note that network plane id propagates through the network, and may
1966 * change at any time. The node with lowest address rules
Per Lidenb97bf3f2006-01-02 19:04:38 +01001967 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001968static void link_recv_proto_msg(struct tipc_link *l_ptr, struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001969{
1970 u32 rec_gap = 0;
1971 u32 max_pkt_info;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001972 u32 max_pkt_ack;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001973 u32 msg_tol;
1974 struct tipc_msg *msg = buf_msg(buf);
1975
Per Lidenb97bf3f2006-01-02 19:04:38 +01001976 if (link_blocked(l_ptr))
1977 goto exit;
1978
1979 /* record unnumbered packet arrival (force mismatch on next timeout) */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001980 l_ptr->checkpoint--;
1981
1982 if (l_ptr->b_ptr->net_plane != msg_net_plane(msg))
1983 if (tipc_own_addr > msg_prevnode(msg))
1984 l_ptr->b_ptr->net_plane = msg_net_plane(msg);
1985
1986 l_ptr->owner->permit_changeover = msg_redundant_link(msg);
1987
1988 switch (msg_type(msg)) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001989
Per Lidenb97bf3f2006-01-02 19:04:38 +01001990 case RESET_MSG:
Allan Stephensa686e682008-06-04 17:29:39 -07001991 if (!link_working_unknown(l_ptr) &&
1992 (l_ptr->peer_session != INVALID_SESSION)) {
Allan Stephens641c2182011-04-07 09:54:43 -04001993 if (less_eq(msg_session(msg), l_ptr->peer_session))
1994 break; /* duplicate or old reset: ignore */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001995 }
Allan Stephensb4b56102011-05-27 11:00:51 -04001996
1997 if (!msg_redundant_link(msg) && (link_working_working(l_ptr) ||
1998 link_working_unknown(l_ptr))) {
1999 /*
2000 * peer has lost contact -- don't allow peer's links
2001 * to reactivate before we recognize loss & clean up
2002 */
2003 l_ptr->owner->block_setup = WAIT_NODE_DOWN;
2004 }
2005
Allan Stephens47361c82011-10-26 10:55:16 -04002006 link_state_event(l_ptr, RESET_MSG);
2007
Per Lidenb97bf3f2006-01-02 19:04:38 +01002008 /* fall thru' */
2009 case ACTIVATE_MSG:
2010 /* Update link settings according other endpoint's values */
Per Lidenb97bf3f2006-01-02 19:04:38 +01002011 strcpy((strrchr(l_ptr->name, ':') + 1), (char *)msg_data(msg));
2012
Allan Stephens2db99832010-12-31 18:59:33 +00002013 msg_tol = msg_link_tolerance(msg);
2014 if (msg_tol > l_ptr->tolerance)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002015 link_set_supervision_props(l_ptr, msg_tol);
2016
2017 if (msg_linkprio(msg) > l_ptr->priority)
2018 l_ptr->priority = msg_linkprio(msg);
2019
2020 max_pkt_info = msg_max_pkt(msg);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002021 if (max_pkt_info) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01002022 if (max_pkt_info < l_ptr->max_pkt_target)
2023 l_ptr->max_pkt_target = max_pkt_info;
2024 if (l_ptr->max_pkt > l_ptr->max_pkt_target)
2025 l_ptr->max_pkt = l_ptr->max_pkt_target;
2026 } else {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002027 l_ptr->max_pkt = l_ptr->max_pkt_target;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002028 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01002029
Allan Stephens4d753132011-10-25 12:19:05 -04002030 /* Synchronize broadcast link info, if not done previously */
Allan Stephens7a54d4a2011-10-27 14:17:53 -04002031 if (!tipc_node_is_up(l_ptr->owner)) {
2032 l_ptr->owner->bclink.last_sent =
2033 l_ptr->owner->bclink.last_in =
2034 msg_last_bcast(msg);
2035 l_ptr->owner->bclink.oos_state = 0;
2036 }
Allan Stephens4d753132011-10-25 12:19:05 -04002037
Per Lidenb97bf3f2006-01-02 19:04:38 +01002038 l_ptr->peer_session = msg_session(msg);
2039 l_ptr->peer_bearer_id = msg_bearer_id(msg);
Allan Stephens47361c82011-10-26 10:55:16 -04002040
2041 if (msg_type(msg) == ACTIVATE_MSG)
2042 link_state_event(l_ptr, ACTIVATE_MSG);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002043 break;
2044 case STATE_MSG:
2045
Allan Stephens2db99832010-12-31 18:59:33 +00002046 msg_tol = msg_link_tolerance(msg);
2047 if (msg_tol)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002048 link_set_supervision_props(l_ptr, msg_tol);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002049
2050 if (msg_linkprio(msg) &&
Per Lidenb97bf3f2006-01-02 19:04:38 +01002051 (msg_linkprio(msg) != l_ptr->priority)) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04002052 pr_warn("%s<%s>, priority change %u->%u\n",
2053 link_rst_msg, l_ptr->name, l_ptr->priority,
2054 msg_linkprio(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01002055 l_ptr->priority = msg_linkprio(msg);
Per Liden4323add2006-01-18 00:38:21 +01002056 tipc_link_reset(l_ptr); /* Enforce change to take effect */
Per Lidenb97bf3f2006-01-02 19:04:38 +01002057 break;
2058 }
2059 link_state_event(l_ptr, TRAFFIC_MSG_EVT);
2060 l_ptr->stats.recv_states++;
2061 if (link_reset_unknown(l_ptr))
2062 break;
2063
2064 if (less_eq(mod(l_ptr->next_in_no), msg_next_sent(msg))) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002065 rec_gap = mod(msg_next_sent(msg) -
Per Lidenb97bf3f2006-01-02 19:04:38 +01002066 mod(l_ptr->next_in_no));
2067 }
2068
2069 max_pkt_ack = msg_max_pkt(msg);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002070 if (max_pkt_ack > l_ptr->max_pkt) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002071 l_ptr->max_pkt = max_pkt_ack;
2072 l_ptr->max_pkt_probes = 0;
2073 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01002074
2075 max_pkt_ack = 0;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002076 if (msg_probe(msg)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01002077 l_ptr->stats.recv_probes++;
Allan Stephensa0168922010-12-31 18:59:35 +00002078 if (msg_size(msg) > sizeof(l_ptr->proto_msg))
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002079 max_pkt_ack = msg_size(msg);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002080 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01002081
2082 /* Protocol message before retransmits, reduce loss risk */
Ying Xue389dd9b2012-11-16 13:51:30 +08002083 if (l_ptr->owner->bclink.recv_permitted)
Allan Stephens7a54d4a2011-10-27 14:17:53 -04002084 tipc_bclink_update_link_state(l_ptr->owner,
2085 msg_last_bcast(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01002086
2087 if (rec_gap || (msg_probe(msg))) {
Per Liden4323add2006-01-18 00:38:21 +01002088 tipc_link_send_proto_msg(l_ptr, STATE_MSG,
2089 0, rec_gap, 0, 0, max_pkt_ack);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002090 }
2091 if (msg_seq_gap(msg)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01002092 l_ptr->stats.recv_nacks++;
Per Liden4323add2006-01-18 00:38:21 +01002093 tipc_link_retransmit(l_ptr, l_ptr->first_out,
2094 msg_seq_gap(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01002095 }
2096 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002097 }
2098exit:
Allan Stephens5f6d9122011-11-04 13:24:29 -04002099 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002100}
2101
2102
2103/*
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002104 * tipc_link_tunnel(): Send one message via a link belonging to
Per Lidenb97bf3f2006-01-02 19:04:38 +01002105 * another bearer. Owner node is locked.
2106 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002107static void tipc_link_tunnel(struct tipc_link *l_ptr,
Paul Gortmakerae8509c2013-06-17 10:54:47 -04002108 struct tipc_msg *tunnel_hdr, struct tipc_msg *msg,
stephen hemminger31e3c3f2010-10-13 13:20:35 +00002109 u32 selector)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002110{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002111 struct tipc_link *tunnel;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002112 struct sk_buff *buf;
2113 u32 length = msg_size(msg);
2114
2115 tunnel = l_ptr->owner->active_links[selector & 1];
Allan Stephens5392d642006-06-25 23:52:50 -07002116 if (!tipc_link_is_up(tunnel)) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04002117 pr_warn("%stunnel link no longer available\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002118 return;
Allan Stephens5392d642006-06-25 23:52:50 -07002119 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01002120 msg_set_size(tunnel_hdr, length + INT_H_SIZE);
stephen hemminger31e3c3f2010-10-13 13:20:35 +00002121 buf = tipc_buf_acquire(length + INT_H_SIZE);
Allan Stephens5392d642006-06-25 23:52:50 -07002122 if (!buf) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04002123 pr_warn("%sunable to send tunnel msg\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002124 return;
Allan Stephens5392d642006-06-25 23:52:50 -07002125 }
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03002126 skb_copy_to_linear_data(buf, tunnel_hdr, INT_H_SIZE);
2127 skb_copy_to_linear_data_offset(buf, INT_H_SIZE, msg, length);
Per Liden4323add2006-01-18 00:38:21 +01002128 tipc_link_send_buf(tunnel, buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002129}
2130
2131
2132
2133/*
2134 * changeover(): Send whole message queue via the remaining link
2135 * Owner node is locked.
2136 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002137void tipc_link_changeover(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002138{
2139 u32 msgcount = l_ptr->out_queue_size;
2140 struct sk_buff *crs = l_ptr->first_out;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002141 struct tipc_link *tunnel = l_ptr->owner->active_links[0];
Per Lidenb97bf3f2006-01-02 19:04:38 +01002142 struct tipc_msg tunnel_hdr;
Allan Stephens5392d642006-06-25 23:52:50 -07002143 int split_bundles;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002144
2145 if (!tunnel)
2146 return;
2147
Allan Stephens5392d642006-06-25 23:52:50 -07002148 if (!l_ptr->owner->permit_changeover) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04002149 pr_warn("%speer did not permit changeover\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002150 return;
Allan Stephens5392d642006-06-25 23:52:50 -07002151 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01002152
Allan Stephensc68ca7b2010-05-11 14:30:12 +00002153 tipc_msg_init(&tunnel_hdr, CHANGEOVER_PROTOCOL,
Allan Stephens75715212008-06-04 17:37:34 -07002154 ORIGINAL_MSG, INT_H_SIZE, l_ptr->addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002155 msg_set_bearer_id(&tunnel_hdr, l_ptr->peer_bearer_id);
2156 msg_set_msgcnt(&tunnel_hdr, msgcount);
Allan Stephensf1310722006-06-25 23:51:37 -07002157
Per Lidenb97bf3f2006-01-02 19:04:38 +01002158 if (!l_ptr->first_out) {
2159 struct sk_buff *buf;
2160
stephen hemminger31e3c3f2010-10-13 13:20:35 +00002161 buf = tipc_buf_acquire(INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002162 if (buf) {
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03002163 skb_copy_to_linear_data(buf, &tunnel_hdr, INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002164 msg_set_size(&tunnel_hdr, INT_H_SIZE);
Per Liden4323add2006-01-18 00:38:21 +01002165 tipc_link_send_buf(tunnel, buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002166 } else {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04002167 pr_warn("%sunable to send changeover msg\n",
2168 link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002169 }
2170 return;
2171 }
Allan Stephensf1310722006-06-25 23:51:37 -07002172
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002173 split_bundles = (l_ptr->owner->active_links[0] !=
Allan Stephens5392d642006-06-25 23:52:50 -07002174 l_ptr->owner->active_links[1]);
2175
Per Lidenb97bf3f2006-01-02 19:04:38 +01002176 while (crs) {
2177 struct tipc_msg *msg = buf_msg(crs);
2178
2179 if ((msg_user(msg) == MSG_BUNDLER) && split_bundles) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01002180 struct tipc_msg *m = msg_get_wrapped(msg);
Allan Stephens0e659672010-12-31 18:59:32 +00002181 unchar *pos = (unchar *)m;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002182
Florian Westphald788d802007-08-02 19:28:06 -07002183 msgcount = msg_msgcnt(msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002184 while (msgcount--) {
Allan Stephens0e659672010-12-31 18:59:32 +00002185 msg_set_seqno(m, msg_seqno(msg));
Per Liden4323add2006-01-18 00:38:21 +01002186 tipc_link_tunnel(l_ptr, &tunnel_hdr, m,
2187 msg_link_selector(m));
Per Lidenb97bf3f2006-01-02 19:04:38 +01002188 pos += align(msg_size(m));
2189 m = (struct tipc_msg *)pos;
2190 }
2191 } else {
Per Liden4323add2006-01-18 00:38:21 +01002192 tipc_link_tunnel(l_ptr, &tunnel_hdr, msg,
2193 msg_link_selector(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01002194 }
2195 crs = crs->next;
2196 }
2197}
2198
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002199void tipc_link_send_duplicate(struct tipc_link *l_ptr, struct tipc_link *tunnel)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002200{
2201 struct sk_buff *iter;
2202 struct tipc_msg tunnel_hdr;
2203
Allan Stephensc68ca7b2010-05-11 14:30:12 +00002204 tipc_msg_init(&tunnel_hdr, CHANGEOVER_PROTOCOL,
Allan Stephens75715212008-06-04 17:37:34 -07002205 DUPLICATE_MSG, INT_H_SIZE, l_ptr->addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002206 msg_set_msgcnt(&tunnel_hdr, l_ptr->out_queue_size);
2207 msg_set_bearer_id(&tunnel_hdr, l_ptr->peer_bearer_id);
2208 iter = l_ptr->first_out;
2209 while (iter) {
2210 struct sk_buff *outbuf;
2211 struct tipc_msg *msg = buf_msg(iter);
2212 u32 length = msg_size(msg);
2213
2214 if (msg_user(msg) == MSG_BUNDLER)
2215 msg_set_type(msg, CLOSED_MSG);
2216 msg_set_ack(msg, mod(l_ptr->next_in_no - 1)); /* Update */
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002217 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002218 msg_set_size(&tunnel_hdr, length + INT_H_SIZE);
stephen hemminger31e3c3f2010-10-13 13:20:35 +00002219 outbuf = tipc_buf_acquire(length + INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002220 if (outbuf == NULL) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04002221 pr_warn("%sunable to send duplicate msg\n",
2222 link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002223 return;
2224 }
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03002225 skb_copy_to_linear_data(outbuf, &tunnel_hdr, INT_H_SIZE);
2226 skb_copy_to_linear_data_offset(outbuf, INT_H_SIZE, iter->data,
2227 length);
Per Liden4323add2006-01-18 00:38:21 +01002228 tipc_link_send_buf(tunnel, outbuf);
2229 if (!tipc_link_is_up(l_ptr))
Per Lidenb97bf3f2006-01-02 19:04:38 +01002230 return;
2231 iter = iter->next;
2232 }
2233}
2234
Per Lidenb97bf3f2006-01-02 19:04:38 +01002235/**
2236 * buf_extract - extracts embedded TIPC message from another message
2237 * @skb: encapsulating message buffer
2238 * @from_pos: offset to extract from
2239 *
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002240 * Returns a new message buffer containing an embedded message. The
Per Lidenb97bf3f2006-01-02 19:04:38 +01002241 * encapsulating message itself is left unchanged.
2242 */
Per Lidenb97bf3f2006-01-02 19:04:38 +01002243static struct sk_buff *buf_extract(struct sk_buff *skb, u32 from_pos)
2244{
2245 struct tipc_msg *msg = (struct tipc_msg *)(skb->data + from_pos);
2246 u32 size = msg_size(msg);
2247 struct sk_buff *eb;
2248
stephen hemminger31e3c3f2010-10-13 13:20:35 +00002249 eb = tipc_buf_acquire(size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002250 if (eb)
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03002251 skb_copy_to_linear_data(eb, msg, size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002252 return eb;
2253}
2254
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002255/*
Per Lidenb97bf3f2006-01-02 19:04:38 +01002256 * link_recv_changeover_msg(): Receive tunneled packet sent
2257 * via other link. Node is locked. Return extracted buffer.
2258 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002259static int link_recv_changeover_msg(struct tipc_link **l_ptr,
Per Lidenb97bf3f2006-01-02 19:04:38 +01002260 struct sk_buff **buf)
2261{
2262 struct sk_buff *tunnel_buf = *buf;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002263 struct tipc_link *dest_link;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002264 struct tipc_msg *msg;
2265 struct tipc_msg *tunnel_msg = buf_msg(tunnel_buf);
2266 u32 msg_typ = msg_type(tunnel_msg);
2267 u32 msg_count = msg_msgcnt(tunnel_msg);
Dan Carpentercb4b102f2013-05-06 08:28:41 +00002268 u32 bearer_id = msg_bearer_id(tunnel_msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002269
Dan Carpentercb4b102f2013-05-06 08:28:41 +00002270 if (bearer_id >= MAX_BEARERS)
2271 goto exit;
2272 dest_link = (*l_ptr)->owner->links[bearer_id];
Allan Stephensb29f1422010-12-31 18:59:25 +00002273 if (!dest_link)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002274 goto exit;
Allan Stephensf1310722006-06-25 23:51:37 -07002275 if (dest_link == *l_ptr) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04002276 pr_err("Unexpected changeover message on link <%s>\n",
2277 (*l_ptr)->name);
Allan Stephensf1310722006-06-25 23:51:37 -07002278 goto exit;
2279 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01002280 *l_ptr = dest_link;
2281 msg = msg_get_wrapped(tunnel_msg);
2282
2283 if (msg_typ == DUPLICATE_MSG) {
Allan Stephensb29f1422010-12-31 18:59:25 +00002284 if (less(msg_seqno(msg), mod(dest_link->next_in_no)))
Per Lidenb97bf3f2006-01-02 19:04:38 +01002285 goto exit;
Allan Stephens0e659672010-12-31 18:59:32 +00002286 *buf = buf_extract(tunnel_buf, INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002287 if (*buf == NULL) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04002288 pr_warn("%sduplicate msg dropped\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002289 goto exit;
2290 }
Allan Stephens5f6d9122011-11-04 13:24:29 -04002291 kfree_skb(tunnel_buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002292 return 1;
2293 }
2294
2295 /* First original message ?: */
Per Liden4323add2006-01-18 00:38:21 +01002296 if (tipc_link_is_up(dest_link)) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04002297 pr_info("%s<%s>, changeover initiated by peer\n", link_rst_msg,
2298 dest_link->name);
Per Liden4323add2006-01-18 00:38:21 +01002299 tipc_link_reset(dest_link);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002300 dest_link->exp_msg_count = msg_count;
2301 if (!msg_count)
2302 goto exit;
2303 } else if (dest_link->exp_msg_count == START_CHANGEOVER) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01002304 dest_link->exp_msg_count = msg_count;
2305 if (!msg_count)
2306 goto exit;
2307 }
2308
2309 /* Receive original message */
Per Lidenb97bf3f2006-01-02 19:04:38 +01002310 if (dest_link->exp_msg_count == 0) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04002311 pr_warn("%sgot too many tunnelled messages\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002312 goto exit;
2313 }
2314 dest_link->exp_msg_count--;
2315 if (less(msg_seqno(msg), dest_link->reset_checkpoint)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01002316 goto exit;
2317 } else {
2318 *buf = buf_extract(tunnel_buf, INT_H_SIZE);
2319 if (*buf != NULL) {
Allan Stephens5f6d9122011-11-04 13:24:29 -04002320 kfree_skb(tunnel_buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002321 return 1;
2322 } else {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04002323 pr_warn("%soriginal msg dropped\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002324 }
2325 }
2326exit:
Sam Ravnborg1fc54d82006-03-20 22:36:47 -08002327 *buf = NULL;
Allan Stephens5f6d9122011-11-04 13:24:29 -04002328 kfree_skb(tunnel_buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002329 return 0;
2330}
2331
2332/*
2333 * Bundler functionality:
2334 */
Per Liden4323add2006-01-18 00:38:21 +01002335void tipc_link_recv_bundle(struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002336{
2337 u32 msgcount = msg_msgcnt(buf_msg(buf));
2338 u32 pos = INT_H_SIZE;
2339 struct sk_buff *obuf;
2340
Per Lidenb97bf3f2006-01-02 19:04:38 +01002341 while (msgcount--) {
2342 obuf = buf_extract(buf, pos);
2343 if (obuf == NULL) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04002344 pr_warn("Link unable to unbundle message(s)\n");
Allan Stephensa10bd922006-06-25 23:52:17 -07002345 break;
Stephen Hemminger3ff50b72007-04-20 17:09:22 -07002346 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01002347 pos += align(msg_size(buf_msg(obuf)));
Per Liden4323add2006-01-18 00:38:21 +01002348 tipc_net_route_msg(obuf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002349 }
Allan Stephens5f6d9122011-11-04 13:24:29 -04002350 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002351}
2352
2353/*
2354 * Fragmentation/defragmentation:
2355 */
2356
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002357/*
stephen hemminger31e3c3f2010-10-13 13:20:35 +00002358 * link_send_long_buf: Entry for buffers needing fragmentation.
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002359 * The buffer is complete, inclusive total message length.
Per Lidenb97bf3f2006-01-02 19:04:38 +01002360 * Returns user data length.
2361 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002362static int link_send_long_buf(struct tipc_link *l_ptr, struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002363{
Allan Stephens77561552011-04-17 13:06:23 -04002364 struct sk_buff *buf_chain = NULL;
2365 struct sk_buff *buf_chain_tail = (struct sk_buff *)&buf_chain;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002366 struct tipc_msg *inmsg = buf_msg(buf);
2367 struct tipc_msg fragm_hdr;
2368 u32 insize = msg_size(inmsg);
2369 u32 dsz = msg_data_sz(inmsg);
2370 unchar *crs = buf->data;
2371 u32 rest = insize;
Allan Stephens15e979d2010-05-11 14:30:10 +00002372 u32 pack_sz = l_ptr->max_pkt;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002373 u32 fragm_sz = pack_sz - INT_H_SIZE;
Allan Stephens77561552011-04-17 13:06:23 -04002374 u32 fragm_no = 0;
Allan Stephens9c396a72008-06-04 17:36:58 -07002375 u32 destaddr;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002376
2377 if (msg_short(inmsg))
2378 destaddr = l_ptr->addr;
Allan Stephens9c396a72008-06-04 17:36:58 -07002379 else
2380 destaddr = msg_destnode(inmsg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002381
Per Lidenb97bf3f2006-01-02 19:04:38 +01002382 /* Prepare reusable fragment header: */
Allan Stephensc68ca7b2010-05-11 14:30:12 +00002383 tipc_msg_init(&fragm_hdr, MSG_FRAGMENTER, FIRST_FRAGMENT,
Allan Stephens75715212008-06-04 17:37:34 -07002384 INT_H_SIZE, destaddr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002385
2386 /* Chop up message: */
Per Lidenb97bf3f2006-01-02 19:04:38 +01002387 while (rest > 0) {
2388 struct sk_buff *fragm;
2389
2390 if (rest <= fragm_sz) {
2391 fragm_sz = rest;
2392 msg_set_type(&fragm_hdr, LAST_FRAGMENT);
2393 }
stephen hemminger31e3c3f2010-10-13 13:20:35 +00002394 fragm = tipc_buf_acquire(fragm_sz + INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002395 if (fragm == NULL) {
Allan Stephens5f6d9122011-11-04 13:24:29 -04002396 kfree_skb(buf);
Allan Stephens77561552011-04-17 13:06:23 -04002397 while (buf_chain) {
2398 buf = buf_chain;
2399 buf_chain = buf_chain->next;
Allan Stephens5f6d9122011-11-04 13:24:29 -04002400 kfree_skb(buf);
Allan Stephens77561552011-04-17 13:06:23 -04002401 }
2402 return -ENOMEM;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002403 }
2404 msg_set_size(&fragm_hdr, fragm_sz + INT_H_SIZE);
Allan Stephens77561552011-04-17 13:06:23 -04002405 fragm_no++;
2406 msg_set_fragm_no(&fragm_hdr, fragm_no);
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03002407 skb_copy_to_linear_data(fragm, &fragm_hdr, INT_H_SIZE);
2408 skb_copy_to_linear_data_offset(fragm, INT_H_SIZE, crs,
2409 fragm_sz);
Allan Stephens77561552011-04-17 13:06:23 -04002410 buf_chain_tail->next = fragm;
2411 buf_chain_tail = fragm;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002412
Per Lidenb97bf3f2006-01-02 19:04:38 +01002413 rest -= fragm_sz;
2414 crs += fragm_sz;
2415 msg_set_type(&fragm_hdr, FRAGMENT);
2416 }
Allan Stephens5f6d9122011-11-04 13:24:29 -04002417 kfree_skb(buf);
Allan Stephens77561552011-04-17 13:06:23 -04002418
2419 /* Append chain of fragments to send queue & send them */
Allan Stephens77561552011-04-17 13:06:23 -04002420 l_ptr->long_msg_seq_no++;
2421 link_add_chain_to_outqueue(l_ptr, buf_chain, l_ptr->long_msg_seq_no);
2422 l_ptr->stats.sent_fragments += fragm_no;
2423 l_ptr->stats.sent_fragmented++;
2424 tipc_link_push_queue(l_ptr);
2425
Per Lidenb97bf3f2006-01-02 19:04:38 +01002426 return dsz;
2427}
2428
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002429/*
2430 * A pending message being re-assembled must store certain values
2431 * to handle subsequent fragments correctly. The following functions
Per Lidenb97bf3f2006-01-02 19:04:38 +01002432 * help storing these values in unused, available fields in the
Lucas De Marchi25985ed2011-03-30 22:57:33 -03002433 * pending message. This makes dynamic memory allocation unnecessary.
Per Lidenb97bf3f2006-01-02 19:04:38 +01002434 */
Sam Ravnborg05790c62006-03-20 22:37:04 -08002435static void set_long_msg_seqno(struct sk_buff *buf, u32 seqno)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002436{
2437 msg_set_seqno(buf_msg(buf), seqno);
2438}
2439
Sam Ravnborg05790c62006-03-20 22:37:04 -08002440static u32 get_fragm_size(struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002441{
2442 return msg_ack(buf_msg(buf));
2443}
2444
Sam Ravnborg05790c62006-03-20 22:37:04 -08002445static void set_fragm_size(struct sk_buff *buf, u32 sz)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002446{
2447 msg_set_ack(buf_msg(buf), sz);
2448}
2449
Sam Ravnborg05790c62006-03-20 22:37:04 -08002450static u32 get_expected_frags(struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002451{
2452 return msg_bcast_ack(buf_msg(buf));
2453}
2454
Sam Ravnborg05790c62006-03-20 22:37:04 -08002455static void set_expected_frags(struct sk_buff *buf, u32 exp)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002456{
2457 msg_set_bcast_ack(buf_msg(buf), exp);
2458}
2459
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002460/*
2461 * tipc_link_recv_fragment(): Called with node lock on. Returns
Per Lidenb97bf3f2006-01-02 19:04:38 +01002462 * the reassembled buffer if message is complete.
2463 */
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002464int tipc_link_recv_fragment(struct sk_buff **pending, struct sk_buff **fb,
Per Liden4323add2006-01-18 00:38:21 +01002465 struct tipc_msg **m)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002466{
Sam Ravnborg1fc54d82006-03-20 22:36:47 -08002467 struct sk_buff *prev = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002468 struct sk_buff *fbuf = *fb;
2469 struct tipc_msg *fragm = buf_msg(fbuf);
2470 struct sk_buff *pbuf = *pending;
2471 u32 long_msg_seq_no = msg_long_msgno(fragm);
2472
Sam Ravnborg1fc54d82006-03-20 22:36:47 -08002473 *fb = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002474
2475 /* Is there an incomplete message waiting for this fragment? */
Allan Stephensf9057302011-10-24 16:03:12 -04002476 while (pbuf && ((buf_seqno(pbuf) != long_msg_seq_no) ||
Joe Perchesf64f9e72009-11-29 16:55:45 -08002477 (msg_orignode(fragm) != msg_orignode(buf_msg(pbuf))))) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01002478 prev = pbuf;
2479 pbuf = pbuf->next;
2480 }
2481
2482 if (!pbuf && (msg_type(fragm) == FIRST_FRAGMENT)) {
2483 struct tipc_msg *imsg = (struct tipc_msg *)msg_data(fragm);
2484 u32 msg_sz = msg_size(imsg);
2485 u32 fragm_sz = msg_data_sz(fragm);
Dan Carpenter6bf15192013-05-06 09:31:17 +00002486 u32 exp_fragm_cnt;
Allan Stephens741d9eb2011-05-31 15:03:18 -04002487 u32 max = TIPC_MAX_USER_MSG_SIZE + NAMED_H_SIZE;
Dan Carpenter6bf15192013-05-06 09:31:17 +00002488
Per Lidenb97bf3f2006-01-02 19:04:38 +01002489 if (msg_type(imsg) == TIPC_MCAST_MSG)
2490 max = TIPC_MAX_USER_MSG_SIZE + MCAST_H_SIZE;
Dan Carpenter6bf15192013-05-06 09:31:17 +00002491 if (fragm_sz == 0 || msg_size(imsg) > max) {
Allan Stephens5f6d9122011-11-04 13:24:29 -04002492 kfree_skb(fbuf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002493 return 0;
2494 }
Dan Carpenter6bf15192013-05-06 09:31:17 +00002495 exp_fragm_cnt = msg_sz / fragm_sz + !!(msg_sz % fragm_sz);
stephen hemminger31e3c3f2010-10-13 13:20:35 +00002496 pbuf = tipc_buf_acquire(msg_size(imsg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01002497 if (pbuf != NULL) {
2498 pbuf->next = *pending;
2499 *pending = pbuf;
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03002500 skb_copy_to_linear_data(pbuf, imsg,
2501 msg_data_sz(fragm));
Per Lidenb97bf3f2006-01-02 19:04:38 +01002502 /* Prepare buffer for subsequent fragments. */
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002503 set_long_msg_seqno(pbuf, long_msg_seq_no);
Allan Stephens0e659672010-12-31 18:59:32 +00002504 set_fragm_size(pbuf, fragm_sz);
2505 set_expected_frags(pbuf, exp_fragm_cnt - 1);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002506 } else {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04002507 pr_debug("Link unable to reassemble fragmented message\n");
Allan Stephens5f6d9122011-11-04 13:24:29 -04002508 kfree_skb(fbuf);
Allan Stephensb76b27c2011-10-27 16:31:26 -04002509 return -1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002510 }
Allan Stephens5f6d9122011-11-04 13:24:29 -04002511 kfree_skb(fbuf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002512 return 0;
2513 } else if (pbuf && (msg_type(fragm) != FIRST_FRAGMENT)) {
2514 u32 dsz = msg_data_sz(fragm);
2515 u32 fsz = get_fragm_size(pbuf);
2516 u32 crs = ((msg_fragm_no(fragm) - 1) * fsz);
2517 u32 exp_frags = get_expected_frags(pbuf) - 1;
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03002518 skb_copy_to_linear_data_offset(pbuf, crs,
2519 msg_data(fragm), dsz);
Allan Stephens5f6d9122011-11-04 13:24:29 -04002520 kfree_skb(fbuf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002521
2522 /* Is message complete? */
Per Lidenb97bf3f2006-01-02 19:04:38 +01002523 if (exp_frags == 0) {
2524 if (prev)
2525 prev->next = pbuf->next;
2526 else
2527 *pending = pbuf->next;
2528 msg_reset_reroute_cnt(buf_msg(pbuf));
2529 *fb = pbuf;
2530 *m = buf_msg(pbuf);
2531 return 1;
2532 }
Allan Stephens0e659672010-12-31 18:59:32 +00002533 set_expected_frags(pbuf, exp_frags);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002534 return 0;
2535 }
Allan Stephens5f6d9122011-11-04 13:24:29 -04002536 kfree_skb(fbuf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002537 return 0;
2538}
2539
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002540static void link_set_supervision_props(struct tipc_link *l_ptr, u32 tolerance)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002541{
Allan Stephens5413b4c2011-01-18 13:24:55 -05002542 if ((tolerance < TIPC_MIN_LINK_TOL) || (tolerance > TIPC_MAX_LINK_TOL))
2543 return;
2544
Per Lidenb97bf3f2006-01-02 19:04:38 +01002545 l_ptr->tolerance = tolerance;
2546 l_ptr->continuity_interval =
2547 ((tolerance / 4) > 500) ? 500 : tolerance / 4;
2548 l_ptr->abort_limit = tolerance / (l_ptr->continuity_interval / 4);
2549}
2550
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002551void tipc_link_set_queue_limits(struct tipc_link *l_ptr, u32 window)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002552{
2553 /* Data messages from this node, inclusive FIRST_FRAGM */
Allan Stephens06d82c92008-03-06 15:06:55 -08002554 l_ptr->queue_limit[TIPC_LOW_IMPORTANCE] = window;
2555 l_ptr->queue_limit[TIPC_MEDIUM_IMPORTANCE] = (window / 3) * 4;
2556 l_ptr->queue_limit[TIPC_HIGH_IMPORTANCE] = (window / 3) * 5;
2557 l_ptr->queue_limit[TIPC_CRITICAL_IMPORTANCE] = (window / 3) * 6;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002558 /* Transiting data messages,inclusive FIRST_FRAGM */
Allan Stephens06d82c92008-03-06 15:06:55 -08002559 l_ptr->queue_limit[TIPC_LOW_IMPORTANCE + 4] = 300;
2560 l_ptr->queue_limit[TIPC_MEDIUM_IMPORTANCE + 4] = 600;
2561 l_ptr->queue_limit[TIPC_HIGH_IMPORTANCE + 4] = 900;
2562 l_ptr->queue_limit[TIPC_CRITICAL_IMPORTANCE + 4] = 1200;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002563 l_ptr->queue_limit[CONN_MANAGER] = 1200;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002564 l_ptr->queue_limit[CHANGEOVER_PROTOCOL] = 2500;
2565 l_ptr->queue_limit[NAME_DISTRIBUTOR] = 3000;
2566 /* FRAGMENT and LAST_FRAGMENT packets */
2567 l_ptr->queue_limit[MSG_FRAGMENTER] = 4000;
2568}
2569
2570/**
2571 * link_find_link - locate link by name
Ben Hutchings2c530402012-07-10 10:55:09 +00002572 * @name: ptr to link name string
2573 * @node: ptr to area to be filled with ptr to associated node
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002574 *
Per Liden4323add2006-01-18 00:38:21 +01002575 * Caller must hold 'tipc_net_lock' to ensure node and bearer are not deleted;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002576 * this also prevents link deletion.
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002577 *
Per Lidenb97bf3f2006-01-02 19:04:38 +01002578 * Returns pointer to link (or 0 if invalid link name).
2579 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002580static struct tipc_link *link_find_link(const char *name,
2581 struct tipc_node **node)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002582{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002583 struct tipc_link_name link_name_parts;
Allan Stephens2d627b92011-01-07 13:00:11 -05002584 struct tipc_bearer *b_ptr;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002585 struct tipc_link *l_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002586
2587 if (!link_name_validate(name, &link_name_parts))
Sam Ravnborg1fc54d82006-03-20 22:36:47 -08002588 return NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002589
Per Liden4323add2006-01-18 00:38:21 +01002590 b_ptr = tipc_bearer_find_interface(link_name_parts.if_local);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002591 if (!b_ptr)
Sam Ravnborg1fc54d82006-03-20 22:36:47 -08002592 return NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002593
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002594 *node = tipc_node_find(link_name_parts.addr_peer);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002595 if (!*node)
Sam Ravnborg1fc54d82006-03-20 22:36:47 -08002596 return NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002597
2598 l_ptr = (*node)->links[b_ptr->identity];
2599 if (!l_ptr || strcmp(l_ptr->name, name))
Sam Ravnborg1fc54d82006-03-20 22:36:47 -08002600 return NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002601
2602 return l_ptr;
2603}
2604
Allan Stephens5c216e12011-10-18 11:34:29 -04002605/**
2606 * link_value_is_valid -- validate proposed link tolerance/priority/window
2607 *
Ben Hutchings2c530402012-07-10 10:55:09 +00002608 * @cmd: value type (TIPC_CMD_SET_LINK_*)
2609 * @new_value: the new value
Allan Stephens5c216e12011-10-18 11:34:29 -04002610 *
2611 * Returns 1 if value is within range, 0 if not.
2612 */
Allan Stephens5c216e12011-10-18 11:34:29 -04002613static int link_value_is_valid(u16 cmd, u32 new_value)
2614{
2615 switch (cmd) {
2616 case TIPC_CMD_SET_LINK_TOL:
2617 return (new_value >= TIPC_MIN_LINK_TOL) &&
2618 (new_value <= TIPC_MAX_LINK_TOL);
2619 case TIPC_CMD_SET_LINK_PRI:
2620 return (new_value <= TIPC_MAX_LINK_PRI);
2621 case TIPC_CMD_SET_LINK_WINDOW:
2622 return (new_value >= TIPC_MIN_LINK_WIN) &&
2623 (new_value <= TIPC_MAX_LINK_WIN);
2624 }
2625 return 0;
2626}
2627
Allan Stephens5c216e12011-10-18 11:34:29 -04002628/**
2629 * link_cmd_set_value - change priority/tolerance/window for link/bearer/media
Ben Hutchings2c530402012-07-10 10:55:09 +00002630 * @name: ptr to link, bearer, or media name
2631 * @new_value: new value of link, bearer, or media setting
2632 * @cmd: which link, bearer, or media attribute to set (TIPC_CMD_SET_LINK_*)
Allan Stephens5c216e12011-10-18 11:34:29 -04002633 *
2634 * Caller must hold 'tipc_net_lock' to ensure link/bearer/media is not deleted.
2635 *
2636 * Returns 0 if value updated and negative value on error.
2637 */
Allan Stephens5c216e12011-10-18 11:34:29 -04002638static int link_cmd_set_value(const char *name, u32 new_value, u16 cmd)
2639{
2640 struct tipc_node *node;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002641 struct tipc_link *l_ptr;
Allan Stephens5c216e12011-10-18 11:34:29 -04002642 struct tipc_bearer *b_ptr;
Paul Gortmaker358a0d12011-12-29 20:19:42 -05002643 struct tipc_media *m_ptr;
Allan Stephens5c216e12011-10-18 11:34:29 -04002644
2645 l_ptr = link_find_link(name, &node);
2646 if (l_ptr) {
2647 /*
2648 * acquire node lock for tipc_link_send_proto_msg().
2649 * see "TIPC locking policy" in net.c.
2650 */
2651 tipc_node_lock(node);
2652 switch (cmd) {
2653 case TIPC_CMD_SET_LINK_TOL:
2654 link_set_supervision_props(l_ptr, new_value);
2655 tipc_link_send_proto_msg(l_ptr,
2656 STATE_MSG, 0, 0, new_value, 0, 0);
2657 break;
2658 case TIPC_CMD_SET_LINK_PRI:
2659 l_ptr->priority = new_value;
2660 tipc_link_send_proto_msg(l_ptr,
2661 STATE_MSG, 0, 0, 0, new_value, 0);
2662 break;
2663 case TIPC_CMD_SET_LINK_WINDOW:
2664 tipc_link_set_queue_limits(l_ptr, new_value);
2665 break;
2666 }
2667 tipc_node_unlock(node);
2668 return 0;
2669 }
2670
2671 b_ptr = tipc_bearer_find(name);
2672 if (b_ptr) {
2673 switch (cmd) {
2674 case TIPC_CMD_SET_LINK_TOL:
2675 b_ptr->tolerance = new_value;
2676 return 0;
2677 case TIPC_CMD_SET_LINK_PRI:
2678 b_ptr->priority = new_value;
2679 return 0;
2680 case TIPC_CMD_SET_LINK_WINDOW:
2681 b_ptr->window = new_value;
2682 return 0;
2683 }
2684 return -EINVAL;
2685 }
2686
2687 m_ptr = tipc_media_find(name);
2688 if (!m_ptr)
2689 return -ENODEV;
2690 switch (cmd) {
2691 case TIPC_CMD_SET_LINK_TOL:
2692 m_ptr->tolerance = new_value;
2693 return 0;
2694 case TIPC_CMD_SET_LINK_PRI:
2695 m_ptr->priority = new_value;
2696 return 0;
2697 case TIPC_CMD_SET_LINK_WINDOW:
2698 m_ptr->window = new_value;
2699 return 0;
2700 }
2701 return -EINVAL;
2702}
2703
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002704struct sk_buff *tipc_link_cmd_config(const void *req_tlv_area, int req_tlv_space,
Per Liden4323add2006-01-18 00:38:21 +01002705 u16 cmd)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002706{
2707 struct tipc_link_config *args;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002708 u32 new_value;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002709 int res;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002710
2711 if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_LINK_CONFIG))
Per Liden4323add2006-01-18 00:38:21 +01002712 return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002713
2714 args = (struct tipc_link_config *)TLV_DATA(req_tlv_area);
2715 new_value = ntohl(args->value);
2716
Allan Stephens5c216e12011-10-18 11:34:29 -04002717 if (!link_value_is_valid(cmd, new_value))
2718 return tipc_cfg_reply_error_string(
2719 "cannot change, value invalid");
2720
Per Liden4323add2006-01-18 00:38:21 +01002721 if (!strcmp(args->name, tipc_bclink_name)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01002722 if ((cmd == TIPC_CMD_SET_LINK_WINDOW) &&
Per Liden4323add2006-01-18 00:38:21 +01002723 (tipc_bclink_set_queue_limits(new_value) == 0))
2724 return tipc_cfg_reply_none();
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002725 return tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED
Per Liden4323add2006-01-18 00:38:21 +01002726 " (cannot change setting on broadcast link)");
Per Lidenb97bf3f2006-01-02 19:04:38 +01002727 }
2728
Per Liden4323add2006-01-18 00:38:21 +01002729 read_lock_bh(&tipc_net_lock);
Allan Stephens5c216e12011-10-18 11:34:29 -04002730 res = link_cmd_set_value(args->name, new_value, cmd);
Per Liden4323add2006-01-18 00:38:21 +01002731 read_unlock_bh(&tipc_net_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002732 if (res)
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002733 return tipc_cfg_reply_error_string("cannot change link setting");
Per Lidenb97bf3f2006-01-02 19:04:38 +01002734
Per Liden4323add2006-01-18 00:38:21 +01002735 return tipc_cfg_reply_none();
Per Lidenb97bf3f2006-01-02 19:04:38 +01002736}
2737
2738/**
2739 * link_reset_statistics - reset link statistics
2740 * @l_ptr: pointer to link
2741 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002742static void link_reset_statistics(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002743{
2744 memset(&l_ptr->stats, 0, sizeof(l_ptr->stats));
2745 l_ptr->stats.sent_info = l_ptr->next_out_no;
2746 l_ptr->stats.recv_info = l_ptr->next_in_no;
2747}
2748
Per Liden4323add2006-01-18 00:38:21 +01002749struct sk_buff *tipc_link_cmd_reset_stats(const void *req_tlv_area, int req_tlv_space)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002750{
2751 char *link_name;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002752 struct tipc_link *l_ptr;
David S. Miller6c000552008-09-02 23:38:32 -07002753 struct tipc_node *node;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002754
2755 if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_LINK_NAME))
Per Liden4323add2006-01-18 00:38:21 +01002756 return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002757
2758 link_name = (char *)TLV_DATA(req_tlv_area);
Per Liden4323add2006-01-18 00:38:21 +01002759 if (!strcmp(link_name, tipc_bclink_name)) {
2760 if (tipc_bclink_reset_stats())
2761 return tipc_cfg_reply_error_string("link not found");
2762 return tipc_cfg_reply_none();
Per Lidenb97bf3f2006-01-02 19:04:38 +01002763 }
2764
Per Liden4323add2006-01-18 00:38:21 +01002765 read_lock_bh(&tipc_net_lock);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002766 l_ptr = link_find_link(link_name, &node);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002767 if (!l_ptr) {
Per Liden4323add2006-01-18 00:38:21 +01002768 read_unlock_bh(&tipc_net_lock);
2769 return tipc_cfg_reply_error_string("link not found");
Per Lidenb97bf3f2006-01-02 19:04:38 +01002770 }
2771
Per Liden4323add2006-01-18 00:38:21 +01002772 tipc_node_lock(node);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002773 link_reset_statistics(l_ptr);
Per Liden4323add2006-01-18 00:38:21 +01002774 tipc_node_unlock(node);
2775 read_unlock_bh(&tipc_net_lock);
2776 return tipc_cfg_reply_none();
Per Lidenb97bf3f2006-01-02 19:04:38 +01002777}
2778
2779/**
2780 * percent - convert count to a percentage of total (rounding up or down)
2781 */
Per Lidenb97bf3f2006-01-02 19:04:38 +01002782static u32 percent(u32 count, u32 total)
2783{
2784 return (count * 100 + (total / 2)) / total;
2785}
2786
2787/**
Per Liden4323add2006-01-18 00:38:21 +01002788 * tipc_link_stats - print link statistics
Per Lidenb97bf3f2006-01-02 19:04:38 +01002789 * @name: link name
2790 * @buf: print buffer area
2791 * @buf_size: size of print buffer area
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002792 *
Per Lidenb97bf3f2006-01-02 19:04:38 +01002793 * Returns length of print buffer data string (or 0 if error)
2794 */
Per Liden4323add2006-01-18 00:38:21 +01002795static int tipc_link_stats(const char *name, char *buf, const u32 buf_size)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002796{
Erik Hugnedc1aed32012-06-29 00:50:23 -04002797 struct tipc_link *l;
2798 struct tipc_stats *s;
David S. Miller6c000552008-09-02 23:38:32 -07002799 struct tipc_node *node;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002800 char *status;
2801 u32 profile_total = 0;
Erik Hugnedc1aed32012-06-29 00:50:23 -04002802 int ret;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002803
Per Liden4323add2006-01-18 00:38:21 +01002804 if (!strcmp(name, tipc_bclink_name))
2805 return tipc_bclink_stats(buf, buf_size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002806
Per Liden4323add2006-01-18 00:38:21 +01002807 read_lock_bh(&tipc_net_lock);
Erik Hugnedc1aed32012-06-29 00:50:23 -04002808 l = link_find_link(name, &node);
2809 if (!l) {
Per Liden4323add2006-01-18 00:38:21 +01002810 read_unlock_bh(&tipc_net_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002811 return 0;
2812 }
Per Liden4323add2006-01-18 00:38:21 +01002813 tipc_node_lock(node);
Erik Hugnedc1aed32012-06-29 00:50:23 -04002814 s = &l->stats;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002815
Erik Hugnedc1aed32012-06-29 00:50:23 -04002816 if (tipc_link_is_active(l))
Per Lidenb97bf3f2006-01-02 19:04:38 +01002817 status = "ACTIVE";
Erik Hugnedc1aed32012-06-29 00:50:23 -04002818 else if (tipc_link_is_up(l))
Per Lidenb97bf3f2006-01-02 19:04:38 +01002819 status = "STANDBY";
2820 else
2821 status = "DEFUNCT";
Erik Hugnedc1aed32012-06-29 00:50:23 -04002822
2823 ret = tipc_snprintf(buf, buf_size, "Link <%s>\n"
2824 " %s MTU:%u Priority:%u Tolerance:%u ms"
2825 " Window:%u packets\n",
2826 l->name, status, l->max_pkt, l->priority,
2827 l->tolerance, l->queue_limit[0]);
2828
2829 ret += tipc_snprintf(buf + ret, buf_size - ret,
2830 " RX packets:%u fragments:%u/%u bundles:%u/%u\n",
2831 l->next_in_no - s->recv_info, s->recv_fragments,
2832 s->recv_fragmented, s->recv_bundles,
2833 s->recv_bundled);
2834
2835 ret += tipc_snprintf(buf + ret, buf_size - ret,
2836 " TX packets:%u fragments:%u/%u bundles:%u/%u\n",
2837 l->next_out_no - s->sent_info, s->sent_fragments,
2838 s->sent_fragmented, s->sent_bundles,
2839 s->sent_bundled);
2840
2841 profile_total = s->msg_length_counts;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002842 if (!profile_total)
2843 profile_total = 1;
Erik Hugnedc1aed32012-06-29 00:50:23 -04002844
2845 ret += tipc_snprintf(buf + ret, buf_size - ret,
2846 " TX profile sample:%u packets average:%u octets\n"
2847 " 0-64:%u%% -256:%u%% -1024:%u%% -4096:%u%% "
2848 "-16384:%u%% -32768:%u%% -66000:%u%%\n",
2849 s->msg_length_counts,
2850 s->msg_lengths_total / profile_total,
2851 percent(s->msg_length_profile[0], profile_total),
2852 percent(s->msg_length_profile[1], profile_total),
2853 percent(s->msg_length_profile[2], profile_total),
2854 percent(s->msg_length_profile[3], profile_total),
2855 percent(s->msg_length_profile[4], profile_total),
2856 percent(s->msg_length_profile[5], profile_total),
2857 percent(s->msg_length_profile[6], profile_total));
2858
2859 ret += tipc_snprintf(buf + ret, buf_size - ret,
2860 " RX states:%u probes:%u naks:%u defs:%u"
2861 " dups:%u\n", s->recv_states, s->recv_probes,
2862 s->recv_nacks, s->deferred_recv, s->duplicates);
2863
2864 ret += tipc_snprintf(buf + ret, buf_size - ret,
2865 " TX states:%u probes:%u naks:%u acks:%u"
2866 " dups:%u\n", s->sent_states, s->sent_probes,
2867 s->sent_nacks, s->sent_acks, s->retransmitted);
2868
2869 ret += tipc_snprintf(buf + ret, buf_size - ret,
Ying Xue3c294cb2012-11-15 11:34:45 +08002870 " Congestion link:%u Send queue"
2871 " max:%u avg:%u\n", s->link_congs,
Erik Hugnedc1aed32012-06-29 00:50:23 -04002872 s->max_queue_sz, s->queue_sz_counts ?
2873 (s->accu_queue_sz / s->queue_sz_counts) : 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002874
Per Liden4323add2006-01-18 00:38:21 +01002875 tipc_node_unlock(node);
2876 read_unlock_bh(&tipc_net_lock);
Erik Hugnedc1aed32012-06-29 00:50:23 -04002877 return ret;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002878}
2879
Per Liden4323add2006-01-18 00:38:21 +01002880struct sk_buff *tipc_link_cmd_show_stats(const void *req_tlv_area, int req_tlv_space)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002881{
2882 struct sk_buff *buf;
2883 struct tlv_desc *rep_tlv;
2884 int str_len;
Erik Hugnedc1aed32012-06-29 00:50:23 -04002885 int pb_len;
2886 char *pb;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002887
2888 if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_LINK_NAME))
Per Liden4323add2006-01-18 00:38:21 +01002889 return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002890
Erik Hugnedc1aed32012-06-29 00:50:23 -04002891 buf = tipc_cfg_reply_alloc(TLV_SPACE(ULTRA_STRING_MAX_LEN));
Per Lidenb97bf3f2006-01-02 19:04:38 +01002892 if (!buf)
2893 return NULL;
2894
2895 rep_tlv = (struct tlv_desc *)buf->data;
Erik Hugnedc1aed32012-06-29 00:50:23 -04002896 pb = TLV_DATA(rep_tlv);
2897 pb_len = ULTRA_STRING_MAX_LEN;
Per Liden4323add2006-01-18 00:38:21 +01002898 str_len = tipc_link_stats((char *)TLV_DATA(req_tlv_area),
Erik Hugnedc1aed32012-06-29 00:50:23 -04002899 pb, pb_len);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002900 if (!str_len) {
Allan Stephens5f6d9122011-11-04 13:24:29 -04002901 kfree_skb(buf);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002902 return tipc_cfg_reply_error_string("link not found");
Per Lidenb97bf3f2006-01-02 19:04:38 +01002903 }
Erik Hugnedc1aed32012-06-29 00:50:23 -04002904 str_len += 1; /* for "\0" */
Per Lidenb97bf3f2006-01-02 19:04:38 +01002905 skb_put(buf, TLV_SPACE(str_len));
2906 TLV_SET(rep_tlv, TIPC_TLV_ULTRA_STRING, NULL, str_len);
2907
2908 return buf;
2909}
2910
Per Lidenb97bf3f2006-01-02 19:04:38 +01002911/**
Per Liden4323add2006-01-18 00:38:21 +01002912 * tipc_link_get_max_pkt - get maximum packet size to use when sending to destination
Per Lidenb97bf3f2006-01-02 19:04:38 +01002913 * @dest: network address of destination node
2914 * @selector: used to select from set of active links
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002915 *
Per Lidenb97bf3f2006-01-02 19:04:38 +01002916 * If no active link can be found, uses default maximum packet size.
2917 */
Per Liden4323add2006-01-18 00:38:21 +01002918u32 tipc_link_get_max_pkt(u32 dest, u32 selector)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002919{
David S. Miller6c000552008-09-02 23:38:32 -07002920 struct tipc_node *n_ptr;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002921 struct tipc_link *l_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002922 u32 res = MAX_PKT_DEFAULT;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002923
Per Lidenb97bf3f2006-01-02 19:04:38 +01002924 if (dest == tipc_own_addr)
2925 return MAX_MSG_SIZE;
2926
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002927 read_lock_bh(&tipc_net_lock);
Allan Stephens51a8e4d2010-12-31 18:59:18 +00002928 n_ptr = tipc_node_find(dest);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002929 if (n_ptr) {
Per Liden4323add2006-01-18 00:38:21 +01002930 tipc_node_lock(n_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002931 l_ptr = n_ptr->active_links[selector & 1];
2932 if (l_ptr)
Allan Stephens15e979d2010-05-11 14:30:10 +00002933 res = l_ptr->max_pkt;
Per Liden4323add2006-01-18 00:38:21 +01002934 tipc_node_unlock(n_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002935 }
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002936 read_unlock_bh(&tipc_net_lock);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002937 return res;
2938}
2939
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002940static void link_print(struct tipc_link *l_ptr, const char *str)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002941{
Paul Gortmaker5deedde2012-07-11 19:27:56 -04002942 pr_info("%s Link %x<%s>:", str, l_ptr->addr, l_ptr->b_ptr->name);
Allan Stephens8d64a5b2010-12-31 18:59:27 +00002943
Per Lidenb97bf3f2006-01-02 19:04:38 +01002944 if (link_working_unknown(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04002945 pr_cont(":WU\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00002946 else if (link_reset_reset(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04002947 pr_cont(":RR\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00002948 else if (link_reset_unknown(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04002949 pr_cont(":RU\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00002950 else if (link_working_working(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04002951 pr_cont(":WW\n");
2952 else
2953 pr_cont("\n");
Per Lidenb97bf3f2006-01-02 19:04:38 +01002954}