blob: 1287161e9424a854ab18e8442fdf74528ac7cec7 [file] [log] [blame]
Per Lidenb97bf3f2006-01-02 19:04:38 +01001/*
2 * net/tipc/link.c: TIPC link code
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09003 *
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04004 * Copyright (c) 1996-2007, 2012-2015, 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"
Jon Paul Maloye3eea1e2015-03-13 16:08:11 -040038#include "subscr.h"
Per Lidenb97bf3f2006-01-02 19:04:38 +010039#include "link.h"
Richard Alpe7be57fc2014-11-20 10:29:12 +010040#include "bcast.h"
Jon Paul Maloy9816f062014-05-14 05:39:15 -040041#include "socket.h"
Per Lidenb97bf3f2006-01-02 19:04:38 +010042#include "name_distr.h"
Per Lidenb97bf3f2006-01-02 19:04:38 +010043#include "discover.h"
Richard Alpe0655f6a2014-11-20 10:29:07 +010044#include "netlink.h"
Per Lidenb97bf3f2006-01-02 19:04:38 +010045
Ying Xue796c75d2013-06-17 10:54:48 -040046#include <linux/pkt_sched.h>
47
Erik Hugne2cf8aa12012-06-29 00:16:37 -040048/*
49 * Error message prefixes
50 */
51static const char *link_co_err = "Link changeover error, ";
52static const char *link_rst_msg = "Resetting link ";
53static const char *link_unk_evt = "Unknown link event ";
Per Lidenb97bf3f2006-01-02 19:04:38 +010054
Richard Alpe7be57fc2014-11-20 10:29:12 +010055static const struct nla_policy tipc_nl_link_policy[TIPC_NLA_LINK_MAX + 1] = {
56 [TIPC_NLA_LINK_UNSPEC] = { .type = NLA_UNSPEC },
57 [TIPC_NLA_LINK_NAME] = {
58 .type = NLA_STRING,
59 .len = TIPC_MAX_LINK_NAME
60 },
61 [TIPC_NLA_LINK_MTU] = { .type = NLA_U32 },
62 [TIPC_NLA_LINK_BROADCAST] = { .type = NLA_FLAG },
63 [TIPC_NLA_LINK_UP] = { .type = NLA_FLAG },
64 [TIPC_NLA_LINK_ACTIVE] = { .type = NLA_FLAG },
65 [TIPC_NLA_LINK_PROP] = { .type = NLA_NESTED },
66 [TIPC_NLA_LINK_STATS] = { .type = NLA_NESTED },
67 [TIPC_NLA_LINK_RX] = { .type = NLA_U32 },
68 [TIPC_NLA_LINK_TX] = { .type = NLA_U32 }
69};
70
Richard Alpe0655f6a2014-11-20 10:29:07 +010071/* Properties valid for media, bearar and link */
72static const struct nla_policy tipc_nl_prop_policy[TIPC_NLA_PROP_MAX + 1] = {
73 [TIPC_NLA_PROP_UNSPEC] = { .type = NLA_UNSPEC },
74 [TIPC_NLA_PROP_PRIO] = { .type = NLA_U32 },
75 [TIPC_NLA_PROP_TOL] = { .type = NLA_U32 },
76 [TIPC_NLA_PROP_WIN] = { .type = NLA_U32 }
77};
78
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +090079/*
Allan Stephensa686e682008-06-04 17:29:39 -070080 * Out-of-range value for link session numbers
81 */
Allan Stephensa686e682008-06-04 17:29:39 -070082#define INVALID_SESSION 0x10000
83
84/*
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +090085 * Link state events:
Per Lidenb97bf3f2006-01-02 19:04:38 +010086 */
Per Lidenb97bf3f2006-01-02 19:04:38 +010087#define STARTING_EVT 856384768 /* link processing trigger */
88#define TRAFFIC_MSG_EVT 560815u /* rx'd ??? */
89#define TIMEOUT_EVT 560817u /* link timer expired */
90
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +090091/*
92 * The following two 'message types' is really just implementation
93 * data conveniently stored in the message header.
Per Lidenb97bf3f2006-01-02 19:04:38 +010094 * They must not be considered part of the protocol
95 */
96#define OPEN_MSG 0
97#define CLOSED_MSG 1
98
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +090099/*
Per Lidenb97bf3f2006-01-02 19:04:38 +0100100 * State value stored in 'exp_msg_count'
101 */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100102#define START_CHANGEOVER 100000u
103
Jon Paul Maloyc5898632015-02-05 08:36:36 -0500104static void link_handle_out_of_seq_msg(struct tipc_link *link,
105 struct sk_buff *skb);
106static void tipc_link_proto_rcv(struct tipc_link *link,
107 struct sk_buff *skb);
108static int tipc_link_tunnel_rcv(struct tipc_node *node,
109 struct sk_buff **skb);
Ying Xue2f55c432015-01-09 15:27:00 +0800110static void link_set_supervision_props(struct tipc_link *l_ptr, u32 tol);
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500111static void link_state_event(struct tipc_link *l_ptr, u32 event);
112static void link_reset_statistics(struct tipc_link *l_ptr);
113static void link_print(struct tipc_link *l_ptr, const char *str);
Ying Xue247f0f32014-02-18 16:06:46 +0800114static void tipc_link_sync_xmit(struct tipc_link *l);
115static void tipc_link_sync_rcv(struct tipc_node *n, struct sk_buff *buf);
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500116static void tipc_link_input(struct tipc_link *l, struct sk_buff *skb);
117static bool tipc_data_input(struct tipc_link *l, struct sk_buff *skb);
stephen hemminger31e3c3f2010-10-13 13:20:35 +0000118
Per Lidenb97bf3f2006-01-02 19:04:38 +0100119/*
Sam Ravnborg05790c62006-03-20 22:37:04 -0800120 * Simple link routines
Per Lidenb97bf3f2006-01-02 19:04:38 +0100121 */
Sam Ravnborg05790c62006-03-20 22:37:04 -0800122static unsigned int align(unsigned int i)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100123{
124 return (i + 3) & ~3u;
125}
126
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500127static void tipc_link_release(struct kref *kref)
128{
129 kfree(container_of(kref, struct tipc_link, ref));
130}
131
132static void tipc_link_get(struct tipc_link *l_ptr)
133{
134 kref_get(&l_ptr->ref);
135}
136
137static void tipc_link_put(struct tipc_link *l_ptr)
138{
139 kref_put(&l_ptr->ref, tipc_link_release);
140}
141
Jon Paul Maloy8b4ed862015-03-25 12:07:26 -0400142static struct tipc_link *tipc_parallel_link(struct tipc_link *l)
143{
144 if (l->owner->active_links[0] != l)
145 return l->owner->active_links[0];
146 return l->owner->active_links[1];
147}
148
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500149static void link_init_max_pkt(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100150{
Ying Xue7f9f95d2015-01-09 15:27:06 +0800151 struct tipc_node *node = l_ptr->owner;
152 struct tipc_net *tn = net_generic(node->net, tipc_net_id);
Ying Xue7a2f7d12014-04-21 10:55:46 +0800153 struct tipc_bearer *b_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100154 u32 max_pkt;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900155
Ying Xue7a2f7d12014-04-21 10:55:46 +0800156 rcu_read_lock();
Ying Xue7f9f95d2015-01-09 15:27:06 +0800157 b_ptr = rcu_dereference_rtnl(tn->bearer_list[l_ptr->bearer_id]);
Ying Xue7a2f7d12014-04-21 10:55:46 +0800158 if (!b_ptr) {
159 rcu_read_unlock();
160 return;
161 }
162 max_pkt = (b_ptr->mtu & ~3);
163 rcu_read_unlock();
164
Per Lidenb97bf3f2006-01-02 19:04:38 +0100165 if (max_pkt > MAX_MSG_SIZE)
166 max_pkt = MAX_MSG_SIZE;
167
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900168 l_ptr->max_pkt_target = max_pkt;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100169 if (l_ptr->max_pkt_target < MAX_PKT_DEFAULT)
170 l_ptr->max_pkt = l_ptr->max_pkt_target;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900171 else
Per Lidenb97bf3f2006-01-02 19:04:38 +0100172 l_ptr->max_pkt = MAX_PKT_DEFAULT;
173
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900174 l_ptr->max_pkt_probes = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100175}
176
Per Lidenb97bf3f2006-01-02 19:04:38 +0100177/*
Sam Ravnborg05790c62006-03-20 22:37:04 -0800178 * Simple non-static link routines (i.e. referenced outside this file)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100179 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500180int tipc_link_is_up(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100181{
182 if (!l_ptr)
183 return 0;
Eric Dumazeta02cec22010-09-22 20:43:57 +0000184 return link_working_working(l_ptr) || link_working_unknown(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100185}
186
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500187int tipc_link_is_active(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100188{
Eric Dumazeta02cec22010-09-22 20:43:57 +0000189 return (l_ptr->owner->active_links[0] == l_ptr) ||
190 (l_ptr->owner->active_links[1] == l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100191}
192
193/**
Per Lidenb97bf3f2006-01-02 19:04:38 +0100194 * link_timeout - handle expiration of link timer
195 * @l_ptr: pointer to link
Per Lidenb97bf3f2006-01-02 19:04:38 +0100196 */
Ying Xue2f55c432015-01-09 15:27:00 +0800197static void link_timeout(unsigned long data)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100198{
Ying Xue2f55c432015-01-09 15:27:00 +0800199 struct tipc_link *l_ptr = (struct tipc_link *)data;
Ying Xue58dc55f2014-11-26 11:41:52 +0800200 struct sk_buff *skb;
201
Per Liden4323add2006-01-18 00:38:21 +0100202 tipc_node_lock(l_ptr->owner);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100203
204 /* update counters used in statistical profiling of send traffic */
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400205 l_ptr->stats.accu_queue_sz += skb_queue_len(&l_ptr->transmq);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100206 l_ptr->stats.queue_sz_counts++;
207
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400208 skb = skb_peek(&l_ptr->transmq);
Ying Xue58dc55f2014-11-26 11:41:52 +0800209 if (skb) {
210 struct tipc_msg *msg = buf_msg(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100211 u32 length = msg_size(msg);
212
Joe Perchesf64f9e72009-11-29 16:55:45 -0800213 if ((msg_user(msg) == MSG_FRAGMENTER) &&
214 (msg_type(msg) == FIRST_FRAGMENT)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100215 length = msg_size(msg_get_wrapped(msg));
216 }
217 if (length) {
218 l_ptr->stats.msg_lengths_total += length;
219 l_ptr->stats.msg_length_counts++;
220 if (length <= 64)
221 l_ptr->stats.msg_length_profile[0]++;
222 else if (length <= 256)
223 l_ptr->stats.msg_length_profile[1]++;
224 else if (length <= 1024)
225 l_ptr->stats.msg_length_profile[2]++;
226 else if (length <= 4096)
227 l_ptr->stats.msg_length_profile[3]++;
228 else if (length <= 16384)
229 l_ptr->stats.msg_length_profile[4]++;
230 else if (length <= 32768)
231 l_ptr->stats.msg_length_profile[5]++;
232 else
233 l_ptr->stats.msg_length_profile[6]++;
234 }
235 }
236
237 /* do all other link processing performed on a periodic basis */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100238 link_state_event(l_ptr, TIMEOUT_EVT);
239
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400240 if (skb_queue_len(&l_ptr->backlogq))
Ying Xue47b4c9a2014-11-26 11:41:48 +0800241 tipc_link_push_packets(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100242
Per Liden4323add2006-01-18 00:38:21 +0100243 tipc_node_unlock(l_ptr->owner);
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500244 tipc_link_put(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100245}
246
Ying Xue2f55c432015-01-09 15:27:00 +0800247static void link_set_timer(struct tipc_link *link, unsigned long time)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100248{
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500249 if (!mod_timer(&link->timer, jiffies + time))
250 tipc_link_get(link);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100251}
252
253/**
Per Liden4323add2006-01-18 00:38:21 +0100254 * tipc_link_create - create a new link
Allan Stephens37b9c082011-02-28 11:32:27 -0500255 * @n_ptr: pointer to associated node
Per Lidenb97bf3f2006-01-02 19:04:38 +0100256 * @b_ptr: pointer to associated bearer
Per Lidenb97bf3f2006-01-02 19:04:38 +0100257 * @media_addr: media address to use when sending messages over link
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900258 *
Per Lidenb97bf3f2006-01-02 19:04:38 +0100259 * Returns pointer to link.
260 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500261struct tipc_link *tipc_link_create(struct tipc_node *n_ptr,
Ying Xuec61dd612014-02-13 17:29:09 -0500262 struct tipc_bearer *b_ptr,
263 const struct tipc_media_addr *media_addr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100264{
Ying Xue34747532015-01-09 15:27:10 +0800265 struct tipc_net *tn = net_generic(n_ptr->net, tipc_net_id);
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500266 struct tipc_link *l_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100267 struct tipc_msg *msg;
268 char *if_name;
Allan Stephens37b9c082011-02-28 11:32:27 -0500269 char addr_string[16];
270 u32 peer = n_ptr->addr;
271
Holger Brunck0372bf52014-11-14 18:33:19 +0100272 if (n_ptr->link_cnt >= MAX_BEARERS) {
Allan Stephens37b9c082011-02-28 11:32:27 -0500273 tipc_addr_string_fill(addr_string, n_ptr->addr);
Holger Brunck0372bf52014-11-14 18:33:19 +0100274 pr_err("Attempt to establish %uth link to %s. Max %u allowed.\n",
275 n_ptr->link_cnt, addr_string, MAX_BEARERS);
Allan Stephens37b9c082011-02-28 11:32:27 -0500276 return NULL;
277 }
278
279 if (n_ptr->links[b_ptr->identity]) {
280 tipc_addr_string_fill(addr_string, n_ptr->addr);
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400281 pr_err("Attempt to establish second link on <%s> to %s\n",
282 b_ptr->name, addr_string);
Allan Stephens37b9c082011-02-28 11:32:27 -0500283 return NULL;
284 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100285
Panagiotis Issaris0da974f2006-07-21 14:51:30 -0700286 l_ptr = kzalloc(sizeof(*l_ptr), GFP_ATOMIC);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100287 if (!l_ptr) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400288 pr_warn("Link creation failed, no memory\n");
Per Lidenb97bf3f2006-01-02 19:04:38 +0100289 return NULL;
290 }
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500291 kref_init(&l_ptr->ref);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100292 l_ptr->addr = peer;
Allan Stephens2d627b92011-01-07 13:00:11 -0500293 if_name = strchr(b_ptr->name, ':') + 1;
Allan Stephens062b4c92011-04-07 09:28:47 -0400294 sprintf(l_ptr->name, "%u.%u.%u:%s-%u.%u.%u:unknown",
Ying Xue34747532015-01-09 15:27:10 +0800295 tipc_zone(tn->own_addr), tipc_cluster(tn->own_addr),
296 tipc_node(tn->own_addr),
Per Lidenb97bf3f2006-01-02 19:04:38 +0100297 if_name,
298 tipc_zone(peer), tipc_cluster(peer), tipc_node(peer));
Allan Stephens062b4c92011-04-07 09:28:47 -0400299 /* note: peer i/f name is updated by reset/activate message */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100300 memcpy(&l_ptr->media_addr, media_addr, sizeof(*media_addr));
Allan Stephens37b9c082011-02-28 11:32:27 -0500301 l_ptr->owner = n_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100302 l_ptr->checkpoint = 1;
Allan Stephensf882cb762011-04-07 09:43:27 -0400303 l_ptr->peer_session = INVALID_SESSION;
Ying Xue7a2f7d12014-04-21 10:55:46 +0800304 l_ptr->bearer_id = b_ptr->identity;
Allan Stephens5c216e12011-10-18 11:34:29 -0400305 link_set_supervision_props(l_ptr, b_ptr->tolerance);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100306 l_ptr->state = RESET_UNKNOWN;
307
308 l_ptr->pmsg = (struct tipc_msg *)&l_ptr->proto_msg;
309 msg = l_ptr->pmsg;
Jon Paul Maloyc5898632015-02-05 08:36:36 -0500310 tipc_msg_init(tn->own_addr, msg, LINK_PROTOCOL, RESET_MSG, INT_H_SIZE,
Ying Xue34747532015-01-09 15:27:10 +0800311 l_ptr->addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100312 msg_set_size(msg, sizeof(l_ptr->proto_msg));
Ying Xuebafa29e2015-01-09 15:27:12 +0800313 msg_set_session(msg, (tn->random & 0xffff));
Per Lidenb97bf3f2006-01-02 19:04:38 +0100314 msg_set_bearer_id(msg, b_ptr->identity);
315 strcpy((char *)msg_data(msg), if_name);
Ying Xue7a2f7d12014-04-21 10:55:46 +0800316 l_ptr->net_plane = b_ptr->net_plane;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100317 link_init_max_pkt(l_ptr);
Jon Paul Maloye3eea1e2015-03-13 16:08:11 -0400318 l_ptr->priority = b_ptr->priority;
319 tipc_link_set_queue_limits(l_ptr, b_ptr->window);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100320 l_ptr->next_out_no = 1;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400321 __skb_queue_head_init(&l_ptr->transmq);
322 __skb_queue_head_init(&l_ptr->backlogq);
323 __skb_queue_head_init(&l_ptr->deferdq);
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500324 skb_queue_head_init(&l_ptr->wakeupq);
325 skb_queue_head_init(&l_ptr->inputq);
326 skb_queue_head_init(&l_ptr->namedq);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100327 link_reset_statistics(l_ptr);
Allan Stephens37b9c082011-02-28 11:32:27 -0500328 tipc_node_attach_link(n_ptr, l_ptr);
Ying Xue2f55c432015-01-09 15:27:00 +0800329 setup_timer(&l_ptr->timer, link_timeout, (unsigned long)l_ptr);
Jon Paul Maloy581465f2014-01-07 17:02:44 -0500330 link_state_event(l_ptr, STARTING_EVT);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100331
Per Lidenb97bf3f2006-01-02 19:04:38 +0100332 return l_ptr;
333}
334
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500335/**
336 * link_delete - Conditional deletion of link.
337 * If timer still running, real delete is done when it expires
338 * @link: link to be deleted
339 */
340void tipc_link_delete(struct tipc_link *link)
341{
342 tipc_link_reset_fragments(link);
343 tipc_node_detach_link(link->owner, link);
344 tipc_link_put(link);
345}
346
Ying Xuef2f98002015-01-09 15:27:05 +0800347void tipc_link_delete_list(struct net *net, unsigned int bearer_id,
348 bool shutting_down)
Ying Xue8d8439b2014-02-13 17:29:07 -0500349{
Ying Xuef2f98002015-01-09 15:27:05 +0800350 struct tipc_net *tn = net_generic(net, tipc_net_id);
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500351 struct tipc_link *link;
352 struct tipc_node *node;
Jon Paul Maloy169bf912015-03-10 12:23:34 -0400353 bool del_link;
Ying Xue8d8439b2014-02-13 17:29:07 -0500354
Ying Xue6c7a7622014-03-27 12:54:37 +0800355 rcu_read_lock();
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500356 list_for_each_entry_rcu(node, &tn->node_list, list) {
357 tipc_node_lock(node);
358 link = node->links[bearer_id];
359 if (!link) {
360 tipc_node_unlock(node);
Ying Xuec61dd612014-02-13 17:29:09 -0500361 continue;
362 }
Jon Paul Maloy169bf912015-03-10 12:23:34 -0400363 del_link = !tipc_link_is_up(link) && !link->exp_msg_count;
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500364 tipc_link_reset(link);
365 if (del_timer(&link->timer))
366 tipc_link_put(link);
367 link->flags |= LINK_STOPPED;
368 /* Delete link now, or when failover is finished: */
Jon Paul Maloy169bf912015-03-10 12:23:34 -0400369 if (shutting_down || !tipc_node_is_up(node) || del_link)
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500370 tipc_link_delete(link);
371 tipc_node_unlock(node);
Ying Xue8d8439b2014-02-13 17:29:07 -0500372 }
Ying Xue6c7a7622014-03-27 12:54:37 +0800373 rcu_read_unlock();
Ying Xue8d8439b2014-02-13 17:29:07 -0500374}
Per Lidenb97bf3f2006-01-02 19:04:38 +0100375
376/**
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400377 * link_schedule_user - schedule a message sender for wakeup after congestion
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400378 * @link: congested link
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400379 * @list: message that was attempted sent
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400380 * Create pseudo msg to send back to user when congestion abates
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400381 * Only consumes message if there is an error
Per Lidenb97bf3f2006-01-02 19:04:38 +0100382 */
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400383static int link_schedule_user(struct tipc_link *link, struct sk_buff_head *list)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100384{
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400385 struct tipc_msg *msg = buf_msg(skb_peek(list));
386 int imp = msg_importance(msg);
387 u32 oport = msg_origport(msg);
388 u32 addr = link_own_addr(link);
389 struct sk_buff *skb;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100390
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400391 /* This really cannot happen... */
392 if (unlikely(imp > TIPC_CRITICAL_IMPORTANCE)) {
393 pr_warn("%s<%s>, send queue full", link_rst_msg, link->name);
394 tipc_link_reset(link);
395 goto err;
396 }
397 /* Non-blocking sender: */
398 if (TIPC_SKB_CB(skb_peek(list))->wakeup_pending)
399 return -ELINKCONG;
400
401 /* Create and schedule wakeup pseudo message */
402 skb = tipc_msg_create(SOCK_WAKEUP, 0, INT_H_SIZE, 0,
403 addr, addr, oport, 0, 0);
404 if (!skb)
405 goto err;
406 TIPC_SKB_CB(skb)->chain_sz = skb_queue_len(list);
407 TIPC_SKB_CB(skb)->chain_imp = imp;
408 skb_queue_tail(&link->wakeupq, skb);
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400409 link->stats.link_congs++;
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400410 return -ELINKCONG;
411err:
412 __skb_queue_purge(list);
413 return -ENOBUFS;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100414}
415
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400416/**
417 * link_prepare_wakeup - prepare users for wakeup after congestion
418 * @link: congested link
419 * Move a number of waiting users, as permitted by available space in
420 * the send queue, from link wait queue to node wait queue for wakeup
421 */
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400422void link_prepare_wakeup(struct tipc_link *l)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100423{
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400424 int pnd[TIPC_SYSTEM_IMPORTANCE + 1] = {0,};
425 int imp, lim;
Ying Xue58d78b32014-11-26 11:41:51 +0800426 struct sk_buff *skb, *tmp;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100427
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400428 skb_queue_walk_safe(&l->wakeupq, skb, tmp) {
429 imp = TIPC_SKB_CB(skb)->chain_imp;
430 lim = l->window + l->backlog[imp].limit;
431 pnd[imp] += TIPC_SKB_CB(skb)->chain_sz;
432 if ((pnd[imp] + l->backlog[imp].len) >= lim)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100433 break;
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400434 skb_unlink(skb, &l->wakeupq);
435 skb_queue_tail(&l->inputq, skb);
436 l->owner->inputq = &l->inputq;
437 l->owner->action_flags |= TIPC_MSG_EVT;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100438 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100439}
440
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900441/**
Per Liden4323add2006-01-18 00:38:21 +0100442 * tipc_link_reset_fragments - purge link's inbound message fragments queue
Per Lidenb97bf3f2006-01-02 19:04:38 +0100443 * @l_ptr: pointer to link
444 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500445void tipc_link_reset_fragments(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100446{
Jon Paul Maloy37e22162014-05-14 05:39:12 -0400447 kfree_skb(l_ptr->reasm_buf);
448 l_ptr->reasm_buf = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100449}
450
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400451static void tipc_link_purge_backlog(struct tipc_link *l)
452{
453 __skb_queue_purge(&l->backlogq);
454 l->backlog[TIPC_LOW_IMPORTANCE].len = 0;
455 l->backlog[TIPC_MEDIUM_IMPORTANCE].len = 0;
456 l->backlog[TIPC_HIGH_IMPORTANCE].len = 0;
457 l->backlog[TIPC_CRITICAL_IMPORTANCE].len = 0;
458 l->backlog[TIPC_SYSTEM_IMPORTANCE].len = 0;
459}
460
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900461/**
Jon Paul Maloy581465f2014-01-07 17:02:44 -0500462 * tipc_link_purge_queues - purge all pkt queues associated with link
Per Lidenb97bf3f2006-01-02 19:04:38 +0100463 * @l_ptr: pointer to link
464 */
Jon Paul Maloy581465f2014-01-07 17:02:44 -0500465void tipc_link_purge_queues(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100466{
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400467 __skb_queue_purge(&l_ptr->deferdq);
468 __skb_queue_purge(&l_ptr->transmq);
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400469 tipc_link_purge_backlog(l_ptr);
Per Liden4323add2006-01-18 00:38:21 +0100470 tipc_link_reset_fragments(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100471}
472
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500473void tipc_link_reset(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100474{
Per Lidenb97bf3f2006-01-02 19:04:38 +0100475 u32 prev_state = l_ptr->state;
476 u32 checkpoint = l_ptr->next_in_no;
Allan Stephens5392d642006-06-25 23:52:50 -0700477 int was_active_link = tipc_link_is_active(l_ptr);
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400478 struct tipc_node *owner = l_ptr->owner;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900479
Allan Stephensa686e682008-06-04 17:29:39 -0700480 msg_set_session(l_ptr->pmsg, ((msg_session(l_ptr->pmsg) + 1) & 0xffff));
Per Lidenb97bf3f2006-01-02 19:04:38 +0100481
Allan Stephensa686e682008-06-04 17:29:39 -0700482 /* Link is down, accept any session */
483 l_ptr->peer_session = INVALID_SESSION;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100484
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900485 /* Prepare for max packet size negotiation */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100486 link_init_max_pkt(l_ptr);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900487
Per Lidenb97bf3f2006-01-02 19:04:38 +0100488 l_ptr->state = RESET_UNKNOWN;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100489
490 if ((prev_state == RESET_UNKNOWN) || (prev_state == RESET_RESET))
491 return;
492
Per Liden4323add2006-01-18 00:38:21 +0100493 tipc_node_link_down(l_ptr->owner, l_ptr);
Ying Xue7f9f95d2015-01-09 15:27:06 +0800494 tipc_bearer_remove_dest(owner->net, l_ptr->bearer_id, l_ptr->addr);
Paul Gortmaker7368ddf2010-10-12 14:25:58 +0000495
Jon Paul Maloyb9d4c332014-01-07 17:02:42 -0500496 if (was_active_link && tipc_node_active_links(l_ptr->owner)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100497 l_ptr->reset_checkpoint = checkpoint;
498 l_ptr->exp_msg_count = START_CHANGEOVER;
499 }
500
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500501 /* Clean up all queues, except inputq: */
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400502 __skb_queue_purge(&l_ptr->transmq);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400503 __skb_queue_purge(&l_ptr->deferdq);
Jon Paul Maloye6441ba2015-03-09 16:16:22 -0400504 if (!owner->inputq)
505 owner->inputq = &l_ptr->inputq;
506 skb_queue_splice_init(&l_ptr->wakeupq, owner->inputq);
507 if (!skb_queue_empty(owner->inputq))
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500508 owner->action_flags |= TIPC_MSG_EVT;
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400509 tipc_link_purge_backlog(l_ptr);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400510 l_ptr->rcv_unacked = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100511 l_ptr->checkpoint = 1;
512 l_ptr->next_out_no = 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100513 l_ptr->fsm_msg_cnt = 0;
514 l_ptr->stale_count = 0;
515 link_reset_statistics(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100516}
517
Ying Xuef2f98002015-01-09 15:27:05 +0800518void tipc_link_reset_list(struct net *net, unsigned int bearer_id)
Ying Xuee0ca2c32014-02-13 17:29:06 -0500519{
Ying Xuef2f98002015-01-09 15:27:05 +0800520 struct tipc_net *tn = net_generic(net, tipc_net_id);
Ying Xuee0ca2c32014-02-13 17:29:06 -0500521 struct tipc_link *l_ptr;
Ying Xuec61dd612014-02-13 17:29:09 -0500522 struct tipc_node *n_ptr;
Ying Xuee0ca2c32014-02-13 17:29:06 -0500523
Ying Xue6c7a7622014-03-27 12:54:37 +0800524 rcu_read_lock();
Ying Xuef2f98002015-01-09 15:27:05 +0800525 list_for_each_entry_rcu(n_ptr, &tn->node_list, list) {
Ying Xue5356f3d2014-05-05 08:56:09 +0800526 tipc_node_lock(n_ptr);
Ying Xuec61dd612014-02-13 17:29:09 -0500527 l_ptr = n_ptr->links[bearer_id];
528 if (l_ptr)
529 tipc_link_reset(l_ptr);
Ying Xue5356f3d2014-05-05 08:56:09 +0800530 tipc_node_unlock(n_ptr);
Ying Xuee0ca2c32014-02-13 17:29:06 -0500531 }
Ying Xue6c7a7622014-03-27 12:54:37 +0800532 rcu_read_unlock();
Ying Xuee0ca2c32014-02-13 17:29:06 -0500533}
Per Lidenb97bf3f2006-01-02 19:04:38 +0100534
Ying Xue7f9f95d2015-01-09 15:27:06 +0800535static void link_activate(struct tipc_link *link)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100536{
Ying Xue7f9f95d2015-01-09 15:27:06 +0800537 struct tipc_node *node = link->owner;
538
539 link->next_in_no = 1;
540 link->stats.recv_info = 1;
541 tipc_node_link_up(node, link);
542 tipc_bearer_add_dest(node->net, link->bearer_id, link->addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100543}
544
545/**
546 * link_state_event - link finite state machine
547 * @l_ptr: pointer to link
548 * @event: state machine event to process
549 */
Eric Dumazet95c96172012-04-15 05:58:06 +0000550static void link_state_event(struct tipc_link *l_ptr, unsigned int event)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100551{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500552 struct tipc_link *other;
Ying Xue2f55c432015-01-09 15:27:00 +0800553 unsigned long cont_intv = l_ptr->cont_intv;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100554
Jon Paul Maloy7d339392014-02-13 17:29:16 -0500555 if (l_ptr->flags & LINK_STOPPED)
556 return;
557
Ying Xue135daee2014-02-13 17:29:08 -0500558 if (!(l_ptr->flags & LINK_STARTED) && (event != STARTING_EVT))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100559 return; /* Not yet. */
560
Ying Xue77a7e072013-12-10 20:45:44 -0800561 /* Check whether changeover is going on */
562 if (l_ptr->exp_msg_count) {
Allan Stephensa0168922010-12-31 18:59:35 +0000563 if (event == TIMEOUT_EVT)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100564 link_set_timer(l_ptr, cont_intv);
Ying Xue77a7e072013-12-10 20:45:44 -0800565 return;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100566 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100567
568 switch (l_ptr->state) {
569 case WORKING_WORKING:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100570 switch (event) {
571 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100572 case ACTIVATE_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100573 break;
574 case TIMEOUT_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100575 if (l_ptr->next_in_no != l_ptr->checkpoint) {
576 l_ptr->checkpoint = l_ptr->next_in_no;
Per Liden4323add2006-01-18 00:38:21 +0100577 if (tipc_bclink_acks_missing(l_ptr->owner)) {
Ying Xue247f0f32014-02-18 16:06:46 +0800578 tipc_link_proto_xmit(l_ptr, STATE_MSG,
579 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100580 l_ptr->fsm_msg_cnt++;
581 } else if (l_ptr->max_pkt < l_ptr->max_pkt_target) {
Ying Xue247f0f32014-02-18 16:06:46 +0800582 tipc_link_proto_xmit(l_ptr, STATE_MSG,
583 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100584 l_ptr->fsm_msg_cnt++;
585 }
586 link_set_timer(l_ptr, cont_intv);
587 break;
588 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100589 l_ptr->state = WORKING_UNKNOWN;
590 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800591 tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100592 l_ptr->fsm_msg_cnt++;
593 link_set_timer(l_ptr, cont_intv / 4);
594 break;
595 case RESET_MSG:
Erik Hugne3fa9cac2015-01-22 17:10:31 +0100596 pr_debug("%s<%s>, requested by peer\n",
597 link_rst_msg, l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100598 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100599 l_ptr->state = RESET_RESET;
600 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800601 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
602 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100603 l_ptr->fsm_msg_cnt++;
604 link_set_timer(l_ptr, cont_intv);
605 break;
606 default:
Erik Hugne3fa9cac2015-01-22 17:10:31 +0100607 pr_debug("%s%u in WW state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100608 }
609 break;
610 case WORKING_UNKNOWN:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100611 switch (event) {
612 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100613 case ACTIVATE_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100614 l_ptr->state = WORKING_WORKING;
615 l_ptr->fsm_msg_cnt = 0;
616 link_set_timer(l_ptr, cont_intv);
617 break;
618 case RESET_MSG:
Erik Hugne3fa9cac2015-01-22 17:10:31 +0100619 pr_debug("%s<%s>, requested by peer while probing\n",
620 link_rst_msg, l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100621 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100622 l_ptr->state = RESET_RESET;
623 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800624 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
625 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100626 l_ptr->fsm_msg_cnt++;
627 link_set_timer(l_ptr, cont_intv);
628 break;
629 case TIMEOUT_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100630 if (l_ptr->next_in_no != l_ptr->checkpoint) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100631 l_ptr->state = WORKING_WORKING;
632 l_ptr->fsm_msg_cnt = 0;
633 l_ptr->checkpoint = l_ptr->next_in_no;
Per Liden4323add2006-01-18 00:38:21 +0100634 if (tipc_bclink_acks_missing(l_ptr->owner)) {
Ying Xue247f0f32014-02-18 16:06:46 +0800635 tipc_link_proto_xmit(l_ptr, STATE_MSG,
636 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100637 l_ptr->fsm_msg_cnt++;
638 }
639 link_set_timer(l_ptr, cont_intv);
640 } else if (l_ptr->fsm_msg_cnt < l_ptr->abort_limit) {
Ying Xue247f0f32014-02-18 16:06:46 +0800641 tipc_link_proto_xmit(l_ptr, STATE_MSG,
642 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100643 l_ptr->fsm_msg_cnt++;
644 link_set_timer(l_ptr, cont_intv / 4);
645 } else { /* Link has failed */
Erik Hugne3fa9cac2015-01-22 17:10:31 +0100646 pr_debug("%s<%s>, peer not responding\n",
647 link_rst_msg, l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100648 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100649 l_ptr->state = RESET_UNKNOWN;
650 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800651 tipc_link_proto_xmit(l_ptr, RESET_MSG,
652 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100653 l_ptr->fsm_msg_cnt++;
654 link_set_timer(l_ptr, cont_intv);
655 }
656 break;
657 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400658 pr_err("%s%u in WU state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100659 }
660 break;
661 case RESET_UNKNOWN:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100662 switch (event) {
663 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100664 break;
665 case ACTIVATE_MSG:
666 other = l_ptr->owner->active_links[0];
Allan Stephens8d64a5b2010-12-31 18:59:27 +0000667 if (other && link_working_unknown(other))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100668 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100669 l_ptr->state = WORKING_WORKING;
670 l_ptr->fsm_msg_cnt = 0;
671 link_activate(l_ptr);
Ying Xue247f0f32014-02-18 16:06:46 +0800672 tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100673 l_ptr->fsm_msg_cnt++;
Jon Maloyc64f7a62012-11-16 13:51:31 +0800674 if (l_ptr->owner->working_links == 1)
Ying Xue247f0f32014-02-18 16:06:46 +0800675 tipc_link_sync_xmit(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100676 link_set_timer(l_ptr, cont_intv);
677 break;
678 case RESET_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100679 l_ptr->state = RESET_RESET;
680 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800681 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
682 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100683 l_ptr->fsm_msg_cnt++;
684 link_set_timer(l_ptr, cont_intv);
685 break;
686 case STARTING_EVT:
Ying Xue135daee2014-02-13 17:29:08 -0500687 l_ptr->flags |= LINK_STARTED;
Jon Paul Maloyaf9946f2015-02-03 08:59:20 -0500688 l_ptr->fsm_msg_cnt++;
689 link_set_timer(l_ptr, cont_intv);
690 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100691 case TIMEOUT_EVT:
Ying Xue247f0f32014-02-18 16:06:46 +0800692 tipc_link_proto_xmit(l_ptr, RESET_MSG, 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100693 l_ptr->fsm_msg_cnt++;
694 link_set_timer(l_ptr, cont_intv);
695 break;
696 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400697 pr_err("%s%u in RU state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100698 }
699 break;
700 case RESET_RESET:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100701 switch (event) {
702 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100703 case ACTIVATE_MSG:
704 other = l_ptr->owner->active_links[0];
Allan Stephens8d64a5b2010-12-31 18:59:27 +0000705 if (other && link_working_unknown(other))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100706 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100707 l_ptr->state = WORKING_WORKING;
708 l_ptr->fsm_msg_cnt = 0;
709 link_activate(l_ptr);
Ying Xue247f0f32014-02-18 16:06:46 +0800710 tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100711 l_ptr->fsm_msg_cnt++;
Jon Maloyc64f7a62012-11-16 13:51:31 +0800712 if (l_ptr->owner->working_links == 1)
Ying Xue247f0f32014-02-18 16:06:46 +0800713 tipc_link_sync_xmit(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100714 link_set_timer(l_ptr, cont_intv);
715 break;
716 case RESET_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100717 break;
718 case TIMEOUT_EVT:
Ying Xue247f0f32014-02-18 16:06:46 +0800719 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
720 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100721 l_ptr->fsm_msg_cnt++;
722 link_set_timer(l_ptr, cont_intv);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100723 break;
724 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400725 pr_err("%s%u in RR state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100726 }
727 break;
728 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400729 pr_err("Unknown link state %u/%u\n", l_ptr->state, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100730 }
731}
732
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500733/**
Jon Paul Maloy9fbfb8b2014-07-16 20:41:03 -0400734 * __tipc_link_xmit(): same as tipc_link_xmit, but destlink is known & locked
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500735 * @link: link to use
Ying Xuea6ca1092014-11-26 11:41:55 +0800736 * @list: chain of buffers containing message
737 *
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400738 * Consumes the buffer chain, except when returning -ELINKCONG,
739 * since the caller then may want to make more send attempts.
740 * Returns 0 if success, or errno: -ELINKCONG, -EMSGSIZE or -ENOBUFS
741 * Messages at TIPC_SYSTEM_IMPORTANCE are always accepted
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500742 */
Ying Xue7f9f95d2015-01-09 15:27:06 +0800743int __tipc_link_xmit(struct net *net, struct tipc_link *link,
744 struct sk_buff_head *list)
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500745{
Ying Xuea6ca1092014-11-26 11:41:55 +0800746 struct tipc_msg *msg = buf_msg(skb_peek(list));
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400747 unsigned int maxwin = link->window;
Jon Paul Maloye3eea1e2015-03-13 16:08:11 -0400748 unsigned int imp = msg_importance(msg);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500749 uint mtu = link->max_pkt;
750 uint ack = mod(link->next_in_no - 1);
751 uint seqno = link->next_out_no;
752 uint bc_last_in = link->owner->bclink.last_in;
753 struct tipc_media_addr *addr = &link->media_addr;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400754 struct sk_buff_head *transmq = &link->transmq;
755 struct sk_buff_head *backlogq = &link->backlogq;
Ying Xuea6ca1092014-11-26 11:41:55 +0800756 struct sk_buff *skb, *tmp;
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500757
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400758 /* Match backlog limit against msg importance: */
759 if (unlikely(link->backlog[imp].len >= link->backlog[imp].limit))
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400760 return link_schedule_user(link, list);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500761
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400762 if (unlikely(msg_size(msg) > mtu)) {
Ying Xuea6ca1092014-11-26 11:41:55 +0800763 __skb_queue_purge(list);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500764 return -EMSGSIZE;
765 }
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400766 /* Prepare each packet for sending, and add to relevant queue: */
Ying Xuea6ca1092014-11-26 11:41:55 +0800767 skb_queue_walk_safe(list, skb, tmp) {
768 __skb_unlink(skb, list);
Ying Xue58dc55f2014-11-26 11:41:52 +0800769 msg = buf_msg(skb);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400770 msg_set_seqno(msg, seqno);
771 msg_set_ack(msg, ack);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500772 msg_set_bcast_ack(msg, bc_last_in);
773
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400774 if (likely(skb_queue_len(transmq) < maxwin)) {
775 __skb_queue_tail(transmq, skb);
776 tipc_bearer_send(net, link->bearer_id, skb, addr);
777 link->rcv_unacked = 0;
778 seqno++;
779 continue;
780 }
781 if (tipc_msg_bundle(skb_peek_tail(backlogq), skb, mtu)) {
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500782 link->stats.sent_bundled++;
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500783 continue;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400784 }
785 if (tipc_msg_make_bundle(&skb, mtu, link->addr)) {
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500786 link->stats.sent_bundled++;
787 link->stats.sent_bundles++;
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400788 imp = msg_importance(buf_msg(skb));
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500789 }
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400790 __skb_queue_tail(backlogq, skb);
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400791 link->backlog[imp].len++;
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500792 seqno++;
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500793 }
794 link->next_out_no = seqno;
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500795 return 0;
796}
797
Ying Xuea6ca1092014-11-26 11:41:55 +0800798static void skb2list(struct sk_buff *skb, struct sk_buff_head *list)
799{
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500800 skb_queue_head_init(list);
Ying Xuea6ca1092014-11-26 11:41:55 +0800801 __skb_queue_tail(list, skb);
802}
803
804static int __tipc_link_xmit_skb(struct tipc_link *link, struct sk_buff *skb)
805{
806 struct sk_buff_head head;
807
808 skb2list(skb, &head);
Ying Xue7f9f95d2015-01-09 15:27:06 +0800809 return __tipc_link_xmit(link->owner->net, link, &head);
Ying Xuea6ca1092014-11-26 11:41:55 +0800810}
811
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400812/* tipc_link_xmit_skb(): send single buffer to destination
813 * Buffers sent via this functon are generally TIPC_SYSTEM_IMPORTANCE
814 * messages, which will not be rejected
815 * The only exception is datagram messages rerouted after secondary
816 * lookup, which are rare and safe to dispose of anyway.
817 * TODO: Return real return value, and let callers use
818 * tipc_wait_for_sendpkt() where applicable
819 */
Ying Xuef2f98002015-01-09 15:27:05 +0800820int tipc_link_xmit_skb(struct net *net, struct sk_buff *skb, u32 dnode,
821 u32 selector)
Ying Xuea6ca1092014-11-26 11:41:55 +0800822{
823 struct sk_buff_head head;
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400824 int rc;
Ying Xuea6ca1092014-11-26 11:41:55 +0800825
826 skb2list(skb, &head);
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400827 rc = tipc_link_xmit(net, &head, dnode, selector);
828 if (rc == -ELINKCONG)
829 kfree_skb(skb);
830 return 0;
Ying Xuea6ca1092014-11-26 11:41:55 +0800831}
832
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500833/**
Jon Paul Maloy9fbfb8b2014-07-16 20:41:03 -0400834 * tipc_link_xmit() is the general link level function for message sending
Ying Xuef2f98002015-01-09 15:27:05 +0800835 * @net: the applicable net namespace
Ying Xuea6ca1092014-11-26 11:41:55 +0800836 * @list: chain of buffers containing message
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500837 * @dsz: amount of user data to be sent
838 * @dnode: address of destination node
839 * @selector: a number used for deterministic link selection
840 * Consumes the buffer chain, except when returning -ELINKCONG
841 * Returns 0 if success, otherwise errno: -ELINKCONG,-EHOSTUNREACH,-EMSGSIZE
842 */
Ying Xuef2f98002015-01-09 15:27:05 +0800843int tipc_link_xmit(struct net *net, struct sk_buff_head *list, u32 dnode,
844 u32 selector)
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500845{
846 struct tipc_link *link = NULL;
847 struct tipc_node *node;
848 int rc = -EHOSTUNREACH;
849
Ying Xuef2f98002015-01-09 15:27:05 +0800850 node = tipc_node_find(net, dnode);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500851 if (node) {
852 tipc_node_lock(node);
853 link = node->active_links[selector & 1];
854 if (link)
Ying Xue7f9f95d2015-01-09 15:27:06 +0800855 rc = __tipc_link_xmit(net, link, list);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500856 tipc_node_unlock(node);
857 }
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500858 if (link)
859 return rc;
860
Erik Hugne3bd88ee2015-03-19 09:02:18 +0100861 if (likely(in_own_node(net, dnode))) {
862 tipc_sk_rcv(net, list);
863 return 0;
864 }
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500865
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500866 __skb_queue_purge(list);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500867 return rc;
868}
869
Jon Maloyc64f7a62012-11-16 13:51:31 +0800870/*
Ying Xue247f0f32014-02-18 16:06:46 +0800871 * tipc_link_sync_xmit - synchronize broadcast link endpoints.
Jon Maloyc64f7a62012-11-16 13:51:31 +0800872 *
873 * Give a newly added peer node the sequence number where it should
874 * start receiving and acking broadcast packets.
875 *
876 * Called with node locked
877 */
Jon Paul Maloy25b660c2014-07-16 20:40:59 -0400878static void tipc_link_sync_xmit(struct tipc_link *link)
Jon Maloyc64f7a62012-11-16 13:51:31 +0800879{
Ying Xuea6ca1092014-11-26 11:41:55 +0800880 struct sk_buff *skb;
Jon Maloyc64f7a62012-11-16 13:51:31 +0800881 struct tipc_msg *msg;
882
Ying Xuea6ca1092014-11-26 11:41:55 +0800883 skb = tipc_buf_acquire(INT_H_SIZE);
884 if (!skb)
Jon Maloyc64f7a62012-11-16 13:51:31 +0800885 return;
886
Ying Xuea6ca1092014-11-26 11:41:55 +0800887 msg = buf_msg(skb);
Jon Paul Maloyc5898632015-02-05 08:36:36 -0500888 tipc_msg_init(link_own_addr(link), msg, BCAST_PROTOCOL, STATE_MSG,
Ying Xue34747532015-01-09 15:27:10 +0800889 INT_H_SIZE, link->addr);
Jon Paul Maloy25b660c2014-07-16 20:40:59 -0400890 msg_set_last_bcast(msg, link->owner->bclink.acked);
Ying Xuea6ca1092014-11-26 11:41:55 +0800891 __tipc_link_xmit_skb(link, skb);
Jon Maloyc64f7a62012-11-16 13:51:31 +0800892}
893
894/*
Ying Xue247f0f32014-02-18 16:06:46 +0800895 * tipc_link_sync_rcv - synchronize broadcast link endpoints.
Jon Maloyc64f7a62012-11-16 13:51:31 +0800896 * Receive the sequence number where we should start receiving and
897 * acking broadcast packets from a newly added peer node, and open
898 * up for reception of such packets.
899 *
900 * Called with node locked
901 */
Ying Xue247f0f32014-02-18 16:06:46 +0800902static void tipc_link_sync_rcv(struct tipc_node *n, struct sk_buff *buf)
Jon Maloyc64f7a62012-11-16 13:51:31 +0800903{
904 struct tipc_msg *msg = buf_msg(buf);
905
906 n->bclink.last_sent = n->bclink.last_in = msg_last_bcast(msg);
907 n->bclink.recv_permitted = true;
908 kfree_skb(buf);
909}
910
911/*
Ying Xue47b4c9a2014-11-26 11:41:48 +0800912 * tipc_link_push_packets - push unsent packets to bearer
913 *
914 * Push out the unsent messages of a link where congestion
915 * has abated. Node is locked.
916 *
917 * Called with node locked
Per Lidenb97bf3f2006-01-02 19:04:38 +0100918 */
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400919void tipc_link_push_packets(struct tipc_link *link)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100920{
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400921 struct sk_buff *skb;
Ying Xue47b4c9a2014-11-26 11:41:48 +0800922 struct tipc_msg *msg;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400923 unsigned int ack = mod(link->next_in_no - 1);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100924
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400925 while (skb_queue_len(&link->transmq) < link->window) {
926 skb = __skb_dequeue(&link->backlogq);
927 if (!skb)
Ying Xue47b4c9a2014-11-26 11:41:48 +0800928 break;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400929 msg = buf_msg(skb);
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400930 link->backlog[msg_importance(msg)].len--;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400931 msg_set_ack(msg, ack);
932 msg_set_bcast_ack(msg, link->owner->bclink.last_in);
933 link->rcv_unacked = 0;
934 __skb_queue_tail(&link->transmq, skb);
935 tipc_bearer_send(link->owner->net, link->bearer_id,
936 skb, &link->media_addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100937 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100938}
939
Ying Xue3f5a12b2014-05-05 08:56:17 +0800940void tipc_link_reset_all(struct tipc_node *node)
Allan Stephensd356eeb2006-06-25 23:40:01 -0700941{
Allan Stephensd356eeb2006-06-25 23:40:01 -0700942 char addr_string[16];
943 u32 i;
944
Ying Xue3f5a12b2014-05-05 08:56:17 +0800945 tipc_node_lock(node);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700946
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400947 pr_warn("Resetting all links to %s\n",
Ying Xue3f5a12b2014-05-05 08:56:17 +0800948 tipc_addr_string_fill(addr_string, node->addr));
Allan Stephensd356eeb2006-06-25 23:40:01 -0700949
950 for (i = 0; i < MAX_BEARERS; i++) {
Ying Xue3f5a12b2014-05-05 08:56:17 +0800951 if (node->links[i]) {
952 link_print(node->links[i], "Resetting link\n");
953 tipc_link_reset(node->links[i]);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700954 }
955 }
956
Ying Xue3f5a12b2014-05-05 08:56:17 +0800957 tipc_node_unlock(node);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700958}
959
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500960static void link_retransmit_failure(struct tipc_link *l_ptr,
Paul Gortmakerae8509c2013-06-17 10:54:47 -0400961 struct sk_buff *buf)
Allan Stephensd356eeb2006-06-25 23:40:01 -0700962{
963 struct tipc_msg *msg = buf_msg(buf);
Ying Xue1da46562015-01-09 15:27:07 +0800964 struct net *net = l_ptr->owner->net;
Allan Stephensd356eeb2006-06-25 23:40:01 -0700965
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400966 pr_warn("Retransmission failure on link <%s>\n", l_ptr->name);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700967
968 if (l_ptr->addr) {
Allan Stephensd356eeb2006-06-25 23:40:01 -0700969 /* Handle failure on standard link */
Allan Stephens8d64a5b2010-12-31 18:59:27 +0000970 link_print(l_ptr, "Resetting link\n");
Allan Stephensd356eeb2006-06-25 23:40:01 -0700971 tipc_link_reset(l_ptr);
972
973 } else {
Allan Stephensd356eeb2006-06-25 23:40:01 -0700974 /* Handle failure on broadcast link */
David S. Miller6c000552008-09-02 23:38:32 -0700975 struct tipc_node *n_ptr;
Allan Stephensd356eeb2006-06-25 23:40:01 -0700976 char addr_string[16];
977
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400978 pr_info("Msg seq number: %u, ", msg_seqno(msg));
979 pr_cont("Outstanding acks: %lu\n",
980 (unsigned long) TIPC_SKB_CB(buf)->handle);
Jeff Garzik617dbea2006-10-03 16:25:34 -0700981
Ying Xue1da46562015-01-09 15:27:07 +0800982 n_ptr = tipc_bclink_retransmit_to(net);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700983 tipc_node_lock(n_ptr);
984
Allan Stephensc68ca7b2010-05-11 14:30:12 +0000985 tipc_addr_string_fill(addr_string, n_ptr->addr);
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400986 pr_info("Broadcast link info for %s\n", addr_string);
Ying Xue389dd9b2012-11-16 13:51:30 +0800987 pr_info("Reception permitted: %d, Acked: %u\n",
988 n_ptr->bclink.recv_permitted,
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400989 n_ptr->bclink.acked);
990 pr_info("Last in: %u, Oos state: %u, Last sent: %u\n",
991 n_ptr->bclink.last_in,
992 n_ptr->bclink.oos_state,
993 n_ptr->bclink.last_sent);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700994
Allan Stephensd356eeb2006-06-25 23:40:01 -0700995 tipc_node_unlock(n_ptr);
996
Ying Xue1da46562015-01-09 15:27:07 +0800997 tipc_bclink_set_flags(net, TIPC_BCLINK_RESET);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700998 l_ptr->stale_count = 0;
999 }
1000}
1001
Ying Xue58dc55f2014-11-26 11:41:52 +08001002void tipc_link_retransmit(struct tipc_link *l_ptr, struct sk_buff *skb,
Per Liden4323add2006-01-18 00:38:21 +01001003 u32 retransmits)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001004{
1005 struct tipc_msg *msg;
1006
Ying Xue58dc55f2014-11-26 11:41:52 +08001007 if (!skb)
Allan Stephensd356eeb2006-06-25 23:40:01 -07001008 return;
1009
Ying Xue58dc55f2014-11-26 11:41:52 +08001010 msg = buf_msg(skb);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001011
Erik Hugne512137e2013-12-06 10:08:00 -05001012 /* Detect repeated retransmit failures */
1013 if (l_ptr->last_retransmitted == msg_seqno(msg)) {
1014 if (++l_ptr->stale_count > 100) {
Ying Xue58dc55f2014-11-26 11:41:52 +08001015 link_retransmit_failure(l_ptr, skb);
Erik Hugne512137e2013-12-06 10:08:00 -05001016 return;
Allan Stephensd356eeb2006-06-25 23:40:01 -07001017 }
1018 } else {
Erik Hugne512137e2013-12-06 10:08:00 -05001019 l_ptr->last_retransmitted = msg_seqno(msg);
1020 l_ptr->stale_count = 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001021 }
Allan Stephensd356eeb2006-06-25 23:40:01 -07001022
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001023 skb_queue_walk_from(&l_ptr->transmq, skb) {
1024 if (!retransmits)
Ying Xue58dc55f2014-11-26 11:41:52 +08001025 break;
1026 msg = buf_msg(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001027 msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001028 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Ying Xue7f9f95d2015-01-09 15:27:06 +08001029 tipc_bearer_send(l_ptr->owner->net, l_ptr->bearer_id, skb,
1030 &l_ptr->media_addr);
Ying Xue3c294cb2012-11-15 11:34:45 +08001031 retransmits--;
1032 l_ptr->stats.retransmitted++;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001033 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001034}
1035
Jon Paul Maloy8b4ed862015-03-25 12:07:26 -04001036/* link_synch(): check if all packets arrived before the synch
1037 * point have been consumed
1038 * Returns true if the parallel links are synched, otherwise false
1039 */
1040static bool link_synch(struct tipc_link *l)
1041{
1042 unsigned int post_synch;
1043 struct tipc_link *pl;
1044
1045 pl = tipc_parallel_link(l);
1046 if (pl == l)
1047 goto synched;
1048
1049 /* Was last pre-synch packet added to input queue ? */
1050 if (less_eq(pl->next_in_no, l->synch_point))
1051 return false;
1052
1053 /* Is it still in the input queue ? */
1054 post_synch = mod(pl->next_in_no - l->synch_point) - 1;
1055 if (skb_queue_len(&pl->inputq) > post_synch)
1056 return false;
1057synched:
1058 l->flags &= ~LINK_SYNCHING;
1059 return true;
1060}
1061
Ying Xuef03273f2014-11-26 11:41:54 +08001062static void link_retrieve_defq(struct tipc_link *link,
1063 struct sk_buff_head *list)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001064{
1065 u32 seq_no;
1066
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001067 if (skb_queue_empty(&link->deferdq))
Ying Xuef03273f2014-11-26 11:41:54 +08001068 return;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001069
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001070 seq_no = buf_seqno(skb_peek(&link->deferdq));
Ying Xuef03273f2014-11-26 11:41:54 +08001071 if (seq_no == mod(link->next_in_no))
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001072 skb_queue_splice_tail_init(&link->deferdq, list);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001073}
1074
Allan Stephens85035562008-04-15 19:04:54 -07001075/**
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001076 * tipc_rcv - process TIPC packets/messages arriving from off-node
Ying Xuef2f98002015-01-09 15:27:05 +08001077 * @net: the applicable net namespace
Ying Xuef03273f2014-11-26 11:41:54 +08001078 * @skb: TIPC packet
Ying Xue7a2f7d12014-04-21 10:55:46 +08001079 * @b_ptr: pointer to bearer message arrived on
Allan Stephensb02b69c2010-08-17 11:00:07 +00001080 *
1081 * Invoked with no locks held. Bearer pointer must point to a valid bearer
1082 * structure (i.e. cannot be NULL), but bearer can be inactive.
1083 */
Ying Xuec93d3ba2015-01-09 15:27:04 +08001084void tipc_rcv(struct net *net, struct sk_buff *skb, struct tipc_bearer *b_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001085{
Ying Xue34747532015-01-09 15:27:10 +08001086 struct tipc_net *tn = net_generic(net, tipc_net_id);
Ying Xuef03273f2014-11-26 11:41:54 +08001087 struct sk_buff_head head;
1088 struct tipc_node *n_ptr;
1089 struct tipc_link *l_ptr;
1090 struct sk_buff *skb1, *tmp;
1091 struct tipc_msg *msg;
1092 u32 seq_no;
1093 u32 ackd;
1094 u32 released;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001095
Ying Xuea6ca1092014-11-26 11:41:55 +08001096 skb2list(skb, &head);
Allan Stephens85035562008-04-15 19:04:54 -07001097
Ying Xuef03273f2014-11-26 11:41:54 +08001098 while ((skb = __skb_dequeue(&head))) {
Allan Stephens85035562008-04-15 19:04:54 -07001099 /* Ensure message is well-formed */
Jon Paul Maloycf2157f2015-03-13 16:08:06 -04001100 if (unlikely(!tipc_msg_validate(skb)))
Ying Xue3af390e2013-10-30 11:26:57 +08001101 goto discard;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001102
Allan Stephens85035562008-04-15 19:04:54 -07001103 /* Handle arrival of a non-unicast link message */
Ying Xuef03273f2014-11-26 11:41:54 +08001104 msg = buf_msg(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001105 if (unlikely(msg_non_seq(msg))) {
Allan Stephens1265a022008-06-04 17:32:35 -07001106 if (msg_user(msg) == LINK_CONFIG)
Ying Xuec93d3ba2015-01-09 15:27:04 +08001107 tipc_disc_rcv(net, skb, b_ptr);
Allan Stephens1265a022008-06-04 17:32:35 -07001108 else
Ying Xuec93d3ba2015-01-09 15:27:04 +08001109 tipc_bclink_rcv(net, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001110 continue;
1111 }
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001112
Allan Stephensed33a9c2011-04-05 15:15:04 -04001113 /* Discard unicast link messages destined for another node */
Allan Stephens26008242006-06-25 23:39:31 -07001114 if (unlikely(!msg_short(msg) &&
Ying Xue34747532015-01-09 15:27:10 +08001115 (msg_destnode(msg) != tn->own_addr)))
Ying Xue3af390e2013-10-30 11:26:57 +08001116 goto discard;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001117
Allan Stephens5a68d5e2010-08-17 11:00:16 +00001118 /* Locate neighboring node that sent message */
Ying Xuef2f98002015-01-09 15:27:05 +08001119 n_ptr = tipc_node_find(net, msg_prevnode(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001120 if (unlikely(!n_ptr))
Ying Xue3af390e2013-10-30 11:26:57 +08001121 goto discard;
Per Liden4323add2006-01-18 00:38:21 +01001122 tipc_node_lock(n_ptr);
Allan Stephens85035562008-04-15 19:04:54 -07001123
Allan Stephens5a68d5e2010-08-17 11:00:16 +00001124 /* Locate unicast link endpoint that should handle message */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001125 l_ptr = n_ptr->links[b_ptr->identity];
Ying Xue3af390e2013-10-30 11:26:57 +08001126 if (unlikely(!l_ptr))
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001127 goto unlock;
Allan Stephens85035562008-04-15 19:04:54 -07001128
Allan Stephensb4b56102011-05-27 11:00:51 -04001129 /* Verify that communication with node is currently allowed */
Ying Xueaecb9bb2014-05-08 08:54:39 +08001130 if ((n_ptr->action_flags & TIPC_WAIT_PEER_LINKS_DOWN) &&
Ying Xue10f465c2014-05-05 08:56:11 +08001131 msg_user(msg) == LINK_PROTOCOL &&
1132 (msg_type(msg) == RESET_MSG ||
1133 msg_type(msg) == ACTIVATE_MSG) &&
1134 !msg_redundant_link(msg))
Ying Xueaecb9bb2014-05-08 08:54:39 +08001135 n_ptr->action_flags &= ~TIPC_WAIT_PEER_LINKS_DOWN;
Allan Stephensb4b56102011-05-27 11:00:51 -04001136
Ying Xue10f465c2014-05-05 08:56:11 +08001137 if (tipc_node_blocked(n_ptr))
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001138 goto unlock;
Allan Stephensb4b56102011-05-27 11:00:51 -04001139
Allan Stephens85035562008-04-15 19:04:54 -07001140 /* Validate message sequence number info */
Allan Stephens85035562008-04-15 19:04:54 -07001141 seq_no = msg_seqno(msg);
1142 ackd = msg_ack(msg);
1143
1144 /* Release acked messages */
Jon Paul Maloy2cdf3912015-03-13 16:08:09 -04001145 if (unlikely(n_ptr->bclink.acked != msg_bcast_ack(msg)))
Allan Stephens365595912011-10-24 15:26:24 -04001146 tipc_bclink_acknowledge(n_ptr, msg_bcast_ack(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001147
Ying Xue58dc55f2014-11-26 11:41:52 +08001148 released = 0;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001149 skb_queue_walk_safe(&l_ptr->transmq, skb1, tmp) {
1150 if (more(buf_seqno(skb1), ackd))
Ying Xue58dc55f2014-11-26 11:41:52 +08001151 break;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001152 __skb_unlink(skb1, &l_ptr->transmq);
Ying Xue58dc55f2014-11-26 11:41:52 +08001153 kfree_skb(skb1);
1154 released = 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001155 }
Allan Stephens85035562008-04-15 19:04:54 -07001156
1157 /* Try sending any messages link endpoint has pending */
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001158 if (unlikely(skb_queue_len(&l_ptr->backlogq)))
Ying Xue47b4c9a2014-11-26 11:41:48 +08001159 tipc_link_push_packets(l_ptr);
Jon Paul Maloya5377832014-02-13 17:29:15 -05001160
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001161 if (released && !skb_queue_empty(&l_ptr->wakeupq))
Jon Paul Maloy50100a52014-08-22 18:09:07 -04001162 link_prepare_wakeup(l_ptr);
Jon Paul Maloya5377832014-02-13 17:29:15 -05001163
Jon Paul Maloya5377832014-02-13 17:29:15 -05001164 /* Process the incoming packet */
Ying Xue3af390e2013-10-30 11:26:57 +08001165 if (unlikely(!link_working_working(l_ptr))) {
1166 if (msg_user(msg) == LINK_PROTOCOL) {
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001167 tipc_link_proto_rcv(l_ptr, skb);
Ying Xuef03273f2014-11-26 11:41:54 +08001168 link_retrieve_defq(l_ptr, &head);
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001169 skb = NULL;
1170 goto unlock;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001171 }
Ying Xue3af390e2013-10-30 11:26:57 +08001172
1173 /* Traffic message. Conditionally activate link */
1174 link_state_event(l_ptr, TRAFFIC_MSG_EVT);
1175
1176 if (link_working_working(l_ptr)) {
1177 /* Re-insert buffer in front of queue */
Ying Xuef03273f2014-11-26 11:41:54 +08001178 __skb_queue_head(&head, skb);
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001179 skb = NULL;
1180 goto unlock;
Ying Xue3af390e2013-10-30 11:26:57 +08001181 }
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001182 goto unlock;
Ying Xue3af390e2013-10-30 11:26:57 +08001183 }
1184
1185 /* Link is now in state WORKING_WORKING */
1186 if (unlikely(seq_no != mod(l_ptr->next_in_no))) {
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001187 link_handle_out_of_seq_msg(l_ptr, skb);
Ying Xuef03273f2014-11-26 11:41:54 +08001188 link_retrieve_defq(l_ptr, &head);
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001189 skb = NULL;
1190 goto unlock;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001191 }
Jon Paul Maloy8b4ed862015-03-25 12:07:26 -04001192 /* Synchronize with parallel link if applicable */
1193 if (unlikely((l_ptr->flags & LINK_SYNCHING) && !msg_dup(msg))) {
1194 link_handle_out_of_seq_msg(l_ptr, skb);
1195 if (link_synch(l_ptr))
1196 link_retrieve_defq(l_ptr, &head);
1197 skb = NULL;
1198 goto unlock;
1199 }
Ying Xue3af390e2013-10-30 11:26:57 +08001200 l_ptr->next_in_no++;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001201 if (unlikely(!skb_queue_empty(&l_ptr->deferdq)))
Ying Xuef03273f2014-11-26 11:41:54 +08001202 link_retrieve_defq(l_ptr, &head);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001203 if (unlikely(++l_ptr->rcv_unacked >= TIPC_MIN_LINK_WIN)) {
Erik Hugne3f53bd82014-07-01 10:22:41 +02001204 l_ptr->stats.sent_acks++;
1205 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0, 0, 0, 0);
1206 }
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001207 tipc_link_input(l_ptr, skb);
1208 skb = NULL;
1209unlock:
Ying Xue3af390e2013-10-30 11:26:57 +08001210 tipc_node_unlock(n_ptr);
1211discard:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001212 if (unlikely(skb))
1213 kfree_skb(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001214 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001215}
1216
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001217/* tipc_data_input - deliver data and name distr msgs to upper layer
Erik Hugne7ae934b2014-07-01 10:22:40 +02001218 *
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001219 * Consumes buffer if message is of right type
Erik Hugne7ae934b2014-07-01 10:22:40 +02001220 * Node lock must be held
1221 */
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001222static bool tipc_data_input(struct tipc_link *link, struct sk_buff *skb)
Erik Hugne7ae934b2014-07-01 10:22:40 +02001223{
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001224 struct tipc_node *node = link->owner;
1225 struct tipc_msg *msg = buf_msg(skb);
1226 u32 dport = msg_destport(msg);
Erik Hugne7ae934b2014-07-01 10:22:40 +02001227
1228 switch (msg_user(msg)) {
1229 case TIPC_LOW_IMPORTANCE:
1230 case TIPC_MEDIUM_IMPORTANCE:
1231 case TIPC_HIGH_IMPORTANCE:
1232 case TIPC_CRITICAL_IMPORTANCE:
1233 case CONN_MANAGER:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001234 if (tipc_skb_queue_tail(&link->inputq, skb, dport)) {
1235 node->inputq = &link->inputq;
1236 node->action_flags |= TIPC_MSG_EVT;
1237 }
1238 return true;
Erik Hugne7ae934b2014-07-01 10:22:40 +02001239 case NAME_DISTRIBUTOR:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001240 node->bclink.recv_permitted = true;
1241 node->namedq = &link->namedq;
1242 skb_queue_tail(&link->namedq, skb);
1243 if (skb_queue_len(&link->namedq) == 1)
1244 node->action_flags |= TIPC_NAMED_MSG_EVT;
1245 return true;
Erik Hugne7ae934b2014-07-01 10:22:40 +02001246 case MSG_BUNDLER:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001247 case CHANGEOVER_PROTOCOL:
1248 case MSG_FRAGMENTER:
1249 case BCAST_PROTOCOL:
1250 return false;
1251 default:
1252 pr_warn("Dropping received illegal msg type\n");
1253 kfree_skb(skb);
1254 return false;
1255 };
1256}
1257
1258/* tipc_link_input - process packet that has passed link protocol check
1259 *
1260 * Consumes buffer
1261 * Node lock must be held
1262 */
1263static void tipc_link_input(struct tipc_link *link, struct sk_buff *skb)
1264{
1265 struct tipc_node *node = link->owner;
1266 struct tipc_msg *msg = buf_msg(skb);
1267 struct sk_buff *iskb;
1268 int pos = 0;
1269
1270 if (likely(tipc_data_input(link, skb)))
1271 return;
1272
1273 switch (msg_user(msg)) {
1274 case CHANGEOVER_PROTOCOL:
Jon Paul Maloy8b4ed862015-03-25 12:07:26 -04001275 if (msg_dup(msg)) {
1276 link->flags |= LINK_SYNCHING;
1277 link->synch_point = msg_seqno(msg_get_wrapped(msg));
1278 }
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001279 if (!tipc_link_tunnel_rcv(node, &skb))
1280 break;
1281 if (msg_user(buf_msg(skb)) != MSG_BUNDLER) {
1282 tipc_data_input(link, skb);
1283 break;
1284 }
1285 case MSG_BUNDLER:
1286 link->stats.recv_bundles++;
1287 link->stats.recv_bundled += msg_msgcnt(msg);
1288
1289 while (tipc_msg_extract(skb, &iskb, &pos))
1290 tipc_data_input(link, iskb);
1291 break;
1292 case MSG_FRAGMENTER:
1293 link->stats.recv_fragments++;
1294 if (tipc_buf_append(&link->reasm_buf, &skb)) {
1295 link->stats.recv_fragmented++;
1296 tipc_data_input(link, skb);
1297 } else if (!link->reasm_buf) {
1298 tipc_link_reset(link);
1299 }
1300 break;
1301 case BCAST_PROTOCOL:
1302 tipc_link_sync_rcv(node, skb);
Erik Hugne7ae934b2014-07-01 10:22:40 +02001303 break;
1304 default:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001305 break;
1306 };
Erik Hugne7ae934b2014-07-01 10:22:40 +02001307}
1308
1309/**
Allan Stephens8809b252011-10-25 10:44:35 -04001310 * tipc_link_defer_pkt - Add out-of-sequence message to deferred reception queue
1311 *
1312 * Returns increase in queue length (i.e. 0 or 1)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001313 */
Ying Xuebc6fecd2014-11-26 11:41:53 +08001314u32 tipc_link_defer_pkt(struct sk_buff_head *list, struct sk_buff *skb)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001315{
Ying Xuebc6fecd2014-11-26 11:41:53 +08001316 struct sk_buff *skb1;
1317 u32 seq_no = buf_seqno(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001318
1319 /* Empty queue ? */
Ying Xuebc6fecd2014-11-26 11:41:53 +08001320 if (skb_queue_empty(list)) {
1321 __skb_queue_tail(list, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001322 return 1;
1323 }
1324
1325 /* Last ? */
Ying Xuebc6fecd2014-11-26 11:41:53 +08001326 if (less(buf_seqno(skb_peek_tail(list)), seq_no)) {
1327 __skb_queue_tail(list, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001328 return 1;
1329 }
1330
Allan Stephens8809b252011-10-25 10:44:35 -04001331 /* Locate insertion point in queue, then insert; discard if duplicate */
Ying Xuebc6fecd2014-11-26 11:41:53 +08001332 skb_queue_walk(list, skb1) {
1333 u32 curr_seqno = buf_seqno(skb1);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001334
Allan Stephens8809b252011-10-25 10:44:35 -04001335 if (seq_no == curr_seqno) {
Ying Xuebc6fecd2014-11-26 11:41:53 +08001336 kfree_skb(skb);
Allan Stephens8809b252011-10-25 10:44:35 -04001337 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001338 }
Allan Stephens8809b252011-10-25 10:44:35 -04001339
1340 if (less(seq_no, curr_seqno))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001341 break;
Allan Stephens8809b252011-10-25 10:44:35 -04001342 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001343
Ying Xuebc6fecd2014-11-26 11:41:53 +08001344 __skb_queue_before(list, skb1, skb);
Allan Stephens8809b252011-10-25 10:44:35 -04001345 return 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001346}
1347
Allan Stephens8809b252011-10-25 10:44:35 -04001348/*
Per Lidenb97bf3f2006-01-02 19:04:38 +01001349 * link_handle_out_of_seq_msg - handle arrival of out-of-sequence packet
1350 */
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001351static void link_handle_out_of_seq_msg(struct tipc_link *l_ptr,
Per Lidenb97bf3f2006-01-02 19:04:38 +01001352 struct sk_buff *buf)
1353{
Allan Stephensf9057302011-10-24 16:03:12 -04001354 u32 seq_no = buf_seqno(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001355
1356 if (likely(msg_user(buf_msg(buf)) == LINK_PROTOCOL)) {
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001357 tipc_link_proto_rcv(l_ptr, buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001358 return;
1359 }
1360
Per Lidenb97bf3f2006-01-02 19:04:38 +01001361 /* Record OOS packet arrival (force mismatch on next timeout) */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001362 l_ptr->checkpoint--;
1363
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001364 /*
Per Lidenb97bf3f2006-01-02 19:04:38 +01001365 * Discard packet if a duplicate; otherwise add it to deferred queue
1366 * and notify peer of gap as per protocol specification
1367 */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001368 if (less(seq_no, mod(l_ptr->next_in_no))) {
1369 l_ptr->stats.duplicates++;
Allan Stephens5f6d9122011-11-04 13:24:29 -04001370 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001371 return;
1372 }
1373
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001374 if (tipc_link_defer_pkt(&l_ptr->deferdq, buf)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001375 l_ptr->stats.deferred_recv++;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001376 if ((skb_queue_len(&l_ptr->deferdq) % TIPC_MIN_LINK_WIN) == 1)
Ying Xue247f0f32014-02-18 16:06:46 +08001377 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0, 0, 0, 0);
Ying Xuebc6fecd2014-11-26 11:41:53 +08001378 } else {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001379 l_ptr->stats.duplicates++;
Ying Xuebc6fecd2014-11-26 11:41:53 +08001380 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001381}
1382
1383/*
1384 * Send protocol message to the other endpoint.
1385 */
Ying Xue247f0f32014-02-18 16:06:46 +08001386void tipc_link_proto_xmit(struct tipc_link *l_ptr, u32 msg_typ, int probe_msg,
1387 u32 gap, u32 tolerance, u32 priority, u32 ack_mtu)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001388{
Sam Ravnborg1fc54d82006-03-20 22:36:47 -08001389 struct sk_buff *buf = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001390 struct tipc_msg *msg = l_ptr->pmsg;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001391 u32 msg_size = sizeof(l_ptr->proto_msg);
Allan Stephens75f0aa42011-02-28 15:30:20 -05001392 int r_flag;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001393
Ying Xue77a7e072013-12-10 20:45:44 -08001394 /* Don't send protocol message during link changeover */
1395 if (l_ptr->exp_msg_count)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001396 return;
Allan Stephensb4b56102011-05-27 11:00:51 -04001397
1398 /* Abort non-RESET send if communication with node is prohibited */
Ying Xue10f465c2014-05-05 08:56:11 +08001399 if ((tipc_node_blocked(l_ptr->owner)) && (msg_typ != RESET_MSG))
Allan Stephensb4b56102011-05-27 11:00:51 -04001400 return;
1401
Allan Stephens92d2c902011-10-25 11:20:26 -04001402 /* Create protocol message with "out-of-sequence" sequence number */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001403 msg_set_type(msg, msg_typ);
Ying Xue7a2f7d12014-04-21 10:55:46 +08001404 msg_set_net_plane(msg, l_ptr->net_plane);
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001405 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Ying Xue1da46562015-01-09 15:27:07 +08001406 msg_set_last_bcast(msg, tipc_bclink_get_last_sent(l_ptr->owner->net));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001407
1408 if (msg_typ == STATE_MSG) {
1409 u32 next_sent = mod(l_ptr->next_out_no);
1410
Per Liden4323add2006-01-18 00:38:21 +01001411 if (!tipc_link_is_up(l_ptr))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001412 return;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001413 if (skb_queue_len(&l_ptr->backlogq))
1414 next_sent = buf_seqno(skb_peek(&l_ptr->backlogq));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001415 msg_set_next_sent(msg, next_sent);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001416 if (!skb_queue_empty(&l_ptr->deferdq)) {
1417 u32 rec = buf_seqno(skb_peek(&l_ptr->deferdq));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001418 gap = mod(rec - mod(l_ptr->next_in_no));
1419 }
1420 msg_set_seq_gap(msg, gap);
1421 if (gap)
1422 l_ptr->stats.sent_nacks++;
1423 msg_set_link_tolerance(msg, tolerance);
1424 msg_set_linkprio(msg, priority);
1425 msg_set_max_pkt(msg, ack_mtu);
1426 msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
1427 msg_set_probe(msg, probe_msg != 0);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001428 if (probe_msg) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001429 u32 mtu = l_ptr->max_pkt;
1430
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001431 if ((mtu < l_ptr->max_pkt_target) &&
Per Lidenb97bf3f2006-01-02 19:04:38 +01001432 link_working_working(l_ptr) &&
1433 l_ptr->fsm_msg_cnt) {
1434 msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001435 if (l_ptr->max_pkt_probes == 10) {
1436 l_ptr->max_pkt_target = (msg_size - 4);
1437 l_ptr->max_pkt_probes = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001438 msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001439 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001440 l_ptr->max_pkt_probes++;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001441 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001442
1443 l_ptr->stats.sent_probes++;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001444 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001445 l_ptr->stats.sent_states++;
1446 } else { /* RESET_MSG or ACTIVATE_MSG */
1447 msg_set_ack(msg, mod(l_ptr->reset_checkpoint - 1));
1448 msg_set_seq_gap(msg, 0);
1449 msg_set_next_sent(msg, 1);
Allan Stephensf23d9bf2011-01-18 15:15:34 -05001450 msg_set_probe(msg, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001451 msg_set_link_tolerance(msg, l_ptr->tolerance);
1452 msg_set_linkprio(msg, l_ptr->priority);
1453 msg_set_max_pkt(msg, l_ptr->max_pkt_target);
1454 }
1455
Allan Stephens75f0aa42011-02-28 15:30:20 -05001456 r_flag = (l_ptr->owner->working_links > tipc_link_is_up(l_ptr));
1457 msg_set_redundant_link(msg, r_flag);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001458 msg_set_linkprio(msg, l_ptr->priority);
Allan Stephens92d2c902011-10-25 11:20:26 -04001459 msg_set_size(msg, msg_size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001460
1461 msg_set_seqno(msg, mod(l_ptr->next_out_no + (0xffff/2)));
1462
stephen hemminger31e3c3f2010-10-13 13:20:35 +00001463 buf = tipc_buf_acquire(msg_size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001464 if (!buf)
1465 return;
1466
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03001467 skb_copy_to_linear_data(buf, msg, sizeof(l_ptr->proto_msg));
Ying Xue796c75d2013-06-17 10:54:48 -04001468 buf->priority = TC_PRIO_CONTROL;
Ying Xue7f9f95d2015-01-09 15:27:06 +08001469 tipc_bearer_send(l_ptr->owner->net, l_ptr->bearer_id, buf,
1470 &l_ptr->media_addr);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001471 l_ptr->rcv_unacked = 0;
Allan Stephens5f6d9122011-11-04 13:24:29 -04001472 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001473}
1474
1475/*
1476 * Receive protocol message :
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001477 * Note that network plane id propagates through the network, and may
1478 * change at any time. The node with lowest address rules
Per Lidenb97bf3f2006-01-02 19:04:38 +01001479 */
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001480static void tipc_link_proto_rcv(struct tipc_link *l_ptr,
Ying Xuec93d3ba2015-01-09 15:27:04 +08001481 struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001482{
1483 u32 rec_gap = 0;
1484 u32 max_pkt_info;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001485 u32 max_pkt_ack;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001486 u32 msg_tol;
1487 struct tipc_msg *msg = buf_msg(buf);
1488
Ying Xue77a7e072013-12-10 20:45:44 -08001489 /* Discard protocol message during link changeover */
1490 if (l_ptr->exp_msg_count)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001491 goto exit;
1492
Ying Xue7a2f7d12014-04-21 10:55:46 +08001493 if (l_ptr->net_plane != msg_net_plane(msg))
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001494 if (link_own_addr(l_ptr) > msg_prevnode(msg))
Ying Xue7a2f7d12014-04-21 10:55:46 +08001495 l_ptr->net_plane = msg_net_plane(msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001496
Per Lidenb97bf3f2006-01-02 19:04:38 +01001497 switch (msg_type(msg)) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001498
Per Lidenb97bf3f2006-01-02 19:04:38 +01001499 case RESET_MSG:
Allan Stephensa686e682008-06-04 17:29:39 -07001500 if (!link_working_unknown(l_ptr) &&
1501 (l_ptr->peer_session != INVALID_SESSION)) {
Allan Stephens641c2182011-04-07 09:54:43 -04001502 if (less_eq(msg_session(msg), l_ptr->peer_session))
1503 break; /* duplicate or old reset: ignore */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001504 }
Allan Stephensb4b56102011-05-27 11:00:51 -04001505
1506 if (!msg_redundant_link(msg) && (link_working_working(l_ptr) ||
1507 link_working_unknown(l_ptr))) {
1508 /*
1509 * peer has lost contact -- don't allow peer's links
1510 * to reactivate before we recognize loss & clean up
1511 */
Ying Xueca9cf062014-05-08 08:54:40 +08001512 l_ptr->owner->action_flags |= TIPC_WAIT_OWN_LINKS_DOWN;
Allan Stephensb4b56102011-05-27 11:00:51 -04001513 }
1514
Allan Stephens47361c82011-10-26 10:55:16 -04001515 link_state_event(l_ptr, RESET_MSG);
1516
Per Lidenb97bf3f2006-01-02 19:04:38 +01001517 /* fall thru' */
1518 case ACTIVATE_MSG:
1519 /* Update link settings according other endpoint's values */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001520 strcpy((strrchr(l_ptr->name, ':') + 1), (char *)msg_data(msg));
1521
Allan Stephens2db99832010-12-31 18:59:33 +00001522 msg_tol = msg_link_tolerance(msg);
1523 if (msg_tol > l_ptr->tolerance)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001524 link_set_supervision_props(l_ptr, msg_tol);
1525
1526 if (msg_linkprio(msg) > l_ptr->priority)
1527 l_ptr->priority = msg_linkprio(msg);
1528
1529 max_pkt_info = msg_max_pkt(msg);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001530 if (max_pkt_info) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001531 if (max_pkt_info < l_ptr->max_pkt_target)
1532 l_ptr->max_pkt_target = max_pkt_info;
1533 if (l_ptr->max_pkt > l_ptr->max_pkt_target)
1534 l_ptr->max_pkt = l_ptr->max_pkt_target;
1535 } else {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001536 l_ptr->max_pkt = l_ptr->max_pkt_target;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001537 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001538
Allan Stephens4d753132011-10-25 12:19:05 -04001539 /* Synchronize broadcast link info, if not done previously */
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001540 if (!tipc_node_is_up(l_ptr->owner)) {
1541 l_ptr->owner->bclink.last_sent =
1542 l_ptr->owner->bclink.last_in =
1543 msg_last_bcast(msg);
1544 l_ptr->owner->bclink.oos_state = 0;
1545 }
Allan Stephens4d753132011-10-25 12:19:05 -04001546
Per Lidenb97bf3f2006-01-02 19:04:38 +01001547 l_ptr->peer_session = msg_session(msg);
1548 l_ptr->peer_bearer_id = msg_bearer_id(msg);
Allan Stephens47361c82011-10-26 10:55:16 -04001549
1550 if (msg_type(msg) == ACTIVATE_MSG)
1551 link_state_event(l_ptr, ACTIVATE_MSG);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001552 break;
1553 case STATE_MSG:
1554
Allan Stephens2db99832010-12-31 18:59:33 +00001555 msg_tol = msg_link_tolerance(msg);
1556 if (msg_tol)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001557 link_set_supervision_props(l_ptr, msg_tol);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001558
1559 if (msg_linkprio(msg) &&
Per Lidenb97bf3f2006-01-02 19:04:38 +01001560 (msg_linkprio(msg) != l_ptr->priority)) {
Erik Hugne3fa9cac2015-01-22 17:10:31 +01001561 pr_debug("%s<%s>, priority change %u->%u\n",
1562 link_rst_msg, l_ptr->name,
1563 l_ptr->priority, msg_linkprio(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001564 l_ptr->priority = msg_linkprio(msg);
Per Liden4323add2006-01-18 00:38:21 +01001565 tipc_link_reset(l_ptr); /* Enforce change to take effect */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001566 break;
1567 }
Jon Paul Maloyec37dcd2014-05-14 05:39:10 -04001568
1569 /* Record reception; force mismatch at next timeout: */
1570 l_ptr->checkpoint--;
1571
Per Lidenb97bf3f2006-01-02 19:04:38 +01001572 link_state_event(l_ptr, TRAFFIC_MSG_EVT);
1573 l_ptr->stats.recv_states++;
1574 if (link_reset_unknown(l_ptr))
1575 break;
1576
1577 if (less_eq(mod(l_ptr->next_in_no), msg_next_sent(msg))) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001578 rec_gap = mod(msg_next_sent(msg) -
Per Lidenb97bf3f2006-01-02 19:04:38 +01001579 mod(l_ptr->next_in_no));
1580 }
1581
1582 max_pkt_ack = msg_max_pkt(msg);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001583 if (max_pkt_ack > l_ptr->max_pkt) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001584 l_ptr->max_pkt = max_pkt_ack;
1585 l_ptr->max_pkt_probes = 0;
1586 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001587
1588 max_pkt_ack = 0;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001589 if (msg_probe(msg)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001590 l_ptr->stats.recv_probes++;
Allan Stephensa0168922010-12-31 18:59:35 +00001591 if (msg_size(msg) > sizeof(l_ptr->proto_msg))
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001592 max_pkt_ack = msg_size(msg);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001593 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001594
1595 /* Protocol message before retransmits, reduce loss risk */
Ying Xue389dd9b2012-11-16 13:51:30 +08001596 if (l_ptr->owner->bclink.recv_permitted)
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001597 tipc_bclink_update_link_state(l_ptr->owner,
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001598 msg_last_bcast(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001599
1600 if (rec_gap || (msg_probe(msg))) {
Ying Xue247f0f32014-02-18 16:06:46 +08001601 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, rec_gap, 0,
1602 0, max_pkt_ack);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001603 }
1604 if (msg_seq_gap(msg)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001605 l_ptr->stats.recv_nacks++;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001606 tipc_link_retransmit(l_ptr, skb_peek(&l_ptr->transmq),
Per Liden4323add2006-01-18 00:38:21 +01001607 msg_seq_gap(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001608 }
1609 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001610 }
1611exit:
Allan Stephens5f6d9122011-11-04 13:24:29 -04001612 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001613}
1614
1615
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001616/* tipc_link_tunnel_xmit(): Tunnel one packet via a link belonging to
1617 * a different bearer. Owner node is locked.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001618 */
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001619static void tipc_link_tunnel_xmit(struct tipc_link *l_ptr,
1620 struct tipc_msg *tunnel_hdr,
1621 struct tipc_msg *msg,
1622 u32 selector)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001623{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001624 struct tipc_link *tunnel;
Ying Xuea6ca1092014-11-26 11:41:55 +08001625 struct sk_buff *skb;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001626 u32 length = msg_size(msg);
1627
1628 tunnel = l_ptr->owner->active_links[selector & 1];
Allan Stephens5392d642006-06-25 23:52:50 -07001629 if (!tipc_link_is_up(tunnel)) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001630 pr_warn("%stunnel link no longer available\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001631 return;
Allan Stephens5392d642006-06-25 23:52:50 -07001632 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001633 msg_set_size(tunnel_hdr, length + INT_H_SIZE);
Ying Xuea6ca1092014-11-26 11:41:55 +08001634 skb = tipc_buf_acquire(length + INT_H_SIZE);
1635 if (!skb) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001636 pr_warn("%sunable to send tunnel msg\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001637 return;
Allan Stephens5392d642006-06-25 23:52:50 -07001638 }
Ying Xuea6ca1092014-11-26 11:41:55 +08001639 skb_copy_to_linear_data(skb, tunnel_hdr, INT_H_SIZE);
1640 skb_copy_to_linear_data_offset(skb, INT_H_SIZE, msg, length);
1641 __tipc_link_xmit_skb(tunnel, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001642}
1643
1644
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001645/* tipc_link_failover_send_queue(): A link has gone down, but a second
1646 * link is still active. We can do failover. Tunnel the failing link's
1647 * whole send queue via the remaining link. This way, we don't lose
1648 * any packets, and sequence order is preserved for subsequent traffic
1649 * sent over the remaining link. Owner node is locked.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001650 */
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001651void tipc_link_failover_send_queue(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001652{
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001653 int msgcount;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001654 struct tipc_link *tunnel = l_ptr->owner->active_links[0];
Per Lidenb97bf3f2006-01-02 19:04:38 +01001655 struct tipc_msg tunnel_hdr;
Ying Xue58dc55f2014-11-26 11:41:52 +08001656 struct sk_buff *skb;
Allan Stephens5392d642006-06-25 23:52:50 -07001657 int split_bundles;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001658
1659 if (!tunnel)
1660 return;
1661
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001662 tipc_msg_init(link_own_addr(l_ptr), &tunnel_hdr, CHANGEOVER_PROTOCOL,
Ying Xue34747532015-01-09 15:27:10 +08001663 ORIGINAL_MSG, INT_H_SIZE, l_ptr->addr);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001664 skb_queue_splice_tail_init(&l_ptr->backlogq, &l_ptr->transmq);
Jon Paul Maloy1f66d162015-03-25 12:07:24 -04001665 tipc_link_purge_backlog(l_ptr);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001666 msgcount = skb_queue_len(&l_ptr->transmq);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001667 msg_set_bearer_id(&tunnel_hdr, l_ptr->peer_bearer_id);
1668 msg_set_msgcnt(&tunnel_hdr, msgcount);
Allan Stephensf1310722006-06-25 23:51:37 -07001669
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001670 if (skb_queue_empty(&l_ptr->transmq)) {
Ying Xue58dc55f2014-11-26 11:41:52 +08001671 skb = tipc_buf_acquire(INT_H_SIZE);
1672 if (skb) {
1673 skb_copy_to_linear_data(skb, &tunnel_hdr, INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001674 msg_set_size(&tunnel_hdr, INT_H_SIZE);
Ying Xuea6ca1092014-11-26 11:41:55 +08001675 __tipc_link_xmit_skb(tunnel, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001676 } else {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001677 pr_warn("%sunable to send changeover msg\n",
1678 link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001679 }
1680 return;
1681 }
Allan Stephensf1310722006-06-25 23:51:37 -07001682
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001683 split_bundles = (l_ptr->owner->active_links[0] !=
Allan Stephens5392d642006-06-25 23:52:50 -07001684 l_ptr->owner->active_links[1]);
1685
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001686 skb_queue_walk(&l_ptr->transmq, skb) {
Ying Xue58dc55f2014-11-26 11:41:52 +08001687 struct tipc_msg *msg = buf_msg(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001688
1689 if ((msg_user(msg) == MSG_BUNDLER) && split_bundles) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001690 struct tipc_msg *m = msg_get_wrapped(msg);
Allan Stephens0e659672010-12-31 18:59:32 +00001691 unchar *pos = (unchar *)m;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001692
Florian Westphald788d802007-08-02 19:28:06 -07001693 msgcount = msg_msgcnt(msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001694 while (msgcount--) {
Allan Stephens0e659672010-12-31 18:59:32 +00001695 msg_set_seqno(m, msg_seqno(msg));
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001696 tipc_link_tunnel_xmit(l_ptr, &tunnel_hdr, m,
1697 msg_link_selector(m));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001698 pos += align(msg_size(m));
1699 m = (struct tipc_msg *)pos;
1700 }
1701 } else {
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001702 tipc_link_tunnel_xmit(l_ptr, &tunnel_hdr, msg,
1703 msg_link_selector(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001704 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001705 }
1706}
1707
Ying Xue247f0f32014-02-18 16:06:46 +08001708/* tipc_link_dup_queue_xmit(): A second link has become active. Tunnel a
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001709 * duplicate of the first link's send queue via the new link. This way, we
1710 * are guaranteed that currently queued packets from a socket are delivered
1711 * before future traffic from the same socket, even if this is using the
1712 * new link. The last arriving copy of each duplicate packet is dropped at
1713 * the receiving end by the regular protocol check, so packet cardinality
1714 * and sequence order is preserved per sender/receiver socket pair.
1715 * Owner node is locked.
1716 */
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001717void tipc_link_dup_queue_xmit(struct tipc_link *link,
1718 struct tipc_link *tnl)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001719{
Ying Xue58dc55f2014-11-26 11:41:52 +08001720 struct sk_buff *skb;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001721 struct tipc_msg tnl_hdr;
1722 struct sk_buff_head *queue = &link->transmq;
1723 int mcnt;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001724
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001725 tipc_msg_init(link_own_addr(link), &tnl_hdr, CHANGEOVER_PROTOCOL,
1726 DUPLICATE_MSG, INT_H_SIZE, link->addr);
1727 mcnt = skb_queue_len(&link->transmq) + skb_queue_len(&link->backlogq);
1728 msg_set_msgcnt(&tnl_hdr, mcnt);
1729 msg_set_bearer_id(&tnl_hdr, link->peer_bearer_id);
1730
1731tunnel_queue:
1732 skb_queue_walk(queue, skb) {
Ying Xue58dc55f2014-11-26 11:41:52 +08001733 struct sk_buff *outskb;
1734 struct tipc_msg *msg = buf_msg(skb);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001735 u32 len = msg_size(msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001736
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001737 msg_set_ack(msg, mod(link->next_in_no - 1));
1738 msg_set_bcast_ack(msg, link->owner->bclink.last_in);
1739 msg_set_size(&tnl_hdr, len + INT_H_SIZE);
1740 outskb = tipc_buf_acquire(len + INT_H_SIZE);
Ying Xue58dc55f2014-11-26 11:41:52 +08001741 if (outskb == NULL) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001742 pr_warn("%sunable to send duplicate msg\n",
1743 link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001744 return;
1745 }
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001746 skb_copy_to_linear_data(outskb, &tnl_hdr, INT_H_SIZE);
1747 skb_copy_to_linear_data_offset(outskb, INT_H_SIZE,
1748 skb->data, len);
1749 __tipc_link_xmit_skb(tnl, outskb);
1750 if (!tipc_link_is_up(link))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001751 return;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001752 }
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001753 if (queue == &link->backlogq)
1754 return;
1755 queue = &link->backlogq;
1756 goto tunnel_queue;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001757}
1758
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001759/* tipc_link_dup_rcv(): Receive a tunnelled DUPLICATE_MSG packet.
1760 * Owner node is locked.
1761 */
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001762static void tipc_link_dup_rcv(struct tipc_link *link,
1763 struct sk_buff *skb)
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001764{
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001765 struct sk_buff *iskb;
1766 int pos = 0;
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001767
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001768 if (!tipc_link_is_up(link))
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001769 return;
1770
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001771 if (!tipc_msg_extract(skb, &iskb, &pos)) {
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001772 pr_warn("%sfailed to extract inner dup pkt\n", link_co_err);
1773 return;
1774 }
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001775 /* Append buffer to deferred queue, if applicable: */
1776 link_handle_out_of_seq_msg(link, iskb);
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001777}
1778
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001779/* tipc_link_failover_rcv(): Receive a tunnelled ORIGINAL_MSG packet
1780 * Owner node is locked.
1781 */
1782static struct sk_buff *tipc_link_failover_rcv(struct tipc_link *l_ptr,
1783 struct sk_buff *t_buf)
1784{
1785 struct tipc_msg *t_msg = buf_msg(t_buf);
1786 struct sk_buff *buf = NULL;
1787 struct tipc_msg *msg;
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001788 int pos = 0;
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001789
1790 if (tipc_link_is_up(l_ptr))
1791 tipc_link_reset(l_ptr);
1792
1793 /* First failover packet? */
1794 if (l_ptr->exp_msg_count == START_CHANGEOVER)
1795 l_ptr->exp_msg_count = msg_msgcnt(t_msg);
1796
1797 /* Should there be an inner packet? */
1798 if (l_ptr->exp_msg_count) {
1799 l_ptr->exp_msg_count--;
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001800 if (!tipc_msg_extract(t_buf, &buf, &pos)) {
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001801 pr_warn("%sno inner failover pkt\n", link_co_err);
1802 goto exit;
1803 }
1804 msg = buf_msg(buf);
1805
1806 if (less(msg_seqno(msg), l_ptr->reset_checkpoint)) {
1807 kfree_skb(buf);
1808 buf = NULL;
1809 goto exit;
1810 }
1811 if (msg_user(msg) == MSG_FRAGMENTER) {
1812 l_ptr->stats.recv_fragments++;
Jon Paul Maloy37e22162014-05-14 05:39:12 -04001813 tipc_buf_append(&l_ptr->reasm_buf, &buf);
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001814 }
1815 }
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001816exit:
Jon Paul Maloy2d72d492015-02-03 08:59:17 -05001817 if ((!l_ptr->exp_msg_count) && (l_ptr->flags & LINK_STOPPED))
1818 tipc_link_delete(l_ptr);
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001819 return buf;
1820}
1821
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001822/* tipc_link_tunnel_rcv(): Receive a tunnelled packet, sent
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001823 * via other link as result of a failover (ORIGINAL_MSG) or
1824 * a new active link (DUPLICATE_MSG). Failover packets are
1825 * returned to the active link for delivery upwards.
1826 * Owner node is locked.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001827 */
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001828static int tipc_link_tunnel_rcv(struct tipc_node *n_ptr,
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001829 struct sk_buff **buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001830{
Jon Paul Maloy02842f72014-02-13 17:29:14 -05001831 struct sk_buff *t_buf = *buf;
1832 struct tipc_link *l_ptr;
1833 struct tipc_msg *t_msg = buf_msg(t_buf);
1834 u32 bearer_id = msg_bearer_id(t_msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001835
Jon Paul Maloy1e9d47a2014-02-13 17:29:13 -05001836 *buf = NULL;
1837
Dan Carpentercb4b102f2013-05-06 08:28:41 +00001838 if (bearer_id >= MAX_BEARERS)
1839 goto exit;
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001840
Jon Paul Maloy02842f72014-02-13 17:29:14 -05001841 l_ptr = n_ptr->links[bearer_id];
1842 if (!l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001843 goto exit;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001844
Jon Paul Maloy02842f72014-02-13 17:29:14 -05001845 if (msg_type(t_msg) == DUPLICATE_MSG)
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001846 tipc_link_dup_rcv(l_ptr, t_buf);
Jon Paul Maloy02842f72014-02-13 17:29:14 -05001847 else if (msg_type(t_msg) == ORIGINAL_MSG)
1848 *buf = tipc_link_failover_rcv(l_ptr, t_buf);
Jon Paul Maloy1e9d47a2014-02-13 17:29:13 -05001849 else
1850 pr_warn("%sunknown tunnel pkt received\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001851exit:
Jon Paul Maloy02842f72014-02-13 17:29:14 -05001852 kfree_skb(t_buf);
Jon Paul Maloy1e9d47a2014-02-13 17:29:13 -05001853 return *buf != NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001854}
1855
Ying Xue2f55c432015-01-09 15:27:00 +08001856static void link_set_supervision_props(struct tipc_link *l_ptr, u32 tol)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001857{
Ying Xue2f55c432015-01-09 15:27:00 +08001858 unsigned long intv = ((tol / 4) > 500) ? 500 : tol / 4;
1859
1860 if ((tol < TIPC_MIN_LINK_TOL) || (tol > TIPC_MAX_LINK_TOL))
Allan Stephens5413b4c2011-01-18 13:24:55 -05001861 return;
1862
Ying Xue2f55c432015-01-09 15:27:00 +08001863 l_ptr->tolerance = tol;
1864 l_ptr->cont_intv = msecs_to_jiffies(intv);
1865 l_ptr->abort_limit = tol / (jiffies_to_msecs(l_ptr->cont_intv) / 4);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001866}
1867
Jon Paul Maloye3eea1e2015-03-13 16:08:11 -04001868void tipc_link_set_queue_limits(struct tipc_link *l, u32 win)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001869{
Jon Paul Maloye3eea1e2015-03-13 16:08:11 -04001870 int max_bulk = TIPC_MAX_PUBLICATIONS / (l->max_pkt / ITEM_SIZE);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001871
Jon Paul Maloye3eea1e2015-03-13 16:08:11 -04001872 l->window = win;
Jon Paul Maloy1f66d162015-03-25 12:07:24 -04001873 l->backlog[TIPC_LOW_IMPORTANCE].limit = win / 2;
1874 l->backlog[TIPC_MEDIUM_IMPORTANCE].limit = win;
1875 l->backlog[TIPC_HIGH_IMPORTANCE].limit = win / 2 * 3;
1876 l->backlog[TIPC_CRITICAL_IMPORTANCE].limit = win * 2;
1877 l->backlog[TIPC_SYSTEM_IMPORTANCE].limit = max_bulk;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001878}
1879
Jon Paul Maloye099e862014-02-13 17:29:18 -05001880/* tipc_link_find_owner - locate owner node of link by link's name
Ying Xuef2f98002015-01-09 15:27:05 +08001881 * @net: the applicable net namespace
Jon Paul Maloye099e862014-02-13 17:29:18 -05001882 * @name: pointer to link name string
1883 * @bearer_id: pointer to index in 'node->links' array where the link was found.
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001884 *
Jon Paul Maloye099e862014-02-13 17:29:18 -05001885 * Returns pointer to node owning the link, or 0 if no matching link is found.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001886 */
Ying Xuef2f98002015-01-09 15:27:05 +08001887static struct tipc_node *tipc_link_find_owner(struct net *net,
1888 const char *link_name,
Jon Paul Maloye099e862014-02-13 17:29:18 -05001889 unsigned int *bearer_id)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001890{
Ying Xuef2f98002015-01-09 15:27:05 +08001891 struct tipc_net *tn = net_generic(net, tipc_net_id);
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001892 struct tipc_link *l_ptr;
Erik Hugnebbfbe472013-10-18 07:23:21 +02001893 struct tipc_node *n_ptr;
Fabian Frederick886eaa12014-12-25 12:05:50 +01001894 struct tipc_node *found_node = NULL;
Erik Hugnebbfbe472013-10-18 07:23:21 +02001895 int i;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001896
Jon Paul Maloye099e862014-02-13 17:29:18 -05001897 *bearer_id = 0;
Ying Xue6c7a7622014-03-27 12:54:37 +08001898 rcu_read_lock();
Ying Xuef2f98002015-01-09 15:27:05 +08001899 list_for_each_entry_rcu(n_ptr, &tn->node_list, list) {
Jon Paul Maloya11607f2014-02-14 16:40:44 -05001900 tipc_node_lock(n_ptr);
Erik Hugnebbfbe472013-10-18 07:23:21 +02001901 for (i = 0; i < MAX_BEARERS; i++) {
1902 l_ptr = n_ptr->links[i];
Jon Paul Maloye099e862014-02-13 17:29:18 -05001903 if (l_ptr && !strcmp(l_ptr->name, link_name)) {
1904 *bearer_id = i;
1905 found_node = n_ptr;
1906 break;
1907 }
Erik Hugnebbfbe472013-10-18 07:23:21 +02001908 }
Jon Paul Maloya11607f2014-02-14 16:40:44 -05001909 tipc_node_unlock(n_ptr);
Jon Paul Maloye099e862014-02-13 17:29:18 -05001910 if (found_node)
1911 break;
Erik Hugnebbfbe472013-10-18 07:23:21 +02001912 }
Ying Xue6c7a7622014-03-27 12:54:37 +08001913 rcu_read_unlock();
1914
Jon Paul Maloye099e862014-02-13 17:29:18 -05001915 return found_node;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001916}
1917
Allan Stephens5c216e12011-10-18 11:34:29 -04001918/**
Per Lidenb97bf3f2006-01-02 19:04:38 +01001919 * link_reset_statistics - reset link statistics
1920 * @l_ptr: pointer to link
1921 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001922static void link_reset_statistics(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001923{
1924 memset(&l_ptr->stats, 0, sizeof(l_ptr->stats));
1925 l_ptr->stats.sent_info = l_ptr->next_out_no;
1926 l_ptr->stats.recv_info = l_ptr->next_in_no;
1927}
1928
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001929static void link_print(struct tipc_link *l_ptr, const char *str)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001930{
Ying Xue7f9f95d2015-01-09 15:27:06 +08001931 struct tipc_net *tn = net_generic(l_ptr->owner->net, tipc_net_id);
Ying Xue7a2f7d12014-04-21 10:55:46 +08001932 struct tipc_bearer *b_ptr;
1933
1934 rcu_read_lock();
Ying Xue7f9f95d2015-01-09 15:27:06 +08001935 b_ptr = rcu_dereference_rtnl(tn->bearer_list[l_ptr->bearer_id]);
Ying Xue7a2f7d12014-04-21 10:55:46 +08001936 if (b_ptr)
1937 pr_info("%s Link %x<%s>:", str, l_ptr->addr, b_ptr->name);
1938 rcu_read_unlock();
Allan Stephens8d64a5b2010-12-31 18:59:27 +00001939
Per Lidenb97bf3f2006-01-02 19:04:38 +01001940 if (link_working_unknown(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04001941 pr_cont(":WU\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00001942 else if (link_reset_reset(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04001943 pr_cont(":RR\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00001944 else if (link_reset_unknown(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04001945 pr_cont(":RU\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00001946 else if (link_working_working(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04001947 pr_cont(":WW\n");
1948 else
1949 pr_cont("\n");
Per Lidenb97bf3f2006-01-02 19:04:38 +01001950}
Richard Alpe0655f6a2014-11-20 10:29:07 +01001951
1952/* Parse and validate nested (link) properties valid for media, bearer and link
1953 */
1954int tipc_nl_parse_link_prop(struct nlattr *prop, struct nlattr *props[])
1955{
1956 int err;
1957
1958 err = nla_parse_nested(props, TIPC_NLA_PROP_MAX, prop,
1959 tipc_nl_prop_policy);
1960 if (err)
1961 return err;
1962
1963 if (props[TIPC_NLA_PROP_PRIO]) {
1964 u32 prio;
1965
1966 prio = nla_get_u32(props[TIPC_NLA_PROP_PRIO]);
1967 if (prio > TIPC_MAX_LINK_PRI)
1968 return -EINVAL;
1969 }
1970
1971 if (props[TIPC_NLA_PROP_TOL]) {
1972 u32 tol;
1973
1974 tol = nla_get_u32(props[TIPC_NLA_PROP_TOL]);
1975 if ((tol < TIPC_MIN_LINK_TOL) || (tol > TIPC_MAX_LINK_TOL))
1976 return -EINVAL;
1977 }
1978
1979 if (props[TIPC_NLA_PROP_WIN]) {
1980 u32 win;
1981
1982 win = nla_get_u32(props[TIPC_NLA_PROP_WIN]);
1983 if ((win < TIPC_MIN_LINK_WIN) || (win > TIPC_MAX_LINK_WIN))
1984 return -EINVAL;
1985 }
1986
1987 return 0;
1988}
Richard Alpe7be57fc2014-11-20 10:29:12 +01001989
Richard Alpef96ce7a2014-11-20 10:29:13 +01001990int tipc_nl_link_set(struct sk_buff *skb, struct genl_info *info)
1991{
1992 int err;
1993 int res = 0;
1994 int bearer_id;
1995 char *name;
1996 struct tipc_link *link;
1997 struct tipc_node *node;
1998 struct nlattr *attrs[TIPC_NLA_LINK_MAX + 1];
Richard Alpe37e2d482015-02-09 09:50:08 +01001999 struct net *net = sock_net(skb->sk);
Richard Alpef96ce7a2014-11-20 10:29:13 +01002000
2001 if (!info->attrs[TIPC_NLA_LINK])
2002 return -EINVAL;
2003
2004 err = nla_parse_nested(attrs, TIPC_NLA_LINK_MAX,
2005 info->attrs[TIPC_NLA_LINK],
2006 tipc_nl_link_policy);
2007 if (err)
2008 return err;
2009
2010 if (!attrs[TIPC_NLA_LINK_NAME])
2011 return -EINVAL;
2012
2013 name = nla_data(attrs[TIPC_NLA_LINK_NAME]);
2014
Ying Xuef2f98002015-01-09 15:27:05 +08002015 node = tipc_link_find_owner(net, name, &bearer_id);
Richard Alpef96ce7a2014-11-20 10:29:13 +01002016 if (!node)
2017 return -EINVAL;
2018
2019 tipc_node_lock(node);
2020
2021 link = node->links[bearer_id];
2022 if (!link) {
2023 res = -EINVAL;
2024 goto out;
2025 }
2026
2027 if (attrs[TIPC_NLA_LINK_PROP]) {
2028 struct nlattr *props[TIPC_NLA_PROP_MAX + 1];
2029
2030 err = tipc_nl_parse_link_prop(attrs[TIPC_NLA_LINK_PROP],
2031 props);
2032 if (err) {
2033 res = err;
2034 goto out;
2035 }
2036
2037 if (props[TIPC_NLA_PROP_TOL]) {
2038 u32 tol;
2039
2040 tol = nla_get_u32(props[TIPC_NLA_PROP_TOL]);
2041 link_set_supervision_props(link, tol);
2042 tipc_link_proto_xmit(link, STATE_MSG, 0, 0, tol, 0, 0);
2043 }
2044 if (props[TIPC_NLA_PROP_PRIO]) {
2045 u32 prio;
2046
2047 prio = nla_get_u32(props[TIPC_NLA_PROP_PRIO]);
2048 link->priority = prio;
2049 tipc_link_proto_xmit(link, STATE_MSG, 0, 0, 0, prio, 0);
2050 }
2051 if (props[TIPC_NLA_PROP_WIN]) {
2052 u32 win;
2053
2054 win = nla_get_u32(props[TIPC_NLA_PROP_WIN]);
2055 tipc_link_set_queue_limits(link, win);
2056 }
2057 }
2058
2059out:
2060 tipc_node_unlock(node);
2061
2062 return res;
2063}
Richard Alped8182802014-11-24 11:10:29 +01002064
2065static int __tipc_nl_add_stats(struct sk_buff *skb, struct tipc_stats *s)
Richard Alpe7be57fc2014-11-20 10:29:12 +01002066{
2067 int i;
2068 struct nlattr *stats;
2069
2070 struct nla_map {
2071 u32 key;
2072 u32 val;
2073 };
2074
2075 struct nla_map map[] = {
2076 {TIPC_NLA_STATS_RX_INFO, s->recv_info},
2077 {TIPC_NLA_STATS_RX_FRAGMENTS, s->recv_fragments},
2078 {TIPC_NLA_STATS_RX_FRAGMENTED, s->recv_fragmented},
2079 {TIPC_NLA_STATS_RX_BUNDLES, s->recv_bundles},
2080 {TIPC_NLA_STATS_RX_BUNDLED, s->recv_bundled},
2081 {TIPC_NLA_STATS_TX_INFO, s->sent_info},
2082 {TIPC_NLA_STATS_TX_FRAGMENTS, s->sent_fragments},
2083 {TIPC_NLA_STATS_TX_FRAGMENTED, s->sent_fragmented},
2084 {TIPC_NLA_STATS_TX_BUNDLES, s->sent_bundles},
2085 {TIPC_NLA_STATS_TX_BUNDLED, s->sent_bundled},
2086 {TIPC_NLA_STATS_MSG_PROF_TOT, (s->msg_length_counts) ?
2087 s->msg_length_counts : 1},
2088 {TIPC_NLA_STATS_MSG_LEN_CNT, s->msg_length_counts},
2089 {TIPC_NLA_STATS_MSG_LEN_TOT, s->msg_lengths_total},
2090 {TIPC_NLA_STATS_MSG_LEN_P0, s->msg_length_profile[0]},
2091 {TIPC_NLA_STATS_MSG_LEN_P1, s->msg_length_profile[1]},
2092 {TIPC_NLA_STATS_MSG_LEN_P2, s->msg_length_profile[2]},
2093 {TIPC_NLA_STATS_MSG_LEN_P3, s->msg_length_profile[3]},
2094 {TIPC_NLA_STATS_MSG_LEN_P4, s->msg_length_profile[4]},
2095 {TIPC_NLA_STATS_MSG_LEN_P5, s->msg_length_profile[5]},
2096 {TIPC_NLA_STATS_MSG_LEN_P6, s->msg_length_profile[6]},
2097 {TIPC_NLA_STATS_RX_STATES, s->recv_states},
2098 {TIPC_NLA_STATS_RX_PROBES, s->recv_probes},
2099 {TIPC_NLA_STATS_RX_NACKS, s->recv_nacks},
2100 {TIPC_NLA_STATS_RX_DEFERRED, s->deferred_recv},
2101 {TIPC_NLA_STATS_TX_STATES, s->sent_states},
2102 {TIPC_NLA_STATS_TX_PROBES, s->sent_probes},
2103 {TIPC_NLA_STATS_TX_NACKS, s->sent_nacks},
2104 {TIPC_NLA_STATS_TX_ACKS, s->sent_acks},
2105 {TIPC_NLA_STATS_RETRANSMITTED, s->retransmitted},
2106 {TIPC_NLA_STATS_DUPLICATES, s->duplicates},
2107 {TIPC_NLA_STATS_LINK_CONGS, s->link_congs},
2108 {TIPC_NLA_STATS_MAX_QUEUE, s->max_queue_sz},
2109 {TIPC_NLA_STATS_AVG_QUEUE, s->queue_sz_counts ?
2110 (s->accu_queue_sz / s->queue_sz_counts) : 0}
2111 };
2112
2113 stats = nla_nest_start(skb, TIPC_NLA_LINK_STATS);
2114 if (!stats)
2115 return -EMSGSIZE;
2116
2117 for (i = 0; i < ARRAY_SIZE(map); i++)
2118 if (nla_put_u32(skb, map[i].key, map[i].val))
2119 goto msg_full;
2120
2121 nla_nest_end(skb, stats);
2122
2123 return 0;
2124msg_full:
2125 nla_nest_cancel(skb, stats);
2126
2127 return -EMSGSIZE;
2128}
2129
2130/* Caller should hold appropriate locks to protect the link */
Ying Xue34747532015-01-09 15:27:10 +08002131static int __tipc_nl_add_link(struct net *net, struct tipc_nl_msg *msg,
2132 struct tipc_link *link)
Richard Alpe7be57fc2014-11-20 10:29:12 +01002133{
2134 int err;
2135 void *hdr;
2136 struct nlattr *attrs;
2137 struct nlattr *prop;
Ying Xue34747532015-01-09 15:27:10 +08002138 struct tipc_net *tn = net_generic(net, tipc_net_id);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002139
Richard Alpebfb3e5d2015-02-09 09:50:03 +01002140 hdr = genlmsg_put(msg->skb, msg->portid, msg->seq, &tipc_genl_family,
Richard Alpe7be57fc2014-11-20 10:29:12 +01002141 NLM_F_MULTI, TIPC_NL_LINK_GET);
2142 if (!hdr)
2143 return -EMSGSIZE;
2144
2145 attrs = nla_nest_start(msg->skb, TIPC_NLA_LINK);
2146 if (!attrs)
2147 goto msg_full;
2148
2149 if (nla_put_string(msg->skb, TIPC_NLA_LINK_NAME, link->name))
2150 goto attr_msg_full;
2151 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_DEST,
Ying Xue34747532015-01-09 15:27:10 +08002152 tipc_cluster_mask(tn->own_addr)))
Richard Alpe7be57fc2014-11-20 10:29:12 +01002153 goto attr_msg_full;
2154 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_MTU, link->max_pkt))
2155 goto attr_msg_full;
2156 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_RX, link->next_in_no))
2157 goto attr_msg_full;
2158 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_TX, link->next_out_no))
2159 goto attr_msg_full;
2160
2161 if (tipc_link_is_up(link))
2162 if (nla_put_flag(msg->skb, TIPC_NLA_LINK_UP))
2163 goto attr_msg_full;
2164 if (tipc_link_is_active(link))
2165 if (nla_put_flag(msg->skb, TIPC_NLA_LINK_ACTIVE))
2166 goto attr_msg_full;
2167
2168 prop = nla_nest_start(msg->skb, TIPC_NLA_LINK_PROP);
2169 if (!prop)
2170 goto attr_msg_full;
2171 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_PRIO, link->priority))
2172 goto prop_msg_full;
2173 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_TOL, link->tolerance))
2174 goto prop_msg_full;
2175 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_WIN,
Jon Paul Maloy1f66d162015-03-25 12:07:24 -04002176 link->window))
Richard Alpe7be57fc2014-11-20 10:29:12 +01002177 goto prop_msg_full;
2178 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_PRIO, link->priority))
2179 goto prop_msg_full;
2180 nla_nest_end(msg->skb, prop);
2181
2182 err = __tipc_nl_add_stats(msg->skb, &link->stats);
2183 if (err)
2184 goto attr_msg_full;
2185
2186 nla_nest_end(msg->skb, attrs);
2187 genlmsg_end(msg->skb, hdr);
2188
2189 return 0;
2190
2191prop_msg_full:
2192 nla_nest_cancel(msg->skb, prop);
2193attr_msg_full:
2194 nla_nest_cancel(msg->skb, attrs);
2195msg_full:
2196 genlmsg_cancel(msg->skb, hdr);
2197
2198 return -EMSGSIZE;
2199}
2200
2201/* Caller should hold node lock */
Ying Xue34747532015-01-09 15:27:10 +08002202static int __tipc_nl_add_node_links(struct net *net, struct tipc_nl_msg *msg,
2203 struct tipc_node *node, u32 *prev_link)
Richard Alpe7be57fc2014-11-20 10:29:12 +01002204{
2205 u32 i;
2206 int err;
2207
2208 for (i = *prev_link; i < MAX_BEARERS; i++) {
2209 *prev_link = i;
2210
2211 if (!node->links[i])
2212 continue;
2213
Ying Xue34747532015-01-09 15:27:10 +08002214 err = __tipc_nl_add_link(net, msg, node->links[i]);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002215 if (err)
2216 return err;
2217 }
2218 *prev_link = 0;
2219
2220 return 0;
2221}
2222
2223int tipc_nl_link_dump(struct sk_buff *skb, struct netlink_callback *cb)
2224{
Ying Xuef2f98002015-01-09 15:27:05 +08002225 struct net *net = sock_net(skb->sk);
2226 struct tipc_net *tn = net_generic(net, tipc_net_id);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002227 struct tipc_node *node;
2228 struct tipc_nl_msg msg;
2229 u32 prev_node = cb->args[0];
2230 u32 prev_link = cb->args[1];
2231 int done = cb->args[2];
2232 int err;
2233
2234 if (done)
2235 return 0;
2236
2237 msg.skb = skb;
2238 msg.portid = NETLINK_CB(cb->skb).portid;
2239 msg.seq = cb->nlh->nlmsg_seq;
2240
2241 rcu_read_lock();
2242
2243 if (prev_node) {
Ying Xuef2f98002015-01-09 15:27:05 +08002244 node = tipc_node_find(net, prev_node);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002245 if (!node) {
2246 /* We never set seq or call nl_dump_check_consistent()
2247 * this means that setting prev_seq here will cause the
2248 * consistence check to fail in the netlink callback
2249 * handler. Resulting in the last NLMSG_DONE message
2250 * having the NLM_F_DUMP_INTR flag set.
2251 */
2252 cb->prev_seq = 1;
2253 goto out;
2254 }
2255
Ying Xuef2f98002015-01-09 15:27:05 +08002256 list_for_each_entry_continue_rcu(node, &tn->node_list,
2257 list) {
Richard Alpe7be57fc2014-11-20 10:29:12 +01002258 tipc_node_lock(node);
Ying Xue34747532015-01-09 15:27:10 +08002259 err = __tipc_nl_add_node_links(net, &msg, node,
2260 &prev_link);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002261 tipc_node_unlock(node);
2262 if (err)
2263 goto out;
2264
2265 prev_node = node->addr;
2266 }
2267 } else {
Ying Xue1da46562015-01-09 15:27:07 +08002268 err = tipc_nl_add_bc_link(net, &msg);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002269 if (err)
2270 goto out;
2271
Ying Xuef2f98002015-01-09 15:27:05 +08002272 list_for_each_entry_rcu(node, &tn->node_list, list) {
Richard Alpe7be57fc2014-11-20 10:29:12 +01002273 tipc_node_lock(node);
Ying Xue34747532015-01-09 15:27:10 +08002274 err = __tipc_nl_add_node_links(net, &msg, node,
2275 &prev_link);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002276 tipc_node_unlock(node);
2277 if (err)
2278 goto out;
2279
2280 prev_node = node->addr;
2281 }
2282 }
2283 done = 1;
2284out:
2285 rcu_read_unlock();
2286
2287 cb->args[0] = prev_node;
2288 cb->args[1] = prev_link;
2289 cb->args[2] = done;
2290
2291 return skb->len;
2292}
2293
2294int tipc_nl_link_get(struct sk_buff *skb, struct genl_info *info)
2295{
Ying Xuef2f98002015-01-09 15:27:05 +08002296 struct net *net = genl_info_net(info);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002297 struct sk_buff *ans_skb;
2298 struct tipc_nl_msg msg;
2299 struct tipc_link *link;
2300 struct tipc_node *node;
2301 char *name;
2302 int bearer_id;
2303 int err;
2304
2305 if (!info->attrs[TIPC_NLA_LINK_NAME])
2306 return -EINVAL;
2307
2308 name = nla_data(info->attrs[TIPC_NLA_LINK_NAME]);
Ying Xuef2f98002015-01-09 15:27:05 +08002309 node = tipc_link_find_owner(net, name, &bearer_id);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002310 if (!node)
2311 return -EINVAL;
2312
2313 ans_skb = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
2314 if (!ans_skb)
2315 return -ENOMEM;
2316
2317 msg.skb = ans_skb;
2318 msg.portid = info->snd_portid;
2319 msg.seq = info->snd_seq;
2320
2321 tipc_node_lock(node);
2322 link = node->links[bearer_id];
2323 if (!link) {
2324 err = -EINVAL;
2325 goto err_out;
2326 }
2327
Ying Xue34747532015-01-09 15:27:10 +08002328 err = __tipc_nl_add_link(net, &msg, link);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002329 if (err)
2330 goto err_out;
2331
2332 tipc_node_unlock(node);
2333
2334 return genlmsg_reply(ans_skb, info);
2335
2336err_out:
2337 tipc_node_unlock(node);
2338 nlmsg_free(ans_skb);
2339
2340 return err;
2341}
Richard Alpeae363422014-11-20 10:29:14 +01002342
2343int tipc_nl_link_reset_stats(struct sk_buff *skb, struct genl_info *info)
2344{
2345 int err;
2346 char *link_name;
2347 unsigned int bearer_id;
2348 struct tipc_link *link;
2349 struct tipc_node *node;
2350 struct nlattr *attrs[TIPC_NLA_LINK_MAX + 1];
Richard Alpe18178772015-02-09 09:50:09 +01002351 struct net *net = sock_net(skb->sk);
Richard Alpeae363422014-11-20 10:29:14 +01002352
2353 if (!info->attrs[TIPC_NLA_LINK])
2354 return -EINVAL;
2355
2356 err = nla_parse_nested(attrs, TIPC_NLA_LINK_MAX,
2357 info->attrs[TIPC_NLA_LINK],
2358 tipc_nl_link_policy);
2359 if (err)
2360 return err;
2361
2362 if (!attrs[TIPC_NLA_LINK_NAME])
2363 return -EINVAL;
2364
2365 link_name = nla_data(attrs[TIPC_NLA_LINK_NAME]);
2366
2367 if (strcmp(link_name, tipc_bclink_name) == 0) {
Ying Xue1da46562015-01-09 15:27:07 +08002368 err = tipc_bclink_reset_stats(net);
Richard Alpeae363422014-11-20 10:29:14 +01002369 if (err)
2370 return err;
2371 return 0;
2372 }
2373
Ying Xuef2f98002015-01-09 15:27:05 +08002374 node = tipc_link_find_owner(net, link_name, &bearer_id);
Richard Alpeae363422014-11-20 10:29:14 +01002375 if (!node)
2376 return -EINVAL;
2377
2378 tipc_node_lock(node);
2379
2380 link = node->links[bearer_id];
2381 if (!link) {
2382 tipc_node_unlock(node);
2383 return -EINVAL;
2384 }
2385
2386 link_reset_statistics(link);
2387
2388 tipc_node_unlock(node);
2389
2390 return 0;
2391}