blob: 514466efc25cd64961c64d39bba2fce6801ff757 [file] [log] [blame]
Per Lidenb97bf3f2006-01-02 19:04:38 +01001/*
2 * net/tipc/link.c: TIPC link code
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09003 *
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04004 * Copyright (c) 1996-2007, 2012-2015, Ericsson AB
Ying Xue198d73b2013-06-17 10:54:42 -04005 * Copyright (c) 2004-2007, 2010-2013, Wind River Systems
Per Lidenb97bf3f2006-01-02 19:04:38 +01006 * All rights reserved.
7 *
Per Liden9ea1fd32006-01-11 13:30:43 +01008 * Redistribution and use in source and binary forms, with or without
Per Lidenb97bf3f2006-01-02 19:04:38 +01009 * modification, are permitted provided that the following conditions are met:
10 *
Per Liden9ea1fd32006-01-11 13:30:43 +010011 * 1. Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the distribution.
16 * 3. Neither the names of the copyright holders nor the names of its
17 * contributors may be used to endorse or promote products derived from
18 * this software without specific prior written permission.
Per Lidenb97bf3f2006-01-02 19:04:38 +010019 *
Per Liden9ea1fd32006-01-11 13:30:43 +010020 * Alternatively, this software may be distributed under the terms of the
21 * GNU General Public License ("GPL") version 2 as published by the Free
22 * Software Foundation.
23 *
24 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
25 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
26 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
27 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
28 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
29 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
30 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
31 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
32 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
33 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
Per Lidenb97bf3f2006-01-02 19:04:38 +010034 * POSSIBILITY OF SUCH DAMAGE.
35 */
36
37#include "core.h"
Jon Paul Maloye3eea1e2015-03-13 16:08:11 -040038#include "subscr.h"
Per Lidenb97bf3f2006-01-02 19:04:38 +010039#include "link.h"
Richard Alpe7be57fc2014-11-20 10:29:12 +010040#include "bcast.h"
Jon Paul Maloy9816f062014-05-14 05:39:15 -040041#include "socket.h"
Per Lidenb97bf3f2006-01-02 19:04:38 +010042#include "name_distr.h"
Per Lidenb97bf3f2006-01-02 19:04:38 +010043#include "discover.h"
Richard Alpe0655f6a2014-11-20 10:29:07 +010044#include "netlink.h"
Per Lidenb97bf3f2006-01-02 19:04:38 +010045
Ying Xue796c75d2013-06-17 10:54:48 -040046#include <linux/pkt_sched.h>
47
Erik Hugne2cf8aa12012-06-29 00:16:37 -040048/*
49 * Error message prefixes
50 */
51static const char *link_co_err = "Link changeover error, ";
52static const char *link_rst_msg = "Resetting link ";
53static const char *link_unk_evt = "Unknown link event ";
Per Lidenb97bf3f2006-01-02 19:04:38 +010054
Richard Alpe7be57fc2014-11-20 10:29:12 +010055static const struct nla_policy tipc_nl_link_policy[TIPC_NLA_LINK_MAX + 1] = {
56 [TIPC_NLA_LINK_UNSPEC] = { .type = NLA_UNSPEC },
57 [TIPC_NLA_LINK_NAME] = {
58 .type = NLA_STRING,
59 .len = TIPC_MAX_LINK_NAME
60 },
61 [TIPC_NLA_LINK_MTU] = { .type = NLA_U32 },
62 [TIPC_NLA_LINK_BROADCAST] = { .type = NLA_FLAG },
63 [TIPC_NLA_LINK_UP] = { .type = NLA_FLAG },
64 [TIPC_NLA_LINK_ACTIVE] = { .type = NLA_FLAG },
65 [TIPC_NLA_LINK_PROP] = { .type = NLA_NESTED },
66 [TIPC_NLA_LINK_STATS] = { .type = NLA_NESTED },
67 [TIPC_NLA_LINK_RX] = { .type = NLA_U32 },
68 [TIPC_NLA_LINK_TX] = { .type = NLA_U32 }
69};
70
Richard Alpe0655f6a2014-11-20 10:29:07 +010071/* Properties valid for media, bearar and link */
72static const struct nla_policy tipc_nl_prop_policy[TIPC_NLA_PROP_MAX + 1] = {
73 [TIPC_NLA_PROP_UNSPEC] = { .type = NLA_UNSPEC },
74 [TIPC_NLA_PROP_PRIO] = { .type = NLA_U32 },
75 [TIPC_NLA_PROP_TOL] = { .type = NLA_U32 },
76 [TIPC_NLA_PROP_WIN] = { .type = NLA_U32 }
77};
78
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +090079/*
Allan Stephensa686e682008-06-04 17:29:39 -070080 * Out-of-range value for link session numbers
81 */
Allan Stephensa686e682008-06-04 17:29:39 -070082#define INVALID_SESSION 0x10000
83
84/*
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +090085 * Link state events:
Per Lidenb97bf3f2006-01-02 19:04:38 +010086 */
Per Lidenb97bf3f2006-01-02 19:04:38 +010087#define STARTING_EVT 856384768 /* link processing trigger */
88#define TRAFFIC_MSG_EVT 560815u /* rx'd ??? */
89#define TIMEOUT_EVT 560817u /* link timer expired */
90
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +090091/*
92 * The following two 'message types' is really just implementation
93 * data conveniently stored in the message header.
Per Lidenb97bf3f2006-01-02 19:04:38 +010094 * They must not be considered part of the protocol
95 */
96#define OPEN_MSG 0
97#define CLOSED_MSG 1
98
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +090099/*
Per Lidenb97bf3f2006-01-02 19:04:38 +0100100 * State value stored in 'exp_msg_count'
101 */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100102#define START_CHANGEOVER 100000u
103
Jon Paul Maloyc5898632015-02-05 08:36:36 -0500104static void link_handle_out_of_seq_msg(struct tipc_link *link,
105 struct sk_buff *skb);
106static void tipc_link_proto_rcv(struct tipc_link *link,
107 struct sk_buff *skb);
108static int tipc_link_tunnel_rcv(struct tipc_node *node,
109 struct sk_buff **skb);
Ying Xue2f55c432015-01-09 15:27:00 +0800110static void link_set_supervision_props(struct tipc_link *l_ptr, u32 tol);
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500111static void link_state_event(struct tipc_link *l_ptr, u32 event);
112static void link_reset_statistics(struct tipc_link *l_ptr);
113static void link_print(struct tipc_link *l_ptr, const char *str);
Ying Xue247f0f32014-02-18 16:06:46 +0800114static void tipc_link_sync_xmit(struct tipc_link *l);
115static void tipc_link_sync_rcv(struct tipc_node *n, struct sk_buff *buf);
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500116static void tipc_link_input(struct tipc_link *l, struct sk_buff *skb);
117static bool tipc_data_input(struct tipc_link *l, struct sk_buff *skb);
stephen hemminger31e3c3f2010-10-13 13:20:35 +0000118
Per Lidenb97bf3f2006-01-02 19:04:38 +0100119/*
Sam Ravnborg05790c62006-03-20 22:37:04 -0800120 * Simple link routines
Per Lidenb97bf3f2006-01-02 19:04:38 +0100121 */
Sam Ravnborg05790c62006-03-20 22:37:04 -0800122static unsigned int align(unsigned int i)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100123{
124 return (i + 3) & ~3u;
125}
126
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500127static void tipc_link_release(struct kref *kref)
128{
129 kfree(container_of(kref, struct tipc_link, ref));
130}
131
132static void tipc_link_get(struct tipc_link *l_ptr)
133{
134 kref_get(&l_ptr->ref);
135}
136
137static void tipc_link_put(struct tipc_link *l_ptr)
138{
139 kref_put(&l_ptr->ref, tipc_link_release);
140}
141
Jon Paul Maloy8b4ed862015-03-25 12:07:26 -0400142static struct tipc_link *tipc_parallel_link(struct tipc_link *l)
143{
144 if (l->owner->active_links[0] != l)
145 return l->owner->active_links[0];
146 return l->owner->active_links[1];
147}
148
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500149static void link_init_max_pkt(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100150{
Ying Xue7f9f95d2015-01-09 15:27:06 +0800151 struct tipc_node *node = l_ptr->owner;
152 struct tipc_net *tn = net_generic(node->net, tipc_net_id);
Ying Xue7a2f7d12014-04-21 10:55:46 +0800153 struct tipc_bearer *b_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100154 u32 max_pkt;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900155
Ying Xue7a2f7d12014-04-21 10:55:46 +0800156 rcu_read_lock();
Ying Xue7f9f95d2015-01-09 15:27:06 +0800157 b_ptr = rcu_dereference_rtnl(tn->bearer_list[l_ptr->bearer_id]);
Ying Xue7a2f7d12014-04-21 10:55:46 +0800158 if (!b_ptr) {
159 rcu_read_unlock();
160 return;
161 }
162 max_pkt = (b_ptr->mtu & ~3);
163 rcu_read_unlock();
164
Per Lidenb97bf3f2006-01-02 19:04:38 +0100165 if (max_pkt > MAX_MSG_SIZE)
166 max_pkt = MAX_MSG_SIZE;
167
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900168 l_ptr->max_pkt_target = max_pkt;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100169 if (l_ptr->max_pkt_target < MAX_PKT_DEFAULT)
170 l_ptr->max_pkt = l_ptr->max_pkt_target;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900171 else
Per Lidenb97bf3f2006-01-02 19:04:38 +0100172 l_ptr->max_pkt = MAX_PKT_DEFAULT;
173
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900174 l_ptr->max_pkt_probes = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100175}
176
Per Lidenb97bf3f2006-01-02 19:04:38 +0100177/*
Sam Ravnborg05790c62006-03-20 22:37:04 -0800178 * Simple non-static link routines (i.e. referenced outside this file)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100179 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500180int tipc_link_is_up(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100181{
182 if (!l_ptr)
183 return 0;
Eric Dumazeta02cec22010-09-22 20:43:57 +0000184 return link_working_working(l_ptr) || link_working_unknown(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100185}
186
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500187int tipc_link_is_active(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100188{
Eric Dumazeta02cec22010-09-22 20:43:57 +0000189 return (l_ptr->owner->active_links[0] == l_ptr) ||
190 (l_ptr->owner->active_links[1] == l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100191}
192
193/**
Per Lidenb97bf3f2006-01-02 19:04:38 +0100194 * link_timeout - handle expiration of link timer
195 * @l_ptr: pointer to link
Per Lidenb97bf3f2006-01-02 19:04:38 +0100196 */
Ying Xue2f55c432015-01-09 15:27:00 +0800197static void link_timeout(unsigned long data)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100198{
Ying Xue2f55c432015-01-09 15:27:00 +0800199 struct tipc_link *l_ptr = (struct tipc_link *)data;
Ying Xue58dc55f2014-11-26 11:41:52 +0800200 struct sk_buff *skb;
201
Per Liden4323add2006-01-18 00:38:21 +0100202 tipc_node_lock(l_ptr->owner);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100203
204 /* update counters used in statistical profiling of send traffic */
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400205 l_ptr->stats.accu_queue_sz += skb_queue_len(&l_ptr->transmq);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100206 l_ptr->stats.queue_sz_counts++;
207
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400208 skb = skb_peek(&l_ptr->transmq);
Ying Xue58dc55f2014-11-26 11:41:52 +0800209 if (skb) {
210 struct tipc_msg *msg = buf_msg(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100211 u32 length = msg_size(msg);
212
Joe Perchesf64f9e72009-11-29 16:55:45 -0800213 if ((msg_user(msg) == MSG_FRAGMENTER) &&
214 (msg_type(msg) == FIRST_FRAGMENT)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100215 length = msg_size(msg_get_wrapped(msg));
216 }
217 if (length) {
218 l_ptr->stats.msg_lengths_total += length;
219 l_ptr->stats.msg_length_counts++;
220 if (length <= 64)
221 l_ptr->stats.msg_length_profile[0]++;
222 else if (length <= 256)
223 l_ptr->stats.msg_length_profile[1]++;
224 else if (length <= 1024)
225 l_ptr->stats.msg_length_profile[2]++;
226 else if (length <= 4096)
227 l_ptr->stats.msg_length_profile[3]++;
228 else if (length <= 16384)
229 l_ptr->stats.msg_length_profile[4]++;
230 else if (length <= 32768)
231 l_ptr->stats.msg_length_profile[5]++;
232 else
233 l_ptr->stats.msg_length_profile[6]++;
234 }
235 }
236
237 /* do all other link processing performed on a periodic basis */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100238 link_state_event(l_ptr, TIMEOUT_EVT);
239
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400240 if (skb_queue_len(&l_ptr->backlogq))
Ying Xue47b4c9a2014-11-26 11:41:48 +0800241 tipc_link_push_packets(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100242
Per Liden4323add2006-01-18 00:38:21 +0100243 tipc_node_unlock(l_ptr->owner);
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500244 tipc_link_put(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100245}
246
Ying Xue2f55c432015-01-09 15:27:00 +0800247static void link_set_timer(struct tipc_link *link, unsigned long time)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100248{
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500249 if (!mod_timer(&link->timer, jiffies + time))
250 tipc_link_get(link);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100251}
252
253/**
Per Liden4323add2006-01-18 00:38:21 +0100254 * tipc_link_create - create a new link
Allan Stephens37b9c082011-02-28 11:32:27 -0500255 * @n_ptr: pointer to associated node
Per Lidenb97bf3f2006-01-02 19:04:38 +0100256 * @b_ptr: pointer to associated bearer
Per Lidenb97bf3f2006-01-02 19:04:38 +0100257 * @media_addr: media address to use when sending messages over link
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900258 *
Per Lidenb97bf3f2006-01-02 19:04:38 +0100259 * Returns pointer to link.
260 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500261struct tipc_link *tipc_link_create(struct tipc_node *n_ptr,
Ying Xuec61dd612014-02-13 17:29:09 -0500262 struct tipc_bearer *b_ptr,
263 const struct tipc_media_addr *media_addr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100264{
Ying Xue34747532015-01-09 15:27:10 +0800265 struct tipc_net *tn = net_generic(n_ptr->net, tipc_net_id);
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500266 struct tipc_link *l_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100267 struct tipc_msg *msg;
268 char *if_name;
Allan Stephens37b9c082011-02-28 11:32:27 -0500269 char addr_string[16];
270 u32 peer = n_ptr->addr;
271
Holger Brunck0372bf52014-11-14 18:33:19 +0100272 if (n_ptr->link_cnt >= MAX_BEARERS) {
Allan Stephens37b9c082011-02-28 11:32:27 -0500273 tipc_addr_string_fill(addr_string, n_ptr->addr);
Holger Brunck0372bf52014-11-14 18:33:19 +0100274 pr_err("Attempt to establish %uth link to %s. Max %u allowed.\n",
275 n_ptr->link_cnt, addr_string, MAX_BEARERS);
Allan Stephens37b9c082011-02-28 11:32:27 -0500276 return NULL;
277 }
278
279 if (n_ptr->links[b_ptr->identity]) {
280 tipc_addr_string_fill(addr_string, n_ptr->addr);
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400281 pr_err("Attempt to establish second link on <%s> to %s\n",
282 b_ptr->name, addr_string);
Allan Stephens37b9c082011-02-28 11:32:27 -0500283 return NULL;
284 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100285
Panagiotis Issaris0da974f2006-07-21 14:51:30 -0700286 l_ptr = kzalloc(sizeof(*l_ptr), GFP_ATOMIC);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100287 if (!l_ptr) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400288 pr_warn("Link creation failed, no memory\n");
Per Lidenb97bf3f2006-01-02 19:04:38 +0100289 return NULL;
290 }
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500291 kref_init(&l_ptr->ref);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100292 l_ptr->addr = peer;
Allan Stephens2d627b92011-01-07 13:00:11 -0500293 if_name = strchr(b_ptr->name, ':') + 1;
Allan Stephens062b4c92011-04-07 09:28:47 -0400294 sprintf(l_ptr->name, "%u.%u.%u:%s-%u.%u.%u:unknown",
Ying Xue34747532015-01-09 15:27:10 +0800295 tipc_zone(tn->own_addr), tipc_cluster(tn->own_addr),
296 tipc_node(tn->own_addr),
Per Lidenb97bf3f2006-01-02 19:04:38 +0100297 if_name,
298 tipc_zone(peer), tipc_cluster(peer), tipc_node(peer));
Allan Stephens062b4c92011-04-07 09:28:47 -0400299 /* note: peer i/f name is updated by reset/activate message */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100300 memcpy(&l_ptr->media_addr, media_addr, sizeof(*media_addr));
Allan Stephens37b9c082011-02-28 11:32:27 -0500301 l_ptr->owner = n_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100302 l_ptr->checkpoint = 1;
Allan Stephensf882cb762011-04-07 09:43:27 -0400303 l_ptr->peer_session = INVALID_SESSION;
Ying Xue7a2f7d12014-04-21 10:55:46 +0800304 l_ptr->bearer_id = b_ptr->identity;
Allan Stephens5c216e12011-10-18 11:34:29 -0400305 link_set_supervision_props(l_ptr, b_ptr->tolerance);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100306 l_ptr->state = RESET_UNKNOWN;
307
308 l_ptr->pmsg = (struct tipc_msg *)&l_ptr->proto_msg;
309 msg = l_ptr->pmsg;
Jon Paul Maloyc5898632015-02-05 08:36:36 -0500310 tipc_msg_init(tn->own_addr, msg, LINK_PROTOCOL, RESET_MSG, INT_H_SIZE,
Ying Xue34747532015-01-09 15:27:10 +0800311 l_ptr->addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100312 msg_set_size(msg, sizeof(l_ptr->proto_msg));
Ying Xuebafa29e2015-01-09 15:27:12 +0800313 msg_set_session(msg, (tn->random & 0xffff));
Per Lidenb97bf3f2006-01-02 19:04:38 +0100314 msg_set_bearer_id(msg, b_ptr->identity);
315 strcpy((char *)msg_data(msg), if_name);
Ying Xue7a2f7d12014-04-21 10:55:46 +0800316 l_ptr->net_plane = b_ptr->net_plane;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100317 link_init_max_pkt(l_ptr);
Jon Paul Maloye3eea1e2015-03-13 16:08:11 -0400318 l_ptr->priority = b_ptr->priority;
319 tipc_link_set_queue_limits(l_ptr, b_ptr->window);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100320 l_ptr->next_out_no = 1;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400321 __skb_queue_head_init(&l_ptr->transmq);
322 __skb_queue_head_init(&l_ptr->backlogq);
323 __skb_queue_head_init(&l_ptr->deferdq);
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500324 skb_queue_head_init(&l_ptr->wakeupq);
325 skb_queue_head_init(&l_ptr->inputq);
326 skb_queue_head_init(&l_ptr->namedq);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100327 link_reset_statistics(l_ptr);
Allan Stephens37b9c082011-02-28 11:32:27 -0500328 tipc_node_attach_link(n_ptr, l_ptr);
Ying Xue2f55c432015-01-09 15:27:00 +0800329 setup_timer(&l_ptr->timer, link_timeout, (unsigned long)l_ptr);
Jon Paul Maloy581465f2014-01-07 17:02:44 -0500330 link_state_event(l_ptr, STARTING_EVT);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100331
Per Lidenb97bf3f2006-01-02 19:04:38 +0100332 return l_ptr;
333}
334
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500335/**
336 * link_delete - Conditional deletion of link.
337 * If timer still running, real delete is done when it expires
338 * @link: link to be deleted
339 */
340void tipc_link_delete(struct tipc_link *link)
341{
342 tipc_link_reset_fragments(link);
343 tipc_node_detach_link(link->owner, link);
344 tipc_link_put(link);
345}
346
Ying Xuef2f98002015-01-09 15:27:05 +0800347void tipc_link_delete_list(struct net *net, unsigned int bearer_id,
348 bool shutting_down)
Ying Xue8d8439b2014-02-13 17:29:07 -0500349{
Ying Xuef2f98002015-01-09 15:27:05 +0800350 struct tipc_net *tn = net_generic(net, tipc_net_id);
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500351 struct tipc_link *link;
352 struct tipc_node *node;
Jon Paul Maloy169bf912015-03-10 12:23:34 -0400353 bool del_link;
Ying Xue8d8439b2014-02-13 17:29:07 -0500354
Ying Xue6c7a7622014-03-27 12:54:37 +0800355 rcu_read_lock();
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500356 list_for_each_entry_rcu(node, &tn->node_list, list) {
357 tipc_node_lock(node);
358 link = node->links[bearer_id];
359 if (!link) {
360 tipc_node_unlock(node);
Ying Xuec61dd612014-02-13 17:29:09 -0500361 continue;
362 }
Jon Paul Maloy169bf912015-03-10 12:23:34 -0400363 del_link = !tipc_link_is_up(link) && !link->exp_msg_count;
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500364 tipc_link_reset(link);
365 if (del_timer(&link->timer))
366 tipc_link_put(link);
367 link->flags |= LINK_STOPPED;
368 /* Delete link now, or when failover is finished: */
Jon Paul Maloy169bf912015-03-10 12:23:34 -0400369 if (shutting_down || !tipc_node_is_up(node) || del_link)
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500370 tipc_link_delete(link);
371 tipc_node_unlock(node);
Ying Xue8d8439b2014-02-13 17:29:07 -0500372 }
Ying Xue6c7a7622014-03-27 12:54:37 +0800373 rcu_read_unlock();
Ying Xue8d8439b2014-02-13 17:29:07 -0500374}
Per Lidenb97bf3f2006-01-02 19:04:38 +0100375
376/**
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400377 * link_schedule_user - schedule a message sender for wakeup after congestion
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400378 * @link: congested link
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400379 * @list: message that was attempted sent
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400380 * Create pseudo msg to send back to user when congestion abates
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400381 * Only consumes message if there is an error
Per Lidenb97bf3f2006-01-02 19:04:38 +0100382 */
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400383static int link_schedule_user(struct tipc_link *link, struct sk_buff_head *list)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100384{
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400385 struct tipc_msg *msg = buf_msg(skb_peek(list));
386 int imp = msg_importance(msg);
387 u32 oport = msg_origport(msg);
388 u32 addr = link_own_addr(link);
389 struct sk_buff *skb;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100390
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400391 /* This really cannot happen... */
392 if (unlikely(imp > TIPC_CRITICAL_IMPORTANCE)) {
393 pr_warn("%s<%s>, send queue full", link_rst_msg, link->name);
394 tipc_link_reset(link);
395 goto err;
396 }
397 /* Non-blocking sender: */
398 if (TIPC_SKB_CB(skb_peek(list))->wakeup_pending)
399 return -ELINKCONG;
400
401 /* Create and schedule wakeup pseudo message */
402 skb = tipc_msg_create(SOCK_WAKEUP, 0, INT_H_SIZE, 0,
403 addr, addr, oport, 0, 0);
404 if (!skb)
405 goto err;
406 TIPC_SKB_CB(skb)->chain_sz = skb_queue_len(list);
407 TIPC_SKB_CB(skb)->chain_imp = imp;
408 skb_queue_tail(&link->wakeupq, skb);
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400409 link->stats.link_congs++;
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400410 return -ELINKCONG;
411err:
412 __skb_queue_purge(list);
413 return -ENOBUFS;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100414}
415
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400416/**
417 * link_prepare_wakeup - prepare users for wakeup after congestion
418 * @link: congested link
419 * Move a number of waiting users, as permitted by available space in
420 * the send queue, from link wait queue to node wait queue for wakeup
421 */
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400422void link_prepare_wakeup(struct tipc_link *l)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100423{
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400424 int pnd[TIPC_SYSTEM_IMPORTANCE + 1] = {0,};
425 int imp, lim;
Ying Xue58d78b32014-11-26 11:41:51 +0800426 struct sk_buff *skb, *tmp;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100427
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400428 skb_queue_walk_safe(&l->wakeupq, skb, tmp) {
429 imp = TIPC_SKB_CB(skb)->chain_imp;
430 lim = l->window + l->backlog[imp].limit;
431 pnd[imp] += TIPC_SKB_CB(skb)->chain_sz;
432 if ((pnd[imp] + l->backlog[imp].len) >= lim)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100433 break;
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400434 skb_unlink(skb, &l->wakeupq);
435 skb_queue_tail(&l->inputq, skb);
436 l->owner->inputq = &l->inputq;
437 l->owner->action_flags |= TIPC_MSG_EVT;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100438 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100439}
440
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900441/**
Per Liden4323add2006-01-18 00:38:21 +0100442 * tipc_link_reset_fragments - purge link's inbound message fragments queue
Per Lidenb97bf3f2006-01-02 19:04:38 +0100443 * @l_ptr: pointer to link
444 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500445void tipc_link_reset_fragments(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100446{
Jon Paul Maloy37e22162014-05-14 05:39:12 -0400447 kfree_skb(l_ptr->reasm_buf);
448 l_ptr->reasm_buf = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100449}
450
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400451static void tipc_link_purge_backlog(struct tipc_link *l)
452{
453 __skb_queue_purge(&l->backlogq);
454 l->backlog[TIPC_LOW_IMPORTANCE].len = 0;
455 l->backlog[TIPC_MEDIUM_IMPORTANCE].len = 0;
456 l->backlog[TIPC_HIGH_IMPORTANCE].len = 0;
457 l->backlog[TIPC_CRITICAL_IMPORTANCE].len = 0;
458 l->backlog[TIPC_SYSTEM_IMPORTANCE].len = 0;
459}
460
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900461/**
Jon Paul Maloy581465f2014-01-07 17:02:44 -0500462 * tipc_link_purge_queues - purge all pkt queues associated with link
Per Lidenb97bf3f2006-01-02 19:04:38 +0100463 * @l_ptr: pointer to link
464 */
Jon Paul Maloy581465f2014-01-07 17:02:44 -0500465void tipc_link_purge_queues(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100466{
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400467 __skb_queue_purge(&l_ptr->deferdq);
468 __skb_queue_purge(&l_ptr->transmq);
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400469 tipc_link_purge_backlog(l_ptr);
Per Liden4323add2006-01-18 00:38:21 +0100470 tipc_link_reset_fragments(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100471}
472
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500473void tipc_link_reset(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100474{
Per Lidenb97bf3f2006-01-02 19:04:38 +0100475 u32 prev_state = l_ptr->state;
476 u32 checkpoint = l_ptr->next_in_no;
Allan Stephens5392d642006-06-25 23:52:50 -0700477 int was_active_link = tipc_link_is_active(l_ptr);
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400478 struct tipc_node *owner = l_ptr->owner;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900479
Allan Stephensa686e682008-06-04 17:29:39 -0700480 msg_set_session(l_ptr->pmsg, ((msg_session(l_ptr->pmsg) + 1) & 0xffff));
Per Lidenb97bf3f2006-01-02 19:04:38 +0100481
Allan Stephensa686e682008-06-04 17:29:39 -0700482 /* Link is down, accept any session */
483 l_ptr->peer_session = INVALID_SESSION;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100484
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900485 /* Prepare for max packet size negotiation */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100486 link_init_max_pkt(l_ptr);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900487
Per Lidenb97bf3f2006-01-02 19:04:38 +0100488 l_ptr->state = RESET_UNKNOWN;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100489
490 if ((prev_state == RESET_UNKNOWN) || (prev_state == RESET_RESET))
491 return;
492
Per Liden4323add2006-01-18 00:38:21 +0100493 tipc_node_link_down(l_ptr->owner, l_ptr);
Ying Xue7f9f95d2015-01-09 15:27:06 +0800494 tipc_bearer_remove_dest(owner->net, l_ptr->bearer_id, l_ptr->addr);
Paul Gortmaker7368ddf2010-10-12 14:25:58 +0000495
Jon Paul Maloyb9d4c332014-01-07 17:02:42 -0500496 if (was_active_link && tipc_node_active_links(l_ptr->owner)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100497 l_ptr->reset_checkpoint = checkpoint;
498 l_ptr->exp_msg_count = START_CHANGEOVER;
499 }
500
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500501 /* Clean up all queues, except inputq: */
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400502 __skb_queue_purge(&l_ptr->transmq);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400503 __skb_queue_purge(&l_ptr->deferdq);
Jon Paul Maloye6441ba2015-03-09 16:16:22 -0400504 if (!owner->inputq)
505 owner->inputq = &l_ptr->inputq;
506 skb_queue_splice_init(&l_ptr->wakeupq, owner->inputq);
507 if (!skb_queue_empty(owner->inputq))
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500508 owner->action_flags |= TIPC_MSG_EVT;
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400509 tipc_link_purge_backlog(l_ptr);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400510 l_ptr->rcv_unacked = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100511 l_ptr->checkpoint = 1;
512 l_ptr->next_out_no = 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100513 l_ptr->fsm_msg_cnt = 0;
514 l_ptr->stale_count = 0;
515 link_reset_statistics(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100516}
517
Ying Xuef2f98002015-01-09 15:27:05 +0800518void tipc_link_reset_list(struct net *net, unsigned int bearer_id)
Ying Xuee0ca2c32014-02-13 17:29:06 -0500519{
Ying Xuef2f98002015-01-09 15:27:05 +0800520 struct tipc_net *tn = net_generic(net, tipc_net_id);
Ying Xuee0ca2c32014-02-13 17:29:06 -0500521 struct tipc_link *l_ptr;
Ying Xuec61dd612014-02-13 17:29:09 -0500522 struct tipc_node *n_ptr;
Ying Xuee0ca2c32014-02-13 17:29:06 -0500523
Ying Xue6c7a7622014-03-27 12:54:37 +0800524 rcu_read_lock();
Ying Xuef2f98002015-01-09 15:27:05 +0800525 list_for_each_entry_rcu(n_ptr, &tn->node_list, list) {
Ying Xue5356f3d2014-05-05 08:56:09 +0800526 tipc_node_lock(n_ptr);
Ying Xuec61dd612014-02-13 17:29:09 -0500527 l_ptr = n_ptr->links[bearer_id];
528 if (l_ptr)
529 tipc_link_reset(l_ptr);
Ying Xue5356f3d2014-05-05 08:56:09 +0800530 tipc_node_unlock(n_ptr);
Ying Xuee0ca2c32014-02-13 17:29:06 -0500531 }
Ying Xue6c7a7622014-03-27 12:54:37 +0800532 rcu_read_unlock();
Ying Xuee0ca2c32014-02-13 17:29:06 -0500533}
Per Lidenb97bf3f2006-01-02 19:04:38 +0100534
Ying Xue7f9f95d2015-01-09 15:27:06 +0800535static void link_activate(struct tipc_link *link)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100536{
Ying Xue7f9f95d2015-01-09 15:27:06 +0800537 struct tipc_node *node = link->owner;
538
539 link->next_in_no = 1;
540 link->stats.recv_info = 1;
541 tipc_node_link_up(node, link);
542 tipc_bearer_add_dest(node->net, link->bearer_id, link->addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100543}
544
545/**
546 * link_state_event - link finite state machine
547 * @l_ptr: pointer to link
548 * @event: state machine event to process
549 */
Eric Dumazet95c96172012-04-15 05:58:06 +0000550static void link_state_event(struct tipc_link *l_ptr, unsigned int event)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100551{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500552 struct tipc_link *other;
Ying Xue2f55c432015-01-09 15:27:00 +0800553 unsigned long cont_intv = l_ptr->cont_intv;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100554
Jon Paul Maloy7d339392014-02-13 17:29:16 -0500555 if (l_ptr->flags & LINK_STOPPED)
556 return;
557
Ying Xue135daee2014-02-13 17:29:08 -0500558 if (!(l_ptr->flags & LINK_STARTED) && (event != STARTING_EVT))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100559 return; /* Not yet. */
560
Ying Xue77a7e072013-12-10 20:45:44 -0800561 /* Check whether changeover is going on */
562 if (l_ptr->exp_msg_count) {
Allan Stephensa0168922010-12-31 18:59:35 +0000563 if (event == TIMEOUT_EVT)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100564 link_set_timer(l_ptr, cont_intv);
Ying Xue77a7e072013-12-10 20:45:44 -0800565 return;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100566 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100567
568 switch (l_ptr->state) {
569 case WORKING_WORKING:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100570 switch (event) {
571 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100572 case ACTIVATE_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100573 break;
574 case TIMEOUT_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100575 if (l_ptr->next_in_no != l_ptr->checkpoint) {
576 l_ptr->checkpoint = l_ptr->next_in_no;
Per Liden4323add2006-01-18 00:38:21 +0100577 if (tipc_bclink_acks_missing(l_ptr->owner)) {
Ying Xue247f0f32014-02-18 16:06:46 +0800578 tipc_link_proto_xmit(l_ptr, STATE_MSG,
579 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100580 l_ptr->fsm_msg_cnt++;
581 } else if (l_ptr->max_pkt < l_ptr->max_pkt_target) {
Ying Xue247f0f32014-02-18 16:06:46 +0800582 tipc_link_proto_xmit(l_ptr, STATE_MSG,
583 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100584 l_ptr->fsm_msg_cnt++;
585 }
586 link_set_timer(l_ptr, cont_intv);
587 break;
588 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100589 l_ptr->state = WORKING_UNKNOWN;
590 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800591 tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100592 l_ptr->fsm_msg_cnt++;
593 link_set_timer(l_ptr, cont_intv / 4);
594 break;
595 case RESET_MSG:
Erik Hugne3fa9cac2015-01-22 17:10:31 +0100596 pr_debug("%s<%s>, requested by peer\n",
597 link_rst_msg, l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100598 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100599 l_ptr->state = RESET_RESET;
600 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800601 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
602 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100603 l_ptr->fsm_msg_cnt++;
604 link_set_timer(l_ptr, cont_intv);
605 break;
606 default:
Erik Hugne3fa9cac2015-01-22 17:10:31 +0100607 pr_debug("%s%u in WW state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100608 }
609 break;
610 case WORKING_UNKNOWN:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100611 switch (event) {
612 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100613 case ACTIVATE_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100614 l_ptr->state = WORKING_WORKING;
615 l_ptr->fsm_msg_cnt = 0;
616 link_set_timer(l_ptr, cont_intv);
617 break;
618 case RESET_MSG:
Erik Hugne3fa9cac2015-01-22 17:10:31 +0100619 pr_debug("%s<%s>, requested by peer while probing\n",
620 link_rst_msg, l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100621 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100622 l_ptr->state = RESET_RESET;
623 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800624 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
625 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100626 l_ptr->fsm_msg_cnt++;
627 link_set_timer(l_ptr, cont_intv);
628 break;
629 case TIMEOUT_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100630 if (l_ptr->next_in_no != l_ptr->checkpoint) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100631 l_ptr->state = WORKING_WORKING;
632 l_ptr->fsm_msg_cnt = 0;
633 l_ptr->checkpoint = l_ptr->next_in_no;
Per Liden4323add2006-01-18 00:38:21 +0100634 if (tipc_bclink_acks_missing(l_ptr->owner)) {
Ying Xue247f0f32014-02-18 16:06:46 +0800635 tipc_link_proto_xmit(l_ptr, STATE_MSG,
636 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100637 l_ptr->fsm_msg_cnt++;
638 }
639 link_set_timer(l_ptr, cont_intv);
640 } else if (l_ptr->fsm_msg_cnt < l_ptr->abort_limit) {
Ying Xue247f0f32014-02-18 16:06:46 +0800641 tipc_link_proto_xmit(l_ptr, STATE_MSG,
642 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100643 l_ptr->fsm_msg_cnt++;
644 link_set_timer(l_ptr, cont_intv / 4);
645 } else { /* Link has failed */
Erik Hugne3fa9cac2015-01-22 17:10:31 +0100646 pr_debug("%s<%s>, peer not responding\n",
647 link_rst_msg, l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100648 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100649 l_ptr->state = RESET_UNKNOWN;
650 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800651 tipc_link_proto_xmit(l_ptr, RESET_MSG,
652 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100653 l_ptr->fsm_msg_cnt++;
654 link_set_timer(l_ptr, cont_intv);
655 }
656 break;
657 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400658 pr_err("%s%u in WU state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100659 }
660 break;
661 case RESET_UNKNOWN:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100662 switch (event) {
663 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100664 break;
665 case ACTIVATE_MSG:
666 other = l_ptr->owner->active_links[0];
Allan Stephens8d64a5b2010-12-31 18:59:27 +0000667 if (other && link_working_unknown(other))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100668 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100669 l_ptr->state = WORKING_WORKING;
670 l_ptr->fsm_msg_cnt = 0;
671 link_activate(l_ptr);
Ying Xue247f0f32014-02-18 16:06:46 +0800672 tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100673 l_ptr->fsm_msg_cnt++;
Jon Maloyc64f7a62012-11-16 13:51:31 +0800674 if (l_ptr->owner->working_links == 1)
Ying Xue247f0f32014-02-18 16:06:46 +0800675 tipc_link_sync_xmit(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100676 link_set_timer(l_ptr, cont_intv);
677 break;
678 case RESET_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100679 l_ptr->state = RESET_RESET;
680 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800681 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
682 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100683 l_ptr->fsm_msg_cnt++;
684 link_set_timer(l_ptr, cont_intv);
685 break;
686 case STARTING_EVT:
Ying Xue135daee2014-02-13 17:29:08 -0500687 l_ptr->flags |= LINK_STARTED;
Jon Paul Maloyaf9946f2015-02-03 08:59:20 -0500688 l_ptr->fsm_msg_cnt++;
689 link_set_timer(l_ptr, cont_intv);
690 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100691 case TIMEOUT_EVT:
Ying Xue247f0f32014-02-18 16:06:46 +0800692 tipc_link_proto_xmit(l_ptr, RESET_MSG, 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100693 l_ptr->fsm_msg_cnt++;
694 link_set_timer(l_ptr, cont_intv);
695 break;
696 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400697 pr_err("%s%u in RU state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100698 }
699 break;
700 case RESET_RESET:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100701 switch (event) {
702 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100703 case ACTIVATE_MSG:
704 other = l_ptr->owner->active_links[0];
Allan Stephens8d64a5b2010-12-31 18:59:27 +0000705 if (other && link_working_unknown(other))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100706 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100707 l_ptr->state = WORKING_WORKING;
708 l_ptr->fsm_msg_cnt = 0;
709 link_activate(l_ptr);
Ying Xue247f0f32014-02-18 16:06:46 +0800710 tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100711 l_ptr->fsm_msg_cnt++;
Jon Maloyc64f7a62012-11-16 13:51:31 +0800712 if (l_ptr->owner->working_links == 1)
Ying Xue247f0f32014-02-18 16:06:46 +0800713 tipc_link_sync_xmit(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100714 link_set_timer(l_ptr, cont_intv);
715 break;
716 case RESET_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100717 break;
718 case TIMEOUT_EVT:
Ying Xue247f0f32014-02-18 16:06:46 +0800719 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
720 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100721 l_ptr->fsm_msg_cnt++;
722 link_set_timer(l_ptr, cont_intv);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100723 break;
724 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400725 pr_err("%s%u in RR state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100726 }
727 break;
728 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400729 pr_err("Unknown link state %u/%u\n", l_ptr->state, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100730 }
731}
732
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500733/**
Jon Paul Maloy9fbfb8b2014-07-16 20:41:03 -0400734 * __tipc_link_xmit(): same as tipc_link_xmit, but destlink is known & locked
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500735 * @link: link to use
Ying Xuea6ca1092014-11-26 11:41:55 +0800736 * @list: chain of buffers containing message
737 *
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400738 * Consumes the buffer chain, except when returning -ELINKCONG,
739 * since the caller then may want to make more send attempts.
740 * Returns 0 if success, or errno: -ELINKCONG, -EMSGSIZE or -ENOBUFS
741 * Messages at TIPC_SYSTEM_IMPORTANCE are always accepted
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500742 */
Ying Xue7f9f95d2015-01-09 15:27:06 +0800743int __tipc_link_xmit(struct net *net, struct tipc_link *link,
744 struct sk_buff_head *list)
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500745{
Ying Xuea6ca1092014-11-26 11:41:55 +0800746 struct tipc_msg *msg = buf_msg(skb_peek(list));
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400747 unsigned int maxwin = link->window;
Jon Paul Maloye3eea1e2015-03-13 16:08:11 -0400748 unsigned int imp = msg_importance(msg);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500749 uint mtu = link->max_pkt;
750 uint ack = mod(link->next_in_no - 1);
751 uint seqno = link->next_out_no;
752 uint bc_last_in = link->owner->bclink.last_in;
753 struct tipc_media_addr *addr = &link->media_addr;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400754 struct sk_buff_head *transmq = &link->transmq;
755 struct sk_buff_head *backlogq = &link->backlogq;
Ying Xuea6ca1092014-11-26 11:41:55 +0800756 struct sk_buff *skb, *tmp;
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500757
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400758 /* Match backlog limit against msg importance: */
759 if (unlikely(link->backlog[imp].len >= link->backlog[imp].limit))
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400760 return link_schedule_user(link, list);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500761
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400762 if (unlikely(msg_size(msg) > mtu)) {
Ying Xuea6ca1092014-11-26 11:41:55 +0800763 __skb_queue_purge(list);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500764 return -EMSGSIZE;
765 }
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400766 /* Prepare each packet for sending, and add to relevant queue: */
Ying Xuea6ca1092014-11-26 11:41:55 +0800767 skb_queue_walk_safe(list, skb, tmp) {
768 __skb_unlink(skb, list);
Ying Xue58dc55f2014-11-26 11:41:52 +0800769 msg = buf_msg(skb);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400770 msg_set_seqno(msg, seqno);
771 msg_set_ack(msg, ack);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500772 msg_set_bcast_ack(msg, bc_last_in);
773
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400774 if (likely(skb_queue_len(transmq) < maxwin)) {
775 __skb_queue_tail(transmq, skb);
776 tipc_bearer_send(net, link->bearer_id, skb, addr);
777 link->rcv_unacked = 0;
778 seqno++;
779 continue;
780 }
781 if (tipc_msg_bundle(skb_peek_tail(backlogq), skb, mtu)) {
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500782 link->stats.sent_bundled++;
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500783 continue;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400784 }
785 if (tipc_msg_make_bundle(&skb, mtu, link->addr)) {
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500786 link->stats.sent_bundled++;
787 link->stats.sent_bundles++;
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400788 imp = msg_importance(buf_msg(skb));
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500789 }
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400790 __skb_queue_tail(backlogq, skb);
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400791 link->backlog[imp].len++;
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500792 seqno++;
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500793 }
794 link->next_out_no = seqno;
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500795 return 0;
796}
797
Ying Xuea6ca1092014-11-26 11:41:55 +0800798static void skb2list(struct sk_buff *skb, struct sk_buff_head *list)
799{
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500800 skb_queue_head_init(list);
Ying Xuea6ca1092014-11-26 11:41:55 +0800801 __skb_queue_tail(list, skb);
802}
803
804static int __tipc_link_xmit_skb(struct tipc_link *link, struct sk_buff *skb)
805{
806 struct sk_buff_head head;
807
808 skb2list(skb, &head);
Ying Xue7f9f95d2015-01-09 15:27:06 +0800809 return __tipc_link_xmit(link->owner->net, link, &head);
Ying Xuea6ca1092014-11-26 11:41:55 +0800810}
811
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400812/* tipc_link_xmit_skb(): send single buffer to destination
813 * Buffers sent via this functon are generally TIPC_SYSTEM_IMPORTANCE
814 * messages, which will not be rejected
815 * The only exception is datagram messages rerouted after secondary
816 * lookup, which are rare and safe to dispose of anyway.
817 * TODO: Return real return value, and let callers use
818 * tipc_wait_for_sendpkt() where applicable
819 */
Ying Xuef2f98002015-01-09 15:27:05 +0800820int tipc_link_xmit_skb(struct net *net, struct sk_buff *skb, u32 dnode,
821 u32 selector)
Ying Xuea6ca1092014-11-26 11:41:55 +0800822{
823 struct sk_buff_head head;
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400824 int rc;
Ying Xuea6ca1092014-11-26 11:41:55 +0800825
826 skb2list(skb, &head);
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400827 rc = tipc_link_xmit(net, &head, dnode, selector);
828 if (rc == -ELINKCONG)
829 kfree_skb(skb);
830 return 0;
Ying Xuea6ca1092014-11-26 11:41:55 +0800831}
832
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500833/**
Jon Paul Maloy9fbfb8b2014-07-16 20:41:03 -0400834 * tipc_link_xmit() is the general link level function for message sending
Ying Xuef2f98002015-01-09 15:27:05 +0800835 * @net: the applicable net namespace
Ying Xuea6ca1092014-11-26 11:41:55 +0800836 * @list: chain of buffers containing message
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500837 * @dsz: amount of user data to be sent
838 * @dnode: address of destination node
839 * @selector: a number used for deterministic link selection
840 * Consumes the buffer chain, except when returning -ELINKCONG
841 * Returns 0 if success, otherwise errno: -ELINKCONG,-EHOSTUNREACH,-EMSGSIZE
842 */
Ying Xuef2f98002015-01-09 15:27:05 +0800843int tipc_link_xmit(struct net *net, struct sk_buff_head *list, u32 dnode,
844 u32 selector)
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500845{
846 struct tipc_link *link = NULL;
847 struct tipc_node *node;
848 int rc = -EHOSTUNREACH;
849
Ying Xuef2f98002015-01-09 15:27:05 +0800850 node = tipc_node_find(net, dnode);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500851 if (node) {
852 tipc_node_lock(node);
853 link = node->active_links[selector & 1];
854 if (link)
Ying Xue7f9f95d2015-01-09 15:27:06 +0800855 rc = __tipc_link_xmit(net, link, list);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500856 tipc_node_unlock(node);
Ying Xue8a0f6eb2015-03-26 18:10:24 +0800857 tipc_node_put(node);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500858 }
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500859 if (link)
860 return rc;
861
Erik Hugne3bd88ee2015-03-19 09:02:18 +0100862 if (likely(in_own_node(net, dnode))) {
863 tipc_sk_rcv(net, list);
864 return 0;
865 }
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500866
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500867 __skb_queue_purge(list);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500868 return rc;
869}
870
Jon Maloyc64f7a62012-11-16 13:51:31 +0800871/*
Ying Xue247f0f32014-02-18 16:06:46 +0800872 * tipc_link_sync_xmit - synchronize broadcast link endpoints.
Jon Maloyc64f7a62012-11-16 13:51:31 +0800873 *
874 * Give a newly added peer node the sequence number where it should
875 * start receiving and acking broadcast packets.
876 *
877 * Called with node locked
878 */
Jon Paul Maloy25b660c2014-07-16 20:40:59 -0400879static void tipc_link_sync_xmit(struct tipc_link *link)
Jon Maloyc64f7a62012-11-16 13:51:31 +0800880{
Ying Xuea6ca1092014-11-26 11:41:55 +0800881 struct sk_buff *skb;
Jon Maloyc64f7a62012-11-16 13:51:31 +0800882 struct tipc_msg *msg;
883
Ying Xuea6ca1092014-11-26 11:41:55 +0800884 skb = tipc_buf_acquire(INT_H_SIZE);
885 if (!skb)
Jon Maloyc64f7a62012-11-16 13:51:31 +0800886 return;
887
Ying Xuea6ca1092014-11-26 11:41:55 +0800888 msg = buf_msg(skb);
Jon Paul Maloyc5898632015-02-05 08:36:36 -0500889 tipc_msg_init(link_own_addr(link), msg, BCAST_PROTOCOL, STATE_MSG,
Ying Xue34747532015-01-09 15:27:10 +0800890 INT_H_SIZE, link->addr);
Jon Paul Maloy25b660c2014-07-16 20:40:59 -0400891 msg_set_last_bcast(msg, link->owner->bclink.acked);
Ying Xuea6ca1092014-11-26 11:41:55 +0800892 __tipc_link_xmit_skb(link, skb);
Jon Maloyc64f7a62012-11-16 13:51:31 +0800893}
894
895/*
Ying Xue247f0f32014-02-18 16:06:46 +0800896 * tipc_link_sync_rcv - synchronize broadcast link endpoints.
Jon Maloyc64f7a62012-11-16 13:51:31 +0800897 * Receive the sequence number where we should start receiving and
898 * acking broadcast packets from a newly added peer node, and open
899 * up for reception of such packets.
900 *
901 * Called with node locked
902 */
Ying Xue247f0f32014-02-18 16:06:46 +0800903static void tipc_link_sync_rcv(struct tipc_node *n, struct sk_buff *buf)
Jon Maloyc64f7a62012-11-16 13:51:31 +0800904{
905 struct tipc_msg *msg = buf_msg(buf);
906
907 n->bclink.last_sent = n->bclink.last_in = msg_last_bcast(msg);
908 n->bclink.recv_permitted = true;
909 kfree_skb(buf);
910}
911
912/*
Ying Xue47b4c9a2014-11-26 11:41:48 +0800913 * tipc_link_push_packets - push unsent packets to bearer
914 *
915 * Push out the unsent messages of a link where congestion
916 * has abated. Node is locked.
917 *
918 * Called with node locked
Per Lidenb97bf3f2006-01-02 19:04:38 +0100919 */
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400920void tipc_link_push_packets(struct tipc_link *link)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100921{
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400922 struct sk_buff *skb;
Ying Xue47b4c9a2014-11-26 11:41:48 +0800923 struct tipc_msg *msg;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400924 unsigned int ack = mod(link->next_in_no - 1);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100925
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400926 while (skb_queue_len(&link->transmq) < link->window) {
927 skb = __skb_dequeue(&link->backlogq);
928 if (!skb)
Ying Xue47b4c9a2014-11-26 11:41:48 +0800929 break;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400930 msg = buf_msg(skb);
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400931 link->backlog[msg_importance(msg)].len--;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400932 msg_set_ack(msg, ack);
933 msg_set_bcast_ack(msg, link->owner->bclink.last_in);
934 link->rcv_unacked = 0;
935 __skb_queue_tail(&link->transmq, skb);
936 tipc_bearer_send(link->owner->net, link->bearer_id,
937 skb, &link->media_addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100938 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100939}
940
Ying Xue3f5a12b2014-05-05 08:56:17 +0800941void tipc_link_reset_all(struct tipc_node *node)
Allan Stephensd356eeb2006-06-25 23:40:01 -0700942{
Allan Stephensd356eeb2006-06-25 23:40:01 -0700943 char addr_string[16];
944 u32 i;
945
Ying Xue3f5a12b2014-05-05 08:56:17 +0800946 tipc_node_lock(node);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700947
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400948 pr_warn("Resetting all links to %s\n",
Ying Xue3f5a12b2014-05-05 08:56:17 +0800949 tipc_addr_string_fill(addr_string, node->addr));
Allan Stephensd356eeb2006-06-25 23:40:01 -0700950
951 for (i = 0; i < MAX_BEARERS; i++) {
Ying Xue3f5a12b2014-05-05 08:56:17 +0800952 if (node->links[i]) {
953 link_print(node->links[i], "Resetting link\n");
954 tipc_link_reset(node->links[i]);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700955 }
956 }
957
Ying Xue3f5a12b2014-05-05 08:56:17 +0800958 tipc_node_unlock(node);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700959}
960
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500961static void link_retransmit_failure(struct tipc_link *l_ptr,
Paul Gortmakerae8509c2013-06-17 10:54:47 -0400962 struct sk_buff *buf)
Allan Stephensd356eeb2006-06-25 23:40:01 -0700963{
964 struct tipc_msg *msg = buf_msg(buf);
Ying Xue1da46562015-01-09 15:27:07 +0800965 struct net *net = l_ptr->owner->net;
Allan Stephensd356eeb2006-06-25 23:40:01 -0700966
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400967 pr_warn("Retransmission failure on link <%s>\n", l_ptr->name);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700968
969 if (l_ptr->addr) {
Allan Stephensd356eeb2006-06-25 23:40:01 -0700970 /* Handle failure on standard link */
Allan Stephens8d64a5b2010-12-31 18:59:27 +0000971 link_print(l_ptr, "Resetting link\n");
Allan Stephensd356eeb2006-06-25 23:40:01 -0700972 tipc_link_reset(l_ptr);
973
974 } else {
Allan Stephensd356eeb2006-06-25 23:40:01 -0700975 /* Handle failure on broadcast link */
David S. Miller6c000552008-09-02 23:38:32 -0700976 struct tipc_node *n_ptr;
Allan Stephensd356eeb2006-06-25 23:40:01 -0700977 char addr_string[16];
978
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400979 pr_info("Msg seq number: %u, ", msg_seqno(msg));
980 pr_cont("Outstanding acks: %lu\n",
981 (unsigned long) TIPC_SKB_CB(buf)->handle);
Jeff Garzik617dbea2006-10-03 16:25:34 -0700982
Ying Xue1da46562015-01-09 15:27:07 +0800983 n_ptr = tipc_bclink_retransmit_to(net);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700984
Allan Stephensc68ca7b2010-05-11 14:30:12 +0000985 tipc_addr_string_fill(addr_string, n_ptr->addr);
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400986 pr_info("Broadcast link info for %s\n", addr_string);
Ying Xue389dd9b2012-11-16 13:51:30 +0800987 pr_info("Reception permitted: %d, Acked: %u\n",
988 n_ptr->bclink.recv_permitted,
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400989 n_ptr->bclink.acked);
990 pr_info("Last in: %u, Oos state: %u, Last sent: %u\n",
991 n_ptr->bclink.last_in,
992 n_ptr->bclink.oos_state,
993 n_ptr->bclink.last_sent);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700994
Ying Xueb952b2b2015-03-26 18:10:23 +0800995 n_ptr->action_flags |= TIPC_BCAST_RESET;
Allan Stephensd356eeb2006-06-25 23:40:01 -0700996 l_ptr->stale_count = 0;
997 }
998}
999
Ying Xue58dc55f2014-11-26 11:41:52 +08001000void tipc_link_retransmit(struct tipc_link *l_ptr, struct sk_buff *skb,
Per Liden4323add2006-01-18 00:38:21 +01001001 u32 retransmits)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001002{
1003 struct tipc_msg *msg;
1004
Ying Xue58dc55f2014-11-26 11:41:52 +08001005 if (!skb)
Allan Stephensd356eeb2006-06-25 23:40:01 -07001006 return;
1007
Ying Xue58dc55f2014-11-26 11:41:52 +08001008 msg = buf_msg(skb);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001009
Erik Hugne512137e2013-12-06 10:08:00 -05001010 /* Detect repeated retransmit failures */
1011 if (l_ptr->last_retransmitted == msg_seqno(msg)) {
1012 if (++l_ptr->stale_count > 100) {
Ying Xue58dc55f2014-11-26 11:41:52 +08001013 link_retransmit_failure(l_ptr, skb);
Erik Hugne512137e2013-12-06 10:08:00 -05001014 return;
Allan Stephensd356eeb2006-06-25 23:40:01 -07001015 }
1016 } else {
Erik Hugne512137e2013-12-06 10:08:00 -05001017 l_ptr->last_retransmitted = msg_seqno(msg);
1018 l_ptr->stale_count = 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001019 }
Allan Stephensd356eeb2006-06-25 23:40:01 -07001020
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001021 skb_queue_walk_from(&l_ptr->transmq, skb) {
1022 if (!retransmits)
Ying Xue58dc55f2014-11-26 11:41:52 +08001023 break;
1024 msg = buf_msg(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001025 msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001026 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Ying Xue7f9f95d2015-01-09 15:27:06 +08001027 tipc_bearer_send(l_ptr->owner->net, l_ptr->bearer_id, skb,
1028 &l_ptr->media_addr);
Ying Xue3c294cb2012-11-15 11:34:45 +08001029 retransmits--;
1030 l_ptr->stats.retransmitted++;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001031 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001032}
1033
Jon Paul Maloy8b4ed862015-03-25 12:07:26 -04001034/* link_synch(): check if all packets arrived before the synch
1035 * point have been consumed
1036 * Returns true if the parallel links are synched, otherwise false
1037 */
1038static bool link_synch(struct tipc_link *l)
1039{
1040 unsigned int post_synch;
1041 struct tipc_link *pl;
1042
1043 pl = tipc_parallel_link(l);
1044 if (pl == l)
1045 goto synched;
1046
1047 /* Was last pre-synch packet added to input queue ? */
1048 if (less_eq(pl->next_in_no, l->synch_point))
1049 return false;
1050
1051 /* Is it still in the input queue ? */
1052 post_synch = mod(pl->next_in_no - l->synch_point) - 1;
1053 if (skb_queue_len(&pl->inputq) > post_synch)
1054 return false;
1055synched:
1056 l->flags &= ~LINK_SYNCHING;
1057 return true;
1058}
1059
Ying Xuef03273f2014-11-26 11:41:54 +08001060static void link_retrieve_defq(struct tipc_link *link,
1061 struct sk_buff_head *list)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001062{
1063 u32 seq_no;
1064
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001065 if (skb_queue_empty(&link->deferdq))
Ying Xuef03273f2014-11-26 11:41:54 +08001066 return;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001067
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001068 seq_no = buf_seqno(skb_peek(&link->deferdq));
Ying Xuef03273f2014-11-26 11:41:54 +08001069 if (seq_no == mod(link->next_in_no))
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001070 skb_queue_splice_tail_init(&link->deferdq, list);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001071}
1072
Allan Stephens85035562008-04-15 19:04:54 -07001073/**
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001074 * tipc_rcv - process TIPC packets/messages arriving from off-node
Ying Xuef2f98002015-01-09 15:27:05 +08001075 * @net: the applicable net namespace
Ying Xuef03273f2014-11-26 11:41:54 +08001076 * @skb: TIPC packet
Ying Xue7a2f7d12014-04-21 10:55:46 +08001077 * @b_ptr: pointer to bearer message arrived on
Allan Stephensb02b69c2010-08-17 11:00:07 +00001078 *
1079 * Invoked with no locks held. Bearer pointer must point to a valid bearer
1080 * structure (i.e. cannot be NULL), but bearer can be inactive.
1081 */
Ying Xuec93d3ba2015-01-09 15:27:04 +08001082void tipc_rcv(struct net *net, struct sk_buff *skb, struct tipc_bearer *b_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001083{
Ying Xue34747532015-01-09 15:27:10 +08001084 struct tipc_net *tn = net_generic(net, tipc_net_id);
Ying Xuef03273f2014-11-26 11:41:54 +08001085 struct sk_buff_head head;
1086 struct tipc_node *n_ptr;
1087 struct tipc_link *l_ptr;
1088 struct sk_buff *skb1, *tmp;
1089 struct tipc_msg *msg;
1090 u32 seq_no;
1091 u32 ackd;
1092 u32 released;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001093
Ying Xuea6ca1092014-11-26 11:41:55 +08001094 skb2list(skb, &head);
Allan Stephens85035562008-04-15 19:04:54 -07001095
Ying Xuef03273f2014-11-26 11:41:54 +08001096 while ((skb = __skb_dequeue(&head))) {
Allan Stephens85035562008-04-15 19:04:54 -07001097 /* Ensure message is well-formed */
Jon Paul Maloycf2157f2015-03-13 16:08:06 -04001098 if (unlikely(!tipc_msg_validate(skb)))
Ying Xue3af390e2013-10-30 11:26:57 +08001099 goto discard;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001100
Allan Stephens85035562008-04-15 19:04:54 -07001101 /* Handle arrival of a non-unicast link message */
Ying Xuef03273f2014-11-26 11:41:54 +08001102 msg = buf_msg(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001103 if (unlikely(msg_non_seq(msg))) {
Allan Stephens1265a022008-06-04 17:32:35 -07001104 if (msg_user(msg) == LINK_CONFIG)
Ying Xuec93d3ba2015-01-09 15:27:04 +08001105 tipc_disc_rcv(net, skb, b_ptr);
Allan Stephens1265a022008-06-04 17:32:35 -07001106 else
Ying Xuec93d3ba2015-01-09 15:27:04 +08001107 tipc_bclink_rcv(net, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001108 continue;
1109 }
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001110
Allan Stephensed33a9c2011-04-05 15:15:04 -04001111 /* Discard unicast link messages destined for another node */
Allan Stephens26008242006-06-25 23:39:31 -07001112 if (unlikely(!msg_short(msg) &&
Ying Xue34747532015-01-09 15:27:10 +08001113 (msg_destnode(msg) != tn->own_addr)))
Ying Xue3af390e2013-10-30 11:26:57 +08001114 goto discard;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001115
Allan Stephens5a68d5e2010-08-17 11:00:16 +00001116 /* Locate neighboring node that sent message */
Ying Xuef2f98002015-01-09 15:27:05 +08001117 n_ptr = tipc_node_find(net, msg_prevnode(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001118 if (unlikely(!n_ptr))
Ying Xue3af390e2013-10-30 11:26:57 +08001119 goto discard;
Allan Stephens85035562008-04-15 19:04:54 -07001120
Ying Xue8a0f6eb2015-03-26 18:10:24 +08001121 tipc_node_lock(n_ptr);
Allan Stephens5a68d5e2010-08-17 11:00:16 +00001122 /* Locate unicast link endpoint that should handle message */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001123 l_ptr = n_ptr->links[b_ptr->identity];
Ying Xue3af390e2013-10-30 11:26:57 +08001124 if (unlikely(!l_ptr))
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001125 goto unlock;
Allan Stephens85035562008-04-15 19:04:54 -07001126
Allan Stephensb4b56102011-05-27 11:00:51 -04001127 /* Verify that communication with node is currently allowed */
Ying Xueaecb9bb2014-05-08 08:54:39 +08001128 if ((n_ptr->action_flags & TIPC_WAIT_PEER_LINKS_DOWN) &&
Ying Xue10f465c2014-05-05 08:56:11 +08001129 msg_user(msg) == LINK_PROTOCOL &&
1130 (msg_type(msg) == RESET_MSG ||
1131 msg_type(msg) == ACTIVATE_MSG) &&
1132 !msg_redundant_link(msg))
Ying Xueaecb9bb2014-05-08 08:54:39 +08001133 n_ptr->action_flags &= ~TIPC_WAIT_PEER_LINKS_DOWN;
Allan Stephensb4b56102011-05-27 11:00:51 -04001134
Ying Xue10f465c2014-05-05 08:56:11 +08001135 if (tipc_node_blocked(n_ptr))
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001136 goto unlock;
Allan Stephensb4b56102011-05-27 11:00:51 -04001137
Allan Stephens85035562008-04-15 19:04:54 -07001138 /* Validate message sequence number info */
Allan Stephens85035562008-04-15 19:04:54 -07001139 seq_no = msg_seqno(msg);
1140 ackd = msg_ack(msg);
1141
1142 /* Release acked messages */
Jon Paul Maloy2cdf3912015-03-13 16:08:09 -04001143 if (unlikely(n_ptr->bclink.acked != msg_bcast_ack(msg)))
Allan Stephens365595912011-10-24 15:26:24 -04001144 tipc_bclink_acknowledge(n_ptr, msg_bcast_ack(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001145
Ying Xue58dc55f2014-11-26 11:41:52 +08001146 released = 0;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001147 skb_queue_walk_safe(&l_ptr->transmq, skb1, tmp) {
1148 if (more(buf_seqno(skb1), ackd))
Ying Xue58dc55f2014-11-26 11:41:52 +08001149 break;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001150 __skb_unlink(skb1, &l_ptr->transmq);
Ying Xue58dc55f2014-11-26 11:41:52 +08001151 kfree_skb(skb1);
1152 released = 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001153 }
Allan Stephens85035562008-04-15 19:04:54 -07001154
1155 /* Try sending any messages link endpoint has pending */
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001156 if (unlikely(skb_queue_len(&l_ptr->backlogq)))
Ying Xue47b4c9a2014-11-26 11:41:48 +08001157 tipc_link_push_packets(l_ptr);
Jon Paul Maloya5377832014-02-13 17:29:15 -05001158
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001159 if (released && !skb_queue_empty(&l_ptr->wakeupq))
Jon Paul Maloy50100a52014-08-22 18:09:07 -04001160 link_prepare_wakeup(l_ptr);
Jon Paul Maloya5377832014-02-13 17:29:15 -05001161
Jon Paul Maloya5377832014-02-13 17:29:15 -05001162 /* Process the incoming packet */
Ying Xue3af390e2013-10-30 11:26:57 +08001163 if (unlikely(!link_working_working(l_ptr))) {
1164 if (msg_user(msg) == LINK_PROTOCOL) {
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001165 tipc_link_proto_rcv(l_ptr, skb);
Ying Xuef03273f2014-11-26 11:41:54 +08001166 link_retrieve_defq(l_ptr, &head);
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001167 skb = NULL;
1168 goto unlock;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001169 }
Ying Xue3af390e2013-10-30 11:26:57 +08001170
1171 /* Traffic message. Conditionally activate link */
1172 link_state_event(l_ptr, TRAFFIC_MSG_EVT);
1173
1174 if (link_working_working(l_ptr)) {
1175 /* Re-insert buffer in front of queue */
Ying Xuef03273f2014-11-26 11:41:54 +08001176 __skb_queue_head(&head, skb);
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001177 skb = NULL;
1178 goto unlock;
Ying Xue3af390e2013-10-30 11:26:57 +08001179 }
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001180 goto unlock;
Ying Xue3af390e2013-10-30 11:26:57 +08001181 }
1182
1183 /* Link is now in state WORKING_WORKING */
1184 if (unlikely(seq_no != mod(l_ptr->next_in_no))) {
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001185 link_handle_out_of_seq_msg(l_ptr, skb);
Ying Xuef03273f2014-11-26 11:41:54 +08001186 link_retrieve_defq(l_ptr, &head);
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001187 skb = NULL;
1188 goto unlock;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001189 }
Jon Paul Maloy8b4ed862015-03-25 12:07:26 -04001190 /* Synchronize with parallel link if applicable */
1191 if (unlikely((l_ptr->flags & LINK_SYNCHING) && !msg_dup(msg))) {
1192 link_handle_out_of_seq_msg(l_ptr, skb);
1193 if (link_synch(l_ptr))
1194 link_retrieve_defq(l_ptr, &head);
1195 skb = NULL;
1196 goto unlock;
1197 }
Ying Xue3af390e2013-10-30 11:26:57 +08001198 l_ptr->next_in_no++;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001199 if (unlikely(!skb_queue_empty(&l_ptr->deferdq)))
Ying Xuef03273f2014-11-26 11:41:54 +08001200 link_retrieve_defq(l_ptr, &head);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001201 if (unlikely(++l_ptr->rcv_unacked >= TIPC_MIN_LINK_WIN)) {
Erik Hugne3f53bd82014-07-01 10:22:41 +02001202 l_ptr->stats.sent_acks++;
1203 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0, 0, 0, 0);
1204 }
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001205 tipc_link_input(l_ptr, skb);
1206 skb = NULL;
1207unlock:
Ying Xue3af390e2013-10-30 11:26:57 +08001208 tipc_node_unlock(n_ptr);
Ying Xue8a0f6eb2015-03-26 18:10:24 +08001209 tipc_node_put(n_ptr);
Ying Xue3af390e2013-10-30 11:26:57 +08001210discard:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001211 if (unlikely(skb))
1212 kfree_skb(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001213 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001214}
1215
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001216/* tipc_data_input - deliver data and name distr msgs to upper layer
Erik Hugne7ae934b2014-07-01 10:22:40 +02001217 *
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001218 * Consumes buffer if message is of right type
Erik Hugne7ae934b2014-07-01 10:22:40 +02001219 * Node lock must be held
1220 */
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001221static bool tipc_data_input(struct tipc_link *link, struct sk_buff *skb)
Erik Hugne7ae934b2014-07-01 10:22:40 +02001222{
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001223 struct tipc_node *node = link->owner;
1224 struct tipc_msg *msg = buf_msg(skb);
1225 u32 dport = msg_destport(msg);
Erik Hugne7ae934b2014-07-01 10:22:40 +02001226
1227 switch (msg_user(msg)) {
1228 case TIPC_LOW_IMPORTANCE:
1229 case TIPC_MEDIUM_IMPORTANCE:
1230 case TIPC_HIGH_IMPORTANCE:
1231 case TIPC_CRITICAL_IMPORTANCE:
1232 case CONN_MANAGER:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001233 if (tipc_skb_queue_tail(&link->inputq, skb, dport)) {
1234 node->inputq = &link->inputq;
1235 node->action_flags |= TIPC_MSG_EVT;
1236 }
1237 return true;
Erik Hugne7ae934b2014-07-01 10:22:40 +02001238 case NAME_DISTRIBUTOR:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001239 node->bclink.recv_permitted = true;
1240 node->namedq = &link->namedq;
1241 skb_queue_tail(&link->namedq, skb);
1242 if (skb_queue_len(&link->namedq) == 1)
1243 node->action_flags |= TIPC_NAMED_MSG_EVT;
1244 return true;
Erik Hugne7ae934b2014-07-01 10:22:40 +02001245 case MSG_BUNDLER:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001246 case CHANGEOVER_PROTOCOL:
1247 case MSG_FRAGMENTER:
1248 case BCAST_PROTOCOL:
1249 return false;
1250 default:
1251 pr_warn("Dropping received illegal msg type\n");
1252 kfree_skb(skb);
1253 return false;
1254 };
1255}
1256
1257/* tipc_link_input - process packet that has passed link protocol check
1258 *
1259 * Consumes buffer
1260 * Node lock must be held
1261 */
1262static void tipc_link_input(struct tipc_link *link, struct sk_buff *skb)
1263{
1264 struct tipc_node *node = link->owner;
1265 struct tipc_msg *msg = buf_msg(skb);
1266 struct sk_buff *iskb;
1267 int pos = 0;
1268
1269 if (likely(tipc_data_input(link, skb)))
1270 return;
1271
1272 switch (msg_user(msg)) {
1273 case CHANGEOVER_PROTOCOL:
Jon Paul Maloy8b4ed862015-03-25 12:07:26 -04001274 if (msg_dup(msg)) {
1275 link->flags |= LINK_SYNCHING;
1276 link->synch_point = msg_seqno(msg_get_wrapped(msg));
1277 }
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001278 if (!tipc_link_tunnel_rcv(node, &skb))
1279 break;
1280 if (msg_user(buf_msg(skb)) != MSG_BUNDLER) {
1281 tipc_data_input(link, skb);
1282 break;
1283 }
1284 case MSG_BUNDLER:
1285 link->stats.recv_bundles++;
1286 link->stats.recv_bundled += msg_msgcnt(msg);
1287
1288 while (tipc_msg_extract(skb, &iskb, &pos))
1289 tipc_data_input(link, iskb);
1290 break;
1291 case MSG_FRAGMENTER:
1292 link->stats.recv_fragments++;
1293 if (tipc_buf_append(&link->reasm_buf, &skb)) {
1294 link->stats.recv_fragmented++;
1295 tipc_data_input(link, skb);
1296 } else if (!link->reasm_buf) {
1297 tipc_link_reset(link);
1298 }
1299 break;
1300 case BCAST_PROTOCOL:
1301 tipc_link_sync_rcv(node, skb);
Erik Hugne7ae934b2014-07-01 10:22:40 +02001302 break;
1303 default:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001304 break;
1305 };
Erik Hugne7ae934b2014-07-01 10:22:40 +02001306}
1307
1308/**
Allan Stephens8809b252011-10-25 10:44:35 -04001309 * tipc_link_defer_pkt - Add out-of-sequence message to deferred reception queue
1310 *
1311 * Returns increase in queue length (i.e. 0 or 1)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001312 */
Ying Xuebc6fecd2014-11-26 11:41:53 +08001313u32 tipc_link_defer_pkt(struct sk_buff_head *list, struct sk_buff *skb)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001314{
Ying Xuebc6fecd2014-11-26 11:41:53 +08001315 struct sk_buff *skb1;
1316 u32 seq_no = buf_seqno(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001317
1318 /* Empty queue ? */
Ying Xuebc6fecd2014-11-26 11:41:53 +08001319 if (skb_queue_empty(list)) {
1320 __skb_queue_tail(list, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001321 return 1;
1322 }
1323
1324 /* Last ? */
Ying Xuebc6fecd2014-11-26 11:41:53 +08001325 if (less(buf_seqno(skb_peek_tail(list)), seq_no)) {
1326 __skb_queue_tail(list, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001327 return 1;
1328 }
1329
Allan Stephens8809b252011-10-25 10:44:35 -04001330 /* Locate insertion point in queue, then insert; discard if duplicate */
Ying Xuebc6fecd2014-11-26 11:41:53 +08001331 skb_queue_walk(list, skb1) {
1332 u32 curr_seqno = buf_seqno(skb1);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001333
Allan Stephens8809b252011-10-25 10:44:35 -04001334 if (seq_no == curr_seqno) {
Ying Xuebc6fecd2014-11-26 11:41:53 +08001335 kfree_skb(skb);
Allan Stephens8809b252011-10-25 10:44:35 -04001336 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001337 }
Allan Stephens8809b252011-10-25 10:44:35 -04001338
1339 if (less(seq_no, curr_seqno))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001340 break;
Allan Stephens8809b252011-10-25 10:44:35 -04001341 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001342
Ying Xuebc6fecd2014-11-26 11:41:53 +08001343 __skb_queue_before(list, skb1, skb);
Allan Stephens8809b252011-10-25 10:44:35 -04001344 return 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001345}
1346
Allan Stephens8809b252011-10-25 10:44:35 -04001347/*
Per Lidenb97bf3f2006-01-02 19:04:38 +01001348 * link_handle_out_of_seq_msg - handle arrival of out-of-sequence packet
1349 */
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001350static void link_handle_out_of_seq_msg(struct tipc_link *l_ptr,
Per Lidenb97bf3f2006-01-02 19:04:38 +01001351 struct sk_buff *buf)
1352{
Allan Stephensf9057302011-10-24 16:03:12 -04001353 u32 seq_no = buf_seqno(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001354
1355 if (likely(msg_user(buf_msg(buf)) == LINK_PROTOCOL)) {
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001356 tipc_link_proto_rcv(l_ptr, buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001357 return;
1358 }
1359
Per Lidenb97bf3f2006-01-02 19:04:38 +01001360 /* Record OOS packet arrival (force mismatch on next timeout) */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001361 l_ptr->checkpoint--;
1362
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001363 /*
Per Lidenb97bf3f2006-01-02 19:04:38 +01001364 * Discard packet if a duplicate; otherwise add it to deferred queue
1365 * and notify peer of gap as per protocol specification
1366 */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001367 if (less(seq_no, mod(l_ptr->next_in_no))) {
1368 l_ptr->stats.duplicates++;
Allan Stephens5f6d9122011-11-04 13:24:29 -04001369 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001370 return;
1371 }
1372
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001373 if (tipc_link_defer_pkt(&l_ptr->deferdq, buf)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001374 l_ptr->stats.deferred_recv++;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001375 if ((skb_queue_len(&l_ptr->deferdq) % TIPC_MIN_LINK_WIN) == 1)
Ying Xue247f0f32014-02-18 16:06:46 +08001376 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0, 0, 0, 0);
Ying Xuebc6fecd2014-11-26 11:41:53 +08001377 } else {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001378 l_ptr->stats.duplicates++;
Ying Xuebc6fecd2014-11-26 11:41:53 +08001379 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001380}
1381
1382/*
1383 * Send protocol message to the other endpoint.
1384 */
Ying Xue247f0f32014-02-18 16:06:46 +08001385void tipc_link_proto_xmit(struct tipc_link *l_ptr, u32 msg_typ, int probe_msg,
1386 u32 gap, u32 tolerance, u32 priority, u32 ack_mtu)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001387{
Sam Ravnborg1fc54d82006-03-20 22:36:47 -08001388 struct sk_buff *buf = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001389 struct tipc_msg *msg = l_ptr->pmsg;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001390 u32 msg_size = sizeof(l_ptr->proto_msg);
Allan Stephens75f0aa42011-02-28 15:30:20 -05001391 int r_flag;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001392
Ying Xue77a7e072013-12-10 20:45:44 -08001393 /* Don't send protocol message during link changeover */
1394 if (l_ptr->exp_msg_count)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001395 return;
Allan Stephensb4b56102011-05-27 11:00:51 -04001396
1397 /* Abort non-RESET send if communication with node is prohibited */
Ying Xue10f465c2014-05-05 08:56:11 +08001398 if ((tipc_node_blocked(l_ptr->owner)) && (msg_typ != RESET_MSG))
Allan Stephensb4b56102011-05-27 11:00:51 -04001399 return;
1400
Allan Stephens92d2c902011-10-25 11:20:26 -04001401 /* Create protocol message with "out-of-sequence" sequence number */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001402 msg_set_type(msg, msg_typ);
Ying Xue7a2f7d12014-04-21 10:55:46 +08001403 msg_set_net_plane(msg, l_ptr->net_plane);
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001404 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Ying Xue1da46562015-01-09 15:27:07 +08001405 msg_set_last_bcast(msg, tipc_bclink_get_last_sent(l_ptr->owner->net));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001406
1407 if (msg_typ == STATE_MSG) {
1408 u32 next_sent = mod(l_ptr->next_out_no);
1409
Per Liden4323add2006-01-18 00:38:21 +01001410 if (!tipc_link_is_up(l_ptr))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001411 return;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001412 if (skb_queue_len(&l_ptr->backlogq))
1413 next_sent = buf_seqno(skb_peek(&l_ptr->backlogq));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001414 msg_set_next_sent(msg, next_sent);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001415 if (!skb_queue_empty(&l_ptr->deferdq)) {
1416 u32 rec = buf_seqno(skb_peek(&l_ptr->deferdq));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001417 gap = mod(rec - mod(l_ptr->next_in_no));
1418 }
1419 msg_set_seq_gap(msg, gap);
1420 if (gap)
1421 l_ptr->stats.sent_nacks++;
1422 msg_set_link_tolerance(msg, tolerance);
1423 msg_set_linkprio(msg, priority);
1424 msg_set_max_pkt(msg, ack_mtu);
1425 msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
1426 msg_set_probe(msg, probe_msg != 0);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001427 if (probe_msg) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001428 u32 mtu = l_ptr->max_pkt;
1429
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001430 if ((mtu < l_ptr->max_pkt_target) &&
Per Lidenb97bf3f2006-01-02 19:04:38 +01001431 link_working_working(l_ptr) &&
1432 l_ptr->fsm_msg_cnt) {
1433 msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001434 if (l_ptr->max_pkt_probes == 10) {
1435 l_ptr->max_pkt_target = (msg_size - 4);
1436 l_ptr->max_pkt_probes = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001437 msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001438 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001439 l_ptr->max_pkt_probes++;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001440 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001441
1442 l_ptr->stats.sent_probes++;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001443 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001444 l_ptr->stats.sent_states++;
1445 } else { /* RESET_MSG or ACTIVATE_MSG */
1446 msg_set_ack(msg, mod(l_ptr->reset_checkpoint - 1));
1447 msg_set_seq_gap(msg, 0);
1448 msg_set_next_sent(msg, 1);
Allan Stephensf23d9bf2011-01-18 15:15:34 -05001449 msg_set_probe(msg, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001450 msg_set_link_tolerance(msg, l_ptr->tolerance);
1451 msg_set_linkprio(msg, l_ptr->priority);
1452 msg_set_max_pkt(msg, l_ptr->max_pkt_target);
1453 }
1454
Allan Stephens75f0aa42011-02-28 15:30:20 -05001455 r_flag = (l_ptr->owner->working_links > tipc_link_is_up(l_ptr));
1456 msg_set_redundant_link(msg, r_flag);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001457 msg_set_linkprio(msg, l_ptr->priority);
Allan Stephens92d2c902011-10-25 11:20:26 -04001458 msg_set_size(msg, msg_size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001459
1460 msg_set_seqno(msg, mod(l_ptr->next_out_no + (0xffff/2)));
1461
stephen hemminger31e3c3f2010-10-13 13:20:35 +00001462 buf = tipc_buf_acquire(msg_size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001463 if (!buf)
1464 return;
1465
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03001466 skb_copy_to_linear_data(buf, msg, sizeof(l_ptr->proto_msg));
Ying Xue796c75d2013-06-17 10:54:48 -04001467 buf->priority = TC_PRIO_CONTROL;
Ying Xue7f9f95d2015-01-09 15:27:06 +08001468 tipc_bearer_send(l_ptr->owner->net, l_ptr->bearer_id, buf,
1469 &l_ptr->media_addr);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001470 l_ptr->rcv_unacked = 0;
Allan Stephens5f6d9122011-11-04 13:24:29 -04001471 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001472}
1473
1474/*
1475 * Receive protocol message :
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001476 * Note that network plane id propagates through the network, and may
1477 * change at any time. The node with lowest address rules
Per Lidenb97bf3f2006-01-02 19:04:38 +01001478 */
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001479static void tipc_link_proto_rcv(struct tipc_link *l_ptr,
Ying Xuec93d3ba2015-01-09 15:27:04 +08001480 struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001481{
1482 u32 rec_gap = 0;
1483 u32 max_pkt_info;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001484 u32 max_pkt_ack;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001485 u32 msg_tol;
1486 struct tipc_msg *msg = buf_msg(buf);
1487
Ying Xue77a7e072013-12-10 20:45:44 -08001488 /* Discard protocol message during link changeover */
1489 if (l_ptr->exp_msg_count)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001490 goto exit;
1491
Ying Xue7a2f7d12014-04-21 10:55:46 +08001492 if (l_ptr->net_plane != msg_net_plane(msg))
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001493 if (link_own_addr(l_ptr) > msg_prevnode(msg))
Ying Xue7a2f7d12014-04-21 10:55:46 +08001494 l_ptr->net_plane = msg_net_plane(msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001495
Per Lidenb97bf3f2006-01-02 19:04:38 +01001496 switch (msg_type(msg)) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001497
Per Lidenb97bf3f2006-01-02 19:04:38 +01001498 case RESET_MSG:
Allan Stephensa686e682008-06-04 17:29:39 -07001499 if (!link_working_unknown(l_ptr) &&
1500 (l_ptr->peer_session != INVALID_SESSION)) {
Allan Stephens641c2182011-04-07 09:54:43 -04001501 if (less_eq(msg_session(msg), l_ptr->peer_session))
1502 break; /* duplicate or old reset: ignore */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001503 }
Allan Stephensb4b56102011-05-27 11:00:51 -04001504
1505 if (!msg_redundant_link(msg) && (link_working_working(l_ptr) ||
1506 link_working_unknown(l_ptr))) {
1507 /*
1508 * peer has lost contact -- don't allow peer's links
1509 * to reactivate before we recognize loss & clean up
1510 */
Ying Xueca9cf062014-05-08 08:54:40 +08001511 l_ptr->owner->action_flags |= TIPC_WAIT_OWN_LINKS_DOWN;
Allan Stephensb4b56102011-05-27 11:00:51 -04001512 }
1513
Allan Stephens47361c82011-10-26 10:55:16 -04001514 link_state_event(l_ptr, RESET_MSG);
1515
Per Lidenb97bf3f2006-01-02 19:04:38 +01001516 /* fall thru' */
1517 case ACTIVATE_MSG:
1518 /* Update link settings according other endpoint's values */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001519 strcpy((strrchr(l_ptr->name, ':') + 1), (char *)msg_data(msg));
1520
Allan Stephens2db99832010-12-31 18:59:33 +00001521 msg_tol = msg_link_tolerance(msg);
1522 if (msg_tol > l_ptr->tolerance)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001523 link_set_supervision_props(l_ptr, msg_tol);
1524
1525 if (msg_linkprio(msg) > l_ptr->priority)
1526 l_ptr->priority = msg_linkprio(msg);
1527
1528 max_pkt_info = msg_max_pkt(msg);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001529 if (max_pkt_info) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001530 if (max_pkt_info < l_ptr->max_pkt_target)
1531 l_ptr->max_pkt_target = max_pkt_info;
1532 if (l_ptr->max_pkt > l_ptr->max_pkt_target)
1533 l_ptr->max_pkt = l_ptr->max_pkt_target;
1534 } else {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001535 l_ptr->max_pkt = l_ptr->max_pkt_target;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001536 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001537
Allan Stephens4d753132011-10-25 12:19:05 -04001538 /* Synchronize broadcast link info, if not done previously */
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001539 if (!tipc_node_is_up(l_ptr->owner)) {
1540 l_ptr->owner->bclink.last_sent =
1541 l_ptr->owner->bclink.last_in =
1542 msg_last_bcast(msg);
1543 l_ptr->owner->bclink.oos_state = 0;
1544 }
Allan Stephens4d753132011-10-25 12:19:05 -04001545
Per Lidenb97bf3f2006-01-02 19:04:38 +01001546 l_ptr->peer_session = msg_session(msg);
1547 l_ptr->peer_bearer_id = msg_bearer_id(msg);
Allan Stephens47361c82011-10-26 10:55:16 -04001548
1549 if (msg_type(msg) == ACTIVATE_MSG)
1550 link_state_event(l_ptr, ACTIVATE_MSG);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001551 break;
1552 case STATE_MSG:
1553
Allan Stephens2db99832010-12-31 18:59:33 +00001554 msg_tol = msg_link_tolerance(msg);
1555 if (msg_tol)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001556 link_set_supervision_props(l_ptr, msg_tol);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001557
1558 if (msg_linkprio(msg) &&
Per Lidenb97bf3f2006-01-02 19:04:38 +01001559 (msg_linkprio(msg) != l_ptr->priority)) {
Erik Hugne3fa9cac2015-01-22 17:10:31 +01001560 pr_debug("%s<%s>, priority change %u->%u\n",
1561 link_rst_msg, l_ptr->name,
1562 l_ptr->priority, msg_linkprio(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001563 l_ptr->priority = msg_linkprio(msg);
Per Liden4323add2006-01-18 00:38:21 +01001564 tipc_link_reset(l_ptr); /* Enforce change to take effect */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001565 break;
1566 }
Jon Paul Maloyec37dcd2014-05-14 05:39:10 -04001567
1568 /* Record reception; force mismatch at next timeout: */
1569 l_ptr->checkpoint--;
1570
Per Lidenb97bf3f2006-01-02 19:04:38 +01001571 link_state_event(l_ptr, TRAFFIC_MSG_EVT);
1572 l_ptr->stats.recv_states++;
1573 if (link_reset_unknown(l_ptr))
1574 break;
1575
1576 if (less_eq(mod(l_ptr->next_in_no), msg_next_sent(msg))) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001577 rec_gap = mod(msg_next_sent(msg) -
Per Lidenb97bf3f2006-01-02 19:04:38 +01001578 mod(l_ptr->next_in_no));
1579 }
1580
1581 max_pkt_ack = msg_max_pkt(msg);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001582 if (max_pkt_ack > l_ptr->max_pkt) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001583 l_ptr->max_pkt = max_pkt_ack;
1584 l_ptr->max_pkt_probes = 0;
1585 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001586
1587 max_pkt_ack = 0;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001588 if (msg_probe(msg)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001589 l_ptr->stats.recv_probes++;
Allan Stephensa0168922010-12-31 18:59:35 +00001590 if (msg_size(msg) > sizeof(l_ptr->proto_msg))
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001591 max_pkt_ack = msg_size(msg);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001592 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001593
1594 /* Protocol message before retransmits, reduce loss risk */
Ying Xue389dd9b2012-11-16 13:51:30 +08001595 if (l_ptr->owner->bclink.recv_permitted)
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001596 tipc_bclink_update_link_state(l_ptr->owner,
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001597 msg_last_bcast(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001598
1599 if (rec_gap || (msg_probe(msg))) {
Ying Xue247f0f32014-02-18 16:06:46 +08001600 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, rec_gap, 0,
1601 0, max_pkt_ack);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001602 }
1603 if (msg_seq_gap(msg)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001604 l_ptr->stats.recv_nacks++;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001605 tipc_link_retransmit(l_ptr, skb_peek(&l_ptr->transmq),
Per Liden4323add2006-01-18 00:38:21 +01001606 msg_seq_gap(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001607 }
1608 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001609 }
1610exit:
Allan Stephens5f6d9122011-11-04 13:24:29 -04001611 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001612}
1613
1614
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001615/* tipc_link_tunnel_xmit(): Tunnel one packet via a link belonging to
1616 * a different bearer. Owner node is locked.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001617 */
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001618static void tipc_link_tunnel_xmit(struct tipc_link *l_ptr,
1619 struct tipc_msg *tunnel_hdr,
1620 struct tipc_msg *msg,
1621 u32 selector)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001622{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001623 struct tipc_link *tunnel;
Ying Xuea6ca1092014-11-26 11:41:55 +08001624 struct sk_buff *skb;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001625 u32 length = msg_size(msg);
1626
1627 tunnel = l_ptr->owner->active_links[selector & 1];
Allan Stephens5392d642006-06-25 23:52:50 -07001628 if (!tipc_link_is_up(tunnel)) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001629 pr_warn("%stunnel link no longer available\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001630 return;
Allan Stephens5392d642006-06-25 23:52:50 -07001631 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001632 msg_set_size(tunnel_hdr, length + INT_H_SIZE);
Ying Xuea6ca1092014-11-26 11:41:55 +08001633 skb = tipc_buf_acquire(length + INT_H_SIZE);
1634 if (!skb) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001635 pr_warn("%sunable to send tunnel msg\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001636 return;
Allan Stephens5392d642006-06-25 23:52:50 -07001637 }
Ying Xuea6ca1092014-11-26 11:41:55 +08001638 skb_copy_to_linear_data(skb, tunnel_hdr, INT_H_SIZE);
1639 skb_copy_to_linear_data_offset(skb, INT_H_SIZE, msg, length);
1640 __tipc_link_xmit_skb(tunnel, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001641}
1642
1643
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001644/* tipc_link_failover_send_queue(): A link has gone down, but a second
1645 * link is still active. We can do failover. Tunnel the failing link's
1646 * whole send queue via the remaining link. This way, we don't lose
1647 * any packets, and sequence order is preserved for subsequent traffic
1648 * sent over the remaining link. Owner node is locked.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001649 */
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001650void tipc_link_failover_send_queue(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001651{
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001652 int msgcount;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001653 struct tipc_link *tunnel = l_ptr->owner->active_links[0];
Per Lidenb97bf3f2006-01-02 19:04:38 +01001654 struct tipc_msg tunnel_hdr;
Ying Xue58dc55f2014-11-26 11:41:52 +08001655 struct sk_buff *skb;
Allan Stephens5392d642006-06-25 23:52:50 -07001656 int split_bundles;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001657
1658 if (!tunnel)
1659 return;
1660
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001661 tipc_msg_init(link_own_addr(l_ptr), &tunnel_hdr, CHANGEOVER_PROTOCOL,
Ying Xue34747532015-01-09 15:27:10 +08001662 ORIGINAL_MSG, INT_H_SIZE, l_ptr->addr);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001663 skb_queue_splice_tail_init(&l_ptr->backlogq, &l_ptr->transmq);
Jon Paul Maloy1f66d162015-03-25 12:07:24 -04001664 tipc_link_purge_backlog(l_ptr);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001665 msgcount = skb_queue_len(&l_ptr->transmq);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001666 msg_set_bearer_id(&tunnel_hdr, l_ptr->peer_bearer_id);
1667 msg_set_msgcnt(&tunnel_hdr, msgcount);
Allan Stephensf1310722006-06-25 23:51:37 -07001668
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001669 if (skb_queue_empty(&l_ptr->transmq)) {
Ying Xue58dc55f2014-11-26 11:41:52 +08001670 skb = tipc_buf_acquire(INT_H_SIZE);
1671 if (skb) {
1672 skb_copy_to_linear_data(skb, &tunnel_hdr, INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001673 msg_set_size(&tunnel_hdr, INT_H_SIZE);
Ying Xuea6ca1092014-11-26 11:41:55 +08001674 __tipc_link_xmit_skb(tunnel, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001675 } else {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001676 pr_warn("%sunable to send changeover msg\n",
1677 link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001678 }
1679 return;
1680 }
Allan Stephensf1310722006-06-25 23:51:37 -07001681
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001682 split_bundles = (l_ptr->owner->active_links[0] !=
Allan Stephens5392d642006-06-25 23:52:50 -07001683 l_ptr->owner->active_links[1]);
1684
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001685 skb_queue_walk(&l_ptr->transmq, skb) {
Ying Xue58dc55f2014-11-26 11:41:52 +08001686 struct tipc_msg *msg = buf_msg(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001687
1688 if ((msg_user(msg) == MSG_BUNDLER) && split_bundles) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001689 struct tipc_msg *m = msg_get_wrapped(msg);
Allan Stephens0e659672010-12-31 18:59:32 +00001690 unchar *pos = (unchar *)m;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001691
Florian Westphald788d802007-08-02 19:28:06 -07001692 msgcount = msg_msgcnt(msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001693 while (msgcount--) {
Allan Stephens0e659672010-12-31 18:59:32 +00001694 msg_set_seqno(m, msg_seqno(msg));
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001695 tipc_link_tunnel_xmit(l_ptr, &tunnel_hdr, m,
1696 msg_link_selector(m));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001697 pos += align(msg_size(m));
1698 m = (struct tipc_msg *)pos;
1699 }
1700 } else {
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001701 tipc_link_tunnel_xmit(l_ptr, &tunnel_hdr, msg,
1702 msg_link_selector(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001703 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001704 }
1705}
1706
Ying Xue247f0f32014-02-18 16:06:46 +08001707/* tipc_link_dup_queue_xmit(): A second link has become active. Tunnel a
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001708 * duplicate of the first link's send queue via the new link. This way, we
1709 * are guaranteed that currently queued packets from a socket are delivered
1710 * before future traffic from the same socket, even if this is using the
1711 * new link. The last arriving copy of each duplicate packet is dropped at
1712 * the receiving end by the regular protocol check, so packet cardinality
1713 * and sequence order is preserved per sender/receiver socket pair.
1714 * Owner node is locked.
1715 */
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001716void tipc_link_dup_queue_xmit(struct tipc_link *link,
1717 struct tipc_link *tnl)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001718{
Ying Xue58dc55f2014-11-26 11:41:52 +08001719 struct sk_buff *skb;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001720 struct tipc_msg tnl_hdr;
1721 struct sk_buff_head *queue = &link->transmq;
1722 int mcnt;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001723
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001724 tipc_msg_init(link_own_addr(link), &tnl_hdr, CHANGEOVER_PROTOCOL,
1725 DUPLICATE_MSG, INT_H_SIZE, link->addr);
1726 mcnt = skb_queue_len(&link->transmq) + skb_queue_len(&link->backlogq);
1727 msg_set_msgcnt(&tnl_hdr, mcnt);
1728 msg_set_bearer_id(&tnl_hdr, link->peer_bearer_id);
1729
1730tunnel_queue:
1731 skb_queue_walk(queue, skb) {
Ying Xue58dc55f2014-11-26 11:41:52 +08001732 struct sk_buff *outskb;
1733 struct tipc_msg *msg = buf_msg(skb);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001734 u32 len = msg_size(msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001735
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001736 msg_set_ack(msg, mod(link->next_in_no - 1));
1737 msg_set_bcast_ack(msg, link->owner->bclink.last_in);
1738 msg_set_size(&tnl_hdr, len + INT_H_SIZE);
1739 outskb = tipc_buf_acquire(len + INT_H_SIZE);
Ying Xue58dc55f2014-11-26 11:41:52 +08001740 if (outskb == NULL) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001741 pr_warn("%sunable to send duplicate msg\n",
1742 link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001743 return;
1744 }
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001745 skb_copy_to_linear_data(outskb, &tnl_hdr, INT_H_SIZE);
1746 skb_copy_to_linear_data_offset(outskb, INT_H_SIZE,
1747 skb->data, len);
1748 __tipc_link_xmit_skb(tnl, outskb);
1749 if (!tipc_link_is_up(link))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001750 return;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001751 }
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001752 if (queue == &link->backlogq)
1753 return;
1754 queue = &link->backlogq;
1755 goto tunnel_queue;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001756}
1757
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001758/* tipc_link_dup_rcv(): Receive a tunnelled DUPLICATE_MSG packet.
1759 * Owner node is locked.
1760 */
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001761static void tipc_link_dup_rcv(struct tipc_link *link,
1762 struct sk_buff *skb)
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001763{
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001764 struct sk_buff *iskb;
1765 int pos = 0;
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001766
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001767 if (!tipc_link_is_up(link))
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001768 return;
1769
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001770 if (!tipc_msg_extract(skb, &iskb, &pos)) {
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001771 pr_warn("%sfailed to extract inner dup pkt\n", link_co_err);
1772 return;
1773 }
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001774 /* Append buffer to deferred queue, if applicable: */
1775 link_handle_out_of_seq_msg(link, iskb);
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001776}
1777
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001778/* tipc_link_failover_rcv(): Receive a tunnelled ORIGINAL_MSG packet
1779 * Owner node is locked.
1780 */
1781static struct sk_buff *tipc_link_failover_rcv(struct tipc_link *l_ptr,
1782 struct sk_buff *t_buf)
1783{
1784 struct tipc_msg *t_msg = buf_msg(t_buf);
1785 struct sk_buff *buf = NULL;
1786 struct tipc_msg *msg;
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001787 int pos = 0;
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001788
1789 if (tipc_link_is_up(l_ptr))
1790 tipc_link_reset(l_ptr);
1791
1792 /* First failover packet? */
1793 if (l_ptr->exp_msg_count == START_CHANGEOVER)
1794 l_ptr->exp_msg_count = msg_msgcnt(t_msg);
1795
1796 /* Should there be an inner packet? */
1797 if (l_ptr->exp_msg_count) {
1798 l_ptr->exp_msg_count--;
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001799 if (!tipc_msg_extract(t_buf, &buf, &pos)) {
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001800 pr_warn("%sno inner failover pkt\n", link_co_err);
1801 goto exit;
1802 }
1803 msg = buf_msg(buf);
1804
1805 if (less(msg_seqno(msg), l_ptr->reset_checkpoint)) {
1806 kfree_skb(buf);
1807 buf = NULL;
1808 goto exit;
1809 }
1810 if (msg_user(msg) == MSG_FRAGMENTER) {
1811 l_ptr->stats.recv_fragments++;
Jon Paul Maloy37e22162014-05-14 05:39:12 -04001812 tipc_buf_append(&l_ptr->reasm_buf, &buf);
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001813 }
1814 }
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001815exit:
Jon Paul Maloy2d72d492015-02-03 08:59:17 -05001816 if ((!l_ptr->exp_msg_count) && (l_ptr->flags & LINK_STOPPED))
1817 tipc_link_delete(l_ptr);
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001818 return buf;
1819}
1820
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001821/* tipc_link_tunnel_rcv(): Receive a tunnelled packet, sent
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001822 * via other link as result of a failover (ORIGINAL_MSG) or
1823 * a new active link (DUPLICATE_MSG). Failover packets are
1824 * returned to the active link for delivery upwards.
1825 * Owner node is locked.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001826 */
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001827static int tipc_link_tunnel_rcv(struct tipc_node *n_ptr,
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001828 struct sk_buff **buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001829{
Jon Paul Maloy02842f72014-02-13 17:29:14 -05001830 struct sk_buff *t_buf = *buf;
1831 struct tipc_link *l_ptr;
1832 struct tipc_msg *t_msg = buf_msg(t_buf);
1833 u32 bearer_id = msg_bearer_id(t_msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001834
Jon Paul Maloy1e9d47a2014-02-13 17:29:13 -05001835 *buf = NULL;
1836
Dan Carpentercb4b102f2013-05-06 08:28:41 +00001837 if (bearer_id >= MAX_BEARERS)
1838 goto exit;
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001839
Jon Paul Maloy02842f72014-02-13 17:29:14 -05001840 l_ptr = n_ptr->links[bearer_id];
1841 if (!l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001842 goto exit;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001843
Jon Paul Maloy02842f72014-02-13 17:29:14 -05001844 if (msg_type(t_msg) == DUPLICATE_MSG)
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001845 tipc_link_dup_rcv(l_ptr, t_buf);
Jon Paul Maloy02842f72014-02-13 17:29:14 -05001846 else if (msg_type(t_msg) == ORIGINAL_MSG)
1847 *buf = tipc_link_failover_rcv(l_ptr, t_buf);
Jon Paul Maloy1e9d47a2014-02-13 17:29:13 -05001848 else
1849 pr_warn("%sunknown tunnel pkt received\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001850exit:
Jon Paul Maloy02842f72014-02-13 17:29:14 -05001851 kfree_skb(t_buf);
Jon Paul Maloy1e9d47a2014-02-13 17:29:13 -05001852 return *buf != NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001853}
1854
Ying Xue2f55c432015-01-09 15:27:00 +08001855static void link_set_supervision_props(struct tipc_link *l_ptr, u32 tol)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001856{
Ying Xue2f55c432015-01-09 15:27:00 +08001857 unsigned long intv = ((tol / 4) > 500) ? 500 : tol / 4;
1858
1859 if ((tol < TIPC_MIN_LINK_TOL) || (tol > TIPC_MAX_LINK_TOL))
Allan Stephens5413b4c2011-01-18 13:24:55 -05001860 return;
1861
Ying Xue2f55c432015-01-09 15:27:00 +08001862 l_ptr->tolerance = tol;
1863 l_ptr->cont_intv = msecs_to_jiffies(intv);
1864 l_ptr->abort_limit = tol / (jiffies_to_msecs(l_ptr->cont_intv) / 4);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001865}
1866
Jon Paul Maloye3eea1e2015-03-13 16:08:11 -04001867void tipc_link_set_queue_limits(struct tipc_link *l, u32 win)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001868{
Jon Paul Maloye3eea1e2015-03-13 16:08:11 -04001869 int max_bulk = TIPC_MAX_PUBLICATIONS / (l->max_pkt / ITEM_SIZE);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001870
Jon Paul Maloye3eea1e2015-03-13 16:08:11 -04001871 l->window = win;
Jon Paul Maloy1f66d162015-03-25 12:07:24 -04001872 l->backlog[TIPC_LOW_IMPORTANCE].limit = win / 2;
1873 l->backlog[TIPC_MEDIUM_IMPORTANCE].limit = win;
1874 l->backlog[TIPC_HIGH_IMPORTANCE].limit = win / 2 * 3;
1875 l->backlog[TIPC_CRITICAL_IMPORTANCE].limit = win * 2;
1876 l->backlog[TIPC_SYSTEM_IMPORTANCE].limit = max_bulk;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001877}
1878
Jon Paul Maloye099e862014-02-13 17:29:18 -05001879/* tipc_link_find_owner - locate owner node of link by link's name
Ying Xuef2f98002015-01-09 15:27:05 +08001880 * @net: the applicable net namespace
Jon Paul Maloye099e862014-02-13 17:29:18 -05001881 * @name: pointer to link name string
1882 * @bearer_id: pointer to index in 'node->links' array where the link was found.
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001883 *
Jon Paul Maloye099e862014-02-13 17:29:18 -05001884 * Returns pointer to node owning the link, or 0 if no matching link is found.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001885 */
Ying Xuef2f98002015-01-09 15:27:05 +08001886static struct tipc_node *tipc_link_find_owner(struct net *net,
1887 const char *link_name,
Jon Paul Maloye099e862014-02-13 17:29:18 -05001888 unsigned int *bearer_id)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001889{
Ying Xuef2f98002015-01-09 15:27:05 +08001890 struct tipc_net *tn = net_generic(net, tipc_net_id);
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001891 struct tipc_link *l_ptr;
Erik Hugnebbfbe472013-10-18 07:23:21 +02001892 struct tipc_node *n_ptr;
Fabian Frederick886eaa12014-12-25 12:05:50 +01001893 struct tipc_node *found_node = NULL;
Erik Hugnebbfbe472013-10-18 07:23:21 +02001894 int i;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001895
Jon Paul Maloye099e862014-02-13 17:29:18 -05001896 *bearer_id = 0;
Ying Xue6c7a7622014-03-27 12:54:37 +08001897 rcu_read_lock();
Ying Xuef2f98002015-01-09 15:27:05 +08001898 list_for_each_entry_rcu(n_ptr, &tn->node_list, list) {
Jon Paul Maloya11607f2014-02-14 16:40:44 -05001899 tipc_node_lock(n_ptr);
Erik Hugnebbfbe472013-10-18 07:23:21 +02001900 for (i = 0; i < MAX_BEARERS; i++) {
1901 l_ptr = n_ptr->links[i];
Jon Paul Maloye099e862014-02-13 17:29:18 -05001902 if (l_ptr && !strcmp(l_ptr->name, link_name)) {
1903 *bearer_id = i;
1904 found_node = n_ptr;
1905 break;
1906 }
Erik Hugnebbfbe472013-10-18 07:23:21 +02001907 }
Jon Paul Maloya11607f2014-02-14 16:40:44 -05001908 tipc_node_unlock(n_ptr);
Jon Paul Maloye099e862014-02-13 17:29:18 -05001909 if (found_node)
1910 break;
Erik Hugnebbfbe472013-10-18 07:23:21 +02001911 }
Ying Xue6c7a7622014-03-27 12:54:37 +08001912 rcu_read_unlock();
1913
Jon Paul Maloye099e862014-02-13 17:29:18 -05001914 return found_node;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001915}
1916
Allan Stephens5c216e12011-10-18 11:34:29 -04001917/**
Per Lidenb97bf3f2006-01-02 19:04:38 +01001918 * link_reset_statistics - reset link statistics
1919 * @l_ptr: pointer to link
1920 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001921static void link_reset_statistics(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001922{
1923 memset(&l_ptr->stats, 0, sizeof(l_ptr->stats));
1924 l_ptr->stats.sent_info = l_ptr->next_out_no;
1925 l_ptr->stats.recv_info = l_ptr->next_in_no;
1926}
1927
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001928static void link_print(struct tipc_link *l_ptr, const char *str)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001929{
Ying Xue7f9f95d2015-01-09 15:27:06 +08001930 struct tipc_net *tn = net_generic(l_ptr->owner->net, tipc_net_id);
Ying Xue7a2f7d12014-04-21 10:55:46 +08001931 struct tipc_bearer *b_ptr;
1932
1933 rcu_read_lock();
Ying Xue7f9f95d2015-01-09 15:27:06 +08001934 b_ptr = rcu_dereference_rtnl(tn->bearer_list[l_ptr->bearer_id]);
Ying Xue7a2f7d12014-04-21 10:55:46 +08001935 if (b_ptr)
1936 pr_info("%s Link %x<%s>:", str, l_ptr->addr, b_ptr->name);
1937 rcu_read_unlock();
Allan Stephens8d64a5b2010-12-31 18:59:27 +00001938
Per Lidenb97bf3f2006-01-02 19:04:38 +01001939 if (link_working_unknown(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04001940 pr_cont(":WU\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00001941 else if (link_reset_reset(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04001942 pr_cont(":RR\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00001943 else if (link_reset_unknown(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04001944 pr_cont(":RU\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00001945 else if (link_working_working(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04001946 pr_cont(":WW\n");
1947 else
1948 pr_cont("\n");
Per Lidenb97bf3f2006-01-02 19:04:38 +01001949}
Richard Alpe0655f6a2014-11-20 10:29:07 +01001950
1951/* Parse and validate nested (link) properties valid for media, bearer and link
1952 */
1953int tipc_nl_parse_link_prop(struct nlattr *prop, struct nlattr *props[])
1954{
1955 int err;
1956
1957 err = nla_parse_nested(props, TIPC_NLA_PROP_MAX, prop,
1958 tipc_nl_prop_policy);
1959 if (err)
1960 return err;
1961
1962 if (props[TIPC_NLA_PROP_PRIO]) {
1963 u32 prio;
1964
1965 prio = nla_get_u32(props[TIPC_NLA_PROP_PRIO]);
1966 if (prio > TIPC_MAX_LINK_PRI)
1967 return -EINVAL;
1968 }
1969
1970 if (props[TIPC_NLA_PROP_TOL]) {
1971 u32 tol;
1972
1973 tol = nla_get_u32(props[TIPC_NLA_PROP_TOL]);
1974 if ((tol < TIPC_MIN_LINK_TOL) || (tol > TIPC_MAX_LINK_TOL))
1975 return -EINVAL;
1976 }
1977
1978 if (props[TIPC_NLA_PROP_WIN]) {
1979 u32 win;
1980
1981 win = nla_get_u32(props[TIPC_NLA_PROP_WIN]);
1982 if ((win < TIPC_MIN_LINK_WIN) || (win > TIPC_MAX_LINK_WIN))
1983 return -EINVAL;
1984 }
1985
1986 return 0;
1987}
Richard Alpe7be57fc2014-11-20 10:29:12 +01001988
Richard Alpef96ce7a2014-11-20 10:29:13 +01001989int tipc_nl_link_set(struct sk_buff *skb, struct genl_info *info)
1990{
1991 int err;
1992 int res = 0;
1993 int bearer_id;
1994 char *name;
1995 struct tipc_link *link;
1996 struct tipc_node *node;
1997 struct nlattr *attrs[TIPC_NLA_LINK_MAX + 1];
Richard Alpe37e2d482015-02-09 09:50:08 +01001998 struct net *net = sock_net(skb->sk);
Richard Alpef96ce7a2014-11-20 10:29:13 +01001999
2000 if (!info->attrs[TIPC_NLA_LINK])
2001 return -EINVAL;
2002
2003 err = nla_parse_nested(attrs, TIPC_NLA_LINK_MAX,
2004 info->attrs[TIPC_NLA_LINK],
2005 tipc_nl_link_policy);
2006 if (err)
2007 return err;
2008
2009 if (!attrs[TIPC_NLA_LINK_NAME])
2010 return -EINVAL;
2011
2012 name = nla_data(attrs[TIPC_NLA_LINK_NAME]);
2013
Ying Xuef2f98002015-01-09 15:27:05 +08002014 node = tipc_link_find_owner(net, name, &bearer_id);
Richard Alpef96ce7a2014-11-20 10:29:13 +01002015 if (!node)
2016 return -EINVAL;
2017
2018 tipc_node_lock(node);
2019
2020 link = node->links[bearer_id];
2021 if (!link) {
2022 res = -EINVAL;
2023 goto out;
2024 }
2025
2026 if (attrs[TIPC_NLA_LINK_PROP]) {
2027 struct nlattr *props[TIPC_NLA_PROP_MAX + 1];
2028
2029 err = tipc_nl_parse_link_prop(attrs[TIPC_NLA_LINK_PROP],
2030 props);
2031 if (err) {
2032 res = err;
2033 goto out;
2034 }
2035
2036 if (props[TIPC_NLA_PROP_TOL]) {
2037 u32 tol;
2038
2039 tol = nla_get_u32(props[TIPC_NLA_PROP_TOL]);
2040 link_set_supervision_props(link, tol);
2041 tipc_link_proto_xmit(link, STATE_MSG, 0, 0, tol, 0, 0);
2042 }
2043 if (props[TIPC_NLA_PROP_PRIO]) {
2044 u32 prio;
2045
2046 prio = nla_get_u32(props[TIPC_NLA_PROP_PRIO]);
2047 link->priority = prio;
2048 tipc_link_proto_xmit(link, STATE_MSG, 0, 0, 0, prio, 0);
2049 }
2050 if (props[TIPC_NLA_PROP_WIN]) {
2051 u32 win;
2052
2053 win = nla_get_u32(props[TIPC_NLA_PROP_WIN]);
2054 tipc_link_set_queue_limits(link, win);
2055 }
2056 }
2057
2058out:
2059 tipc_node_unlock(node);
2060
2061 return res;
2062}
Richard Alped8182802014-11-24 11:10:29 +01002063
2064static int __tipc_nl_add_stats(struct sk_buff *skb, struct tipc_stats *s)
Richard Alpe7be57fc2014-11-20 10:29:12 +01002065{
2066 int i;
2067 struct nlattr *stats;
2068
2069 struct nla_map {
2070 u32 key;
2071 u32 val;
2072 };
2073
2074 struct nla_map map[] = {
2075 {TIPC_NLA_STATS_RX_INFO, s->recv_info},
2076 {TIPC_NLA_STATS_RX_FRAGMENTS, s->recv_fragments},
2077 {TIPC_NLA_STATS_RX_FRAGMENTED, s->recv_fragmented},
2078 {TIPC_NLA_STATS_RX_BUNDLES, s->recv_bundles},
2079 {TIPC_NLA_STATS_RX_BUNDLED, s->recv_bundled},
2080 {TIPC_NLA_STATS_TX_INFO, s->sent_info},
2081 {TIPC_NLA_STATS_TX_FRAGMENTS, s->sent_fragments},
2082 {TIPC_NLA_STATS_TX_FRAGMENTED, s->sent_fragmented},
2083 {TIPC_NLA_STATS_TX_BUNDLES, s->sent_bundles},
2084 {TIPC_NLA_STATS_TX_BUNDLED, s->sent_bundled},
2085 {TIPC_NLA_STATS_MSG_PROF_TOT, (s->msg_length_counts) ?
2086 s->msg_length_counts : 1},
2087 {TIPC_NLA_STATS_MSG_LEN_CNT, s->msg_length_counts},
2088 {TIPC_NLA_STATS_MSG_LEN_TOT, s->msg_lengths_total},
2089 {TIPC_NLA_STATS_MSG_LEN_P0, s->msg_length_profile[0]},
2090 {TIPC_NLA_STATS_MSG_LEN_P1, s->msg_length_profile[1]},
2091 {TIPC_NLA_STATS_MSG_LEN_P2, s->msg_length_profile[2]},
2092 {TIPC_NLA_STATS_MSG_LEN_P3, s->msg_length_profile[3]},
2093 {TIPC_NLA_STATS_MSG_LEN_P4, s->msg_length_profile[4]},
2094 {TIPC_NLA_STATS_MSG_LEN_P5, s->msg_length_profile[5]},
2095 {TIPC_NLA_STATS_MSG_LEN_P6, s->msg_length_profile[6]},
2096 {TIPC_NLA_STATS_RX_STATES, s->recv_states},
2097 {TIPC_NLA_STATS_RX_PROBES, s->recv_probes},
2098 {TIPC_NLA_STATS_RX_NACKS, s->recv_nacks},
2099 {TIPC_NLA_STATS_RX_DEFERRED, s->deferred_recv},
2100 {TIPC_NLA_STATS_TX_STATES, s->sent_states},
2101 {TIPC_NLA_STATS_TX_PROBES, s->sent_probes},
2102 {TIPC_NLA_STATS_TX_NACKS, s->sent_nacks},
2103 {TIPC_NLA_STATS_TX_ACKS, s->sent_acks},
2104 {TIPC_NLA_STATS_RETRANSMITTED, s->retransmitted},
2105 {TIPC_NLA_STATS_DUPLICATES, s->duplicates},
2106 {TIPC_NLA_STATS_LINK_CONGS, s->link_congs},
2107 {TIPC_NLA_STATS_MAX_QUEUE, s->max_queue_sz},
2108 {TIPC_NLA_STATS_AVG_QUEUE, s->queue_sz_counts ?
2109 (s->accu_queue_sz / s->queue_sz_counts) : 0}
2110 };
2111
2112 stats = nla_nest_start(skb, TIPC_NLA_LINK_STATS);
2113 if (!stats)
2114 return -EMSGSIZE;
2115
2116 for (i = 0; i < ARRAY_SIZE(map); i++)
2117 if (nla_put_u32(skb, map[i].key, map[i].val))
2118 goto msg_full;
2119
2120 nla_nest_end(skb, stats);
2121
2122 return 0;
2123msg_full:
2124 nla_nest_cancel(skb, stats);
2125
2126 return -EMSGSIZE;
2127}
2128
2129/* Caller should hold appropriate locks to protect the link */
Ying Xue34747532015-01-09 15:27:10 +08002130static int __tipc_nl_add_link(struct net *net, struct tipc_nl_msg *msg,
2131 struct tipc_link *link)
Richard Alpe7be57fc2014-11-20 10:29:12 +01002132{
2133 int err;
2134 void *hdr;
2135 struct nlattr *attrs;
2136 struct nlattr *prop;
Ying Xue34747532015-01-09 15:27:10 +08002137 struct tipc_net *tn = net_generic(net, tipc_net_id);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002138
Richard Alpebfb3e5d2015-02-09 09:50:03 +01002139 hdr = genlmsg_put(msg->skb, msg->portid, msg->seq, &tipc_genl_family,
Richard Alpe7be57fc2014-11-20 10:29:12 +01002140 NLM_F_MULTI, TIPC_NL_LINK_GET);
2141 if (!hdr)
2142 return -EMSGSIZE;
2143
2144 attrs = nla_nest_start(msg->skb, TIPC_NLA_LINK);
2145 if (!attrs)
2146 goto msg_full;
2147
2148 if (nla_put_string(msg->skb, TIPC_NLA_LINK_NAME, link->name))
2149 goto attr_msg_full;
2150 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_DEST,
Ying Xue34747532015-01-09 15:27:10 +08002151 tipc_cluster_mask(tn->own_addr)))
Richard Alpe7be57fc2014-11-20 10:29:12 +01002152 goto attr_msg_full;
2153 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_MTU, link->max_pkt))
2154 goto attr_msg_full;
2155 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_RX, link->next_in_no))
2156 goto attr_msg_full;
2157 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_TX, link->next_out_no))
2158 goto attr_msg_full;
2159
2160 if (tipc_link_is_up(link))
2161 if (nla_put_flag(msg->skb, TIPC_NLA_LINK_UP))
2162 goto attr_msg_full;
2163 if (tipc_link_is_active(link))
2164 if (nla_put_flag(msg->skb, TIPC_NLA_LINK_ACTIVE))
2165 goto attr_msg_full;
2166
2167 prop = nla_nest_start(msg->skb, TIPC_NLA_LINK_PROP);
2168 if (!prop)
2169 goto attr_msg_full;
2170 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_PRIO, link->priority))
2171 goto prop_msg_full;
2172 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_TOL, link->tolerance))
2173 goto prop_msg_full;
2174 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_WIN,
Jon Paul Maloy1f66d162015-03-25 12:07:24 -04002175 link->window))
Richard Alpe7be57fc2014-11-20 10:29:12 +01002176 goto prop_msg_full;
2177 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_PRIO, link->priority))
2178 goto prop_msg_full;
2179 nla_nest_end(msg->skb, prop);
2180
2181 err = __tipc_nl_add_stats(msg->skb, &link->stats);
2182 if (err)
2183 goto attr_msg_full;
2184
2185 nla_nest_end(msg->skb, attrs);
2186 genlmsg_end(msg->skb, hdr);
2187
2188 return 0;
2189
2190prop_msg_full:
2191 nla_nest_cancel(msg->skb, prop);
2192attr_msg_full:
2193 nla_nest_cancel(msg->skb, attrs);
2194msg_full:
2195 genlmsg_cancel(msg->skb, hdr);
2196
2197 return -EMSGSIZE;
2198}
2199
2200/* Caller should hold node lock */
Ying Xue34747532015-01-09 15:27:10 +08002201static int __tipc_nl_add_node_links(struct net *net, struct tipc_nl_msg *msg,
2202 struct tipc_node *node, u32 *prev_link)
Richard Alpe7be57fc2014-11-20 10:29:12 +01002203{
2204 u32 i;
2205 int err;
2206
2207 for (i = *prev_link; i < MAX_BEARERS; i++) {
2208 *prev_link = i;
2209
2210 if (!node->links[i])
2211 continue;
2212
Ying Xue34747532015-01-09 15:27:10 +08002213 err = __tipc_nl_add_link(net, msg, node->links[i]);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002214 if (err)
2215 return err;
2216 }
2217 *prev_link = 0;
2218
2219 return 0;
2220}
2221
2222int tipc_nl_link_dump(struct sk_buff *skb, struct netlink_callback *cb)
2223{
Ying Xuef2f98002015-01-09 15:27:05 +08002224 struct net *net = sock_net(skb->sk);
2225 struct tipc_net *tn = net_generic(net, tipc_net_id);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002226 struct tipc_node *node;
2227 struct tipc_nl_msg msg;
2228 u32 prev_node = cb->args[0];
2229 u32 prev_link = cb->args[1];
2230 int done = cb->args[2];
2231 int err;
2232
2233 if (done)
2234 return 0;
2235
2236 msg.skb = skb;
2237 msg.portid = NETLINK_CB(cb->skb).portid;
2238 msg.seq = cb->nlh->nlmsg_seq;
2239
2240 rcu_read_lock();
Richard Alpe7be57fc2014-11-20 10:29:12 +01002241 if (prev_node) {
Ying Xuef2f98002015-01-09 15:27:05 +08002242 node = tipc_node_find(net, prev_node);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002243 if (!node) {
2244 /* We never set seq or call nl_dump_check_consistent()
2245 * this means that setting prev_seq here will cause the
2246 * consistence check to fail in the netlink callback
2247 * handler. Resulting in the last NLMSG_DONE message
2248 * having the NLM_F_DUMP_INTR flag set.
2249 */
2250 cb->prev_seq = 1;
2251 goto out;
2252 }
Ying Xue8a0f6eb2015-03-26 18:10:24 +08002253 tipc_node_put(node);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002254
Ying Xuef2f98002015-01-09 15:27:05 +08002255 list_for_each_entry_continue_rcu(node, &tn->node_list,
2256 list) {
Richard Alpe7be57fc2014-11-20 10:29:12 +01002257 tipc_node_lock(node);
Ying Xue34747532015-01-09 15:27:10 +08002258 err = __tipc_nl_add_node_links(net, &msg, node,
2259 &prev_link);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002260 tipc_node_unlock(node);
Ying Xue8a0f6eb2015-03-26 18:10:24 +08002261 tipc_node_put(node);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002262 if (err)
2263 goto out;
2264
2265 prev_node = node->addr;
2266 }
2267 } else {
Ying Xue1da46562015-01-09 15:27:07 +08002268 err = tipc_nl_add_bc_link(net, &msg);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002269 if (err)
2270 goto out;
2271
Ying Xuef2f98002015-01-09 15:27:05 +08002272 list_for_each_entry_rcu(node, &tn->node_list, list) {
Richard Alpe7be57fc2014-11-20 10:29:12 +01002273 tipc_node_lock(node);
Ying Xue34747532015-01-09 15:27:10 +08002274 err = __tipc_nl_add_node_links(net, &msg, node,
2275 &prev_link);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002276 tipc_node_unlock(node);
2277 if (err)
2278 goto out;
2279
2280 prev_node = node->addr;
2281 }
2282 }
2283 done = 1;
2284out:
2285 rcu_read_unlock();
2286
2287 cb->args[0] = prev_node;
2288 cb->args[1] = prev_link;
2289 cb->args[2] = done;
2290
2291 return skb->len;
2292}
2293
2294int tipc_nl_link_get(struct sk_buff *skb, struct genl_info *info)
2295{
Ying Xuef2f98002015-01-09 15:27:05 +08002296 struct net *net = genl_info_net(info);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002297 struct sk_buff *ans_skb;
2298 struct tipc_nl_msg msg;
2299 struct tipc_link *link;
2300 struct tipc_node *node;
2301 char *name;
2302 int bearer_id;
2303 int err;
2304
2305 if (!info->attrs[TIPC_NLA_LINK_NAME])
2306 return -EINVAL;
2307
2308 name = nla_data(info->attrs[TIPC_NLA_LINK_NAME]);
Ying Xuef2f98002015-01-09 15:27:05 +08002309 node = tipc_link_find_owner(net, name, &bearer_id);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002310 if (!node)
2311 return -EINVAL;
2312
2313 ans_skb = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
2314 if (!ans_skb)
2315 return -ENOMEM;
2316
2317 msg.skb = ans_skb;
2318 msg.portid = info->snd_portid;
2319 msg.seq = info->snd_seq;
2320
2321 tipc_node_lock(node);
2322 link = node->links[bearer_id];
2323 if (!link) {
2324 err = -EINVAL;
2325 goto err_out;
2326 }
2327
Ying Xue34747532015-01-09 15:27:10 +08002328 err = __tipc_nl_add_link(net, &msg, link);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002329 if (err)
2330 goto err_out;
2331
2332 tipc_node_unlock(node);
2333
2334 return genlmsg_reply(ans_skb, info);
2335
2336err_out:
2337 tipc_node_unlock(node);
2338 nlmsg_free(ans_skb);
2339
2340 return err;
2341}
Richard Alpeae363422014-11-20 10:29:14 +01002342
2343int tipc_nl_link_reset_stats(struct sk_buff *skb, struct genl_info *info)
2344{
2345 int err;
2346 char *link_name;
2347 unsigned int bearer_id;
2348 struct tipc_link *link;
2349 struct tipc_node *node;
2350 struct nlattr *attrs[TIPC_NLA_LINK_MAX + 1];
Richard Alpe18178772015-02-09 09:50:09 +01002351 struct net *net = sock_net(skb->sk);
Richard Alpeae363422014-11-20 10:29:14 +01002352
2353 if (!info->attrs[TIPC_NLA_LINK])
2354 return -EINVAL;
2355
2356 err = nla_parse_nested(attrs, TIPC_NLA_LINK_MAX,
2357 info->attrs[TIPC_NLA_LINK],
2358 tipc_nl_link_policy);
2359 if (err)
2360 return err;
2361
2362 if (!attrs[TIPC_NLA_LINK_NAME])
2363 return -EINVAL;
2364
2365 link_name = nla_data(attrs[TIPC_NLA_LINK_NAME]);
2366
2367 if (strcmp(link_name, tipc_bclink_name) == 0) {
Ying Xue1da46562015-01-09 15:27:07 +08002368 err = tipc_bclink_reset_stats(net);
Richard Alpeae363422014-11-20 10:29:14 +01002369 if (err)
2370 return err;
2371 return 0;
2372 }
2373
Ying Xuef2f98002015-01-09 15:27:05 +08002374 node = tipc_link_find_owner(net, link_name, &bearer_id);
Richard Alpeae363422014-11-20 10:29:14 +01002375 if (!node)
2376 return -EINVAL;
2377
2378 tipc_node_lock(node);
2379
2380 link = node->links[bearer_id];
2381 if (!link) {
2382 tipc_node_unlock(node);
2383 return -EINVAL;
2384 }
2385
2386 link_reset_statistics(link);
2387
2388 tipc_node_unlock(node);
2389
2390 return 0;
2391}