blob: f5e086c5f7248a840f82e5064ade30590e421c4d [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 Stephensf882cb72011-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
Allan Stephensc68ca7b2010-05-11 14:30:12 +0000984 tipc_addr_string_fill(addr_string, n_ptr->addr);
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400985 pr_info("Broadcast link info for %s\n", addr_string);
Ying Xue389dd9b2012-11-16 13:51:30 +0800986 pr_info("Reception permitted: %d, Acked: %u\n",
987 n_ptr->bclink.recv_permitted,
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400988 n_ptr->bclink.acked);
989 pr_info("Last in: %u, Oos state: %u, Last sent: %u\n",
990 n_ptr->bclink.last_in,
991 n_ptr->bclink.oos_state,
992 n_ptr->bclink.last_sent);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700993
Ying Xueb952b2b2015-03-26 18:10:23 +0800994 n_ptr->action_flags |= TIPC_BCAST_RESET;
Allan Stephensd356eeb2006-06-25 23:40:01 -0700995 l_ptr->stale_count = 0;
996 }
997}
998
Ying Xue58dc55f2014-11-26 11:41:52 +0800999void tipc_link_retransmit(struct tipc_link *l_ptr, struct sk_buff *skb,
Per Liden4323add2006-01-18 00:38:21 +01001000 u32 retransmits)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001001{
1002 struct tipc_msg *msg;
1003
Ying Xue58dc55f2014-11-26 11:41:52 +08001004 if (!skb)
Allan Stephensd356eeb2006-06-25 23:40:01 -07001005 return;
1006
Ying Xue58dc55f2014-11-26 11:41:52 +08001007 msg = buf_msg(skb);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001008
Erik Hugne512137e2013-12-06 10:08:00 -05001009 /* Detect repeated retransmit failures */
1010 if (l_ptr->last_retransmitted == msg_seqno(msg)) {
1011 if (++l_ptr->stale_count > 100) {
Ying Xue58dc55f2014-11-26 11:41:52 +08001012 link_retransmit_failure(l_ptr, skb);
Erik Hugne512137e2013-12-06 10:08:00 -05001013 return;
Allan Stephensd356eeb2006-06-25 23:40:01 -07001014 }
1015 } else {
Erik Hugne512137e2013-12-06 10:08:00 -05001016 l_ptr->last_retransmitted = msg_seqno(msg);
1017 l_ptr->stale_count = 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001018 }
Allan Stephensd356eeb2006-06-25 23:40:01 -07001019
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001020 skb_queue_walk_from(&l_ptr->transmq, skb) {
1021 if (!retransmits)
Ying Xue58dc55f2014-11-26 11:41:52 +08001022 break;
1023 msg = buf_msg(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001024 msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001025 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Ying Xue7f9f95d2015-01-09 15:27:06 +08001026 tipc_bearer_send(l_ptr->owner->net, l_ptr->bearer_id, skb,
1027 &l_ptr->media_addr);
Ying Xue3c294cb2012-11-15 11:34:45 +08001028 retransmits--;
1029 l_ptr->stats.retransmitted++;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001030 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001031}
1032
Jon Paul Maloy8b4ed862015-03-25 12:07:26 -04001033/* link_synch(): check if all packets arrived before the synch
1034 * point have been consumed
1035 * Returns true if the parallel links are synched, otherwise false
1036 */
1037static bool link_synch(struct tipc_link *l)
1038{
1039 unsigned int post_synch;
1040 struct tipc_link *pl;
1041
1042 pl = tipc_parallel_link(l);
1043 if (pl == l)
1044 goto synched;
1045
1046 /* Was last pre-synch packet added to input queue ? */
1047 if (less_eq(pl->next_in_no, l->synch_point))
1048 return false;
1049
1050 /* Is it still in the input queue ? */
1051 post_synch = mod(pl->next_in_no - l->synch_point) - 1;
1052 if (skb_queue_len(&pl->inputq) > post_synch)
1053 return false;
1054synched:
1055 l->flags &= ~LINK_SYNCHING;
1056 return true;
1057}
1058
Ying Xuef03273f2014-11-26 11:41:54 +08001059static void link_retrieve_defq(struct tipc_link *link,
1060 struct sk_buff_head *list)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001061{
1062 u32 seq_no;
1063
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001064 if (skb_queue_empty(&link->deferdq))
Ying Xuef03273f2014-11-26 11:41:54 +08001065 return;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001066
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001067 seq_no = buf_seqno(skb_peek(&link->deferdq));
Ying Xuef03273f2014-11-26 11:41:54 +08001068 if (seq_no == mod(link->next_in_no))
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001069 skb_queue_splice_tail_init(&link->deferdq, list);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001070}
1071
Allan Stephens85035562008-04-15 19:04:54 -07001072/**
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001073 * tipc_rcv - process TIPC packets/messages arriving from off-node
Ying Xuef2f98002015-01-09 15:27:05 +08001074 * @net: the applicable net namespace
Ying Xuef03273f2014-11-26 11:41:54 +08001075 * @skb: TIPC packet
Ying Xue7a2f7d12014-04-21 10:55:46 +08001076 * @b_ptr: pointer to bearer message arrived on
Allan Stephensb02b69c2010-08-17 11:00:07 +00001077 *
1078 * Invoked with no locks held. Bearer pointer must point to a valid bearer
1079 * structure (i.e. cannot be NULL), but bearer can be inactive.
1080 */
Ying Xuec93d3ba2015-01-09 15:27:04 +08001081void tipc_rcv(struct net *net, struct sk_buff *skb, struct tipc_bearer *b_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001082{
Ying Xue34747532015-01-09 15:27:10 +08001083 struct tipc_net *tn = net_generic(net, tipc_net_id);
Ying Xuef03273f2014-11-26 11:41:54 +08001084 struct sk_buff_head head;
1085 struct tipc_node *n_ptr;
1086 struct tipc_link *l_ptr;
1087 struct sk_buff *skb1, *tmp;
1088 struct tipc_msg *msg;
1089 u32 seq_no;
1090 u32 ackd;
1091 u32 released;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001092
Ying Xuea6ca1092014-11-26 11:41:55 +08001093 skb2list(skb, &head);
Allan Stephens85035562008-04-15 19:04:54 -07001094
Ying Xuef03273f2014-11-26 11:41:54 +08001095 while ((skb = __skb_dequeue(&head))) {
Allan Stephens85035562008-04-15 19:04:54 -07001096 /* Ensure message is well-formed */
Jon Paul Maloycf2157f2015-03-13 16:08:06 -04001097 if (unlikely(!tipc_msg_validate(skb)))
Ying Xue3af390e2013-10-30 11:26:57 +08001098 goto discard;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001099
Allan Stephens85035562008-04-15 19:04:54 -07001100 /* Handle arrival of a non-unicast link message */
Ying Xuef03273f2014-11-26 11:41:54 +08001101 msg = buf_msg(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001102 if (unlikely(msg_non_seq(msg))) {
Allan Stephens1265a022008-06-04 17:32:35 -07001103 if (msg_user(msg) == LINK_CONFIG)
Ying Xuec93d3ba2015-01-09 15:27:04 +08001104 tipc_disc_rcv(net, skb, b_ptr);
Allan Stephens1265a022008-06-04 17:32:35 -07001105 else
Ying Xuec93d3ba2015-01-09 15:27:04 +08001106 tipc_bclink_rcv(net, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001107 continue;
1108 }
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001109
Allan Stephensed33a9c2011-04-05 15:15:04 -04001110 /* Discard unicast link messages destined for another node */
Allan Stephens26008242006-06-25 23:39:31 -07001111 if (unlikely(!msg_short(msg) &&
Ying Xue34747532015-01-09 15:27:10 +08001112 (msg_destnode(msg) != tn->own_addr)))
Ying Xue3af390e2013-10-30 11:26:57 +08001113 goto discard;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001114
Allan Stephens5a68d5e2010-08-17 11:00:16 +00001115 /* Locate neighboring node that sent message */
Ying Xuef2f98002015-01-09 15:27:05 +08001116 n_ptr = tipc_node_find(net, msg_prevnode(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001117 if (unlikely(!n_ptr))
Ying Xue3af390e2013-10-30 11:26:57 +08001118 goto discard;
Per Liden4323add2006-01-18 00:38:21 +01001119 tipc_node_lock(n_ptr);
Allan Stephens85035562008-04-15 19:04:54 -07001120
Allan Stephens5a68d5e2010-08-17 11:00:16 +00001121 /* Locate unicast link endpoint that should handle message */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001122 l_ptr = n_ptr->links[b_ptr->identity];
Ying Xue3af390e2013-10-30 11:26:57 +08001123 if (unlikely(!l_ptr))
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001124 goto unlock;
Allan Stephens85035562008-04-15 19:04:54 -07001125
Allan Stephensb4b56102011-05-27 11:00:51 -04001126 /* Verify that communication with node is currently allowed */
Ying Xueaecb9bb2014-05-08 08:54:39 +08001127 if ((n_ptr->action_flags & TIPC_WAIT_PEER_LINKS_DOWN) &&
Ying Xue10f465c2014-05-05 08:56:11 +08001128 msg_user(msg) == LINK_PROTOCOL &&
1129 (msg_type(msg) == RESET_MSG ||
1130 msg_type(msg) == ACTIVATE_MSG) &&
1131 !msg_redundant_link(msg))
Ying Xueaecb9bb2014-05-08 08:54:39 +08001132 n_ptr->action_flags &= ~TIPC_WAIT_PEER_LINKS_DOWN;
Allan Stephensb4b56102011-05-27 11:00:51 -04001133
Ying Xue10f465c2014-05-05 08:56:11 +08001134 if (tipc_node_blocked(n_ptr))
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001135 goto unlock;
Allan Stephensb4b56102011-05-27 11:00:51 -04001136
Allan Stephens85035562008-04-15 19:04:54 -07001137 /* Validate message sequence number info */
Allan Stephens85035562008-04-15 19:04:54 -07001138 seq_no = msg_seqno(msg);
1139 ackd = msg_ack(msg);
1140
1141 /* Release acked messages */
Jon Paul Maloy2cdf3912015-03-13 16:08:09 -04001142 if (unlikely(n_ptr->bclink.acked != msg_bcast_ack(msg)))
Allan Stephens365595912011-10-24 15:26:24 -04001143 tipc_bclink_acknowledge(n_ptr, msg_bcast_ack(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001144
Ying Xue58dc55f2014-11-26 11:41:52 +08001145 released = 0;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001146 skb_queue_walk_safe(&l_ptr->transmq, skb1, tmp) {
1147 if (more(buf_seqno(skb1), ackd))
Ying Xue58dc55f2014-11-26 11:41:52 +08001148 break;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001149 __skb_unlink(skb1, &l_ptr->transmq);
Ying Xue58dc55f2014-11-26 11:41:52 +08001150 kfree_skb(skb1);
1151 released = 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001152 }
Allan Stephens85035562008-04-15 19:04:54 -07001153
1154 /* Try sending any messages link endpoint has pending */
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001155 if (unlikely(skb_queue_len(&l_ptr->backlogq)))
Ying Xue47b4c9a2014-11-26 11:41:48 +08001156 tipc_link_push_packets(l_ptr);
Jon Paul Maloya5377832014-02-13 17:29:15 -05001157
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001158 if (released && !skb_queue_empty(&l_ptr->wakeupq))
Jon Paul Maloy50100a52014-08-22 18:09:07 -04001159 link_prepare_wakeup(l_ptr);
Jon Paul Maloya5377832014-02-13 17:29:15 -05001160
Jon Paul Maloya5377832014-02-13 17:29:15 -05001161 /* Process the incoming packet */
Ying Xue3af390e2013-10-30 11:26:57 +08001162 if (unlikely(!link_working_working(l_ptr))) {
1163 if (msg_user(msg) == LINK_PROTOCOL) {
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001164 tipc_link_proto_rcv(l_ptr, skb);
Ying Xuef03273f2014-11-26 11:41:54 +08001165 link_retrieve_defq(l_ptr, &head);
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001166 skb = NULL;
1167 goto unlock;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001168 }
Ying Xue3af390e2013-10-30 11:26:57 +08001169
1170 /* Traffic message. Conditionally activate link */
1171 link_state_event(l_ptr, TRAFFIC_MSG_EVT);
1172
1173 if (link_working_working(l_ptr)) {
1174 /* Re-insert buffer in front of queue */
Ying Xuef03273f2014-11-26 11:41:54 +08001175 __skb_queue_head(&head, skb);
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001176 skb = NULL;
1177 goto unlock;
Ying Xue3af390e2013-10-30 11:26:57 +08001178 }
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001179 goto unlock;
Ying Xue3af390e2013-10-30 11:26:57 +08001180 }
1181
1182 /* Link is now in state WORKING_WORKING */
1183 if (unlikely(seq_no != mod(l_ptr->next_in_no))) {
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001184 link_handle_out_of_seq_msg(l_ptr, skb);
Ying Xuef03273f2014-11-26 11:41:54 +08001185 link_retrieve_defq(l_ptr, &head);
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001186 skb = NULL;
1187 goto unlock;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001188 }
Jon Paul Maloy8b4ed862015-03-25 12:07:26 -04001189 /* Synchronize with parallel link if applicable */
1190 if (unlikely((l_ptr->flags & LINK_SYNCHING) && !msg_dup(msg))) {
1191 link_handle_out_of_seq_msg(l_ptr, skb);
1192 if (link_synch(l_ptr))
1193 link_retrieve_defq(l_ptr, &head);
1194 skb = NULL;
1195 goto unlock;
1196 }
Ying Xue3af390e2013-10-30 11:26:57 +08001197 l_ptr->next_in_no++;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001198 if (unlikely(!skb_queue_empty(&l_ptr->deferdq)))
Ying Xuef03273f2014-11-26 11:41:54 +08001199 link_retrieve_defq(l_ptr, &head);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001200 if (unlikely(++l_ptr->rcv_unacked >= TIPC_MIN_LINK_WIN)) {
Erik Hugne3f53bd82014-07-01 10:22:41 +02001201 l_ptr->stats.sent_acks++;
1202 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0, 0, 0, 0);
1203 }
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001204 tipc_link_input(l_ptr, skb);
1205 skb = NULL;
1206unlock:
Ying Xue3af390e2013-10-30 11:26:57 +08001207 tipc_node_unlock(n_ptr);
1208discard:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001209 if (unlikely(skb))
1210 kfree_skb(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001211 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001212}
1213
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001214/* tipc_data_input - deliver data and name distr msgs to upper layer
Erik Hugne7ae934b2014-07-01 10:22:40 +02001215 *
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001216 * Consumes buffer if message is of right type
Erik Hugne7ae934b2014-07-01 10:22:40 +02001217 * Node lock must be held
1218 */
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001219static bool tipc_data_input(struct tipc_link *link, struct sk_buff *skb)
Erik Hugne7ae934b2014-07-01 10:22:40 +02001220{
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001221 struct tipc_node *node = link->owner;
1222 struct tipc_msg *msg = buf_msg(skb);
1223 u32 dport = msg_destport(msg);
Erik Hugne7ae934b2014-07-01 10:22:40 +02001224
1225 switch (msg_user(msg)) {
1226 case TIPC_LOW_IMPORTANCE:
1227 case TIPC_MEDIUM_IMPORTANCE:
1228 case TIPC_HIGH_IMPORTANCE:
1229 case TIPC_CRITICAL_IMPORTANCE:
1230 case CONN_MANAGER:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001231 if (tipc_skb_queue_tail(&link->inputq, skb, dport)) {
1232 node->inputq = &link->inputq;
1233 node->action_flags |= TIPC_MSG_EVT;
1234 }
1235 return true;
Erik Hugne7ae934b2014-07-01 10:22:40 +02001236 case NAME_DISTRIBUTOR:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001237 node->bclink.recv_permitted = true;
1238 node->namedq = &link->namedq;
1239 skb_queue_tail(&link->namedq, skb);
1240 if (skb_queue_len(&link->namedq) == 1)
1241 node->action_flags |= TIPC_NAMED_MSG_EVT;
1242 return true;
Erik Hugne7ae934b2014-07-01 10:22:40 +02001243 case MSG_BUNDLER:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001244 case CHANGEOVER_PROTOCOL:
1245 case MSG_FRAGMENTER:
1246 case BCAST_PROTOCOL:
1247 return false;
1248 default:
1249 pr_warn("Dropping received illegal msg type\n");
1250 kfree_skb(skb);
1251 return false;
1252 };
1253}
1254
1255/* tipc_link_input - process packet that has passed link protocol check
1256 *
1257 * Consumes buffer
1258 * Node lock must be held
1259 */
1260static void tipc_link_input(struct tipc_link *link, struct sk_buff *skb)
1261{
1262 struct tipc_node *node = link->owner;
1263 struct tipc_msg *msg = buf_msg(skb);
1264 struct sk_buff *iskb;
1265 int pos = 0;
1266
1267 if (likely(tipc_data_input(link, skb)))
1268 return;
1269
1270 switch (msg_user(msg)) {
1271 case CHANGEOVER_PROTOCOL:
Jon Paul Maloy8b4ed862015-03-25 12:07:26 -04001272 if (msg_dup(msg)) {
1273 link->flags |= LINK_SYNCHING;
1274 link->synch_point = msg_seqno(msg_get_wrapped(msg));
1275 }
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001276 if (!tipc_link_tunnel_rcv(node, &skb))
1277 break;
1278 if (msg_user(buf_msg(skb)) != MSG_BUNDLER) {
1279 tipc_data_input(link, skb);
1280 break;
1281 }
1282 case MSG_BUNDLER:
1283 link->stats.recv_bundles++;
1284 link->stats.recv_bundled += msg_msgcnt(msg);
1285
1286 while (tipc_msg_extract(skb, &iskb, &pos))
1287 tipc_data_input(link, iskb);
1288 break;
1289 case MSG_FRAGMENTER:
1290 link->stats.recv_fragments++;
1291 if (tipc_buf_append(&link->reasm_buf, &skb)) {
1292 link->stats.recv_fragmented++;
1293 tipc_data_input(link, skb);
1294 } else if (!link->reasm_buf) {
1295 tipc_link_reset(link);
1296 }
1297 break;
1298 case BCAST_PROTOCOL:
1299 tipc_link_sync_rcv(node, skb);
Erik Hugne7ae934b2014-07-01 10:22:40 +02001300 break;
1301 default:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001302 break;
1303 };
Erik Hugne7ae934b2014-07-01 10:22:40 +02001304}
1305
1306/**
Allan Stephens8809b252011-10-25 10:44:35 -04001307 * tipc_link_defer_pkt - Add out-of-sequence message to deferred reception queue
1308 *
1309 * Returns increase in queue length (i.e. 0 or 1)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001310 */
Ying Xuebc6fecd2014-11-26 11:41:53 +08001311u32 tipc_link_defer_pkt(struct sk_buff_head *list, struct sk_buff *skb)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001312{
Ying Xuebc6fecd2014-11-26 11:41:53 +08001313 struct sk_buff *skb1;
1314 u32 seq_no = buf_seqno(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001315
1316 /* Empty queue ? */
Ying Xuebc6fecd2014-11-26 11:41:53 +08001317 if (skb_queue_empty(list)) {
1318 __skb_queue_tail(list, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001319 return 1;
1320 }
1321
1322 /* Last ? */
Ying Xuebc6fecd2014-11-26 11:41:53 +08001323 if (less(buf_seqno(skb_peek_tail(list)), seq_no)) {
1324 __skb_queue_tail(list, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001325 return 1;
1326 }
1327
Allan Stephens8809b252011-10-25 10:44:35 -04001328 /* Locate insertion point in queue, then insert; discard if duplicate */
Ying Xuebc6fecd2014-11-26 11:41:53 +08001329 skb_queue_walk(list, skb1) {
1330 u32 curr_seqno = buf_seqno(skb1);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001331
Allan Stephens8809b252011-10-25 10:44:35 -04001332 if (seq_no == curr_seqno) {
Ying Xuebc6fecd2014-11-26 11:41:53 +08001333 kfree_skb(skb);
Allan Stephens8809b252011-10-25 10:44:35 -04001334 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001335 }
Allan Stephens8809b252011-10-25 10:44:35 -04001336
1337 if (less(seq_no, curr_seqno))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001338 break;
Allan Stephens8809b252011-10-25 10:44:35 -04001339 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001340
Ying Xuebc6fecd2014-11-26 11:41:53 +08001341 __skb_queue_before(list, skb1, skb);
Allan Stephens8809b252011-10-25 10:44:35 -04001342 return 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001343}
1344
Allan Stephens8809b252011-10-25 10:44:35 -04001345/*
Per Lidenb97bf3f2006-01-02 19:04:38 +01001346 * link_handle_out_of_seq_msg - handle arrival of out-of-sequence packet
1347 */
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001348static void link_handle_out_of_seq_msg(struct tipc_link *l_ptr,
Per Lidenb97bf3f2006-01-02 19:04:38 +01001349 struct sk_buff *buf)
1350{
Allan Stephensf9057302011-10-24 16:03:12 -04001351 u32 seq_no = buf_seqno(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001352
1353 if (likely(msg_user(buf_msg(buf)) == LINK_PROTOCOL)) {
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001354 tipc_link_proto_rcv(l_ptr, buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001355 return;
1356 }
1357
Per Lidenb97bf3f2006-01-02 19:04:38 +01001358 /* Record OOS packet arrival (force mismatch on next timeout) */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001359 l_ptr->checkpoint--;
1360
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001361 /*
Per Lidenb97bf3f2006-01-02 19:04:38 +01001362 * Discard packet if a duplicate; otherwise add it to deferred queue
1363 * and notify peer of gap as per protocol specification
1364 */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001365 if (less(seq_no, mod(l_ptr->next_in_no))) {
1366 l_ptr->stats.duplicates++;
Allan Stephens5f6d9122011-11-04 13:24:29 -04001367 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001368 return;
1369 }
1370
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001371 if (tipc_link_defer_pkt(&l_ptr->deferdq, buf)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001372 l_ptr->stats.deferred_recv++;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001373 if ((skb_queue_len(&l_ptr->deferdq) % TIPC_MIN_LINK_WIN) == 1)
Ying Xue247f0f32014-02-18 16:06:46 +08001374 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0, 0, 0, 0);
Ying Xuebc6fecd2014-11-26 11:41:53 +08001375 } else {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001376 l_ptr->stats.duplicates++;
Ying Xuebc6fecd2014-11-26 11:41:53 +08001377 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001378}
1379
1380/*
1381 * Send protocol message to the other endpoint.
1382 */
Ying Xue247f0f32014-02-18 16:06:46 +08001383void tipc_link_proto_xmit(struct tipc_link *l_ptr, u32 msg_typ, int probe_msg,
1384 u32 gap, u32 tolerance, u32 priority, u32 ack_mtu)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001385{
Sam Ravnborg1fc54d82006-03-20 22:36:47 -08001386 struct sk_buff *buf = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001387 struct tipc_msg *msg = l_ptr->pmsg;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001388 u32 msg_size = sizeof(l_ptr->proto_msg);
Allan Stephens75f0aa42011-02-28 15:30:20 -05001389 int r_flag;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001390
Ying Xue77a7e072013-12-10 20:45:44 -08001391 /* Don't send protocol message during link changeover */
1392 if (l_ptr->exp_msg_count)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001393 return;
Allan Stephensb4b56102011-05-27 11:00:51 -04001394
1395 /* Abort non-RESET send if communication with node is prohibited */
Ying Xue10f465c2014-05-05 08:56:11 +08001396 if ((tipc_node_blocked(l_ptr->owner)) && (msg_typ != RESET_MSG))
Allan Stephensb4b56102011-05-27 11:00:51 -04001397 return;
1398
Allan Stephens92d2c902011-10-25 11:20:26 -04001399 /* Create protocol message with "out-of-sequence" sequence number */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001400 msg_set_type(msg, msg_typ);
Ying Xue7a2f7d12014-04-21 10:55:46 +08001401 msg_set_net_plane(msg, l_ptr->net_plane);
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001402 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Ying Xue1da46562015-01-09 15:27:07 +08001403 msg_set_last_bcast(msg, tipc_bclink_get_last_sent(l_ptr->owner->net));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001404
1405 if (msg_typ == STATE_MSG) {
1406 u32 next_sent = mod(l_ptr->next_out_no);
1407
Per Liden4323add2006-01-18 00:38:21 +01001408 if (!tipc_link_is_up(l_ptr))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001409 return;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001410 if (skb_queue_len(&l_ptr->backlogq))
1411 next_sent = buf_seqno(skb_peek(&l_ptr->backlogq));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001412 msg_set_next_sent(msg, next_sent);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001413 if (!skb_queue_empty(&l_ptr->deferdq)) {
1414 u32 rec = buf_seqno(skb_peek(&l_ptr->deferdq));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001415 gap = mod(rec - mod(l_ptr->next_in_no));
1416 }
1417 msg_set_seq_gap(msg, gap);
1418 if (gap)
1419 l_ptr->stats.sent_nacks++;
1420 msg_set_link_tolerance(msg, tolerance);
1421 msg_set_linkprio(msg, priority);
1422 msg_set_max_pkt(msg, ack_mtu);
1423 msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
1424 msg_set_probe(msg, probe_msg != 0);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001425 if (probe_msg) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001426 u32 mtu = l_ptr->max_pkt;
1427
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001428 if ((mtu < l_ptr->max_pkt_target) &&
Per Lidenb97bf3f2006-01-02 19:04:38 +01001429 link_working_working(l_ptr) &&
1430 l_ptr->fsm_msg_cnt) {
1431 msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001432 if (l_ptr->max_pkt_probes == 10) {
1433 l_ptr->max_pkt_target = (msg_size - 4);
1434 l_ptr->max_pkt_probes = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001435 msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001436 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001437 l_ptr->max_pkt_probes++;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001438 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001439
1440 l_ptr->stats.sent_probes++;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001441 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001442 l_ptr->stats.sent_states++;
1443 } else { /* RESET_MSG or ACTIVATE_MSG */
1444 msg_set_ack(msg, mod(l_ptr->reset_checkpoint - 1));
1445 msg_set_seq_gap(msg, 0);
1446 msg_set_next_sent(msg, 1);
Allan Stephensf23d9bf2011-01-18 15:15:34 -05001447 msg_set_probe(msg, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001448 msg_set_link_tolerance(msg, l_ptr->tolerance);
1449 msg_set_linkprio(msg, l_ptr->priority);
1450 msg_set_max_pkt(msg, l_ptr->max_pkt_target);
1451 }
1452
Allan Stephens75f0aa42011-02-28 15:30:20 -05001453 r_flag = (l_ptr->owner->working_links > tipc_link_is_up(l_ptr));
1454 msg_set_redundant_link(msg, r_flag);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001455 msg_set_linkprio(msg, l_ptr->priority);
Allan Stephens92d2c902011-10-25 11:20:26 -04001456 msg_set_size(msg, msg_size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001457
1458 msg_set_seqno(msg, mod(l_ptr->next_out_no + (0xffff/2)));
1459
stephen hemminger31e3c3f2010-10-13 13:20:35 +00001460 buf = tipc_buf_acquire(msg_size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001461 if (!buf)
1462 return;
1463
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03001464 skb_copy_to_linear_data(buf, msg, sizeof(l_ptr->proto_msg));
Ying Xue796c75d2013-06-17 10:54:48 -04001465 buf->priority = TC_PRIO_CONTROL;
Ying Xue7f9f95d2015-01-09 15:27:06 +08001466 tipc_bearer_send(l_ptr->owner->net, l_ptr->bearer_id, buf,
1467 &l_ptr->media_addr);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001468 l_ptr->rcv_unacked = 0;
Allan Stephens5f6d9122011-11-04 13:24:29 -04001469 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001470}
1471
1472/*
1473 * Receive protocol message :
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001474 * Note that network plane id propagates through the network, and may
1475 * change at any time. The node with lowest address rules
Per Lidenb97bf3f2006-01-02 19:04:38 +01001476 */
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001477static void tipc_link_proto_rcv(struct tipc_link *l_ptr,
Ying Xuec93d3ba2015-01-09 15:27:04 +08001478 struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001479{
1480 u32 rec_gap = 0;
1481 u32 max_pkt_info;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001482 u32 max_pkt_ack;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001483 u32 msg_tol;
1484 struct tipc_msg *msg = buf_msg(buf);
1485
Ying Xue77a7e072013-12-10 20:45:44 -08001486 /* Discard protocol message during link changeover */
1487 if (l_ptr->exp_msg_count)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001488 goto exit;
1489
Ying Xue7a2f7d12014-04-21 10:55:46 +08001490 if (l_ptr->net_plane != msg_net_plane(msg))
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001491 if (link_own_addr(l_ptr) > msg_prevnode(msg))
Ying Xue7a2f7d12014-04-21 10:55:46 +08001492 l_ptr->net_plane = msg_net_plane(msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001493
Per Lidenb97bf3f2006-01-02 19:04:38 +01001494 switch (msg_type(msg)) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001495
Per Lidenb97bf3f2006-01-02 19:04:38 +01001496 case RESET_MSG:
Allan Stephensa686e682008-06-04 17:29:39 -07001497 if (!link_working_unknown(l_ptr) &&
1498 (l_ptr->peer_session != INVALID_SESSION)) {
Allan Stephens641c2182011-04-07 09:54:43 -04001499 if (less_eq(msg_session(msg), l_ptr->peer_session))
1500 break; /* duplicate or old reset: ignore */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001501 }
Allan Stephensb4b56102011-05-27 11:00:51 -04001502
1503 if (!msg_redundant_link(msg) && (link_working_working(l_ptr) ||
1504 link_working_unknown(l_ptr))) {
1505 /*
1506 * peer has lost contact -- don't allow peer's links
1507 * to reactivate before we recognize loss & clean up
1508 */
Ying Xueca9cf062014-05-08 08:54:40 +08001509 l_ptr->owner->action_flags |= TIPC_WAIT_OWN_LINKS_DOWN;
Allan Stephensb4b56102011-05-27 11:00:51 -04001510 }
1511
Allan Stephens47361c82011-10-26 10:55:16 -04001512 link_state_event(l_ptr, RESET_MSG);
1513
Per Lidenb97bf3f2006-01-02 19:04:38 +01001514 /* fall thru' */
1515 case ACTIVATE_MSG:
1516 /* Update link settings according other endpoint's values */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001517 strcpy((strrchr(l_ptr->name, ':') + 1), (char *)msg_data(msg));
1518
Allan Stephens2db99832010-12-31 18:59:33 +00001519 msg_tol = msg_link_tolerance(msg);
1520 if (msg_tol > l_ptr->tolerance)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001521 link_set_supervision_props(l_ptr, msg_tol);
1522
1523 if (msg_linkprio(msg) > l_ptr->priority)
1524 l_ptr->priority = msg_linkprio(msg);
1525
1526 max_pkt_info = msg_max_pkt(msg);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001527 if (max_pkt_info) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001528 if (max_pkt_info < l_ptr->max_pkt_target)
1529 l_ptr->max_pkt_target = max_pkt_info;
1530 if (l_ptr->max_pkt > l_ptr->max_pkt_target)
1531 l_ptr->max_pkt = l_ptr->max_pkt_target;
1532 } else {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001533 l_ptr->max_pkt = l_ptr->max_pkt_target;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001534 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001535
Allan Stephens4d753132011-10-25 12:19:05 -04001536 /* Synchronize broadcast link info, if not done previously */
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001537 if (!tipc_node_is_up(l_ptr->owner)) {
1538 l_ptr->owner->bclink.last_sent =
1539 l_ptr->owner->bclink.last_in =
1540 msg_last_bcast(msg);
1541 l_ptr->owner->bclink.oos_state = 0;
1542 }
Allan Stephens4d753132011-10-25 12:19:05 -04001543
Per Lidenb97bf3f2006-01-02 19:04:38 +01001544 l_ptr->peer_session = msg_session(msg);
1545 l_ptr->peer_bearer_id = msg_bearer_id(msg);
Allan Stephens47361c82011-10-26 10:55:16 -04001546
1547 if (msg_type(msg) == ACTIVATE_MSG)
1548 link_state_event(l_ptr, ACTIVATE_MSG);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001549 break;
1550 case STATE_MSG:
1551
Allan Stephens2db99832010-12-31 18:59:33 +00001552 msg_tol = msg_link_tolerance(msg);
1553 if (msg_tol)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001554 link_set_supervision_props(l_ptr, msg_tol);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001555
1556 if (msg_linkprio(msg) &&
Per Lidenb97bf3f2006-01-02 19:04:38 +01001557 (msg_linkprio(msg) != l_ptr->priority)) {
Erik Hugne3fa9cac2015-01-22 17:10:31 +01001558 pr_debug("%s<%s>, priority change %u->%u\n",
1559 link_rst_msg, l_ptr->name,
1560 l_ptr->priority, msg_linkprio(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001561 l_ptr->priority = msg_linkprio(msg);
Per Liden4323add2006-01-18 00:38:21 +01001562 tipc_link_reset(l_ptr); /* Enforce change to take effect */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001563 break;
1564 }
Jon Paul Maloyec37dcd2014-05-14 05:39:10 -04001565
1566 /* Record reception; force mismatch at next timeout: */
1567 l_ptr->checkpoint--;
1568
Per Lidenb97bf3f2006-01-02 19:04:38 +01001569 link_state_event(l_ptr, TRAFFIC_MSG_EVT);
1570 l_ptr->stats.recv_states++;
1571 if (link_reset_unknown(l_ptr))
1572 break;
1573
1574 if (less_eq(mod(l_ptr->next_in_no), msg_next_sent(msg))) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001575 rec_gap = mod(msg_next_sent(msg) -
Per Lidenb97bf3f2006-01-02 19:04:38 +01001576 mod(l_ptr->next_in_no));
1577 }
1578
1579 max_pkt_ack = msg_max_pkt(msg);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001580 if (max_pkt_ack > l_ptr->max_pkt) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001581 l_ptr->max_pkt = max_pkt_ack;
1582 l_ptr->max_pkt_probes = 0;
1583 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001584
1585 max_pkt_ack = 0;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001586 if (msg_probe(msg)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001587 l_ptr->stats.recv_probes++;
Allan Stephensa0168922010-12-31 18:59:35 +00001588 if (msg_size(msg) > sizeof(l_ptr->proto_msg))
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001589 max_pkt_ack = msg_size(msg);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001590 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001591
1592 /* Protocol message before retransmits, reduce loss risk */
Ying Xue389dd9b2012-11-16 13:51:30 +08001593 if (l_ptr->owner->bclink.recv_permitted)
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001594 tipc_bclink_update_link_state(l_ptr->owner,
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001595 msg_last_bcast(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001596
1597 if (rec_gap || (msg_probe(msg))) {
Ying Xue247f0f32014-02-18 16:06:46 +08001598 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, rec_gap, 0,
1599 0, max_pkt_ack);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001600 }
1601 if (msg_seq_gap(msg)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001602 l_ptr->stats.recv_nacks++;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001603 tipc_link_retransmit(l_ptr, skb_peek(&l_ptr->transmq),
Per Liden4323add2006-01-18 00:38:21 +01001604 msg_seq_gap(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001605 }
1606 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001607 }
1608exit:
Allan Stephens5f6d9122011-11-04 13:24:29 -04001609 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001610}
1611
1612
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001613/* tipc_link_tunnel_xmit(): Tunnel one packet via a link belonging to
1614 * a different bearer. Owner node is locked.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001615 */
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001616static void tipc_link_tunnel_xmit(struct tipc_link *l_ptr,
1617 struct tipc_msg *tunnel_hdr,
1618 struct tipc_msg *msg,
1619 u32 selector)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001620{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001621 struct tipc_link *tunnel;
Ying Xuea6ca1092014-11-26 11:41:55 +08001622 struct sk_buff *skb;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001623 u32 length = msg_size(msg);
1624
1625 tunnel = l_ptr->owner->active_links[selector & 1];
Allan Stephens5392d642006-06-25 23:52:50 -07001626 if (!tipc_link_is_up(tunnel)) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001627 pr_warn("%stunnel link no longer available\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001628 return;
Allan Stephens5392d642006-06-25 23:52:50 -07001629 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001630 msg_set_size(tunnel_hdr, length + INT_H_SIZE);
Ying Xuea6ca1092014-11-26 11:41:55 +08001631 skb = tipc_buf_acquire(length + INT_H_SIZE);
1632 if (!skb) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001633 pr_warn("%sunable to send tunnel msg\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001634 return;
Allan Stephens5392d642006-06-25 23:52:50 -07001635 }
Ying Xuea6ca1092014-11-26 11:41:55 +08001636 skb_copy_to_linear_data(skb, tunnel_hdr, INT_H_SIZE);
1637 skb_copy_to_linear_data_offset(skb, INT_H_SIZE, msg, length);
1638 __tipc_link_xmit_skb(tunnel, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001639}
1640
1641
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001642/* tipc_link_failover_send_queue(): A link has gone down, but a second
1643 * link is still active. We can do failover. Tunnel the failing link's
1644 * whole send queue via the remaining link. This way, we don't lose
1645 * any packets, and sequence order is preserved for subsequent traffic
1646 * sent over the remaining link. Owner node is locked.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001647 */
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001648void tipc_link_failover_send_queue(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001649{
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001650 int msgcount;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001651 struct tipc_link *tunnel = l_ptr->owner->active_links[0];
Per Lidenb97bf3f2006-01-02 19:04:38 +01001652 struct tipc_msg tunnel_hdr;
Ying Xue58dc55f2014-11-26 11:41:52 +08001653 struct sk_buff *skb;
Allan Stephens5392d642006-06-25 23:52:50 -07001654 int split_bundles;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001655
1656 if (!tunnel)
1657 return;
1658
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001659 tipc_msg_init(link_own_addr(l_ptr), &tunnel_hdr, CHANGEOVER_PROTOCOL,
Ying Xue34747532015-01-09 15:27:10 +08001660 ORIGINAL_MSG, INT_H_SIZE, l_ptr->addr);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001661 skb_queue_splice_tail_init(&l_ptr->backlogq, &l_ptr->transmq);
Jon Paul Maloy1f66d162015-03-25 12:07:24 -04001662 tipc_link_purge_backlog(l_ptr);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001663 msgcount = skb_queue_len(&l_ptr->transmq);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001664 msg_set_bearer_id(&tunnel_hdr, l_ptr->peer_bearer_id);
1665 msg_set_msgcnt(&tunnel_hdr, msgcount);
Allan Stephensf1310722006-06-25 23:51:37 -07001666
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001667 if (skb_queue_empty(&l_ptr->transmq)) {
Ying Xue58dc55f2014-11-26 11:41:52 +08001668 skb = tipc_buf_acquire(INT_H_SIZE);
1669 if (skb) {
1670 skb_copy_to_linear_data(skb, &tunnel_hdr, INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001671 msg_set_size(&tunnel_hdr, INT_H_SIZE);
Ying Xuea6ca1092014-11-26 11:41:55 +08001672 __tipc_link_xmit_skb(tunnel, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001673 } else {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001674 pr_warn("%sunable to send changeover msg\n",
1675 link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001676 }
1677 return;
1678 }
Allan Stephensf1310722006-06-25 23:51:37 -07001679
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001680 split_bundles = (l_ptr->owner->active_links[0] !=
Allan Stephens5392d642006-06-25 23:52:50 -07001681 l_ptr->owner->active_links[1]);
1682
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001683 skb_queue_walk(&l_ptr->transmq, skb) {
Ying Xue58dc55f2014-11-26 11:41:52 +08001684 struct tipc_msg *msg = buf_msg(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001685
1686 if ((msg_user(msg) == MSG_BUNDLER) && split_bundles) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001687 struct tipc_msg *m = msg_get_wrapped(msg);
Allan Stephens0e659672010-12-31 18:59:32 +00001688 unchar *pos = (unchar *)m;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001689
Florian Westphald788d802007-08-02 19:28:06 -07001690 msgcount = msg_msgcnt(msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001691 while (msgcount--) {
Allan Stephens0e659672010-12-31 18:59:32 +00001692 msg_set_seqno(m, msg_seqno(msg));
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001693 tipc_link_tunnel_xmit(l_ptr, &tunnel_hdr, m,
1694 msg_link_selector(m));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001695 pos += align(msg_size(m));
1696 m = (struct tipc_msg *)pos;
1697 }
1698 } else {
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001699 tipc_link_tunnel_xmit(l_ptr, &tunnel_hdr, msg,
1700 msg_link_selector(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001701 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001702 }
1703}
1704
Ying Xue247f0f32014-02-18 16:06:46 +08001705/* tipc_link_dup_queue_xmit(): A second link has become active. Tunnel a
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001706 * duplicate of the first link's send queue via the new link. This way, we
1707 * are guaranteed that currently queued packets from a socket are delivered
1708 * before future traffic from the same socket, even if this is using the
1709 * new link. The last arriving copy of each duplicate packet is dropped at
1710 * the receiving end by the regular protocol check, so packet cardinality
1711 * and sequence order is preserved per sender/receiver socket pair.
1712 * Owner node is locked.
1713 */
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001714void tipc_link_dup_queue_xmit(struct tipc_link *link,
1715 struct tipc_link *tnl)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001716{
Ying Xue58dc55f2014-11-26 11:41:52 +08001717 struct sk_buff *skb;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001718 struct tipc_msg tnl_hdr;
1719 struct sk_buff_head *queue = &link->transmq;
1720 int mcnt;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001721
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001722 tipc_msg_init(link_own_addr(link), &tnl_hdr, CHANGEOVER_PROTOCOL,
1723 DUPLICATE_MSG, INT_H_SIZE, link->addr);
1724 mcnt = skb_queue_len(&link->transmq) + skb_queue_len(&link->backlogq);
1725 msg_set_msgcnt(&tnl_hdr, mcnt);
1726 msg_set_bearer_id(&tnl_hdr, link->peer_bearer_id);
1727
1728tunnel_queue:
1729 skb_queue_walk(queue, skb) {
Ying Xue58dc55f2014-11-26 11:41:52 +08001730 struct sk_buff *outskb;
1731 struct tipc_msg *msg = buf_msg(skb);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001732 u32 len = msg_size(msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001733
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001734 msg_set_ack(msg, mod(link->next_in_no - 1));
1735 msg_set_bcast_ack(msg, link->owner->bclink.last_in);
1736 msg_set_size(&tnl_hdr, len + INT_H_SIZE);
1737 outskb = tipc_buf_acquire(len + INT_H_SIZE);
Ying Xue58dc55f2014-11-26 11:41:52 +08001738 if (outskb == NULL) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001739 pr_warn("%sunable to send duplicate msg\n",
1740 link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001741 return;
1742 }
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001743 skb_copy_to_linear_data(outskb, &tnl_hdr, INT_H_SIZE);
1744 skb_copy_to_linear_data_offset(outskb, INT_H_SIZE,
1745 skb->data, len);
1746 __tipc_link_xmit_skb(tnl, outskb);
1747 if (!tipc_link_is_up(link))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001748 return;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001749 }
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001750 if (queue == &link->backlogq)
1751 return;
1752 queue = &link->backlogq;
1753 goto tunnel_queue;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001754}
1755
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001756/* tipc_link_dup_rcv(): Receive a tunnelled DUPLICATE_MSG packet.
1757 * Owner node is locked.
1758 */
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001759static void tipc_link_dup_rcv(struct tipc_link *link,
1760 struct sk_buff *skb)
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001761{
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001762 struct sk_buff *iskb;
1763 int pos = 0;
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001764
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001765 if (!tipc_link_is_up(link))
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001766 return;
1767
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001768 if (!tipc_msg_extract(skb, &iskb, &pos)) {
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001769 pr_warn("%sfailed to extract inner dup pkt\n", link_co_err);
1770 return;
1771 }
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001772 /* Append buffer to deferred queue, if applicable: */
1773 link_handle_out_of_seq_msg(link, iskb);
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001774}
1775
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001776/* tipc_link_failover_rcv(): Receive a tunnelled ORIGINAL_MSG packet
1777 * Owner node is locked.
1778 */
1779static struct sk_buff *tipc_link_failover_rcv(struct tipc_link *l_ptr,
1780 struct sk_buff *t_buf)
1781{
1782 struct tipc_msg *t_msg = buf_msg(t_buf);
1783 struct sk_buff *buf = NULL;
1784 struct tipc_msg *msg;
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001785 int pos = 0;
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001786
1787 if (tipc_link_is_up(l_ptr))
1788 tipc_link_reset(l_ptr);
1789
1790 /* First failover packet? */
1791 if (l_ptr->exp_msg_count == START_CHANGEOVER)
1792 l_ptr->exp_msg_count = msg_msgcnt(t_msg);
1793
1794 /* Should there be an inner packet? */
1795 if (l_ptr->exp_msg_count) {
1796 l_ptr->exp_msg_count--;
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001797 if (!tipc_msg_extract(t_buf, &buf, &pos)) {
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001798 pr_warn("%sno inner failover pkt\n", link_co_err);
1799 goto exit;
1800 }
1801 msg = buf_msg(buf);
1802
1803 if (less(msg_seqno(msg), l_ptr->reset_checkpoint)) {
1804 kfree_skb(buf);
1805 buf = NULL;
1806 goto exit;
1807 }
1808 if (msg_user(msg) == MSG_FRAGMENTER) {
1809 l_ptr->stats.recv_fragments++;
Jon Paul Maloy37e22162014-05-14 05:39:12 -04001810 tipc_buf_append(&l_ptr->reasm_buf, &buf);
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001811 }
1812 }
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001813exit:
Jon Paul Maloy2d72d492015-02-03 08:59:17 -05001814 if ((!l_ptr->exp_msg_count) && (l_ptr->flags & LINK_STOPPED))
1815 tipc_link_delete(l_ptr);
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001816 return buf;
1817}
1818
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001819/* tipc_link_tunnel_rcv(): Receive a tunnelled packet, sent
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001820 * via other link as result of a failover (ORIGINAL_MSG) or
1821 * a new active link (DUPLICATE_MSG). Failover packets are
1822 * returned to the active link for delivery upwards.
1823 * Owner node is locked.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001824 */
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001825static int tipc_link_tunnel_rcv(struct tipc_node *n_ptr,
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001826 struct sk_buff **buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001827{
Jon Paul Maloy02842f72014-02-13 17:29:14 -05001828 struct sk_buff *t_buf = *buf;
1829 struct tipc_link *l_ptr;
1830 struct tipc_msg *t_msg = buf_msg(t_buf);
1831 u32 bearer_id = msg_bearer_id(t_msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001832
Jon Paul Maloy1e9d47a2014-02-13 17:29:13 -05001833 *buf = NULL;
1834
Dan Carpentercb4b102f2013-05-06 08:28:41 +00001835 if (bearer_id >= MAX_BEARERS)
1836 goto exit;
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001837
Jon Paul Maloy02842f72014-02-13 17:29:14 -05001838 l_ptr = n_ptr->links[bearer_id];
1839 if (!l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001840 goto exit;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001841
Jon Paul Maloy02842f72014-02-13 17:29:14 -05001842 if (msg_type(t_msg) == DUPLICATE_MSG)
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001843 tipc_link_dup_rcv(l_ptr, t_buf);
Jon Paul Maloy02842f72014-02-13 17:29:14 -05001844 else if (msg_type(t_msg) == ORIGINAL_MSG)
1845 *buf = tipc_link_failover_rcv(l_ptr, t_buf);
Jon Paul Maloy1e9d47a2014-02-13 17:29:13 -05001846 else
1847 pr_warn("%sunknown tunnel pkt received\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001848exit:
Jon Paul Maloy02842f72014-02-13 17:29:14 -05001849 kfree_skb(t_buf);
Jon Paul Maloy1e9d47a2014-02-13 17:29:13 -05001850 return *buf != NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001851}
1852
Ying Xue2f55c432015-01-09 15:27:00 +08001853static void link_set_supervision_props(struct tipc_link *l_ptr, u32 tol)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001854{
Ying Xue2f55c432015-01-09 15:27:00 +08001855 unsigned long intv = ((tol / 4) > 500) ? 500 : tol / 4;
1856
1857 if ((tol < TIPC_MIN_LINK_TOL) || (tol > TIPC_MAX_LINK_TOL))
Allan Stephens5413b4c2011-01-18 13:24:55 -05001858 return;
1859
Ying Xue2f55c432015-01-09 15:27:00 +08001860 l_ptr->tolerance = tol;
1861 l_ptr->cont_intv = msecs_to_jiffies(intv);
1862 l_ptr->abort_limit = tol / (jiffies_to_msecs(l_ptr->cont_intv) / 4);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001863}
1864
Jon Paul Maloye3eea1e2015-03-13 16:08:11 -04001865void tipc_link_set_queue_limits(struct tipc_link *l, u32 win)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001866{
Jon Paul Maloye3eea1e2015-03-13 16:08:11 -04001867 int max_bulk = TIPC_MAX_PUBLICATIONS / (l->max_pkt / ITEM_SIZE);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001868
Jon Paul Maloye3eea1e2015-03-13 16:08:11 -04001869 l->window = win;
Jon Paul Maloy1f66d162015-03-25 12:07:24 -04001870 l->backlog[TIPC_LOW_IMPORTANCE].limit = win / 2;
1871 l->backlog[TIPC_MEDIUM_IMPORTANCE].limit = win;
1872 l->backlog[TIPC_HIGH_IMPORTANCE].limit = win / 2 * 3;
1873 l->backlog[TIPC_CRITICAL_IMPORTANCE].limit = win * 2;
1874 l->backlog[TIPC_SYSTEM_IMPORTANCE].limit = max_bulk;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001875}
1876
Jon Paul Maloye099e862014-02-13 17:29:18 -05001877/* tipc_link_find_owner - locate owner node of link by link's name
Ying Xuef2f98002015-01-09 15:27:05 +08001878 * @net: the applicable net namespace
Jon Paul Maloye099e862014-02-13 17:29:18 -05001879 * @name: pointer to link name string
1880 * @bearer_id: pointer to index in 'node->links' array where the link was found.
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001881 *
Jon Paul Maloye099e862014-02-13 17:29:18 -05001882 * Returns pointer to node owning the link, or 0 if no matching link is found.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001883 */
Ying Xuef2f98002015-01-09 15:27:05 +08001884static struct tipc_node *tipc_link_find_owner(struct net *net,
1885 const char *link_name,
Jon Paul Maloye099e862014-02-13 17:29:18 -05001886 unsigned int *bearer_id)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001887{
Ying Xuef2f98002015-01-09 15:27:05 +08001888 struct tipc_net *tn = net_generic(net, tipc_net_id);
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001889 struct tipc_link *l_ptr;
Erik Hugnebbfbe472013-10-18 07:23:21 +02001890 struct tipc_node *n_ptr;
Fabian Frederick886eaa12014-12-25 12:05:50 +01001891 struct tipc_node *found_node = NULL;
Erik Hugnebbfbe472013-10-18 07:23:21 +02001892 int i;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001893
Jon Paul Maloye099e862014-02-13 17:29:18 -05001894 *bearer_id = 0;
Ying Xue6c7a7622014-03-27 12:54:37 +08001895 rcu_read_lock();
Ying Xuef2f98002015-01-09 15:27:05 +08001896 list_for_each_entry_rcu(n_ptr, &tn->node_list, list) {
Jon Paul Maloya11607f2014-02-14 16:40:44 -05001897 tipc_node_lock(n_ptr);
Erik Hugnebbfbe472013-10-18 07:23:21 +02001898 for (i = 0; i < MAX_BEARERS; i++) {
1899 l_ptr = n_ptr->links[i];
Jon Paul Maloye099e862014-02-13 17:29:18 -05001900 if (l_ptr && !strcmp(l_ptr->name, link_name)) {
1901 *bearer_id = i;
1902 found_node = n_ptr;
1903 break;
1904 }
Erik Hugnebbfbe472013-10-18 07:23:21 +02001905 }
Jon Paul Maloya11607f2014-02-14 16:40:44 -05001906 tipc_node_unlock(n_ptr);
Jon Paul Maloye099e862014-02-13 17:29:18 -05001907 if (found_node)
1908 break;
Erik Hugnebbfbe472013-10-18 07:23:21 +02001909 }
Ying Xue6c7a7622014-03-27 12:54:37 +08001910 rcu_read_unlock();
1911
Jon Paul Maloye099e862014-02-13 17:29:18 -05001912 return found_node;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001913}
1914
Allan Stephens5c216e12011-10-18 11:34:29 -04001915/**
Per Lidenb97bf3f2006-01-02 19:04:38 +01001916 * link_reset_statistics - reset link statistics
1917 * @l_ptr: pointer to link
1918 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001919static void link_reset_statistics(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001920{
1921 memset(&l_ptr->stats, 0, sizeof(l_ptr->stats));
1922 l_ptr->stats.sent_info = l_ptr->next_out_no;
1923 l_ptr->stats.recv_info = l_ptr->next_in_no;
1924}
1925
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001926static void link_print(struct tipc_link *l_ptr, const char *str)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001927{
Ying Xue7f9f95d2015-01-09 15:27:06 +08001928 struct tipc_net *tn = net_generic(l_ptr->owner->net, tipc_net_id);
Ying Xue7a2f7d12014-04-21 10:55:46 +08001929 struct tipc_bearer *b_ptr;
1930
1931 rcu_read_lock();
Ying Xue7f9f95d2015-01-09 15:27:06 +08001932 b_ptr = rcu_dereference_rtnl(tn->bearer_list[l_ptr->bearer_id]);
Ying Xue7a2f7d12014-04-21 10:55:46 +08001933 if (b_ptr)
1934 pr_info("%s Link %x<%s>:", str, l_ptr->addr, b_ptr->name);
1935 rcu_read_unlock();
Allan Stephens8d64a5b2010-12-31 18:59:27 +00001936
Per Lidenb97bf3f2006-01-02 19:04:38 +01001937 if (link_working_unknown(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04001938 pr_cont(":WU\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00001939 else if (link_reset_reset(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04001940 pr_cont(":RR\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00001941 else if (link_reset_unknown(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04001942 pr_cont(":RU\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00001943 else if (link_working_working(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04001944 pr_cont(":WW\n");
1945 else
1946 pr_cont("\n");
Per Lidenb97bf3f2006-01-02 19:04:38 +01001947}
Richard Alpe0655f6a2014-11-20 10:29:07 +01001948
1949/* Parse and validate nested (link) properties valid for media, bearer and link
1950 */
1951int tipc_nl_parse_link_prop(struct nlattr *prop, struct nlattr *props[])
1952{
1953 int err;
1954
1955 err = nla_parse_nested(props, TIPC_NLA_PROP_MAX, prop,
1956 tipc_nl_prop_policy);
1957 if (err)
1958 return err;
1959
1960 if (props[TIPC_NLA_PROP_PRIO]) {
1961 u32 prio;
1962
1963 prio = nla_get_u32(props[TIPC_NLA_PROP_PRIO]);
1964 if (prio > TIPC_MAX_LINK_PRI)
1965 return -EINVAL;
1966 }
1967
1968 if (props[TIPC_NLA_PROP_TOL]) {
1969 u32 tol;
1970
1971 tol = nla_get_u32(props[TIPC_NLA_PROP_TOL]);
1972 if ((tol < TIPC_MIN_LINK_TOL) || (tol > TIPC_MAX_LINK_TOL))
1973 return -EINVAL;
1974 }
1975
1976 if (props[TIPC_NLA_PROP_WIN]) {
1977 u32 win;
1978
1979 win = nla_get_u32(props[TIPC_NLA_PROP_WIN]);
1980 if ((win < TIPC_MIN_LINK_WIN) || (win > TIPC_MAX_LINK_WIN))
1981 return -EINVAL;
1982 }
1983
1984 return 0;
1985}
Richard Alpe7be57fc2014-11-20 10:29:12 +01001986
Richard Alpef96ce7a2014-11-20 10:29:13 +01001987int tipc_nl_link_set(struct sk_buff *skb, struct genl_info *info)
1988{
1989 int err;
1990 int res = 0;
1991 int bearer_id;
1992 char *name;
1993 struct tipc_link *link;
1994 struct tipc_node *node;
1995 struct nlattr *attrs[TIPC_NLA_LINK_MAX + 1];
Richard Alpe37e2d482015-02-09 09:50:08 +01001996 struct net *net = sock_net(skb->sk);
Richard Alpef96ce7a2014-11-20 10:29:13 +01001997
1998 if (!info->attrs[TIPC_NLA_LINK])
1999 return -EINVAL;
2000
2001 err = nla_parse_nested(attrs, TIPC_NLA_LINK_MAX,
2002 info->attrs[TIPC_NLA_LINK],
2003 tipc_nl_link_policy);
2004 if (err)
2005 return err;
2006
2007 if (!attrs[TIPC_NLA_LINK_NAME])
2008 return -EINVAL;
2009
2010 name = nla_data(attrs[TIPC_NLA_LINK_NAME]);
2011
Ying Xuef2f98002015-01-09 15:27:05 +08002012 node = tipc_link_find_owner(net, name, &bearer_id);
Richard Alpef96ce7a2014-11-20 10:29:13 +01002013 if (!node)
2014 return -EINVAL;
2015
2016 tipc_node_lock(node);
2017
2018 link = node->links[bearer_id];
2019 if (!link) {
2020 res = -EINVAL;
2021 goto out;
2022 }
2023
2024 if (attrs[TIPC_NLA_LINK_PROP]) {
2025 struct nlattr *props[TIPC_NLA_PROP_MAX + 1];
2026
2027 err = tipc_nl_parse_link_prop(attrs[TIPC_NLA_LINK_PROP],
2028 props);
2029 if (err) {
2030 res = err;
2031 goto out;
2032 }
2033
2034 if (props[TIPC_NLA_PROP_TOL]) {
2035 u32 tol;
2036
2037 tol = nla_get_u32(props[TIPC_NLA_PROP_TOL]);
2038 link_set_supervision_props(link, tol);
2039 tipc_link_proto_xmit(link, STATE_MSG, 0, 0, tol, 0, 0);
2040 }
2041 if (props[TIPC_NLA_PROP_PRIO]) {
2042 u32 prio;
2043
2044 prio = nla_get_u32(props[TIPC_NLA_PROP_PRIO]);
2045 link->priority = prio;
2046 tipc_link_proto_xmit(link, STATE_MSG, 0, 0, 0, prio, 0);
2047 }
2048 if (props[TIPC_NLA_PROP_WIN]) {
2049 u32 win;
2050
2051 win = nla_get_u32(props[TIPC_NLA_PROP_WIN]);
2052 tipc_link_set_queue_limits(link, win);
2053 }
2054 }
2055
2056out:
2057 tipc_node_unlock(node);
2058
2059 return res;
2060}
Richard Alped8182802014-11-24 11:10:29 +01002061
2062static int __tipc_nl_add_stats(struct sk_buff *skb, struct tipc_stats *s)
Richard Alpe7be57fc2014-11-20 10:29:12 +01002063{
2064 int i;
2065 struct nlattr *stats;
2066
2067 struct nla_map {
2068 u32 key;
2069 u32 val;
2070 };
2071
2072 struct nla_map map[] = {
2073 {TIPC_NLA_STATS_RX_INFO, s->recv_info},
2074 {TIPC_NLA_STATS_RX_FRAGMENTS, s->recv_fragments},
2075 {TIPC_NLA_STATS_RX_FRAGMENTED, s->recv_fragmented},
2076 {TIPC_NLA_STATS_RX_BUNDLES, s->recv_bundles},
2077 {TIPC_NLA_STATS_RX_BUNDLED, s->recv_bundled},
2078 {TIPC_NLA_STATS_TX_INFO, s->sent_info},
2079 {TIPC_NLA_STATS_TX_FRAGMENTS, s->sent_fragments},
2080 {TIPC_NLA_STATS_TX_FRAGMENTED, s->sent_fragmented},
2081 {TIPC_NLA_STATS_TX_BUNDLES, s->sent_bundles},
2082 {TIPC_NLA_STATS_TX_BUNDLED, s->sent_bundled},
2083 {TIPC_NLA_STATS_MSG_PROF_TOT, (s->msg_length_counts) ?
2084 s->msg_length_counts : 1},
2085 {TIPC_NLA_STATS_MSG_LEN_CNT, s->msg_length_counts},
2086 {TIPC_NLA_STATS_MSG_LEN_TOT, s->msg_lengths_total},
2087 {TIPC_NLA_STATS_MSG_LEN_P0, s->msg_length_profile[0]},
2088 {TIPC_NLA_STATS_MSG_LEN_P1, s->msg_length_profile[1]},
2089 {TIPC_NLA_STATS_MSG_LEN_P2, s->msg_length_profile[2]},
2090 {TIPC_NLA_STATS_MSG_LEN_P3, s->msg_length_profile[3]},
2091 {TIPC_NLA_STATS_MSG_LEN_P4, s->msg_length_profile[4]},
2092 {TIPC_NLA_STATS_MSG_LEN_P5, s->msg_length_profile[5]},
2093 {TIPC_NLA_STATS_MSG_LEN_P6, s->msg_length_profile[6]},
2094 {TIPC_NLA_STATS_RX_STATES, s->recv_states},
2095 {TIPC_NLA_STATS_RX_PROBES, s->recv_probes},
2096 {TIPC_NLA_STATS_RX_NACKS, s->recv_nacks},
2097 {TIPC_NLA_STATS_RX_DEFERRED, s->deferred_recv},
2098 {TIPC_NLA_STATS_TX_STATES, s->sent_states},
2099 {TIPC_NLA_STATS_TX_PROBES, s->sent_probes},
2100 {TIPC_NLA_STATS_TX_NACKS, s->sent_nacks},
2101 {TIPC_NLA_STATS_TX_ACKS, s->sent_acks},
2102 {TIPC_NLA_STATS_RETRANSMITTED, s->retransmitted},
2103 {TIPC_NLA_STATS_DUPLICATES, s->duplicates},
2104 {TIPC_NLA_STATS_LINK_CONGS, s->link_congs},
2105 {TIPC_NLA_STATS_MAX_QUEUE, s->max_queue_sz},
2106 {TIPC_NLA_STATS_AVG_QUEUE, s->queue_sz_counts ?
2107 (s->accu_queue_sz / s->queue_sz_counts) : 0}
2108 };
2109
2110 stats = nla_nest_start(skb, TIPC_NLA_LINK_STATS);
2111 if (!stats)
2112 return -EMSGSIZE;
2113
2114 for (i = 0; i < ARRAY_SIZE(map); i++)
2115 if (nla_put_u32(skb, map[i].key, map[i].val))
2116 goto msg_full;
2117
2118 nla_nest_end(skb, stats);
2119
2120 return 0;
2121msg_full:
2122 nla_nest_cancel(skb, stats);
2123
2124 return -EMSGSIZE;
2125}
2126
2127/* Caller should hold appropriate locks to protect the link */
Ying Xue34747532015-01-09 15:27:10 +08002128static int __tipc_nl_add_link(struct net *net, struct tipc_nl_msg *msg,
2129 struct tipc_link *link)
Richard Alpe7be57fc2014-11-20 10:29:12 +01002130{
2131 int err;
2132 void *hdr;
2133 struct nlattr *attrs;
2134 struct nlattr *prop;
Ying Xue34747532015-01-09 15:27:10 +08002135 struct tipc_net *tn = net_generic(net, tipc_net_id);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002136
Richard Alpebfb3e5d2015-02-09 09:50:03 +01002137 hdr = genlmsg_put(msg->skb, msg->portid, msg->seq, &tipc_genl_family,
Richard Alpe7be57fc2014-11-20 10:29:12 +01002138 NLM_F_MULTI, TIPC_NL_LINK_GET);
2139 if (!hdr)
2140 return -EMSGSIZE;
2141
2142 attrs = nla_nest_start(msg->skb, TIPC_NLA_LINK);
2143 if (!attrs)
2144 goto msg_full;
2145
2146 if (nla_put_string(msg->skb, TIPC_NLA_LINK_NAME, link->name))
2147 goto attr_msg_full;
2148 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_DEST,
Ying Xue34747532015-01-09 15:27:10 +08002149 tipc_cluster_mask(tn->own_addr)))
Richard Alpe7be57fc2014-11-20 10:29:12 +01002150 goto attr_msg_full;
2151 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_MTU, link->max_pkt))
2152 goto attr_msg_full;
2153 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_RX, link->next_in_no))
2154 goto attr_msg_full;
2155 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_TX, link->next_out_no))
2156 goto attr_msg_full;
2157
2158 if (tipc_link_is_up(link))
2159 if (nla_put_flag(msg->skb, TIPC_NLA_LINK_UP))
2160 goto attr_msg_full;
2161 if (tipc_link_is_active(link))
2162 if (nla_put_flag(msg->skb, TIPC_NLA_LINK_ACTIVE))
2163 goto attr_msg_full;
2164
2165 prop = nla_nest_start(msg->skb, TIPC_NLA_LINK_PROP);
2166 if (!prop)
2167 goto attr_msg_full;
2168 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_PRIO, link->priority))
2169 goto prop_msg_full;
2170 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_TOL, link->tolerance))
2171 goto prop_msg_full;
2172 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_WIN,
Jon Paul Maloy1f66d162015-03-25 12:07:24 -04002173 link->window))
Richard Alpe7be57fc2014-11-20 10:29:12 +01002174 goto prop_msg_full;
2175 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_PRIO, link->priority))
2176 goto prop_msg_full;
2177 nla_nest_end(msg->skb, prop);
2178
2179 err = __tipc_nl_add_stats(msg->skb, &link->stats);
2180 if (err)
2181 goto attr_msg_full;
2182
2183 nla_nest_end(msg->skb, attrs);
2184 genlmsg_end(msg->skb, hdr);
2185
2186 return 0;
2187
2188prop_msg_full:
2189 nla_nest_cancel(msg->skb, prop);
2190attr_msg_full:
2191 nla_nest_cancel(msg->skb, attrs);
2192msg_full:
2193 genlmsg_cancel(msg->skb, hdr);
2194
2195 return -EMSGSIZE;
2196}
2197
2198/* Caller should hold node lock */
Ying Xue34747532015-01-09 15:27:10 +08002199static int __tipc_nl_add_node_links(struct net *net, struct tipc_nl_msg *msg,
2200 struct tipc_node *node, u32 *prev_link)
Richard Alpe7be57fc2014-11-20 10:29:12 +01002201{
2202 u32 i;
2203 int err;
2204
2205 for (i = *prev_link; i < MAX_BEARERS; i++) {
2206 *prev_link = i;
2207
2208 if (!node->links[i])
2209 continue;
2210
Ying Xue34747532015-01-09 15:27:10 +08002211 err = __tipc_nl_add_link(net, msg, node->links[i]);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002212 if (err)
2213 return err;
2214 }
2215 *prev_link = 0;
2216
2217 return 0;
2218}
2219
2220int tipc_nl_link_dump(struct sk_buff *skb, struct netlink_callback *cb)
2221{
Ying Xuef2f98002015-01-09 15:27:05 +08002222 struct net *net = sock_net(skb->sk);
2223 struct tipc_net *tn = net_generic(net, tipc_net_id);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002224 struct tipc_node *node;
2225 struct tipc_nl_msg msg;
2226 u32 prev_node = cb->args[0];
2227 u32 prev_link = cb->args[1];
2228 int done = cb->args[2];
2229 int err;
2230
2231 if (done)
2232 return 0;
2233
2234 msg.skb = skb;
2235 msg.portid = NETLINK_CB(cb->skb).portid;
2236 msg.seq = cb->nlh->nlmsg_seq;
2237
2238 rcu_read_lock();
2239
2240 if (prev_node) {
Ying Xuef2f98002015-01-09 15:27:05 +08002241 node = tipc_node_find(net, prev_node);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002242 if (!node) {
2243 /* We never set seq or call nl_dump_check_consistent()
2244 * this means that setting prev_seq here will cause the
2245 * consistence check to fail in the netlink callback
2246 * handler. Resulting in the last NLMSG_DONE message
2247 * having the NLM_F_DUMP_INTR flag set.
2248 */
2249 cb->prev_seq = 1;
2250 goto out;
2251 }
2252
Ying Xuef2f98002015-01-09 15:27:05 +08002253 list_for_each_entry_continue_rcu(node, &tn->node_list,
2254 list) {
Richard Alpe7be57fc2014-11-20 10:29:12 +01002255 tipc_node_lock(node);
Ying Xue34747532015-01-09 15:27:10 +08002256 err = __tipc_nl_add_node_links(net, &msg, node,
2257 &prev_link);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002258 tipc_node_unlock(node);
2259 if (err)
2260 goto out;
2261
2262 prev_node = node->addr;
2263 }
2264 } else {
Ying Xue1da46562015-01-09 15:27:07 +08002265 err = tipc_nl_add_bc_link(net, &msg);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002266 if (err)
2267 goto out;
2268
Ying Xuef2f98002015-01-09 15:27:05 +08002269 list_for_each_entry_rcu(node, &tn->node_list, list) {
Richard Alpe7be57fc2014-11-20 10:29:12 +01002270 tipc_node_lock(node);
Ying Xue34747532015-01-09 15:27:10 +08002271 err = __tipc_nl_add_node_links(net, &msg, node,
2272 &prev_link);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002273 tipc_node_unlock(node);
2274 if (err)
2275 goto out;
2276
2277 prev_node = node->addr;
2278 }
2279 }
2280 done = 1;
2281out:
2282 rcu_read_unlock();
2283
2284 cb->args[0] = prev_node;
2285 cb->args[1] = prev_link;
2286 cb->args[2] = done;
2287
2288 return skb->len;
2289}
2290
2291int tipc_nl_link_get(struct sk_buff *skb, struct genl_info *info)
2292{
Ying Xuef2f98002015-01-09 15:27:05 +08002293 struct net *net = genl_info_net(info);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002294 struct sk_buff *ans_skb;
2295 struct tipc_nl_msg msg;
2296 struct tipc_link *link;
2297 struct tipc_node *node;
2298 char *name;
2299 int bearer_id;
2300 int err;
2301
2302 if (!info->attrs[TIPC_NLA_LINK_NAME])
2303 return -EINVAL;
2304
2305 name = nla_data(info->attrs[TIPC_NLA_LINK_NAME]);
Ying Xuef2f98002015-01-09 15:27:05 +08002306 node = tipc_link_find_owner(net, name, &bearer_id);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002307 if (!node)
2308 return -EINVAL;
2309
2310 ans_skb = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
2311 if (!ans_skb)
2312 return -ENOMEM;
2313
2314 msg.skb = ans_skb;
2315 msg.portid = info->snd_portid;
2316 msg.seq = info->snd_seq;
2317
2318 tipc_node_lock(node);
2319 link = node->links[bearer_id];
2320 if (!link) {
2321 err = -EINVAL;
2322 goto err_out;
2323 }
2324
Ying Xue34747532015-01-09 15:27:10 +08002325 err = __tipc_nl_add_link(net, &msg, link);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002326 if (err)
2327 goto err_out;
2328
2329 tipc_node_unlock(node);
2330
2331 return genlmsg_reply(ans_skb, info);
2332
2333err_out:
2334 tipc_node_unlock(node);
2335 nlmsg_free(ans_skb);
2336
2337 return err;
2338}
Richard Alpeae363422014-11-20 10:29:14 +01002339
2340int tipc_nl_link_reset_stats(struct sk_buff *skb, struct genl_info *info)
2341{
2342 int err;
2343 char *link_name;
2344 unsigned int bearer_id;
2345 struct tipc_link *link;
2346 struct tipc_node *node;
2347 struct nlattr *attrs[TIPC_NLA_LINK_MAX + 1];
Richard Alpe18178772015-02-09 09:50:09 +01002348 struct net *net = sock_net(skb->sk);
Richard Alpeae363422014-11-20 10:29:14 +01002349
2350 if (!info->attrs[TIPC_NLA_LINK])
2351 return -EINVAL;
2352
2353 err = nla_parse_nested(attrs, TIPC_NLA_LINK_MAX,
2354 info->attrs[TIPC_NLA_LINK],
2355 tipc_nl_link_policy);
2356 if (err)
2357 return err;
2358
2359 if (!attrs[TIPC_NLA_LINK_NAME])
2360 return -EINVAL;
2361
2362 link_name = nla_data(attrs[TIPC_NLA_LINK_NAME]);
2363
2364 if (strcmp(link_name, tipc_bclink_name) == 0) {
Ying Xue1da46562015-01-09 15:27:07 +08002365 err = tipc_bclink_reset_stats(net);
Richard Alpeae363422014-11-20 10:29:14 +01002366 if (err)
2367 return err;
2368 return 0;
2369 }
2370
Ying Xuef2f98002015-01-09 15:27:05 +08002371 node = tipc_link_find_owner(net, link_name, &bearer_id);
Richard Alpeae363422014-11-20 10:29:14 +01002372 if (!node)
2373 return -EINVAL;
2374
2375 tipc_node_lock(node);
2376
2377 link = node->links[bearer_id];
2378 if (!link) {
2379 tipc_node_unlock(node);
2380 return -EINVAL;
2381 }
2382
2383 link_reset_statistics(link);
2384
2385 tipc_node_unlock(node);
2386
2387 return 0;
2388}