blob: 466f28fcf2151806907b71f03582b42e2fa3bc8d [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 Maloy170b3922014-01-07 17:02:41 -05004 * Copyright (c) 1996-2007, 2012-2014, Ericsson AB
Ying Xue198d73b2013-06-17 10:54:42 -04005 * Copyright (c) 2004-2007, 2010-2013, Wind River Systems
Per Lidenb97bf3f2006-01-02 19:04:38 +01006 * All rights reserved.
7 *
Per Liden9ea1fd32006-01-11 13:30:43 +01008 * Redistribution and use in source and binary forms, with or without
Per Lidenb97bf3f2006-01-02 19:04:38 +01009 * modification, are permitted provided that the following conditions are met:
10 *
Per Liden9ea1fd32006-01-11 13:30:43 +010011 * 1. Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the distribution.
16 * 3. Neither the names of the copyright holders nor the names of its
17 * contributors may be used to endorse or promote products derived from
18 * this software without specific prior written permission.
Per Lidenb97bf3f2006-01-02 19:04:38 +010019 *
Per Liden9ea1fd32006-01-11 13:30:43 +010020 * Alternatively, this software may be distributed under the terms of the
21 * GNU General Public License ("GPL") version 2 as published by the Free
22 * Software Foundation.
23 *
24 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
25 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
26 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
27 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
28 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
29 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
30 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
31 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
32 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
33 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
Per Lidenb97bf3f2006-01-02 19:04:38 +010034 * POSSIBILITY OF SUCH DAMAGE.
35 */
36
37#include "core.h"
Per Lidenb97bf3f2006-01-02 19:04:38 +010038#include "link.h"
Richard Alpe7be57fc2014-11-20 10:29:12 +010039#include "bcast.h"
Jon Paul Maloy9816f062014-05-14 05:39:15 -040040#include "socket.h"
Per Lidenb97bf3f2006-01-02 19:04:38 +010041#include "name_distr.h"
Per Lidenb97bf3f2006-01-02 19:04:38 +010042#include "discover.h"
43#include "config.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 */
Ying Xue58dc55f2014-11-26 11:41:52 +0800198 l_ptr->stats.accu_queue_sz += skb_queue_len(&l_ptr->outqueue);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100199 l_ptr->stats.queue_sz_counts++;
200
Ying Xue58dc55f2014-11-26 11:41:52 +0800201 skb = skb_peek(&l_ptr->outqueue);
202 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
233 if (l_ptr->next_out)
Ying Xue47b4c9a82014-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);
309
310 l_ptr->priority = b_ptr->priority;
Allan Stephens5c216e12011-10-18 11:34:29 -0400311 tipc_link_set_queue_limits(l_ptr, b_ptr->window);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100312
Ying Xue7a2f7d12014-04-21 10:55:46 +0800313 l_ptr->net_plane = b_ptr->net_plane;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100314 link_init_max_pkt(l_ptr);
315
316 l_ptr->next_out_no = 1;
Ying Xue58dc55f2014-11-26 11:41:52 +0800317 __skb_queue_head_init(&l_ptr->outqueue);
Ying Xuebc6fecd2014-11-26 11:41:53 +0800318 __skb_queue_head_init(&l_ptr->deferred_queue);
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500319 skb_queue_head_init(&l_ptr->wakeupq);
320 skb_queue_head_init(&l_ptr->inputq);
321 skb_queue_head_init(&l_ptr->namedq);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100322 link_reset_statistics(l_ptr);
Allan Stephens37b9c082011-02-28 11:32:27 -0500323 tipc_node_attach_link(n_ptr, l_ptr);
Ying Xue2f55c432015-01-09 15:27:00 +0800324 setup_timer(&l_ptr->timer, link_timeout, (unsigned long)l_ptr);
Jon Paul Maloy581465f2014-01-07 17:02:44 -0500325 link_state_event(l_ptr, STARTING_EVT);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100326
Per Lidenb97bf3f2006-01-02 19:04:38 +0100327 return l_ptr;
328}
329
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500330/**
331 * link_delete - Conditional deletion of link.
332 * If timer still running, real delete is done when it expires
333 * @link: link to be deleted
334 */
335void tipc_link_delete(struct tipc_link *link)
336{
337 tipc_link_reset_fragments(link);
338 tipc_node_detach_link(link->owner, link);
339 tipc_link_put(link);
340}
341
Ying Xuef2f98002015-01-09 15:27:05 +0800342void tipc_link_delete_list(struct net *net, unsigned int bearer_id,
343 bool shutting_down)
Ying Xue8d8439b2014-02-13 17:29:07 -0500344{
Ying Xuef2f98002015-01-09 15:27:05 +0800345 struct tipc_net *tn = net_generic(net, tipc_net_id);
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500346 struct tipc_link *link;
347 struct tipc_node *node;
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 Maloy2d72d492015-02-03 08:59:17 -0500357 tipc_link_reset(link);
358 if (del_timer(&link->timer))
359 tipc_link_put(link);
360 link->flags |= LINK_STOPPED;
361 /* Delete link now, or when failover is finished: */
362 if (shutting_down || !tipc_node_is_up(node))
363 tipc_link_delete(link);
364 tipc_node_unlock(node);
Ying Xue8d8439b2014-02-13 17:29:07 -0500365 }
Ying Xue6c7a7622014-03-27 12:54:37 +0800366 rcu_read_unlock();
Ying Xue8d8439b2014-02-13 17:29:07 -0500367}
Per Lidenb97bf3f2006-01-02 19:04:38 +0100368
369/**
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400370 * link_schedule_user - schedule user for wakeup after congestion
371 * @link: congested link
372 * @oport: sending port
373 * @chain_sz: size of buffer chain that was attempted sent
374 * @imp: importance of message attempted sent
375 * Create pseudo msg to send back to user when congestion abates
Per Lidenb97bf3f2006-01-02 19:04:38 +0100376 */
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400377static bool link_schedule_user(struct tipc_link *link, u32 oport,
378 uint chain_sz, uint imp)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100379{
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400380 struct sk_buff *buf;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100381
Jon Paul Maloyc5898632015-02-05 08:36:36 -0500382 buf = tipc_msg_create(SOCK_WAKEUP, 0, INT_H_SIZE, 0,
383 link_own_addr(link), link_own_addr(link),
384 oport, 0, 0);
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400385 if (!buf)
386 return false;
387 TIPC_SKB_CB(buf)->chain_sz = chain_sz;
388 TIPC_SKB_CB(buf)->chain_imp = imp;
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500389 skb_queue_tail(&link->wakeupq, buf);
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400390 link->stats.link_congs++;
391 return true;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100392}
393
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400394/**
395 * link_prepare_wakeup - prepare users for wakeup after congestion
396 * @link: congested link
397 * Move a number of waiting users, as permitted by available space in
398 * the send queue, from link wait queue to node wait queue for wakeup
399 */
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500400void link_prepare_wakeup(struct tipc_link *link)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100401{
Ying Xue58dc55f2014-11-26 11:41:52 +0800402 uint pend_qsz = skb_queue_len(&link->outqueue);
Ying Xue58d78b32014-11-26 11:41:51 +0800403 struct sk_buff *skb, *tmp;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100404
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500405 skb_queue_walk_safe(&link->wakeupq, skb, tmp) {
Ying Xue58d78b32014-11-26 11:41:51 +0800406 if (pend_qsz >= link->queue_limit[TIPC_SKB_CB(skb)->chain_imp])
Per Lidenb97bf3f2006-01-02 19:04:38 +0100407 break;
Ying Xue58d78b32014-11-26 11:41:51 +0800408 pend_qsz += TIPC_SKB_CB(skb)->chain_sz;
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500409 skb_unlink(skb, &link->wakeupq);
410 skb_queue_tail(&link->inputq, skb);
411 link->owner->inputq = &link->inputq;
412 link->owner->action_flags |= TIPC_MSG_EVT;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100413 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100414}
415
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900416/**
Per Liden4323add2006-01-18 00:38:21 +0100417 * tipc_link_reset_fragments - purge link's inbound message fragments queue
Per Lidenb97bf3f2006-01-02 19:04:38 +0100418 * @l_ptr: pointer to link
419 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500420void tipc_link_reset_fragments(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100421{
Jon Paul Maloy37e22162014-05-14 05:39:12 -0400422 kfree_skb(l_ptr->reasm_buf);
423 l_ptr->reasm_buf = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100424}
425
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900426/**
Jon Paul Maloy581465f2014-01-07 17:02:44 -0500427 * tipc_link_purge_queues - purge all pkt queues associated with link
Per Lidenb97bf3f2006-01-02 19:04:38 +0100428 * @l_ptr: pointer to link
429 */
Jon Paul Maloy581465f2014-01-07 17:02:44 -0500430void tipc_link_purge_queues(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100431{
Ying Xuebc6fecd2014-11-26 11:41:53 +0800432 __skb_queue_purge(&l_ptr->deferred_queue);
Ying Xue58dc55f2014-11-26 11:41:52 +0800433 __skb_queue_purge(&l_ptr->outqueue);
Per Liden4323add2006-01-18 00:38:21 +0100434 tipc_link_reset_fragments(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100435}
436
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500437void tipc_link_reset(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100438{
Per Lidenb97bf3f2006-01-02 19:04:38 +0100439 u32 prev_state = l_ptr->state;
440 u32 checkpoint = l_ptr->next_in_no;
Allan Stephens5392d642006-06-25 23:52:50 -0700441 int was_active_link = tipc_link_is_active(l_ptr);
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400442 struct tipc_node *owner = l_ptr->owner;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900443
Allan Stephensa686e682008-06-04 17:29:39 -0700444 msg_set_session(l_ptr->pmsg, ((msg_session(l_ptr->pmsg) + 1) & 0xffff));
Per Lidenb97bf3f2006-01-02 19:04:38 +0100445
Allan Stephensa686e682008-06-04 17:29:39 -0700446 /* Link is down, accept any session */
447 l_ptr->peer_session = INVALID_SESSION;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100448
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900449 /* Prepare for max packet size negotiation */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100450 link_init_max_pkt(l_ptr);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900451
Per Lidenb97bf3f2006-01-02 19:04:38 +0100452 l_ptr->state = RESET_UNKNOWN;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100453
454 if ((prev_state == RESET_UNKNOWN) || (prev_state == RESET_RESET))
455 return;
456
Per Liden4323add2006-01-18 00:38:21 +0100457 tipc_node_link_down(l_ptr->owner, l_ptr);
Ying Xue7f9f95d2015-01-09 15:27:06 +0800458 tipc_bearer_remove_dest(owner->net, l_ptr->bearer_id, l_ptr->addr);
Paul Gortmaker7368ddf2010-10-12 14:25:58 +0000459
Jon Paul Maloyb9d4c332014-01-07 17:02:42 -0500460 if (was_active_link && tipc_node_active_links(l_ptr->owner)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100461 l_ptr->reset_checkpoint = checkpoint;
462 l_ptr->exp_msg_count = START_CHANGEOVER;
463 }
464
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500465 /* Clean up all queues, except inputq: */
Ying Xue58dc55f2014-11-26 11:41:52 +0800466 __skb_queue_purge(&l_ptr->outqueue);
Ying Xuebc6fecd2014-11-26 11:41:53 +0800467 __skb_queue_purge(&l_ptr->deferred_queue);
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500468 skb_queue_splice_init(&l_ptr->wakeupq, &l_ptr->inputq);
469 if (!skb_queue_empty(&l_ptr->inputq))
470 owner->action_flags |= TIPC_MSG_EVT;
471 owner->inputq = &l_ptr->inputq;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100472 l_ptr->next_out = NULL;
473 l_ptr->unacked_window = 0;
474 l_ptr->checkpoint = 1;
475 l_ptr->next_out_no = 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100476 l_ptr->fsm_msg_cnt = 0;
477 l_ptr->stale_count = 0;
478 link_reset_statistics(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100479}
480
Ying Xuef2f98002015-01-09 15:27:05 +0800481void tipc_link_reset_list(struct net *net, unsigned int bearer_id)
Ying Xuee0ca2c32014-02-13 17:29:06 -0500482{
Ying Xuef2f98002015-01-09 15:27:05 +0800483 struct tipc_net *tn = net_generic(net, tipc_net_id);
Ying Xuee0ca2c32014-02-13 17:29:06 -0500484 struct tipc_link *l_ptr;
Ying Xuec61dd612014-02-13 17:29:09 -0500485 struct tipc_node *n_ptr;
Ying Xuee0ca2c32014-02-13 17:29:06 -0500486
Ying Xue6c7a7622014-03-27 12:54:37 +0800487 rcu_read_lock();
Ying Xuef2f98002015-01-09 15:27:05 +0800488 list_for_each_entry_rcu(n_ptr, &tn->node_list, list) {
Ying Xue5356f3d2014-05-05 08:56:09 +0800489 tipc_node_lock(n_ptr);
Ying Xuec61dd612014-02-13 17:29:09 -0500490 l_ptr = n_ptr->links[bearer_id];
491 if (l_ptr)
492 tipc_link_reset(l_ptr);
Ying Xue5356f3d2014-05-05 08:56:09 +0800493 tipc_node_unlock(n_ptr);
Ying Xuee0ca2c32014-02-13 17:29:06 -0500494 }
Ying Xue6c7a7622014-03-27 12:54:37 +0800495 rcu_read_unlock();
Ying Xuee0ca2c32014-02-13 17:29:06 -0500496}
Per Lidenb97bf3f2006-01-02 19:04:38 +0100497
Ying Xue7f9f95d2015-01-09 15:27:06 +0800498static void link_activate(struct tipc_link *link)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100499{
Ying Xue7f9f95d2015-01-09 15:27:06 +0800500 struct tipc_node *node = link->owner;
501
502 link->next_in_no = 1;
503 link->stats.recv_info = 1;
504 tipc_node_link_up(node, link);
505 tipc_bearer_add_dest(node->net, link->bearer_id, link->addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100506}
507
508/**
509 * link_state_event - link finite state machine
510 * @l_ptr: pointer to link
511 * @event: state machine event to process
512 */
Eric Dumazet95c96172012-04-15 05:58:06 +0000513static void link_state_event(struct tipc_link *l_ptr, unsigned int event)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100514{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500515 struct tipc_link *other;
Ying Xue2f55c432015-01-09 15:27:00 +0800516 unsigned long cont_intv = l_ptr->cont_intv;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100517
Jon Paul Maloy7d339392014-02-13 17:29:16 -0500518 if (l_ptr->flags & LINK_STOPPED)
519 return;
520
Ying Xue135daee2014-02-13 17:29:08 -0500521 if (!(l_ptr->flags & LINK_STARTED) && (event != STARTING_EVT))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100522 return; /* Not yet. */
523
Ying Xue77a7e072013-12-10 20:45:44 -0800524 /* Check whether changeover is going on */
525 if (l_ptr->exp_msg_count) {
Allan Stephensa0168922010-12-31 18:59:35 +0000526 if (event == TIMEOUT_EVT)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100527 link_set_timer(l_ptr, cont_intv);
Ying Xue77a7e072013-12-10 20:45:44 -0800528 return;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100529 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100530
531 switch (l_ptr->state) {
532 case WORKING_WORKING:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100533 switch (event) {
534 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100535 case ACTIVATE_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100536 break;
537 case TIMEOUT_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100538 if (l_ptr->next_in_no != l_ptr->checkpoint) {
539 l_ptr->checkpoint = l_ptr->next_in_no;
Per Liden4323add2006-01-18 00:38:21 +0100540 if (tipc_bclink_acks_missing(l_ptr->owner)) {
Ying Xue247f0f32014-02-18 16:06:46 +0800541 tipc_link_proto_xmit(l_ptr, STATE_MSG,
542 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100543 l_ptr->fsm_msg_cnt++;
544 } else if (l_ptr->max_pkt < l_ptr->max_pkt_target) {
Ying Xue247f0f32014-02-18 16:06:46 +0800545 tipc_link_proto_xmit(l_ptr, STATE_MSG,
546 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100547 l_ptr->fsm_msg_cnt++;
548 }
549 link_set_timer(l_ptr, cont_intv);
550 break;
551 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100552 l_ptr->state = WORKING_UNKNOWN;
553 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800554 tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100555 l_ptr->fsm_msg_cnt++;
556 link_set_timer(l_ptr, cont_intv / 4);
557 break;
558 case RESET_MSG:
Erik Hugne3fa9cac2015-01-22 17:10:31 +0100559 pr_debug("%s<%s>, requested by peer\n",
560 link_rst_msg, l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100561 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100562 l_ptr->state = RESET_RESET;
563 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800564 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
565 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100566 l_ptr->fsm_msg_cnt++;
567 link_set_timer(l_ptr, cont_intv);
568 break;
569 default:
Erik Hugne3fa9cac2015-01-22 17:10:31 +0100570 pr_debug("%s%u in WW state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100571 }
572 break;
573 case WORKING_UNKNOWN:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100574 switch (event) {
575 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100576 case ACTIVATE_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100577 l_ptr->state = WORKING_WORKING;
578 l_ptr->fsm_msg_cnt = 0;
579 link_set_timer(l_ptr, cont_intv);
580 break;
581 case RESET_MSG:
Erik Hugne3fa9cac2015-01-22 17:10:31 +0100582 pr_debug("%s<%s>, requested by peer while probing\n",
583 link_rst_msg, l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100584 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100585 l_ptr->state = RESET_RESET;
586 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800587 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
588 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100589 l_ptr->fsm_msg_cnt++;
590 link_set_timer(l_ptr, cont_intv);
591 break;
592 case TIMEOUT_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100593 if (l_ptr->next_in_no != l_ptr->checkpoint) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100594 l_ptr->state = WORKING_WORKING;
595 l_ptr->fsm_msg_cnt = 0;
596 l_ptr->checkpoint = l_ptr->next_in_no;
Per Liden4323add2006-01-18 00:38:21 +0100597 if (tipc_bclink_acks_missing(l_ptr->owner)) {
Ying Xue247f0f32014-02-18 16:06:46 +0800598 tipc_link_proto_xmit(l_ptr, STATE_MSG,
599 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100600 l_ptr->fsm_msg_cnt++;
601 }
602 link_set_timer(l_ptr, cont_intv);
603 } else if (l_ptr->fsm_msg_cnt < l_ptr->abort_limit) {
Ying Xue247f0f32014-02-18 16:06:46 +0800604 tipc_link_proto_xmit(l_ptr, STATE_MSG,
605 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100606 l_ptr->fsm_msg_cnt++;
607 link_set_timer(l_ptr, cont_intv / 4);
608 } else { /* Link has failed */
Erik Hugne3fa9cac2015-01-22 17:10:31 +0100609 pr_debug("%s<%s>, peer not responding\n",
610 link_rst_msg, l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100611 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100612 l_ptr->state = RESET_UNKNOWN;
613 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800614 tipc_link_proto_xmit(l_ptr, RESET_MSG,
615 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100616 l_ptr->fsm_msg_cnt++;
617 link_set_timer(l_ptr, cont_intv);
618 }
619 break;
620 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400621 pr_err("%s%u in WU state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100622 }
623 break;
624 case RESET_UNKNOWN:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100625 switch (event) {
626 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100627 break;
628 case ACTIVATE_MSG:
629 other = l_ptr->owner->active_links[0];
Allan Stephens8d64a5b2010-12-31 18:59:27 +0000630 if (other && link_working_unknown(other))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100631 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100632 l_ptr->state = WORKING_WORKING;
633 l_ptr->fsm_msg_cnt = 0;
634 link_activate(l_ptr);
Ying Xue247f0f32014-02-18 16:06:46 +0800635 tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100636 l_ptr->fsm_msg_cnt++;
Jon Maloyc64f7a62012-11-16 13:51:31 +0800637 if (l_ptr->owner->working_links == 1)
Ying Xue247f0f32014-02-18 16:06:46 +0800638 tipc_link_sync_xmit(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100639 link_set_timer(l_ptr, cont_intv);
640 break;
641 case RESET_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100642 l_ptr->state = RESET_RESET;
643 l_ptr->fsm_msg_cnt = 0;
Ying Xue247f0f32014-02-18 16:06:46 +0800644 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
645 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100646 l_ptr->fsm_msg_cnt++;
647 link_set_timer(l_ptr, cont_intv);
648 break;
649 case STARTING_EVT:
Ying Xue135daee2014-02-13 17:29:08 -0500650 l_ptr->flags |= LINK_STARTED;
Jon Paul Maloyaf9946f2015-02-03 08:59:20 -0500651 l_ptr->fsm_msg_cnt++;
652 link_set_timer(l_ptr, cont_intv);
653 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100654 case TIMEOUT_EVT:
Ying Xue247f0f32014-02-18 16:06:46 +0800655 tipc_link_proto_xmit(l_ptr, RESET_MSG, 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100656 l_ptr->fsm_msg_cnt++;
657 link_set_timer(l_ptr, cont_intv);
658 break;
659 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400660 pr_err("%s%u in RU state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100661 }
662 break;
663 case RESET_RESET:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100664 switch (event) {
665 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100666 case ACTIVATE_MSG:
667 other = l_ptr->owner->active_links[0];
Allan Stephens8d64a5b2010-12-31 18:59:27 +0000668 if (other && link_working_unknown(other))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100669 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100670 l_ptr->state = WORKING_WORKING;
671 l_ptr->fsm_msg_cnt = 0;
672 link_activate(l_ptr);
Ying Xue247f0f32014-02-18 16:06:46 +0800673 tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100674 l_ptr->fsm_msg_cnt++;
Jon Maloyc64f7a62012-11-16 13:51:31 +0800675 if (l_ptr->owner->working_links == 1)
Ying Xue247f0f32014-02-18 16:06:46 +0800676 tipc_link_sync_xmit(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100677 link_set_timer(l_ptr, cont_intv);
678 break;
679 case RESET_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100680 break;
681 case TIMEOUT_EVT:
Ying Xue247f0f32014-02-18 16:06:46 +0800682 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
683 0, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100684 l_ptr->fsm_msg_cnt++;
685 link_set_timer(l_ptr, cont_intv);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100686 break;
687 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400688 pr_err("%s%u in RR state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100689 }
690 break;
691 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400692 pr_err("Unknown link state %u/%u\n", l_ptr->state, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100693 }
694}
695
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500696/* tipc_link_cong: determine return value and how to treat the
697 * sent buffer during link congestion.
698 * - For plain, errorless user data messages we keep the buffer and
699 * return -ELINKONG.
700 * - For all other messages we discard the buffer and return -EHOSTUNREACH
701 * - For TIPC internal messages we also reset the link
702 */
Ying Xuea6ca1092014-11-26 11:41:55 +0800703static int tipc_link_cong(struct tipc_link *link, struct sk_buff_head *list)
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500704{
Ying Xuea6ca1092014-11-26 11:41:55 +0800705 struct sk_buff *skb = skb_peek(list);
706 struct tipc_msg *msg = buf_msg(skb);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500707 uint imp = tipc_msg_tot_importance(msg);
708 u32 oport = msg_tot_origport(msg);
709
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400710 if (unlikely(imp > TIPC_CRITICAL_IMPORTANCE)) {
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500711 pr_warn("%s<%s>, send queue full", link_rst_msg, link->name);
712 tipc_link_reset(link);
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400713 goto drop;
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500714 }
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400715 if (unlikely(msg_errcode(msg)))
716 goto drop;
717 if (unlikely(msg_reroute_cnt(msg)))
718 goto drop;
Ying Xuea6ca1092014-11-26 11:41:55 +0800719 if (TIPC_SKB_CB(skb)->wakeup_pending)
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400720 return -ELINKCONG;
Ying Xuea6ca1092014-11-26 11:41:55 +0800721 if (link_schedule_user(link, oport, skb_queue_len(list), imp))
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400722 return -ELINKCONG;
723drop:
Ying Xuea6ca1092014-11-26 11:41:55 +0800724 __skb_queue_purge(list);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500725 return -EHOSTUNREACH;
726}
727
728/**
Jon Paul Maloy9fbfb8b2014-07-16 20:41:03 -0400729 * __tipc_link_xmit(): same as tipc_link_xmit, but destlink is known & locked
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500730 * @link: link to use
Ying Xuea6ca1092014-11-26 11:41:55 +0800731 * @list: chain of buffers containing message
732 *
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500733 * Consumes the buffer chain, except when returning -ELINKCONG
734 * Returns 0 if success, otherwise errno: -ELINKCONG, -EMSGSIZE (plain socket
735 * user data messages) or -EHOSTUNREACH (all other messages/senders)
736 * Only the socket functions tipc_send_stream() and tipc_send_packet() need
737 * to act on the return value, since they may need to do more send attempts.
738 */
Ying Xue7f9f95d2015-01-09 15:27:06 +0800739int __tipc_link_xmit(struct net *net, struct tipc_link *link,
740 struct sk_buff_head *list)
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500741{
Ying Xuea6ca1092014-11-26 11:41:55 +0800742 struct tipc_msg *msg = buf_msg(skb_peek(list));
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500743 uint psz = msg_size(msg);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500744 uint sndlim = link->queue_limit[0];
745 uint imp = tipc_msg_tot_importance(msg);
746 uint mtu = link->max_pkt;
747 uint ack = mod(link->next_in_no - 1);
748 uint seqno = link->next_out_no;
749 uint bc_last_in = link->owner->bclink.last_in;
750 struct tipc_media_addr *addr = &link->media_addr;
Ying Xue58dc55f2014-11-26 11:41:52 +0800751 struct sk_buff_head *outqueue = &link->outqueue;
Ying Xuea6ca1092014-11-26 11:41:55 +0800752 struct sk_buff *skb, *tmp;
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500753
754 /* Match queue limits against msg importance: */
Ying Xue58dc55f2014-11-26 11:41:52 +0800755 if (unlikely(skb_queue_len(outqueue) >= link->queue_limit[imp]))
Ying Xuea6ca1092014-11-26 11:41:55 +0800756 return tipc_link_cong(link, list);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500757
758 /* Has valid packet limit been used ? */
759 if (unlikely(psz > mtu)) {
Ying Xuea6ca1092014-11-26 11:41:55 +0800760 __skb_queue_purge(list);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500761 return -EMSGSIZE;
762 }
763
764 /* Prepare each packet for sending, and add to outqueue: */
Ying Xuea6ca1092014-11-26 11:41:55 +0800765 skb_queue_walk_safe(list, skb, tmp) {
766 __skb_unlink(skb, list);
Ying Xue58dc55f2014-11-26 11:41:52 +0800767 msg = buf_msg(skb);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500768 msg_set_word(msg, 2, ((ack << 16) | mod(seqno)));
769 msg_set_bcast_ack(msg, bc_last_in);
770
Ying Xue58dc55f2014-11-26 11:41:52 +0800771 if (skb_queue_len(outqueue) < sndlim) {
772 __skb_queue_tail(outqueue, skb);
Ying Xue7f9f95d2015-01-09 15:27:06 +0800773 tipc_bearer_send(net, link->bearer_id,
774 skb, addr);
Ying Xue58dc55f2014-11-26 11:41:52 +0800775 link->next_out = NULL;
776 link->unacked_window = 0;
777 } else if (tipc_msg_bundle(outqueue, skb, mtu)) {
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500778 link->stats.sent_bundled++;
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500779 continue;
Jon Paul Maloyc5898632015-02-05 08:36:36 -0500780 } else if (tipc_msg_make_bundle(outqueue, skb, mtu,
Ying Xue58dc55f2014-11-26 11:41:52 +0800781 link->addr)) {
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500782 link->stats.sent_bundled++;
783 link->stats.sent_bundles++;
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500784 if (!link->next_out)
Ying Xue58dc55f2014-11-26 11:41:52 +0800785 link->next_out = skb_peek_tail(outqueue);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500786 } else {
Ying Xue58dc55f2014-11-26 11:41:52 +0800787 __skb_queue_tail(outqueue, skb);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500788 if (!link->next_out)
Ying Xue58dc55f2014-11-26 11:41:52 +0800789 link->next_out = skb;
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500790 }
791 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
Ying Xue58dc55f2014-11-26 11:41:52 +0800896struct sk_buff *tipc_skb_queue_next(const struct sk_buff_head *list,
897 const struct sk_buff *skb)
898{
899 if (skb_queue_is_last(list, skb))
900 return NULL;
901 return skb->next;
902}
903
Jon Maloyc64f7a62012-11-16 13:51:31 +0800904/*
Ying Xue47b4c9a82014-11-26 11:41:48 +0800905 * tipc_link_push_packets - push unsent packets to bearer
906 *
907 * Push out the unsent messages of a link where congestion
908 * has abated. Node is locked.
909 *
910 * Called with node locked
Per Lidenb97bf3f2006-01-02 19:04:38 +0100911 */
Ying Xue47b4c9a82014-11-26 11:41:48 +0800912void tipc_link_push_packets(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100913{
Ying Xue58dc55f2014-11-26 11:41:52 +0800914 struct sk_buff_head *outqueue = &l_ptr->outqueue;
915 struct sk_buff *skb = l_ptr->next_out;
Ying Xue47b4c9a82014-11-26 11:41:48 +0800916 struct tipc_msg *msg;
917 u32 next, first;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100918
Ying Xue58dc55f2014-11-26 11:41:52 +0800919 skb_queue_walk_from(outqueue, skb) {
Ying Xue47b4c9a82014-11-26 11:41:48 +0800920 msg = buf_msg(skb);
921 next = msg_seqno(msg);
Ying Xue58dc55f2014-11-26 11:41:52 +0800922 first = buf_seqno(skb_peek(outqueue));
Per Lidenb97bf3f2006-01-02 19:04:38 +0100923
924 if (mod(next - first) < l_ptr->queue_limit[0]) {
925 msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900926 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Ying Xue3c294cb2012-11-15 11:34:45 +0800927 if (msg_user(msg) == MSG_BUNDLER)
Ying Xue58311d12014-11-26 11:41:49 +0800928 TIPC_SKB_CB(skb)->bundling = false;
Ying Xue7f9f95d2015-01-09 15:27:06 +0800929 tipc_bearer_send(l_ptr->owner->net,
930 l_ptr->bearer_id, skb,
Ying Xue47b4c9a82014-11-26 11:41:48 +0800931 &l_ptr->media_addr);
Ying Xue58dc55f2014-11-26 11:41:52 +0800932 l_ptr->next_out = tipc_skb_queue_next(outqueue, skb);
Ying Xue47b4c9a82014-11-26 11:41:48 +0800933 } else {
934 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100935 }
936 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100937}
938
Ying Xue3f5a12b2014-05-05 08:56:17 +0800939void tipc_link_reset_all(struct tipc_node *node)
Allan Stephensd356eeb2006-06-25 23:40:01 -0700940{
Allan Stephensd356eeb2006-06-25 23:40:01 -0700941 char addr_string[16];
942 u32 i;
943
Ying Xue3f5a12b2014-05-05 08:56:17 +0800944 tipc_node_lock(node);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700945
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400946 pr_warn("Resetting all links to %s\n",
Ying Xue3f5a12b2014-05-05 08:56:17 +0800947 tipc_addr_string_fill(addr_string, node->addr));
Allan Stephensd356eeb2006-06-25 23:40:01 -0700948
949 for (i = 0; i < MAX_BEARERS; i++) {
Ying Xue3f5a12b2014-05-05 08:56:17 +0800950 if (node->links[i]) {
951 link_print(node->links[i], "Resetting link\n");
952 tipc_link_reset(node->links[i]);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700953 }
954 }
955
Ying Xue3f5a12b2014-05-05 08:56:17 +0800956 tipc_node_unlock(node);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700957}
958
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500959static void link_retransmit_failure(struct tipc_link *l_ptr,
Paul Gortmakerae8509c2013-06-17 10:54:47 -0400960 struct sk_buff *buf)
Allan Stephensd356eeb2006-06-25 23:40:01 -0700961{
962 struct tipc_msg *msg = buf_msg(buf);
Ying Xue1da46562015-01-09 15:27:07 +0800963 struct net *net = l_ptr->owner->net;
Allan Stephensd356eeb2006-06-25 23:40:01 -0700964
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400965 pr_warn("Retransmission failure on link <%s>\n", l_ptr->name);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700966
967 if (l_ptr->addr) {
Allan Stephensd356eeb2006-06-25 23:40:01 -0700968 /* Handle failure on standard link */
Allan Stephens8d64a5b2010-12-31 18:59:27 +0000969 link_print(l_ptr, "Resetting link\n");
Allan Stephensd356eeb2006-06-25 23:40:01 -0700970 tipc_link_reset(l_ptr);
971
972 } else {
Allan Stephensd356eeb2006-06-25 23:40:01 -0700973 /* Handle failure on broadcast link */
David S. Miller6c000552008-09-02 23:38:32 -0700974 struct tipc_node *n_ptr;
Allan Stephensd356eeb2006-06-25 23:40:01 -0700975 char addr_string[16];
976
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400977 pr_info("Msg seq number: %u, ", msg_seqno(msg));
978 pr_cont("Outstanding acks: %lu\n",
979 (unsigned long) TIPC_SKB_CB(buf)->handle);
Jeff Garzik617dbea2006-10-03 16:25:34 -0700980
Ying Xue1da46562015-01-09 15:27:07 +0800981 n_ptr = tipc_bclink_retransmit_to(net);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700982 tipc_node_lock(n_ptr);
983
Allan Stephensc68ca7b2010-05-11 14:30:12 +0000984 tipc_addr_string_fill(addr_string, n_ptr->addr);
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400985 pr_info("Broadcast link info for %s\n", addr_string);
Ying Xue389dd9b2012-11-16 13:51:30 +0800986 pr_info("Reception permitted: %d, Acked: %u\n",
987 n_ptr->bclink.recv_permitted,
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400988 n_ptr->bclink.acked);
989 pr_info("Last in: %u, Oos state: %u, Last sent: %u\n",
990 n_ptr->bclink.last_in,
991 n_ptr->bclink.oos_state,
992 n_ptr->bclink.last_sent);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700993
Allan Stephensd356eeb2006-06-25 23:40:01 -0700994 tipc_node_unlock(n_ptr);
995
Ying Xue1da46562015-01-09 15:27:07 +0800996 tipc_bclink_set_flags(net, TIPC_BCLINK_RESET);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700997 l_ptr->stale_count = 0;
998 }
999}
1000
Ying Xue58dc55f2014-11-26 11:41:52 +08001001void tipc_link_retransmit(struct tipc_link *l_ptr, struct sk_buff *skb,
Per Liden4323add2006-01-18 00:38:21 +01001002 u32 retransmits)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001003{
1004 struct tipc_msg *msg;
1005
Ying Xue58dc55f2014-11-26 11:41:52 +08001006 if (!skb)
Allan Stephensd356eeb2006-06-25 23:40:01 -07001007 return;
1008
Ying Xue58dc55f2014-11-26 11:41:52 +08001009 msg = buf_msg(skb);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001010
Erik Hugne512137e2013-12-06 10:08:00 -05001011 /* Detect repeated retransmit failures */
1012 if (l_ptr->last_retransmitted == msg_seqno(msg)) {
1013 if (++l_ptr->stale_count > 100) {
Ying Xue58dc55f2014-11-26 11:41:52 +08001014 link_retransmit_failure(l_ptr, skb);
Erik Hugne512137e2013-12-06 10:08:00 -05001015 return;
Allan Stephensd356eeb2006-06-25 23:40:01 -07001016 }
1017 } else {
Erik Hugne512137e2013-12-06 10:08:00 -05001018 l_ptr->last_retransmitted = msg_seqno(msg);
1019 l_ptr->stale_count = 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001020 }
Allan Stephensd356eeb2006-06-25 23:40:01 -07001021
Ying Xue58dc55f2014-11-26 11:41:52 +08001022 skb_queue_walk_from(&l_ptr->outqueue, skb) {
1023 if (!retransmits || skb == l_ptr->next_out)
1024 break;
1025 msg = buf_msg(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001026 msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001027 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Ying Xue7f9f95d2015-01-09 15:27:06 +08001028 tipc_bearer_send(l_ptr->owner->net, l_ptr->bearer_id, skb,
1029 &l_ptr->media_addr);
Ying Xue3c294cb2012-11-15 11:34:45 +08001030 retransmits--;
1031 l_ptr->stats.retransmitted++;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001032 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001033}
1034
Ying Xuef03273f2014-11-26 11:41:54 +08001035static void link_retrieve_defq(struct tipc_link *link,
1036 struct sk_buff_head *list)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001037{
1038 u32 seq_no;
1039
Ying Xuef03273f2014-11-26 11:41:54 +08001040 if (skb_queue_empty(&link->deferred_queue))
1041 return;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001042
Ying Xuef03273f2014-11-26 11:41:54 +08001043 seq_no = buf_seqno(skb_peek(&link->deferred_queue));
1044 if (seq_no == mod(link->next_in_no))
1045 skb_queue_splice_tail_init(&link->deferred_queue, list);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001046}
1047
Allan Stephens85035562008-04-15 19:04:54 -07001048/**
1049 * link_recv_buf_validate - validate basic format of received message
1050 *
1051 * This routine ensures a TIPC message has an acceptable header, and at least
1052 * as much data as the header indicates it should. The routine also ensures
1053 * that the entire message header is stored in the main fragment of the message
1054 * buffer, to simplify future access to message header fields.
1055 *
1056 * Note: Having extra info present in the message header or data areas is OK.
1057 * TIPC will ignore the excess, under the assumption that it is optional info
1058 * introduced by a later release of the protocol.
1059 */
Allan Stephens85035562008-04-15 19:04:54 -07001060static int link_recv_buf_validate(struct sk_buff *buf)
1061{
1062 static u32 min_data_hdr_size[8] = {
Allan Stephens741d9eb2011-05-31 15:03:18 -04001063 SHORT_H_SIZE, MCAST_H_SIZE, NAMED_H_SIZE, BASIC_H_SIZE,
Allan Stephens85035562008-04-15 19:04:54 -07001064 MAX_H_SIZE, MAX_H_SIZE, MAX_H_SIZE, MAX_H_SIZE
1065 };
1066
1067 struct tipc_msg *msg;
1068 u32 tipc_hdr[2];
1069 u32 size;
1070 u32 hdr_size;
1071 u32 min_hdr_size;
1072
Erik Hugne64380a02014-02-11 11:38:26 +01001073 /* If this packet comes from the defer queue, the skb has already
1074 * been validated
1075 */
1076 if (unlikely(TIPC_SKB_CB(buf)->deferred))
1077 return 1;
1078
Allan Stephens85035562008-04-15 19:04:54 -07001079 if (unlikely(buf->len < MIN_H_SIZE))
1080 return 0;
1081
1082 msg = skb_header_pointer(buf, 0, sizeof(tipc_hdr), tipc_hdr);
1083 if (msg == NULL)
1084 return 0;
1085
1086 if (unlikely(msg_version(msg) != TIPC_VERSION))
1087 return 0;
1088
1089 size = msg_size(msg);
1090 hdr_size = msg_hdr_sz(msg);
1091 min_hdr_size = msg_isdata(msg) ?
1092 min_data_hdr_size[msg_type(msg)] : INT_H_SIZE;
1093
1094 if (unlikely((hdr_size < min_hdr_size) ||
1095 (size < hdr_size) ||
1096 (buf->len < size) ||
1097 (size - hdr_size > TIPC_MAX_USER_MSG_SIZE)))
1098 return 0;
1099
1100 return pskb_may_pull(buf, hdr_size);
1101}
1102
Allan Stephensb02b69c2010-08-17 11:00:07 +00001103/**
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001104 * tipc_rcv - process TIPC packets/messages arriving from off-node
Ying Xuef2f98002015-01-09 15:27:05 +08001105 * @net: the applicable net namespace
Ying Xuef03273f2014-11-26 11:41:54 +08001106 * @skb: TIPC packet
Ying Xue7a2f7d12014-04-21 10:55:46 +08001107 * @b_ptr: pointer to bearer message arrived on
Allan Stephensb02b69c2010-08-17 11:00:07 +00001108 *
1109 * Invoked with no locks held. Bearer pointer must point to a valid bearer
1110 * structure (i.e. cannot be NULL), but bearer can be inactive.
1111 */
Ying Xuec93d3ba2015-01-09 15:27:04 +08001112void tipc_rcv(struct net *net, struct sk_buff *skb, struct tipc_bearer *b_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001113{
Ying Xue34747532015-01-09 15:27:10 +08001114 struct tipc_net *tn = net_generic(net, tipc_net_id);
Ying Xuef03273f2014-11-26 11:41:54 +08001115 struct sk_buff_head head;
1116 struct tipc_node *n_ptr;
1117 struct tipc_link *l_ptr;
1118 struct sk_buff *skb1, *tmp;
1119 struct tipc_msg *msg;
1120 u32 seq_no;
1121 u32 ackd;
1122 u32 released;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001123
Ying Xuea6ca1092014-11-26 11:41:55 +08001124 skb2list(skb, &head);
Allan Stephens85035562008-04-15 19:04:54 -07001125
Ying Xuef03273f2014-11-26 11:41:54 +08001126 while ((skb = __skb_dequeue(&head))) {
Allan Stephens85035562008-04-15 19:04:54 -07001127 /* Ensure message is well-formed */
Ying Xuef03273f2014-11-26 11:41:54 +08001128 if (unlikely(!link_recv_buf_validate(skb)))
Ying Xue3af390e2013-10-30 11:26:57 +08001129 goto discard;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001130
Allan Stephensfe13dda2008-04-15 19:03:23 -07001131 /* Ensure message data is a single contiguous unit */
Ying Xuef03273f2014-11-26 11:41:54 +08001132 if (unlikely(skb_linearize(skb)))
Ying Xue3af390e2013-10-30 11:26:57 +08001133 goto discard;
Allan Stephensfe13dda2008-04-15 19:03:23 -07001134
Allan Stephens85035562008-04-15 19:04:54 -07001135 /* Handle arrival of a non-unicast link message */
Ying Xuef03273f2014-11-26 11:41:54 +08001136 msg = buf_msg(skb);
Allan Stephens85035562008-04-15 19:04:54 -07001137
Per Lidenb97bf3f2006-01-02 19:04:38 +01001138 if (unlikely(msg_non_seq(msg))) {
Allan Stephens1265a022008-06-04 17:32:35 -07001139 if (msg_user(msg) == LINK_CONFIG)
Ying Xuec93d3ba2015-01-09 15:27:04 +08001140 tipc_disc_rcv(net, skb, b_ptr);
Allan Stephens1265a022008-06-04 17:32:35 -07001141 else
Ying Xuec93d3ba2015-01-09 15:27:04 +08001142 tipc_bclink_rcv(net, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001143 continue;
1144 }
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001145
Allan Stephensed33a9c2011-04-05 15:15:04 -04001146 /* Discard unicast link messages destined for another node */
Allan Stephens26008242006-06-25 23:39:31 -07001147 if (unlikely(!msg_short(msg) &&
Ying Xue34747532015-01-09 15:27:10 +08001148 (msg_destnode(msg) != tn->own_addr)))
Ying Xue3af390e2013-10-30 11:26:57 +08001149 goto discard;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001150
Allan Stephens5a68d5e2010-08-17 11:00:16 +00001151 /* Locate neighboring node that sent message */
Ying Xuef2f98002015-01-09 15:27:05 +08001152 n_ptr = tipc_node_find(net, msg_prevnode(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001153 if (unlikely(!n_ptr))
Ying Xue3af390e2013-10-30 11:26:57 +08001154 goto discard;
Per Liden4323add2006-01-18 00:38:21 +01001155 tipc_node_lock(n_ptr);
Allan Stephens85035562008-04-15 19:04:54 -07001156
Allan Stephens5a68d5e2010-08-17 11:00:16 +00001157 /* Locate unicast link endpoint that should handle message */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001158 l_ptr = n_ptr->links[b_ptr->identity];
Ying Xue3af390e2013-10-30 11:26:57 +08001159 if (unlikely(!l_ptr))
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001160 goto unlock;
Allan Stephens85035562008-04-15 19:04:54 -07001161
Allan Stephensb4b56102011-05-27 11:00:51 -04001162 /* Verify that communication with node is currently allowed */
Ying Xueaecb9bb2014-05-08 08:54:39 +08001163 if ((n_ptr->action_flags & TIPC_WAIT_PEER_LINKS_DOWN) &&
Ying Xue10f465c2014-05-05 08:56:11 +08001164 msg_user(msg) == LINK_PROTOCOL &&
1165 (msg_type(msg) == RESET_MSG ||
1166 msg_type(msg) == ACTIVATE_MSG) &&
1167 !msg_redundant_link(msg))
Ying Xueaecb9bb2014-05-08 08:54:39 +08001168 n_ptr->action_flags &= ~TIPC_WAIT_PEER_LINKS_DOWN;
Allan Stephensb4b56102011-05-27 11:00:51 -04001169
Ying Xue10f465c2014-05-05 08:56:11 +08001170 if (tipc_node_blocked(n_ptr))
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001171 goto unlock;
Allan Stephensb4b56102011-05-27 11:00:51 -04001172
Allan Stephens85035562008-04-15 19:04:54 -07001173 /* Validate message sequence number info */
Allan Stephens85035562008-04-15 19:04:54 -07001174 seq_no = msg_seqno(msg);
1175 ackd = msg_ack(msg);
1176
1177 /* Release acked messages */
Ying Xue389dd9b2012-11-16 13:51:30 +08001178 if (n_ptr->bclink.recv_permitted)
Allan Stephens365595912011-10-24 15:26:24 -04001179 tipc_bclink_acknowledge(n_ptr, msg_bcast_ack(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001180
Ying Xue58dc55f2014-11-26 11:41:52 +08001181 released = 0;
1182 skb_queue_walk_safe(&l_ptr->outqueue, skb1, tmp) {
1183 if (skb1 == l_ptr->next_out ||
1184 more(buf_seqno(skb1), ackd))
1185 break;
1186 __skb_unlink(skb1, &l_ptr->outqueue);
1187 kfree_skb(skb1);
1188 released = 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001189 }
Allan Stephens85035562008-04-15 19:04:54 -07001190
1191 /* Try sending any messages link endpoint has pending */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001192 if (unlikely(l_ptr->next_out))
Ying Xue47b4c9a82014-11-26 11:41:48 +08001193 tipc_link_push_packets(l_ptr);
Jon Paul Maloya5377832014-02-13 17:29:15 -05001194
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001195 if (released && !skb_queue_empty(&l_ptr->wakeupq))
Jon Paul Maloy50100a52014-08-22 18:09:07 -04001196 link_prepare_wakeup(l_ptr);
Jon Paul Maloya5377832014-02-13 17:29:15 -05001197
Jon Paul Maloya5377832014-02-13 17:29:15 -05001198 /* Process the incoming packet */
Ying Xue3af390e2013-10-30 11:26:57 +08001199 if (unlikely(!link_working_working(l_ptr))) {
1200 if (msg_user(msg) == LINK_PROTOCOL) {
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001201 tipc_link_proto_rcv(l_ptr, skb);
Ying Xuef03273f2014-11-26 11:41:54 +08001202 link_retrieve_defq(l_ptr, &head);
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001203 skb = NULL;
1204 goto unlock;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001205 }
Ying Xue3af390e2013-10-30 11:26:57 +08001206
1207 /* Traffic message. Conditionally activate link */
1208 link_state_event(l_ptr, TRAFFIC_MSG_EVT);
1209
1210 if (link_working_working(l_ptr)) {
1211 /* Re-insert buffer in front of queue */
Ying Xuef03273f2014-11-26 11:41:54 +08001212 __skb_queue_head(&head, skb);
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001213 skb = NULL;
1214 goto unlock;
Ying Xue3af390e2013-10-30 11:26:57 +08001215 }
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001216 goto unlock;
Ying Xue3af390e2013-10-30 11:26:57 +08001217 }
1218
1219 /* Link is now in state WORKING_WORKING */
1220 if (unlikely(seq_no != mod(l_ptr->next_in_no))) {
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001221 link_handle_out_of_seq_msg(l_ptr, skb);
Ying Xuef03273f2014-11-26 11:41:54 +08001222 link_retrieve_defq(l_ptr, &head);
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001223 skb = NULL;
1224 goto unlock;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001225 }
Ying Xue3af390e2013-10-30 11:26:57 +08001226 l_ptr->next_in_no++;
Ying Xuebc6fecd2014-11-26 11:41:53 +08001227 if (unlikely(!skb_queue_empty(&l_ptr->deferred_queue)))
Ying Xuef03273f2014-11-26 11:41:54 +08001228 link_retrieve_defq(l_ptr, &head);
Jon Paul Maloya5377832014-02-13 17:29:15 -05001229
Erik Hugne3f53bd82014-07-01 10:22:41 +02001230 if (unlikely(++l_ptr->unacked_window >= TIPC_MIN_LINK_WIN)) {
1231 l_ptr->stats.sent_acks++;
1232 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0, 0, 0, 0);
1233 }
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001234 tipc_link_input(l_ptr, skb);
1235 skb = NULL;
1236unlock:
Ying Xue3af390e2013-10-30 11:26:57 +08001237 tipc_node_unlock(n_ptr);
1238discard:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001239 if (unlikely(skb))
1240 kfree_skb(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001241 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001242}
1243
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001244/* tipc_data_input - deliver data and name distr msgs to upper layer
Erik Hugne7ae934b2014-07-01 10:22:40 +02001245 *
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001246 * Consumes buffer if message is of right type
Erik Hugne7ae934b2014-07-01 10:22:40 +02001247 * Node lock must be held
1248 */
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001249static bool tipc_data_input(struct tipc_link *link, struct sk_buff *skb)
Erik Hugne7ae934b2014-07-01 10:22:40 +02001250{
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001251 struct tipc_node *node = link->owner;
1252 struct tipc_msg *msg = buf_msg(skb);
1253 u32 dport = msg_destport(msg);
Erik Hugne7ae934b2014-07-01 10:22:40 +02001254
1255 switch (msg_user(msg)) {
1256 case TIPC_LOW_IMPORTANCE:
1257 case TIPC_MEDIUM_IMPORTANCE:
1258 case TIPC_HIGH_IMPORTANCE:
1259 case TIPC_CRITICAL_IMPORTANCE:
1260 case CONN_MANAGER:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001261 if (tipc_skb_queue_tail(&link->inputq, skb, dport)) {
1262 node->inputq = &link->inputq;
1263 node->action_flags |= TIPC_MSG_EVT;
1264 }
1265 return true;
Erik Hugne7ae934b2014-07-01 10:22:40 +02001266 case NAME_DISTRIBUTOR:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001267 node->bclink.recv_permitted = true;
1268 node->namedq = &link->namedq;
1269 skb_queue_tail(&link->namedq, skb);
1270 if (skb_queue_len(&link->namedq) == 1)
1271 node->action_flags |= TIPC_NAMED_MSG_EVT;
1272 return true;
Erik Hugne7ae934b2014-07-01 10:22:40 +02001273 case MSG_BUNDLER:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001274 case CHANGEOVER_PROTOCOL:
1275 case MSG_FRAGMENTER:
1276 case BCAST_PROTOCOL:
1277 return false;
1278 default:
1279 pr_warn("Dropping received illegal msg type\n");
1280 kfree_skb(skb);
1281 return false;
1282 };
1283}
1284
1285/* tipc_link_input - process packet that has passed link protocol check
1286 *
1287 * Consumes buffer
1288 * Node lock must be held
1289 */
1290static void tipc_link_input(struct tipc_link *link, struct sk_buff *skb)
1291{
1292 struct tipc_node *node = link->owner;
1293 struct tipc_msg *msg = buf_msg(skb);
1294 struct sk_buff *iskb;
1295 int pos = 0;
1296
1297 if (likely(tipc_data_input(link, skb)))
1298 return;
1299
1300 switch (msg_user(msg)) {
1301 case CHANGEOVER_PROTOCOL:
1302 if (!tipc_link_tunnel_rcv(node, &skb))
1303 break;
1304 if (msg_user(buf_msg(skb)) != MSG_BUNDLER) {
1305 tipc_data_input(link, skb);
1306 break;
1307 }
1308 case MSG_BUNDLER:
1309 link->stats.recv_bundles++;
1310 link->stats.recv_bundled += msg_msgcnt(msg);
1311
1312 while (tipc_msg_extract(skb, &iskb, &pos))
1313 tipc_data_input(link, iskb);
1314 break;
1315 case MSG_FRAGMENTER:
1316 link->stats.recv_fragments++;
1317 if (tipc_buf_append(&link->reasm_buf, &skb)) {
1318 link->stats.recv_fragmented++;
1319 tipc_data_input(link, skb);
1320 } else if (!link->reasm_buf) {
1321 tipc_link_reset(link);
1322 }
1323 break;
1324 case BCAST_PROTOCOL:
1325 tipc_link_sync_rcv(node, skb);
Erik Hugne7ae934b2014-07-01 10:22:40 +02001326 break;
1327 default:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001328 break;
1329 };
Erik Hugne7ae934b2014-07-01 10:22:40 +02001330}
1331
1332/**
Allan Stephens8809b252011-10-25 10:44:35 -04001333 * tipc_link_defer_pkt - Add out-of-sequence message to deferred reception queue
1334 *
1335 * Returns increase in queue length (i.e. 0 or 1)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001336 */
Ying Xuebc6fecd2014-11-26 11:41:53 +08001337u32 tipc_link_defer_pkt(struct sk_buff_head *list, struct sk_buff *skb)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001338{
Ying Xuebc6fecd2014-11-26 11:41:53 +08001339 struct sk_buff *skb1;
1340 u32 seq_no = buf_seqno(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001341
1342 /* Empty queue ? */
Ying Xuebc6fecd2014-11-26 11:41:53 +08001343 if (skb_queue_empty(list)) {
1344 __skb_queue_tail(list, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001345 return 1;
1346 }
1347
1348 /* Last ? */
Ying Xuebc6fecd2014-11-26 11:41:53 +08001349 if (less(buf_seqno(skb_peek_tail(list)), seq_no)) {
1350 __skb_queue_tail(list, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001351 return 1;
1352 }
1353
Allan Stephens8809b252011-10-25 10:44:35 -04001354 /* Locate insertion point in queue, then insert; discard if duplicate */
Ying Xuebc6fecd2014-11-26 11:41:53 +08001355 skb_queue_walk(list, skb1) {
1356 u32 curr_seqno = buf_seqno(skb1);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001357
Allan Stephens8809b252011-10-25 10:44:35 -04001358 if (seq_no == curr_seqno) {
Ying Xuebc6fecd2014-11-26 11:41:53 +08001359 kfree_skb(skb);
Allan Stephens8809b252011-10-25 10:44:35 -04001360 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001361 }
Allan Stephens8809b252011-10-25 10:44:35 -04001362
1363 if (less(seq_no, curr_seqno))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001364 break;
Allan Stephens8809b252011-10-25 10:44:35 -04001365 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001366
Ying Xuebc6fecd2014-11-26 11:41:53 +08001367 __skb_queue_before(list, skb1, skb);
Allan Stephens8809b252011-10-25 10:44:35 -04001368 return 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001369}
1370
Allan Stephens8809b252011-10-25 10:44:35 -04001371/*
Per Lidenb97bf3f2006-01-02 19:04:38 +01001372 * link_handle_out_of_seq_msg - handle arrival of out-of-sequence packet
1373 */
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001374static void link_handle_out_of_seq_msg(struct tipc_link *l_ptr,
Per Lidenb97bf3f2006-01-02 19:04:38 +01001375 struct sk_buff *buf)
1376{
Allan Stephensf9057302011-10-24 16:03:12 -04001377 u32 seq_no = buf_seqno(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001378
1379 if (likely(msg_user(buf_msg(buf)) == LINK_PROTOCOL)) {
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001380 tipc_link_proto_rcv(l_ptr, buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001381 return;
1382 }
1383
Per Lidenb97bf3f2006-01-02 19:04:38 +01001384 /* Record OOS packet arrival (force mismatch on next timeout) */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001385 l_ptr->checkpoint--;
1386
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001387 /*
Per Lidenb97bf3f2006-01-02 19:04:38 +01001388 * Discard packet if a duplicate; otherwise add it to deferred queue
1389 * and notify peer of gap as per protocol specification
1390 */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001391 if (less(seq_no, mod(l_ptr->next_in_no))) {
1392 l_ptr->stats.duplicates++;
Allan Stephens5f6d9122011-11-04 13:24:29 -04001393 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001394 return;
1395 }
1396
Ying Xuebc6fecd2014-11-26 11:41:53 +08001397 if (tipc_link_defer_pkt(&l_ptr->deferred_queue, buf)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001398 l_ptr->stats.deferred_recv++;
Erik Hugne64380a02014-02-11 11:38:26 +01001399 TIPC_SKB_CB(buf)->deferred = true;
Ying Xuebc6fecd2014-11-26 11:41:53 +08001400 if ((skb_queue_len(&l_ptr->deferred_queue) % 16) == 1)
Ying Xue247f0f32014-02-18 16:06:46 +08001401 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0, 0, 0, 0);
Ying Xuebc6fecd2014-11-26 11:41:53 +08001402 } else {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001403 l_ptr->stats.duplicates++;
Ying Xuebc6fecd2014-11-26 11:41:53 +08001404 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001405}
1406
1407/*
1408 * Send protocol message to the other endpoint.
1409 */
Ying Xue247f0f32014-02-18 16:06:46 +08001410void tipc_link_proto_xmit(struct tipc_link *l_ptr, u32 msg_typ, int probe_msg,
1411 u32 gap, u32 tolerance, u32 priority, u32 ack_mtu)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001412{
Sam Ravnborg1fc54d82006-03-20 22:36:47 -08001413 struct sk_buff *buf = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001414 struct tipc_msg *msg = l_ptr->pmsg;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001415 u32 msg_size = sizeof(l_ptr->proto_msg);
Allan Stephens75f0aa42011-02-28 15:30:20 -05001416 int r_flag;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001417
Ying Xue77a7e072013-12-10 20:45:44 -08001418 /* Don't send protocol message during link changeover */
1419 if (l_ptr->exp_msg_count)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001420 return;
Allan Stephensb4b56102011-05-27 11:00:51 -04001421
1422 /* Abort non-RESET send if communication with node is prohibited */
Ying Xue10f465c2014-05-05 08:56:11 +08001423 if ((tipc_node_blocked(l_ptr->owner)) && (msg_typ != RESET_MSG))
Allan Stephensb4b56102011-05-27 11:00:51 -04001424 return;
1425
Allan Stephens92d2c902011-10-25 11:20:26 -04001426 /* Create protocol message with "out-of-sequence" sequence number */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001427 msg_set_type(msg, msg_typ);
Ying Xue7a2f7d12014-04-21 10:55:46 +08001428 msg_set_net_plane(msg, l_ptr->net_plane);
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001429 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Ying Xue1da46562015-01-09 15:27:07 +08001430 msg_set_last_bcast(msg, tipc_bclink_get_last_sent(l_ptr->owner->net));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001431
1432 if (msg_typ == STATE_MSG) {
1433 u32 next_sent = mod(l_ptr->next_out_no);
1434
Per Liden4323add2006-01-18 00:38:21 +01001435 if (!tipc_link_is_up(l_ptr))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001436 return;
1437 if (l_ptr->next_out)
Allan Stephensf9057302011-10-24 16:03:12 -04001438 next_sent = buf_seqno(l_ptr->next_out);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001439 msg_set_next_sent(msg, next_sent);
Ying Xuebc6fecd2014-11-26 11:41:53 +08001440 if (!skb_queue_empty(&l_ptr->deferred_queue)) {
1441 u32 rec = buf_seqno(skb_peek(&l_ptr->deferred_queue));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001442 gap = mod(rec - mod(l_ptr->next_in_no));
1443 }
1444 msg_set_seq_gap(msg, gap);
1445 if (gap)
1446 l_ptr->stats.sent_nacks++;
1447 msg_set_link_tolerance(msg, tolerance);
1448 msg_set_linkprio(msg, priority);
1449 msg_set_max_pkt(msg, ack_mtu);
1450 msg_set_ack(msg, mod(l_ptr->next_in_no - 1));
1451 msg_set_probe(msg, probe_msg != 0);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001452 if (probe_msg) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001453 u32 mtu = l_ptr->max_pkt;
1454
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001455 if ((mtu < l_ptr->max_pkt_target) &&
Per Lidenb97bf3f2006-01-02 19:04:38 +01001456 link_working_working(l_ptr) &&
1457 l_ptr->fsm_msg_cnt) {
1458 msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001459 if (l_ptr->max_pkt_probes == 10) {
1460 l_ptr->max_pkt_target = (msg_size - 4);
1461 l_ptr->max_pkt_probes = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001462 msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001463 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001464 l_ptr->max_pkt_probes++;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001465 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001466
1467 l_ptr->stats.sent_probes++;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001468 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001469 l_ptr->stats.sent_states++;
1470 } else { /* RESET_MSG or ACTIVATE_MSG */
1471 msg_set_ack(msg, mod(l_ptr->reset_checkpoint - 1));
1472 msg_set_seq_gap(msg, 0);
1473 msg_set_next_sent(msg, 1);
Allan Stephensf23d9bf2011-01-18 15:15:34 -05001474 msg_set_probe(msg, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001475 msg_set_link_tolerance(msg, l_ptr->tolerance);
1476 msg_set_linkprio(msg, l_ptr->priority);
1477 msg_set_max_pkt(msg, l_ptr->max_pkt_target);
1478 }
1479
Allan Stephens75f0aa42011-02-28 15:30:20 -05001480 r_flag = (l_ptr->owner->working_links > tipc_link_is_up(l_ptr));
1481 msg_set_redundant_link(msg, r_flag);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001482 msg_set_linkprio(msg, l_ptr->priority);
Allan Stephens92d2c902011-10-25 11:20:26 -04001483 msg_set_size(msg, msg_size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001484
1485 msg_set_seqno(msg, mod(l_ptr->next_out_no + (0xffff/2)));
1486
stephen hemminger31e3c3f2010-10-13 13:20:35 +00001487 buf = tipc_buf_acquire(msg_size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001488 if (!buf)
1489 return;
1490
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03001491 skb_copy_to_linear_data(buf, msg, sizeof(l_ptr->proto_msg));
Ying Xue796c75d2013-06-17 10:54:48 -04001492 buf->priority = TC_PRIO_CONTROL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001493
Ying Xue7f9f95d2015-01-09 15:27:06 +08001494 tipc_bearer_send(l_ptr->owner->net, l_ptr->bearer_id, buf,
1495 &l_ptr->media_addr);
Allan Stephens92d2c902011-10-25 11:20:26 -04001496 l_ptr->unacked_window = 0;
Allan Stephens5f6d9122011-11-04 13:24:29 -04001497 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001498}
1499
1500/*
1501 * Receive protocol message :
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001502 * Note that network plane id propagates through the network, and may
1503 * change at any time. The node with lowest address rules
Per Lidenb97bf3f2006-01-02 19:04:38 +01001504 */
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001505static void tipc_link_proto_rcv(struct tipc_link *l_ptr,
Ying Xuec93d3ba2015-01-09 15:27:04 +08001506 struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001507{
1508 u32 rec_gap = 0;
1509 u32 max_pkt_info;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001510 u32 max_pkt_ack;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001511 u32 msg_tol;
1512 struct tipc_msg *msg = buf_msg(buf);
1513
Ying Xue77a7e072013-12-10 20:45:44 -08001514 /* Discard protocol message during link changeover */
1515 if (l_ptr->exp_msg_count)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001516 goto exit;
1517
Ying Xue7a2f7d12014-04-21 10:55:46 +08001518 if (l_ptr->net_plane != msg_net_plane(msg))
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001519 if (link_own_addr(l_ptr) > msg_prevnode(msg))
Ying Xue7a2f7d12014-04-21 10:55:46 +08001520 l_ptr->net_plane = msg_net_plane(msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001521
Per Lidenb97bf3f2006-01-02 19:04:38 +01001522 switch (msg_type(msg)) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001523
Per Lidenb97bf3f2006-01-02 19:04:38 +01001524 case RESET_MSG:
Allan Stephensa686e682008-06-04 17:29:39 -07001525 if (!link_working_unknown(l_ptr) &&
1526 (l_ptr->peer_session != INVALID_SESSION)) {
Allan Stephens641c2182011-04-07 09:54:43 -04001527 if (less_eq(msg_session(msg), l_ptr->peer_session))
1528 break; /* duplicate or old reset: ignore */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001529 }
Allan Stephensb4b56102011-05-27 11:00:51 -04001530
1531 if (!msg_redundant_link(msg) && (link_working_working(l_ptr) ||
1532 link_working_unknown(l_ptr))) {
1533 /*
1534 * peer has lost contact -- don't allow peer's links
1535 * to reactivate before we recognize loss & clean up
1536 */
Ying Xueca9cf062014-05-08 08:54:40 +08001537 l_ptr->owner->action_flags |= TIPC_WAIT_OWN_LINKS_DOWN;
Allan Stephensb4b56102011-05-27 11:00:51 -04001538 }
1539
Allan Stephens47361c82011-10-26 10:55:16 -04001540 link_state_event(l_ptr, RESET_MSG);
1541
Per Lidenb97bf3f2006-01-02 19:04:38 +01001542 /* fall thru' */
1543 case ACTIVATE_MSG:
1544 /* Update link settings according other endpoint's values */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001545 strcpy((strrchr(l_ptr->name, ':') + 1), (char *)msg_data(msg));
1546
Allan Stephens2db99832010-12-31 18:59:33 +00001547 msg_tol = msg_link_tolerance(msg);
1548 if (msg_tol > l_ptr->tolerance)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001549 link_set_supervision_props(l_ptr, msg_tol);
1550
1551 if (msg_linkprio(msg) > l_ptr->priority)
1552 l_ptr->priority = msg_linkprio(msg);
1553
1554 max_pkt_info = msg_max_pkt(msg);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001555 if (max_pkt_info) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001556 if (max_pkt_info < l_ptr->max_pkt_target)
1557 l_ptr->max_pkt_target = max_pkt_info;
1558 if (l_ptr->max_pkt > l_ptr->max_pkt_target)
1559 l_ptr->max_pkt = l_ptr->max_pkt_target;
1560 } else {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001561 l_ptr->max_pkt = l_ptr->max_pkt_target;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001562 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001563
Allan Stephens4d753132011-10-25 12:19:05 -04001564 /* Synchronize broadcast link info, if not done previously */
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001565 if (!tipc_node_is_up(l_ptr->owner)) {
1566 l_ptr->owner->bclink.last_sent =
1567 l_ptr->owner->bclink.last_in =
1568 msg_last_bcast(msg);
1569 l_ptr->owner->bclink.oos_state = 0;
1570 }
Allan Stephens4d753132011-10-25 12:19:05 -04001571
Per Lidenb97bf3f2006-01-02 19:04:38 +01001572 l_ptr->peer_session = msg_session(msg);
1573 l_ptr->peer_bearer_id = msg_bearer_id(msg);
Allan Stephens47361c82011-10-26 10:55:16 -04001574
1575 if (msg_type(msg) == ACTIVATE_MSG)
1576 link_state_event(l_ptr, ACTIVATE_MSG);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001577 break;
1578 case STATE_MSG:
1579
Allan Stephens2db99832010-12-31 18:59:33 +00001580 msg_tol = msg_link_tolerance(msg);
1581 if (msg_tol)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001582 link_set_supervision_props(l_ptr, msg_tol);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001583
1584 if (msg_linkprio(msg) &&
Per Lidenb97bf3f2006-01-02 19:04:38 +01001585 (msg_linkprio(msg) != l_ptr->priority)) {
Erik Hugne3fa9cac2015-01-22 17:10:31 +01001586 pr_debug("%s<%s>, priority change %u->%u\n",
1587 link_rst_msg, l_ptr->name,
1588 l_ptr->priority, msg_linkprio(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001589 l_ptr->priority = msg_linkprio(msg);
Per Liden4323add2006-01-18 00:38:21 +01001590 tipc_link_reset(l_ptr); /* Enforce change to take effect */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001591 break;
1592 }
Jon Paul Maloyec37dcd2014-05-14 05:39:10 -04001593
1594 /* Record reception; force mismatch at next timeout: */
1595 l_ptr->checkpoint--;
1596
Per Lidenb97bf3f2006-01-02 19:04:38 +01001597 link_state_event(l_ptr, TRAFFIC_MSG_EVT);
1598 l_ptr->stats.recv_states++;
1599 if (link_reset_unknown(l_ptr))
1600 break;
1601
1602 if (less_eq(mod(l_ptr->next_in_no), msg_next_sent(msg))) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001603 rec_gap = mod(msg_next_sent(msg) -
Per Lidenb97bf3f2006-01-02 19:04:38 +01001604 mod(l_ptr->next_in_no));
1605 }
1606
1607 max_pkt_ack = msg_max_pkt(msg);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001608 if (max_pkt_ack > l_ptr->max_pkt) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001609 l_ptr->max_pkt = max_pkt_ack;
1610 l_ptr->max_pkt_probes = 0;
1611 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001612
1613 max_pkt_ack = 0;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001614 if (msg_probe(msg)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001615 l_ptr->stats.recv_probes++;
Allan Stephensa0168922010-12-31 18:59:35 +00001616 if (msg_size(msg) > sizeof(l_ptr->proto_msg))
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001617 max_pkt_ack = msg_size(msg);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001618 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001619
1620 /* Protocol message before retransmits, reduce loss risk */
Ying Xue389dd9b2012-11-16 13:51:30 +08001621 if (l_ptr->owner->bclink.recv_permitted)
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001622 tipc_bclink_update_link_state(l_ptr->owner,
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001623 msg_last_bcast(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001624
1625 if (rec_gap || (msg_probe(msg))) {
Ying Xue247f0f32014-02-18 16:06:46 +08001626 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, rec_gap, 0,
1627 0, max_pkt_ack);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001628 }
1629 if (msg_seq_gap(msg)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001630 l_ptr->stats.recv_nacks++;
Ying Xue58dc55f2014-11-26 11:41:52 +08001631 tipc_link_retransmit(l_ptr, skb_peek(&l_ptr->outqueue),
Per Liden4323add2006-01-18 00:38:21 +01001632 msg_seq_gap(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001633 }
1634 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001635 }
1636exit:
Allan Stephens5f6d9122011-11-04 13:24:29 -04001637 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001638}
1639
1640
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001641/* tipc_link_tunnel_xmit(): Tunnel one packet via a link belonging to
1642 * a different bearer. Owner node is locked.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001643 */
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001644static void tipc_link_tunnel_xmit(struct tipc_link *l_ptr,
1645 struct tipc_msg *tunnel_hdr,
1646 struct tipc_msg *msg,
1647 u32 selector)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001648{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001649 struct tipc_link *tunnel;
Ying Xuea6ca1092014-11-26 11:41:55 +08001650 struct sk_buff *skb;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001651 u32 length = msg_size(msg);
1652
1653 tunnel = l_ptr->owner->active_links[selector & 1];
Allan Stephens5392d642006-06-25 23:52:50 -07001654 if (!tipc_link_is_up(tunnel)) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001655 pr_warn("%stunnel link no longer available\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001656 return;
Allan Stephens5392d642006-06-25 23:52:50 -07001657 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001658 msg_set_size(tunnel_hdr, length + INT_H_SIZE);
Ying Xuea6ca1092014-11-26 11:41:55 +08001659 skb = tipc_buf_acquire(length + INT_H_SIZE);
1660 if (!skb) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001661 pr_warn("%sunable to send tunnel msg\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001662 return;
Allan Stephens5392d642006-06-25 23:52:50 -07001663 }
Ying Xuea6ca1092014-11-26 11:41:55 +08001664 skb_copy_to_linear_data(skb, tunnel_hdr, INT_H_SIZE);
1665 skb_copy_to_linear_data_offset(skb, INT_H_SIZE, msg, length);
1666 __tipc_link_xmit_skb(tunnel, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001667}
1668
1669
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001670/* tipc_link_failover_send_queue(): A link has gone down, but a second
1671 * link is still active. We can do failover. Tunnel the failing link's
1672 * whole send queue via the remaining link. This way, we don't lose
1673 * any packets, and sequence order is preserved for subsequent traffic
1674 * sent over the remaining link. Owner node is locked.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001675 */
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001676void tipc_link_failover_send_queue(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001677{
Ying Xue58dc55f2014-11-26 11:41:52 +08001678 u32 msgcount = skb_queue_len(&l_ptr->outqueue);
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001679 struct tipc_link *tunnel = l_ptr->owner->active_links[0];
Per Lidenb97bf3f2006-01-02 19:04:38 +01001680 struct tipc_msg tunnel_hdr;
Ying Xue58dc55f2014-11-26 11:41:52 +08001681 struct sk_buff *skb;
Allan Stephens5392d642006-06-25 23:52:50 -07001682 int split_bundles;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001683
1684 if (!tunnel)
1685 return;
1686
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001687 tipc_msg_init(link_own_addr(l_ptr), &tunnel_hdr, CHANGEOVER_PROTOCOL,
Ying Xue34747532015-01-09 15:27:10 +08001688 ORIGINAL_MSG, INT_H_SIZE, l_ptr->addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001689 msg_set_bearer_id(&tunnel_hdr, l_ptr->peer_bearer_id);
1690 msg_set_msgcnt(&tunnel_hdr, msgcount);
Allan Stephensf1310722006-06-25 23:51:37 -07001691
Ying Xue58dc55f2014-11-26 11:41:52 +08001692 if (skb_queue_empty(&l_ptr->outqueue)) {
1693 skb = tipc_buf_acquire(INT_H_SIZE);
1694 if (skb) {
1695 skb_copy_to_linear_data(skb, &tunnel_hdr, INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001696 msg_set_size(&tunnel_hdr, INT_H_SIZE);
Ying Xuea6ca1092014-11-26 11:41:55 +08001697 __tipc_link_xmit_skb(tunnel, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001698 } else {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001699 pr_warn("%sunable to send changeover msg\n",
1700 link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001701 }
1702 return;
1703 }
Allan Stephensf1310722006-06-25 23:51:37 -07001704
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001705 split_bundles = (l_ptr->owner->active_links[0] !=
Allan Stephens5392d642006-06-25 23:52:50 -07001706 l_ptr->owner->active_links[1]);
1707
Ying Xue58dc55f2014-11-26 11:41:52 +08001708 skb_queue_walk(&l_ptr->outqueue, skb) {
1709 struct tipc_msg *msg = buf_msg(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001710
1711 if ((msg_user(msg) == MSG_BUNDLER) && split_bundles) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001712 struct tipc_msg *m = msg_get_wrapped(msg);
Allan Stephens0e659672010-12-31 18:59:32 +00001713 unchar *pos = (unchar *)m;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001714
Florian Westphald788d802007-08-02 19:28:06 -07001715 msgcount = msg_msgcnt(msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001716 while (msgcount--) {
Allan Stephens0e659672010-12-31 18:59:32 +00001717 msg_set_seqno(m, msg_seqno(msg));
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001718 tipc_link_tunnel_xmit(l_ptr, &tunnel_hdr, m,
1719 msg_link_selector(m));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001720 pos += align(msg_size(m));
1721 m = (struct tipc_msg *)pos;
1722 }
1723 } else {
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001724 tipc_link_tunnel_xmit(l_ptr, &tunnel_hdr, msg,
1725 msg_link_selector(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001726 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001727 }
1728}
1729
Ying Xue247f0f32014-02-18 16:06:46 +08001730/* tipc_link_dup_queue_xmit(): A second link has become active. Tunnel a
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001731 * duplicate of the first link's send queue via the new link. This way, we
1732 * are guaranteed that currently queued packets from a socket are delivered
1733 * before future traffic from the same socket, even if this is using the
1734 * new link. The last arriving copy of each duplicate packet is dropped at
1735 * the receiving end by the regular protocol check, so packet cardinality
1736 * and sequence order is preserved per sender/receiver socket pair.
1737 * Owner node is locked.
1738 */
Ying Xue247f0f32014-02-18 16:06:46 +08001739void tipc_link_dup_queue_xmit(struct tipc_link *l_ptr,
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001740 struct tipc_link *tunnel)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001741{
Ying Xue58dc55f2014-11-26 11:41:52 +08001742 struct sk_buff *skb;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001743 struct tipc_msg tunnel_hdr;
1744
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001745 tipc_msg_init(link_own_addr(l_ptr), &tunnel_hdr, CHANGEOVER_PROTOCOL,
Ying Xue34747532015-01-09 15:27:10 +08001746 DUPLICATE_MSG, INT_H_SIZE, l_ptr->addr);
Ying Xue58dc55f2014-11-26 11:41:52 +08001747 msg_set_msgcnt(&tunnel_hdr, skb_queue_len(&l_ptr->outqueue));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001748 msg_set_bearer_id(&tunnel_hdr, l_ptr->peer_bearer_id);
Ying Xue58dc55f2014-11-26 11:41:52 +08001749 skb_queue_walk(&l_ptr->outqueue, skb) {
1750 struct sk_buff *outskb;
1751 struct tipc_msg *msg = buf_msg(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001752 u32 length = msg_size(msg);
1753
1754 if (msg_user(msg) == MSG_BUNDLER)
1755 msg_set_type(msg, CLOSED_MSG);
1756 msg_set_ack(msg, mod(l_ptr->next_in_no - 1)); /* Update */
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001757 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001758 msg_set_size(&tunnel_hdr, length + INT_H_SIZE);
Ying Xue58dc55f2014-11-26 11:41:52 +08001759 outskb = tipc_buf_acquire(length + INT_H_SIZE);
1760 if (outskb == NULL) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001761 pr_warn("%sunable to send duplicate msg\n",
1762 link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001763 return;
1764 }
Ying Xue58dc55f2014-11-26 11:41:52 +08001765 skb_copy_to_linear_data(outskb, &tunnel_hdr, INT_H_SIZE);
1766 skb_copy_to_linear_data_offset(outskb, INT_H_SIZE, skb->data,
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03001767 length);
Ying Xuea6ca1092014-11-26 11:41:55 +08001768 __tipc_link_xmit_skb(tunnel, outskb);
Per Liden4323add2006-01-18 00:38:21 +01001769 if (!tipc_link_is_up(l_ptr))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001770 return;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001771 }
1772}
1773
Per Lidenb97bf3f2006-01-02 19:04:38 +01001774/**
1775 * buf_extract - extracts embedded TIPC message from another message
1776 * @skb: encapsulating message buffer
1777 * @from_pos: offset to extract from
1778 *
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001779 * Returns a new message buffer containing an embedded message. The
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001780 * encapsulating buffer is left unchanged.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001781 */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001782static struct sk_buff *buf_extract(struct sk_buff *skb, u32 from_pos)
1783{
1784 struct tipc_msg *msg = (struct tipc_msg *)(skb->data + from_pos);
1785 u32 size = msg_size(msg);
1786 struct sk_buff *eb;
1787
stephen hemminger31e3c3f2010-10-13 13:20:35 +00001788 eb = tipc_buf_acquire(size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001789 if (eb)
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03001790 skb_copy_to_linear_data(eb, msg, size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001791 return eb;
1792}
1793
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001794/* tipc_link_dup_rcv(): Receive a tunnelled DUPLICATE_MSG packet.
1795 * Owner node is locked.
1796 */
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001797static void tipc_link_dup_rcv(struct tipc_link *l_ptr,
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001798 struct sk_buff *t_buf)
1799{
1800 struct sk_buff *buf;
1801
1802 if (!tipc_link_is_up(l_ptr))
1803 return;
1804
1805 buf = buf_extract(t_buf, INT_H_SIZE);
1806 if (buf == NULL) {
1807 pr_warn("%sfailed to extract inner dup pkt\n", link_co_err);
1808 return;
1809 }
1810
1811 /* Add buffer to deferred queue, if applicable: */
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001812 link_handle_out_of_seq_msg(l_ptr, buf);
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001813}
1814
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001815/* tipc_link_failover_rcv(): Receive a tunnelled ORIGINAL_MSG packet
1816 * Owner node is locked.
1817 */
1818static struct sk_buff *tipc_link_failover_rcv(struct tipc_link *l_ptr,
1819 struct sk_buff *t_buf)
1820{
1821 struct tipc_msg *t_msg = buf_msg(t_buf);
1822 struct sk_buff *buf = NULL;
1823 struct tipc_msg *msg;
1824
1825 if (tipc_link_is_up(l_ptr))
1826 tipc_link_reset(l_ptr);
1827
1828 /* First failover packet? */
1829 if (l_ptr->exp_msg_count == START_CHANGEOVER)
1830 l_ptr->exp_msg_count = msg_msgcnt(t_msg);
1831
1832 /* Should there be an inner packet? */
1833 if (l_ptr->exp_msg_count) {
1834 l_ptr->exp_msg_count--;
1835 buf = buf_extract(t_buf, INT_H_SIZE);
1836 if (buf == NULL) {
1837 pr_warn("%sno inner failover pkt\n", link_co_err);
1838 goto exit;
1839 }
1840 msg = buf_msg(buf);
1841
1842 if (less(msg_seqno(msg), l_ptr->reset_checkpoint)) {
1843 kfree_skb(buf);
1844 buf = NULL;
1845 goto exit;
1846 }
1847 if (msg_user(msg) == MSG_FRAGMENTER) {
1848 l_ptr->stats.recv_fragments++;
Jon Paul Maloy37e22162014-05-14 05:39:12 -04001849 tipc_buf_append(&l_ptr->reasm_buf, &buf);
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001850 }
1851 }
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001852exit:
Jon Paul Maloy2d72d492015-02-03 08:59:17 -05001853 if ((!l_ptr->exp_msg_count) && (l_ptr->flags & LINK_STOPPED))
1854 tipc_link_delete(l_ptr);
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001855 return buf;
1856}
1857
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001858/* tipc_link_tunnel_rcv(): Receive a tunnelled packet, sent
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001859 * via other link as result of a failover (ORIGINAL_MSG) or
1860 * a new active link (DUPLICATE_MSG). Failover packets are
1861 * returned to the active link for delivery upwards.
1862 * Owner node is locked.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001863 */
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001864static int tipc_link_tunnel_rcv(struct tipc_node *n_ptr,
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001865 struct sk_buff **buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001866{
Jon Paul Maloy02842f72014-02-13 17:29:14 -05001867 struct sk_buff *t_buf = *buf;
1868 struct tipc_link *l_ptr;
1869 struct tipc_msg *t_msg = buf_msg(t_buf);
1870 u32 bearer_id = msg_bearer_id(t_msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001871
Jon Paul Maloy1e9d47a2014-02-13 17:29:13 -05001872 *buf = NULL;
1873
Dan Carpentercb4b102f2013-05-06 08:28:41 +00001874 if (bearer_id >= MAX_BEARERS)
1875 goto exit;
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001876
Jon Paul Maloy02842f72014-02-13 17:29:14 -05001877 l_ptr = n_ptr->links[bearer_id];
1878 if (!l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001879 goto exit;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001880
Jon Paul Maloy02842f72014-02-13 17:29:14 -05001881 if (msg_type(t_msg) == DUPLICATE_MSG)
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001882 tipc_link_dup_rcv(l_ptr, t_buf);
Jon Paul Maloy02842f72014-02-13 17:29:14 -05001883 else if (msg_type(t_msg) == ORIGINAL_MSG)
1884 *buf = tipc_link_failover_rcv(l_ptr, t_buf);
Jon Paul Maloy1e9d47a2014-02-13 17:29:13 -05001885 else
1886 pr_warn("%sunknown tunnel pkt received\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001887exit:
Jon Paul Maloy02842f72014-02-13 17:29:14 -05001888 kfree_skb(t_buf);
Jon Paul Maloy1e9d47a2014-02-13 17:29:13 -05001889 return *buf != NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001890}
1891
Ying Xue2f55c432015-01-09 15:27:00 +08001892static void link_set_supervision_props(struct tipc_link *l_ptr, u32 tol)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001893{
Ying Xue2f55c432015-01-09 15:27:00 +08001894 unsigned long intv = ((tol / 4) > 500) ? 500 : tol / 4;
1895
1896 if ((tol < TIPC_MIN_LINK_TOL) || (tol > TIPC_MAX_LINK_TOL))
Allan Stephens5413b4c2011-01-18 13:24:55 -05001897 return;
1898
Ying Xue2f55c432015-01-09 15:27:00 +08001899 l_ptr->tolerance = tol;
1900 l_ptr->cont_intv = msecs_to_jiffies(intv);
1901 l_ptr->abort_limit = tol / (jiffies_to_msecs(l_ptr->cont_intv) / 4);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001902}
1903
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001904void tipc_link_set_queue_limits(struct tipc_link *l_ptr, u32 window)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001905{
1906 /* Data messages from this node, inclusive FIRST_FRAGM */
Allan Stephens06d82c92008-03-06 15:06:55 -08001907 l_ptr->queue_limit[TIPC_LOW_IMPORTANCE] = window;
1908 l_ptr->queue_limit[TIPC_MEDIUM_IMPORTANCE] = (window / 3) * 4;
1909 l_ptr->queue_limit[TIPC_HIGH_IMPORTANCE] = (window / 3) * 5;
1910 l_ptr->queue_limit[TIPC_CRITICAL_IMPORTANCE] = (window / 3) * 6;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001911 /* Transiting data messages,inclusive FIRST_FRAGM */
Allan Stephens06d82c92008-03-06 15:06:55 -08001912 l_ptr->queue_limit[TIPC_LOW_IMPORTANCE + 4] = 300;
1913 l_ptr->queue_limit[TIPC_MEDIUM_IMPORTANCE + 4] = 600;
1914 l_ptr->queue_limit[TIPC_HIGH_IMPORTANCE + 4] = 900;
1915 l_ptr->queue_limit[TIPC_CRITICAL_IMPORTANCE + 4] = 1200;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001916 l_ptr->queue_limit[CONN_MANAGER] = 1200;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001917 l_ptr->queue_limit[CHANGEOVER_PROTOCOL] = 2500;
1918 l_ptr->queue_limit[NAME_DISTRIBUTOR] = 3000;
1919 /* FRAGMENT and LAST_FRAGMENT packets */
1920 l_ptr->queue_limit[MSG_FRAGMENTER] = 4000;
1921}
1922
Jon Paul Maloye099e862014-02-13 17:29:18 -05001923/* tipc_link_find_owner - locate owner node of link by link's name
Ying Xuef2f98002015-01-09 15:27:05 +08001924 * @net: the applicable net namespace
Jon Paul Maloye099e862014-02-13 17:29:18 -05001925 * @name: pointer to link name string
1926 * @bearer_id: pointer to index in 'node->links' array where the link was found.
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001927 *
Jon Paul Maloye099e862014-02-13 17:29:18 -05001928 * Returns pointer to node owning the link, or 0 if no matching link is found.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001929 */
Ying Xuef2f98002015-01-09 15:27:05 +08001930static struct tipc_node *tipc_link_find_owner(struct net *net,
1931 const char *link_name,
Jon Paul Maloye099e862014-02-13 17:29:18 -05001932 unsigned int *bearer_id)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001933{
Ying Xuef2f98002015-01-09 15:27:05 +08001934 struct tipc_net *tn = net_generic(net, tipc_net_id);
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001935 struct tipc_link *l_ptr;
Erik Hugnebbfbe472013-10-18 07:23:21 +02001936 struct tipc_node *n_ptr;
Fabian Frederick886eaa12014-12-25 12:05:50 +01001937 struct tipc_node *found_node = NULL;
Erik Hugnebbfbe472013-10-18 07:23:21 +02001938 int i;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001939
Jon Paul Maloye099e862014-02-13 17:29:18 -05001940 *bearer_id = 0;
Ying Xue6c7a7622014-03-27 12:54:37 +08001941 rcu_read_lock();
Ying Xuef2f98002015-01-09 15:27:05 +08001942 list_for_each_entry_rcu(n_ptr, &tn->node_list, list) {
Jon Paul Maloya11607f2014-02-14 16:40:44 -05001943 tipc_node_lock(n_ptr);
Erik Hugnebbfbe472013-10-18 07:23:21 +02001944 for (i = 0; i < MAX_BEARERS; i++) {
1945 l_ptr = n_ptr->links[i];
Jon Paul Maloye099e862014-02-13 17:29:18 -05001946 if (l_ptr && !strcmp(l_ptr->name, link_name)) {
1947 *bearer_id = i;
1948 found_node = n_ptr;
1949 break;
1950 }
Erik Hugnebbfbe472013-10-18 07:23:21 +02001951 }
Jon Paul Maloya11607f2014-02-14 16:40:44 -05001952 tipc_node_unlock(n_ptr);
Jon Paul Maloye099e862014-02-13 17:29:18 -05001953 if (found_node)
1954 break;
Erik Hugnebbfbe472013-10-18 07:23:21 +02001955 }
Ying Xue6c7a7622014-03-27 12:54:37 +08001956 rcu_read_unlock();
1957
Jon Paul Maloye099e862014-02-13 17:29:18 -05001958 return found_node;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001959}
1960
Allan Stephens5c216e12011-10-18 11:34:29 -04001961/**
1962 * link_value_is_valid -- validate proposed link tolerance/priority/window
1963 *
Ben Hutchings2c530402012-07-10 10:55:09 +00001964 * @cmd: value type (TIPC_CMD_SET_LINK_*)
1965 * @new_value: the new value
Allan Stephens5c216e12011-10-18 11:34:29 -04001966 *
1967 * Returns 1 if value is within range, 0 if not.
1968 */
Allan Stephens5c216e12011-10-18 11:34:29 -04001969static int link_value_is_valid(u16 cmd, u32 new_value)
1970{
1971 switch (cmd) {
1972 case TIPC_CMD_SET_LINK_TOL:
1973 return (new_value >= TIPC_MIN_LINK_TOL) &&
1974 (new_value <= TIPC_MAX_LINK_TOL);
1975 case TIPC_CMD_SET_LINK_PRI:
1976 return (new_value <= TIPC_MAX_LINK_PRI);
1977 case TIPC_CMD_SET_LINK_WINDOW:
1978 return (new_value >= TIPC_MIN_LINK_WIN) &&
1979 (new_value <= TIPC_MAX_LINK_WIN);
1980 }
1981 return 0;
1982}
1983
Allan Stephens5c216e12011-10-18 11:34:29 -04001984/**
1985 * link_cmd_set_value - change priority/tolerance/window for link/bearer/media
Ying Xuef2f98002015-01-09 15:27:05 +08001986 * @net: the applicable net namespace
Ben Hutchings2c530402012-07-10 10:55:09 +00001987 * @name: ptr to link, bearer, or media name
1988 * @new_value: new value of link, bearer, or media setting
1989 * @cmd: which link, bearer, or media attribute to set (TIPC_CMD_SET_LINK_*)
Allan Stephens5c216e12011-10-18 11:34:29 -04001990 *
Ying Xue7216cd92014-04-21 10:55:48 +08001991 * Caller must hold RTNL lock to ensure link/bearer/media is not deleted.
Allan Stephens5c216e12011-10-18 11:34:29 -04001992 *
1993 * Returns 0 if value updated and negative value on error.
1994 */
Ying Xuef2f98002015-01-09 15:27:05 +08001995static int link_cmd_set_value(struct net *net, const char *name, u32 new_value,
1996 u16 cmd)
Allan Stephens5c216e12011-10-18 11:34:29 -04001997{
1998 struct tipc_node *node;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001999 struct tipc_link *l_ptr;
Allan Stephens5c216e12011-10-18 11:34:29 -04002000 struct tipc_bearer *b_ptr;
Paul Gortmaker358a0d12011-12-29 20:19:42 -05002001 struct tipc_media *m_ptr;
Jon Paul Maloye099e862014-02-13 17:29:18 -05002002 int bearer_id;
Ying Xue636c0372013-10-18 07:23:20 +02002003 int res = 0;
Allan Stephens5c216e12011-10-18 11:34:29 -04002004
Ying Xuef2f98002015-01-09 15:27:05 +08002005 node = tipc_link_find_owner(net, name, &bearer_id);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002006 if (node) {
Allan Stephens5c216e12011-10-18 11:34:29 -04002007 tipc_node_lock(node);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002008 l_ptr = node->links[bearer_id];
2009
2010 if (l_ptr) {
2011 switch (cmd) {
2012 case TIPC_CMD_SET_LINK_TOL:
2013 link_set_supervision_props(l_ptr, new_value);
Ying Xue247f0f32014-02-18 16:06:46 +08002014 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0,
2015 new_value, 0, 0);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002016 break;
2017 case TIPC_CMD_SET_LINK_PRI:
2018 l_ptr->priority = new_value;
Ying Xue247f0f32014-02-18 16:06:46 +08002019 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0,
2020 0, new_value, 0);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002021 break;
2022 case TIPC_CMD_SET_LINK_WINDOW:
2023 tipc_link_set_queue_limits(l_ptr, new_value);
2024 break;
2025 default:
2026 res = -EINVAL;
2027 break;
2028 }
Allan Stephens5c216e12011-10-18 11:34:29 -04002029 }
2030 tipc_node_unlock(node);
Ying Xue636c0372013-10-18 07:23:20 +02002031 return res;
Allan Stephens5c216e12011-10-18 11:34:29 -04002032 }
2033
Ying Xue7f9f95d2015-01-09 15:27:06 +08002034 b_ptr = tipc_bearer_find(net, name);
Allan Stephens5c216e12011-10-18 11:34:29 -04002035 if (b_ptr) {
2036 switch (cmd) {
2037 case TIPC_CMD_SET_LINK_TOL:
2038 b_ptr->tolerance = new_value;
Ying Xue636c0372013-10-18 07:23:20 +02002039 break;
Allan Stephens5c216e12011-10-18 11:34:29 -04002040 case TIPC_CMD_SET_LINK_PRI:
2041 b_ptr->priority = new_value;
Ying Xue636c0372013-10-18 07:23:20 +02002042 break;
Allan Stephens5c216e12011-10-18 11:34:29 -04002043 case TIPC_CMD_SET_LINK_WINDOW:
2044 b_ptr->window = new_value;
Ying Xue636c0372013-10-18 07:23:20 +02002045 break;
2046 default:
2047 res = -EINVAL;
2048 break;
Allan Stephens5c216e12011-10-18 11:34:29 -04002049 }
Ying Xue636c0372013-10-18 07:23:20 +02002050 return res;
Allan Stephens5c216e12011-10-18 11:34:29 -04002051 }
2052
2053 m_ptr = tipc_media_find(name);
2054 if (!m_ptr)
2055 return -ENODEV;
2056 switch (cmd) {
2057 case TIPC_CMD_SET_LINK_TOL:
2058 m_ptr->tolerance = new_value;
Ying Xue636c0372013-10-18 07:23:20 +02002059 break;
Allan Stephens5c216e12011-10-18 11:34:29 -04002060 case TIPC_CMD_SET_LINK_PRI:
2061 m_ptr->priority = new_value;
Ying Xue636c0372013-10-18 07:23:20 +02002062 break;
Allan Stephens5c216e12011-10-18 11:34:29 -04002063 case TIPC_CMD_SET_LINK_WINDOW:
2064 m_ptr->window = new_value;
Ying Xue636c0372013-10-18 07:23:20 +02002065 break;
2066 default:
2067 res = -EINVAL;
2068 break;
Allan Stephens5c216e12011-10-18 11:34:29 -04002069 }
Ying Xue636c0372013-10-18 07:23:20 +02002070 return res;
Allan Stephens5c216e12011-10-18 11:34:29 -04002071}
2072
Ying Xuef2f98002015-01-09 15:27:05 +08002073struct sk_buff *tipc_link_cmd_config(struct net *net, const void *req_tlv_area,
2074 int req_tlv_space, u16 cmd)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002075{
2076 struct tipc_link_config *args;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002077 u32 new_value;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002078 int res;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002079
2080 if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_LINK_CONFIG))
Per Liden4323add2006-01-18 00:38:21 +01002081 return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002082
2083 args = (struct tipc_link_config *)TLV_DATA(req_tlv_area);
2084 new_value = ntohl(args->value);
2085
Allan Stephens5c216e12011-10-18 11:34:29 -04002086 if (!link_value_is_valid(cmd, new_value))
2087 return tipc_cfg_reply_error_string(
2088 "cannot change, value invalid");
2089
Per Liden4323add2006-01-18 00:38:21 +01002090 if (!strcmp(args->name, tipc_bclink_name)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01002091 if ((cmd == TIPC_CMD_SET_LINK_WINDOW) &&
Ying Xue1da46562015-01-09 15:27:07 +08002092 (tipc_bclink_set_queue_limits(net, new_value) == 0))
Per Liden4323add2006-01-18 00:38:21 +01002093 return tipc_cfg_reply_none();
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002094 return tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED
Per Liden4323add2006-01-18 00:38:21 +01002095 " (cannot change setting on broadcast link)");
Per Lidenb97bf3f2006-01-02 19:04:38 +01002096 }
2097
Ying Xuef2f98002015-01-09 15:27:05 +08002098 res = link_cmd_set_value(net, args->name, new_value, cmd);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002099 if (res)
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002100 return tipc_cfg_reply_error_string("cannot change link setting");
Per Lidenb97bf3f2006-01-02 19:04:38 +01002101
Per Liden4323add2006-01-18 00:38:21 +01002102 return tipc_cfg_reply_none();
Per Lidenb97bf3f2006-01-02 19:04:38 +01002103}
2104
2105/**
2106 * link_reset_statistics - reset link statistics
2107 * @l_ptr: pointer to link
2108 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002109static void link_reset_statistics(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002110{
2111 memset(&l_ptr->stats, 0, sizeof(l_ptr->stats));
2112 l_ptr->stats.sent_info = l_ptr->next_out_no;
2113 l_ptr->stats.recv_info = l_ptr->next_in_no;
2114}
2115
Ying Xuef2f98002015-01-09 15:27:05 +08002116struct sk_buff *tipc_link_cmd_reset_stats(struct net *net,
2117 const void *req_tlv_area,
2118 int req_tlv_space)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002119{
2120 char *link_name;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002121 struct tipc_link *l_ptr;
David S. Miller6c000552008-09-02 23:38:32 -07002122 struct tipc_node *node;
Jon Paul Maloye099e862014-02-13 17:29:18 -05002123 unsigned int bearer_id;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002124
2125 if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_LINK_NAME))
Per Liden4323add2006-01-18 00:38:21 +01002126 return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002127
2128 link_name = (char *)TLV_DATA(req_tlv_area);
Per Liden4323add2006-01-18 00:38:21 +01002129 if (!strcmp(link_name, tipc_bclink_name)) {
Ying Xue1da46562015-01-09 15:27:07 +08002130 if (tipc_bclink_reset_stats(net))
Per Liden4323add2006-01-18 00:38:21 +01002131 return tipc_cfg_reply_error_string("link not found");
2132 return tipc_cfg_reply_none();
Per Lidenb97bf3f2006-01-02 19:04:38 +01002133 }
Ying Xuef2f98002015-01-09 15:27:05 +08002134 node = tipc_link_find_owner(net, link_name, &bearer_id);
Ying Xue7216cd92014-04-21 10:55:48 +08002135 if (!node)
Per Liden4323add2006-01-18 00:38:21 +01002136 return tipc_cfg_reply_error_string("link not found");
Ying Xue7216cd92014-04-21 10:55:48 +08002137
Jon Paul Maloya11607f2014-02-14 16:40:44 -05002138 tipc_node_lock(node);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002139 l_ptr = node->links[bearer_id];
2140 if (!l_ptr) {
2141 tipc_node_unlock(node);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002142 return tipc_cfg_reply_error_string("link not found");
2143 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01002144 link_reset_statistics(l_ptr);
Per Liden4323add2006-01-18 00:38:21 +01002145 tipc_node_unlock(node);
Per Liden4323add2006-01-18 00:38:21 +01002146 return tipc_cfg_reply_none();
Per Lidenb97bf3f2006-01-02 19:04:38 +01002147}
2148
2149/**
2150 * percent - convert count to a percentage of total (rounding up or down)
2151 */
Per Lidenb97bf3f2006-01-02 19:04:38 +01002152static u32 percent(u32 count, u32 total)
2153{
2154 return (count * 100 + (total / 2)) / total;
2155}
2156
2157/**
Per Liden4323add2006-01-18 00:38:21 +01002158 * tipc_link_stats - print link statistics
Ying Xuef2f98002015-01-09 15:27:05 +08002159 * @net: the applicable net namespace
Per Lidenb97bf3f2006-01-02 19:04:38 +01002160 * @name: link name
2161 * @buf: print buffer area
2162 * @buf_size: size of print buffer area
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002163 *
Per Lidenb97bf3f2006-01-02 19:04:38 +01002164 * Returns length of print buffer data string (or 0 if error)
2165 */
Ying Xuef2f98002015-01-09 15:27:05 +08002166static int tipc_link_stats(struct net *net, const char *name, char *buf,
2167 const u32 buf_size)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002168{
Erik Hugnedc1aed32012-06-29 00:50:23 -04002169 struct tipc_link *l;
2170 struct tipc_stats *s;
David S. Miller6c000552008-09-02 23:38:32 -07002171 struct tipc_node *node;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002172 char *status;
2173 u32 profile_total = 0;
Jon Paul Maloye099e862014-02-13 17:29:18 -05002174 unsigned int bearer_id;
Erik Hugnedc1aed32012-06-29 00:50:23 -04002175 int ret;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002176
Per Liden4323add2006-01-18 00:38:21 +01002177 if (!strcmp(name, tipc_bclink_name))
Ying Xue1da46562015-01-09 15:27:07 +08002178 return tipc_bclink_stats(net, buf, buf_size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002179
Ying Xuef2f98002015-01-09 15:27:05 +08002180 node = tipc_link_find_owner(net, name, &bearer_id);
Ying Xue7216cd92014-04-21 10:55:48 +08002181 if (!node)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002182 return 0;
Ying Xue7216cd92014-04-21 10:55:48 +08002183
Per Liden4323add2006-01-18 00:38:21 +01002184 tipc_node_lock(node);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002185
2186 l = node->links[bearer_id];
2187 if (!l) {
2188 tipc_node_unlock(node);
Jon Paul Maloye099e862014-02-13 17:29:18 -05002189 return 0;
2190 }
2191
Erik Hugnedc1aed32012-06-29 00:50:23 -04002192 s = &l->stats;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002193
Erik Hugnedc1aed32012-06-29 00:50:23 -04002194 if (tipc_link_is_active(l))
Per Lidenb97bf3f2006-01-02 19:04:38 +01002195 status = "ACTIVE";
Erik Hugnedc1aed32012-06-29 00:50:23 -04002196 else if (tipc_link_is_up(l))
Per Lidenb97bf3f2006-01-02 19:04:38 +01002197 status = "STANDBY";
2198 else
2199 status = "DEFUNCT";
Erik Hugnedc1aed32012-06-29 00:50:23 -04002200
2201 ret = tipc_snprintf(buf, buf_size, "Link <%s>\n"
2202 " %s MTU:%u Priority:%u Tolerance:%u ms"
2203 " Window:%u packets\n",
2204 l->name, status, l->max_pkt, l->priority,
2205 l->tolerance, l->queue_limit[0]);
2206
2207 ret += tipc_snprintf(buf + ret, buf_size - ret,
2208 " RX packets:%u fragments:%u/%u bundles:%u/%u\n",
2209 l->next_in_no - s->recv_info, s->recv_fragments,
2210 s->recv_fragmented, s->recv_bundles,
2211 s->recv_bundled);
2212
2213 ret += tipc_snprintf(buf + ret, buf_size - ret,
2214 " TX packets:%u fragments:%u/%u bundles:%u/%u\n",
2215 l->next_out_no - s->sent_info, s->sent_fragments,
2216 s->sent_fragmented, s->sent_bundles,
2217 s->sent_bundled);
2218
2219 profile_total = s->msg_length_counts;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002220 if (!profile_total)
2221 profile_total = 1;
Erik Hugnedc1aed32012-06-29 00:50:23 -04002222
2223 ret += tipc_snprintf(buf + ret, buf_size - ret,
2224 " TX profile sample:%u packets average:%u octets\n"
2225 " 0-64:%u%% -256:%u%% -1024:%u%% -4096:%u%% "
2226 "-16384:%u%% -32768:%u%% -66000:%u%%\n",
2227 s->msg_length_counts,
2228 s->msg_lengths_total / profile_total,
2229 percent(s->msg_length_profile[0], profile_total),
2230 percent(s->msg_length_profile[1], profile_total),
2231 percent(s->msg_length_profile[2], profile_total),
2232 percent(s->msg_length_profile[3], profile_total),
2233 percent(s->msg_length_profile[4], profile_total),
2234 percent(s->msg_length_profile[5], profile_total),
2235 percent(s->msg_length_profile[6], profile_total));
2236
2237 ret += tipc_snprintf(buf + ret, buf_size - ret,
2238 " RX states:%u probes:%u naks:%u defs:%u"
2239 " dups:%u\n", s->recv_states, s->recv_probes,
2240 s->recv_nacks, s->deferred_recv, s->duplicates);
2241
2242 ret += tipc_snprintf(buf + ret, buf_size - ret,
2243 " TX states:%u probes:%u naks:%u acks:%u"
2244 " dups:%u\n", s->sent_states, s->sent_probes,
2245 s->sent_nacks, s->sent_acks, s->retransmitted);
2246
2247 ret += tipc_snprintf(buf + ret, buf_size - ret,
Ying Xue3c294cb2012-11-15 11:34:45 +08002248 " Congestion link:%u Send queue"
2249 " max:%u avg:%u\n", s->link_congs,
Erik Hugnedc1aed32012-06-29 00:50:23 -04002250 s->max_queue_sz, s->queue_sz_counts ?
2251 (s->accu_queue_sz / s->queue_sz_counts) : 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002252
Per Liden4323add2006-01-18 00:38:21 +01002253 tipc_node_unlock(node);
Erik Hugnedc1aed32012-06-29 00:50:23 -04002254 return ret;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002255}
2256
Ying Xuef2f98002015-01-09 15:27:05 +08002257struct sk_buff *tipc_link_cmd_show_stats(struct net *net,
2258 const void *req_tlv_area,
2259 int req_tlv_space)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002260{
2261 struct sk_buff *buf;
2262 struct tlv_desc *rep_tlv;
2263 int str_len;
Erik Hugnedc1aed32012-06-29 00:50:23 -04002264 int pb_len;
2265 char *pb;
Per Lidenb97bf3f2006-01-02 19:04:38 +01002266
2267 if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_LINK_NAME))
Per Liden4323add2006-01-18 00:38:21 +01002268 return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002269
Erik Hugnedc1aed32012-06-29 00:50:23 -04002270 buf = tipc_cfg_reply_alloc(TLV_SPACE(ULTRA_STRING_MAX_LEN));
Per Lidenb97bf3f2006-01-02 19:04:38 +01002271 if (!buf)
2272 return NULL;
2273
2274 rep_tlv = (struct tlv_desc *)buf->data;
Erik Hugnedc1aed32012-06-29 00:50:23 -04002275 pb = TLV_DATA(rep_tlv);
2276 pb_len = ULTRA_STRING_MAX_LEN;
Ying Xuef2f98002015-01-09 15:27:05 +08002277 str_len = tipc_link_stats(net, (char *)TLV_DATA(req_tlv_area),
Erik Hugnedc1aed32012-06-29 00:50:23 -04002278 pb, pb_len);
Per Lidenb97bf3f2006-01-02 19:04:38 +01002279 if (!str_len) {
Allan Stephens5f6d9122011-11-04 13:24:29 -04002280 kfree_skb(buf);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09002281 return tipc_cfg_reply_error_string("link not found");
Per Lidenb97bf3f2006-01-02 19:04:38 +01002282 }
Erik Hugnedc1aed32012-06-29 00:50:23 -04002283 str_len += 1; /* for "\0" */
Per Lidenb97bf3f2006-01-02 19:04:38 +01002284 skb_put(buf, TLV_SPACE(str_len));
2285 TLV_SET(rep_tlv, TIPC_TLV_ULTRA_STRING, NULL, str_len);
2286
2287 return buf;
2288}
2289
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05002290static void link_print(struct tipc_link *l_ptr, const char *str)
Per Lidenb97bf3f2006-01-02 19:04:38 +01002291{
Ying Xue7f9f95d2015-01-09 15:27:06 +08002292 struct tipc_net *tn = net_generic(l_ptr->owner->net, tipc_net_id);
Ying Xue7a2f7d12014-04-21 10:55:46 +08002293 struct tipc_bearer *b_ptr;
2294
2295 rcu_read_lock();
Ying Xue7f9f95d2015-01-09 15:27:06 +08002296 b_ptr = rcu_dereference_rtnl(tn->bearer_list[l_ptr->bearer_id]);
Ying Xue7a2f7d12014-04-21 10:55:46 +08002297 if (b_ptr)
2298 pr_info("%s Link %x<%s>:", str, l_ptr->addr, b_ptr->name);
2299 rcu_read_unlock();
Allan Stephens8d64a5b2010-12-31 18:59:27 +00002300
Per Lidenb97bf3f2006-01-02 19:04:38 +01002301 if (link_working_unknown(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04002302 pr_cont(":WU\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00002303 else if (link_reset_reset(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04002304 pr_cont(":RR\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00002305 else if (link_reset_unknown(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04002306 pr_cont(":RU\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00002307 else if (link_working_working(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04002308 pr_cont(":WW\n");
2309 else
2310 pr_cont("\n");
Per Lidenb97bf3f2006-01-02 19:04:38 +01002311}
Richard Alpe0655f6a2014-11-20 10:29:07 +01002312
2313/* Parse and validate nested (link) properties valid for media, bearer and link
2314 */
2315int tipc_nl_parse_link_prop(struct nlattr *prop, struct nlattr *props[])
2316{
2317 int err;
2318
2319 err = nla_parse_nested(props, TIPC_NLA_PROP_MAX, prop,
2320 tipc_nl_prop_policy);
2321 if (err)
2322 return err;
2323
2324 if (props[TIPC_NLA_PROP_PRIO]) {
2325 u32 prio;
2326
2327 prio = nla_get_u32(props[TIPC_NLA_PROP_PRIO]);
2328 if (prio > TIPC_MAX_LINK_PRI)
2329 return -EINVAL;
2330 }
2331
2332 if (props[TIPC_NLA_PROP_TOL]) {
2333 u32 tol;
2334
2335 tol = nla_get_u32(props[TIPC_NLA_PROP_TOL]);
2336 if ((tol < TIPC_MIN_LINK_TOL) || (tol > TIPC_MAX_LINK_TOL))
2337 return -EINVAL;
2338 }
2339
2340 if (props[TIPC_NLA_PROP_WIN]) {
2341 u32 win;
2342
2343 win = nla_get_u32(props[TIPC_NLA_PROP_WIN]);
2344 if ((win < TIPC_MIN_LINK_WIN) || (win > TIPC_MAX_LINK_WIN))
2345 return -EINVAL;
2346 }
2347
2348 return 0;
2349}
Richard Alpe7be57fc2014-11-20 10:29:12 +01002350
Richard Alpef96ce7a2014-11-20 10:29:13 +01002351int tipc_nl_link_set(struct sk_buff *skb, struct genl_info *info)
2352{
2353 int err;
2354 int res = 0;
2355 int bearer_id;
2356 char *name;
2357 struct tipc_link *link;
2358 struct tipc_node *node;
2359 struct nlattr *attrs[TIPC_NLA_LINK_MAX + 1];
Ying Xuef2f98002015-01-09 15:27:05 +08002360 struct net *net = genl_info_net(info);
Richard Alpef96ce7a2014-11-20 10:29:13 +01002361
2362 if (!info->attrs[TIPC_NLA_LINK])
2363 return -EINVAL;
2364
2365 err = nla_parse_nested(attrs, TIPC_NLA_LINK_MAX,
2366 info->attrs[TIPC_NLA_LINK],
2367 tipc_nl_link_policy);
2368 if (err)
2369 return err;
2370
2371 if (!attrs[TIPC_NLA_LINK_NAME])
2372 return -EINVAL;
2373
2374 name = nla_data(attrs[TIPC_NLA_LINK_NAME]);
2375
Ying Xuef2f98002015-01-09 15:27:05 +08002376 node = tipc_link_find_owner(net, name, &bearer_id);
Richard Alpef96ce7a2014-11-20 10:29:13 +01002377 if (!node)
2378 return -EINVAL;
2379
2380 tipc_node_lock(node);
2381
2382 link = node->links[bearer_id];
2383 if (!link) {
2384 res = -EINVAL;
2385 goto out;
2386 }
2387
2388 if (attrs[TIPC_NLA_LINK_PROP]) {
2389 struct nlattr *props[TIPC_NLA_PROP_MAX + 1];
2390
2391 err = tipc_nl_parse_link_prop(attrs[TIPC_NLA_LINK_PROP],
2392 props);
2393 if (err) {
2394 res = err;
2395 goto out;
2396 }
2397
2398 if (props[TIPC_NLA_PROP_TOL]) {
2399 u32 tol;
2400
2401 tol = nla_get_u32(props[TIPC_NLA_PROP_TOL]);
2402 link_set_supervision_props(link, tol);
2403 tipc_link_proto_xmit(link, STATE_MSG, 0, 0, tol, 0, 0);
2404 }
2405 if (props[TIPC_NLA_PROP_PRIO]) {
2406 u32 prio;
2407
2408 prio = nla_get_u32(props[TIPC_NLA_PROP_PRIO]);
2409 link->priority = prio;
2410 tipc_link_proto_xmit(link, STATE_MSG, 0, 0, 0, prio, 0);
2411 }
2412 if (props[TIPC_NLA_PROP_WIN]) {
2413 u32 win;
2414
2415 win = nla_get_u32(props[TIPC_NLA_PROP_WIN]);
2416 tipc_link_set_queue_limits(link, win);
2417 }
2418 }
2419
2420out:
2421 tipc_node_unlock(node);
2422
2423 return res;
2424}
Richard Alped8182802014-11-24 11:10:29 +01002425
2426static int __tipc_nl_add_stats(struct sk_buff *skb, struct tipc_stats *s)
Richard Alpe7be57fc2014-11-20 10:29:12 +01002427{
2428 int i;
2429 struct nlattr *stats;
2430
2431 struct nla_map {
2432 u32 key;
2433 u32 val;
2434 };
2435
2436 struct nla_map map[] = {
2437 {TIPC_NLA_STATS_RX_INFO, s->recv_info},
2438 {TIPC_NLA_STATS_RX_FRAGMENTS, s->recv_fragments},
2439 {TIPC_NLA_STATS_RX_FRAGMENTED, s->recv_fragmented},
2440 {TIPC_NLA_STATS_RX_BUNDLES, s->recv_bundles},
2441 {TIPC_NLA_STATS_RX_BUNDLED, s->recv_bundled},
2442 {TIPC_NLA_STATS_TX_INFO, s->sent_info},
2443 {TIPC_NLA_STATS_TX_FRAGMENTS, s->sent_fragments},
2444 {TIPC_NLA_STATS_TX_FRAGMENTED, s->sent_fragmented},
2445 {TIPC_NLA_STATS_TX_BUNDLES, s->sent_bundles},
2446 {TIPC_NLA_STATS_TX_BUNDLED, s->sent_bundled},
2447 {TIPC_NLA_STATS_MSG_PROF_TOT, (s->msg_length_counts) ?
2448 s->msg_length_counts : 1},
2449 {TIPC_NLA_STATS_MSG_LEN_CNT, s->msg_length_counts},
2450 {TIPC_NLA_STATS_MSG_LEN_TOT, s->msg_lengths_total},
2451 {TIPC_NLA_STATS_MSG_LEN_P0, s->msg_length_profile[0]},
2452 {TIPC_NLA_STATS_MSG_LEN_P1, s->msg_length_profile[1]},
2453 {TIPC_NLA_STATS_MSG_LEN_P2, s->msg_length_profile[2]},
2454 {TIPC_NLA_STATS_MSG_LEN_P3, s->msg_length_profile[3]},
2455 {TIPC_NLA_STATS_MSG_LEN_P4, s->msg_length_profile[4]},
2456 {TIPC_NLA_STATS_MSG_LEN_P5, s->msg_length_profile[5]},
2457 {TIPC_NLA_STATS_MSG_LEN_P6, s->msg_length_profile[6]},
2458 {TIPC_NLA_STATS_RX_STATES, s->recv_states},
2459 {TIPC_NLA_STATS_RX_PROBES, s->recv_probes},
2460 {TIPC_NLA_STATS_RX_NACKS, s->recv_nacks},
2461 {TIPC_NLA_STATS_RX_DEFERRED, s->deferred_recv},
2462 {TIPC_NLA_STATS_TX_STATES, s->sent_states},
2463 {TIPC_NLA_STATS_TX_PROBES, s->sent_probes},
2464 {TIPC_NLA_STATS_TX_NACKS, s->sent_nacks},
2465 {TIPC_NLA_STATS_TX_ACKS, s->sent_acks},
2466 {TIPC_NLA_STATS_RETRANSMITTED, s->retransmitted},
2467 {TIPC_NLA_STATS_DUPLICATES, s->duplicates},
2468 {TIPC_NLA_STATS_LINK_CONGS, s->link_congs},
2469 {TIPC_NLA_STATS_MAX_QUEUE, s->max_queue_sz},
2470 {TIPC_NLA_STATS_AVG_QUEUE, s->queue_sz_counts ?
2471 (s->accu_queue_sz / s->queue_sz_counts) : 0}
2472 };
2473
2474 stats = nla_nest_start(skb, TIPC_NLA_LINK_STATS);
2475 if (!stats)
2476 return -EMSGSIZE;
2477
2478 for (i = 0; i < ARRAY_SIZE(map); i++)
2479 if (nla_put_u32(skb, map[i].key, map[i].val))
2480 goto msg_full;
2481
2482 nla_nest_end(skb, stats);
2483
2484 return 0;
2485msg_full:
2486 nla_nest_cancel(skb, stats);
2487
2488 return -EMSGSIZE;
2489}
2490
2491/* Caller should hold appropriate locks to protect the link */
Ying Xue34747532015-01-09 15:27:10 +08002492static int __tipc_nl_add_link(struct net *net, struct tipc_nl_msg *msg,
2493 struct tipc_link *link)
Richard Alpe7be57fc2014-11-20 10:29:12 +01002494{
2495 int err;
2496 void *hdr;
2497 struct nlattr *attrs;
2498 struct nlattr *prop;
Ying Xue34747532015-01-09 15:27:10 +08002499 struct tipc_net *tn = net_generic(net, tipc_net_id);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002500
Richard Alpebfb3e5d2015-02-09 09:50:03 +01002501 hdr = genlmsg_put(msg->skb, msg->portid, msg->seq, &tipc_genl_family,
Richard Alpe7be57fc2014-11-20 10:29:12 +01002502 NLM_F_MULTI, TIPC_NL_LINK_GET);
2503 if (!hdr)
2504 return -EMSGSIZE;
2505
2506 attrs = nla_nest_start(msg->skb, TIPC_NLA_LINK);
2507 if (!attrs)
2508 goto msg_full;
2509
2510 if (nla_put_string(msg->skb, TIPC_NLA_LINK_NAME, link->name))
2511 goto attr_msg_full;
2512 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_DEST,
Ying Xue34747532015-01-09 15:27:10 +08002513 tipc_cluster_mask(tn->own_addr)))
Richard Alpe7be57fc2014-11-20 10:29:12 +01002514 goto attr_msg_full;
2515 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_MTU, link->max_pkt))
2516 goto attr_msg_full;
2517 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_RX, link->next_in_no))
2518 goto attr_msg_full;
2519 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_TX, link->next_out_no))
2520 goto attr_msg_full;
2521
2522 if (tipc_link_is_up(link))
2523 if (nla_put_flag(msg->skb, TIPC_NLA_LINK_UP))
2524 goto attr_msg_full;
2525 if (tipc_link_is_active(link))
2526 if (nla_put_flag(msg->skb, TIPC_NLA_LINK_ACTIVE))
2527 goto attr_msg_full;
2528
2529 prop = nla_nest_start(msg->skb, TIPC_NLA_LINK_PROP);
2530 if (!prop)
2531 goto attr_msg_full;
2532 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_PRIO, link->priority))
2533 goto prop_msg_full;
2534 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_TOL, link->tolerance))
2535 goto prop_msg_full;
2536 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_WIN,
2537 link->queue_limit[TIPC_LOW_IMPORTANCE]))
2538 goto prop_msg_full;
2539 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_PRIO, link->priority))
2540 goto prop_msg_full;
2541 nla_nest_end(msg->skb, prop);
2542
2543 err = __tipc_nl_add_stats(msg->skb, &link->stats);
2544 if (err)
2545 goto attr_msg_full;
2546
2547 nla_nest_end(msg->skb, attrs);
2548 genlmsg_end(msg->skb, hdr);
2549
2550 return 0;
2551
2552prop_msg_full:
2553 nla_nest_cancel(msg->skb, prop);
2554attr_msg_full:
2555 nla_nest_cancel(msg->skb, attrs);
2556msg_full:
2557 genlmsg_cancel(msg->skb, hdr);
2558
2559 return -EMSGSIZE;
2560}
2561
2562/* Caller should hold node lock */
Ying Xue34747532015-01-09 15:27:10 +08002563static int __tipc_nl_add_node_links(struct net *net, struct tipc_nl_msg *msg,
2564 struct tipc_node *node, u32 *prev_link)
Richard Alpe7be57fc2014-11-20 10:29:12 +01002565{
2566 u32 i;
2567 int err;
2568
2569 for (i = *prev_link; i < MAX_BEARERS; i++) {
2570 *prev_link = i;
2571
2572 if (!node->links[i])
2573 continue;
2574
Ying Xue34747532015-01-09 15:27:10 +08002575 err = __tipc_nl_add_link(net, msg, node->links[i]);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002576 if (err)
2577 return err;
2578 }
2579 *prev_link = 0;
2580
2581 return 0;
2582}
2583
2584int tipc_nl_link_dump(struct sk_buff *skb, struct netlink_callback *cb)
2585{
Ying Xuef2f98002015-01-09 15:27:05 +08002586 struct net *net = sock_net(skb->sk);
2587 struct tipc_net *tn = net_generic(net, tipc_net_id);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002588 struct tipc_node *node;
2589 struct tipc_nl_msg msg;
2590 u32 prev_node = cb->args[0];
2591 u32 prev_link = cb->args[1];
2592 int done = cb->args[2];
2593 int err;
2594
2595 if (done)
2596 return 0;
2597
2598 msg.skb = skb;
2599 msg.portid = NETLINK_CB(cb->skb).portid;
2600 msg.seq = cb->nlh->nlmsg_seq;
2601
2602 rcu_read_lock();
2603
2604 if (prev_node) {
Ying Xuef2f98002015-01-09 15:27:05 +08002605 node = tipc_node_find(net, prev_node);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002606 if (!node) {
2607 /* We never set seq or call nl_dump_check_consistent()
2608 * this means that setting prev_seq here will cause the
2609 * consistence check to fail in the netlink callback
2610 * handler. Resulting in the last NLMSG_DONE message
2611 * having the NLM_F_DUMP_INTR flag set.
2612 */
2613 cb->prev_seq = 1;
2614 goto out;
2615 }
2616
Ying Xuef2f98002015-01-09 15:27:05 +08002617 list_for_each_entry_continue_rcu(node, &tn->node_list,
2618 list) {
Richard Alpe7be57fc2014-11-20 10:29:12 +01002619 tipc_node_lock(node);
Ying Xue34747532015-01-09 15:27:10 +08002620 err = __tipc_nl_add_node_links(net, &msg, node,
2621 &prev_link);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002622 tipc_node_unlock(node);
2623 if (err)
2624 goto out;
2625
2626 prev_node = node->addr;
2627 }
2628 } else {
Ying Xue1da46562015-01-09 15:27:07 +08002629 err = tipc_nl_add_bc_link(net, &msg);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002630 if (err)
2631 goto out;
2632
Ying Xuef2f98002015-01-09 15:27:05 +08002633 list_for_each_entry_rcu(node, &tn->node_list, list) {
Richard Alpe7be57fc2014-11-20 10:29:12 +01002634 tipc_node_lock(node);
Ying Xue34747532015-01-09 15:27:10 +08002635 err = __tipc_nl_add_node_links(net, &msg, node,
2636 &prev_link);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002637 tipc_node_unlock(node);
2638 if (err)
2639 goto out;
2640
2641 prev_node = node->addr;
2642 }
2643 }
2644 done = 1;
2645out:
2646 rcu_read_unlock();
2647
2648 cb->args[0] = prev_node;
2649 cb->args[1] = prev_link;
2650 cb->args[2] = done;
2651
2652 return skb->len;
2653}
2654
2655int tipc_nl_link_get(struct sk_buff *skb, struct genl_info *info)
2656{
Ying Xuef2f98002015-01-09 15:27:05 +08002657 struct net *net = genl_info_net(info);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002658 struct sk_buff *ans_skb;
2659 struct tipc_nl_msg msg;
2660 struct tipc_link *link;
2661 struct tipc_node *node;
2662 char *name;
2663 int bearer_id;
2664 int err;
2665
2666 if (!info->attrs[TIPC_NLA_LINK_NAME])
2667 return -EINVAL;
2668
2669 name = nla_data(info->attrs[TIPC_NLA_LINK_NAME]);
Ying Xuef2f98002015-01-09 15:27:05 +08002670 node = tipc_link_find_owner(net, name, &bearer_id);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002671 if (!node)
2672 return -EINVAL;
2673
2674 ans_skb = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
2675 if (!ans_skb)
2676 return -ENOMEM;
2677
2678 msg.skb = ans_skb;
2679 msg.portid = info->snd_portid;
2680 msg.seq = info->snd_seq;
2681
2682 tipc_node_lock(node);
2683 link = node->links[bearer_id];
2684 if (!link) {
2685 err = -EINVAL;
2686 goto err_out;
2687 }
2688
Ying Xue34747532015-01-09 15:27:10 +08002689 err = __tipc_nl_add_link(net, &msg, link);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002690 if (err)
2691 goto err_out;
2692
2693 tipc_node_unlock(node);
2694
2695 return genlmsg_reply(ans_skb, info);
2696
2697err_out:
2698 tipc_node_unlock(node);
2699 nlmsg_free(ans_skb);
2700
2701 return err;
2702}
Richard Alpeae363422014-11-20 10:29:14 +01002703
2704int tipc_nl_link_reset_stats(struct sk_buff *skb, struct genl_info *info)
2705{
2706 int err;
2707 char *link_name;
2708 unsigned int bearer_id;
2709 struct tipc_link *link;
2710 struct tipc_node *node;
2711 struct nlattr *attrs[TIPC_NLA_LINK_MAX + 1];
Ying Xuef2f98002015-01-09 15:27:05 +08002712 struct net *net = genl_info_net(info);
Richard Alpeae363422014-11-20 10:29:14 +01002713
2714 if (!info->attrs[TIPC_NLA_LINK])
2715 return -EINVAL;
2716
2717 err = nla_parse_nested(attrs, TIPC_NLA_LINK_MAX,
2718 info->attrs[TIPC_NLA_LINK],
2719 tipc_nl_link_policy);
2720 if (err)
2721 return err;
2722
2723 if (!attrs[TIPC_NLA_LINK_NAME])
2724 return -EINVAL;
2725
2726 link_name = nla_data(attrs[TIPC_NLA_LINK_NAME]);
2727
2728 if (strcmp(link_name, tipc_bclink_name) == 0) {
Ying Xue1da46562015-01-09 15:27:07 +08002729 err = tipc_bclink_reset_stats(net);
Richard Alpeae363422014-11-20 10:29:14 +01002730 if (err)
2731 return err;
2732 return 0;
2733 }
2734
Ying Xuef2f98002015-01-09 15:27:05 +08002735 node = tipc_link_find_owner(net, link_name, &bearer_id);
Richard Alpeae363422014-11-20 10:29:14 +01002736 if (!node)
2737 return -EINVAL;
2738
2739 tipc_node_lock(node);
2740
2741 link = node->links[bearer_id];
2742 if (!link) {
2743 tipc_node_unlock(node);
2744 return -EINVAL;
2745 }
2746
2747 link_reset_statistics(link);
2748
2749 tipc_node_unlock(node);
2750
2751 return 0;
2752}