blob: bc49120bfb44fbb69463a302cfbbfe17b75877f5 [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
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500142static void link_init_max_pkt(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100143{
Ying Xue7f9f95d2015-01-09 15:27:06 +0800144 struct tipc_node *node = l_ptr->owner;
145 struct tipc_net *tn = net_generic(node->net, tipc_net_id);
Ying Xue7a2f7d12014-04-21 10:55:46 +0800146 struct tipc_bearer *b_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100147 u32 max_pkt;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900148
Ying Xue7a2f7d12014-04-21 10:55:46 +0800149 rcu_read_lock();
Ying Xue7f9f95d2015-01-09 15:27:06 +0800150 b_ptr = rcu_dereference_rtnl(tn->bearer_list[l_ptr->bearer_id]);
Ying Xue7a2f7d12014-04-21 10:55:46 +0800151 if (!b_ptr) {
152 rcu_read_unlock();
153 return;
154 }
155 max_pkt = (b_ptr->mtu & ~3);
156 rcu_read_unlock();
157
Per Lidenb97bf3f2006-01-02 19:04:38 +0100158 if (max_pkt > MAX_MSG_SIZE)
159 max_pkt = MAX_MSG_SIZE;
160
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900161 l_ptr->max_pkt_target = max_pkt;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100162 if (l_ptr->max_pkt_target < MAX_PKT_DEFAULT)
163 l_ptr->max_pkt = l_ptr->max_pkt_target;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900164 else
Per Lidenb97bf3f2006-01-02 19:04:38 +0100165 l_ptr->max_pkt = MAX_PKT_DEFAULT;
166
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900167 l_ptr->max_pkt_probes = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100168}
169
Per Lidenb97bf3f2006-01-02 19:04:38 +0100170/*
Sam Ravnborg05790c62006-03-20 22:37:04 -0800171 * Simple non-static link routines (i.e. referenced outside this file)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100172 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500173int tipc_link_is_up(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100174{
175 if (!l_ptr)
176 return 0;
Eric Dumazeta02cec22010-09-22 20:43:57 +0000177 return link_working_working(l_ptr) || link_working_unknown(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100178}
179
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500180int tipc_link_is_active(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100181{
Eric Dumazeta02cec22010-09-22 20:43:57 +0000182 return (l_ptr->owner->active_links[0] == l_ptr) ||
183 (l_ptr->owner->active_links[1] == l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100184}
185
186/**
Per Lidenb97bf3f2006-01-02 19:04:38 +0100187 * link_timeout - handle expiration of link timer
188 * @l_ptr: pointer to link
Per Lidenb97bf3f2006-01-02 19:04:38 +0100189 */
Ying Xue2f55c432015-01-09 15:27:00 +0800190static void link_timeout(unsigned long data)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100191{
Ying Xue2f55c432015-01-09 15:27:00 +0800192 struct tipc_link *l_ptr = (struct tipc_link *)data;
Ying Xue58dc55f2014-11-26 11:41:52 +0800193 struct sk_buff *skb;
194
Per Liden4323add2006-01-18 00:38:21 +0100195 tipc_node_lock(l_ptr->owner);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100196
197 /* update counters used in statistical profiling of send traffic */
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400198 l_ptr->stats.accu_queue_sz += skb_queue_len(&l_ptr->transmq);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100199 l_ptr->stats.queue_sz_counts++;
200
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400201 skb = skb_peek(&l_ptr->transmq);
Ying Xue58dc55f2014-11-26 11:41:52 +0800202 if (skb) {
203 struct tipc_msg *msg = buf_msg(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100204 u32 length = msg_size(msg);
205
Joe Perchesf64f9e72009-11-29 16:55:45 -0800206 if ((msg_user(msg) == MSG_FRAGMENTER) &&
207 (msg_type(msg) == FIRST_FRAGMENT)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100208 length = msg_size(msg_get_wrapped(msg));
209 }
210 if (length) {
211 l_ptr->stats.msg_lengths_total += length;
212 l_ptr->stats.msg_length_counts++;
213 if (length <= 64)
214 l_ptr->stats.msg_length_profile[0]++;
215 else if (length <= 256)
216 l_ptr->stats.msg_length_profile[1]++;
217 else if (length <= 1024)
218 l_ptr->stats.msg_length_profile[2]++;
219 else if (length <= 4096)
220 l_ptr->stats.msg_length_profile[3]++;
221 else if (length <= 16384)
222 l_ptr->stats.msg_length_profile[4]++;
223 else if (length <= 32768)
224 l_ptr->stats.msg_length_profile[5]++;
225 else
226 l_ptr->stats.msg_length_profile[6]++;
227 }
228 }
229
230 /* do all other link processing performed on a periodic basis */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100231 link_state_event(l_ptr, TIMEOUT_EVT);
232
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400233 if (skb_queue_len(&l_ptr->backlogq))
Ying Xue47b4c9a2014-11-26 11:41:48 +0800234 tipc_link_push_packets(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100235
Per Liden4323add2006-01-18 00:38:21 +0100236 tipc_node_unlock(l_ptr->owner);
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500237 tipc_link_put(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100238}
239
Ying Xue2f55c432015-01-09 15:27:00 +0800240static void link_set_timer(struct tipc_link *link, unsigned long time)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100241{
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500242 if (!mod_timer(&link->timer, jiffies + time))
243 tipc_link_get(link);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100244}
245
246/**
Per Liden4323add2006-01-18 00:38:21 +0100247 * tipc_link_create - create a new link
Allan Stephens37b9c082011-02-28 11:32:27 -0500248 * @n_ptr: pointer to associated node
Per Lidenb97bf3f2006-01-02 19:04:38 +0100249 * @b_ptr: pointer to associated bearer
Per Lidenb97bf3f2006-01-02 19:04:38 +0100250 * @media_addr: media address to use when sending messages over link
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900251 *
Per Lidenb97bf3f2006-01-02 19:04:38 +0100252 * Returns pointer to link.
253 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500254struct tipc_link *tipc_link_create(struct tipc_node *n_ptr,
Ying Xuec61dd612014-02-13 17:29:09 -0500255 struct tipc_bearer *b_ptr,
256 const struct tipc_media_addr *media_addr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100257{
Ying Xue34747532015-01-09 15:27:10 +0800258 struct tipc_net *tn = net_generic(n_ptr->net, tipc_net_id);
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500259 struct tipc_link *l_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100260 struct tipc_msg *msg;
261 char *if_name;
Allan Stephens37b9c082011-02-28 11:32:27 -0500262 char addr_string[16];
263 u32 peer = n_ptr->addr;
264
Holger Brunck0372bf52014-11-14 18:33:19 +0100265 if (n_ptr->link_cnt >= MAX_BEARERS) {
Allan Stephens37b9c082011-02-28 11:32:27 -0500266 tipc_addr_string_fill(addr_string, n_ptr->addr);
Holger Brunck0372bf52014-11-14 18:33:19 +0100267 pr_err("Attempt to establish %uth link to %s. Max %u allowed.\n",
268 n_ptr->link_cnt, addr_string, MAX_BEARERS);
Allan Stephens37b9c082011-02-28 11:32:27 -0500269 return NULL;
270 }
271
272 if (n_ptr->links[b_ptr->identity]) {
273 tipc_addr_string_fill(addr_string, n_ptr->addr);
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400274 pr_err("Attempt to establish second link on <%s> to %s\n",
275 b_ptr->name, addr_string);
Allan Stephens37b9c082011-02-28 11:32:27 -0500276 return NULL;
277 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100278
Panagiotis Issaris0da974f2006-07-21 14:51:30 -0700279 l_ptr = kzalloc(sizeof(*l_ptr), GFP_ATOMIC);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100280 if (!l_ptr) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400281 pr_warn("Link creation failed, no memory\n");
Per Lidenb97bf3f2006-01-02 19:04:38 +0100282 return NULL;
283 }
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500284 kref_init(&l_ptr->ref);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100285 l_ptr->addr = peer;
Allan Stephens2d627b92011-01-07 13:00:11 -0500286 if_name = strchr(b_ptr->name, ':') + 1;
Allan Stephens062b4c92011-04-07 09:28:47 -0400287 sprintf(l_ptr->name, "%u.%u.%u:%s-%u.%u.%u:unknown",
Ying Xue34747532015-01-09 15:27:10 +0800288 tipc_zone(tn->own_addr), tipc_cluster(tn->own_addr),
289 tipc_node(tn->own_addr),
Per Lidenb97bf3f2006-01-02 19:04:38 +0100290 if_name,
291 tipc_zone(peer), tipc_cluster(peer), tipc_node(peer));
Allan Stephens062b4c92011-04-07 09:28:47 -0400292 /* note: peer i/f name is updated by reset/activate message */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100293 memcpy(&l_ptr->media_addr, media_addr, sizeof(*media_addr));
Allan Stephens37b9c082011-02-28 11:32:27 -0500294 l_ptr->owner = n_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100295 l_ptr->checkpoint = 1;
Allan Stephensf882cb762011-04-07 09:43:27 -0400296 l_ptr->peer_session = INVALID_SESSION;
Ying Xue7a2f7d12014-04-21 10:55:46 +0800297 l_ptr->bearer_id = b_ptr->identity;
Allan Stephens5c216e12011-10-18 11:34:29 -0400298 link_set_supervision_props(l_ptr, b_ptr->tolerance);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100299 l_ptr->state = RESET_UNKNOWN;
300
301 l_ptr->pmsg = (struct tipc_msg *)&l_ptr->proto_msg;
302 msg = l_ptr->pmsg;
Jon Paul Maloyc5898632015-02-05 08:36:36 -0500303 tipc_msg_init(tn->own_addr, msg, LINK_PROTOCOL, RESET_MSG, INT_H_SIZE,
Ying Xue34747532015-01-09 15:27:10 +0800304 l_ptr->addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100305 msg_set_size(msg, sizeof(l_ptr->proto_msg));
Ying Xuebafa29e2015-01-09 15:27:12 +0800306 msg_set_session(msg, (tn->random & 0xffff));
Per Lidenb97bf3f2006-01-02 19:04:38 +0100307 msg_set_bearer_id(msg, b_ptr->identity);
308 strcpy((char *)msg_data(msg), if_name);
Ying Xue7a2f7d12014-04-21 10:55:46 +0800309 l_ptr->net_plane = b_ptr->net_plane;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100310 link_init_max_pkt(l_ptr);
Jon Paul Maloye3eea1e2015-03-13 16:08:11 -0400311 l_ptr->priority = b_ptr->priority;
312 tipc_link_set_queue_limits(l_ptr, b_ptr->window);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100313
314 l_ptr->next_out_no = 1;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400315 __skb_queue_head_init(&l_ptr->transmq);
316 __skb_queue_head_init(&l_ptr->backlogq);
317 __skb_queue_head_init(&l_ptr->deferdq);
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500318 skb_queue_head_init(&l_ptr->wakeupq);
319 skb_queue_head_init(&l_ptr->inputq);
320 skb_queue_head_init(&l_ptr->namedq);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100321 link_reset_statistics(l_ptr);
Allan Stephens37b9c082011-02-28 11:32:27 -0500322 tipc_node_attach_link(n_ptr, l_ptr);
Ying Xue2f55c432015-01-09 15:27:00 +0800323 setup_timer(&l_ptr->timer, link_timeout, (unsigned long)l_ptr);
Jon Paul Maloy581465f2014-01-07 17:02:44 -0500324 link_state_event(l_ptr, STARTING_EVT);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100325
Per Lidenb97bf3f2006-01-02 19:04:38 +0100326 return l_ptr;
327}
328
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500329/**
330 * link_delete - Conditional deletion of link.
331 * If timer still running, real delete is done when it expires
332 * @link: link to be deleted
333 */
334void tipc_link_delete(struct tipc_link *link)
335{
336 tipc_link_reset_fragments(link);
337 tipc_node_detach_link(link->owner, link);
338 tipc_link_put(link);
339}
340
Ying Xuef2f98002015-01-09 15:27:05 +0800341void tipc_link_delete_list(struct net *net, unsigned int bearer_id,
342 bool shutting_down)
Ying Xue8d8439b2014-02-13 17:29:07 -0500343{
Ying Xuef2f98002015-01-09 15:27:05 +0800344 struct tipc_net *tn = net_generic(net, tipc_net_id);
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500345 struct tipc_link *link;
346 struct tipc_node *node;
Jon Paul Maloy169bf912015-03-10 12:23:34 -0400347 bool del_link;
Ying Xue8d8439b2014-02-13 17:29:07 -0500348
Ying Xue6c7a7622014-03-27 12:54:37 +0800349 rcu_read_lock();
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500350 list_for_each_entry_rcu(node, &tn->node_list, list) {
351 tipc_node_lock(node);
352 link = node->links[bearer_id];
353 if (!link) {
354 tipc_node_unlock(node);
Ying Xuec61dd612014-02-13 17:29:09 -0500355 continue;
356 }
Jon Paul Maloy169bf912015-03-10 12:23:34 -0400357 del_link = !tipc_link_is_up(link) && !link->exp_msg_count;
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500358 tipc_link_reset(link);
359 if (del_timer(&link->timer))
360 tipc_link_put(link);
361 link->flags |= LINK_STOPPED;
362 /* Delete link now, or when failover is finished: */
Jon Paul Maloy169bf912015-03-10 12:23:34 -0400363 if (shutting_down || !tipc_node_is_up(node) || del_link)
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500364 tipc_link_delete(link);
365 tipc_node_unlock(node);
Ying Xue8d8439b2014-02-13 17:29:07 -0500366 }
Ying Xue6c7a7622014-03-27 12:54:37 +0800367 rcu_read_unlock();
Ying Xue8d8439b2014-02-13 17:29:07 -0500368}
Per Lidenb97bf3f2006-01-02 19:04:38 +0100369
370/**
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400371 * link_schedule_user - schedule user for wakeup after congestion
372 * @link: congested link
373 * @oport: sending port
374 * @chain_sz: size of buffer chain that was attempted sent
375 * @imp: importance of message attempted sent
376 * Create pseudo msg to send back to user when congestion abates
Per Lidenb97bf3f2006-01-02 19:04:38 +0100377 */
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400378static bool link_schedule_user(struct tipc_link *link, u32 oport,
379 uint chain_sz, uint imp)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100380{
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400381 struct sk_buff *buf;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100382
Jon Paul Maloyc5898632015-02-05 08:36:36 -0500383 buf = tipc_msg_create(SOCK_WAKEUP, 0, INT_H_SIZE, 0,
384 link_own_addr(link), link_own_addr(link),
385 oport, 0, 0);
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400386 if (!buf)
387 return false;
388 TIPC_SKB_CB(buf)->chain_sz = chain_sz;
389 TIPC_SKB_CB(buf)->chain_imp = imp;
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500390 skb_queue_tail(&link->wakeupq, buf);
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400391 link->stats.link_congs++;
392 return true;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100393}
394
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400395/**
396 * link_prepare_wakeup - prepare users for wakeup after congestion
397 * @link: congested link
398 * Move a number of waiting users, as permitted by available space in
399 * the send queue, from link wait queue to node wait queue for wakeup
400 */
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500401void link_prepare_wakeup(struct tipc_link *link)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100402{
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400403 uint pend_qsz = skb_queue_len(&link->backlogq);
Ying Xue58d78b32014-11-26 11:41:51 +0800404 struct sk_buff *skb, *tmp;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100405
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500406 skb_queue_walk_safe(&link->wakeupq, skb, tmp) {
Ying Xue58d78b32014-11-26 11:41:51 +0800407 if (pend_qsz >= link->queue_limit[TIPC_SKB_CB(skb)->chain_imp])
Per Lidenb97bf3f2006-01-02 19:04:38 +0100408 break;
Ying Xue58d78b32014-11-26 11:41:51 +0800409 pend_qsz += TIPC_SKB_CB(skb)->chain_sz;
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500410 skb_unlink(skb, &link->wakeupq);
411 skb_queue_tail(&link->inputq, skb);
412 link->owner->inputq = &link->inputq;
413 link->owner->action_flags |= TIPC_MSG_EVT;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100414 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100415}
416
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900417/**
Per Liden4323add2006-01-18 00:38:21 +0100418 * tipc_link_reset_fragments - purge link's inbound message fragments queue
Per Lidenb97bf3f2006-01-02 19:04:38 +0100419 * @l_ptr: pointer to link
420 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500421void tipc_link_reset_fragments(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100422{
Jon Paul Maloy37e22162014-05-14 05:39:12 -0400423 kfree_skb(l_ptr->reasm_buf);
424 l_ptr->reasm_buf = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100425}
426
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900427/**
Jon Paul Maloy581465f2014-01-07 17:02:44 -0500428 * tipc_link_purge_queues - purge all pkt queues associated with link
Per Lidenb97bf3f2006-01-02 19:04:38 +0100429 * @l_ptr: pointer to link
430 */
Jon Paul Maloy581465f2014-01-07 17:02:44 -0500431void tipc_link_purge_queues(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100432{
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400433 __skb_queue_purge(&l_ptr->deferdq);
434 __skb_queue_purge(&l_ptr->transmq);
435 __skb_queue_purge(&l_ptr->backlogq);
Per Liden4323add2006-01-18 00:38:21 +0100436 tipc_link_reset_fragments(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100437}
438
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500439void tipc_link_reset(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100440{
Per Lidenb97bf3f2006-01-02 19:04:38 +0100441 u32 prev_state = l_ptr->state;
442 u32 checkpoint = l_ptr->next_in_no;
Allan Stephens5392d642006-06-25 23:52:50 -0700443 int was_active_link = tipc_link_is_active(l_ptr);
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400444 struct tipc_node *owner = l_ptr->owner;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900445
Allan Stephensa686e682008-06-04 17:29:39 -0700446 msg_set_session(l_ptr->pmsg, ((msg_session(l_ptr->pmsg) + 1) & 0xffff));
Per Lidenb97bf3f2006-01-02 19:04:38 +0100447
Allan Stephensa686e682008-06-04 17:29:39 -0700448 /* Link is down, accept any session */
449 l_ptr->peer_session = INVALID_SESSION;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100450
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900451 /* Prepare for max packet size negotiation */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100452 link_init_max_pkt(l_ptr);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900453
Per Lidenb97bf3f2006-01-02 19:04:38 +0100454 l_ptr->state = RESET_UNKNOWN;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100455
456 if ((prev_state == RESET_UNKNOWN) || (prev_state == RESET_RESET))
457 return;
458
Per Liden4323add2006-01-18 00:38:21 +0100459 tipc_node_link_down(l_ptr->owner, l_ptr);
Ying Xue7f9f95d2015-01-09 15:27:06 +0800460 tipc_bearer_remove_dest(owner->net, l_ptr->bearer_id, l_ptr->addr);
Paul Gortmaker7368ddf2010-10-12 14:25:58 +0000461
Jon Paul Maloyb9d4c332014-01-07 17:02:42 -0500462 if (was_active_link && tipc_node_active_links(l_ptr->owner)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100463 l_ptr->reset_checkpoint = checkpoint;
464 l_ptr->exp_msg_count = START_CHANGEOVER;
465 }
466
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500467 /* Clean up all queues, except inputq: */
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400468 __skb_queue_purge(&l_ptr->transmq);
469 __skb_queue_purge(&l_ptr->backlogq);
470 __skb_queue_purge(&l_ptr->deferdq);
Jon Paul Maloye6441ba2015-03-09 16:16:22 -0400471 if (!owner->inputq)
472 owner->inputq = &l_ptr->inputq;
473 skb_queue_splice_init(&l_ptr->wakeupq, owner->inputq);
474 if (!skb_queue_empty(owner->inputq))
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500475 owner->action_flags |= TIPC_MSG_EVT;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400476 l_ptr->rcv_unacked = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100477 l_ptr->checkpoint = 1;
478 l_ptr->next_out_no = 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100479 l_ptr->fsm_msg_cnt = 0;
480 l_ptr->stale_count = 0;
481 link_reset_statistics(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100482}
483
Ying Xuef2f98002015-01-09 15:27:05 +0800484void tipc_link_reset_list(struct net *net, unsigned int bearer_id)
Ying Xuee0ca2c32014-02-13 17:29:06 -0500485{
Ying Xuef2f98002015-01-09 15:27:05 +0800486 struct tipc_net *tn = net_generic(net, tipc_net_id);
Ying Xuee0ca2c32014-02-13 17:29:06 -0500487 struct tipc_link *l_ptr;
Ying Xuec61dd612014-02-13 17:29:09 -0500488 struct tipc_node *n_ptr;
Ying Xuee0ca2c32014-02-13 17:29:06 -0500489
Ying Xue6c7a7622014-03-27 12:54:37 +0800490 rcu_read_lock();
Ying Xuef2f98002015-01-09 15:27:05 +0800491 list_for_each_entry_rcu(n_ptr, &tn->node_list, list) {
Ying Xue5356f3d2014-05-05 08:56:09 +0800492 tipc_node_lock(n_ptr);
Ying Xuec61dd612014-02-13 17:29:09 -0500493 l_ptr = n_ptr->links[bearer_id];
494 if (l_ptr)
495 tipc_link_reset(l_ptr);
Ying Xue5356f3d2014-05-05 08:56:09 +0800496 tipc_node_unlock(n_ptr);
Ying Xuee0ca2c32014-02-13 17:29:06 -0500497 }
Ying Xue6c7a7622014-03-27 12:54:37 +0800498 rcu_read_unlock();
Ying Xuee0ca2c32014-02-13 17:29:06 -0500499}
Per Lidenb97bf3f2006-01-02 19:04:38 +0100500
Ying Xue7f9f95d2015-01-09 15:27:06 +0800501static void link_activate(struct tipc_link *link)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100502{
Ying Xue7f9f95d2015-01-09 15:27:06 +0800503 struct tipc_node *node = link->owner;
504
505 link->next_in_no = 1;
506 link->stats.recv_info = 1;
507 tipc_node_link_up(node, link);
508 tipc_bearer_add_dest(node->net, link->bearer_id, link->addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100509}
510
511/**
512 * link_state_event - link finite state machine
513 * @l_ptr: pointer to link
514 * @event: state machine event to process
515 */
Eric Dumazet95c96172012-04-15 05:58:06 +0000516static void link_state_event(struct tipc_link *l_ptr, unsigned int event)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100517{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500518 struct tipc_link *other;
Ying Xue2f55c432015-01-09 15:27:00 +0800519 unsigned long cont_intv = l_ptr->cont_intv;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100520
Jon Paul Maloy7d339392014-02-13 17:29:16 -0500521 if (l_ptr->flags & LINK_STOPPED)
522 return;
523
Ying Xue135daee2014-02-13 17:29:08 -0500524 if (!(l_ptr->flags & LINK_STARTED) && (event != STARTING_EVT))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100525 return; /* Not yet. */
526
Ying Xue77a7e072013-12-10 20:45:44 -0800527 /* Check whether changeover is going on */
528 if (l_ptr->exp_msg_count) {
Allan Stephensa0168922010-12-31 18:59:35 +0000529 if (event == TIMEOUT_EVT)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100530 link_set_timer(l_ptr, cont_intv);
Ying Xue77a7e072013-12-10 20:45:44 -0800531 return;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100532 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100533
534 switch (l_ptr->state) {
535 case WORKING_WORKING:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100536 switch (event) {
537 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100538 case ACTIVATE_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100539 break;
540 case TIMEOUT_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100541 if (l_ptr->next_in_no != l_ptr->checkpoint) {
542 l_ptr->checkpoint = l_ptr->next_in_no;
Per Liden4323add2006-01-18 00:38:21 +0100543 if (tipc_bclink_acks_missing(l_ptr->owner)) {
Ying Xue247f0f32014-02-18 16:06:46 +0800544 tipc_link_proto_xmit(l_ptr, STATE_MSG,
545 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100546 l_ptr->fsm_msg_cnt++;
547 } else if (l_ptr->max_pkt < l_ptr->max_pkt_target) {
Ying Xue247f0f32014-02-18 16:06:46 +0800548 tipc_link_proto_xmit(l_ptr, STATE_MSG,
549 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100550 l_ptr->fsm_msg_cnt++;
551 }
552 link_set_timer(l_ptr, cont_intv);
553 break;
554 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100555 l_ptr->state = WORKING_UNKNOWN;
556 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800557 tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100558 l_ptr->fsm_msg_cnt++;
559 link_set_timer(l_ptr, cont_intv / 4);
560 break;
561 case RESET_MSG:
Erik Hugne3fa9cac2015-01-22 17:10:31 +0100562 pr_debug("%s<%s>, requested by peer\n",
563 link_rst_msg, l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100564 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100565 l_ptr->state = RESET_RESET;
566 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800567 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
568 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100569 l_ptr->fsm_msg_cnt++;
570 link_set_timer(l_ptr, cont_intv);
571 break;
572 default:
Erik Hugne3fa9cac2015-01-22 17:10:31 +0100573 pr_debug("%s%u in WW state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100574 }
575 break;
576 case WORKING_UNKNOWN:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100577 switch (event) {
578 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100579 case ACTIVATE_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100580 l_ptr->state = WORKING_WORKING;
581 l_ptr->fsm_msg_cnt = 0;
582 link_set_timer(l_ptr, cont_intv);
583 break;
584 case RESET_MSG:
Erik Hugne3fa9cac2015-01-22 17:10:31 +0100585 pr_debug("%s<%s>, requested by peer while probing\n",
586 link_rst_msg, l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100587 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100588 l_ptr->state = RESET_RESET;
589 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800590 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
591 0, 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);
594 break;
595 case TIMEOUT_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100596 if (l_ptr->next_in_no != l_ptr->checkpoint) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100597 l_ptr->state = WORKING_WORKING;
598 l_ptr->fsm_msg_cnt = 0;
599 l_ptr->checkpoint = l_ptr->next_in_no;
Per Liden4323add2006-01-18 00:38:21 +0100600 if (tipc_bclink_acks_missing(l_ptr->owner)) {
Ying Xue247f0f32014-02-18 16:06:46 +0800601 tipc_link_proto_xmit(l_ptr, STATE_MSG,
602 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100603 l_ptr->fsm_msg_cnt++;
604 }
605 link_set_timer(l_ptr, cont_intv);
606 } else if (l_ptr->fsm_msg_cnt < l_ptr->abort_limit) {
Ying Xue247f0f32014-02-18 16:06:46 +0800607 tipc_link_proto_xmit(l_ptr, STATE_MSG,
608 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100609 l_ptr->fsm_msg_cnt++;
610 link_set_timer(l_ptr, cont_intv / 4);
611 } else { /* Link has failed */
Erik Hugne3fa9cac2015-01-22 17:10:31 +0100612 pr_debug("%s<%s>, peer not responding\n",
613 link_rst_msg, l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100614 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100615 l_ptr->state = RESET_UNKNOWN;
616 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800617 tipc_link_proto_xmit(l_ptr, RESET_MSG,
618 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100619 l_ptr->fsm_msg_cnt++;
620 link_set_timer(l_ptr, cont_intv);
621 }
622 break;
623 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400624 pr_err("%s%u in WU state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100625 }
626 break;
627 case RESET_UNKNOWN:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100628 switch (event) {
629 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100630 break;
631 case ACTIVATE_MSG:
632 other = l_ptr->owner->active_links[0];
Allan Stephens8d64a5b2010-12-31 18:59:27 +0000633 if (other && link_working_unknown(other))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100634 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100635 l_ptr->state = WORKING_WORKING;
636 l_ptr->fsm_msg_cnt = 0;
637 link_activate(l_ptr);
Ying Xue247f0f32014-02-18 16:06:46 +0800638 tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100639 l_ptr->fsm_msg_cnt++;
Jon Maloyc64f7a62012-11-16 13:51:31 +0800640 if (l_ptr->owner->working_links == 1)
Ying Xue247f0f32014-02-18 16:06:46 +0800641 tipc_link_sync_xmit(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100642 link_set_timer(l_ptr, cont_intv);
643 break;
644 case RESET_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100645 l_ptr->state = RESET_RESET;
646 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800647 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
648 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100649 l_ptr->fsm_msg_cnt++;
650 link_set_timer(l_ptr, cont_intv);
651 break;
652 case STARTING_EVT:
Ying Xue135daee2014-02-13 17:29:08 -0500653 l_ptr->flags |= LINK_STARTED;
Jon Paul Maloyaf9946f2015-02-03 08:59:20 -0500654 l_ptr->fsm_msg_cnt++;
655 link_set_timer(l_ptr, cont_intv);
656 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100657 case TIMEOUT_EVT:
Ying Xue247f0f32014-02-18 16:06:46 +0800658 tipc_link_proto_xmit(l_ptr, RESET_MSG, 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100659 l_ptr->fsm_msg_cnt++;
660 link_set_timer(l_ptr, cont_intv);
661 break;
662 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400663 pr_err("%s%u in RU state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100664 }
665 break;
666 case RESET_RESET:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100667 switch (event) {
668 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100669 case ACTIVATE_MSG:
670 other = l_ptr->owner->active_links[0];
Allan Stephens8d64a5b2010-12-31 18:59:27 +0000671 if (other && link_working_unknown(other))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100672 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100673 l_ptr->state = WORKING_WORKING;
674 l_ptr->fsm_msg_cnt = 0;
675 link_activate(l_ptr);
Ying Xue247f0f32014-02-18 16:06:46 +0800676 tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100677 l_ptr->fsm_msg_cnt++;
Jon Maloyc64f7a62012-11-16 13:51:31 +0800678 if (l_ptr->owner->working_links == 1)
Ying Xue247f0f32014-02-18 16:06:46 +0800679 tipc_link_sync_xmit(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100680 link_set_timer(l_ptr, cont_intv);
681 break;
682 case RESET_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100683 break;
684 case TIMEOUT_EVT:
Ying Xue247f0f32014-02-18 16:06:46 +0800685 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
686 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100687 l_ptr->fsm_msg_cnt++;
688 link_set_timer(l_ptr, cont_intv);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100689 break;
690 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400691 pr_err("%s%u in RR state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100692 }
693 break;
694 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400695 pr_err("Unknown link state %u/%u\n", l_ptr->state, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100696 }
697}
698
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500699/* tipc_link_cong: determine return value and how to treat the
700 * sent buffer during link congestion.
701 * - For plain, errorless user data messages we keep the buffer and
702 * return -ELINKONG.
703 * - For all other messages we discard the buffer and return -EHOSTUNREACH
704 * - For TIPC internal messages we also reset the link
705 */
Ying Xuea6ca1092014-11-26 11:41:55 +0800706static int tipc_link_cong(struct tipc_link *link, struct sk_buff_head *list)
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500707{
Ying Xuea6ca1092014-11-26 11:41:55 +0800708 struct sk_buff *skb = skb_peek(list);
709 struct tipc_msg *msg = buf_msg(skb);
Jon Paul Maloye3eea1e2015-03-13 16:08:11 -0400710 int imp = msg_importance(msg);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500711 u32 oport = msg_tot_origport(msg);
712
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400713 if (unlikely(imp > TIPC_CRITICAL_IMPORTANCE)) {
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500714 pr_warn("%s<%s>, send queue full", link_rst_msg, link->name);
715 tipc_link_reset(link);
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400716 goto drop;
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500717 }
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400718 if (unlikely(msg_errcode(msg)))
719 goto drop;
720 if (unlikely(msg_reroute_cnt(msg)))
721 goto drop;
Ying Xuea6ca1092014-11-26 11:41:55 +0800722 if (TIPC_SKB_CB(skb)->wakeup_pending)
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400723 return -ELINKCONG;
Ying Xuea6ca1092014-11-26 11:41:55 +0800724 if (link_schedule_user(link, oport, skb_queue_len(list), imp))
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400725 return -ELINKCONG;
726drop:
Ying Xuea6ca1092014-11-26 11:41:55 +0800727 __skb_queue_purge(list);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500728 return -EHOSTUNREACH;
729}
730
731/**
Jon Paul Maloy9fbfb8b2014-07-16 20:41:03 -0400732 * __tipc_link_xmit(): same as tipc_link_xmit, but destlink is known & locked
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500733 * @link: link to use
Ying Xuea6ca1092014-11-26 11:41:55 +0800734 * @list: chain of buffers containing message
735 *
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500736 * Consumes the buffer chain, except when returning -ELINKCONG
737 * Returns 0 if success, otherwise errno: -ELINKCONG, -EMSGSIZE (plain socket
738 * user data messages) or -EHOSTUNREACH (all other messages/senders)
739 * Only the socket functions tipc_send_stream() and tipc_send_packet() need
740 * to act on the return value, since they may need to do more send attempts.
741 */
Ying Xue7f9f95d2015-01-09 15:27:06 +0800742int __tipc_link_xmit(struct net *net, struct tipc_link *link,
743 struct sk_buff_head *list)
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500744{
Ying Xuea6ca1092014-11-26 11:41:55 +0800745 struct tipc_msg *msg = buf_msg(skb_peek(list));
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400746 unsigned int maxwin = link->window;
Jon Paul Maloye3eea1e2015-03-13 16:08:11 -0400747 unsigned int imp = msg_importance(msg);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500748 uint mtu = link->max_pkt;
749 uint ack = mod(link->next_in_no - 1);
750 uint seqno = link->next_out_no;
751 uint bc_last_in = link->owner->bclink.last_in;
752 struct tipc_media_addr *addr = &link->media_addr;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400753 struct sk_buff_head *transmq = &link->transmq;
754 struct sk_buff_head *backlogq = &link->backlogq;
Ying Xuea6ca1092014-11-26 11:41:55 +0800755 struct sk_buff *skb, *tmp;
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500756
Jon Paul Maloye3eea1e2015-03-13 16:08:11 -0400757 /* Match queue limit against msg importance: */
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400758 if (unlikely(skb_queue_len(backlogq) >= link->queue_limit[imp]))
Ying Xuea6ca1092014-11-26 11:41:55 +0800759 return tipc_link_cong(link, list);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500760
761 /* Has valid packet limit been used ? */
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 }
766
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400767 /* Prepare each packet for sending, and add to relevant queue: */
Ying Xuea6ca1092014-11-26 11:41:55 +0800768 skb_queue_walk_safe(list, skb, tmp) {
769 __skb_unlink(skb, list);
Ying Xue58dc55f2014-11-26 11:41:52 +0800770 msg = buf_msg(skb);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400771 msg_set_seqno(msg, seqno);
772 msg_set_ack(msg, ack);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500773 msg_set_bcast_ack(msg, bc_last_in);
774
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400775 if (likely(skb_queue_len(transmq) < maxwin)) {
776 __skb_queue_tail(transmq, skb);
777 tipc_bearer_send(net, link->bearer_id, skb, addr);
778 link->rcv_unacked = 0;
779 seqno++;
780 continue;
781 }
782 if (tipc_msg_bundle(skb_peek_tail(backlogq), skb, mtu)) {
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500783 link->stats.sent_bundled++;
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500784 continue;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400785 }
786 if (tipc_msg_make_bundle(&skb, mtu, link->addr)) {
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500787 link->stats.sent_bundled++;
788 link->stats.sent_bundles++;
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 Maloy4f1688b2014-06-25 20:41:32 -0500791 seqno++;
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500792 }
793 link->next_out_no = seqno;
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500794 return 0;
795}
796
Ying Xuea6ca1092014-11-26 11:41:55 +0800797static void skb2list(struct sk_buff *skb, struct sk_buff_head *list)
798{
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500799 skb_queue_head_init(list);
Ying Xuea6ca1092014-11-26 11:41:55 +0800800 __skb_queue_tail(list, skb);
801}
802
803static int __tipc_link_xmit_skb(struct tipc_link *link, struct sk_buff *skb)
804{
805 struct sk_buff_head head;
806
807 skb2list(skb, &head);
Ying Xue7f9f95d2015-01-09 15:27:06 +0800808 return __tipc_link_xmit(link->owner->net, link, &head);
Ying Xuea6ca1092014-11-26 11:41:55 +0800809}
810
Ying Xuef2f98002015-01-09 15:27:05 +0800811int tipc_link_xmit_skb(struct net *net, struct sk_buff *skb, u32 dnode,
812 u32 selector)
Ying Xuea6ca1092014-11-26 11:41:55 +0800813{
814 struct sk_buff_head head;
815
816 skb2list(skb, &head);
Ying Xuef2f98002015-01-09 15:27:05 +0800817 return tipc_link_xmit(net, &head, dnode, selector);
Ying Xuea6ca1092014-11-26 11:41:55 +0800818}
819
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500820/**
Jon Paul Maloy9fbfb8b2014-07-16 20:41:03 -0400821 * tipc_link_xmit() is the general link level function for message sending
Ying Xuef2f98002015-01-09 15:27:05 +0800822 * @net: the applicable net namespace
Ying Xuea6ca1092014-11-26 11:41:55 +0800823 * @list: chain of buffers containing message
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500824 * @dsz: amount of user data to be sent
825 * @dnode: address of destination node
826 * @selector: a number used for deterministic link selection
827 * Consumes the buffer chain, except when returning -ELINKCONG
828 * Returns 0 if success, otherwise errno: -ELINKCONG,-EHOSTUNREACH,-EMSGSIZE
829 */
Ying Xuef2f98002015-01-09 15:27:05 +0800830int tipc_link_xmit(struct net *net, struct sk_buff_head *list, u32 dnode,
831 u32 selector)
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500832{
833 struct tipc_link *link = NULL;
834 struct tipc_node *node;
835 int rc = -EHOSTUNREACH;
836
Ying Xuef2f98002015-01-09 15:27:05 +0800837 node = tipc_node_find(net, dnode);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500838 if (node) {
839 tipc_node_lock(node);
840 link = node->active_links[selector & 1];
841 if (link)
Ying Xue7f9f95d2015-01-09 15:27:06 +0800842 rc = __tipc_link_xmit(net, link, list);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500843 tipc_node_unlock(node);
844 }
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500845 if (link)
846 return rc;
847
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500848 if (likely(in_own_node(net, dnode)))
849 return tipc_sk_rcv(net, list);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500850
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500851 __skb_queue_purge(list);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500852 return rc;
853}
854
Jon Maloyc64f7a62012-11-16 13:51:31 +0800855/*
Ying Xue247f0f32014-02-18 16:06:46 +0800856 * tipc_link_sync_xmit - synchronize broadcast link endpoints.
Jon Maloyc64f7a62012-11-16 13:51:31 +0800857 *
858 * Give a newly added peer node the sequence number where it should
859 * start receiving and acking broadcast packets.
860 *
861 * Called with node locked
862 */
Jon Paul Maloy25b660c2014-07-16 20:40:59 -0400863static void tipc_link_sync_xmit(struct tipc_link *link)
Jon Maloyc64f7a62012-11-16 13:51:31 +0800864{
Ying Xuea6ca1092014-11-26 11:41:55 +0800865 struct sk_buff *skb;
Jon Maloyc64f7a62012-11-16 13:51:31 +0800866 struct tipc_msg *msg;
867
Ying Xuea6ca1092014-11-26 11:41:55 +0800868 skb = tipc_buf_acquire(INT_H_SIZE);
869 if (!skb)
Jon Maloyc64f7a62012-11-16 13:51:31 +0800870 return;
871
Ying Xuea6ca1092014-11-26 11:41:55 +0800872 msg = buf_msg(skb);
Jon Paul Maloyc5898632015-02-05 08:36:36 -0500873 tipc_msg_init(link_own_addr(link), msg, BCAST_PROTOCOL, STATE_MSG,
Ying Xue34747532015-01-09 15:27:10 +0800874 INT_H_SIZE, link->addr);
Jon Paul Maloy25b660c2014-07-16 20:40:59 -0400875 msg_set_last_bcast(msg, link->owner->bclink.acked);
Ying Xuea6ca1092014-11-26 11:41:55 +0800876 __tipc_link_xmit_skb(link, skb);
Jon Maloyc64f7a62012-11-16 13:51:31 +0800877}
878
879/*
Ying Xue247f0f32014-02-18 16:06:46 +0800880 * tipc_link_sync_rcv - synchronize broadcast link endpoints.
Jon Maloyc64f7a62012-11-16 13:51:31 +0800881 * Receive the sequence number where we should start receiving and
882 * acking broadcast packets from a newly added peer node, and open
883 * up for reception of such packets.
884 *
885 * Called with node locked
886 */
Ying Xue247f0f32014-02-18 16:06:46 +0800887static void tipc_link_sync_rcv(struct tipc_node *n, struct sk_buff *buf)
Jon Maloyc64f7a62012-11-16 13:51:31 +0800888{
889 struct tipc_msg *msg = buf_msg(buf);
890
891 n->bclink.last_sent = n->bclink.last_in = msg_last_bcast(msg);
892 n->bclink.recv_permitted = true;
893 kfree_skb(buf);
894}
895
896/*
Ying Xue47b4c9a2014-11-26 11:41:48 +0800897 * tipc_link_push_packets - push unsent packets to bearer
898 *
899 * Push out the unsent messages of a link where congestion
900 * has abated. Node is locked.
901 *
902 * Called with node locked
Per Lidenb97bf3f2006-01-02 19:04:38 +0100903 */
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400904void tipc_link_push_packets(struct tipc_link *link)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100905{
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400906 struct sk_buff *skb;
Ying Xue47b4c9a2014-11-26 11:41:48 +0800907 struct tipc_msg *msg;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400908 unsigned int ack = mod(link->next_in_no - 1);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100909
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400910 while (skb_queue_len(&link->transmq) < link->window) {
911 skb = __skb_dequeue(&link->backlogq);
912 if (!skb)
Ying Xue47b4c9a2014-11-26 11:41:48 +0800913 break;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400914 msg = buf_msg(skb);
915 msg_set_ack(msg, ack);
916 msg_set_bcast_ack(msg, link->owner->bclink.last_in);
917 link->rcv_unacked = 0;
918 __skb_queue_tail(&link->transmq, skb);
919 tipc_bearer_send(link->owner->net, link->bearer_id,
920 skb, &link->media_addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100921 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100922}
923
Ying Xue3f5a12b2014-05-05 08:56:17 +0800924void tipc_link_reset_all(struct tipc_node *node)
Allan Stephensd356eeb2006-06-25 23:40:01 -0700925{
Allan Stephensd356eeb2006-06-25 23:40:01 -0700926 char addr_string[16];
927 u32 i;
928
Ying Xue3f5a12b2014-05-05 08:56:17 +0800929 tipc_node_lock(node);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700930
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400931 pr_warn("Resetting all links to %s\n",
Ying Xue3f5a12b2014-05-05 08:56:17 +0800932 tipc_addr_string_fill(addr_string, node->addr));
Allan Stephensd356eeb2006-06-25 23:40:01 -0700933
934 for (i = 0; i < MAX_BEARERS; i++) {
Ying Xue3f5a12b2014-05-05 08:56:17 +0800935 if (node->links[i]) {
936 link_print(node->links[i], "Resetting link\n");
937 tipc_link_reset(node->links[i]);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700938 }
939 }
940
Ying Xue3f5a12b2014-05-05 08:56:17 +0800941 tipc_node_unlock(node);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700942}
943
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500944static void link_retransmit_failure(struct tipc_link *l_ptr,
Paul Gortmakerae8509c2013-06-17 10:54:47 -0400945 struct sk_buff *buf)
Allan Stephensd356eeb2006-06-25 23:40:01 -0700946{
947 struct tipc_msg *msg = buf_msg(buf);
Ying Xue1da46562015-01-09 15:27:07 +0800948 struct net *net = l_ptr->owner->net;
Allan Stephensd356eeb2006-06-25 23:40:01 -0700949
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400950 pr_warn("Retransmission failure on link <%s>\n", l_ptr->name);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700951
952 if (l_ptr->addr) {
Allan Stephensd356eeb2006-06-25 23:40:01 -0700953 /* Handle failure on standard link */
Allan Stephens8d64a5b2010-12-31 18:59:27 +0000954 link_print(l_ptr, "Resetting link\n");
Allan Stephensd356eeb2006-06-25 23:40:01 -0700955 tipc_link_reset(l_ptr);
956
957 } else {
Allan Stephensd356eeb2006-06-25 23:40:01 -0700958 /* Handle failure on broadcast link */
David S. Miller6c000552008-09-02 23:38:32 -0700959 struct tipc_node *n_ptr;
Allan Stephensd356eeb2006-06-25 23:40:01 -0700960 char addr_string[16];
961
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400962 pr_info("Msg seq number: %u, ", msg_seqno(msg));
963 pr_cont("Outstanding acks: %lu\n",
964 (unsigned long) TIPC_SKB_CB(buf)->handle);
Jeff Garzik617dbea2006-10-03 16:25:34 -0700965
Ying Xue1da46562015-01-09 15:27:07 +0800966 n_ptr = tipc_bclink_retransmit_to(net);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700967 tipc_node_lock(n_ptr);
968
Allan Stephensc68ca7b2010-05-11 14:30:12 +0000969 tipc_addr_string_fill(addr_string, n_ptr->addr);
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400970 pr_info("Broadcast link info for %s\n", addr_string);
Ying Xue389dd9b2012-11-16 13:51:30 +0800971 pr_info("Reception permitted: %d, Acked: %u\n",
972 n_ptr->bclink.recv_permitted,
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400973 n_ptr->bclink.acked);
974 pr_info("Last in: %u, Oos state: %u, Last sent: %u\n",
975 n_ptr->bclink.last_in,
976 n_ptr->bclink.oos_state,
977 n_ptr->bclink.last_sent);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700978
Allan Stephensd356eeb2006-06-25 23:40:01 -0700979 tipc_node_unlock(n_ptr);
980
Ying Xue1da46562015-01-09 15:27:07 +0800981 tipc_bclink_set_flags(net, TIPC_BCLINK_RESET);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700982 l_ptr->stale_count = 0;
983 }
984}
985
Ying Xue58dc55f2014-11-26 11:41:52 +0800986void tipc_link_retransmit(struct tipc_link *l_ptr, struct sk_buff *skb,
Per Liden4323add2006-01-18 00:38:21 +0100987 u32 retransmits)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100988{
989 struct tipc_msg *msg;
990
Ying Xue58dc55f2014-11-26 11:41:52 +0800991 if (!skb)
Allan Stephensd356eeb2006-06-25 23:40:01 -0700992 return;
993
Ying Xue58dc55f2014-11-26 11:41:52 +0800994 msg = buf_msg(skb);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900995
Erik Hugne512137e2013-12-06 10:08:00 -0500996 /* Detect repeated retransmit failures */
997 if (l_ptr->last_retransmitted == msg_seqno(msg)) {
998 if (++l_ptr->stale_count > 100) {
Ying Xue58dc55f2014-11-26 11:41:52 +0800999 link_retransmit_failure(l_ptr, skb);
Erik Hugne512137e2013-12-06 10:08:00 -05001000 return;
Allan Stephensd356eeb2006-06-25 23:40:01 -07001001 }
1002 } else {
Erik Hugne512137e2013-12-06 10:08:00 -05001003 l_ptr->last_retransmitted = msg_seqno(msg);
1004 l_ptr->stale_count = 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001005 }
Allan Stephensd356eeb2006-06-25 23:40:01 -07001006
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001007 skb_queue_walk_from(&l_ptr->transmq, skb) {
1008 if (!retransmits)
Ying Xue58dc55f2014-11-26 11:41:52 +08001009 break;
1010 msg = buf_msg(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001011 msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001012 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Ying Xue7f9f95d2015-01-09 15:27:06 +08001013 tipc_bearer_send(l_ptr->owner->net, l_ptr->bearer_id, skb,
1014 &l_ptr->media_addr);
Ying Xue3c294cb2012-11-15 11:34:45 +08001015 retransmits--;
1016 l_ptr->stats.retransmitted++;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001017 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001018}
1019
Ying Xuef03273f2014-11-26 11:41:54 +08001020static void link_retrieve_defq(struct tipc_link *link,
1021 struct sk_buff_head *list)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001022{
1023 u32 seq_no;
1024
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001025 if (skb_queue_empty(&link->deferdq))
Ying Xuef03273f2014-11-26 11:41:54 +08001026 return;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001027
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001028 seq_no = buf_seqno(skb_peek(&link->deferdq));
Ying Xuef03273f2014-11-26 11:41:54 +08001029 if (seq_no == mod(link->next_in_no))
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001030 skb_queue_splice_tail_init(&link->deferdq, list);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001031}
1032
Allan Stephens85035562008-04-15 19:04:54 -07001033/**
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001034 * tipc_rcv - process TIPC packets/messages arriving from off-node
Ying Xuef2f98002015-01-09 15:27:05 +08001035 * @net: the applicable net namespace
Ying Xuef03273f2014-11-26 11:41:54 +08001036 * @skb: TIPC packet
Ying Xue7a2f7d12014-04-21 10:55:46 +08001037 * @b_ptr: pointer to bearer message arrived on
Allan Stephensb02b69c2010-08-17 11:00:07 +00001038 *
1039 * Invoked with no locks held. Bearer pointer must point to a valid bearer
1040 * structure (i.e. cannot be NULL), but bearer can be inactive.
1041 */
Ying Xuec93d3ba2015-01-09 15:27:04 +08001042void tipc_rcv(struct net *net, struct sk_buff *skb, struct tipc_bearer *b_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001043{
Ying Xue34747532015-01-09 15:27:10 +08001044 struct tipc_net *tn = net_generic(net, tipc_net_id);
Ying Xuef03273f2014-11-26 11:41:54 +08001045 struct sk_buff_head head;
1046 struct tipc_node *n_ptr;
1047 struct tipc_link *l_ptr;
1048 struct sk_buff *skb1, *tmp;
1049 struct tipc_msg *msg;
1050 u32 seq_no;
1051 u32 ackd;
1052 u32 released;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001053
Ying Xuea6ca1092014-11-26 11:41:55 +08001054 skb2list(skb, &head);
Allan Stephens85035562008-04-15 19:04:54 -07001055
Ying Xuef03273f2014-11-26 11:41:54 +08001056 while ((skb = __skb_dequeue(&head))) {
Allan Stephens85035562008-04-15 19:04:54 -07001057 /* Ensure message is well-formed */
Jon Paul Maloycf2157f2015-03-13 16:08:06 -04001058 if (unlikely(!tipc_msg_validate(skb)))
Ying Xue3af390e2013-10-30 11:26:57 +08001059 goto discard;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001060
Allan Stephens85035562008-04-15 19:04:54 -07001061 /* Handle arrival of a non-unicast link message */
Ying Xuef03273f2014-11-26 11:41:54 +08001062 msg = buf_msg(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001063 if (unlikely(msg_non_seq(msg))) {
Allan Stephens1265a022008-06-04 17:32:35 -07001064 if (msg_user(msg) == LINK_CONFIG)
Ying Xuec93d3ba2015-01-09 15:27:04 +08001065 tipc_disc_rcv(net, skb, b_ptr);
Allan Stephens1265a022008-06-04 17:32:35 -07001066 else
Ying Xuec93d3ba2015-01-09 15:27:04 +08001067 tipc_bclink_rcv(net, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001068 continue;
1069 }
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001070
Allan Stephensed33a9c2011-04-05 15:15:04 -04001071 /* Discard unicast link messages destined for another node */
Allan Stephens26008242006-06-25 23:39:31 -07001072 if (unlikely(!msg_short(msg) &&
Ying Xue34747532015-01-09 15:27:10 +08001073 (msg_destnode(msg) != tn->own_addr)))
Ying Xue3af390e2013-10-30 11:26:57 +08001074 goto discard;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001075
Allan Stephens5a68d5e2010-08-17 11:00:16 +00001076 /* Locate neighboring node that sent message */
Ying Xuef2f98002015-01-09 15:27:05 +08001077 n_ptr = tipc_node_find(net, msg_prevnode(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001078 if (unlikely(!n_ptr))
Ying Xue3af390e2013-10-30 11:26:57 +08001079 goto discard;
Per Liden4323add2006-01-18 00:38:21 +01001080 tipc_node_lock(n_ptr);
Allan Stephens85035562008-04-15 19:04:54 -07001081
Allan Stephens5a68d5e2010-08-17 11:00:16 +00001082 /* Locate unicast link endpoint that should handle message */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001083 l_ptr = n_ptr->links[b_ptr->identity];
Ying Xue3af390e2013-10-30 11:26:57 +08001084 if (unlikely(!l_ptr))
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001085 goto unlock;
Allan Stephens85035562008-04-15 19:04:54 -07001086
Allan Stephensb4b56102011-05-27 11:00:51 -04001087 /* Verify that communication with node is currently allowed */
Ying Xueaecb9bb2014-05-08 08:54:39 +08001088 if ((n_ptr->action_flags & TIPC_WAIT_PEER_LINKS_DOWN) &&
Ying Xue10f465c2014-05-05 08:56:11 +08001089 msg_user(msg) == LINK_PROTOCOL &&
1090 (msg_type(msg) == RESET_MSG ||
1091 msg_type(msg) == ACTIVATE_MSG) &&
1092 !msg_redundant_link(msg))
Ying Xueaecb9bb2014-05-08 08:54:39 +08001093 n_ptr->action_flags &= ~TIPC_WAIT_PEER_LINKS_DOWN;
Allan Stephensb4b56102011-05-27 11:00:51 -04001094
Ying Xue10f465c2014-05-05 08:56:11 +08001095 if (tipc_node_blocked(n_ptr))
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001096 goto unlock;
Allan Stephensb4b56102011-05-27 11:00:51 -04001097
Allan Stephens85035562008-04-15 19:04:54 -07001098 /* Validate message sequence number info */
Allan Stephens85035562008-04-15 19:04:54 -07001099 seq_no = msg_seqno(msg);
1100 ackd = msg_ack(msg);
1101
1102 /* Release acked messages */
Jon Paul Maloy2cdf3912015-03-13 16:08:09 -04001103 if (unlikely(n_ptr->bclink.acked != msg_bcast_ack(msg)))
Allan Stephens365595912011-10-24 15:26:24 -04001104 tipc_bclink_acknowledge(n_ptr, msg_bcast_ack(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001105
Ying Xue58dc55f2014-11-26 11:41:52 +08001106 released = 0;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001107 skb_queue_walk_safe(&l_ptr->transmq, skb1, tmp) {
1108 if (more(buf_seqno(skb1), ackd))
Ying Xue58dc55f2014-11-26 11:41:52 +08001109 break;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001110 __skb_unlink(skb1, &l_ptr->transmq);
Ying Xue58dc55f2014-11-26 11:41:52 +08001111 kfree_skb(skb1);
1112 released = 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001113 }
Allan Stephens85035562008-04-15 19:04:54 -07001114
1115 /* Try sending any messages link endpoint has pending */
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001116 if (unlikely(skb_queue_len(&l_ptr->backlogq)))
Ying Xue47b4c9a2014-11-26 11:41:48 +08001117 tipc_link_push_packets(l_ptr);
Jon Paul Maloya5377832014-02-13 17:29:15 -05001118
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001119 if (released && !skb_queue_empty(&l_ptr->wakeupq))
Jon Paul Maloy50100a52014-08-22 18:09:07 -04001120 link_prepare_wakeup(l_ptr);
Jon Paul Maloya5377832014-02-13 17:29:15 -05001121
Jon Paul Maloya5377832014-02-13 17:29:15 -05001122 /* Process the incoming packet */
Ying Xue3af390e2013-10-30 11:26:57 +08001123 if (unlikely(!link_working_working(l_ptr))) {
1124 if (msg_user(msg) == LINK_PROTOCOL) {
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001125 tipc_link_proto_rcv(l_ptr, skb);
Ying Xuef03273f2014-11-26 11:41:54 +08001126 link_retrieve_defq(l_ptr, &head);
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001127 skb = NULL;
1128 goto unlock;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001129 }
Ying Xue3af390e2013-10-30 11:26:57 +08001130
1131 /* Traffic message. Conditionally activate link */
1132 link_state_event(l_ptr, TRAFFIC_MSG_EVT);
1133
1134 if (link_working_working(l_ptr)) {
1135 /* Re-insert buffer in front of queue */
Ying Xuef03273f2014-11-26 11:41:54 +08001136 __skb_queue_head(&head, skb);
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001137 skb = NULL;
1138 goto unlock;
Ying Xue3af390e2013-10-30 11:26:57 +08001139 }
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001140 goto unlock;
Ying Xue3af390e2013-10-30 11:26:57 +08001141 }
1142
1143 /* Link is now in state WORKING_WORKING */
1144 if (unlikely(seq_no != mod(l_ptr->next_in_no))) {
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001145 link_handle_out_of_seq_msg(l_ptr, skb);
Ying Xuef03273f2014-11-26 11:41:54 +08001146 link_retrieve_defq(l_ptr, &head);
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001147 skb = NULL;
1148 goto unlock;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001149 }
Ying Xue3af390e2013-10-30 11:26:57 +08001150 l_ptr->next_in_no++;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001151 if (unlikely(!skb_queue_empty(&l_ptr->deferdq)))
Ying Xuef03273f2014-11-26 11:41:54 +08001152 link_retrieve_defq(l_ptr, &head);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001153 if (unlikely(++l_ptr->rcv_unacked >= TIPC_MIN_LINK_WIN)) {
Erik Hugne3f53bd82014-07-01 10:22:41 +02001154 l_ptr->stats.sent_acks++;
1155 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0, 0, 0, 0);
1156 }
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001157 tipc_link_input(l_ptr, skb);
1158 skb = NULL;
1159unlock:
Ying Xue3af390e2013-10-30 11:26:57 +08001160 tipc_node_unlock(n_ptr);
1161discard:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001162 if (unlikely(skb))
1163 kfree_skb(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001164 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001165}
1166
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001167/* tipc_data_input - deliver data and name distr msgs to upper layer
Erik Hugne7ae934b2014-07-01 10:22:40 +02001168 *
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001169 * Consumes buffer if message is of right type
Erik Hugne7ae934b2014-07-01 10:22:40 +02001170 * Node lock must be held
1171 */
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001172static bool tipc_data_input(struct tipc_link *link, struct sk_buff *skb)
Erik Hugne7ae934b2014-07-01 10:22:40 +02001173{
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001174 struct tipc_node *node = link->owner;
1175 struct tipc_msg *msg = buf_msg(skb);
1176 u32 dport = msg_destport(msg);
Erik Hugne7ae934b2014-07-01 10:22:40 +02001177
1178 switch (msg_user(msg)) {
1179 case TIPC_LOW_IMPORTANCE:
1180 case TIPC_MEDIUM_IMPORTANCE:
1181 case TIPC_HIGH_IMPORTANCE:
1182 case TIPC_CRITICAL_IMPORTANCE:
1183 case CONN_MANAGER:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001184 if (tipc_skb_queue_tail(&link->inputq, skb, dport)) {
1185 node->inputq = &link->inputq;
1186 node->action_flags |= TIPC_MSG_EVT;
1187 }
1188 return true;
Erik Hugne7ae934b2014-07-01 10:22:40 +02001189 case NAME_DISTRIBUTOR:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001190 node->bclink.recv_permitted = true;
1191 node->namedq = &link->namedq;
1192 skb_queue_tail(&link->namedq, skb);
1193 if (skb_queue_len(&link->namedq) == 1)
1194 node->action_flags |= TIPC_NAMED_MSG_EVT;
1195 return true;
Erik Hugne7ae934b2014-07-01 10:22:40 +02001196 case MSG_BUNDLER:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001197 case CHANGEOVER_PROTOCOL:
1198 case MSG_FRAGMENTER:
1199 case BCAST_PROTOCOL:
1200 return false;
1201 default:
1202 pr_warn("Dropping received illegal msg type\n");
1203 kfree_skb(skb);
1204 return false;
1205 };
1206}
1207
1208/* tipc_link_input - process packet that has passed link protocol check
1209 *
1210 * Consumes buffer
1211 * Node lock must be held
1212 */
1213static void tipc_link_input(struct tipc_link *link, struct sk_buff *skb)
1214{
1215 struct tipc_node *node = link->owner;
1216 struct tipc_msg *msg = buf_msg(skb);
1217 struct sk_buff *iskb;
1218 int pos = 0;
1219
1220 if (likely(tipc_data_input(link, skb)))
1221 return;
1222
1223 switch (msg_user(msg)) {
1224 case CHANGEOVER_PROTOCOL:
1225 if (!tipc_link_tunnel_rcv(node, &skb))
1226 break;
1227 if (msg_user(buf_msg(skb)) != MSG_BUNDLER) {
1228 tipc_data_input(link, skb);
1229 break;
1230 }
1231 case MSG_BUNDLER:
1232 link->stats.recv_bundles++;
1233 link->stats.recv_bundled += msg_msgcnt(msg);
1234
1235 while (tipc_msg_extract(skb, &iskb, &pos))
1236 tipc_data_input(link, iskb);
1237 break;
1238 case MSG_FRAGMENTER:
1239 link->stats.recv_fragments++;
1240 if (tipc_buf_append(&link->reasm_buf, &skb)) {
1241 link->stats.recv_fragmented++;
1242 tipc_data_input(link, skb);
1243 } else if (!link->reasm_buf) {
1244 tipc_link_reset(link);
1245 }
1246 break;
1247 case BCAST_PROTOCOL:
1248 tipc_link_sync_rcv(node, skb);
Erik Hugne7ae934b2014-07-01 10:22:40 +02001249 break;
1250 default:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001251 break;
1252 };
Erik Hugne7ae934b2014-07-01 10:22:40 +02001253}
1254
1255/**
Allan Stephens8809b252011-10-25 10:44:35 -04001256 * tipc_link_defer_pkt - Add out-of-sequence message to deferred reception queue
1257 *
1258 * Returns increase in queue length (i.e. 0 or 1)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001259 */
Ying Xuebc6fecd2014-11-26 11:41:53 +08001260u32 tipc_link_defer_pkt(struct sk_buff_head *list, struct sk_buff *skb)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001261{
Ying Xuebc6fecd2014-11-26 11:41:53 +08001262 struct sk_buff *skb1;
1263 u32 seq_no = buf_seqno(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001264
1265 /* Empty queue ? */
Ying Xuebc6fecd2014-11-26 11:41:53 +08001266 if (skb_queue_empty(list)) {
1267 __skb_queue_tail(list, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001268 return 1;
1269 }
1270
1271 /* Last ? */
Ying Xuebc6fecd2014-11-26 11:41:53 +08001272 if (less(buf_seqno(skb_peek_tail(list)), seq_no)) {
1273 __skb_queue_tail(list, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001274 return 1;
1275 }
1276
Allan Stephens8809b252011-10-25 10:44:35 -04001277 /* Locate insertion point in queue, then insert; discard if duplicate */
Ying Xuebc6fecd2014-11-26 11:41:53 +08001278 skb_queue_walk(list, skb1) {
1279 u32 curr_seqno = buf_seqno(skb1);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001280
Allan Stephens8809b252011-10-25 10:44:35 -04001281 if (seq_no == curr_seqno) {
Ying Xuebc6fecd2014-11-26 11:41:53 +08001282 kfree_skb(skb);
Allan Stephens8809b252011-10-25 10:44:35 -04001283 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001284 }
Allan Stephens8809b252011-10-25 10:44:35 -04001285
1286 if (less(seq_no, curr_seqno))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001287 break;
Allan Stephens8809b252011-10-25 10:44:35 -04001288 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001289
Ying Xuebc6fecd2014-11-26 11:41:53 +08001290 __skb_queue_before(list, skb1, skb);
Allan Stephens8809b252011-10-25 10:44:35 -04001291 return 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001292}
1293
Allan Stephens8809b252011-10-25 10:44:35 -04001294/*
Per Lidenb97bf3f2006-01-02 19:04:38 +01001295 * link_handle_out_of_seq_msg - handle arrival of out-of-sequence packet
1296 */
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001297static void link_handle_out_of_seq_msg(struct tipc_link *l_ptr,
Per Lidenb97bf3f2006-01-02 19:04:38 +01001298 struct sk_buff *buf)
1299{
Allan Stephensf9057302011-10-24 16:03:12 -04001300 u32 seq_no = buf_seqno(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001301
1302 if (likely(msg_user(buf_msg(buf)) == LINK_PROTOCOL)) {
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001303 tipc_link_proto_rcv(l_ptr, buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001304 return;
1305 }
1306
Per Lidenb97bf3f2006-01-02 19:04:38 +01001307 /* Record OOS packet arrival (force mismatch on next timeout) */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001308 l_ptr->checkpoint--;
1309
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001310 /*
Per Lidenb97bf3f2006-01-02 19:04:38 +01001311 * Discard packet if a duplicate; otherwise add it to deferred queue
1312 * and notify peer of gap as per protocol specification
1313 */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001314 if (less(seq_no, mod(l_ptr->next_in_no))) {
1315 l_ptr->stats.duplicates++;
Allan Stephens5f6d9122011-11-04 13:24:29 -04001316 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001317 return;
1318 }
1319
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001320 if (tipc_link_defer_pkt(&l_ptr->deferdq, buf)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001321 l_ptr->stats.deferred_recv++;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001322 if ((skb_queue_len(&l_ptr->deferdq) % TIPC_MIN_LINK_WIN) == 1)
Ying Xue247f0f32014-02-18 16:06:46 +08001323 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0, 0, 0, 0);
Ying Xuebc6fecd2014-11-26 11:41:53 +08001324 } else {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001325 l_ptr->stats.duplicates++;
Ying Xuebc6fecd2014-11-26 11:41:53 +08001326 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001327}
1328
1329/*
1330 * Send protocol message to the other endpoint.
1331 */
Ying Xue247f0f32014-02-18 16:06:46 +08001332void tipc_link_proto_xmit(struct tipc_link *l_ptr, u32 msg_typ, int probe_msg,
1333 u32 gap, u32 tolerance, u32 priority, u32 ack_mtu)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001334{
Sam Ravnborg1fc54d82006-03-20 22:36:47 -08001335 struct sk_buff *buf = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001336 struct tipc_msg *msg = l_ptr->pmsg;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001337 u32 msg_size = sizeof(l_ptr->proto_msg);
Allan Stephens75f0aa42011-02-28 15:30:20 -05001338 int r_flag;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001339
Ying Xue77a7e072013-12-10 20:45:44 -08001340 /* Don't send protocol message during link changeover */
1341 if (l_ptr->exp_msg_count)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001342 return;
Allan Stephensb4b56102011-05-27 11:00:51 -04001343
1344 /* Abort non-RESET send if communication with node is prohibited */
Ying Xue10f465c2014-05-05 08:56:11 +08001345 if ((tipc_node_blocked(l_ptr->owner)) && (msg_typ != RESET_MSG))
Allan Stephensb4b56102011-05-27 11:00:51 -04001346 return;
1347
Allan Stephens92d2c902011-10-25 11:20:26 -04001348 /* Create protocol message with "out-of-sequence" sequence number */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001349 msg_set_type(msg, msg_typ);
Ying Xue7a2f7d12014-04-21 10:55:46 +08001350 msg_set_net_plane(msg, l_ptr->net_plane);
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001351 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Ying Xue1da46562015-01-09 15:27:07 +08001352 msg_set_last_bcast(msg, tipc_bclink_get_last_sent(l_ptr->owner->net));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001353
1354 if (msg_typ == STATE_MSG) {
1355 u32 next_sent = mod(l_ptr->next_out_no);
1356
Per Liden4323add2006-01-18 00:38:21 +01001357 if (!tipc_link_is_up(l_ptr))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001358 return;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001359 if (skb_queue_len(&l_ptr->backlogq))
1360 next_sent = buf_seqno(skb_peek(&l_ptr->backlogq));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001361 msg_set_next_sent(msg, next_sent);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001362 if (!skb_queue_empty(&l_ptr->deferdq)) {
1363 u32 rec = buf_seqno(skb_peek(&l_ptr->deferdq));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001364 gap = mod(rec - mod(l_ptr->next_in_no));
1365 }
1366 msg_set_seq_gap(msg, gap);
1367 if (gap)
1368 l_ptr->stats.sent_nacks++;
1369 msg_set_link_tolerance(msg, tolerance);
1370 msg_set_linkprio(msg, priority);
1371 msg_set_max_pkt(msg, ack_mtu);
1372 msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
1373 msg_set_probe(msg, probe_msg != 0);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001374 if (probe_msg) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001375 u32 mtu = l_ptr->max_pkt;
1376
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001377 if ((mtu < l_ptr->max_pkt_target) &&
Per Lidenb97bf3f2006-01-02 19:04:38 +01001378 link_working_working(l_ptr) &&
1379 l_ptr->fsm_msg_cnt) {
1380 msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001381 if (l_ptr->max_pkt_probes == 10) {
1382 l_ptr->max_pkt_target = (msg_size - 4);
1383 l_ptr->max_pkt_probes = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001384 msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001385 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001386 l_ptr->max_pkt_probes++;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001387 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001388
1389 l_ptr->stats.sent_probes++;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001390 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001391 l_ptr->stats.sent_states++;
1392 } else { /* RESET_MSG or ACTIVATE_MSG */
1393 msg_set_ack(msg, mod(l_ptr->reset_checkpoint - 1));
1394 msg_set_seq_gap(msg, 0);
1395 msg_set_next_sent(msg, 1);
Allan Stephensf23d9bf2011-01-18 15:15:34 -05001396 msg_set_probe(msg, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001397 msg_set_link_tolerance(msg, l_ptr->tolerance);
1398 msg_set_linkprio(msg, l_ptr->priority);
1399 msg_set_max_pkt(msg, l_ptr->max_pkt_target);
1400 }
1401
Allan Stephens75f0aa42011-02-28 15:30:20 -05001402 r_flag = (l_ptr->owner->working_links > tipc_link_is_up(l_ptr));
1403 msg_set_redundant_link(msg, r_flag);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001404 msg_set_linkprio(msg, l_ptr->priority);
Allan Stephens92d2c902011-10-25 11:20:26 -04001405 msg_set_size(msg, msg_size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001406
1407 msg_set_seqno(msg, mod(l_ptr->next_out_no + (0xffff/2)));
1408
stephen hemminger31e3c3f2010-10-13 13:20:35 +00001409 buf = tipc_buf_acquire(msg_size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001410 if (!buf)
1411 return;
1412
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03001413 skb_copy_to_linear_data(buf, msg, sizeof(l_ptr->proto_msg));
Ying Xue796c75d2013-06-17 10:54:48 -04001414 buf->priority = TC_PRIO_CONTROL;
Ying Xue7f9f95d2015-01-09 15:27:06 +08001415 tipc_bearer_send(l_ptr->owner->net, l_ptr->bearer_id, buf,
1416 &l_ptr->media_addr);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001417 l_ptr->rcv_unacked = 0;
Allan Stephens5f6d9122011-11-04 13:24:29 -04001418 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001419}
1420
1421/*
1422 * Receive protocol message :
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001423 * Note that network plane id propagates through the network, and may
1424 * change at any time. The node with lowest address rules
Per Lidenb97bf3f2006-01-02 19:04:38 +01001425 */
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001426static void tipc_link_proto_rcv(struct tipc_link *l_ptr,
Ying Xuec93d3ba2015-01-09 15:27:04 +08001427 struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001428{
1429 u32 rec_gap = 0;
1430 u32 max_pkt_info;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001431 u32 max_pkt_ack;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001432 u32 msg_tol;
1433 struct tipc_msg *msg = buf_msg(buf);
1434
Ying Xue77a7e072013-12-10 20:45:44 -08001435 /* Discard protocol message during link changeover */
1436 if (l_ptr->exp_msg_count)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001437 goto exit;
1438
Ying Xue7a2f7d12014-04-21 10:55:46 +08001439 if (l_ptr->net_plane != msg_net_plane(msg))
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001440 if (link_own_addr(l_ptr) > msg_prevnode(msg))
Ying Xue7a2f7d12014-04-21 10:55:46 +08001441 l_ptr->net_plane = msg_net_plane(msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001442
Per Lidenb97bf3f2006-01-02 19:04:38 +01001443 switch (msg_type(msg)) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001444
Per Lidenb97bf3f2006-01-02 19:04:38 +01001445 case RESET_MSG:
Allan Stephensa686e682008-06-04 17:29:39 -07001446 if (!link_working_unknown(l_ptr) &&
1447 (l_ptr->peer_session != INVALID_SESSION)) {
Allan Stephens641c2182011-04-07 09:54:43 -04001448 if (less_eq(msg_session(msg), l_ptr->peer_session))
1449 break; /* duplicate or old reset: ignore */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001450 }
Allan Stephensb4b56102011-05-27 11:00:51 -04001451
1452 if (!msg_redundant_link(msg) && (link_working_working(l_ptr) ||
1453 link_working_unknown(l_ptr))) {
1454 /*
1455 * peer has lost contact -- don't allow peer's links
1456 * to reactivate before we recognize loss & clean up
1457 */
Ying Xueca9cf062014-05-08 08:54:40 +08001458 l_ptr->owner->action_flags |= TIPC_WAIT_OWN_LINKS_DOWN;
Allan Stephensb4b56102011-05-27 11:00:51 -04001459 }
1460
Allan Stephens47361c82011-10-26 10:55:16 -04001461 link_state_event(l_ptr, RESET_MSG);
1462
Per Lidenb97bf3f2006-01-02 19:04:38 +01001463 /* fall thru' */
1464 case ACTIVATE_MSG:
1465 /* Update link settings according other endpoint's values */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001466 strcpy((strrchr(l_ptr->name, ':') + 1), (char *)msg_data(msg));
1467
Allan Stephens2db99832010-12-31 18:59:33 +00001468 msg_tol = msg_link_tolerance(msg);
1469 if (msg_tol > l_ptr->tolerance)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001470 link_set_supervision_props(l_ptr, msg_tol);
1471
1472 if (msg_linkprio(msg) > l_ptr->priority)
1473 l_ptr->priority = msg_linkprio(msg);
1474
1475 max_pkt_info = msg_max_pkt(msg);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001476 if (max_pkt_info) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001477 if (max_pkt_info < l_ptr->max_pkt_target)
1478 l_ptr->max_pkt_target = max_pkt_info;
1479 if (l_ptr->max_pkt > l_ptr->max_pkt_target)
1480 l_ptr->max_pkt = l_ptr->max_pkt_target;
1481 } else {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001482 l_ptr->max_pkt = l_ptr->max_pkt_target;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001483 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001484
Allan Stephens4d753132011-10-25 12:19:05 -04001485 /* Synchronize broadcast link info, if not done previously */
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001486 if (!tipc_node_is_up(l_ptr->owner)) {
1487 l_ptr->owner->bclink.last_sent =
1488 l_ptr->owner->bclink.last_in =
1489 msg_last_bcast(msg);
1490 l_ptr->owner->bclink.oos_state = 0;
1491 }
Allan Stephens4d753132011-10-25 12:19:05 -04001492
Per Lidenb97bf3f2006-01-02 19:04:38 +01001493 l_ptr->peer_session = msg_session(msg);
1494 l_ptr->peer_bearer_id = msg_bearer_id(msg);
Allan Stephens47361c82011-10-26 10:55:16 -04001495
1496 if (msg_type(msg) == ACTIVATE_MSG)
1497 link_state_event(l_ptr, ACTIVATE_MSG);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001498 break;
1499 case STATE_MSG:
1500
Allan Stephens2db99832010-12-31 18:59:33 +00001501 msg_tol = msg_link_tolerance(msg);
1502 if (msg_tol)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001503 link_set_supervision_props(l_ptr, msg_tol);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001504
1505 if (msg_linkprio(msg) &&
Per Lidenb97bf3f2006-01-02 19:04:38 +01001506 (msg_linkprio(msg) != l_ptr->priority)) {
Erik Hugne3fa9cac2015-01-22 17:10:31 +01001507 pr_debug("%s<%s>, priority change %u->%u\n",
1508 link_rst_msg, l_ptr->name,
1509 l_ptr->priority, msg_linkprio(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001510 l_ptr->priority = msg_linkprio(msg);
Per Liden4323add2006-01-18 00:38:21 +01001511 tipc_link_reset(l_ptr); /* Enforce change to take effect */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001512 break;
1513 }
Jon Paul Maloyec37dcd2014-05-14 05:39:10 -04001514
1515 /* Record reception; force mismatch at next timeout: */
1516 l_ptr->checkpoint--;
1517
Per Lidenb97bf3f2006-01-02 19:04:38 +01001518 link_state_event(l_ptr, TRAFFIC_MSG_EVT);
1519 l_ptr->stats.recv_states++;
1520 if (link_reset_unknown(l_ptr))
1521 break;
1522
1523 if (less_eq(mod(l_ptr->next_in_no), msg_next_sent(msg))) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001524 rec_gap = mod(msg_next_sent(msg) -
Per Lidenb97bf3f2006-01-02 19:04:38 +01001525 mod(l_ptr->next_in_no));
1526 }
1527
1528 max_pkt_ack = msg_max_pkt(msg);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001529 if (max_pkt_ack > l_ptr->max_pkt) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001530 l_ptr->max_pkt = max_pkt_ack;
1531 l_ptr->max_pkt_probes = 0;
1532 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001533
1534 max_pkt_ack = 0;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001535 if (msg_probe(msg)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001536 l_ptr->stats.recv_probes++;
Allan Stephensa0168922010-12-31 18:59:35 +00001537 if (msg_size(msg) > sizeof(l_ptr->proto_msg))
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001538 max_pkt_ack = msg_size(msg);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001539 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001540
1541 /* Protocol message before retransmits, reduce loss risk */
Ying Xue389dd9b2012-11-16 13:51:30 +08001542 if (l_ptr->owner->bclink.recv_permitted)
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001543 tipc_bclink_update_link_state(l_ptr->owner,
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001544 msg_last_bcast(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001545
1546 if (rec_gap || (msg_probe(msg))) {
Ying Xue247f0f32014-02-18 16:06:46 +08001547 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, rec_gap, 0,
1548 0, max_pkt_ack);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001549 }
1550 if (msg_seq_gap(msg)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001551 l_ptr->stats.recv_nacks++;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001552 tipc_link_retransmit(l_ptr, skb_peek(&l_ptr->transmq),
Per Liden4323add2006-01-18 00:38:21 +01001553 msg_seq_gap(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001554 }
1555 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001556 }
1557exit:
Allan Stephens5f6d9122011-11-04 13:24:29 -04001558 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001559}
1560
1561
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001562/* tipc_link_tunnel_xmit(): Tunnel one packet via a link belonging to
1563 * a different bearer. Owner node is locked.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001564 */
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001565static void tipc_link_tunnel_xmit(struct tipc_link *l_ptr,
1566 struct tipc_msg *tunnel_hdr,
1567 struct tipc_msg *msg,
1568 u32 selector)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001569{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001570 struct tipc_link *tunnel;
Ying Xuea6ca1092014-11-26 11:41:55 +08001571 struct sk_buff *skb;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001572 u32 length = msg_size(msg);
1573
1574 tunnel = l_ptr->owner->active_links[selector & 1];
Allan Stephens5392d642006-06-25 23:52:50 -07001575 if (!tipc_link_is_up(tunnel)) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001576 pr_warn("%stunnel link no longer available\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001577 return;
Allan Stephens5392d642006-06-25 23:52:50 -07001578 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001579 msg_set_size(tunnel_hdr, length + INT_H_SIZE);
Ying Xuea6ca1092014-11-26 11:41:55 +08001580 skb = tipc_buf_acquire(length + INT_H_SIZE);
1581 if (!skb) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001582 pr_warn("%sunable to send tunnel msg\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001583 return;
Allan Stephens5392d642006-06-25 23:52:50 -07001584 }
Ying Xuea6ca1092014-11-26 11:41:55 +08001585 skb_copy_to_linear_data(skb, tunnel_hdr, INT_H_SIZE);
1586 skb_copy_to_linear_data_offset(skb, INT_H_SIZE, msg, length);
1587 __tipc_link_xmit_skb(tunnel, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001588}
1589
1590
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001591/* tipc_link_failover_send_queue(): A link has gone down, but a second
1592 * link is still active. We can do failover. Tunnel the failing link's
1593 * whole send queue via the remaining link. This way, we don't lose
1594 * any packets, and sequence order is preserved for subsequent traffic
1595 * sent over the remaining link. Owner node is locked.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001596 */
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001597void tipc_link_failover_send_queue(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001598{
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001599 int msgcount;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001600 struct tipc_link *tunnel = l_ptr->owner->active_links[0];
Per Lidenb97bf3f2006-01-02 19:04:38 +01001601 struct tipc_msg tunnel_hdr;
Ying Xue58dc55f2014-11-26 11:41:52 +08001602 struct sk_buff *skb;
Allan Stephens5392d642006-06-25 23:52:50 -07001603 int split_bundles;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001604
1605 if (!tunnel)
1606 return;
1607
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001608 tipc_msg_init(link_own_addr(l_ptr), &tunnel_hdr, CHANGEOVER_PROTOCOL,
Ying Xue34747532015-01-09 15:27:10 +08001609 ORIGINAL_MSG, INT_H_SIZE, l_ptr->addr);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001610 skb_queue_splice_tail_init(&l_ptr->backlogq, &l_ptr->transmq);
1611 msgcount = skb_queue_len(&l_ptr->transmq);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001612 msg_set_bearer_id(&tunnel_hdr, l_ptr->peer_bearer_id);
1613 msg_set_msgcnt(&tunnel_hdr, msgcount);
Allan Stephensf1310722006-06-25 23:51:37 -07001614
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001615 if (skb_queue_empty(&l_ptr->transmq)) {
Ying Xue58dc55f2014-11-26 11:41:52 +08001616 skb = tipc_buf_acquire(INT_H_SIZE);
1617 if (skb) {
1618 skb_copy_to_linear_data(skb, &tunnel_hdr, INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001619 msg_set_size(&tunnel_hdr, INT_H_SIZE);
Ying Xuea6ca1092014-11-26 11:41:55 +08001620 __tipc_link_xmit_skb(tunnel, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001621 } else {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001622 pr_warn("%sunable to send changeover msg\n",
1623 link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001624 }
1625 return;
1626 }
Allan Stephensf1310722006-06-25 23:51:37 -07001627
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001628 split_bundles = (l_ptr->owner->active_links[0] !=
Allan Stephens5392d642006-06-25 23:52:50 -07001629 l_ptr->owner->active_links[1]);
1630
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001631 skb_queue_walk(&l_ptr->transmq, skb) {
Ying Xue58dc55f2014-11-26 11:41:52 +08001632 struct tipc_msg *msg = buf_msg(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001633
1634 if ((msg_user(msg) == MSG_BUNDLER) && split_bundles) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001635 struct tipc_msg *m = msg_get_wrapped(msg);
Allan Stephens0e659672010-12-31 18:59:32 +00001636 unchar *pos = (unchar *)m;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001637
Florian Westphald788d802007-08-02 19:28:06 -07001638 msgcount = msg_msgcnt(msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001639 while (msgcount--) {
Allan Stephens0e659672010-12-31 18:59:32 +00001640 msg_set_seqno(m, msg_seqno(msg));
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001641 tipc_link_tunnel_xmit(l_ptr, &tunnel_hdr, m,
1642 msg_link_selector(m));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001643 pos += align(msg_size(m));
1644 m = (struct tipc_msg *)pos;
1645 }
1646 } else {
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001647 tipc_link_tunnel_xmit(l_ptr, &tunnel_hdr, msg,
1648 msg_link_selector(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001649 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001650 }
1651}
1652
Ying Xue247f0f32014-02-18 16:06:46 +08001653/* tipc_link_dup_queue_xmit(): A second link has become active. Tunnel a
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001654 * duplicate of the first link's send queue via the new link. This way, we
1655 * are guaranteed that currently queued packets from a socket are delivered
1656 * before future traffic from the same socket, even if this is using the
1657 * new link. The last arriving copy of each duplicate packet is dropped at
1658 * the receiving end by the regular protocol check, so packet cardinality
1659 * and sequence order is preserved per sender/receiver socket pair.
1660 * Owner node is locked.
1661 */
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001662void tipc_link_dup_queue_xmit(struct tipc_link *link,
1663 struct tipc_link *tnl)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001664{
Ying Xue58dc55f2014-11-26 11:41:52 +08001665 struct sk_buff *skb;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001666 struct tipc_msg tnl_hdr;
1667 struct sk_buff_head *queue = &link->transmq;
1668 int mcnt;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001669
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001670 tipc_msg_init(link_own_addr(link), &tnl_hdr, CHANGEOVER_PROTOCOL,
1671 DUPLICATE_MSG, INT_H_SIZE, link->addr);
1672 mcnt = skb_queue_len(&link->transmq) + skb_queue_len(&link->backlogq);
1673 msg_set_msgcnt(&tnl_hdr, mcnt);
1674 msg_set_bearer_id(&tnl_hdr, link->peer_bearer_id);
1675
1676tunnel_queue:
1677 skb_queue_walk(queue, skb) {
Ying Xue58dc55f2014-11-26 11:41:52 +08001678 struct sk_buff *outskb;
1679 struct tipc_msg *msg = buf_msg(skb);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001680 u32 len = msg_size(msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001681
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001682 msg_set_ack(msg, mod(link->next_in_no - 1));
1683 msg_set_bcast_ack(msg, link->owner->bclink.last_in);
1684 msg_set_size(&tnl_hdr, len + INT_H_SIZE);
1685 outskb = tipc_buf_acquire(len + INT_H_SIZE);
Ying Xue58dc55f2014-11-26 11:41:52 +08001686 if (outskb == NULL) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001687 pr_warn("%sunable to send duplicate msg\n",
1688 link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001689 return;
1690 }
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001691 skb_copy_to_linear_data(outskb, &tnl_hdr, INT_H_SIZE);
1692 skb_copy_to_linear_data_offset(outskb, INT_H_SIZE,
1693 skb->data, len);
1694 __tipc_link_xmit_skb(tnl, outskb);
1695 if (!tipc_link_is_up(link))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001696 return;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001697 }
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001698 if (queue == &link->backlogq)
1699 return;
1700 queue = &link->backlogq;
1701 goto tunnel_queue;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001702}
1703
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001704/* tipc_link_dup_rcv(): Receive a tunnelled DUPLICATE_MSG packet.
1705 * Owner node is locked.
1706 */
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001707static void tipc_link_dup_rcv(struct tipc_link *link,
1708 struct sk_buff *skb)
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001709{
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001710 struct sk_buff *iskb;
1711 int pos = 0;
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001712
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001713 if (!tipc_link_is_up(link))
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001714 return;
1715
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001716 if (!tipc_msg_extract(skb, &iskb, &pos)) {
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001717 pr_warn("%sfailed to extract inner dup pkt\n", link_co_err);
1718 return;
1719 }
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001720 /* Append buffer to deferred queue, if applicable: */
1721 link_handle_out_of_seq_msg(link, iskb);
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001722}
1723
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001724/* tipc_link_failover_rcv(): Receive a tunnelled ORIGINAL_MSG packet
1725 * Owner node is locked.
1726 */
1727static struct sk_buff *tipc_link_failover_rcv(struct tipc_link *l_ptr,
1728 struct sk_buff *t_buf)
1729{
1730 struct tipc_msg *t_msg = buf_msg(t_buf);
1731 struct sk_buff *buf = NULL;
1732 struct tipc_msg *msg;
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001733 int pos = 0;
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001734
1735 if (tipc_link_is_up(l_ptr))
1736 tipc_link_reset(l_ptr);
1737
1738 /* First failover packet? */
1739 if (l_ptr->exp_msg_count == START_CHANGEOVER)
1740 l_ptr->exp_msg_count = msg_msgcnt(t_msg);
1741
1742 /* Should there be an inner packet? */
1743 if (l_ptr->exp_msg_count) {
1744 l_ptr->exp_msg_count--;
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001745 if (!tipc_msg_extract(t_buf, &buf, &pos)) {
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001746 pr_warn("%sno inner failover pkt\n", link_co_err);
1747 goto exit;
1748 }
1749 msg = buf_msg(buf);
1750
1751 if (less(msg_seqno(msg), l_ptr->reset_checkpoint)) {
1752 kfree_skb(buf);
1753 buf = NULL;
1754 goto exit;
1755 }
1756 if (msg_user(msg) == MSG_FRAGMENTER) {
1757 l_ptr->stats.recv_fragments++;
Jon Paul Maloy37e22162014-05-14 05:39:12 -04001758 tipc_buf_append(&l_ptr->reasm_buf, &buf);
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001759 }
1760 }
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001761exit:
Jon Paul Maloy2d72d492015-02-03 08:59:17 -05001762 if ((!l_ptr->exp_msg_count) && (l_ptr->flags & LINK_STOPPED))
1763 tipc_link_delete(l_ptr);
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001764 return buf;
1765}
1766
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001767/* tipc_link_tunnel_rcv(): Receive a tunnelled packet, sent
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001768 * via other link as result of a failover (ORIGINAL_MSG) or
1769 * a new active link (DUPLICATE_MSG). Failover packets are
1770 * returned to the active link for delivery upwards.
1771 * Owner node is locked.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001772 */
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001773static int tipc_link_tunnel_rcv(struct tipc_node *n_ptr,
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001774 struct sk_buff **buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001775{
Jon Paul Maloy02842f72014-02-13 17:29:14 -05001776 struct sk_buff *t_buf = *buf;
1777 struct tipc_link *l_ptr;
1778 struct tipc_msg *t_msg = buf_msg(t_buf);
1779 u32 bearer_id = msg_bearer_id(t_msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001780
Jon Paul Maloy1e9d47a2014-02-13 17:29:13 -05001781 *buf = NULL;
1782
Dan Carpentercb4b102f2013-05-06 08:28:41 +00001783 if (bearer_id >= MAX_BEARERS)
1784 goto exit;
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001785
Jon Paul Maloy02842f72014-02-13 17:29:14 -05001786 l_ptr = n_ptr->links[bearer_id];
1787 if (!l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001788 goto exit;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001789
Jon Paul Maloy02842f72014-02-13 17:29:14 -05001790 if (msg_type(t_msg) == DUPLICATE_MSG)
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001791 tipc_link_dup_rcv(l_ptr, t_buf);
Jon Paul Maloy02842f72014-02-13 17:29:14 -05001792 else if (msg_type(t_msg) == ORIGINAL_MSG)
1793 *buf = tipc_link_failover_rcv(l_ptr, t_buf);
Jon Paul Maloy1e9d47a2014-02-13 17:29:13 -05001794 else
1795 pr_warn("%sunknown tunnel pkt received\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001796exit:
Jon Paul Maloy02842f72014-02-13 17:29:14 -05001797 kfree_skb(t_buf);
Jon Paul Maloy1e9d47a2014-02-13 17:29:13 -05001798 return *buf != NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001799}
1800
Ying Xue2f55c432015-01-09 15:27:00 +08001801static void link_set_supervision_props(struct tipc_link *l_ptr, u32 tol)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001802{
Ying Xue2f55c432015-01-09 15:27:00 +08001803 unsigned long intv = ((tol / 4) > 500) ? 500 : tol / 4;
1804
1805 if ((tol < TIPC_MIN_LINK_TOL) || (tol > TIPC_MAX_LINK_TOL))
Allan Stephens5413b4c2011-01-18 13:24:55 -05001806 return;
1807
Ying Xue2f55c432015-01-09 15:27:00 +08001808 l_ptr->tolerance = tol;
1809 l_ptr->cont_intv = msecs_to_jiffies(intv);
1810 l_ptr->abort_limit = tol / (jiffies_to_msecs(l_ptr->cont_intv) / 4);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001811}
1812
Jon Paul Maloye3eea1e2015-03-13 16:08:11 -04001813void tipc_link_set_queue_limits(struct tipc_link *l, u32 win)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001814{
Jon Paul Maloye3eea1e2015-03-13 16:08:11 -04001815 int max_bulk = TIPC_MAX_PUBLICATIONS / (l->max_pkt / ITEM_SIZE);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001816
Jon Paul Maloye3eea1e2015-03-13 16:08:11 -04001817 l->window = win;
1818 l->queue_limit[TIPC_LOW_IMPORTANCE] = win / 2;
1819 l->queue_limit[TIPC_MEDIUM_IMPORTANCE] = win;
1820 l->queue_limit[TIPC_HIGH_IMPORTANCE] = win / 2 * 3;
1821 l->queue_limit[TIPC_CRITICAL_IMPORTANCE] = win * 2;
1822 l->queue_limit[TIPC_SYSTEM_IMPORTANCE] = max_bulk;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001823}
1824
Jon Paul Maloye099e862014-02-13 17:29:18 -05001825/* tipc_link_find_owner - locate owner node of link by link's name
Ying Xuef2f98002015-01-09 15:27:05 +08001826 * @net: the applicable net namespace
Jon Paul Maloye099e862014-02-13 17:29:18 -05001827 * @name: pointer to link name string
1828 * @bearer_id: pointer to index in 'node->links' array where the link was found.
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001829 *
Jon Paul Maloye099e862014-02-13 17:29:18 -05001830 * Returns pointer to node owning the link, or 0 if no matching link is found.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001831 */
Ying Xuef2f98002015-01-09 15:27:05 +08001832static struct tipc_node *tipc_link_find_owner(struct net *net,
1833 const char *link_name,
Jon Paul Maloye099e862014-02-13 17:29:18 -05001834 unsigned int *bearer_id)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001835{
Ying Xuef2f98002015-01-09 15:27:05 +08001836 struct tipc_net *tn = net_generic(net, tipc_net_id);
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001837 struct tipc_link *l_ptr;
Erik Hugnebbfbe472013-10-18 07:23:21 +02001838 struct tipc_node *n_ptr;
Fabian Frederick886eaa12014-12-25 12:05:50 +01001839 struct tipc_node *found_node = NULL;
Erik Hugnebbfbe472013-10-18 07:23:21 +02001840 int i;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001841
Jon Paul Maloye099e862014-02-13 17:29:18 -05001842 *bearer_id = 0;
Ying Xue6c7a7622014-03-27 12:54:37 +08001843 rcu_read_lock();
Ying Xuef2f98002015-01-09 15:27:05 +08001844 list_for_each_entry_rcu(n_ptr, &tn->node_list, list) {
Jon Paul Maloya11607f2014-02-14 16:40:44 -05001845 tipc_node_lock(n_ptr);
Erik Hugnebbfbe472013-10-18 07:23:21 +02001846 for (i = 0; i < MAX_BEARERS; i++) {
1847 l_ptr = n_ptr->links[i];
Jon Paul Maloye099e862014-02-13 17:29:18 -05001848 if (l_ptr && !strcmp(l_ptr->name, link_name)) {
1849 *bearer_id = i;
1850 found_node = n_ptr;
1851 break;
1852 }
Erik Hugnebbfbe472013-10-18 07:23:21 +02001853 }
Jon Paul Maloya11607f2014-02-14 16:40:44 -05001854 tipc_node_unlock(n_ptr);
Jon Paul Maloye099e862014-02-13 17:29:18 -05001855 if (found_node)
1856 break;
Erik Hugnebbfbe472013-10-18 07:23:21 +02001857 }
Ying Xue6c7a7622014-03-27 12:54:37 +08001858 rcu_read_unlock();
1859
Jon Paul Maloye099e862014-02-13 17:29:18 -05001860 return found_node;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001861}
1862
Allan Stephens5c216e12011-10-18 11:34:29 -04001863/**
Per Lidenb97bf3f2006-01-02 19:04:38 +01001864 * link_reset_statistics - reset link statistics
1865 * @l_ptr: pointer to link
1866 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001867static void link_reset_statistics(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001868{
1869 memset(&l_ptr->stats, 0, sizeof(l_ptr->stats));
1870 l_ptr->stats.sent_info = l_ptr->next_out_no;
1871 l_ptr->stats.recv_info = l_ptr->next_in_no;
1872}
1873
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001874static void link_print(struct tipc_link *l_ptr, const char *str)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001875{
Ying Xue7f9f95d2015-01-09 15:27:06 +08001876 struct tipc_net *tn = net_generic(l_ptr->owner->net, tipc_net_id);
Ying Xue7a2f7d12014-04-21 10:55:46 +08001877 struct tipc_bearer *b_ptr;
1878
1879 rcu_read_lock();
Ying Xue7f9f95d2015-01-09 15:27:06 +08001880 b_ptr = rcu_dereference_rtnl(tn->bearer_list[l_ptr->bearer_id]);
Ying Xue7a2f7d12014-04-21 10:55:46 +08001881 if (b_ptr)
1882 pr_info("%s Link %x<%s>:", str, l_ptr->addr, b_ptr->name);
1883 rcu_read_unlock();
Allan Stephens8d64a5b2010-12-31 18:59:27 +00001884
Per Lidenb97bf3f2006-01-02 19:04:38 +01001885 if (link_working_unknown(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04001886 pr_cont(":WU\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00001887 else if (link_reset_reset(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04001888 pr_cont(":RR\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00001889 else if (link_reset_unknown(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04001890 pr_cont(":RU\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00001891 else if (link_working_working(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04001892 pr_cont(":WW\n");
1893 else
1894 pr_cont("\n");
Per Lidenb97bf3f2006-01-02 19:04:38 +01001895}
Richard Alpe0655f6a2014-11-20 10:29:07 +01001896
1897/* Parse and validate nested (link) properties valid for media, bearer and link
1898 */
1899int tipc_nl_parse_link_prop(struct nlattr *prop, struct nlattr *props[])
1900{
1901 int err;
1902
1903 err = nla_parse_nested(props, TIPC_NLA_PROP_MAX, prop,
1904 tipc_nl_prop_policy);
1905 if (err)
1906 return err;
1907
1908 if (props[TIPC_NLA_PROP_PRIO]) {
1909 u32 prio;
1910
1911 prio = nla_get_u32(props[TIPC_NLA_PROP_PRIO]);
1912 if (prio > TIPC_MAX_LINK_PRI)
1913 return -EINVAL;
1914 }
1915
1916 if (props[TIPC_NLA_PROP_TOL]) {
1917 u32 tol;
1918
1919 tol = nla_get_u32(props[TIPC_NLA_PROP_TOL]);
1920 if ((tol < TIPC_MIN_LINK_TOL) || (tol > TIPC_MAX_LINK_TOL))
1921 return -EINVAL;
1922 }
1923
1924 if (props[TIPC_NLA_PROP_WIN]) {
1925 u32 win;
1926
1927 win = nla_get_u32(props[TIPC_NLA_PROP_WIN]);
1928 if ((win < TIPC_MIN_LINK_WIN) || (win > TIPC_MAX_LINK_WIN))
1929 return -EINVAL;
1930 }
1931
1932 return 0;
1933}
Richard Alpe7be57fc2014-11-20 10:29:12 +01001934
Richard Alpef96ce7a2014-11-20 10:29:13 +01001935int tipc_nl_link_set(struct sk_buff *skb, struct genl_info *info)
1936{
1937 int err;
1938 int res = 0;
1939 int bearer_id;
1940 char *name;
1941 struct tipc_link *link;
1942 struct tipc_node *node;
1943 struct nlattr *attrs[TIPC_NLA_LINK_MAX + 1];
Richard Alpe37e2d482015-02-09 09:50:08 +01001944 struct net *net = sock_net(skb->sk);
Richard Alpef96ce7a2014-11-20 10:29:13 +01001945
1946 if (!info->attrs[TIPC_NLA_LINK])
1947 return -EINVAL;
1948
1949 err = nla_parse_nested(attrs, TIPC_NLA_LINK_MAX,
1950 info->attrs[TIPC_NLA_LINK],
1951 tipc_nl_link_policy);
1952 if (err)
1953 return err;
1954
1955 if (!attrs[TIPC_NLA_LINK_NAME])
1956 return -EINVAL;
1957
1958 name = nla_data(attrs[TIPC_NLA_LINK_NAME]);
1959
Ying Xuef2f98002015-01-09 15:27:05 +08001960 node = tipc_link_find_owner(net, name, &bearer_id);
Richard Alpef96ce7a2014-11-20 10:29:13 +01001961 if (!node)
1962 return -EINVAL;
1963
1964 tipc_node_lock(node);
1965
1966 link = node->links[bearer_id];
1967 if (!link) {
1968 res = -EINVAL;
1969 goto out;
1970 }
1971
1972 if (attrs[TIPC_NLA_LINK_PROP]) {
1973 struct nlattr *props[TIPC_NLA_PROP_MAX + 1];
1974
1975 err = tipc_nl_parse_link_prop(attrs[TIPC_NLA_LINK_PROP],
1976 props);
1977 if (err) {
1978 res = err;
1979 goto out;
1980 }
1981
1982 if (props[TIPC_NLA_PROP_TOL]) {
1983 u32 tol;
1984
1985 tol = nla_get_u32(props[TIPC_NLA_PROP_TOL]);
1986 link_set_supervision_props(link, tol);
1987 tipc_link_proto_xmit(link, STATE_MSG, 0, 0, tol, 0, 0);
1988 }
1989 if (props[TIPC_NLA_PROP_PRIO]) {
1990 u32 prio;
1991
1992 prio = nla_get_u32(props[TIPC_NLA_PROP_PRIO]);
1993 link->priority = prio;
1994 tipc_link_proto_xmit(link, STATE_MSG, 0, 0, 0, prio, 0);
1995 }
1996 if (props[TIPC_NLA_PROP_WIN]) {
1997 u32 win;
1998
1999 win = nla_get_u32(props[TIPC_NLA_PROP_WIN]);
2000 tipc_link_set_queue_limits(link, win);
2001 }
2002 }
2003
2004out:
2005 tipc_node_unlock(node);
2006
2007 return res;
2008}
Richard Alped8182802014-11-24 11:10:29 +01002009
2010static int __tipc_nl_add_stats(struct sk_buff *skb, struct tipc_stats *s)
Richard Alpe7be57fc2014-11-20 10:29:12 +01002011{
2012 int i;
2013 struct nlattr *stats;
2014
2015 struct nla_map {
2016 u32 key;
2017 u32 val;
2018 };
2019
2020 struct nla_map map[] = {
2021 {TIPC_NLA_STATS_RX_INFO, s->recv_info},
2022 {TIPC_NLA_STATS_RX_FRAGMENTS, s->recv_fragments},
2023 {TIPC_NLA_STATS_RX_FRAGMENTED, s->recv_fragmented},
2024 {TIPC_NLA_STATS_RX_BUNDLES, s->recv_bundles},
2025 {TIPC_NLA_STATS_RX_BUNDLED, s->recv_bundled},
2026 {TIPC_NLA_STATS_TX_INFO, s->sent_info},
2027 {TIPC_NLA_STATS_TX_FRAGMENTS, s->sent_fragments},
2028 {TIPC_NLA_STATS_TX_FRAGMENTED, s->sent_fragmented},
2029 {TIPC_NLA_STATS_TX_BUNDLES, s->sent_bundles},
2030 {TIPC_NLA_STATS_TX_BUNDLED, s->sent_bundled},
2031 {TIPC_NLA_STATS_MSG_PROF_TOT, (s->msg_length_counts) ?
2032 s->msg_length_counts : 1},
2033 {TIPC_NLA_STATS_MSG_LEN_CNT, s->msg_length_counts},
2034 {TIPC_NLA_STATS_MSG_LEN_TOT, s->msg_lengths_total},
2035 {TIPC_NLA_STATS_MSG_LEN_P0, s->msg_length_profile[0]},
2036 {TIPC_NLA_STATS_MSG_LEN_P1, s->msg_length_profile[1]},
2037 {TIPC_NLA_STATS_MSG_LEN_P2, s->msg_length_profile[2]},
2038 {TIPC_NLA_STATS_MSG_LEN_P3, s->msg_length_profile[3]},
2039 {TIPC_NLA_STATS_MSG_LEN_P4, s->msg_length_profile[4]},
2040 {TIPC_NLA_STATS_MSG_LEN_P5, s->msg_length_profile[5]},
2041 {TIPC_NLA_STATS_MSG_LEN_P6, s->msg_length_profile[6]},
2042 {TIPC_NLA_STATS_RX_STATES, s->recv_states},
2043 {TIPC_NLA_STATS_RX_PROBES, s->recv_probes},
2044 {TIPC_NLA_STATS_RX_NACKS, s->recv_nacks},
2045 {TIPC_NLA_STATS_RX_DEFERRED, s->deferred_recv},
2046 {TIPC_NLA_STATS_TX_STATES, s->sent_states},
2047 {TIPC_NLA_STATS_TX_PROBES, s->sent_probes},
2048 {TIPC_NLA_STATS_TX_NACKS, s->sent_nacks},
2049 {TIPC_NLA_STATS_TX_ACKS, s->sent_acks},
2050 {TIPC_NLA_STATS_RETRANSMITTED, s->retransmitted},
2051 {TIPC_NLA_STATS_DUPLICATES, s->duplicates},
2052 {TIPC_NLA_STATS_LINK_CONGS, s->link_congs},
2053 {TIPC_NLA_STATS_MAX_QUEUE, s->max_queue_sz},
2054 {TIPC_NLA_STATS_AVG_QUEUE, s->queue_sz_counts ?
2055 (s->accu_queue_sz / s->queue_sz_counts) : 0}
2056 };
2057
2058 stats = nla_nest_start(skb, TIPC_NLA_LINK_STATS);
2059 if (!stats)
2060 return -EMSGSIZE;
2061
2062 for (i = 0; i < ARRAY_SIZE(map); i++)
2063 if (nla_put_u32(skb, map[i].key, map[i].val))
2064 goto msg_full;
2065
2066 nla_nest_end(skb, stats);
2067
2068 return 0;
2069msg_full:
2070 nla_nest_cancel(skb, stats);
2071
2072 return -EMSGSIZE;
2073}
2074
2075/* Caller should hold appropriate locks to protect the link */
Ying Xue34747532015-01-09 15:27:10 +08002076static int __tipc_nl_add_link(struct net *net, struct tipc_nl_msg *msg,
2077 struct tipc_link *link)
Richard Alpe7be57fc2014-11-20 10:29:12 +01002078{
2079 int err;
2080 void *hdr;
2081 struct nlattr *attrs;
2082 struct nlattr *prop;
Ying Xue34747532015-01-09 15:27:10 +08002083 struct tipc_net *tn = net_generic(net, tipc_net_id);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002084
Richard Alpebfb3e5d2015-02-09 09:50:03 +01002085 hdr = genlmsg_put(msg->skb, msg->portid, msg->seq, &tipc_genl_family,
Richard Alpe7be57fc2014-11-20 10:29:12 +01002086 NLM_F_MULTI, TIPC_NL_LINK_GET);
2087 if (!hdr)
2088 return -EMSGSIZE;
2089
2090 attrs = nla_nest_start(msg->skb, TIPC_NLA_LINK);
2091 if (!attrs)
2092 goto msg_full;
2093
2094 if (nla_put_string(msg->skb, TIPC_NLA_LINK_NAME, link->name))
2095 goto attr_msg_full;
2096 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_DEST,
Ying Xue34747532015-01-09 15:27:10 +08002097 tipc_cluster_mask(tn->own_addr)))
Richard Alpe7be57fc2014-11-20 10:29:12 +01002098 goto attr_msg_full;
2099 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_MTU, link->max_pkt))
2100 goto attr_msg_full;
2101 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_RX, link->next_in_no))
2102 goto attr_msg_full;
2103 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_TX, link->next_out_no))
2104 goto attr_msg_full;
2105
2106 if (tipc_link_is_up(link))
2107 if (nla_put_flag(msg->skb, TIPC_NLA_LINK_UP))
2108 goto attr_msg_full;
2109 if (tipc_link_is_active(link))
2110 if (nla_put_flag(msg->skb, TIPC_NLA_LINK_ACTIVE))
2111 goto attr_msg_full;
2112
2113 prop = nla_nest_start(msg->skb, TIPC_NLA_LINK_PROP);
2114 if (!prop)
2115 goto attr_msg_full;
2116 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_PRIO, link->priority))
2117 goto prop_msg_full;
2118 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_TOL, link->tolerance))
2119 goto prop_msg_full;
2120 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_WIN,
2121 link->queue_limit[TIPC_LOW_IMPORTANCE]))
2122 goto prop_msg_full;
2123 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_PRIO, link->priority))
2124 goto prop_msg_full;
2125 nla_nest_end(msg->skb, prop);
2126
2127 err = __tipc_nl_add_stats(msg->skb, &link->stats);
2128 if (err)
2129 goto attr_msg_full;
2130
2131 nla_nest_end(msg->skb, attrs);
2132 genlmsg_end(msg->skb, hdr);
2133
2134 return 0;
2135
2136prop_msg_full:
2137 nla_nest_cancel(msg->skb, prop);
2138attr_msg_full:
2139 nla_nest_cancel(msg->skb, attrs);
2140msg_full:
2141 genlmsg_cancel(msg->skb, hdr);
2142
2143 return -EMSGSIZE;
2144}
2145
2146/* Caller should hold node lock */
Ying Xue34747532015-01-09 15:27:10 +08002147static int __tipc_nl_add_node_links(struct net *net, struct tipc_nl_msg *msg,
2148 struct tipc_node *node, u32 *prev_link)
Richard Alpe7be57fc2014-11-20 10:29:12 +01002149{
2150 u32 i;
2151 int err;
2152
2153 for (i = *prev_link; i < MAX_BEARERS; i++) {
2154 *prev_link = i;
2155
2156 if (!node->links[i])
2157 continue;
2158
Ying Xue34747532015-01-09 15:27:10 +08002159 err = __tipc_nl_add_link(net, msg, node->links[i]);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002160 if (err)
2161 return err;
2162 }
2163 *prev_link = 0;
2164
2165 return 0;
2166}
2167
2168int tipc_nl_link_dump(struct sk_buff *skb, struct netlink_callback *cb)
2169{
Ying Xuef2f98002015-01-09 15:27:05 +08002170 struct net *net = sock_net(skb->sk);
2171 struct tipc_net *tn = net_generic(net, tipc_net_id);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002172 struct tipc_node *node;
2173 struct tipc_nl_msg msg;
2174 u32 prev_node = cb->args[0];
2175 u32 prev_link = cb->args[1];
2176 int done = cb->args[2];
2177 int err;
2178
2179 if (done)
2180 return 0;
2181
2182 msg.skb = skb;
2183 msg.portid = NETLINK_CB(cb->skb).portid;
2184 msg.seq = cb->nlh->nlmsg_seq;
2185
2186 rcu_read_lock();
2187
2188 if (prev_node) {
Ying Xuef2f98002015-01-09 15:27:05 +08002189 node = tipc_node_find(net, prev_node);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002190 if (!node) {
2191 /* We never set seq or call nl_dump_check_consistent()
2192 * this means that setting prev_seq here will cause the
2193 * consistence check to fail in the netlink callback
2194 * handler. Resulting in the last NLMSG_DONE message
2195 * having the NLM_F_DUMP_INTR flag set.
2196 */
2197 cb->prev_seq = 1;
2198 goto out;
2199 }
2200
Ying Xuef2f98002015-01-09 15:27:05 +08002201 list_for_each_entry_continue_rcu(node, &tn->node_list,
2202 list) {
Richard Alpe7be57fc2014-11-20 10:29:12 +01002203 tipc_node_lock(node);
Ying Xue34747532015-01-09 15:27:10 +08002204 err = __tipc_nl_add_node_links(net, &msg, node,
2205 &prev_link);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002206 tipc_node_unlock(node);
2207 if (err)
2208 goto out;
2209
2210 prev_node = node->addr;
2211 }
2212 } else {
Ying Xue1da46562015-01-09 15:27:07 +08002213 err = tipc_nl_add_bc_link(net, &msg);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002214 if (err)
2215 goto out;
2216
Ying Xuef2f98002015-01-09 15:27:05 +08002217 list_for_each_entry_rcu(node, &tn->node_list, list) {
Richard Alpe7be57fc2014-11-20 10:29:12 +01002218 tipc_node_lock(node);
Ying Xue34747532015-01-09 15:27:10 +08002219 err = __tipc_nl_add_node_links(net, &msg, node,
2220 &prev_link);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002221 tipc_node_unlock(node);
2222 if (err)
2223 goto out;
2224
2225 prev_node = node->addr;
2226 }
2227 }
2228 done = 1;
2229out:
2230 rcu_read_unlock();
2231
2232 cb->args[0] = prev_node;
2233 cb->args[1] = prev_link;
2234 cb->args[2] = done;
2235
2236 return skb->len;
2237}
2238
2239int tipc_nl_link_get(struct sk_buff *skb, struct genl_info *info)
2240{
Ying Xuef2f98002015-01-09 15:27:05 +08002241 struct net *net = genl_info_net(info);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002242 struct sk_buff *ans_skb;
2243 struct tipc_nl_msg msg;
2244 struct tipc_link *link;
2245 struct tipc_node *node;
2246 char *name;
2247 int bearer_id;
2248 int err;
2249
2250 if (!info->attrs[TIPC_NLA_LINK_NAME])
2251 return -EINVAL;
2252
2253 name = nla_data(info->attrs[TIPC_NLA_LINK_NAME]);
Ying Xuef2f98002015-01-09 15:27:05 +08002254 node = tipc_link_find_owner(net, name, &bearer_id);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002255 if (!node)
2256 return -EINVAL;
2257
2258 ans_skb = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
2259 if (!ans_skb)
2260 return -ENOMEM;
2261
2262 msg.skb = ans_skb;
2263 msg.portid = info->snd_portid;
2264 msg.seq = info->snd_seq;
2265
2266 tipc_node_lock(node);
2267 link = node->links[bearer_id];
2268 if (!link) {
2269 err = -EINVAL;
2270 goto err_out;
2271 }
2272
Ying Xue34747532015-01-09 15:27:10 +08002273 err = __tipc_nl_add_link(net, &msg, link);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002274 if (err)
2275 goto err_out;
2276
2277 tipc_node_unlock(node);
2278
2279 return genlmsg_reply(ans_skb, info);
2280
2281err_out:
2282 tipc_node_unlock(node);
2283 nlmsg_free(ans_skb);
2284
2285 return err;
2286}
Richard Alpeae363422014-11-20 10:29:14 +01002287
2288int tipc_nl_link_reset_stats(struct sk_buff *skb, struct genl_info *info)
2289{
2290 int err;
2291 char *link_name;
2292 unsigned int bearer_id;
2293 struct tipc_link *link;
2294 struct tipc_node *node;
2295 struct nlattr *attrs[TIPC_NLA_LINK_MAX + 1];
Richard Alpe18178772015-02-09 09:50:09 +01002296 struct net *net = sock_net(skb->sk);
Richard Alpeae363422014-11-20 10:29:14 +01002297
2298 if (!info->attrs[TIPC_NLA_LINK])
2299 return -EINVAL;
2300
2301 err = nla_parse_nested(attrs, TIPC_NLA_LINK_MAX,
2302 info->attrs[TIPC_NLA_LINK],
2303 tipc_nl_link_policy);
2304 if (err)
2305 return err;
2306
2307 if (!attrs[TIPC_NLA_LINK_NAME])
2308 return -EINVAL;
2309
2310 link_name = nla_data(attrs[TIPC_NLA_LINK_NAME]);
2311
2312 if (strcmp(link_name, tipc_bclink_name) == 0) {
Ying Xue1da46562015-01-09 15:27:07 +08002313 err = tipc_bclink_reset_stats(net);
Richard Alpeae363422014-11-20 10:29:14 +01002314 if (err)
2315 return err;
2316 return 0;
2317 }
2318
Ying Xuef2f98002015-01-09 15:27:05 +08002319 node = tipc_link_find_owner(net, link_name, &bearer_id);
Richard Alpeae363422014-11-20 10:29:14 +01002320 if (!node)
2321 return -EINVAL;
2322
2323 tipc_node_lock(node);
2324
2325 link = node->links[bearer_id];
2326 if (!link) {
2327 tipc_node_unlock(node);
2328 return -EINVAL;
2329 }
2330
2331 link_reset_statistics(link);
2332
2333 tipc_node_unlock(node);
2334
2335 return 0;
2336}