blob: a5ea19e9690f720bb84eed42f0849b63d0bc711a [file] [log] [blame]
Per Lidenb97bf3f2006-01-02 19:04:38 +01001/*
2 * net/tipc/link.c: TIPC link code
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09003 *
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04004 * Copyright (c) 1996-2007, 2012-2015, Ericsson AB
Ying Xue198d73b2013-06-17 10:54:42 -04005 * Copyright (c) 2004-2007, 2010-2013, Wind River Systems
Per Lidenb97bf3f2006-01-02 19:04:38 +01006 * All rights reserved.
7 *
Per Liden9ea1fd32006-01-11 13:30:43 +01008 * Redistribution and use in source and binary forms, with or without
Per Lidenb97bf3f2006-01-02 19:04:38 +01009 * modification, are permitted provided that the following conditions are met:
10 *
Per Liden9ea1fd32006-01-11 13:30:43 +010011 * 1. Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the distribution.
16 * 3. Neither the names of the copyright holders nor the names of its
17 * contributors may be used to endorse or promote products derived from
18 * this software without specific prior written permission.
Per Lidenb97bf3f2006-01-02 19:04:38 +010019 *
Per Liden9ea1fd32006-01-11 13:30:43 +010020 * Alternatively, this software may be distributed under the terms of the
21 * GNU General Public License ("GPL") version 2 as published by the Free
22 * Software Foundation.
23 *
24 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
25 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
26 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
27 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
28 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
29 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
30 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
31 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
32 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
33 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
Per Lidenb97bf3f2006-01-02 19:04:38 +010034 * POSSIBILITY OF SUCH DAMAGE.
35 */
36
37#include "core.h"
Jon Paul Maloye3eea1e2015-03-13 16:08:11 -040038#include "subscr.h"
Per Lidenb97bf3f2006-01-02 19:04:38 +010039#include "link.h"
Richard Alpe7be57fc2014-11-20 10:29:12 +010040#include "bcast.h"
Jon Paul Maloy9816f062014-05-14 05:39:15 -040041#include "socket.h"
Per Lidenb97bf3f2006-01-02 19:04:38 +010042#include "name_distr.h"
Per Lidenb97bf3f2006-01-02 19:04:38 +010043#include "discover.h"
Richard Alpe0655f6a2014-11-20 10:29:07 +010044#include "netlink.h"
Per Lidenb97bf3f2006-01-02 19:04:38 +010045
Ying Xue796c75d2013-06-17 10:54:48 -040046#include <linux/pkt_sched.h>
47
Erik Hugne2cf8aa12012-06-29 00:16:37 -040048/*
49 * Error message prefixes
50 */
51static const char *link_co_err = "Link changeover error, ";
52static const char *link_rst_msg = "Resetting link ";
53static const char *link_unk_evt = "Unknown link event ";
Per Lidenb97bf3f2006-01-02 19:04:38 +010054
Richard Alpe7be57fc2014-11-20 10:29:12 +010055static const struct nla_policy tipc_nl_link_policy[TIPC_NLA_LINK_MAX + 1] = {
56 [TIPC_NLA_LINK_UNSPEC] = { .type = NLA_UNSPEC },
57 [TIPC_NLA_LINK_NAME] = {
58 .type = NLA_STRING,
59 .len = TIPC_MAX_LINK_NAME
60 },
61 [TIPC_NLA_LINK_MTU] = { .type = NLA_U32 },
62 [TIPC_NLA_LINK_BROADCAST] = { .type = NLA_FLAG },
63 [TIPC_NLA_LINK_UP] = { .type = NLA_FLAG },
64 [TIPC_NLA_LINK_ACTIVE] = { .type = NLA_FLAG },
65 [TIPC_NLA_LINK_PROP] = { .type = NLA_NESTED },
66 [TIPC_NLA_LINK_STATS] = { .type = NLA_NESTED },
67 [TIPC_NLA_LINK_RX] = { .type = NLA_U32 },
68 [TIPC_NLA_LINK_TX] = { .type = NLA_U32 }
69};
70
Richard Alpe0655f6a2014-11-20 10:29:07 +010071/* Properties valid for media, bearar and link */
72static const struct nla_policy tipc_nl_prop_policy[TIPC_NLA_PROP_MAX + 1] = {
73 [TIPC_NLA_PROP_UNSPEC] = { .type = NLA_UNSPEC },
74 [TIPC_NLA_PROP_PRIO] = { .type = NLA_U32 },
75 [TIPC_NLA_PROP_TOL] = { .type = NLA_U32 },
76 [TIPC_NLA_PROP_WIN] = { .type = NLA_U32 }
77};
78
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +090079/*
Allan Stephensa686e682008-06-04 17:29:39 -070080 * Out-of-range value for link session numbers
81 */
Allan Stephensa686e682008-06-04 17:29:39 -070082#define INVALID_SESSION 0x10000
83
84/*
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +090085 * Link state events:
Per Lidenb97bf3f2006-01-02 19:04:38 +010086 */
Per Lidenb97bf3f2006-01-02 19:04:38 +010087#define STARTING_EVT 856384768 /* link processing trigger */
88#define TRAFFIC_MSG_EVT 560815u /* rx'd ??? */
Jon Paul Maloycd4eee32015-05-14 10:46:16 -040089#define SILENCE_EVT 560817u /* timer dicovered silence from peer */
Per Lidenb97bf3f2006-01-02 19:04:38 +010090
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +090091/*
Jon Paul Maloydff29b12015-04-02 09:33:01 -040092 * State value stored in 'failover_pkts'
Per Lidenb97bf3f2006-01-02 19:04:38 +010093 */
Jon Paul Maloydff29b12015-04-02 09:33:01 -040094#define FIRST_FAILOVER 0xffffu
Per Lidenb97bf3f2006-01-02 19:04:38 +010095
Jon Paul Maloyc5898632015-02-05 08:36:36 -050096static void link_handle_out_of_seq_msg(struct tipc_link *link,
97 struct sk_buff *skb);
98static void tipc_link_proto_rcv(struct tipc_link *link,
99 struct sk_buff *skb);
Ying Xue2f55c432015-01-09 15:27:00 +0800100static void link_set_supervision_props(struct tipc_link *l_ptr, u32 tol);
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500101static void link_state_event(struct tipc_link *l_ptr, u32 event);
102static void link_reset_statistics(struct tipc_link *l_ptr);
103static void link_print(struct tipc_link *l_ptr, const char *str);
Ying Xue247f0f32014-02-18 16:06:46 +0800104static void tipc_link_sync_xmit(struct tipc_link *l);
105static void tipc_link_sync_rcv(struct tipc_node *n, struct sk_buff *buf);
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500106static void tipc_link_input(struct tipc_link *l, struct sk_buff *skb);
107static bool tipc_data_input(struct tipc_link *l, struct sk_buff *skb);
Jon Paul Maloydff29b12015-04-02 09:33:01 -0400108static bool tipc_link_failover_rcv(struct tipc_link *l, struct sk_buff **skb);
Jon Paul Maloycd4eee32015-05-14 10:46:16 -0400109static void link_set_timer(struct tipc_link *link, unsigned long time);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100110/*
Sam Ravnborg05790c62006-03-20 22:37:04 -0800111 * Simple link routines
Per Lidenb97bf3f2006-01-02 19:04:38 +0100112 */
Sam Ravnborg05790c62006-03-20 22:37:04 -0800113static unsigned int align(unsigned int i)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100114{
115 return (i + 3) & ~3u;
116}
117
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500118static void tipc_link_release(struct kref *kref)
119{
120 kfree(container_of(kref, struct tipc_link, ref));
121}
122
123static void tipc_link_get(struct tipc_link *l_ptr)
124{
125 kref_get(&l_ptr->ref);
126}
127
128static void tipc_link_put(struct tipc_link *l_ptr)
129{
130 kref_put(&l_ptr->ref, tipc_link_release);
131}
132
Jon Paul Maloy8b4ed862015-03-25 12:07:26 -0400133static struct tipc_link *tipc_parallel_link(struct tipc_link *l)
134{
135 if (l->owner->active_links[0] != l)
136 return l->owner->active_links[0];
137 return l->owner->active_links[1];
138}
139
Per Lidenb97bf3f2006-01-02 19:04:38 +0100140/*
Sam Ravnborg05790c62006-03-20 22:37:04 -0800141 * Simple non-static link routines (i.e. referenced outside this file)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100142 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500143int tipc_link_is_up(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100144{
145 if (!l_ptr)
146 return 0;
Eric Dumazeta02cec22010-09-22 20:43:57 +0000147 return link_working_working(l_ptr) || link_working_unknown(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100148}
149
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500150int tipc_link_is_active(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100151{
Eric Dumazeta02cec22010-09-22 20:43:57 +0000152 return (l_ptr->owner->active_links[0] == l_ptr) ||
153 (l_ptr->owner->active_links[1] == l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100154}
155
156/**
Per Lidenb97bf3f2006-01-02 19:04:38 +0100157 * link_timeout - handle expiration of link timer
158 * @l_ptr: pointer to link
Per Lidenb97bf3f2006-01-02 19:04:38 +0100159 */
Ying Xue2f55c432015-01-09 15:27:00 +0800160static void link_timeout(unsigned long data)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100161{
Ying Xue2f55c432015-01-09 15:27:00 +0800162 struct tipc_link *l_ptr = (struct tipc_link *)data;
Ying Xue58dc55f2014-11-26 11:41:52 +0800163 struct sk_buff *skb;
164
Per Liden4323add2006-01-18 00:38:21 +0100165 tipc_node_lock(l_ptr->owner);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100166
167 /* update counters used in statistical profiling of send traffic */
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400168 l_ptr->stats.accu_queue_sz += skb_queue_len(&l_ptr->transmq);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100169 l_ptr->stats.queue_sz_counts++;
170
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400171 skb = skb_peek(&l_ptr->transmq);
Ying Xue58dc55f2014-11-26 11:41:52 +0800172 if (skb) {
173 struct tipc_msg *msg = buf_msg(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100174 u32 length = msg_size(msg);
175
Joe Perchesf64f9e72009-11-29 16:55:45 -0800176 if ((msg_user(msg) == MSG_FRAGMENTER) &&
177 (msg_type(msg) == FIRST_FRAGMENT)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100178 length = msg_size(msg_get_wrapped(msg));
179 }
180 if (length) {
181 l_ptr->stats.msg_lengths_total += length;
182 l_ptr->stats.msg_length_counts++;
183 if (length <= 64)
184 l_ptr->stats.msg_length_profile[0]++;
185 else if (length <= 256)
186 l_ptr->stats.msg_length_profile[1]++;
187 else if (length <= 1024)
188 l_ptr->stats.msg_length_profile[2]++;
189 else if (length <= 4096)
190 l_ptr->stats.msg_length_profile[3]++;
191 else if (length <= 16384)
192 l_ptr->stats.msg_length_profile[4]++;
193 else if (length <= 32768)
194 l_ptr->stats.msg_length_profile[5]++;
195 else
196 l_ptr->stats.msg_length_profile[6]++;
197 }
198 }
199
200 /* do all other link processing performed on a periodic basis */
Jon Paul Maloycd4eee32015-05-14 10:46:16 -0400201 if (l_ptr->silent_intv_cnt || tipc_bclink_acks_missing(l_ptr->owner))
202 link_state_event(l_ptr, SILENCE_EVT);
203 l_ptr->silent_intv_cnt++;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400204 if (skb_queue_len(&l_ptr->backlogq))
Ying Xue47b4c9a2014-11-26 11:41:48 +0800205 tipc_link_push_packets(l_ptr);
Jon Paul Maloycd4eee32015-05-14 10:46:16 -0400206 link_set_timer(l_ptr, l_ptr->keepalive_intv);
Per Liden4323add2006-01-18 00:38:21 +0100207 tipc_node_unlock(l_ptr->owner);
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500208 tipc_link_put(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100209}
210
Ying Xue2f55c432015-01-09 15:27:00 +0800211static void link_set_timer(struct tipc_link *link, unsigned long time)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100212{
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500213 if (!mod_timer(&link->timer, jiffies + time))
214 tipc_link_get(link);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100215}
216
217/**
Per Liden4323add2006-01-18 00:38:21 +0100218 * tipc_link_create - create a new link
Allan Stephens37b9c082011-02-28 11:32:27 -0500219 * @n_ptr: pointer to associated node
Per Lidenb97bf3f2006-01-02 19:04:38 +0100220 * @b_ptr: pointer to associated bearer
Per Lidenb97bf3f2006-01-02 19:04:38 +0100221 * @media_addr: media address to use when sending messages over link
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900222 *
Per Lidenb97bf3f2006-01-02 19:04:38 +0100223 * Returns pointer to link.
224 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500225struct tipc_link *tipc_link_create(struct tipc_node *n_ptr,
Ying Xuec61dd612014-02-13 17:29:09 -0500226 struct tipc_bearer *b_ptr,
227 const struct tipc_media_addr *media_addr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100228{
Ying Xue34747532015-01-09 15:27:10 +0800229 struct tipc_net *tn = net_generic(n_ptr->net, tipc_net_id);
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500230 struct tipc_link *l_ptr;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100231 struct tipc_msg *msg;
232 char *if_name;
Allan Stephens37b9c082011-02-28 11:32:27 -0500233 char addr_string[16];
234 u32 peer = n_ptr->addr;
235
Holger Brunck0372bf52014-11-14 18:33:19 +0100236 if (n_ptr->link_cnt >= MAX_BEARERS) {
Allan Stephens37b9c082011-02-28 11:32:27 -0500237 tipc_addr_string_fill(addr_string, n_ptr->addr);
Jon Paul Maloya97b9d32015-05-14 10:46:15 -0400238 pr_err("Cannot establish %uth link to %s. Max %u allowed.\n",
239 n_ptr->link_cnt, addr_string, MAX_BEARERS);
Allan Stephens37b9c082011-02-28 11:32:27 -0500240 return NULL;
241 }
242
243 if (n_ptr->links[b_ptr->identity]) {
244 tipc_addr_string_fill(addr_string, n_ptr->addr);
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400245 pr_err("Attempt to establish second link on <%s> to %s\n",
246 b_ptr->name, addr_string);
Allan Stephens37b9c082011-02-28 11:32:27 -0500247 return NULL;
248 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100249
Panagiotis Issaris0da974f2006-07-21 14:51:30 -0700250 l_ptr = kzalloc(sizeof(*l_ptr), GFP_ATOMIC);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100251 if (!l_ptr) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400252 pr_warn("Link creation failed, no memory\n");
Per Lidenb97bf3f2006-01-02 19:04:38 +0100253 return NULL;
254 }
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500255 kref_init(&l_ptr->ref);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100256 l_ptr->addr = peer;
Allan Stephens2d627b92011-01-07 13:00:11 -0500257 if_name = strchr(b_ptr->name, ':') + 1;
Allan Stephens062b4c92011-04-07 09:28:47 -0400258 sprintf(l_ptr->name, "%u.%u.%u:%s-%u.%u.%u:unknown",
Ying Xue34747532015-01-09 15:27:10 +0800259 tipc_zone(tn->own_addr), tipc_cluster(tn->own_addr),
260 tipc_node(tn->own_addr),
Per Lidenb97bf3f2006-01-02 19:04:38 +0100261 if_name,
262 tipc_zone(peer), tipc_cluster(peer), tipc_node(peer));
Allan Stephens062b4c92011-04-07 09:28:47 -0400263 /* note: peer i/f name is updated by reset/activate message */
Per Lidenb97bf3f2006-01-02 19:04:38 +0100264 memcpy(&l_ptr->media_addr, media_addr, sizeof(*media_addr));
Allan Stephens37b9c082011-02-28 11:32:27 -0500265 l_ptr->owner = n_ptr;
Allan Stephensf882cb72011-04-07 09:43:27 -0400266 l_ptr->peer_session = INVALID_SESSION;
Ying Xue7a2f7d12014-04-21 10:55:46 +0800267 l_ptr->bearer_id = b_ptr->identity;
Allan Stephens5c216e12011-10-18 11:34:29 -0400268 link_set_supervision_props(l_ptr, b_ptr->tolerance);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100269 l_ptr->state = RESET_UNKNOWN;
270
271 l_ptr->pmsg = (struct tipc_msg *)&l_ptr->proto_msg;
272 msg = l_ptr->pmsg;
Jon Paul Maloyc5898632015-02-05 08:36:36 -0500273 tipc_msg_init(tn->own_addr, msg, LINK_PROTOCOL, RESET_MSG, INT_H_SIZE,
Ying Xue34747532015-01-09 15:27:10 +0800274 l_ptr->addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100275 msg_set_size(msg, sizeof(l_ptr->proto_msg));
Ying Xuebafa29e2015-01-09 15:27:12 +0800276 msg_set_session(msg, (tn->random & 0xffff));
Per Lidenb97bf3f2006-01-02 19:04:38 +0100277 msg_set_bearer_id(msg, b_ptr->identity);
278 strcpy((char *)msg_data(msg), if_name);
Ying Xue7a2f7d12014-04-21 10:55:46 +0800279 l_ptr->net_plane = b_ptr->net_plane;
Jon Paul Maloyed193ec2015-04-02 09:33:02 -0400280 l_ptr->advertised_mtu = b_ptr->mtu;
281 l_ptr->mtu = l_ptr->advertised_mtu;
Jon Paul Maloye3eea1e2015-03-13 16:08:11 -0400282 l_ptr->priority = b_ptr->priority;
283 tipc_link_set_queue_limits(l_ptr, b_ptr->window);
Jon Paul Maloya97b9d32015-05-14 10:46:15 -0400284 l_ptr->snd_nxt = 1;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400285 __skb_queue_head_init(&l_ptr->transmq);
286 __skb_queue_head_init(&l_ptr->backlogq);
287 __skb_queue_head_init(&l_ptr->deferdq);
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500288 skb_queue_head_init(&l_ptr->wakeupq);
289 skb_queue_head_init(&l_ptr->inputq);
290 skb_queue_head_init(&l_ptr->namedq);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100291 link_reset_statistics(l_ptr);
Allan Stephens37b9c082011-02-28 11:32:27 -0500292 tipc_node_attach_link(n_ptr, l_ptr);
Ying Xue2f55c432015-01-09 15:27:00 +0800293 setup_timer(&l_ptr->timer, link_timeout, (unsigned long)l_ptr);
Jon Paul Maloy581465f2014-01-07 17:02:44 -0500294 link_state_event(l_ptr, STARTING_EVT);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100295
Per Lidenb97bf3f2006-01-02 19:04:38 +0100296 return l_ptr;
297}
298
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500299/**
Jon Paul Maloydff29b12015-04-02 09:33:01 -0400300 * tipc_link_delete - Delete a link
301 * @l: link to be deleted
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500302 */
Jon Paul Maloydff29b12015-04-02 09:33:01 -0400303void tipc_link_delete(struct tipc_link *l)
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500304{
Jon Paul Maloydff29b12015-04-02 09:33:01 -0400305 tipc_link_reset(l);
306 if (del_timer(&l->timer))
307 tipc_link_put(l);
308 l->flags |= LINK_STOPPED;
309 /* Delete link now, or when timer is finished: */
310 tipc_link_reset_fragments(l);
311 tipc_node_detach_link(l->owner, l);
312 tipc_link_put(l);
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500313}
314
Jon Paul Maloyb1c29f62015-05-14 10:46:11 -0400315void tipc_link_delete_list(struct net *net, unsigned int bearer_id)
Ying Xue8d8439b2014-02-13 17:29:07 -0500316{
Ying Xuef2f98002015-01-09 15:27:05 +0800317 struct tipc_net *tn = net_generic(net, tipc_net_id);
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500318 struct tipc_link *link;
319 struct tipc_node *node;
Ying Xue8d8439b2014-02-13 17:29:07 -0500320
Ying Xue6c7a7622014-03-27 12:54:37 +0800321 rcu_read_lock();
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500322 list_for_each_entry_rcu(node, &tn->node_list, list) {
323 tipc_node_lock(node);
324 link = node->links[bearer_id];
Jon Paul Maloydff29b12015-04-02 09:33:01 -0400325 if (link)
Jon Paul Maloy2d72d492015-02-03 08:59:17 -0500326 tipc_link_delete(link);
327 tipc_node_unlock(node);
Ying Xue8d8439b2014-02-13 17:29:07 -0500328 }
Ying Xue6c7a7622014-03-27 12:54:37 +0800329 rcu_read_unlock();
Ying Xue8d8439b2014-02-13 17:29:07 -0500330}
Per Lidenb97bf3f2006-01-02 19:04:38 +0100331
332/**
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400333 * link_schedule_user - schedule a message sender for wakeup after congestion
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400334 * @link: congested link
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400335 * @list: message that was attempted sent
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400336 * Create pseudo msg to send back to user when congestion abates
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400337 * Only consumes message if there is an error
Per Lidenb97bf3f2006-01-02 19:04:38 +0100338 */
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400339static int link_schedule_user(struct tipc_link *link, struct sk_buff_head *list)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100340{
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400341 struct tipc_msg *msg = buf_msg(skb_peek(list));
342 int imp = msg_importance(msg);
343 u32 oport = msg_origport(msg);
344 u32 addr = link_own_addr(link);
345 struct sk_buff *skb;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100346
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400347 /* This really cannot happen... */
348 if (unlikely(imp > TIPC_CRITICAL_IMPORTANCE)) {
349 pr_warn("%s<%s>, send queue full", link_rst_msg, link->name);
350 tipc_link_reset(link);
351 goto err;
352 }
353 /* Non-blocking sender: */
354 if (TIPC_SKB_CB(skb_peek(list))->wakeup_pending)
355 return -ELINKCONG;
356
357 /* Create and schedule wakeup pseudo message */
358 skb = tipc_msg_create(SOCK_WAKEUP, 0, INT_H_SIZE, 0,
359 addr, addr, oport, 0, 0);
360 if (!skb)
361 goto err;
362 TIPC_SKB_CB(skb)->chain_sz = skb_queue_len(list);
363 TIPC_SKB_CB(skb)->chain_imp = imp;
364 skb_queue_tail(&link->wakeupq, skb);
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400365 link->stats.link_congs++;
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400366 return -ELINKCONG;
367err:
368 __skb_queue_purge(list);
369 return -ENOBUFS;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100370}
371
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400372/**
373 * link_prepare_wakeup - prepare users for wakeup after congestion
374 * @link: congested link
375 * Move a number of waiting users, as permitted by available space in
376 * the send queue, from link wait queue to node wait queue for wakeup
377 */
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400378void link_prepare_wakeup(struct tipc_link *l)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100379{
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400380 int pnd[TIPC_SYSTEM_IMPORTANCE + 1] = {0,};
381 int imp, lim;
Ying Xue58d78b32014-11-26 11:41:51 +0800382 struct sk_buff *skb, *tmp;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100383
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400384 skb_queue_walk_safe(&l->wakeupq, skb, tmp) {
385 imp = TIPC_SKB_CB(skb)->chain_imp;
386 lim = l->window + l->backlog[imp].limit;
387 pnd[imp] += TIPC_SKB_CB(skb)->chain_sz;
388 if ((pnd[imp] + l->backlog[imp].len) >= lim)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100389 break;
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400390 skb_unlink(skb, &l->wakeupq);
391 skb_queue_tail(&l->inputq, skb);
392 l->owner->inputq = &l->inputq;
393 l->owner->action_flags |= TIPC_MSG_EVT;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100394 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100395}
396
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900397/**
Per Liden4323add2006-01-18 00:38:21 +0100398 * tipc_link_reset_fragments - purge link's inbound message fragments queue
Per Lidenb97bf3f2006-01-02 19:04:38 +0100399 * @l_ptr: pointer to link
400 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500401void tipc_link_reset_fragments(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100402{
Jon Paul Maloy37e22162014-05-14 05:39:12 -0400403 kfree_skb(l_ptr->reasm_buf);
404 l_ptr->reasm_buf = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100405}
406
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400407static void tipc_link_purge_backlog(struct tipc_link *l)
408{
409 __skb_queue_purge(&l->backlogq);
410 l->backlog[TIPC_LOW_IMPORTANCE].len = 0;
411 l->backlog[TIPC_MEDIUM_IMPORTANCE].len = 0;
412 l->backlog[TIPC_HIGH_IMPORTANCE].len = 0;
413 l->backlog[TIPC_CRITICAL_IMPORTANCE].len = 0;
414 l->backlog[TIPC_SYSTEM_IMPORTANCE].len = 0;
415}
416
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900417/**
Jon Paul Maloy581465f2014-01-07 17:02:44 -0500418 * tipc_link_purge_queues - purge all pkt queues associated with link
Per Lidenb97bf3f2006-01-02 19:04:38 +0100419 * @l_ptr: pointer to link
420 */
Jon Paul Maloy581465f2014-01-07 17:02:44 -0500421void tipc_link_purge_queues(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100422{
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400423 __skb_queue_purge(&l_ptr->deferdq);
424 __skb_queue_purge(&l_ptr->transmq);
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400425 tipc_link_purge_backlog(l_ptr);
Per Liden4323add2006-01-18 00:38:21 +0100426 tipc_link_reset_fragments(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100427}
428
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500429void tipc_link_reset(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100430{
Per Lidenb97bf3f2006-01-02 19:04:38 +0100431 u32 prev_state = l_ptr->state;
Allan Stephens5392d642006-06-25 23:52:50 -0700432 int was_active_link = tipc_link_is_active(l_ptr);
Jon Paul Maloy50100a52014-08-22 18:09:07 -0400433 struct tipc_node *owner = l_ptr->owner;
Jon Paul Maloydff29b12015-04-02 09:33:01 -0400434 struct tipc_link *pl = tipc_parallel_link(l_ptr);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900435
Allan Stephensa686e682008-06-04 17:29:39 -0700436 msg_set_session(l_ptr->pmsg, ((msg_session(l_ptr->pmsg) + 1) & 0xffff));
Per Lidenb97bf3f2006-01-02 19:04:38 +0100437
Allan Stephensa686e682008-06-04 17:29:39 -0700438 /* Link is down, accept any session */
439 l_ptr->peer_session = INVALID_SESSION;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100440
Jon Paul Maloyed193ec2015-04-02 09:33:02 -0400441 /* Prepare for renewed mtu size negotiation */
442 l_ptr->mtu = l_ptr->advertised_mtu;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900443
Per Lidenb97bf3f2006-01-02 19:04:38 +0100444 l_ptr->state = RESET_UNKNOWN;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100445
446 if ((prev_state == RESET_UNKNOWN) || (prev_state == RESET_RESET))
447 return;
448
Per Liden4323add2006-01-18 00:38:21 +0100449 tipc_node_link_down(l_ptr->owner, l_ptr);
Ying Xue7f9f95d2015-01-09 15:27:06 +0800450 tipc_bearer_remove_dest(owner->net, l_ptr->bearer_id, l_ptr->addr);
Paul Gortmaker7368ddf2010-10-12 14:25:58 +0000451
Jon Paul Maloydff29b12015-04-02 09:33:01 -0400452 if (was_active_link && tipc_node_is_up(l_ptr->owner) && (pl != l_ptr)) {
453 l_ptr->flags |= LINK_FAILINGOVER;
Jon Paul Maloya97b9d32015-05-14 10:46:15 -0400454 l_ptr->failover_checkpt = l_ptr->rcv_nxt;
Jon Paul Maloydff29b12015-04-02 09:33:01 -0400455 pl->failover_pkts = FIRST_FAILOVER;
Jon Paul Maloya97b9d32015-05-14 10:46:15 -0400456 pl->failover_checkpt = l_ptr->rcv_nxt;
Jon Paul Maloydff29b12015-04-02 09:33:01 -0400457 pl->failover_skb = l_ptr->reasm_buf;
458 } else {
459 kfree_skb(l_ptr->reasm_buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100460 }
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500461 /* Clean up all queues, except inputq: */
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400462 __skb_queue_purge(&l_ptr->transmq);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400463 __skb_queue_purge(&l_ptr->deferdq);
Jon Paul Maloye6441ba2015-03-09 16:16:22 -0400464 if (!owner->inputq)
465 owner->inputq = &l_ptr->inputq;
466 skb_queue_splice_init(&l_ptr->wakeupq, owner->inputq);
467 if (!skb_queue_empty(owner->inputq))
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500468 owner->action_flags |= TIPC_MSG_EVT;
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400469 tipc_link_purge_backlog(l_ptr);
Jon Paul Maloydff29b12015-04-02 09:33:01 -0400470 l_ptr->reasm_buf = NULL;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400471 l_ptr->rcv_unacked = 0;
Jon Paul Maloya97b9d32015-05-14 10:46:15 -0400472 l_ptr->snd_nxt = 1;
473 l_ptr->silent_intv_cnt = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100474 l_ptr->stale_count = 0;
475 link_reset_statistics(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100476}
477
Ying Xue7f9f95d2015-01-09 15:27:06 +0800478static void link_activate(struct tipc_link *link)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100479{
Ying Xue7f9f95d2015-01-09 15:27:06 +0800480 struct tipc_node *node = link->owner;
481
Jon Paul Maloya97b9d32015-05-14 10:46:15 -0400482 link->rcv_nxt = 1;
Ying Xue7f9f95d2015-01-09 15:27:06 +0800483 link->stats.recv_info = 1;
Jon Paul Maloycd4eee32015-05-14 10:46:16 -0400484 link->silent_intv_cnt = 0;
Ying Xue7f9f95d2015-01-09 15:27:06 +0800485 tipc_node_link_up(node, link);
486 tipc_bearer_add_dest(node->net, link->bearer_id, link->addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100487}
488
489/**
490 * link_state_event - link finite state machine
491 * @l_ptr: pointer to link
492 * @event: state machine event to process
493 */
Eric Dumazet95c96172012-04-15 05:58:06 +0000494static void link_state_event(struct tipc_link *l_ptr, unsigned int event)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100495{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500496 struct tipc_link *other;
Jon Paul Maloya97b9d32015-05-14 10:46:15 -0400497 unsigned long timer_intv = l_ptr->keepalive_intv;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100498
Jon Paul Maloy7d339392014-02-13 17:29:16 -0500499 if (l_ptr->flags & LINK_STOPPED)
500 return;
501
Ying Xue135daee2014-02-13 17:29:08 -0500502 if (!(l_ptr->flags & LINK_STARTED) && (event != STARTING_EVT))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100503 return; /* Not yet. */
504
Jon Paul Maloycd4eee32015-05-14 10:46:16 -0400505 if (l_ptr->flags & LINK_FAILINGOVER)
Ying Xue77a7e072013-12-10 20:45:44 -0800506 return;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100507
508 switch (l_ptr->state) {
509 case WORKING_WORKING:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100510 switch (event) {
511 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100512 case ACTIVATE_MSG:
Jon Paul Maloycd4eee32015-05-14 10:46:16 -0400513 l_ptr->silent_intv_cnt = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100514 break;
Jon Paul Maloycd4eee32015-05-14 10:46:16 -0400515 case SILENCE_EVT:
516 if (!l_ptr->silent_intv_cnt) {
517 if (tipc_bclink_acks_missing(l_ptr->owner))
Ying Xue247f0f32014-02-18 16:06:46 +0800518 tipc_link_proto_xmit(l_ptr, STATE_MSG,
Jon Paul Maloyed193ec2015-04-02 09:33:02 -0400519 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100520 break;
521 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100522 l_ptr->state = WORKING_UNKNOWN;
Jon Paul Maloyed193ec2015-04-02 09:33:02 -0400523 tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100524 break;
525 case RESET_MSG:
Erik Hugne3fa9cac2015-01-22 17:10:31 +0100526 pr_debug("%s<%s>, requested by peer\n",
527 link_rst_msg, l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100528 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100529 l_ptr->state = RESET_RESET;
Ying Xue247f0f32014-02-18 16:06:46 +0800530 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
Jon Paul Maloyed193ec2015-04-02 09:33:02 -0400531 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100532 break;
533 default:
Erik Hugne3fa9cac2015-01-22 17:10:31 +0100534 pr_debug("%s%u in WW state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100535 }
536 break;
537 case WORKING_UNKNOWN:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100538 switch (event) {
539 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100540 case ACTIVATE_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100541 l_ptr->state = WORKING_WORKING;
Jon Paul Maloya97b9d32015-05-14 10:46:15 -0400542 l_ptr->silent_intv_cnt = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100543 break;
544 case RESET_MSG:
Erik Hugne3fa9cac2015-01-22 17:10:31 +0100545 pr_debug("%s<%s>, requested by peer while probing\n",
546 link_rst_msg, l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100547 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100548 l_ptr->state = RESET_RESET;
Ying Xue247f0f32014-02-18 16:06:46 +0800549 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
Jon Paul Maloyed193ec2015-04-02 09:33:02 -0400550 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100551 break;
Jon Paul Maloycd4eee32015-05-14 10:46:16 -0400552 case SILENCE_EVT:
553 if (!l_ptr->silent_intv_cnt) {
Per Lidenb97bf3f2006-01-02 19:04:38 +0100554 l_ptr->state = WORKING_WORKING;
Jon Paul Maloycd4eee32015-05-14 10:46:16 -0400555 if (tipc_bclink_acks_missing(l_ptr->owner))
Ying Xue247f0f32014-02-18 16:06:46 +0800556 tipc_link_proto_xmit(l_ptr, STATE_MSG,
Jon Paul Maloyed193ec2015-04-02 09:33:02 -0400557 0, 0, 0, 0);
Jon Paul Maloya97b9d32015-05-14 10:46:15 -0400558 } else if (l_ptr->silent_intv_cnt <
559 l_ptr->abort_limit) {
Ying Xue247f0f32014-02-18 16:06:46 +0800560 tipc_link_proto_xmit(l_ptr, STATE_MSG,
Jon Paul Maloyed193ec2015-04-02 09:33:02 -0400561 1, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100562 } else { /* Link has failed */
Erik Hugne3fa9cac2015-01-22 17:10:31 +0100563 pr_debug("%s<%s>, peer not responding\n",
564 link_rst_msg, l_ptr->name);
Per Liden4323add2006-01-18 00:38:21 +0100565 tipc_link_reset(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100566 l_ptr->state = RESET_UNKNOWN;
Ying Xue247f0f32014-02-18 16:06:46 +0800567 tipc_link_proto_xmit(l_ptr, RESET_MSG,
Jon Paul Maloyed193ec2015-04-02 09:33:02 -0400568 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100569 }
570 break;
571 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400572 pr_err("%s%u in WU state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100573 }
574 break;
575 case RESET_UNKNOWN:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100576 switch (event) {
577 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100578 break;
579 case ACTIVATE_MSG:
580 other = l_ptr->owner->active_links[0];
Allan Stephens8d64a5b2010-12-31 18:59:27 +0000581 if (other && link_working_unknown(other))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100582 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100583 l_ptr->state = WORKING_WORKING;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100584 link_activate(l_ptr);
Jon Paul Maloyed193ec2015-04-02 09:33:02 -0400585 tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0);
Jon Maloyc64f7a62012-11-16 13:51:31 +0800586 if (l_ptr->owner->working_links == 1)
Ying Xue247f0f32014-02-18 16:06:46 +0800587 tipc_link_sync_xmit(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100588 break;
589 case RESET_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100590 l_ptr->state = RESET_RESET;
Ying Xue247f0f32014-02-18 16:06:46 +0800591 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
Jon Paul Maloyed193ec2015-04-02 09:33:02 -0400592 1, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100593 break;
594 case STARTING_EVT:
Ying Xue135daee2014-02-13 17:29:08 -0500595 l_ptr->flags |= LINK_STARTED;
Jon Paul Maloya97b9d32015-05-14 10:46:15 -0400596 link_set_timer(l_ptr, timer_intv);
Jon Paul Maloyaf9946f2015-02-03 08:59:20 -0500597 break;
Jon Paul Maloycd4eee32015-05-14 10:46:16 -0400598 case SILENCE_EVT:
Jon Paul Maloyed193ec2015-04-02 09:33:02 -0400599 tipc_link_proto_xmit(l_ptr, RESET_MSG, 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100600 break;
601 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400602 pr_err("%s%u in RU state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100603 }
604 break;
605 case RESET_RESET:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100606 switch (event) {
607 case TRAFFIC_MSG_EVT:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100608 case ACTIVATE_MSG:
609 other = l_ptr->owner->active_links[0];
Allan Stephens8d64a5b2010-12-31 18:59:27 +0000610 if (other && link_working_unknown(other))
Per Lidenb97bf3f2006-01-02 19:04:38 +0100611 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100612 l_ptr->state = WORKING_WORKING;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100613 link_activate(l_ptr);
Jon Paul Maloyed193ec2015-04-02 09:33:02 -0400614 tipc_link_proto_xmit(l_ptr, STATE_MSG, 1, 0, 0, 0);
Jon Maloyc64f7a62012-11-16 13:51:31 +0800615 if (l_ptr->owner->working_links == 1)
Ying Xue247f0f32014-02-18 16:06:46 +0800616 tipc_link_sync_xmit(l_ptr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100617 break;
618 case RESET_MSG:
Per Lidenb97bf3f2006-01-02 19:04:38 +0100619 break;
Jon Paul Maloycd4eee32015-05-14 10:46:16 -0400620 case SILENCE_EVT:
Ying Xue247f0f32014-02-18 16:06:46 +0800621 tipc_link_proto_xmit(l_ptr, ACTIVATE_MSG,
Jon Paul Maloyed193ec2015-04-02 09:33:02 -0400622 0, 0, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100623 break;
624 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400625 pr_err("%s%u in RR state\n", link_unk_evt, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100626 }
627 break;
628 default:
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400629 pr_err("Unknown link state %u/%u\n", l_ptr->state, event);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100630 }
631}
632
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500633/**
Jon Paul Maloy9fbfb8b2014-07-16 20:41:03 -0400634 * __tipc_link_xmit(): same as tipc_link_xmit, but destlink is known & locked
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500635 * @link: link to use
Ying Xuea6ca1092014-11-26 11:41:55 +0800636 * @list: chain of buffers containing message
637 *
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400638 * Consumes the buffer chain, except when returning -ELINKCONG,
639 * since the caller then may want to make more send attempts.
640 * Returns 0 if success, or errno: -ELINKCONG, -EMSGSIZE or -ENOBUFS
641 * Messages at TIPC_SYSTEM_IMPORTANCE are always accepted
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500642 */
Ying Xue7f9f95d2015-01-09 15:27:06 +0800643int __tipc_link_xmit(struct net *net, struct tipc_link *link,
644 struct sk_buff_head *list)
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500645{
Ying Xuea6ca1092014-11-26 11:41:55 +0800646 struct tipc_msg *msg = buf_msg(skb_peek(list));
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400647 unsigned int maxwin = link->window;
Jon Paul Maloye3eea1e2015-03-13 16:08:11 -0400648 unsigned int imp = msg_importance(msg);
Jon Paul Maloyed193ec2015-04-02 09:33:02 -0400649 uint mtu = link->mtu;
Jon Paul Maloya97b9d32015-05-14 10:46:15 -0400650 u16 ack = mod(link->rcv_nxt - 1);
651 u16 seqno = link->snd_nxt;
Jon Paul Maloye4bf4f72015-05-14 10:46:14 -0400652 u16 bc_last_in = link->owner->bclink.last_in;
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500653 struct tipc_media_addr *addr = &link->media_addr;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400654 struct sk_buff_head *transmq = &link->transmq;
655 struct sk_buff_head *backlogq = &link->backlogq;
Ying Xuea6ca1092014-11-26 11:41:55 +0800656 struct sk_buff *skb, *tmp;
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500657
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400658 /* Match backlog limit against msg importance: */
659 if (unlikely(link->backlog[imp].len >= link->backlog[imp].limit))
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400660 return link_schedule_user(link, list);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500661
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400662 if (unlikely(msg_size(msg) > mtu)) {
Ying Xuea6ca1092014-11-26 11:41:55 +0800663 __skb_queue_purge(list);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500664 return -EMSGSIZE;
665 }
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400666 /* Prepare each packet for sending, and add to relevant queue: */
Ying Xuea6ca1092014-11-26 11:41:55 +0800667 skb_queue_walk_safe(list, skb, tmp) {
668 __skb_unlink(skb, list);
Ying Xue58dc55f2014-11-26 11:41:52 +0800669 msg = buf_msg(skb);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400670 msg_set_seqno(msg, seqno);
671 msg_set_ack(msg, ack);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500672 msg_set_bcast_ack(msg, bc_last_in);
673
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400674 if (likely(skb_queue_len(transmq) < maxwin)) {
675 __skb_queue_tail(transmq, skb);
676 tipc_bearer_send(net, link->bearer_id, skb, addr);
677 link->rcv_unacked = 0;
678 seqno++;
679 continue;
680 }
681 if (tipc_msg_bundle(skb_peek_tail(backlogq), skb, mtu)) {
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500682 link->stats.sent_bundled++;
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500683 continue;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400684 }
685 if (tipc_msg_make_bundle(&skb, mtu, link->addr)) {
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500686 link->stats.sent_bundled++;
687 link->stats.sent_bundles++;
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400688 imp = msg_importance(buf_msg(skb));
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500689 }
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400690 __skb_queue_tail(backlogq, skb);
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400691 link->backlog[imp].len++;
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500692 seqno++;
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500693 }
Jon Paul Maloya97b9d32015-05-14 10:46:15 -0400694 link->snd_nxt = seqno;
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500695 return 0;
696}
697
Ying Xuea6ca1092014-11-26 11:41:55 +0800698static void skb2list(struct sk_buff *skb, struct sk_buff_head *list)
699{
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500700 skb_queue_head_init(list);
Ying Xuea6ca1092014-11-26 11:41:55 +0800701 __skb_queue_tail(list, skb);
702}
703
704static int __tipc_link_xmit_skb(struct tipc_link *link, struct sk_buff *skb)
705{
706 struct sk_buff_head head;
707
708 skb2list(skb, &head);
Ying Xue7f9f95d2015-01-09 15:27:06 +0800709 return __tipc_link_xmit(link->owner->net, link, &head);
Ying Xuea6ca1092014-11-26 11:41:55 +0800710}
711
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400712/* tipc_link_xmit_skb(): send single buffer to destination
713 * Buffers sent via this functon are generally TIPC_SYSTEM_IMPORTANCE
714 * messages, which will not be rejected
715 * The only exception is datagram messages rerouted after secondary
716 * lookup, which are rare and safe to dispose of anyway.
717 * TODO: Return real return value, and let callers use
718 * tipc_wait_for_sendpkt() where applicable
719 */
Ying Xuef2f98002015-01-09 15:27:05 +0800720int tipc_link_xmit_skb(struct net *net, struct sk_buff *skb, u32 dnode,
721 u32 selector)
Ying Xuea6ca1092014-11-26 11:41:55 +0800722{
723 struct sk_buff_head head;
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400724 int rc;
Ying Xuea6ca1092014-11-26 11:41:55 +0800725
726 skb2list(skb, &head);
Jon Paul Maloy3127a022015-03-25 12:07:25 -0400727 rc = tipc_link_xmit(net, &head, dnode, selector);
728 if (rc == -ELINKCONG)
729 kfree_skb(skb);
730 return 0;
Ying Xuea6ca1092014-11-26 11:41:55 +0800731}
732
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500733/**
Jon Paul Maloy9fbfb8b2014-07-16 20:41:03 -0400734 * tipc_link_xmit() is the general link level function for message sending
Ying Xuef2f98002015-01-09 15:27:05 +0800735 * @net: the applicable net namespace
Ying Xuea6ca1092014-11-26 11:41:55 +0800736 * @list: chain of buffers containing message
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500737 * @dsz: amount of user data to be sent
738 * @dnode: address of destination node
739 * @selector: a number used for deterministic link selection
740 * Consumes the buffer chain, except when returning -ELINKCONG
741 * Returns 0 if success, otherwise errno: -ELINKCONG,-EHOSTUNREACH,-EMSGSIZE
742 */
Ying Xuef2f98002015-01-09 15:27:05 +0800743int tipc_link_xmit(struct net *net, struct sk_buff_head *list, u32 dnode,
744 u32 selector)
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500745{
746 struct tipc_link *link = NULL;
747 struct tipc_node *node;
748 int rc = -EHOSTUNREACH;
749
Ying Xuef2f98002015-01-09 15:27:05 +0800750 node = tipc_node_find(net, dnode);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500751 if (node) {
752 tipc_node_lock(node);
753 link = node->active_links[selector & 1];
754 if (link)
Ying Xue7f9f95d2015-01-09 15:27:06 +0800755 rc = __tipc_link_xmit(net, link, list);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500756 tipc_node_unlock(node);
Ying Xue8a0f6eb2015-03-26 18:10:24 +0800757 tipc_node_put(node);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500758 }
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500759 if (link)
760 return rc;
761
Erik Hugne3bd88ee2015-03-19 09:02:18 +0100762 if (likely(in_own_node(net, dnode))) {
763 tipc_sk_rcv(net, list);
764 return 0;
765 }
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500766
Jon Paul Maloyc637c102015-02-05 08:36:41 -0500767 __skb_queue_purge(list);
Jon Paul Maloy4f1688b2014-06-25 20:41:32 -0500768 return rc;
769}
770
Jon Maloyc64f7a62012-11-16 13:51:31 +0800771/*
Ying Xue247f0f32014-02-18 16:06:46 +0800772 * tipc_link_sync_xmit - synchronize broadcast link endpoints.
Jon Maloyc64f7a62012-11-16 13:51:31 +0800773 *
774 * Give a newly added peer node the sequence number where it should
775 * start receiving and acking broadcast packets.
776 *
777 * Called with node locked
778 */
Jon Paul Maloy25b660c2014-07-16 20:40:59 -0400779static void tipc_link_sync_xmit(struct tipc_link *link)
Jon Maloyc64f7a62012-11-16 13:51:31 +0800780{
Ying Xuea6ca1092014-11-26 11:41:55 +0800781 struct sk_buff *skb;
Jon Maloyc64f7a62012-11-16 13:51:31 +0800782 struct tipc_msg *msg;
783
Ying Xuea6ca1092014-11-26 11:41:55 +0800784 skb = tipc_buf_acquire(INT_H_SIZE);
785 if (!skb)
Jon Maloyc64f7a62012-11-16 13:51:31 +0800786 return;
787
Ying Xuea6ca1092014-11-26 11:41:55 +0800788 msg = buf_msg(skb);
Jon Paul Maloyc5898632015-02-05 08:36:36 -0500789 tipc_msg_init(link_own_addr(link), msg, BCAST_PROTOCOL, STATE_MSG,
Ying Xue34747532015-01-09 15:27:10 +0800790 INT_H_SIZE, link->addr);
Jon Paul Maloy25b660c2014-07-16 20:40:59 -0400791 msg_set_last_bcast(msg, link->owner->bclink.acked);
Ying Xuea6ca1092014-11-26 11:41:55 +0800792 __tipc_link_xmit_skb(link, skb);
Jon Maloyc64f7a62012-11-16 13:51:31 +0800793}
794
795/*
Ying Xue247f0f32014-02-18 16:06:46 +0800796 * tipc_link_sync_rcv - synchronize broadcast link endpoints.
Jon Maloyc64f7a62012-11-16 13:51:31 +0800797 * Receive the sequence number where we should start receiving and
798 * acking broadcast packets from a newly added peer node, and open
799 * up for reception of such packets.
800 *
801 * Called with node locked
802 */
Ying Xue247f0f32014-02-18 16:06:46 +0800803static void tipc_link_sync_rcv(struct tipc_node *n, struct sk_buff *buf)
Jon Maloyc64f7a62012-11-16 13:51:31 +0800804{
805 struct tipc_msg *msg = buf_msg(buf);
806
807 n->bclink.last_sent = n->bclink.last_in = msg_last_bcast(msg);
808 n->bclink.recv_permitted = true;
809 kfree_skb(buf);
810}
811
812/*
Ying Xue47b4c9a2014-11-26 11:41:48 +0800813 * tipc_link_push_packets - push unsent packets to bearer
814 *
815 * Push out the unsent messages of a link where congestion
816 * has abated. Node is locked.
817 *
818 * Called with node locked
Per Lidenb97bf3f2006-01-02 19:04:38 +0100819 */
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400820void tipc_link_push_packets(struct tipc_link *link)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100821{
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400822 struct sk_buff *skb;
Ying Xue47b4c9a2014-11-26 11:41:48 +0800823 struct tipc_msg *msg;
Jon Paul Maloya97b9d32015-05-14 10:46:15 -0400824 u16 ack = mod(link->rcv_nxt - 1);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100825
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400826 while (skb_queue_len(&link->transmq) < link->window) {
827 skb = __skb_dequeue(&link->backlogq);
828 if (!skb)
Ying Xue47b4c9a2014-11-26 11:41:48 +0800829 break;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400830 msg = buf_msg(skb);
Jon Paul Maloy1f66d162015-03-25 12:07:24 -0400831 link->backlog[msg_importance(msg)].len--;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400832 msg_set_ack(msg, ack);
833 msg_set_bcast_ack(msg, link->owner->bclink.last_in);
834 link->rcv_unacked = 0;
835 __skb_queue_tail(&link->transmq, skb);
836 tipc_bearer_send(link->owner->net, link->bearer_id,
837 skb, &link->media_addr);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100838 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100839}
840
Ying Xue3f5a12b2014-05-05 08:56:17 +0800841void tipc_link_reset_all(struct tipc_node *node)
Allan Stephensd356eeb2006-06-25 23:40:01 -0700842{
Allan Stephensd356eeb2006-06-25 23:40:01 -0700843 char addr_string[16];
844 u32 i;
845
Ying Xue3f5a12b2014-05-05 08:56:17 +0800846 tipc_node_lock(node);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700847
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400848 pr_warn("Resetting all links to %s\n",
Ying Xue3f5a12b2014-05-05 08:56:17 +0800849 tipc_addr_string_fill(addr_string, node->addr));
Allan Stephensd356eeb2006-06-25 23:40:01 -0700850
851 for (i = 0; i < MAX_BEARERS; i++) {
Ying Xue3f5a12b2014-05-05 08:56:17 +0800852 if (node->links[i]) {
853 link_print(node->links[i], "Resetting link\n");
854 tipc_link_reset(node->links[i]);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700855 }
856 }
857
Ying Xue3f5a12b2014-05-05 08:56:17 +0800858 tipc_node_unlock(node);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700859}
860
Paul Gortmakera18c4bc2011-12-29 20:58:42 -0500861static void link_retransmit_failure(struct tipc_link *l_ptr,
Paul Gortmakerae8509c2013-06-17 10:54:47 -0400862 struct sk_buff *buf)
Allan Stephensd356eeb2006-06-25 23:40:01 -0700863{
864 struct tipc_msg *msg = buf_msg(buf);
Ying Xue1da46562015-01-09 15:27:07 +0800865 struct net *net = l_ptr->owner->net;
Allan Stephensd356eeb2006-06-25 23:40:01 -0700866
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400867 pr_warn("Retransmission failure on link <%s>\n", l_ptr->name);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700868
869 if (l_ptr->addr) {
Allan Stephensd356eeb2006-06-25 23:40:01 -0700870 /* Handle failure on standard link */
Allan Stephens8d64a5b2010-12-31 18:59:27 +0000871 link_print(l_ptr, "Resetting link\n");
Allan Stephensd356eeb2006-06-25 23:40:01 -0700872 tipc_link_reset(l_ptr);
873
874 } else {
Allan Stephensd356eeb2006-06-25 23:40:01 -0700875 /* Handle failure on broadcast link */
David S. Miller6c000552008-09-02 23:38:32 -0700876 struct tipc_node *n_ptr;
Allan Stephensd356eeb2006-06-25 23:40:01 -0700877 char addr_string[16];
878
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400879 pr_info("Msg seq number: %u, ", msg_seqno(msg));
880 pr_cont("Outstanding acks: %lu\n",
881 (unsigned long) TIPC_SKB_CB(buf)->handle);
Jeff Garzik617dbea2006-10-03 16:25:34 -0700882
Ying Xue1da46562015-01-09 15:27:07 +0800883 n_ptr = tipc_bclink_retransmit_to(net);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700884
Allan Stephensc68ca7b2010-05-11 14:30:12 +0000885 tipc_addr_string_fill(addr_string, n_ptr->addr);
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400886 pr_info("Broadcast link info for %s\n", addr_string);
Ying Xue389dd9b2012-11-16 13:51:30 +0800887 pr_info("Reception permitted: %d, Acked: %u\n",
888 n_ptr->bclink.recv_permitted,
Erik Hugne2cf8aa12012-06-29 00:16:37 -0400889 n_ptr->bclink.acked);
890 pr_info("Last in: %u, Oos state: %u, Last sent: %u\n",
891 n_ptr->bclink.last_in,
892 n_ptr->bclink.oos_state,
893 n_ptr->bclink.last_sent);
Allan Stephensd356eeb2006-06-25 23:40:01 -0700894
Ying Xueb952b2b2015-03-26 18:10:23 +0800895 n_ptr->action_flags |= TIPC_BCAST_RESET;
Allan Stephensd356eeb2006-06-25 23:40:01 -0700896 l_ptr->stale_count = 0;
897 }
898}
899
Ying Xue58dc55f2014-11-26 11:41:52 +0800900void tipc_link_retransmit(struct tipc_link *l_ptr, struct sk_buff *skb,
Per Liden4323add2006-01-18 00:38:21 +0100901 u32 retransmits)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100902{
903 struct tipc_msg *msg;
904
Ying Xue58dc55f2014-11-26 11:41:52 +0800905 if (!skb)
Allan Stephensd356eeb2006-06-25 23:40:01 -0700906 return;
907
Ying Xue58dc55f2014-11-26 11:41:52 +0800908 msg = buf_msg(skb);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900909
Erik Hugne512137e2013-12-06 10:08:00 -0500910 /* Detect repeated retransmit failures */
Jon Paul Maloya97b9d32015-05-14 10:46:15 -0400911 if (l_ptr->last_retransm == msg_seqno(msg)) {
Erik Hugne512137e2013-12-06 10:08:00 -0500912 if (++l_ptr->stale_count > 100) {
Ying Xue58dc55f2014-11-26 11:41:52 +0800913 link_retransmit_failure(l_ptr, skb);
Erik Hugne512137e2013-12-06 10:08:00 -0500914 return;
Allan Stephensd356eeb2006-06-25 23:40:01 -0700915 }
916 } else {
Jon Paul Maloya97b9d32015-05-14 10:46:15 -0400917 l_ptr->last_retransm = msg_seqno(msg);
Erik Hugne512137e2013-12-06 10:08:00 -0500918 l_ptr->stale_count = 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100919 }
Allan Stephensd356eeb2006-06-25 23:40:01 -0700920
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400921 skb_queue_walk_from(&l_ptr->transmq, skb) {
922 if (!retransmits)
Ying Xue58dc55f2014-11-26 11:41:52 +0800923 break;
924 msg = buf_msg(skb);
Jon Paul Maloya97b9d32015-05-14 10:46:15 -0400925 msg_set_ack(msg, mod(l_ptr->rcv_nxt - 1));
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +0900926 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Ying Xue7f9f95d2015-01-09 15:27:06 +0800927 tipc_bearer_send(l_ptr->owner->net, l_ptr->bearer_id, skb,
928 &l_ptr->media_addr);
Ying Xue3c294cb2012-11-15 11:34:45 +0800929 retransmits--;
930 l_ptr->stats.retransmitted++;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100931 }
Per Lidenb97bf3f2006-01-02 19:04:38 +0100932}
933
Jon Paul Maloy8b4ed862015-03-25 12:07:26 -0400934/* link_synch(): check if all packets arrived before the synch
935 * point have been consumed
936 * Returns true if the parallel links are synched, otherwise false
937 */
938static bool link_synch(struct tipc_link *l)
939{
940 unsigned int post_synch;
941 struct tipc_link *pl;
942
943 pl = tipc_parallel_link(l);
944 if (pl == l)
945 goto synched;
946
947 /* Was last pre-synch packet added to input queue ? */
Jon Paul Maloya97b9d32015-05-14 10:46:15 -0400948 if (less_eq(pl->rcv_nxt, l->synch_point))
Jon Paul Maloy8b4ed862015-03-25 12:07:26 -0400949 return false;
950
951 /* Is it still in the input queue ? */
Jon Paul Maloya97b9d32015-05-14 10:46:15 -0400952 post_synch = mod(pl->rcv_nxt - l->synch_point) - 1;
Jon Paul Maloy8b4ed862015-03-25 12:07:26 -0400953 if (skb_queue_len(&pl->inputq) > post_synch)
954 return false;
955synched:
956 l->flags &= ~LINK_SYNCHING;
957 return true;
958}
959
Ying Xuef03273f2014-11-26 11:41:54 +0800960static void link_retrieve_defq(struct tipc_link *link,
961 struct sk_buff_head *list)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100962{
Jon Paul Maloye4bf4f72015-05-14 10:46:14 -0400963 u16 seq_no;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100964
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400965 if (skb_queue_empty(&link->deferdq))
Ying Xuef03273f2014-11-26 11:41:54 +0800966 return;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100967
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400968 seq_no = buf_seqno(skb_peek(&link->deferdq));
Jon Paul Maloya97b9d32015-05-14 10:46:15 -0400969 if (seq_no == link->rcv_nxt)
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -0400970 skb_queue_splice_tail_init(&link->deferdq, list);
Per Lidenb97bf3f2006-01-02 19:04:38 +0100971}
972
Allan Stephens85035562008-04-15 19:04:54 -0700973/**
Jon Paul Maloy170b3922014-01-07 17:02:41 -0500974 * tipc_rcv - process TIPC packets/messages arriving from off-node
Ying Xuef2f98002015-01-09 15:27:05 +0800975 * @net: the applicable net namespace
Ying Xuef03273f2014-11-26 11:41:54 +0800976 * @skb: TIPC packet
Ying Xue7a2f7d12014-04-21 10:55:46 +0800977 * @b_ptr: pointer to bearer message arrived on
Allan Stephensb02b69c2010-08-17 11:00:07 +0000978 *
979 * Invoked with no locks held. Bearer pointer must point to a valid bearer
980 * structure (i.e. cannot be NULL), but bearer can be inactive.
981 */
Ying Xuec93d3ba2015-01-09 15:27:04 +0800982void tipc_rcv(struct net *net, struct sk_buff *skb, struct tipc_bearer *b_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +0100983{
Ying Xue34747532015-01-09 15:27:10 +0800984 struct tipc_net *tn = net_generic(net, tipc_net_id);
Ying Xuef03273f2014-11-26 11:41:54 +0800985 struct sk_buff_head head;
986 struct tipc_node *n_ptr;
987 struct tipc_link *l_ptr;
988 struct sk_buff *skb1, *tmp;
989 struct tipc_msg *msg;
Jon Paul Maloye4bf4f72015-05-14 10:46:14 -0400990 u16 seq_no;
991 u16 ackd;
Ying Xuef03273f2014-11-26 11:41:54 +0800992 u32 released;
Per Lidenb97bf3f2006-01-02 19:04:38 +0100993
Ying Xuea6ca1092014-11-26 11:41:55 +0800994 skb2list(skb, &head);
Allan Stephens85035562008-04-15 19:04:54 -0700995
Ying Xuef03273f2014-11-26 11:41:54 +0800996 while ((skb = __skb_dequeue(&head))) {
Allan Stephens85035562008-04-15 19:04:54 -0700997 /* Ensure message is well-formed */
Jon Paul Maloycf2157f2015-03-13 16:08:06 -0400998 if (unlikely(!tipc_msg_validate(skb)))
Ying Xue3af390e2013-10-30 11:26:57 +0800999 goto discard;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001000
Allan Stephens85035562008-04-15 19:04:54 -07001001 /* Handle arrival of a non-unicast link message */
Ying Xuef03273f2014-11-26 11:41:54 +08001002 msg = buf_msg(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001003 if (unlikely(msg_non_seq(msg))) {
Allan Stephens1265a022008-06-04 17:32:35 -07001004 if (msg_user(msg) == LINK_CONFIG)
Ying Xuec93d3ba2015-01-09 15:27:04 +08001005 tipc_disc_rcv(net, skb, b_ptr);
Allan Stephens1265a022008-06-04 17:32:35 -07001006 else
Ying Xuec93d3ba2015-01-09 15:27:04 +08001007 tipc_bclink_rcv(net, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001008 continue;
1009 }
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001010
Allan Stephensed33a9c2011-04-05 15:15:04 -04001011 /* Discard unicast link messages destined for another node */
Allan Stephens26008242006-06-25 23:39:31 -07001012 if (unlikely(!msg_short(msg) &&
Ying Xue34747532015-01-09 15:27:10 +08001013 (msg_destnode(msg) != tn->own_addr)))
Ying Xue3af390e2013-10-30 11:26:57 +08001014 goto discard;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001015
Allan Stephens5a68d5e2010-08-17 11:00:16 +00001016 /* Locate neighboring node that sent message */
Ying Xuef2f98002015-01-09 15:27:05 +08001017 n_ptr = tipc_node_find(net, msg_prevnode(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001018 if (unlikely(!n_ptr))
Ying Xue3af390e2013-10-30 11:26:57 +08001019 goto discard;
Allan Stephens85035562008-04-15 19:04:54 -07001020
Ying Xue8a0f6eb2015-03-26 18:10:24 +08001021 tipc_node_lock(n_ptr);
Allan Stephens5a68d5e2010-08-17 11:00:16 +00001022 /* Locate unicast link endpoint that should handle message */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001023 l_ptr = n_ptr->links[b_ptr->identity];
Ying Xue3af390e2013-10-30 11:26:57 +08001024 if (unlikely(!l_ptr))
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001025 goto unlock;
Allan Stephens85035562008-04-15 19:04:54 -07001026
Allan Stephensb4b56102011-05-27 11:00:51 -04001027 /* Verify that communication with node is currently allowed */
Ying Xueaecb9bb2014-05-08 08:54:39 +08001028 if ((n_ptr->action_flags & TIPC_WAIT_PEER_LINKS_DOWN) &&
Ying Xue10f465c2014-05-05 08:56:11 +08001029 msg_user(msg) == LINK_PROTOCOL &&
1030 (msg_type(msg) == RESET_MSG ||
1031 msg_type(msg) == ACTIVATE_MSG) &&
1032 !msg_redundant_link(msg))
Ying Xueaecb9bb2014-05-08 08:54:39 +08001033 n_ptr->action_flags &= ~TIPC_WAIT_PEER_LINKS_DOWN;
Allan Stephensb4b56102011-05-27 11:00:51 -04001034
Ying Xue10f465c2014-05-05 08:56:11 +08001035 if (tipc_node_blocked(n_ptr))
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001036 goto unlock;
Allan Stephensb4b56102011-05-27 11:00:51 -04001037
Allan Stephens85035562008-04-15 19:04:54 -07001038 /* Validate message sequence number info */
Allan Stephens85035562008-04-15 19:04:54 -07001039 seq_no = msg_seqno(msg);
1040 ackd = msg_ack(msg);
1041
1042 /* Release acked messages */
Jon Paul Maloy2cdf3912015-03-13 16:08:09 -04001043 if (unlikely(n_ptr->bclink.acked != msg_bcast_ack(msg)))
Allan Stephens365595912011-10-24 15:26:24 -04001044 tipc_bclink_acknowledge(n_ptr, msg_bcast_ack(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001045
Ying Xue58dc55f2014-11-26 11:41:52 +08001046 released = 0;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001047 skb_queue_walk_safe(&l_ptr->transmq, skb1, tmp) {
1048 if (more(buf_seqno(skb1), ackd))
Ying Xue58dc55f2014-11-26 11:41:52 +08001049 break;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001050 __skb_unlink(skb1, &l_ptr->transmq);
Ying Xue58dc55f2014-11-26 11:41:52 +08001051 kfree_skb(skb1);
1052 released = 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001053 }
Allan Stephens85035562008-04-15 19:04:54 -07001054
1055 /* Try sending any messages link endpoint has pending */
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001056 if (unlikely(skb_queue_len(&l_ptr->backlogq)))
Ying Xue47b4c9a2014-11-26 11:41:48 +08001057 tipc_link_push_packets(l_ptr);
Jon Paul Maloya5377832014-02-13 17:29:15 -05001058
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001059 if (released && !skb_queue_empty(&l_ptr->wakeupq))
Jon Paul Maloy50100a52014-08-22 18:09:07 -04001060 link_prepare_wakeup(l_ptr);
Jon Paul Maloya5377832014-02-13 17:29:15 -05001061
Jon Paul Maloya5377832014-02-13 17:29:15 -05001062 /* Process the incoming packet */
Ying Xue3af390e2013-10-30 11:26:57 +08001063 if (unlikely(!link_working_working(l_ptr))) {
1064 if (msg_user(msg) == LINK_PROTOCOL) {
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001065 tipc_link_proto_rcv(l_ptr, skb);
Ying Xuef03273f2014-11-26 11:41:54 +08001066 link_retrieve_defq(l_ptr, &head);
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001067 skb = NULL;
1068 goto unlock;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001069 }
Ying Xue3af390e2013-10-30 11:26:57 +08001070
1071 /* Traffic message. Conditionally activate link */
1072 link_state_event(l_ptr, TRAFFIC_MSG_EVT);
1073
1074 if (link_working_working(l_ptr)) {
1075 /* Re-insert buffer in front of queue */
Ying Xuef03273f2014-11-26 11:41:54 +08001076 __skb_queue_head(&head, skb);
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001077 skb = NULL;
1078 goto unlock;
Ying Xue3af390e2013-10-30 11:26:57 +08001079 }
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001080 goto unlock;
Ying Xue3af390e2013-10-30 11:26:57 +08001081 }
1082
1083 /* Link is now in state WORKING_WORKING */
Jon Paul Maloya97b9d32015-05-14 10:46:15 -04001084 if (unlikely(seq_no != l_ptr->rcv_nxt)) {
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001085 link_handle_out_of_seq_msg(l_ptr, skb);
Ying Xuef03273f2014-11-26 11:41:54 +08001086 link_retrieve_defq(l_ptr, &head);
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001087 skb = NULL;
1088 goto unlock;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001089 }
Jon Paul Maloycd4eee32015-05-14 10:46:16 -04001090 l_ptr->silent_intv_cnt = 0;
1091
Jon Paul Maloy8b4ed862015-03-25 12:07:26 -04001092 /* Synchronize with parallel link if applicable */
1093 if (unlikely((l_ptr->flags & LINK_SYNCHING) && !msg_dup(msg))) {
Jon Paul Maloy0d699f282015-04-28 16:59:04 -04001094 if (!link_synch(l_ptr))
1095 goto unlock;
Jon Paul Maloy8b4ed862015-03-25 12:07:26 -04001096 }
Jon Paul Maloya97b9d32015-05-14 10:46:15 -04001097 l_ptr->rcv_nxt++;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001098 if (unlikely(!skb_queue_empty(&l_ptr->deferdq)))
Ying Xuef03273f2014-11-26 11:41:54 +08001099 link_retrieve_defq(l_ptr, &head);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001100 if (unlikely(++l_ptr->rcv_unacked >= TIPC_MIN_LINK_WIN)) {
Erik Hugne3f53bd82014-07-01 10:22:41 +02001101 l_ptr->stats.sent_acks++;
Jon Paul Maloyed193ec2015-04-02 09:33:02 -04001102 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0, 0, 0);
Erik Hugne3f53bd82014-07-01 10:22:41 +02001103 }
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001104 tipc_link_input(l_ptr, skb);
1105 skb = NULL;
1106unlock:
Ying Xue3af390e2013-10-30 11:26:57 +08001107 tipc_node_unlock(n_ptr);
Ying Xue8a0f6eb2015-03-26 18:10:24 +08001108 tipc_node_put(n_ptr);
Ying Xue3af390e2013-10-30 11:26:57 +08001109discard:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001110 if (unlikely(skb))
1111 kfree_skb(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001112 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001113}
1114
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001115/* tipc_data_input - deliver data and name distr msgs to upper layer
Erik Hugne7ae934b2014-07-01 10:22:40 +02001116 *
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001117 * Consumes buffer if message is of right type
Erik Hugne7ae934b2014-07-01 10:22:40 +02001118 * Node lock must be held
1119 */
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001120static bool tipc_data_input(struct tipc_link *link, struct sk_buff *skb)
Erik Hugne7ae934b2014-07-01 10:22:40 +02001121{
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001122 struct tipc_node *node = link->owner;
1123 struct tipc_msg *msg = buf_msg(skb);
1124 u32 dport = msg_destport(msg);
Erik Hugne7ae934b2014-07-01 10:22:40 +02001125
1126 switch (msg_user(msg)) {
1127 case TIPC_LOW_IMPORTANCE:
1128 case TIPC_MEDIUM_IMPORTANCE:
1129 case TIPC_HIGH_IMPORTANCE:
1130 case TIPC_CRITICAL_IMPORTANCE:
1131 case CONN_MANAGER:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001132 if (tipc_skb_queue_tail(&link->inputq, skb, dport)) {
1133 node->inputq = &link->inputq;
1134 node->action_flags |= TIPC_MSG_EVT;
1135 }
1136 return true;
Erik Hugne7ae934b2014-07-01 10:22:40 +02001137 case NAME_DISTRIBUTOR:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001138 node->bclink.recv_permitted = true;
1139 node->namedq = &link->namedq;
1140 skb_queue_tail(&link->namedq, skb);
1141 if (skb_queue_len(&link->namedq) == 1)
1142 node->action_flags |= TIPC_NAMED_MSG_EVT;
1143 return true;
Erik Hugne7ae934b2014-07-01 10:22:40 +02001144 case MSG_BUNDLER:
Jon Paul Maloydff29b12015-04-02 09:33:01 -04001145 case TUNNEL_PROTOCOL:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001146 case MSG_FRAGMENTER:
1147 case BCAST_PROTOCOL:
1148 return false;
1149 default:
1150 pr_warn("Dropping received illegal msg type\n");
1151 kfree_skb(skb);
1152 return false;
1153 };
1154}
1155
1156/* tipc_link_input - process packet that has passed link protocol check
1157 *
1158 * Consumes buffer
1159 * Node lock must be held
1160 */
1161static void tipc_link_input(struct tipc_link *link, struct sk_buff *skb)
1162{
1163 struct tipc_node *node = link->owner;
1164 struct tipc_msg *msg = buf_msg(skb);
1165 struct sk_buff *iskb;
1166 int pos = 0;
1167
1168 if (likely(tipc_data_input(link, skb)))
1169 return;
1170
1171 switch (msg_user(msg)) {
Jon Paul Maloydff29b12015-04-02 09:33:01 -04001172 case TUNNEL_PROTOCOL:
Jon Paul Maloy8b4ed862015-03-25 12:07:26 -04001173 if (msg_dup(msg)) {
1174 link->flags |= LINK_SYNCHING;
1175 link->synch_point = msg_seqno(msg_get_wrapped(msg));
Jon Paul Maloy2da71422015-04-02 09:33:00 -04001176 kfree_skb(skb);
1177 break;
Jon Paul Maloy8b4ed862015-03-25 12:07:26 -04001178 }
Jon Paul Maloydff29b12015-04-02 09:33:01 -04001179 if (!tipc_link_failover_rcv(link, &skb))
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001180 break;
1181 if (msg_user(buf_msg(skb)) != MSG_BUNDLER) {
1182 tipc_data_input(link, skb);
1183 break;
1184 }
1185 case MSG_BUNDLER:
1186 link->stats.recv_bundles++;
1187 link->stats.recv_bundled += msg_msgcnt(msg);
1188
1189 while (tipc_msg_extract(skb, &iskb, &pos))
1190 tipc_data_input(link, iskb);
1191 break;
1192 case MSG_FRAGMENTER:
1193 link->stats.recv_fragments++;
1194 if (tipc_buf_append(&link->reasm_buf, &skb)) {
1195 link->stats.recv_fragmented++;
1196 tipc_data_input(link, skb);
1197 } else if (!link->reasm_buf) {
1198 tipc_link_reset(link);
1199 }
1200 break;
1201 case BCAST_PROTOCOL:
1202 tipc_link_sync_rcv(node, skb);
Erik Hugne7ae934b2014-07-01 10:22:40 +02001203 break;
1204 default:
Jon Paul Maloyc637c102015-02-05 08:36:41 -05001205 break;
1206 };
Erik Hugne7ae934b2014-07-01 10:22:40 +02001207}
1208
1209/**
Allan Stephens8809b252011-10-25 10:44:35 -04001210 * tipc_link_defer_pkt - Add out-of-sequence message to deferred reception queue
1211 *
1212 * Returns increase in queue length (i.e. 0 or 1)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001213 */
Ying Xuebc6fecd2014-11-26 11:41:53 +08001214u32 tipc_link_defer_pkt(struct sk_buff_head *list, struct sk_buff *skb)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001215{
Ying Xuebc6fecd2014-11-26 11:41:53 +08001216 struct sk_buff *skb1;
Jon Paul Maloye4bf4f72015-05-14 10:46:14 -04001217 u16 seq_no = buf_seqno(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001218
1219 /* Empty queue ? */
Ying Xuebc6fecd2014-11-26 11:41:53 +08001220 if (skb_queue_empty(list)) {
1221 __skb_queue_tail(list, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001222 return 1;
1223 }
1224
1225 /* Last ? */
Ying Xuebc6fecd2014-11-26 11:41:53 +08001226 if (less(buf_seqno(skb_peek_tail(list)), seq_no)) {
1227 __skb_queue_tail(list, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001228 return 1;
1229 }
1230
Allan Stephens8809b252011-10-25 10:44:35 -04001231 /* Locate insertion point in queue, then insert; discard if duplicate */
Ying Xuebc6fecd2014-11-26 11:41:53 +08001232 skb_queue_walk(list, skb1) {
Jon Paul Maloye4bf4f72015-05-14 10:46:14 -04001233 u16 curr_seqno = buf_seqno(skb1);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001234
Allan Stephens8809b252011-10-25 10:44:35 -04001235 if (seq_no == curr_seqno) {
Ying Xuebc6fecd2014-11-26 11:41:53 +08001236 kfree_skb(skb);
Allan Stephens8809b252011-10-25 10:44:35 -04001237 return 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001238 }
Allan Stephens8809b252011-10-25 10:44:35 -04001239
1240 if (less(seq_no, curr_seqno))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001241 break;
Allan Stephens8809b252011-10-25 10:44:35 -04001242 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001243
Ying Xuebc6fecd2014-11-26 11:41:53 +08001244 __skb_queue_before(list, skb1, skb);
Allan Stephens8809b252011-10-25 10:44:35 -04001245 return 1;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001246}
1247
Allan Stephens8809b252011-10-25 10:44:35 -04001248/*
Per Lidenb97bf3f2006-01-02 19:04:38 +01001249 * link_handle_out_of_seq_msg - handle arrival of out-of-sequence packet
1250 */
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001251static void link_handle_out_of_seq_msg(struct tipc_link *l_ptr,
Per Lidenb97bf3f2006-01-02 19:04:38 +01001252 struct sk_buff *buf)
1253{
Allan Stephensf9057302011-10-24 16:03:12 -04001254 u32 seq_no = buf_seqno(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001255
1256 if (likely(msg_user(buf_msg(buf)) == LINK_PROTOCOL)) {
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001257 tipc_link_proto_rcv(l_ptr, buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001258 return;
1259 }
1260
Jon Paul Maloycd4eee32015-05-14 10:46:16 -04001261 /* Record OOS packet arrival */
1262 l_ptr->silent_intv_cnt = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001263
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001264 /*
Per Lidenb97bf3f2006-01-02 19:04:38 +01001265 * Discard packet if a duplicate; otherwise add it to deferred queue
1266 * and notify peer of gap as per protocol specification
1267 */
Jon Paul Maloya97b9d32015-05-14 10:46:15 -04001268 if (less(seq_no, l_ptr->rcv_nxt)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001269 l_ptr->stats.duplicates++;
Allan Stephens5f6d9122011-11-04 13:24:29 -04001270 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001271 return;
1272 }
1273
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001274 if (tipc_link_defer_pkt(&l_ptr->deferdq, buf)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001275 l_ptr->stats.deferred_recv++;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001276 if ((skb_queue_len(&l_ptr->deferdq) % TIPC_MIN_LINK_WIN) == 1)
Jon Paul Maloyed193ec2015-04-02 09:33:02 -04001277 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0, 0, 0, 0);
Ying Xuebc6fecd2014-11-26 11:41:53 +08001278 } else {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001279 l_ptr->stats.duplicates++;
Ying Xuebc6fecd2014-11-26 11:41:53 +08001280 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001281}
1282
1283/*
1284 * Send protocol message to the other endpoint.
1285 */
Ying Xue247f0f32014-02-18 16:06:46 +08001286void tipc_link_proto_xmit(struct tipc_link *l_ptr, u32 msg_typ, int probe_msg,
Jon Paul Maloyed193ec2015-04-02 09:33:02 -04001287 u32 gap, u32 tolerance, u32 priority)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001288{
Sam Ravnborg1fc54d82006-03-20 22:36:47 -08001289 struct sk_buff *buf = NULL;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001290 struct tipc_msg *msg = l_ptr->pmsg;
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001291 u32 msg_size = sizeof(l_ptr->proto_msg);
Allan Stephens75f0aa42011-02-28 15:30:20 -05001292 int r_flag;
Jon Paul Maloye4bf4f72015-05-14 10:46:14 -04001293 u16 last_rcv;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001294
Jon Paul Maloydff29b12015-04-02 09:33:01 -04001295 /* Don't send protocol message during link failover */
1296 if (l_ptr->flags & LINK_FAILINGOVER)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001297 return;
Allan Stephensb4b56102011-05-27 11:00:51 -04001298
1299 /* Abort non-RESET send if communication with node is prohibited */
Ying Xue10f465c2014-05-05 08:56:11 +08001300 if ((tipc_node_blocked(l_ptr->owner)) && (msg_typ != RESET_MSG))
Allan Stephensb4b56102011-05-27 11:00:51 -04001301 return;
1302
Allan Stephens92d2c902011-10-25 11:20:26 -04001303 /* Create protocol message with "out-of-sequence" sequence number */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001304 msg_set_type(msg, msg_typ);
Ying Xue7a2f7d12014-04-21 10:55:46 +08001305 msg_set_net_plane(msg, l_ptr->net_plane);
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001306 msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in);
Ying Xue1da46562015-01-09 15:27:07 +08001307 msg_set_last_bcast(msg, tipc_bclink_get_last_sent(l_ptr->owner->net));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001308
1309 if (msg_typ == STATE_MSG) {
Jon Paul Maloya97b9d32015-05-14 10:46:15 -04001310 u16 next_sent = l_ptr->snd_nxt;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001311
Per Liden4323add2006-01-18 00:38:21 +01001312 if (!tipc_link_is_up(l_ptr))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001313 return;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001314 if (skb_queue_len(&l_ptr->backlogq))
1315 next_sent = buf_seqno(skb_peek(&l_ptr->backlogq));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001316 msg_set_next_sent(msg, next_sent);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001317 if (!skb_queue_empty(&l_ptr->deferdq)) {
Jon Paul Maloye4bf4f72015-05-14 10:46:14 -04001318 last_rcv = buf_seqno(skb_peek(&l_ptr->deferdq));
Jon Paul Maloya97b9d32015-05-14 10:46:15 -04001319 gap = mod(last_rcv - l_ptr->rcv_nxt);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001320 }
1321 msg_set_seq_gap(msg, gap);
1322 if (gap)
1323 l_ptr->stats.sent_nacks++;
1324 msg_set_link_tolerance(msg, tolerance);
1325 msg_set_linkprio(msg, priority);
Jon Paul Maloyed193ec2015-04-02 09:33:02 -04001326 msg_set_max_pkt(msg, l_ptr->mtu);
Jon Paul Maloya97b9d32015-05-14 10:46:15 -04001327 msg_set_ack(msg, mod(l_ptr->rcv_nxt - 1));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001328 msg_set_probe(msg, probe_msg != 0);
Jon Paul Maloyed193ec2015-04-02 09:33:02 -04001329 if (probe_msg)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001330 l_ptr->stats.sent_probes++;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001331 l_ptr->stats.sent_states++;
1332 } else { /* RESET_MSG or ACTIVATE_MSG */
Jon Paul Maloydff29b12015-04-02 09:33:01 -04001333 msg_set_ack(msg, mod(l_ptr->failover_checkpt - 1));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001334 msg_set_seq_gap(msg, 0);
1335 msg_set_next_sent(msg, 1);
Allan Stephensf23d9bf2011-01-18 15:15:34 -05001336 msg_set_probe(msg, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001337 msg_set_link_tolerance(msg, l_ptr->tolerance);
1338 msg_set_linkprio(msg, l_ptr->priority);
Jon Paul Maloyed193ec2015-04-02 09:33:02 -04001339 msg_set_max_pkt(msg, l_ptr->advertised_mtu);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001340 }
1341
Allan Stephens75f0aa42011-02-28 15:30:20 -05001342 r_flag = (l_ptr->owner->working_links > tipc_link_is_up(l_ptr));
1343 msg_set_redundant_link(msg, r_flag);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001344 msg_set_linkprio(msg, l_ptr->priority);
Allan Stephens92d2c902011-10-25 11:20:26 -04001345 msg_set_size(msg, msg_size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001346
Jon Paul Maloya97b9d32015-05-14 10:46:15 -04001347 msg_set_seqno(msg, mod(l_ptr->snd_nxt + (0xffff / 2)));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001348
stephen hemminger31e3c3f2010-10-13 13:20:35 +00001349 buf = tipc_buf_acquire(msg_size);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001350 if (!buf)
1351 return;
1352
Arnaldo Carvalho de Melo27d7ff42007-03-31 11:55:19 -03001353 skb_copy_to_linear_data(buf, msg, sizeof(l_ptr->proto_msg));
Ying Xue796c75d2013-06-17 10:54:48 -04001354 buf->priority = TC_PRIO_CONTROL;
Ying Xue7f9f95d2015-01-09 15:27:06 +08001355 tipc_bearer_send(l_ptr->owner->net, l_ptr->bearer_id, buf,
1356 &l_ptr->media_addr);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001357 l_ptr->rcv_unacked = 0;
Allan Stephens5f6d9122011-11-04 13:24:29 -04001358 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001359}
1360
1361/*
1362 * Receive protocol message :
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001363 * Note that network plane id propagates through the network, and may
1364 * change at any time. The node with lowest address rules
Per Lidenb97bf3f2006-01-02 19:04:38 +01001365 */
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001366static void tipc_link_proto_rcv(struct tipc_link *l_ptr,
Ying Xuec93d3ba2015-01-09 15:27:04 +08001367 struct sk_buff *buf)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001368{
1369 u32 rec_gap = 0;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001370 u32 msg_tol;
1371 struct tipc_msg *msg = buf_msg(buf);
1372
Jon Paul Maloydff29b12015-04-02 09:33:01 -04001373 if (l_ptr->flags & LINK_FAILINGOVER)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001374 goto exit;
1375
Ying Xue7a2f7d12014-04-21 10:55:46 +08001376 if (l_ptr->net_plane != msg_net_plane(msg))
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001377 if (link_own_addr(l_ptr) > msg_prevnode(msg))
Ying Xue7a2f7d12014-04-21 10:55:46 +08001378 l_ptr->net_plane = msg_net_plane(msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001379
Per Lidenb97bf3f2006-01-02 19:04:38 +01001380 switch (msg_type(msg)) {
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001381
Per Lidenb97bf3f2006-01-02 19:04:38 +01001382 case RESET_MSG:
Allan Stephensa686e682008-06-04 17:29:39 -07001383 if (!link_working_unknown(l_ptr) &&
1384 (l_ptr->peer_session != INVALID_SESSION)) {
Allan Stephens641c2182011-04-07 09:54:43 -04001385 if (less_eq(msg_session(msg), l_ptr->peer_session))
1386 break; /* duplicate or old reset: ignore */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001387 }
Allan Stephensb4b56102011-05-27 11:00:51 -04001388
1389 if (!msg_redundant_link(msg) && (link_working_working(l_ptr) ||
1390 link_working_unknown(l_ptr))) {
1391 /*
1392 * peer has lost contact -- don't allow peer's links
1393 * to reactivate before we recognize loss & clean up
1394 */
Ying Xueca9cf062014-05-08 08:54:40 +08001395 l_ptr->owner->action_flags |= TIPC_WAIT_OWN_LINKS_DOWN;
Allan Stephensb4b56102011-05-27 11:00:51 -04001396 }
1397
Allan Stephens47361c82011-10-26 10:55:16 -04001398 link_state_event(l_ptr, RESET_MSG);
1399
Per Lidenb97bf3f2006-01-02 19:04:38 +01001400 /* fall thru' */
1401 case ACTIVATE_MSG:
1402 /* Update link settings according other endpoint's values */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001403 strcpy((strrchr(l_ptr->name, ':') + 1), (char *)msg_data(msg));
1404
Allan Stephens2db99832010-12-31 18:59:33 +00001405 msg_tol = msg_link_tolerance(msg);
1406 if (msg_tol > l_ptr->tolerance)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001407 link_set_supervision_props(l_ptr, msg_tol);
1408
1409 if (msg_linkprio(msg) > l_ptr->priority)
1410 l_ptr->priority = msg_linkprio(msg);
1411
Jon Paul Maloyed193ec2015-04-02 09:33:02 -04001412 if (l_ptr->mtu > msg_max_pkt(msg))
1413 l_ptr->mtu = msg_max_pkt(msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001414
Allan Stephens4d753132011-10-25 12:19:05 -04001415 /* Synchronize broadcast link info, if not done previously */
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001416 if (!tipc_node_is_up(l_ptr->owner)) {
1417 l_ptr->owner->bclink.last_sent =
1418 l_ptr->owner->bclink.last_in =
1419 msg_last_bcast(msg);
1420 l_ptr->owner->bclink.oos_state = 0;
1421 }
Allan Stephens4d753132011-10-25 12:19:05 -04001422
Per Lidenb97bf3f2006-01-02 19:04:38 +01001423 l_ptr->peer_session = msg_session(msg);
1424 l_ptr->peer_bearer_id = msg_bearer_id(msg);
Allan Stephens47361c82011-10-26 10:55:16 -04001425
1426 if (msg_type(msg) == ACTIVATE_MSG)
1427 link_state_event(l_ptr, ACTIVATE_MSG);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001428 break;
1429 case STATE_MSG:
1430
Allan Stephens2db99832010-12-31 18:59:33 +00001431 msg_tol = msg_link_tolerance(msg);
1432 if (msg_tol)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001433 link_set_supervision_props(l_ptr, msg_tol);
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001434
1435 if (msg_linkprio(msg) &&
Per Lidenb97bf3f2006-01-02 19:04:38 +01001436 (msg_linkprio(msg) != l_ptr->priority)) {
Erik Hugne3fa9cac2015-01-22 17:10:31 +01001437 pr_debug("%s<%s>, priority change %u->%u\n",
1438 link_rst_msg, l_ptr->name,
1439 l_ptr->priority, msg_linkprio(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001440 l_ptr->priority = msg_linkprio(msg);
Per Liden4323add2006-01-18 00:38:21 +01001441 tipc_link_reset(l_ptr); /* Enforce change to take effect */
Per Lidenb97bf3f2006-01-02 19:04:38 +01001442 break;
1443 }
Jon Paul Maloyec37dcd2014-05-14 05:39:10 -04001444
1445 /* Record reception; force mismatch at next timeout: */
Jon Paul Maloycd4eee32015-05-14 10:46:16 -04001446 l_ptr->silent_intv_cnt = 0;
Jon Paul Maloyec37dcd2014-05-14 05:39:10 -04001447
Per Lidenb97bf3f2006-01-02 19:04:38 +01001448 link_state_event(l_ptr, TRAFFIC_MSG_EVT);
1449 l_ptr->stats.recv_states++;
1450 if (link_reset_unknown(l_ptr))
1451 break;
1452
Jon Paul Maloya97b9d32015-05-14 10:46:15 -04001453 if (less_eq(l_ptr->rcv_nxt, msg_next_sent(msg)))
1454 rec_gap = mod(msg_next_sent(msg) - l_ptr->rcv_nxt);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001455
Jon Paul Maloyed193ec2015-04-02 09:33:02 -04001456 if (msg_probe(msg))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001457 l_ptr->stats.recv_probes++;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001458
1459 /* Protocol message before retransmits, reduce loss risk */
Ying Xue389dd9b2012-11-16 13:51:30 +08001460 if (l_ptr->owner->bclink.recv_permitted)
Jon Paul Maloyc5898632015-02-05 08:36:36 -05001461 tipc_bclink_update_link_state(l_ptr->owner,
Allan Stephens7a54d4a2011-10-27 14:17:53 -04001462 msg_last_bcast(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001463
1464 if (rec_gap || (msg_probe(msg))) {
Jon Paul Maloyed193ec2015-04-02 09:33:02 -04001465 tipc_link_proto_xmit(l_ptr, STATE_MSG, 0,
1466 rec_gap, 0, 0);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001467 }
1468 if (msg_seq_gap(msg)) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001469 l_ptr->stats.recv_nacks++;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001470 tipc_link_retransmit(l_ptr, skb_peek(&l_ptr->transmq),
Per Liden4323add2006-01-18 00:38:21 +01001471 msg_seq_gap(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001472 }
1473 break;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001474 }
1475exit:
Allan Stephens5f6d9122011-11-04 13:24:29 -04001476 kfree_skb(buf);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001477}
1478
1479
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001480/* tipc_link_tunnel_xmit(): Tunnel one packet via a link belonging to
1481 * a different bearer. Owner node is locked.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001482 */
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001483static void tipc_link_tunnel_xmit(struct tipc_link *l_ptr,
1484 struct tipc_msg *tunnel_hdr,
1485 struct tipc_msg *msg,
1486 u32 selector)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001487{
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001488 struct tipc_link *tunnel;
Ying Xuea6ca1092014-11-26 11:41:55 +08001489 struct sk_buff *skb;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001490 u32 length = msg_size(msg);
1491
1492 tunnel = l_ptr->owner->active_links[selector & 1];
Allan Stephens5392d642006-06-25 23:52:50 -07001493 if (!tipc_link_is_up(tunnel)) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001494 pr_warn("%stunnel link no longer available\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001495 return;
Allan Stephens5392d642006-06-25 23:52:50 -07001496 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001497 msg_set_size(tunnel_hdr, length + INT_H_SIZE);
Ying Xuea6ca1092014-11-26 11:41:55 +08001498 skb = tipc_buf_acquire(length + INT_H_SIZE);
1499 if (!skb) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001500 pr_warn("%sunable to send tunnel msg\n", link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001501 return;
Allan Stephens5392d642006-06-25 23:52:50 -07001502 }
Ying Xuea6ca1092014-11-26 11:41:55 +08001503 skb_copy_to_linear_data(skb, tunnel_hdr, INT_H_SIZE);
1504 skb_copy_to_linear_data_offset(skb, INT_H_SIZE, msg, length);
1505 __tipc_link_xmit_skb(tunnel, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001506}
1507
1508
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001509/* tipc_link_failover_send_queue(): A link has gone down, but a second
1510 * link is still active. We can do failover. Tunnel the failing link's
1511 * whole send queue via the remaining link. This way, we don't lose
1512 * any packets, and sequence order is preserved for subsequent traffic
1513 * sent over the remaining link. Owner node is locked.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001514 */
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001515void tipc_link_failover_send_queue(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001516{
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001517 int msgcount;
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001518 struct tipc_link *tunnel = l_ptr->owner->active_links[0];
Per Lidenb97bf3f2006-01-02 19:04:38 +01001519 struct tipc_msg tunnel_hdr;
Ying Xue58dc55f2014-11-26 11:41:52 +08001520 struct sk_buff *skb;
Allan Stephens5392d642006-06-25 23:52:50 -07001521 int split_bundles;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001522
1523 if (!tunnel)
1524 return;
1525
Jon Paul Maloydff29b12015-04-02 09:33:01 -04001526 tipc_msg_init(link_own_addr(l_ptr), &tunnel_hdr, TUNNEL_PROTOCOL,
1527 FAILOVER_MSG, INT_H_SIZE, l_ptr->addr);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001528 skb_queue_splice_tail_init(&l_ptr->backlogq, &l_ptr->transmq);
Jon Paul Maloy1f66d162015-03-25 12:07:24 -04001529 tipc_link_purge_backlog(l_ptr);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001530 msgcount = skb_queue_len(&l_ptr->transmq);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001531 msg_set_bearer_id(&tunnel_hdr, l_ptr->peer_bearer_id);
1532 msg_set_msgcnt(&tunnel_hdr, msgcount);
Allan Stephensf1310722006-06-25 23:51:37 -07001533
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001534 if (skb_queue_empty(&l_ptr->transmq)) {
Ying Xue58dc55f2014-11-26 11:41:52 +08001535 skb = tipc_buf_acquire(INT_H_SIZE);
1536 if (skb) {
1537 skb_copy_to_linear_data(skb, &tunnel_hdr, INT_H_SIZE);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001538 msg_set_size(&tunnel_hdr, INT_H_SIZE);
Ying Xuea6ca1092014-11-26 11:41:55 +08001539 __tipc_link_xmit_skb(tunnel, skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001540 } else {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001541 pr_warn("%sunable to send changeover msg\n",
1542 link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001543 }
1544 return;
1545 }
Allan Stephensf1310722006-06-25 23:51:37 -07001546
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001547 split_bundles = (l_ptr->owner->active_links[0] !=
Allan Stephens5392d642006-06-25 23:52:50 -07001548 l_ptr->owner->active_links[1]);
1549
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001550 skb_queue_walk(&l_ptr->transmq, skb) {
Ying Xue58dc55f2014-11-26 11:41:52 +08001551 struct tipc_msg *msg = buf_msg(skb);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001552
1553 if ((msg_user(msg) == MSG_BUNDLER) && split_bundles) {
Per Lidenb97bf3f2006-01-02 19:04:38 +01001554 struct tipc_msg *m = msg_get_wrapped(msg);
Allan Stephens0e659672010-12-31 18:59:32 +00001555 unchar *pos = (unchar *)m;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001556
Florian Westphald788d802007-08-02 19:28:06 -07001557 msgcount = msg_msgcnt(msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001558 while (msgcount--) {
Allan Stephens0e659672010-12-31 18:59:32 +00001559 msg_set_seqno(m, msg_seqno(msg));
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001560 tipc_link_tunnel_xmit(l_ptr, &tunnel_hdr, m,
1561 msg_link_selector(m));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001562 pos += align(msg_size(m));
1563 m = (struct tipc_msg *)pos;
1564 }
1565 } else {
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001566 tipc_link_tunnel_xmit(l_ptr, &tunnel_hdr, msg,
1567 msg_link_selector(msg));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001568 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001569 }
1570}
1571
Ying Xue247f0f32014-02-18 16:06:46 +08001572/* tipc_link_dup_queue_xmit(): A second link has become active. Tunnel a
Jon Paul Maloy170b3922014-01-07 17:02:41 -05001573 * duplicate of the first link's send queue via the new link. This way, we
1574 * are guaranteed that currently queued packets from a socket are delivered
1575 * before future traffic from the same socket, even if this is using the
1576 * new link. The last arriving copy of each duplicate packet is dropped at
1577 * the receiving end by the regular protocol check, so packet cardinality
1578 * and sequence order is preserved per sender/receiver socket pair.
1579 * Owner node is locked.
1580 */
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001581void tipc_link_dup_queue_xmit(struct tipc_link *link,
1582 struct tipc_link *tnl)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001583{
Ying Xue58dc55f2014-11-26 11:41:52 +08001584 struct sk_buff *skb;
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001585 struct tipc_msg tnl_hdr;
1586 struct sk_buff_head *queue = &link->transmq;
1587 int mcnt;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001588
Jon Paul Maloydff29b12015-04-02 09:33:01 -04001589 tipc_msg_init(link_own_addr(link), &tnl_hdr, TUNNEL_PROTOCOL,
1590 SYNCH_MSG, INT_H_SIZE, link->addr);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001591 mcnt = skb_queue_len(&link->transmq) + skb_queue_len(&link->backlogq);
1592 msg_set_msgcnt(&tnl_hdr, mcnt);
1593 msg_set_bearer_id(&tnl_hdr, link->peer_bearer_id);
1594
1595tunnel_queue:
1596 skb_queue_walk(queue, skb) {
Ying Xue58dc55f2014-11-26 11:41:52 +08001597 struct sk_buff *outskb;
1598 struct tipc_msg *msg = buf_msg(skb);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001599 u32 len = msg_size(msg);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001600
Jon Paul Maloya97b9d32015-05-14 10:46:15 -04001601 msg_set_ack(msg, mod(link->rcv_nxt - 1));
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001602 msg_set_bcast_ack(msg, link->owner->bclink.last_in);
1603 msg_set_size(&tnl_hdr, len + INT_H_SIZE);
1604 outskb = tipc_buf_acquire(len + INT_H_SIZE);
Ying Xue58dc55f2014-11-26 11:41:52 +08001605 if (outskb == NULL) {
Erik Hugne2cf8aa12012-06-29 00:16:37 -04001606 pr_warn("%sunable to send duplicate msg\n",
1607 link_co_err);
Per Lidenb97bf3f2006-01-02 19:04:38 +01001608 return;
1609 }
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001610 skb_copy_to_linear_data(outskb, &tnl_hdr, INT_H_SIZE);
1611 skb_copy_to_linear_data_offset(outskb, INT_H_SIZE,
1612 skb->data, len);
1613 __tipc_link_xmit_skb(tnl, outskb);
1614 if (!tipc_link_is_up(link))
Per Lidenb97bf3f2006-01-02 19:04:38 +01001615 return;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001616 }
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001617 if (queue == &link->backlogq)
1618 return;
1619 queue = &link->backlogq;
1620 goto tunnel_queue;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001621}
1622
Jon Paul Maloydff29b12015-04-02 09:33:01 -04001623/* tipc_link_failover_rcv(): Receive a tunnelled FAILOVER_MSG packet
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001624 * Owner node is locked.
1625 */
Jon Paul Maloydff29b12015-04-02 09:33:01 -04001626static bool tipc_link_failover_rcv(struct tipc_link *link,
Jon Paul Maloy2da71422015-04-02 09:33:00 -04001627 struct sk_buff **skb)
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001628{
Jon Paul Maloy2da71422015-04-02 09:33:00 -04001629 struct tipc_msg *msg = buf_msg(*skb);
1630 struct sk_buff *iskb = NULL;
Jon Paul Maloydff29b12015-04-02 09:33:01 -04001631 struct tipc_link *pl = NULL;
Jon Paul Maloy2da71422015-04-02 09:33:00 -04001632 int bearer_id = msg_bearer_id(msg);
Jon Paul Maloyc1336ee2015-03-13 16:08:08 -04001633 int pos = 0;
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001634
Jon Paul Maloydff29b12015-04-02 09:33:01 -04001635 if (msg_type(msg) != FAILOVER_MSG) {
Jon Paul Maloy2da71422015-04-02 09:33:00 -04001636 pr_warn("%sunknown tunnel pkt received\n", link_co_err);
1637 goto exit;
Jon Paul Maloyf006c9c2014-02-13 17:29:11 -05001638 }
Dan Carpentercb4b102f2013-05-06 08:28:41 +00001639 if (bearer_id >= MAX_BEARERS)
1640 goto exit;
Jon Paul Maloy1dab3d52014-02-13 17:29:10 -05001641
Jon Paul Maloydff29b12015-04-02 09:33:01 -04001642 if (bearer_id == link->bearer_id)
1643 goto exit;
1644
1645 pl = link->owner->links[bearer_id];
1646 if (pl && tipc_link_is_up(pl))
1647 tipc_link_reset(pl);
1648
1649 if (link->failover_pkts == FIRST_FAILOVER)
1650 link->failover_pkts = msg_msgcnt(msg);
Jon Paul Maloy2da71422015-04-02 09:33:00 -04001651
1652 /* Should we expect an inner packet? */
Jon Paul Maloydff29b12015-04-02 09:33:01 -04001653 if (!link->failover_pkts)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001654 goto exit;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001655
Jon Paul Maloy2da71422015-04-02 09:33:00 -04001656 if (!tipc_msg_extract(*skb, &iskb, &pos)) {
1657 pr_warn("%sno inner failover pkt\n", link_co_err);
1658 *skb = NULL;
1659 goto exit;
1660 }
Jon Paul Maloydff29b12015-04-02 09:33:01 -04001661 link->failover_pkts--;
Jon Paul Maloy2da71422015-04-02 09:33:00 -04001662 *skb = NULL;
1663
Jon Paul Maloydff29b12015-04-02 09:33:01 -04001664 /* Was this packet already delivered? */
1665 if (less(buf_seqno(iskb), link->failover_checkpt)) {
Jon Paul Maloy2da71422015-04-02 09:33:00 -04001666 kfree_skb(iskb);
1667 iskb = NULL;
1668 goto exit;
1669 }
1670 if (msg_user(buf_msg(iskb)) == MSG_FRAGMENTER) {
1671 link->stats.recv_fragments++;
Jon Paul Maloydff29b12015-04-02 09:33:01 -04001672 tipc_buf_append(&link->failover_skb, &iskb);
Jon Paul Maloy2da71422015-04-02 09:33:00 -04001673 }
Per Lidenb97bf3f2006-01-02 19:04:38 +01001674exit:
Jon Paul Maloydff29b12015-04-02 09:33:01 -04001675 if (!link->failover_pkts && pl)
1676 pl->flags &= ~LINK_FAILINGOVER;
Jon Paul Maloy2da71422015-04-02 09:33:00 -04001677 kfree_skb(*skb);
1678 *skb = iskb;
1679 return *skb;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001680}
1681
Ying Xue2f55c432015-01-09 15:27:00 +08001682static void link_set_supervision_props(struct tipc_link *l_ptr, u32 tol)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001683{
Ying Xue2f55c432015-01-09 15:27:00 +08001684 unsigned long intv = ((tol / 4) > 500) ? 500 : tol / 4;
1685
1686 if ((tol < TIPC_MIN_LINK_TOL) || (tol > TIPC_MAX_LINK_TOL))
Allan Stephens5413b4c2011-01-18 13:24:55 -05001687 return;
1688
Ying Xue2f55c432015-01-09 15:27:00 +08001689 l_ptr->tolerance = tol;
Jon Paul Maloya97b9d32015-05-14 10:46:15 -04001690 l_ptr->keepalive_intv = msecs_to_jiffies(intv);
1691 l_ptr->abort_limit = tol / (jiffies_to_msecs(l_ptr->keepalive_intv));
Per Lidenb97bf3f2006-01-02 19:04:38 +01001692}
1693
Jon Paul Maloye3eea1e2015-03-13 16:08:11 -04001694void tipc_link_set_queue_limits(struct tipc_link *l, u32 win)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001695{
Jon Paul Maloyed193ec2015-04-02 09:33:02 -04001696 int max_bulk = TIPC_MAX_PUBLICATIONS / (l->mtu / ITEM_SIZE);
Jon Paul Maloy05dcc5a2015-03-13 16:08:10 -04001697
Jon Paul Maloye3eea1e2015-03-13 16:08:11 -04001698 l->window = win;
Jon Paul Maloy1f66d162015-03-25 12:07:24 -04001699 l->backlog[TIPC_LOW_IMPORTANCE].limit = win / 2;
1700 l->backlog[TIPC_MEDIUM_IMPORTANCE].limit = win;
1701 l->backlog[TIPC_HIGH_IMPORTANCE].limit = win / 2 * 3;
1702 l->backlog[TIPC_CRITICAL_IMPORTANCE].limit = win * 2;
1703 l->backlog[TIPC_SYSTEM_IMPORTANCE].limit = max_bulk;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001704}
1705
Jon Paul Maloye099e862014-02-13 17:29:18 -05001706/* tipc_link_find_owner - locate owner node of link by link's name
Ying Xuef2f98002015-01-09 15:27:05 +08001707 * @net: the applicable net namespace
Jon Paul Maloye099e862014-02-13 17:29:18 -05001708 * @name: pointer to link name string
1709 * @bearer_id: pointer to index in 'node->links' array where the link was found.
YOSHIFUJI Hideakic4307282007-02-09 23:25:21 +09001710 *
Jon Paul Maloye099e862014-02-13 17:29:18 -05001711 * Returns pointer to node owning the link, or 0 if no matching link is found.
Per Lidenb97bf3f2006-01-02 19:04:38 +01001712 */
Ying Xuef2f98002015-01-09 15:27:05 +08001713static struct tipc_node *tipc_link_find_owner(struct net *net,
1714 const char *link_name,
Jon Paul Maloye099e862014-02-13 17:29:18 -05001715 unsigned int *bearer_id)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001716{
Ying Xuef2f98002015-01-09 15:27:05 +08001717 struct tipc_net *tn = net_generic(net, tipc_net_id);
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001718 struct tipc_link *l_ptr;
Erik Hugnebbfbe472013-10-18 07:23:21 +02001719 struct tipc_node *n_ptr;
Fabian Frederick886eaa12014-12-25 12:05:50 +01001720 struct tipc_node *found_node = NULL;
Erik Hugnebbfbe472013-10-18 07:23:21 +02001721 int i;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001722
Jon Paul Maloye099e862014-02-13 17:29:18 -05001723 *bearer_id = 0;
Ying Xue6c7a7622014-03-27 12:54:37 +08001724 rcu_read_lock();
Ying Xuef2f98002015-01-09 15:27:05 +08001725 list_for_each_entry_rcu(n_ptr, &tn->node_list, list) {
Jon Paul Maloya11607f2014-02-14 16:40:44 -05001726 tipc_node_lock(n_ptr);
Erik Hugnebbfbe472013-10-18 07:23:21 +02001727 for (i = 0; i < MAX_BEARERS; i++) {
1728 l_ptr = n_ptr->links[i];
Jon Paul Maloye099e862014-02-13 17:29:18 -05001729 if (l_ptr && !strcmp(l_ptr->name, link_name)) {
1730 *bearer_id = i;
1731 found_node = n_ptr;
1732 break;
1733 }
Erik Hugnebbfbe472013-10-18 07:23:21 +02001734 }
Jon Paul Maloya11607f2014-02-14 16:40:44 -05001735 tipc_node_unlock(n_ptr);
Jon Paul Maloye099e862014-02-13 17:29:18 -05001736 if (found_node)
1737 break;
Erik Hugnebbfbe472013-10-18 07:23:21 +02001738 }
Ying Xue6c7a7622014-03-27 12:54:37 +08001739 rcu_read_unlock();
1740
Jon Paul Maloye099e862014-02-13 17:29:18 -05001741 return found_node;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001742}
1743
Allan Stephens5c216e12011-10-18 11:34:29 -04001744/**
Per Lidenb97bf3f2006-01-02 19:04:38 +01001745 * link_reset_statistics - reset link statistics
1746 * @l_ptr: pointer to link
1747 */
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001748static void link_reset_statistics(struct tipc_link *l_ptr)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001749{
1750 memset(&l_ptr->stats, 0, sizeof(l_ptr->stats));
Jon Paul Maloya97b9d32015-05-14 10:46:15 -04001751 l_ptr->stats.sent_info = l_ptr->snd_nxt;
1752 l_ptr->stats.recv_info = l_ptr->rcv_nxt;
Per Lidenb97bf3f2006-01-02 19:04:38 +01001753}
1754
Paul Gortmakera18c4bc2011-12-29 20:58:42 -05001755static void link_print(struct tipc_link *l_ptr, const char *str)
Per Lidenb97bf3f2006-01-02 19:04:38 +01001756{
Ying Xue7f9f95d2015-01-09 15:27:06 +08001757 struct tipc_net *tn = net_generic(l_ptr->owner->net, tipc_net_id);
Ying Xue7a2f7d12014-04-21 10:55:46 +08001758 struct tipc_bearer *b_ptr;
1759
1760 rcu_read_lock();
Ying Xue7f9f95d2015-01-09 15:27:06 +08001761 b_ptr = rcu_dereference_rtnl(tn->bearer_list[l_ptr->bearer_id]);
Ying Xue7a2f7d12014-04-21 10:55:46 +08001762 if (b_ptr)
1763 pr_info("%s Link %x<%s>:", str, l_ptr->addr, b_ptr->name);
1764 rcu_read_unlock();
Allan Stephens8d64a5b2010-12-31 18:59:27 +00001765
Per Lidenb97bf3f2006-01-02 19:04:38 +01001766 if (link_working_unknown(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04001767 pr_cont(":WU\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00001768 else if (link_reset_reset(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04001769 pr_cont(":RR\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00001770 else if (link_reset_unknown(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04001771 pr_cont(":RU\n");
Allan Stephens8d64a5b2010-12-31 18:59:27 +00001772 else if (link_working_working(l_ptr))
Paul Gortmaker5deedde2012-07-11 19:27:56 -04001773 pr_cont(":WW\n");
1774 else
1775 pr_cont("\n");
Per Lidenb97bf3f2006-01-02 19:04:38 +01001776}
Richard Alpe0655f6a2014-11-20 10:29:07 +01001777
1778/* Parse and validate nested (link) properties valid for media, bearer and link
1779 */
1780int tipc_nl_parse_link_prop(struct nlattr *prop, struct nlattr *props[])
1781{
1782 int err;
1783
1784 err = nla_parse_nested(props, TIPC_NLA_PROP_MAX, prop,
1785 tipc_nl_prop_policy);
1786 if (err)
1787 return err;
1788
1789 if (props[TIPC_NLA_PROP_PRIO]) {
1790 u32 prio;
1791
1792 prio = nla_get_u32(props[TIPC_NLA_PROP_PRIO]);
1793 if (prio > TIPC_MAX_LINK_PRI)
1794 return -EINVAL;
1795 }
1796
1797 if (props[TIPC_NLA_PROP_TOL]) {
1798 u32 tol;
1799
1800 tol = nla_get_u32(props[TIPC_NLA_PROP_TOL]);
1801 if ((tol < TIPC_MIN_LINK_TOL) || (tol > TIPC_MAX_LINK_TOL))
1802 return -EINVAL;
1803 }
1804
1805 if (props[TIPC_NLA_PROP_WIN]) {
1806 u32 win;
1807
1808 win = nla_get_u32(props[TIPC_NLA_PROP_WIN]);
1809 if ((win < TIPC_MIN_LINK_WIN) || (win > TIPC_MAX_LINK_WIN))
1810 return -EINVAL;
1811 }
1812
1813 return 0;
1814}
Richard Alpe7be57fc2014-11-20 10:29:12 +01001815
Richard Alpef96ce7a2014-11-20 10:29:13 +01001816int tipc_nl_link_set(struct sk_buff *skb, struct genl_info *info)
1817{
1818 int err;
1819 int res = 0;
1820 int bearer_id;
1821 char *name;
1822 struct tipc_link *link;
1823 struct tipc_node *node;
1824 struct nlattr *attrs[TIPC_NLA_LINK_MAX + 1];
Richard Alpe37e2d482015-02-09 09:50:08 +01001825 struct net *net = sock_net(skb->sk);
Richard Alpef96ce7a2014-11-20 10:29:13 +01001826
1827 if (!info->attrs[TIPC_NLA_LINK])
1828 return -EINVAL;
1829
1830 err = nla_parse_nested(attrs, TIPC_NLA_LINK_MAX,
1831 info->attrs[TIPC_NLA_LINK],
1832 tipc_nl_link_policy);
1833 if (err)
1834 return err;
1835
1836 if (!attrs[TIPC_NLA_LINK_NAME])
1837 return -EINVAL;
1838
1839 name = nla_data(attrs[TIPC_NLA_LINK_NAME]);
1840
Richard Alpe670f4f82015-05-06 13:58:55 +02001841 if (strcmp(name, tipc_bclink_name) == 0)
1842 return tipc_nl_bc_link_set(net, attrs);
1843
Ying Xuef2f98002015-01-09 15:27:05 +08001844 node = tipc_link_find_owner(net, name, &bearer_id);
Richard Alpef96ce7a2014-11-20 10:29:13 +01001845 if (!node)
1846 return -EINVAL;
1847
1848 tipc_node_lock(node);
1849
1850 link = node->links[bearer_id];
1851 if (!link) {
1852 res = -EINVAL;
1853 goto out;
1854 }
1855
1856 if (attrs[TIPC_NLA_LINK_PROP]) {
1857 struct nlattr *props[TIPC_NLA_PROP_MAX + 1];
1858
1859 err = tipc_nl_parse_link_prop(attrs[TIPC_NLA_LINK_PROP],
1860 props);
1861 if (err) {
1862 res = err;
1863 goto out;
1864 }
1865
1866 if (props[TIPC_NLA_PROP_TOL]) {
1867 u32 tol;
1868
1869 tol = nla_get_u32(props[TIPC_NLA_PROP_TOL]);
1870 link_set_supervision_props(link, tol);
Jon Paul Maloyed193ec2015-04-02 09:33:02 -04001871 tipc_link_proto_xmit(link, STATE_MSG, 0, 0, tol, 0);
Richard Alpef96ce7a2014-11-20 10:29:13 +01001872 }
1873 if (props[TIPC_NLA_PROP_PRIO]) {
1874 u32 prio;
1875
1876 prio = nla_get_u32(props[TIPC_NLA_PROP_PRIO]);
1877 link->priority = prio;
Jon Paul Maloyed193ec2015-04-02 09:33:02 -04001878 tipc_link_proto_xmit(link, STATE_MSG, 0, 0, 0, prio);
Richard Alpef96ce7a2014-11-20 10:29:13 +01001879 }
1880 if (props[TIPC_NLA_PROP_WIN]) {
1881 u32 win;
1882
1883 win = nla_get_u32(props[TIPC_NLA_PROP_WIN]);
1884 tipc_link_set_queue_limits(link, win);
1885 }
1886 }
1887
1888out:
1889 tipc_node_unlock(node);
1890
1891 return res;
1892}
Richard Alped8182802014-11-24 11:10:29 +01001893
1894static int __tipc_nl_add_stats(struct sk_buff *skb, struct tipc_stats *s)
Richard Alpe7be57fc2014-11-20 10:29:12 +01001895{
1896 int i;
1897 struct nlattr *stats;
1898
1899 struct nla_map {
1900 u32 key;
1901 u32 val;
1902 };
1903
1904 struct nla_map map[] = {
1905 {TIPC_NLA_STATS_RX_INFO, s->recv_info},
1906 {TIPC_NLA_STATS_RX_FRAGMENTS, s->recv_fragments},
1907 {TIPC_NLA_STATS_RX_FRAGMENTED, s->recv_fragmented},
1908 {TIPC_NLA_STATS_RX_BUNDLES, s->recv_bundles},
1909 {TIPC_NLA_STATS_RX_BUNDLED, s->recv_bundled},
1910 {TIPC_NLA_STATS_TX_INFO, s->sent_info},
1911 {TIPC_NLA_STATS_TX_FRAGMENTS, s->sent_fragments},
1912 {TIPC_NLA_STATS_TX_FRAGMENTED, s->sent_fragmented},
1913 {TIPC_NLA_STATS_TX_BUNDLES, s->sent_bundles},
1914 {TIPC_NLA_STATS_TX_BUNDLED, s->sent_bundled},
1915 {TIPC_NLA_STATS_MSG_PROF_TOT, (s->msg_length_counts) ?
1916 s->msg_length_counts : 1},
1917 {TIPC_NLA_STATS_MSG_LEN_CNT, s->msg_length_counts},
1918 {TIPC_NLA_STATS_MSG_LEN_TOT, s->msg_lengths_total},
1919 {TIPC_NLA_STATS_MSG_LEN_P0, s->msg_length_profile[0]},
1920 {TIPC_NLA_STATS_MSG_LEN_P1, s->msg_length_profile[1]},
1921 {TIPC_NLA_STATS_MSG_LEN_P2, s->msg_length_profile[2]},
1922 {TIPC_NLA_STATS_MSG_LEN_P3, s->msg_length_profile[3]},
1923 {TIPC_NLA_STATS_MSG_LEN_P4, s->msg_length_profile[4]},
1924 {TIPC_NLA_STATS_MSG_LEN_P5, s->msg_length_profile[5]},
1925 {TIPC_NLA_STATS_MSG_LEN_P6, s->msg_length_profile[6]},
1926 {TIPC_NLA_STATS_RX_STATES, s->recv_states},
1927 {TIPC_NLA_STATS_RX_PROBES, s->recv_probes},
1928 {TIPC_NLA_STATS_RX_NACKS, s->recv_nacks},
1929 {TIPC_NLA_STATS_RX_DEFERRED, s->deferred_recv},
1930 {TIPC_NLA_STATS_TX_STATES, s->sent_states},
1931 {TIPC_NLA_STATS_TX_PROBES, s->sent_probes},
1932 {TIPC_NLA_STATS_TX_NACKS, s->sent_nacks},
1933 {TIPC_NLA_STATS_TX_ACKS, s->sent_acks},
1934 {TIPC_NLA_STATS_RETRANSMITTED, s->retransmitted},
1935 {TIPC_NLA_STATS_DUPLICATES, s->duplicates},
1936 {TIPC_NLA_STATS_LINK_CONGS, s->link_congs},
1937 {TIPC_NLA_STATS_MAX_QUEUE, s->max_queue_sz},
1938 {TIPC_NLA_STATS_AVG_QUEUE, s->queue_sz_counts ?
1939 (s->accu_queue_sz / s->queue_sz_counts) : 0}
1940 };
1941
1942 stats = nla_nest_start(skb, TIPC_NLA_LINK_STATS);
1943 if (!stats)
1944 return -EMSGSIZE;
1945
1946 for (i = 0; i < ARRAY_SIZE(map); i++)
1947 if (nla_put_u32(skb, map[i].key, map[i].val))
1948 goto msg_full;
1949
1950 nla_nest_end(skb, stats);
1951
1952 return 0;
1953msg_full:
1954 nla_nest_cancel(skb, stats);
1955
1956 return -EMSGSIZE;
1957}
1958
1959/* Caller should hold appropriate locks to protect the link */
Ying Xue34747532015-01-09 15:27:10 +08001960static int __tipc_nl_add_link(struct net *net, struct tipc_nl_msg *msg,
Nicolas Dichtelf2f67392015-04-28 18:33:50 +02001961 struct tipc_link *link, int nlflags)
Richard Alpe7be57fc2014-11-20 10:29:12 +01001962{
1963 int err;
1964 void *hdr;
1965 struct nlattr *attrs;
1966 struct nlattr *prop;
Ying Xue34747532015-01-09 15:27:10 +08001967 struct tipc_net *tn = net_generic(net, tipc_net_id);
Richard Alpe7be57fc2014-11-20 10:29:12 +01001968
Richard Alpebfb3e5d2015-02-09 09:50:03 +01001969 hdr = genlmsg_put(msg->skb, msg->portid, msg->seq, &tipc_genl_family,
Nicolas Dichtelf2f67392015-04-28 18:33:50 +02001970 nlflags, TIPC_NL_LINK_GET);
Richard Alpe7be57fc2014-11-20 10:29:12 +01001971 if (!hdr)
1972 return -EMSGSIZE;
1973
1974 attrs = nla_nest_start(msg->skb, TIPC_NLA_LINK);
1975 if (!attrs)
1976 goto msg_full;
1977
1978 if (nla_put_string(msg->skb, TIPC_NLA_LINK_NAME, link->name))
1979 goto attr_msg_full;
1980 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_DEST,
Ying Xue34747532015-01-09 15:27:10 +08001981 tipc_cluster_mask(tn->own_addr)))
Richard Alpe7be57fc2014-11-20 10:29:12 +01001982 goto attr_msg_full;
Jon Paul Maloyed193ec2015-04-02 09:33:02 -04001983 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_MTU, link->mtu))
Richard Alpe7be57fc2014-11-20 10:29:12 +01001984 goto attr_msg_full;
Jon Paul Maloya97b9d32015-05-14 10:46:15 -04001985 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_RX, link->rcv_nxt))
Richard Alpe7be57fc2014-11-20 10:29:12 +01001986 goto attr_msg_full;
Jon Paul Maloya97b9d32015-05-14 10:46:15 -04001987 if (nla_put_u32(msg->skb, TIPC_NLA_LINK_TX, link->snd_nxt))
Richard Alpe7be57fc2014-11-20 10:29:12 +01001988 goto attr_msg_full;
1989
1990 if (tipc_link_is_up(link))
1991 if (nla_put_flag(msg->skb, TIPC_NLA_LINK_UP))
1992 goto attr_msg_full;
1993 if (tipc_link_is_active(link))
1994 if (nla_put_flag(msg->skb, TIPC_NLA_LINK_ACTIVE))
1995 goto attr_msg_full;
1996
1997 prop = nla_nest_start(msg->skb, TIPC_NLA_LINK_PROP);
1998 if (!prop)
1999 goto attr_msg_full;
2000 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_PRIO, link->priority))
2001 goto prop_msg_full;
2002 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_TOL, link->tolerance))
2003 goto prop_msg_full;
2004 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_WIN,
Jon Paul Maloy1f66d162015-03-25 12:07:24 -04002005 link->window))
Richard Alpe7be57fc2014-11-20 10:29:12 +01002006 goto prop_msg_full;
2007 if (nla_put_u32(msg->skb, TIPC_NLA_PROP_PRIO, link->priority))
2008 goto prop_msg_full;
2009 nla_nest_end(msg->skb, prop);
2010
2011 err = __tipc_nl_add_stats(msg->skb, &link->stats);
2012 if (err)
2013 goto attr_msg_full;
2014
2015 nla_nest_end(msg->skb, attrs);
2016 genlmsg_end(msg->skb, hdr);
2017
2018 return 0;
2019
2020prop_msg_full:
2021 nla_nest_cancel(msg->skb, prop);
2022attr_msg_full:
2023 nla_nest_cancel(msg->skb, attrs);
2024msg_full:
2025 genlmsg_cancel(msg->skb, hdr);
2026
2027 return -EMSGSIZE;
2028}
2029
2030/* Caller should hold node lock */
Ying Xue34747532015-01-09 15:27:10 +08002031static int __tipc_nl_add_node_links(struct net *net, struct tipc_nl_msg *msg,
2032 struct tipc_node *node, u32 *prev_link)
Richard Alpe7be57fc2014-11-20 10:29:12 +01002033{
2034 u32 i;
2035 int err;
2036
2037 for (i = *prev_link; i < MAX_BEARERS; i++) {
2038 *prev_link = i;
2039
2040 if (!node->links[i])
2041 continue;
2042
Nicolas Dichtelf2f67392015-04-28 18:33:50 +02002043 err = __tipc_nl_add_link(net, msg, node->links[i], NLM_F_MULTI);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002044 if (err)
2045 return err;
2046 }
2047 *prev_link = 0;
2048
2049 return 0;
2050}
2051
2052int tipc_nl_link_dump(struct sk_buff *skb, struct netlink_callback *cb)
2053{
Ying Xuef2f98002015-01-09 15:27:05 +08002054 struct net *net = sock_net(skb->sk);
2055 struct tipc_net *tn = net_generic(net, tipc_net_id);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002056 struct tipc_node *node;
2057 struct tipc_nl_msg msg;
2058 u32 prev_node = cb->args[0];
2059 u32 prev_link = cb->args[1];
2060 int done = cb->args[2];
2061 int err;
2062
2063 if (done)
2064 return 0;
2065
2066 msg.skb = skb;
2067 msg.portid = NETLINK_CB(cb->skb).portid;
2068 msg.seq = cb->nlh->nlmsg_seq;
2069
2070 rcu_read_lock();
Richard Alpe7be57fc2014-11-20 10:29:12 +01002071 if (prev_node) {
Ying Xuef2f98002015-01-09 15:27:05 +08002072 node = tipc_node_find(net, prev_node);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002073 if (!node) {
2074 /* We never set seq or call nl_dump_check_consistent()
2075 * this means that setting prev_seq here will cause the
2076 * consistence check to fail in the netlink callback
2077 * handler. Resulting in the last NLMSG_DONE message
2078 * having the NLM_F_DUMP_INTR flag set.
2079 */
2080 cb->prev_seq = 1;
2081 goto out;
2082 }
Ying Xue8a0f6eb2015-03-26 18:10:24 +08002083 tipc_node_put(node);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002084
Ying Xuef2f98002015-01-09 15:27:05 +08002085 list_for_each_entry_continue_rcu(node, &tn->node_list,
2086 list) {
Richard Alpe7be57fc2014-11-20 10:29:12 +01002087 tipc_node_lock(node);
Ying Xue34747532015-01-09 15:27:10 +08002088 err = __tipc_nl_add_node_links(net, &msg, node,
2089 &prev_link);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002090 tipc_node_unlock(node);
2091 if (err)
2092 goto out;
2093
2094 prev_node = node->addr;
2095 }
2096 } else {
Ying Xue1da46562015-01-09 15:27:07 +08002097 err = tipc_nl_add_bc_link(net, &msg);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002098 if (err)
2099 goto out;
2100
Ying Xuef2f98002015-01-09 15:27:05 +08002101 list_for_each_entry_rcu(node, &tn->node_list, list) {
Richard Alpe7be57fc2014-11-20 10:29:12 +01002102 tipc_node_lock(node);
Ying Xue34747532015-01-09 15:27:10 +08002103 err = __tipc_nl_add_node_links(net, &msg, node,
2104 &prev_link);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002105 tipc_node_unlock(node);
2106 if (err)
2107 goto out;
2108
2109 prev_node = node->addr;
2110 }
2111 }
2112 done = 1;
2113out:
2114 rcu_read_unlock();
2115
2116 cb->args[0] = prev_node;
2117 cb->args[1] = prev_link;
2118 cb->args[2] = done;
2119
2120 return skb->len;
2121}
2122
2123int tipc_nl_link_get(struct sk_buff *skb, struct genl_info *info)
2124{
Ying Xuef2f98002015-01-09 15:27:05 +08002125 struct net *net = genl_info_net(info);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002126 struct tipc_nl_msg msg;
Richard Alpe7be57fc2014-11-20 10:29:12 +01002127 char *name;
Richard Alpe7be57fc2014-11-20 10:29:12 +01002128 int err;
2129
Richard Alpe7be57fc2014-11-20 10:29:12 +01002130 msg.portid = info->snd_portid;
2131 msg.seq = info->snd_seq;
2132
Richard Alpe670f4f82015-05-06 13:58:55 +02002133 if (!info->attrs[TIPC_NLA_LINK_NAME])
2134 return -EINVAL;
2135 name = nla_data(info->attrs[TIPC_NLA_LINK_NAME]);
2136
2137 msg.skb = nlmsg_new(NLMSG_GOODSIZE, GFP_KERNEL);
2138 if (!msg.skb)
2139 return -ENOMEM;
2140
2141 if (strcmp(name, tipc_bclink_name) == 0) {
2142 err = tipc_nl_add_bc_link(net, &msg);
2143 if (err) {
2144 nlmsg_free(msg.skb);
2145 return err;
2146 }
2147 } else {
2148 int bearer_id;
2149 struct tipc_node *node;
2150 struct tipc_link *link;
2151
2152 node = tipc_link_find_owner(net, name, &bearer_id);
2153 if (!node)
2154 return -EINVAL;
2155
2156 tipc_node_lock(node);
2157 link = node->links[bearer_id];
2158 if (!link) {
2159 tipc_node_unlock(node);
2160 nlmsg_free(msg.skb);
2161 return -EINVAL;
2162 }
2163
2164 err = __tipc_nl_add_link(net, &msg, link, 0);
2165 tipc_node_unlock(node);
2166 if (err) {
2167 nlmsg_free(msg.skb);
2168 return err;
2169 }
Richard Alpe7be57fc2014-11-20 10:29:12 +01002170 }
2171
Richard Alpe670f4f82015-05-06 13:58:55 +02002172 return genlmsg_reply(msg.skb, info);
Richard Alpe7be57fc2014-11-20 10:29:12 +01002173}
Richard Alpeae363422014-11-20 10:29:14 +01002174
2175int tipc_nl_link_reset_stats(struct sk_buff *skb, struct genl_info *info)
2176{
2177 int err;
2178 char *link_name;
2179 unsigned int bearer_id;
2180 struct tipc_link *link;
2181 struct tipc_node *node;
2182 struct nlattr *attrs[TIPC_NLA_LINK_MAX + 1];
Richard Alpe18178772015-02-09 09:50:09 +01002183 struct net *net = sock_net(skb->sk);
Richard Alpeae363422014-11-20 10:29:14 +01002184
2185 if (!info->attrs[TIPC_NLA_LINK])
2186 return -EINVAL;
2187
2188 err = nla_parse_nested(attrs, TIPC_NLA_LINK_MAX,
2189 info->attrs[TIPC_NLA_LINK],
2190 tipc_nl_link_policy);
2191 if (err)
2192 return err;
2193
2194 if (!attrs[TIPC_NLA_LINK_NAME])
2195 return -EINVAL;
2196
2197 link_name = nla_data(attrs[TIPC_NLA_LINK_NAME]);
2198
2199 if (strcmp(link_name, tipc_bclink_name) == 0) {
Ying Xue1da46562015-01-09 15:27:07 +08002200 err = tipc_bclink_reset_stats(net);
Richard Alpeae363422014-11-20 10:29:14 +01002201 if (err)
2202 return err;
2203 return 0;
2204 }
2205
Ying Xuef2f98002015-01-09 15:27:05 +08002206 node = tipc_link_find_owner(net, link_name, &bearer_id);
Richard Alpeae363422014-11-20 10:29:14 +01002207 if (!node)
2208 return -EINVAL;
2209
2210 tipc_node_lock(node);
2211
2212 link = node->links[bearer_id];
2213 if (!link) {
2214 tipc_node_unlock(node);
2215 return -EINVAL;
2216 }
2217
2218 link_reset_statistics(link);
2219
2220 tipc_node_unlock(node);
2221
2222 return 0;
2223}