| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1 | /* | 
 | 2 |  * net/tipc/link.c: TIPC link code | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 3 |  * | 
| Allan Stephens | 05646c9 | 2007-06-10 17:25:24 -0700 | [diff] [blame] | 4 |  * Copyright (c) 1996-2007, Ericsson AB | 
| Allan Stephens | 23dd4cc | 2011-01-07 11:43:40 -0500 | [diff] [blame] | 5 |  * Copyright (c) 2004-2007, 2010-2011, Wind River Systems | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 6 |  * All rights reserved. | 
 | 7 |  * | 
| Per Liden | 9ea1fd3 | 2006-01-11 13:30:43 +0100 | [diff] [blame] | 8 |  * Redistribution and use in source and binary forms, with or without | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 9 |  * modification, are permitted provided that the following conditions are met: | 
 | 10 |  * | 
| Per Liden | 9ea1fd3 | 2006-01-11 13:30:43 +0100 | [diff] [blame] | 11 |  * 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 Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 19 |  * | 
| Per Liden | 9ea1fd3 | 2006-01-11 13:30:43 +0100 | [diff] [blame] | 20 |  * 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 Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 34 |  * POSSIBILITY OF SUCH DAMAGE. | 
 | 35 |  */ | 
 | 36 |  | 
 | 37 | #include "core.h" | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 38 | #include "link.h" | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 39 | #include "port.h" | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 40 | #include "name_distr.h" | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 41 | #include "discover.h" | 
 | 42 | #include "config.h" | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 43 |  | 
 | 44 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 45 | /* | 
| Allan Stephens | a686e68 | 2008-06-04 17:29:39 -0700 | [diff] [blame] | 46 |  * Out-of-range value for link session numbers | 
 | 47 |  */ | 
 | 48 |  | 
 | 49 | #define INVALID_SESSION 0x10000 | 
 | 50 |  | 
 | 51 | /* | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 52 |  * Link state events: | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 53 |  */ | 
 | 54 |  | 
 | 55 | #define  STARTING_EVT    856384768	/* link processing trigger */ | 
 | 56 | #define  TRAFFIC_MSG_EVT 560815u	/* rx'd ??? */ | 
 | 57 | #define  TIMEOUT_EVT     560817u	/* link timer expired */ | 
 | 58 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 59 | /* | 
 | 60 |  * The following two 'message types' is really just implementation | 
 | 61 |  * data conveniently stored in the message header. | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 62 |  * They must not be considered part of the protocol | 
 | 63 |  */ | 
 | 64 | #define OPEN_MSG   0 | 
 | 65 | #define CLOSED_MSG 1 | 
 | 66 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 67 | /* | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 68 |  * State value stored in 'exp_msg_count' | 
 | 69 |  */ | 
 | 70 |  | 
 | 71 | #define START_CHANGEOVER 100000u | 
 | 72 |  | 
 | 73 | /** | 
 | 74 |  * struct link_name - deconstructed link name | 
 | 75 |  * @addr_local: network address of node at this end | 
 | 76 |  * @if_local: name of interface at this end | 
 | 77 |  * @addr_peer: network address of node at far end | 
 | 78 |  * @if_peer: name of interface at far end | 
 | 79 |  */ | 
 | 80 |  | 
 | 81 | struct link_name { | 
 | 82 | 	u32 addr_local; | 
 | 83 | 	char if_local[TIPC_MAX_IF_NAME]; | 
 | 84 | 	u32 addr_peer; | 
 | 85 | 	char if_peer[TIPC_MAX_IF_NAME]; | 
 | 86 | }; | 
 | 87 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 88 | static void link_handle_out_of_seq_msg(struct link *l_ptr, | 
 | 89 | 				       struct sk_buff *buf); | 
 | 90 | static void link_recv_proto_msg(struct link *l_ptr, struct sk_buff *buf); | 
 | 91 | static int  link_recv_changeover_msg(struct link **l_ptr, struct sk_buff **buf); | 
 | 92 | static void link_set_supervision_props(struct link *l_ptr, u32 tolerance); | 
| Allan Stephens | 23dd4cc | 2011-01-07 11:43:40 -0500 | [diff] [blame] | 93 | static int  link_send_sections_long(struct tipc_port *sender, | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 94 | 				    struct iovec const *msg_sect, | 
| Allan Stephens | 2689690 | 2011-04-21 10:42:07 -0500 | [diff] [blame] | 95 | 				    u32 num_sect, unsigned int total_len, | 
 | 96 | 				    u32 destnode); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 97 | static void link_check_defragm_bufs(struct link *l_ptr); | 
 | 98 | static void link_state_event(struct link *l_ptr, u32 event); | 
 | 99 | static void link_reset_statistics(struct link *l_ptr); | 
| Allan Stephens | 8d64a5b | 2010-12-31 18:59:27 +0000 | [diff] [blame] | 100 | static void link_print(struct link *l_ptr, const char *str); | 
| stephen hemminger | 31e3c3f | 2010-10-13 13:20:35 +0000 | [diff] [blame] | 101 | static void link_start(struct link *l_ptr); | 
 | 102 | static int link_send_long_buf(struct link *l_ptr, struct sk_buff *buf); | 
 | 103 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 104 | /* | 
| Sam Ravnborg | 05790c6 | 2006-03-20 22:37:04 -0800 | [diff] [blame] | 105 |  *  Simple link routines | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 106 |  */ | 
 | 107 |  | 
| Sam Ravnborg | 05790c6 | 2006-03-20 22:37:04 -0800 | [diff] [blame] | 108 | static unsigned int align(unsigned int i) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 109 | { | 
 | 110 | 	return (i + 3) & ~3u; | 
 | 111 | } | 
 | 112 |  | 
| Sam Ravnborg | 05790c6 | 2006-03-20 22:37:04 -0800 | [diff] [blame] | 113 | static void link_init_max_pkt(struct link *l_ptr) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 114 | { | 
 | 115 | 	u32 max_pkt; | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 116 |  | 
| Allan Stephens | 2d627b9 | 2011-01-07 13:00:11 -0500 | [diff] [blame] | 117 | 	max_pkt = (l_ptr->b_ptr->mtu & ~3); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 118 | 	if (max_pkt > MAX_MSG_SIZE) | 
 | 119 | 		max_pkt = MAX_MSG_SIZE; | 
 | 120 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 121 | 	l_ptr->max_pkt_target = max_pkt; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 122 | 	if (l_ptr->max_pkt_target < MAX_PKT_DEFAULT) | 
 | 123 | 		l_ptr->max_pkt = l_ptr->max_pkt_target; | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 124 | 	else | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 125 | 		l_ptr->max_pkt = MAX_PKT_DEFAULT; | 
 | 126 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 127 | 	l_ptr->max_pkt_probes = 0; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 128 | } | 
 | 129 |  | 
| Sam Ravnborg | 05790c6 | 2006-03-20 22:37:04 -0800 | [diff] [blame] | 130 | static u32 link_next_sent(struct link *l_ptr) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 131 | { | 
 | 132 | 	if (l_ptr->next_out) | 
 | 133 | 		return msg_seqno(buf_msg(l_ptr->next_out)); | 
 | 134 | 	return mod(l_ptr->next_out_no); | 
 | 135 | } | 
 | 136 |  | 
| Sam Ravnborg | 05790c6 | 2006-03-20 22:37:04 -0800 | [diff] [blame] | 137 | static u32 link_last_sent(struct link *l_ptr) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 138 | { | 
 | 139 | 	return mod(link_next_sent(l_ptr) - 1); | 
 | 140 | } | 
 | 141 |  | 
 | 142 | /* | 
| Sam Ravnborg | 05790c6 | 2006-03-20 22:37:04 -0800 | [diff] [blame] | 143 |  *  Simple non-static link routines (i.e. referenced outside this file) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 144 |  */ | 
 | 145 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 146 | int tipc_link_is_up(struct link *l_ptr) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 147 | { | 
 | 148 | 	if (!l_ptr) | 
 | 149 | 		return 0; | 
| Eric Dumazet | a02cec2 | 2010-09-22 20:43:57 +0000 | [diff] [blame] | 150 | 	return link_working_working(l_ptr) || link_working_unknown(l_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 151 | } | 
 | 152 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 153 | int tipc_link_is_active(struct link *l_ptr) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 154 | { | 
| Eric Dumazet | a02cec2 | 2010-09-22 20:43:57 +0000 | [diff] [blame] | 155 | 	return	(l_ptr->owner->active_links[0] == l_ptr) || | 
 | 156 | 		(l_ptr->owner->active_links[1] == l_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 157 | } | 
 | 158 |  | 
 | 159 | /** | 
 | 160 |  * link_name_validate - validate & (optionally) deconstruct link name | 
 | 161 |  * @name - ptr to link name string | 
 | 162 |  * @name_parts - ptr to area for link name components (or NULL if not needed) | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 163 |  * | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 164 |  * Returns 1 if link name is valid, otherwise 0. | 
 | 165 |  */ | 
 | 166 |  | 
 | 167 | static int link_name_validate(const char *name, struct link_name *name_parts) | 
 | 168 | { | 
 | 169 | 	char name_copy[TIPC_MAX_LINK_NAME]; | 
 | 170 | 	char *addr_local; | 
 | 171 | 	char *if_local; | 
 | 172 | 	char *addr_peer; | 
 | 173 | 	char *if_peer; | 
 | 174 | 	char dummy; | 
 | 175 | 	u32 z_local, c_local, n_local; | 
 | 176 | 	u32 z_peer, c_peer, n_peer; | 
 | 177 | 	u32 if_local_len; | 
 | 178 | 	u32 if_peer_len; | 
 | 179 |  | 
 | 180 | 	/* copy link name & ensure length is OK */ | 
 | 181 |  | 
 | 182 | 	name_copy[TIPC_MAX_LINK_NAME - 1] = 0; | 
 | 183 | 	/* need above in case non-Posix strncpy() doesn't pad with nulls */ | 
 | 184 | 	strncpy(name_copy, name, TIPC_MAX_LINK_NAME); | 
 | 185 | 	if (name_copy[TIPC_MAX_LINK_NAME - 1] != 0) | 
 | 186 | 		return 0; | 
 | 187 |  | 
 | 188 | 	/* ensure all component parts of link name are present */ | 
 | 189 |  | 
 | 190 | 	addr_local = name_copy; | 
| Allan Stephens | 2db9983 | 2010-12-31 18:59:33 +0000 | [diff] [blame] | 191 | 	if_local = strchr(addr_local, ':'); | 
 | 192 | 	if (if_local == NULL) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 193 | 		return 0; | 
 | 194 | 	*(if_local++) = 0; | 
| Allan Stephens | 2db9983 | 2010-12-31 18:59:33 +0000 | [diff] [blame] | 195 | 	addr_peer = strchr(if_local, '-'); | 
 | 196 | 	if (addr_peer == NULL) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 197 | 		return 0; | 
 | 198 | 	*(addr_peer++) = 0; | 
 | 199 | 	if_local_len = addr_peer - if_local; | 
| Allan Stephens | 2db9983 | 2010-12-31 18:59:33 +0000 | [diff] [blame] | 200 | 	if_peer = strchr(addr_peer, ':'); | 
 | 201 | 	if (if_peer == NULL) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 202 | 		return 0; | 
 | 203 | 	*(if_peer++) = 0; | 
 | 204 | 	if_peer_len = strlen(if_peer) + 1; | 
 | 205 |  | 
 | 206 | 	/* validate component parts of link name */ | 
 | 207 |  | 
 | 208 | 	if ((sscanf(addr_local, "%u.%u.%u%c", | 
 | 209 | 		    &z_local, &c_local, &n_local, &dummy) != 3) || | 
 | 210 | 	    (sscanf(addr_peer, "%u.%u.%u%c", | 
 | 211 | 		    &z_peer, &c_peer, &n_peer, &dummy) != 3) || | 
 | 212 | 	    (z_local > 255) || (c_local > 4095) || (n_local > 4095) || | 
 | 213 | 	    (z_peer  > 255) || (c_peer  > 4095) || (n_peer  > 4095) || | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 214 | 	    (if_local_len <= 1) || (if_local_len > TIPC_MAX_IF_NAME) || | 
 | 215 | 	    (if_peer_len  <= 1) || (if_peer_len  > TIPC_MAX_IF_NAME) || | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 216 | 	    (strspn(if_local, tipc_alphabet) != (if_local_len - 1)) || | 
 | 217 | 	    (strspn(if_peer, tipc_alphabet) != (if_peer_len - 1))) | 
 | 218 | 		return 0; | 
 | 219 |  | 
 | 220 | 	/* return link name components, if necessary */ | 
 | 221 |  | 
 | 222 | 	if (name_parts) { | 
 | 223 | 		name_parts->addr_local = tipc_addr(z_local, c_local, n_local); | 
 | 224 | 		strcpy(name_parts->if_local, if_local); | 
 | 225 | 		name_parts->addr_peer = tipc_addr(z_peer, c_peer, n_peer); | 
 | 226 | 		strcpy(name_parts->if_peer, if_peer); | 
 | 227 | 	} | 
 | 228 | 	return 1; | 
 | 229 | } | 
 | 230 |  | 
 | 231 | /** | 
 | 232 |  * link_timeout - handle expiration of link timer | 
 | 233 |  * @l_ptr: pointer to link | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 234 |  * | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 235 |  * This routine must not grab "tipc_net_lock" to avoid a potential deadlock conflict | 
 | 236 |  * with tipc_link_delete().  (There is no risk that the node will be deleted by | 
 | 237 |  * another thread because tipc_link_delete() always cancels the link timer before | 
 | 238 |  * tipc_node_delete() is called.) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 239 |  */ | 
 | 240 |  | 
 | 241 | static void link_timeout(struct link *l_ptr) | 
 | 242 | { | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 243 | 	tipc_node_lock(l_ptr->owner); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 244 |  | 
 | 245 | 	/* update counters used in statistical profiling of send traffic */ | 
 | 246 |  | 
 | 247 | 	l_ptr->stats.accu_queue_sz += l_ptr->out_queue_size; | 
 | 248 | 	l_ptr->stats.queue_sz_counts++; | 
 | 249 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 250 | 	if (l_ptr->first_out) { | 
 | 251 | 		struct tipc_msg *msg = buf_msg(l_ptr->first_out); | 
 | 252 | 		u32 length = msg_size(msg); | 
 | 253 |  | 
| Joe Perches | f64f9e7 | 2009-11-29 16:55:45 -0800 | [diff] [blame] | 254 | 		if ((msg_user(msg) == MSG_FRAGMENTER) && | 
 | 255 | 		    (msg_type(msg) == FIRST_FRAGMENT)) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 256 | 			length = msg_size(msg_get_wrapped(msg)); | 
 | 257 | 		} | 
 | 258 | 		if (length) { | 
 | 259 | 			l_ptr->stats.msg_lengths_total += length; | 
 | 260 | 			l_ptr->stats.msg_length_counts++; | 
 | 261 | 			if (length <= 64) | 
 | 262 | 				l_ptr->stats.msg_length_profile[0]++; | 
 | 263 | 			else if (length <= 256) | 
 | 264 | 				l_ptr->stats.msg_length_profile[1]++; | 
 | 265 | 			else if (length <= 1024) | 
 | 266 | 				l_ptr->stats.msg_length_profile[2]++; | 
 | 267 | 			else if (length <= 4096) | 
 | 268 | 				l_ptr->stats.msg_length_profile[3]++; | 
 | 269 | 			else if (length <= 16384) | 
 | 270 | 				l_ptr->stats.msg_length_profile[4]++; | 
 | 271 | 			else if (length <= 32768) | 
 | 272 | 				l_ptr->stats.msg_length_profile[5]++; | 
 | 273 | 			else | 
 | 274 | 				l_ptr->stats.msg_length_profile[6]++; | 
 | 275 | 		} | 
 | 276 | 	} | 
 | 277 |  | 
 | 278 | 	/* do all other link processing performed on a periodic basis */ | 
 | 279 |  | 
 | 280 | 	link_check_defragm_bufs(l_ptr); | 
 | 281 |  | 
 | 282 | 	link_state_event(l_ptr, TIMEOUT_EVT); | 
 | 283 |  | 
 | 284 | 	if (l_ptr->next_out) | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 285 | 		tipc_link_push_queue(l_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 286 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 287 | 	tipc_node_unlock(l_ptr->owner); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 288 | } | 
 | 289 |  | 
| Sam Ravnborg | 05790c6 | 2006-03-20 22:37:04 -0800 | [diff] [blame] | 290 | static void link_set_timer(struct link *l_ptr, u32 time) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 291 | { | 
 | 292 | 	k_start_timer(&l_ptr->timer, time); | 
 | 293 | } | 
 | 294 |  | 
 | 295 | /** | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 296 |  * tipc_link_create - create a new link | 
| Allan Stephens | 37b9c08 | 2011-02-28 11:32:27 -0500 | [diff] [blame] | 297 |  * @n_ptr: pointer to associated node | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 298 |  * @b_ptr: pointer to associated bearer | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 299 |  * @media_addr: media address to use when sending messages over link | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 300 |  * | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 301 |  * Returns pointer to link. | 
 | 302 |  */ | 
 | 303 |  | 
| Allan Stephens | 37b9c08 | 2011-02-28 11:32:27 -0500 | [diff] [blame] | 304 | struct link *tipc_link_create(struct tipc_node *n_ptr, | 
 | 305 | 			      struct tipc_bearer *b_ptr, | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 306 | 			      const struct tipc_media_addr *media_addr) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 307 | { | 
 | 308 | 	struct link *l_ptr; | 
 | 309 | 	struct tipc_msg *msg; | 
 | 310 | 	char *if_name; | 
| Allan Stephens | 37b9c08 | 2011-02-28 11:32:27 -0500 | [diff] [blame] | 311 | 	char addr_string[16]; | 
 | 312 | 	u32 peer = n_ptr->addr; | 
 | 313 |  | 
 | 314 | 	if (n_ptr->link_cnt >= 2) { | 
 | 315 | 		tipc_addr_string_fill(addr_string, n_ptr->addr); | 
 | 316 | 		err("Attempt to establish third link to %s\n", addr_string); | 
 | 317 | 		return NULL; | 
 | 318 | 	} | 
 | 319 |  | 
 | 320 | 	if (n_ptr->links[b_ptr->identity]) { | 
 | 321 | 		tipc_addr_string_fill(addr_string, n_ptr->addr); | 
 | 322 | 		err("Attempt to establish second link on <%s> to %s\n", | 
 | 323 | 		    b_ptr->name, addr_string); | 
 | 324 | 		return NULL; | 
 | 325 | 	} | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 326 |  | 
| Panagiotis Issaris | 0da974f | 2006-07-21 14:51:30 -0700 | [diff] [blame] | 327 | 	l_ptr = kzalloc(sizeof(*l_ptr), GFP_ATOMIC); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 328 | 	if (!l_ptr) { | 
| Allan Stephens | a10bd92 | 2006-06-25 23:52:17 -0700 | [diff] [blame] | 329 | 		warn("Link creation failed, no memory\n"); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 330 | 		return NULL; | 
 | 331 | 	} | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 332 |  | 
 | 333 | 	l_ptr->addr = peer; | 
| Allan Stephens | 2d627b9 | 2011-01-07 13:00:11 -0500 | [diff] [blame] | 334 | 	if_name = strchr(b_ptr->name, ':') + 1; | 
| Allan Stephens | 062b4c9 | 2011-04-07 09:28:47 -0400 | [diff] [blame] | 335 | 	sprintf(l_ptr->name, "%u.%u.%u:%s-%u.%u.%u:unknown", | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 336 | 		tipc_zone(tipc_own_addr), tipc_cluster(tipc_own_addr), | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 337 | 		tipc_node(tipc_own_addr), | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 338 | 		if_name, | 
 | 339 | 		tipc_zone(peer), tipc_cluster(peer), tipc_node(peer)); | 
| Allan Stephens | 062b4c9 | 2011-04-07 09:28:47 -0400 | [diff] [blame] | 340 | 		/* note: peer i/f name is updated by reset/activate message */ | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 341 | 	memcpy(&l_ptr->media_addr, media_addr, sizeof(*media_addr)); | 
| Allan Stephens | 37b9c08 | 2011-02-28 11:32:27 -0500 | [diff] [blame] | 342 | 	l_ptr->owner = n_ptr; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 343 | 	l_ptr->checkpoint = 1; | 
| Allan Stephens | f882cb7 | 2011-04-07 09:43:27 -0400 | [diff] [blame] | 344 | 	l_ptr->peer_session = INVALID_SESSION; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 345 | 	l_ptr->b_ptr = b_ptr; | 
 | 346 | 	link_set_supervision_props(l_ptr, b_ptr->media->tolerance); | 
 | 347 | 	l_ptr->state = RESET_UNKNOWN; | 
 | 348 |  | 
 | 349 | 	l_ptr->pmsg = (struct tipc_msg *)&l_ptr->proto_msg; | 
 | 350 | 	msg = l_ptr->pmsg; | 
| Allan Stephens | c68ca7b | 2010-05-11 14:30:12 +0000 | [diff] [blame] | 351 | 	tipc_msg_init(msg, LINK_PROTOCOL, RESET_MSG, INT_H_SIZE, l_ptr->addr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 352 | 	msg_set_size(msg, sizeof(l_ptr->proto_msg)); | 
| Allan Stephens | a686e68 | 2008-06-04 17:29:39 -0700 | [diff] [blame] | 353 | 	msg_set_session(msg, (tipc_random & 0xffff)); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 354 | 	msg_set_bearer_id(msg, b_ptr->identity); | 
 | 355 | 	strcpy((char *)msg_data(msg), if_name); | 
 | 356 |  | 
 | 357 | 	l_ptr->priority = b_ptr->priority; | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 358 | 	tipc_link_set_queue_limits(l_ptr, b_ptr->media->window); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 359 |  | 
 | 360 | 	link_init_max_pkt(l_ptr); | 
 | 361 |  | 
 | 362 | 	l_ptr->next_out_no = 1; | 
 | 363 | 	INIT_LIST_HEAD(&l_ptr->waiting_ports); | 
 | 364 |  | 
 | 365 | 	link_reset_statistics(l_ptr); | 
 | 366 |  | 
| Allan Stephens | 37b9c08 | 2011-02-28 11:32:27 -0500 | [diff] [blame] | 367 | 	tipc_node_attach_link(n_ptr, l_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 368 |  | 
| Florian Westphal | 94571065 | 2007-07-26 00:05:07 -0700 | [diff] [blame] | 369 | 	k_init_timer(&l_ptr->timer, (Handler)link_timeout, (unsigned long)l_ptr); | 
 | 370 | 	list_add_tail(&l_ptr->link_list, &b_ptr->links); | 
| stephen hemminger | 31e3c3f | 2010-10-13 13:20:35 +0000 | [diff] [blame] | 371 | 	tipc_k_signal((Handler)link_start, (unsigned long)l_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 372 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 373 | 	return l_ptr; | 
 | 374 | } | 
 | 375 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 376 | /** | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 377 |  * tipc_link_delete - delete a link | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 378 |  * @l_ptr: pointer to link | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 379 |  * | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 380 |  * Note: 'tipc_net_lock' is write_locked, bearer is locked. | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 381 |  * This routine must not grab the node lock until after link timer cancellation | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 382 |  * to avoid a potential deadlock situation. | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 383 |  */ | 
 | 384 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 385 | void tipc_link_delete(struct link *l_ptr) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 386 | { | 
 | 387 | 	if (!l_ptr) { | 
 | 388 | 		err("Attempt to delete non-existent link\n"); | 
 | 389 | 		return; | 
 | 390 | 	} | 
 | 391 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 392 | 	k_cancel_timer(&l_ptr->timer); | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 393 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 394 | 	tipc_node_lock(l_ptr->owner); | 
 | 395 | 	tipc_link_reset(l_ptr); | 
 | 396 | 	tipc_node_detach_link(l_ptr->owner, l_ptr); | 
 | 397 | 	tipc_link_stop(l_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 398 | 	list_del_init(&l_ptr->link_list); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 399 | 	tipc_node_unlock(l_ptr->owner); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 400 | 	k_term_timer(&l_ptr->timer); | 
 | 401 | 	kfree(l_ptr); | 
 | 402 | } | 
 | 403 |  | 
| stephen hemminger | 31e3c3f | 2010-10-13 13:20:35 +0000 | [diff] [blame] | 404 | static void link_start(struct link *l_ptr) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 405 | { | 
| Allan Stephens | 214dda4 | 2011-01-24 16:22:43 -0500 | [diff] [blame] | 406 | 	tipc_node_lock(l_ptr->owner); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 407 | 	link_state_event(l_ptr, STARTING_EVT); | 
| Allan Stephens | 214dda4 | 2011-01-24 16:22:43 -0500 | [diff] [blame] | 408 | 	tipc_node_unlock(l_ptr->owner); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 409 | } | 
 | 410 |  | 
 | 411 | /** | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 412 |  * link_schedule_port - schedule port for deferred sending | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 413 |  * @l_ptr: pointer to link | 
 | 414 |  * @origport: reference to sending port | 
 | 415 |  * @sz: amount of data to be sent | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 416 |  * | 
 | 417 |  * Schedules port for renewed sending of messages after link congestion | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 418 |  * has abated. | 
 | 419 |  */ | 
 | 420 |  | 
 | 421 | static int link_schedule_port(struct link *l_ptr, u32 origport, u32 sz) | 
 | 422 | { | 
| Allan Stephens | 23dd4cc | 2011-01-07 11:43:40 -0500 | [diff] [blame] | 423 | 	struct tipc_port *p_ptr; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 424 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 425 | 	spin_lock_bh(&tipc_port_list_lock); | 
 | 426 | 	p_ptr = tipc_port_lock(origport); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 427 | 	if (p_ptr) { | 
 | 428 | 		if (!p_ptr->wakeup) | 
 | 429 | 			goto exit; | 
 | 430 | 		if (!list_empty(&p_ptr->wait_list)) | 
 | 431 | 			goto exit; | 
| Allan Stephens | 23dd4cc | 2011-01-07 11:43:40 -0500 | [diff] [blame] | 432 | 		p_ptr->congested = 1; | 
| Allan Stephens | 15e979d | 2010-05-11 14:30:10 +0000 | [diff] [blame] | 433 | 		p_ptr->waiting_pkts = 1 + ((sz - 1) / l_ptr->max_pkt); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 434 | 		list_add_tail(&p_ptr->wait_list, &l_ptr->waiting_ports); | 
 | 435 | 		l_ptr->stats.link_congs++; | 
 | 436 | exit: | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 437 | 		tipc_port_unlock(p_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 438 | 	} | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 439 | 	spin_unlock_bh(&tipc_port_list_lock); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 440 | 	return -ELINKCONG; | 
 | 441 | } | 
 | 442 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 443 | void tipc_link_wakeup_ports(struct link *l_ptr, int all) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 444 | { | 
| Allan Stephens | 23dd4cc | 2011-01-07 11:43:40 -0500 | [diff] [blame] | 445 | 	struct tipc_port *p_ptr; | 
 | 446 | 	struct tipc_port *temp_p_ptr; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 447 | 	int win = l_ptr->queue_limit[0] - l_ptr->out_queue_size; | 
 | 448 |  | 
 | 449 | 	if (all) | 
 | 450 | 		win = 100000; | 
 | 451 | 	if (win <= 0) | 
 | 452 | 		return; | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 453 | 	if (!spin_trylock_bh(&tipc_port_list_lock)) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 454 | 		return; | 
 | 455 | 	if (link_congested(l_ptr)) | 
 | 456 | 		goto exit; | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 457 | 	list_for_each_entry_safe(p_ptr, temp_p_ptr, &l_ptr->waiting_ports, | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 458 | 				 wait_list) { | 
 | 459 | 		if (win <= 0) | 
 | 460 | 			break; | 
 | 461 | 		list_del_init(&p_ptr->wait_list); | 
| Allan Stephens | 23dd4cc | 2011-01-07 11:43:40 -0500 | [diff] [blame] | 462 | 		spin_lock_bh(p_ptr->lock); | 
 | 463 | 		p_ptr->congested = 0; | 
 | 464 | 		p_ptr->wakeup(p_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 465 | 		win -= p_ptr->waiting_pkts; | 
| Allan Stephens | 23dd4cc | 2011-01-07 11:43:40 -0500 | [diff] [blame] | 466 | 		spin_unlock_bh(p_ptr->lock); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 467 | 	} | 
 | 468 |  | 
 | 469 | exit: | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 470 | 	spin_unlock_bh(&tipc_port_list_lock); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 471 | } | 
 | 472 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 473 | /** | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 474 |  * link_release_outqueue - purge link's outbound message queue | 
 | 475 |  * @l_ptr: pointer to link | 
 | 476 |  */ | 
 | 477 |  | 
 | 478 | static void link_release_outqueue(struct link *l_ptr) | 
 | 479 | { | 
 | 480 | 	struct sk_buff *buf = l_ptr->first_out; | 
 | 481 | 	struct sk_buff *next; | 
 | 482 |  | 
 | 483 | 	while (buf) { | 
 | 484 | 		next = buf->next; | 
 | 485 | 		buf_discard(buf); | 
 | 486 | 		buf = next; | 
 | 487 | 	} | 
 | 488 | 	l_ptr->first_out = NULL; | 
 | 489 | 	l_ptr->out_queue_size = 0; | 
 | 490 | } | 
 | 491 |  | 
 | 492 | /** | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 493 |  * tipc_link_reset_fragments - purge link's inbound message fragments queue | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 494 |  * @l_ptr: pointer to link | 
 | 495 |  */ | 
 | 496 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 497 | void tipc_link_reset_fragments(struct link *l_ptr) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 498 | { | 
 | 499 | 	struct sk_buff *buf = l_ptr->defragm_buf; | 
 | 500 | 	struct sk_buff *next; | 
 | 501 |  | 
 | 502 | 	while (buf) { | 
 | 503 | 		next = buf->next; | 
 | 504 | 		buf_discard(buf); | 
 | 505 | 		buf = next; | 
 | 506 | 	} | 
 | 507 | 	l_ptr->defragm_buf = NULL; | 
 | 508 | } | 
 | 509 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 510 | /** | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 511 |  * tipc_link_stop - purge all inbound and outbound messages associated with link | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 512 |  * @l_ptr: pointer to link | 
 | 513 |  */ | 
 | 514 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 515 | void tipc_link_stop(struct link *l_ptr) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 516 | { | 
 | 517 | 	struct sk_buff *buf; | 
 | 518 | 	struct sk_buff *next; | 
 | 519 |  | 
 | 520 | 	buf = l_ptr->oldest_deferred_in; | 
 | 521 | 	while (buf) { | 
 | 522 | 		next = buf->next; | 
 | 523 | 		buf_discard(buf); | 
 | 524 | 		buf = next; | 
 | 525 | 	} | 
 | 526 |  | 
 | 527 | 	buf = l_ptr->first_out; | 
 | 528 | 	while (buf) { | 
 | 529 | 		next = buf->next; | 
 | 530 | 		buf_discard(buf); | 
 | 531 | 		buf = next; | 
 | 532 | 	} | 
 | 533 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 534 | 	tipc_link_reset_fragments(l_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 535 |  | 
 | 536 | 	buf_discard(l_ptr->proto_msg_queue); | 
 | 537 | 	l_ptr->proto_msg_queue = NULL; | 
 | 538 | } | 
 | 539 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 540 | void tipc_link_reset(struct link *l_ptr) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 541 | { | 
 | 542 | 	struct sk_buff *buf; | 
 | 543 | 	u32 prev_state = l_ptr->state; | 
 | 544 | 	u32 checkpoint = l_ptr->next_in_no; | 
| Allan Stephens | 5392d64 | 2006-06-25 23:52:50 -0700 | [diff] [blame] | 545 | 	int was_active_link = tipc_link_is_active(l_ptr); | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 546 |  | 
| Allan Stephens | a686e68 | 2008-06-04 17:29:39 -0700 | [diff] [blame] | 547 | 	msg_set_session(l_ptr->pmsg, ((msg_session(l_ptr->pmsg) + 1) & 0xffff)); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 548 |  | 
| Allan Stephens | a686e68 | 2008-06-04 17:29:39 -0700 | [diff] [blame] | 549 | 	/* Link is down, accept any session */ | 
 | 550 | 	l_ptr->peer_session = INVALID_SESSION; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 551 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 552 | 	/* Prepare for max packet size negotiation */ | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 553 | 	link_init_max_pkt(l_ptr); | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 554 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 555 | 	l_ptr->state = RESET_UNKNOWN; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 556 |  | 
 | 557 | 	if ((prev_state == RESET_UNKNOWN) || (prev_state == RESET_RESET)) | 
 | 558 | 		return; | 
 | 559 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 560 | 	tipc_node_link_down(l_ptr->owner, l_ptr); | 
 | 561 | 	tipc_bearer_remove_dest(l_ptr->b_ptr, l_ptr->addr); | 
| Paul Gortmaker | 7368ddf | 2010-10-12 14:25:58 +0000 | [diff] [blame] | 562 |  | 
| Paul Gortmaker | 8f19afb | 2011-02-28 11:36:21 -0400 | [diff] [blame] | 563 | 	if (was_active_link && tipc_node_active_links(l_ptr->owner) && | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 564 | 	    l_ptr->owner->permit_changeover) { | 
 | 565 | 		l_ptr->reset_checkpoint = checkpoint; | 
 | 566 | 		l_ptr->exp_msg_count = START_CHANGEOVER; | 
 | 567 | 	} | 
 | 568 |  | 
 | 569 | 	/* Clean up all queues: */ | 
 | 570 |  | 
 | 571 | 	link_release_outqueue(l_ptr); | 
 | 572 | 	buf_discard(l_ptr->proto_msg_queue); | 
 | 573 | 	l_ptr->proto_msg_queue = NULL; | 
 | 574 | 	buf = l_ptr->oldest_deferred_in; | 
 | 575 | 	while (buf) { | 
 | 576 | 		struct sk_buff *next = buf->next; | 
 | 577 | 		buf_discard(buf); | 
 | 578 | 		buf = next; | 
 | 579 | 	} | 
 | 580 | 	if (!list_empty(&l_ptr->waiting_ports)) | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 581 | 		tipc_link_wakeup_ports(l_ptr, 1); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 582 |  | 
 | 583 | 	l_ptr->retransm_queue_head = 0; | 
 | 584 | 	l_ptr->retransm_queue_size = 0; | 
 | 585 | 	l_ptr->last_out = NULL; | 
 | 586 | 	l_ptr->first_out = NULL; | 
 | 587 | 	l_ptr->next_out = NULL; | 
 | 588 | 	l_ptr->unacked_window = 0; | 
 | 589 | 	l_ptr->checkpoint = 1; | 
 | 590 | 	l_ptr->next_out_no = 1; | 
 | 591 | 	l_ptr->deferred_inqueue_sz = 0; | 
 | 592 | 	l_ptr->oldest_deferred_in = NULL; | 
 | 593 | 	l_ptr->newest_deferred_in = NULL; | 
 | 594 | 	l_ptr->fsm_msg_cnt = 0; | 
 | 595 | 	l_ptr->stale_count = 0; | 
 | 596 | 	link_reset_statistics(l_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 597 | } | 
 | 598 |  | 
 | 599 |  | 
 | 600 | static void link_activate(struct link *l_ptr) | 
 | 601 | { | 
| Allan Stephens | 5392d64 | 2006-06-25 23:52:50 -0700 | [diff] [blame] | 602 | 	l_ptr->next_in_no = l_ptr->stats.recv_info = 1; | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 603 | 	tipc_node_link_up(l_ptr->owner, l_ptr); | 
 | 604 | 	tipc_bearer_add_dest(l_ptr->b_ptr, l_ptr->addr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 605 | } | 
 | 606 |  | 
 | 607 | /** | 
 | 608 |  * link_state_event - link finite state machine | 
 | 609 |  * @l_ptr: pointer to link | 
 | 610 |  * @event: state machine event to process | 
 | 611 |  */ | 
 | 612 |  | 
 | 613 | static void link_state_event(struct link *l_ptr, unsigned event) | 
 | 614 | { | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 615 | 	struct link *other; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 616 | 	u32 cont_intv = l_ptr->continuity_interval; | 
 | 617 |  | 
 | 618 | 	if (!l_ptr->started && (event != STARTING_EVT)) | 
 | 619 | 		return;		/* Not yet. */ | 
 | 620 |  | 
 | 621 | 	if (link_blocked(l_ptr)) { | 
| Allan Stephens | a016892 | 2010-12-31 18:59:35 +0000 | [diff] [blame] | 622 | 		if (event == TIMEOUT_EVT) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 623 | 			link_set_timer(l_ptr, cont_intv); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 624 | 		return;	  /* Changeover going on */ | 
 | 625 | 	} | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 626 |  | 
 | 627 | 	switch (l_ptr->state) { | 
 | 628 | 	case WORKING_WORKING: | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 629 | 		switch (event) { | 
 | 630 | 		case TRAFFIC_MSG_EVT: | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 631 | 		case ACTIVATE_MSG: | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 632 | 			break; | 
 | 633 | 		case TIMEOUT_EVT: | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 634 | 			if (l_ptr->next_in_no != l_ptr->checkpoint) { | 
 | 635 | 				l_ptr->checkpoint = l_ptr->next_in_no; | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 636 | 				if (tipc_bclink_acks_missing(l_ptr->owner)) { | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 637 | 					tipc_link_send_proto_msg(l_ptr, STATE_MSG, | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 638 | 								 0, 0, 0, 0, 0); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 639 | 					l_ptr->fsm_msg_cnt++; | 
 | 640 | 				} else if (l_ptr->max_pkt < l_ptr->max_pkt_target) { | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 641 | 					tipc_link_send_proto_msg(l_ptr, STATE_MSG, | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 642 | 								 1, 0, 0, 0, 0); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 643 | 					l_ptr->fsm_msg_cnt++; | 
 | 644 | 				} | 
 | 645 | 				link_set_timer(l_ptr, cont_intv); | 
 | 646 | 				break; | 
 | 647 | 			} | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 648 | 			l_ptr->state = WORKING_UNKNOWN; | 
 | 649 | 			l_ptr->fsm_msg_cnt = 0; | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 650 | 			tipc_link_send_proto_msg(l_ptr, STATE_MSG, 1, 0, 0, 0, 0); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 651 | 			l_ptr->fsm_msg_cnt++; | 
 | 652 | 			link_set_timer(l_ptr, cont_intv / 4); | 
 | 653 | 			break; | 
 | 654 | 		case RESET_MSG: | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 655 | 			info("Resetting link <%s>, requested by peer\n", | 
| Allan Stephens | a10bd92 | 2006-06-25 23:52:17 -0700 | [diff] [blame] | 656 | 			     l_ptr->name); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 657 | 			tipc_link_reset(l_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 658 | 			l_ptr->state = RESET_RESET; | 
 | 659 | 			l_ptr->fsm_msg_cnt = 0; | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 660 | 			tipc_link_send_proto_msg(l_ptr, ACTIVATE_MSG, 0, 0, 0, 0, 0); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 661 | 			l_ptr->fsm_msg_cnt++; | 
 | 662 | 			link_set_timer(l_ptr, cont_intv); | 
 | 663 | 			break; | 
 | 664 | 		default: | 
 | 665 | 			err("Unknown link event %u in WW state\n", event); | 
 | 666 | 		} | 
 | 667 | 		break; | 
 | 668 | 	case WORKING_UNKNOWN: | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 669 | 		switch (event) { | 
 | 670 | 		case TRAFFIC_MSG_EVT: | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 671 | 		case ACTIVATE_MSG: | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 672 | 			l_ptr->state = WORKING_WORKING; | 
 | 673 | 			l_ptr->fsm_msg_cnt = 0; | 
 | 674 | 			link_set_timer(l_ptr, cont_intv); | 
 | 675 | 			break; | 
 | 676 | 		case RESET_MSG: | 
| Allan Stephens | a10bd92 | 2006-06-25 23:52:17 -0700 | [diff] [blame] | 677 | 			info("Resetting link <%s>, requested by peer " | 
 | 678 | 			     "while probing\n", l_ptr->name); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 679 | 			tipc_link_reset(l_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 680 | 			l_ptr->state = RESET_RESET; | 
 | 681 | 			l_ptr->fsm_msg_cnt = 0; | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 682 | 			tipc_link_send_proto_msg(l_ptr, ACTIVATE_MSG, 0, 0, 0, 0, 0); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 683 | 			l_ptr->fsm_msg_cnt++; | 
 | 684 | 			link_set_timer(l_ptr, cont_intv); | 
 | 685 | 			break; | 
 | 686 | 		case TIMEOUT_EVT: | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 687 | 			if (l_ptr->next_in_no != l_ptr->checkpoint) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 688 | 				l_ptr->state = WORKING_WORKING; | 
 | 689 | 				l_ptr->fsm_msg_cnt = 0; | 
 | 690 | 				l_ptr->checkpoint = l_ptr->next_in_no; | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 691 | 				if (tipc_bclink_acks_missing(l_ptr->owner)) { | 
 | 692 | 					tipc_link_send_proto_msg(l_ptr, STATE_MSG, | 
 | 693 | 								 0, 0, 0, 0, 0); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 694 | 					l_ptr->fsm_msg_cnt++; | 
 | 695 | 				} | 
 | 696 | 				link_set_timer(l_ptr, cont_intv); | 
 | 697 | 			} else if (l_ptr->fsm_msg_cnt < l_ptr->abort_limit) { | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 698 | 				tipc_link_send_proto_msg(l_ptr, STATE_MSG, | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 699 | 							 1, 0, 0, 0, 0); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 700 | 				l_ptr->fsm_msg_cnt++; | 
 | 701 | 				link_set_timer(l_ptr, cont_intv / 4); | 
 | 702 | 			} else {	/* Link has failed */ | 
| Allan Stephens | a10bd92 | 2006-06-25 23:52:17 -0700 | [diff] [blame] | 703 | 				warn("Resetting link <%s>, peer not responding\n", | 
 | 704 | 				     l_ptr->name); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 705 | 				tipc_link_reset(l_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 706 | 				l_ptr->state = RESET_UNKNOWN; | 
 | 707 | 				l_ptr->fsm_msg_cnt = 0; | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 708 | 				tipc_link_send_proto_msg(l_ptr, RESET_MSG, | 
 | 709 | 							 0, 0, 0, 0, 0); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 710 | 				l_ptr->fsm_msg_cnt++; | 
 | 711 | 				link_set_timer(l_ptr, cont_intv); | 
 | 712 | 			} | 
 | 713 | 			break; | 
 | 714 | 		default: | 
 | 715 | 			err("Unknown link event %u in WU state\n", event); | 
 | 716 | 		} | 
 | 717 | 		break; | 
 | 718 | 	case RESET_UNKNOWN: | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 719 | 		switch (event) { | 
 | 720 | 		case TRAFFIC_MSG_EVT: | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 721 | 			break; | 
 | 722 | 		case ACTIVATE_MSG: | 
 | 723 | 			other = l_ptr->owner->active_links[0]; | 
| Allan Stephens | 8d64a5b | 2010-12-31 18:59:27 +0000 | [diff] [blame] | 724 | 			if (other && link_working_unknown(other)) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 725 | 				break; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 726 | 			l_ptr->state = WORKING_WORKING; | 
 | 727 | 			l_ptr->fsm_msg_cnt = 0; | 
 | 728 | 			link_activate(l_ptr); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 729 | 			tipc_link_send_proto_msg(l_ptr, STATE_MSG, 1, 0, 0, 0, 0); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 730 | 			l_ptr->fsm_msg_cnt++; | 
 | 731 | 			link_set_timer(l_ptr, cont_intv); | 
 | 732 | 			break; | 
 | 733 | 		case RESET_MSG: | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 734 | 			l_ptr->state = RESET_RESET; | 
 | 735 | 			l_ptr->fsm_msg_cnt = 0; | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 736 | 			tipc_link_send_proto_msg(l_ptr, ACTIVATE_MSG, 1, 0, 0, 0, 0); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 737 | 			l_ptr->fsm_msg_cnt++; | 
 | 738 | 			link_set_timer(l_ptr, cont_intv); | 
 | 739 | 			break; | 
 | 740 | 		case STARTING_EVT: | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 741 | 			l_ptr->started = 1; | 
 | 742 | 			/* fall through */ | 
 | 743 | 		case TIMEOUT_EVT: | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 744 | 			tipc_link_send_proto_msg(l_ptr, RESET_MSG, 0, 0, 0, 0, 0); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 745 | 			l_ptr->fsm_msg_cnt++; | 
 | 746 | 			link_set_timer(l_ptr, cont_intv); | 
 | 747 | 			break; | 
 | 748 | 		default: | 
 | 749 | 			err("Unknown link event %u in RU state\n", event); | 
 | 750 | 		} | 
 | 751 | 		break; | 
 | 752 | 	case RESET_RESET: | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 753 | 		switch (event) { | 
 | 754 | 		case TRAFFIC_MSG_EVT: | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 755 | 		case ACTIVATE_MSG: | 
 | 756 | 			other = l_ptr->owner->active_links[0]; | 
| Allan Stephens | 8d64a5b | 2010-12-31 18:59:27 +0000 | [diff] [blame] | 757 | 			if (other && link_working_unknown(other)) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 758 | 				break; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 759 | 			l_ptr->state = WORKING_WORKING; | 
 | 760 | 			l_ptr->fsm_msg_cnt = 0; | 
 | 761 | 			link_activate(l_ptr); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 762 | 			tipc_link_send_proto_msg(l_ptr, STATE_MSG, 1, 0, 0, 0, 0); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 763 | 			l_ptr->fsm_msg_cnt++; | 
 | 764 | 			link_set_timer(l_ptr, cont_intv); | 
 | 765 | 			break; | 
 | 766 | 		case RESET_MSG: | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 767 | 			break; | 
 | 768 | 		case TIMEOUT_EVT: | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 769 | 			tipc_link_send_proto_msg(l_ptr, ACTIVATE_MSG, 0, 0, 0, 0, 0); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 770 | 			l_ptr->fsm_msg_cnt++; | 
 | 771 | 			link_set_timer(l_ptr, cont_intv); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 772 | 			break; | 
 | 773 | 		default: | 
 | 774 | 			err("Unknown link event %u in RR state\n", event); | 
 | 775 | 		} | 
 | 776 | 		break; | 
 | 777 | 	default: | 
 | 778 | 		err("Unknown link state %u/%u\n", l_ptr->state, event); | 
 | 779 | 	} | 
 | 780 | } | 
 | 781 |  | 
 | 782 | /* | 
 | 783 |  * link_bundle_buf(): Append contents of a buffer to | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 784 |  * the tail of an existing one. | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 785 |  */ | 
 | 786 |  | 
 | 787 | static int link_bundle_buf(struct link *l_ptr, | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 788 | 			   struct sk_buff *bundler, | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 789 | 			   struct sk_buff *buf) | 
 | 790 | { | 
 | 791 | 	struct tipc_msg *bundler_msg = buf_msg(bundler); | 
 | 792 | 	struct tipc_msg *msg = buf_msg(buf); | 
 | 793 | 	u32 size = msg_size(msg); | 
| Allan Stephens | e49060c | 2006-06-29 12:32:46 -0700 | [diff] [blame] | 794 | 	u32 bundle_size = msg_size(bundler_msg); | 
 | 795 | 	u32 to_pos = align(bundle_size); | 
 | 796 | 	u32 pad = to_pos - bundle_size; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 797 |  | 
 | 798 | 	if (msg_user(bundler_msg) != MSG_BUNDLER) | 
 | 799 | 		return 0; | 
 | 800 | 	if (msg_type(bundler_msg) != OPEN_MSG) | 
 | 801 | 		return 0; | 
| Allan Stephens | e49060c | 2006-06-29 12:32:46 -0700 | [diff] [blame] | 802 | 	if (skb_tailroom(bundler) < (pad + size)) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 803 | 		return 0; | 
| Allan Stephens | 15e979d | 2010-05-11 14:30:10 +0000 | [diff] [blame] | 804 | 	if (l_ptr->max_pkt < (to_pos + size)) | 
| Allan Stephens | 863fae6 | 2006-07-03 19:39:36 -0700 | [diff] [blame] | 805 | 		return 0; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 806 |  | 
| Allan Stephens | e49060c | 2006-06-29 12:32:46 -0700 | [diff] [blame] | 807 | 	skb_put(bundler, pad + size); | 
| Arnaldo Carvalho de Melo | 27d7ff4 | 2007-03-31 11:55:19 -0300 | [diff] [blame] | 808 | 	skb_copy_to_linear_data_offset(bundler, to_pos, buf->data, size); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 809 | 	msg_set_size(bundler_msg, to_pos + size); | 
 | 810 | 	msg_set_msgcnt(bundler_msg, msg_msgcnt(bundler_msg) + 1); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 811 | 	buf_discard(buf); | 
 | 812 | 	l_ptr->stats.sent_bundled++; | 
 | 813 | 	return 1; | 
 | 814 | } | 
 | 815 |  | 
| Sam Ravnborg | 05790c6 | 2006-03-20 22:37:04 -0800 | [diff] [blame] | 816 | static void link_add_to_outqueue(struct link *l_ptr, | 
 | 817 | 				 struct sk_buff *buf, | 
 | 818 | 				 struct tipc_msg *msg) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 819 | { | 
 | 820 | 	u32 ack = mod(l_ptr->next_in_no - 1); | 
 | 821 | 	u32 seqno = mod(l_ptr->next_out_no++); | 
 | 822 |  | 
 | 823 | 	msg_set_word(msg, 2, ((ack << 16) | seqno)); | 
 | 824 | 	msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in); | 
 | 825 | 	buf->next = NULL; | 
 | 826 | 	if (l_ptr->first_out) { | 
 | 827 | 		l_ptr->last_out->next = buf; | 
 | 828 | 		l_ptr->last_out = buf; | 
 | 829 | 	} else | 
 | 830 | 		l_ptr->first_out = l_ptr->last_out = buf; | 
| Allan Stephens | 9bd80b6 | 2011-01-18 15:02:50 -0500 | [diff] [blame] | 831 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 832 | 	l_ptr->out_queue_size++; | 
| Allan Stephens | 9bd80b6 | 2011-01-18 15:02:50 -0500 | [diff] [blame] | 833 | 	if (l_ptr->out_queue_size > l_ptr->stats.max_queue_sz) | 
 | 834 | 		l_ptr->stats.max_queue_sz = l_ptr->out_queue_size; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 835 | } | 
 | 836 |  | 
| Allan Stephens | dc63d91 | 2011-04-21 11:50:42 -0400 | [diff] [blame] | 837 | static void link_add_chain_to_outqueue(struct link *l_ptr, | 
 | 838 | 				       struct sk_buff *buf_chain, | 
 | 839 | 				       u32 long_msgno) | 
 | 840 | { | 
 | 841 | 	struct sk_buff *buf; | 
 | 842 | 	struct tipc_msg *msg; | 
 | 843 |  | 
 | 844 | 	if (!l_ptr->next_out) | 
 | 845 | 		l_ptr->next_out = buf_chain; | 
 | 846 | 	while (buf_chain) { | 
 | 847 | 		buf = buf_chain; | 
 | 848 | 		buf_chain = buf_chain->next; | 
 | 849 |  | 
 | 850 | 		msg = buf_msg(buf); | 
 | 851 | 		msg_set_long_msgno(msg, long_msgno); | 
 | 852 | 		link_add_to_outqueue(l_ptr, buf, msg); | 
 | 853 | 	} | 
 | 854 | } | 
 | 855 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 856 | /* | 
 | 857 |  * tipc_link_send_buf() is the 'full path' for messages, called from | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 858 |  * inside TIPC when the 'fast path' in tipc_send_buf | 
 | 859 |  * has failed, and from link_send() | 
 | 860 |  */ | 
 | 861 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 862 | int tipc_link_send_buf(struct link *l_ptr, struct sk_buff *buf) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 863 | { | 
 | 864 | 	struct tipc_msg *msg = buf_msg(buf); | 
 | 865 | 	u32 size = msg_size(msg); | 
 | 866 | 	u32 dsz = msg_data_sz(msg); | 
 | 867 | 	u32 queue_size = l_ptr->out_queue_size; | 
| Allan Stephens | c68ca7b | 2010-05-11 14:30:12 +0000 | [diff] [blame] | 868 | 	u32 imp = tipc_msg_tot_importance(msg); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 869 | 	u32 queue_limit = l_ptr->queue_limit[imp]; | 
| Allan Stephens | 15e979d | 2010-05-11 14:30:10 +0000 | [diff] [blame] | 870 | 	u32 max_packet = l_ptr->max_pkt; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 871 |  | 
 | 872 | 	msg_set_prevnode(msg, tipc_own_addr);	/* If routed message */ | 
 | 873 |  | 
 | 874 | 	/* Match msg importance against queue limits: */ | 
 | 875 |  | 
 | 876 | 	if (unlikely(queue_size >= queue_limit)) { | 
 | 877 | 		if (imp <= TIPC_CRITICAL_IMPORTANCE) { | 
| Allan Stephens | bebc55a | 2011-04-19 10:17:58 -0400 | [diff] [blame] | 878 | 			link_schedule_port(l_ptr, msg_origport(msg), size); | 
 | 879 | 			buf_discard(buf); | 
 | 880 | 			return -ELINKCONG; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 881 | 		} | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 882 | 		buf_discard(buf); | 
 | 883 | 		if (imp > CONN_MANAGER) { | 
| Allan Stephens | a10bd92 | 2006-06-25 23:52:17 -0700 | [diff] [blame] | 884 | 			warn("Resetting link <%s>, send queue full", l_ptr->name); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 885 | 			tipc_link_reset(l_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 886 | 		} | 
 | 887 | 		return dsz; | 
 | 888 | 	} | 
 | 889 |  | 
 | 890 | 	/* Fragmentation needed ? */ | 
 | 891 |  | 
 | 892 | 	if (size > max_packet) | 
| stephen hemminger | 31e3c3f | 2010-10-13 13:20:35 +0000 | [diff] [blame] | 893 | 		return link_send_long_buf(l_ptr, buf); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 894 |  | 
 | 895 | 	/* Packet can be queued or sent: */ | 
 | 896 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 897 | 	if (likely(!tipc_bearer_congested(l_ptr->b_ptr, l_ptr) && | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 898 | 		   !link_congested(l_ptr))) { | 
 | 899 | 		link_add_to_outqueue(l_ptr, buf, msg); | 
 | 900 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 901 | 		if (likely(tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr))) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 902 | 			l_ptr->unacked_window = 0; | 
 | 903 | 		} else { | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 904 | 			tipc_bearer_schedule(l_ptr->b_ptr, l_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 905 | 			l_ptr->stats.bearer_congs++; | 
 | 906 | 			l_ptr->next_out = buf; | 
 | 907 | 		} | 
 | 908 | 		return dsz; | 
 | 909 | 	} | 
 | 910 | 	/* Congestion: can message be bundled ?: */ | 
 | 911 |  | 
 | 912 | 	if ((msg_user(msg) != CHANGEOVER_PROTOCOL) && | 
 | 913 | 	    (msg_user(msg) != MSG_FRAGMENTER)) { | 
 | 914 |  | 
 | 915 | 		/* Try adding message to an existing bundle */ | 
 | 916 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 917 | 		if (l_ptr->next_out && | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 918 | 		    link_bundle_buf(l_ptr, l_ptr->last_out, buf)) { | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 919 | 			tipc_bearer_resolve_congestion(l_ptr->b_ptr, l_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 920 | 			return dsz; | 
 | 921 | 		} | 
 | 922 |  | 
 | 923 | 		/* Try creating a new bundle */ | 
 | 924 |  | 
 | 925 | 		if (size <= max_packet * 2 / 3) { | 
| stephen hemminger | 31e3c3f | 2010-10-13 13:20:35 +0000 | [diff] [blame] | 926 | 			struct sk_buff *bundler = tipc_buf_acquire(max_packet); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 927 | 			struct tipc_msg bundler_hdr; | 
 | 928 |  | 
 | 929 | 			if (bundler) { | 
| Allan Stephens | c68ca7b | 2010-05-11 14:30:12 +0000 | [diff] [blame] | 930 | 				tipc_msg_init(&bundler_hdr, MSG_BUNDLER, OPEN_MSG, | 
| Allan Stephens | 7571521 | 2008-06-04 17:37:34 -0700 | [diff] [blame] | 931 | 					 INT_H_SIZE, l_ptr->addr); | 
| Arnaldo Carvalho de Melo | 27d7ff4 | 2007-03-31 11:55:19 -0300 | [diff] [blame] | 932 | 				skb_copy_to_linear_data(bundler, &bundler_hdr, | 
 | 933 | 							INT_H_SIZE); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 934 | 				skb_trim(bundler, INT_H_SIZE); | 
 | 935 | 				link_bundle_buf(l_ptr, bundler, buf); | 
 | 936 | 				buf = bundler; | 
 | 937 | 				msg = buf_msg(buf); | 
 | 938 | 				l_ptr->stats.sent_bundles++; | 
 | 939 | 			} | 
 | 940 | 		} | 
 | 941 | 	} | 
 | 942 | 	if (!l_ptr->next_out) | 
 | 943 | 		l_ptr->next_out = buf; | 
 | 944 | 	link_add_to_outqueue(l_ptr, buf, msg); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 945 | 	tipc_bearer_resolve_congestion(l_ptr->b_ptr, l_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 946 | 	return dsz; | 
 | 947 | } | 
 | 948 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 949 | /* | 
 | 950 |  * tipc_link_send(): same as tipc_link_send_buf(), but the link to use has | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 951 |  * not been selected yet, and the the owner node is not locked | 
 | 952 |  * Called by TIPC internal users, e.g. the name distributor | 
 | 953 |  */ | 
 | 954 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 955 | int tipc_link_send(struct sk_buff *buf, u32 dest, u32 selector) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 956 | { | 
 | 957 | 	struct link *l_ptr; | 
| David S. Miller | 6c00055 | 2008-09-02 23:38:32 -0700 | [diff] [blame] | 958 | 	struct tipc_node *n_ptr; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 959 | 	int res = -ELINKCONG; | 
 | 960 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 961 | 	read_lock_bh(&tipc_net_lock); | 
| Allan Stephens | 51a8e4d | 2010-12-31 18:59:18 +0000 | [diff] [blame] | 962 | 	n_ptr = tipc_node_find(dest); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 963 | 	if (n_ptr) { | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 964 | 		tipc_node_lock(n_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 965 | 		l_ptr = n_ptr->active_links[selector & 1]; | 
| Allan Stephens | a016892 | 2010-12-31 18:59:35 +0000 | [diff] [blame] | 966 | 		if (l_ptr) | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 967 | 			res = tipc_link_send_buf(l_ptr, buf); | 
| Allan Stephens | a016892 | 2010-12-31 18:59:35 +0000 | [diff] [blame] | 968 | 		else | 
| Allan Stephens | c33d53b | 2006-06-25 23:50:30 -0700 | [diff] [blame] | 969 | 			buf_discard(buf); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 970 | 		tipc_node_unlock(n_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 971 | 	} else { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 972 | 		buf_discard(buf); | 
 | 973 | 	} | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 974 | 	read_unlock_bh(&tipc_net_lock); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 975 | 	return res; | 
 | 976 | } | 
 | 977 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 978 | /* | 
| Allan Stephens | 9aa88c2 | 2011-05-31 13:38:02 -0400 | [diff] [blame] | 979 |  * tipc_link_send_names - send name table entries to new neighbor | 
 | 980 |  * | 
 | 981 |  * Send routine for bulk delivery of name table messages when contact | 
 | 982 |  * with a new neighbor occurs. No link congestion checking is performed | 
 | 983 |  * because name table messages *must* be delivered. The messages must be | 
 | 984 |  * small enough not to require fragmentation. | 
 | 985 |  * Called without any locks held. | 
 | 986 |  */ | 
 | 987 |  | 
 | 988 | void tipc_link_send_names(struct list_head *message_list, u32 dest) | 
 | 989 | { | 
 | 990 | 	struct tipc_node *n_ptr; | 
 | 991 | 	struct link *l_ptr; | 
 | 992 | 	struct sk_buff *buf; | 
 | 993 | 	struct sk_buff *temp_buf; | 
 | 994 |  | 
 | 995 | 	if (list_empty(message_list)) | 
 | 996 | 		return; | 
 | 997 |  | 
 | 998 | 	read_lock_bh(&tipc_net_lock); | 
 | 999 | 	n_ptr = tipc_node_find(dest); | 
 | 1000 | 	if (n_ptr) { | 
 | 1001 | 		tipc_node_lock(n_ptr); | 
 | 1002 | 		l_ptr = n_ptr->active_links[0]; | 
 | 1003 | 		if (l_ptr) { | 
 | 1004 | 			/* convert circular list to linear list */ | 
 | 1005 | 			((struct sk_buff *)message_list->prev)->next = NULL; | 
 | 1006 | 			link_add_chain_to_outqueue(l_ptr, | 
 | 1007 | 				(struct sk_buff *)message_list->next, 0); | 
 | 1008 | 			tipc_link_push_queue(l_ptr); | 
 | 1009 | 			INIT_LIST_HEAD(message_list); | 
 | 1010 | 		} | 
 | 1011 | 		tipc_node_unlock(n_ptr); | 
 | 1012 | 	} | 
 | 1013 | 	read_unlock_bh(&tipc_net_lock); | 
 | 1014 |  | 
 | 1015 | 	/* discard the messages if they couldn't be sent */ | 
 | 1016 |  | 
 | 1017 | 	list_for_each_safe(buf, temp_buf, ((struct sk_buff *)message_list)) { | 
 | 1018 | 		list_del((struct list_head *)buf); | 
 | 1019 | 		buf_discard(buf); | 
 | 1020 | 	} | 
 | 1021 | } | 
 | 1022 |  | 
 | 1023 | /* | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1024 |  * link_send_buf_fast: Entry for data messages where the | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1025 |  * destination link is known and the header is complete, | 
 | 1026 |  * inclusive total message length. Very time critical. | 
 | 1027 |  * Link is locked. Returns user data length. | 
 | 1028 |  */ | 
 | 1029 |  | 
| Sam Ravnborg | 05790c6 | 2006-03-20 22:37:04 -0800 | [diff] [blame] | 1030 | static int link_send_buf_fast(struct link *l_ptr, struct sk_buff *buf, | 
 | 1031 | 			      u32 *used_max_pkt) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1032 | { | 
 | 1033 | 	struct tipc_msg *msg = buf_msg(buf); | 
 | 1034 | 	int res = msg_data_sz(msg); | 
 | 1035 |  | 
 | 1036 | 	if (likely(!link_congested(l_ptr))) { | 
| Allan Stephens | 15e979d | 2010-05-11 14:30:10 +0000 | [diff] [blame] | 1037 | 		if (likely(msg_size(msg) <= l_ptr->max_pkt)) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1038 | 			if (likely(list_empty(&l_ptr->b_ptr->cong_links))) { | 
 | 1039 | 				link_add_to_outqueue(l_ptr, buf, msg); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1040 | 				if (likely(tipc_bearer_send(l_ptr->b_ptr, buf, | 
 | 1041 | 							    &l_ptr->media_addr))) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1042 | 					l_ptr->unacked_window = 0; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1043 | 					return res; | 
 | 1044 | 				} | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1045 | 				tipc_bearer_schedule(l_ptr->b_ptr, l_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1046 | 				l_ptr->stats.bearer_congs++; | 
 | 1047 | 				l_ptr->next_out = buf; | 
 | 1048 | 				return res; | 
 | 1049 | 			} | 
| Allan Stephens | 0e65967 | 2010-12-31 18:59:32 +0000 | [diff] [blame] | 1050 | 		} else | 
| Allan Stephens | 15e979d | 2010-05-11 14:30:10 +0000 | [diff] [blame] | 1051 | 			*used_max_pkt = l_ptr->max_pkt; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1052 | 	} | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1053 | 	return tipc_link_send_buf(l_ptr, buf);  /* All other cases */ | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1054 | } | 
 | 1055 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1056 | /* | 
 | 1057 |  * tipc_send_buf_fast: Entry for data messages where the | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1058 |  * destination node is known and the header is complete, | 
 | 1059 |  * inclusive total message length. | 
 | 1060 |  * Returns user data length. | 
 | 1061 |  */ | 
 | 1062 | int tipc_send_buf_fast(struct sk_buff *buf, u32 destnode) | 
 | 1063 | { | 
 | 1064 | 	struct link *l_ptr; | 
| David S. Miller | 6c00055 | 2008-09-02 23:38:32 -0700 | [diff] [blame] | 1065 | 	struct tipc_node *n_ptr; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1066 | 	int res; | 
 | 1067 | 	u32 selector = msg_origport(buf_msg(buf)) & 1; | 
 | 1068 | 	u32 dummy; | 
 | 1069 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1070 | 	read_lock_bh(&tipc_net_lock); | 
| Allan Stephens | 51a8e4d | 2010-12-31 18:59:18 +0000 | [diff] [blame] | 1071 | 	n_ptr = tipc_node_find(destnode); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1072 | 	if (likely(n_ptr)) { | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1073 | 		tipc_node_lock(n_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1074 | 		l_ptr = n_ptr->active_links[selector]; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1075 | 		if (likely(l_ptr)) { | 
 | 1076 | 			res = link_send_buf_fast(l_ptr, buf, &dummy); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1077 | 			tipc_node_unlock(n_ptr); | 
 | 1078 | 			read_unlock_bh(&tipc_net_lock); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1079 | 			return res; | 
 | 1080 | 		} | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1081 | 		tipc_node_unlock(n_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1082 | 	} | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1083 | 	read_unlock_bh(&tipc_net_lock); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1084 | 	res = msg_data_sz(buf_msg(buf)); | 
 | 1085 | 	tipc_reject_msg(buf, TIPC_ERR_NO_NODE); | 
 | 1086 | 	return res; | 
 | 1087 | } | 
 | 1088 |  | 
 | 1089 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1090 | /* | 
 | 1091 |  * tipc_link_send_sections_fast: Entry for messages where the | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1092 |  * destination processor is known and the header is complete, | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1093 |  * except for total message length. | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1094 |  * Returns user data length or errno. | 
 | 1095 |  */ | 
| Allan Stephens | 23dd4cc | 2011-01-07 11:43:40 -0500 | [diff] [blame] | 1096 | int tipc_link_send_sections_fast(struct tipc_port *sender, | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1097 | 				 struct iovec const *msg_sect, | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1098 | 				 const u32 num_sect, | 
| Allan Stephens | 2689690 | 2011-04-21 10:42:07 -0500 | [diff] [blame] | 1099 | 				 unsigned int total_len, | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1100 | 				 u32 destaddr) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1101 | { | 
| Allan Stephens | 23dd4cc | 2011-01-07 11:43:40 -0500 | [diff] [blame] | 1102 | 	struct tipc_msg *hdr = &sender->phdr; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1103 | 	struct link *l_ptr; | 
 | 1104 | 	struct sk_buff *buf; | 
| David S. Miller | 6c00055 | 2008-09-02 23:38:32 -0700 | [diff] [blame] | 1105 | 	struct tipc_node *node; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1106 | 	int res; | 
 | 1107 | 	u32 selector = msg_origport(hdr) & 1; | 
 | 1108 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1109 | again: | 
 | 1110 | 	/* | 
 | 1111 | 	 * Try building message using port's max_pkt hint. | 
 | 1112 | 	 * (Must not hold any locks while building message.) | 
 | 1113 | 	 */ | 
 | 1114 |  | 
| Allan Stephens | 2689690 | 2011-04-21 10:42:07 -0500 | [diff] [blame] | 1115 | 	res = tipc_msg_build(hdr, msg_sect, num_sect, total_len, | 
 | 1116 | 			     sender->max_pkt, !sender->user_port, &buf); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1117 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1118 | 	read_lock_bh(&tipc_net_lock); | 
| Allan Stephens | 51a8e4d | 2010-12-31 18:59:18 +0000 | [diff] [blame] | 1119 | 	node = tipc_node_find(destaddr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1120 | 	if (likely(node)) { | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1121 | 		tipc_node_lock(node); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1122 | 		l_ptr = node->active_links[selector]; | 
 | 1123 | 		if (likely(l_ptr)) { | 
 | 1124 | 			if (likely(buf)) { | 
 | 1125 | 				res = link_send_buf_fast(l_ptr, buf, | 
| Allan Stephens | 23dd4cc | 2011-01-07 11:43:40 -0500 | [diff] [blame] | 1126 | 							 &sender->max_pkt); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1127 | exit: | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1128 | 				tipc_node_unlock(node); | 
 | 1129 | 				read_unlock_bh(&tipc_net_lock); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1130 | 				return res; | 
 | 1131 | 			} | 
 | 1132 |  | 
 | 1133 | 			/* Exit if build request was invalid */ | 
 | 1134 |  | 
 | 1135 | 			if (unlikely(res < 0)) | 
 | 1136 | 				goto exit; | 
 | 1137 |  | 
 | 1138 | 			/* Exit if link (or bearer) is congested */ | 
 | 1139 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1140 | 			if (link_congested(l_ptr) || | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1141 | 			    !list_empty(&l_ptr->b_ptr->cong_links)) { | 
 | 1142 | 				res = link_schedule_port(l_ptr, | 
| Allan Stephens | 23dd4cc | 2011-01-07 11:43:40 -0500 | [diff] [blame] | 1143 | 							 sender->ref, res); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1144 | 				goto exit; | 
 | 1145 | 			} | 
 | 1146 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1147 | 			/* | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1148 | 			 * Message size exceeds max_pkt hint; update hint, | 
 | 1149 | 			 * then re-try fast path or fragment the message | 
 | 1150 | 			 */ | 
 | 1151 |  | 
| Allan Stephens | 23dd4cc | 2011-01-07 11:43:40 -0500 | [diff] [blame] | 1152 | 			sender->max_pkt = l_ptr->max_pkt; | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1153 | 			tipc_node_unlock(node); | 
 | 1154 | 			read_unlock_bh(&tipc_net_lock); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1155 |  | 
 | 1156 |  | 
| Allan Stephens | 23dd4cc | 2011-01-07 11:43:40 -0500 | [diff] [blame] | 1157 | 			if ((msg_hdr_sz(hdr) + res) <= sender->max_pkt) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1158 | 				goto again; | 
 | 1159 |  | 
 | 1160 | 			return link_send_sections_long(sender, msg_sect, | 
| Allan Stephens | 2689690 | 2011-04-21 10:42:07 -0500 | [diff] [blame] | 1161 | 						       num_sect, total_len, | 
 | 1162 | 						       destaddr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1163 | 		} | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1164 | 		tipc_node_unlock(node); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1165 | 	} | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1166 | 	read_unlock_bh(&tipc_net_lock); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1167 |  | 
 | 1168 | 	/* Couldn't find a link to the destination node */ | 
 | 1169 |  | 
 | 1170 | 	if (buf) | 
 | 1171 | 		return tipc_reject_msg(buf, TIPC_ERR_NO_NODE); | 
 | 1172 | 	if (res >= 0) | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1173 | 		return tipc_port_reject_sections(sender, hdr, msg_sect, num_sect, | 
| Allan Stephens | 2689690 | 2011-04-21 10:42:07 -0500 | [diff] [blame] | 1174 | 						 total_len, TIPC_ERR_NO_NODE); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1175 | 	return res; | 
 | 1176 | } | 
 | 1177 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1178 | /* | 
 | 1179 |  * link_send_sections_long(): Entry for long messages where the | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1180 |  * destination node is known and the header is complete, | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1181 |  * inclusive total message length. | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1182 |  * Link and bearer congestion status have been checked to be ok, | 
 | 1183 |  * and are ignored if they change. | 
 | 1184 |  * | 
 | 1185 |  * Note that fragments do not use the full link MTU so that they won't have | 
 | 1186 |  * to undergo refragmentation if link changeover causes them to be sent | 
 | 1187 |  * over another link with an additional tunnel header added as prefix. | 
 | 1188 |  * (Refragmentation will still occur if the other link has a smaller MTU.) | 
 | 1189 |  * | 
 | 1190 |  * Returns user data length or errno. | 
 | 1191 |  */ | 
| Allan Stephens | 23dd4cc | 2011-01-07 11:43:40 -0500 | [diff] [blame] | 1192 | static int link_send_sections_long(struct tipc_port *sender, | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1193 | 				   struct iovec const *msg_sect, | 
 | 1194 | 				   u32 num_sect, | 
| Allan Stephens | 2689690 | 2011-04-21 10:42:07 -0500 | [diff] [blame] | 1195 | 				   unsigned int total_len, | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1196 | 				   u32 destaddr) | 
 | 1197 | { | 
 | 1198 | 	struct link *l_ptr; | 
| David S. Miller | 6c00055 | 2008-09-02 23:38:32 -0700 | [diff] [blame] | 1199 | 	struct tipc_node *node; | 
| Allan Stephens | 23dd4cc | 2011-01-07 11:43:40 -0500 | [diff] [blame] | 1200 | 	struct tipc_msg *hdr = &sender->phdr; | 
| Allan Stephens | 2689690 | 2011-04-21 10:42:07 -0500 | [diff] [blame] | 1201 | 	u32 dsz = total_len; | 
| Allan Stephens | 0e65967 | 2010-12-31 18:59:32 +0000 | [diff] [blame] | 1202 | 	u32 max_pkt, fragm_sz, rest; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1203 | 	struct tipc_msg fragm_hdr; | 
| Allan Stephens | 0e65967 | 2010-12-31 18:59:32 +0000 | [diff] [blame] | 1204 | 	struct sk_buff *buf, *buf_chain, *prev; | 
 | 1205 | 	u32 fragm_crs, fragm_rest, hsz, sect_rest; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1206 | 	const unchar *sect_crs; | 
 | 1207 | 	int curr_sect; | 
 | 1208 | 	u32 fragm_no; | 
 | 1209 |  | 
 | 1210 | again: | 
 | 1211 | 	fragm_no = 1; | 
| Allan Stephens | 23dd4cc | 2011-01-07 11:43:40 -0500 | [diff] [blame] | 1212 | 	max_pkt = sender->max_pkt - INT_H_SIZE; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1213 | 		/* leave room for tunnel header in case of link changeover */ | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1214 | 	fragm_sz = max_pkt - INT_H_SIZE; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1215 | 		/* leave room for fragmentation header in each fragment */ | 
 | 1216 | 	rest = dsz; | 
 | 1217 | 	fragm_crs = 0; | 
 | 1218 | 	fragm_rest = 0; | 
 | 1219 | 	sect_rest = 0; | 
| Sam Ravnborg | 1fc54d8 | 2006-03-20 22:36:47 -0800 | [diff] [blame] | 1220 | 	sect_crs = NULL; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1221 | 	curr_sect = -1; | 
 | 1222 |  | 
 | 1223 | 	/* Prepare reusable fragment header: */ | 
 | 1224 |  | 
| Allan Stephens | c68ca7b | 2010-05-11 14:30:12 +0000 | [diff] [blame] | 1225 | 	tipc_msg_init(&fragm_hdr, MSG_FRAGMENTER, FIRST_FRAGMENT, | 
| Allan Stephens | 7571521 | 2008-06-04 17:37:34 -0700 | [diff] [blame] | 1226 | 		 INT_H_SIZE, msg_destnode(hdr)); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1227 | 	msg_set_size(&fragm_hdr, max_pkt); | 
 | 1228 | 	msg_set_fragm_no(&fragm_hdr, 1); | 
 | 1229 |  | 
 | 1230 | 	/* Prepare header of first fragment: */ | 
 | 1231 |  | 
| stephen hemminger | 31e3c3f | 2010-10-13 13:20:35 +0000 | [diff] [blame] | 1232 | 	buf_chain = buf = tipc_buf_acquire(max_pkt); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1233 | 	if (!buf) | 
 | 1234 | 		return -ENOMEM; | 
 | 1235 | 	buf->next = NULL; | 
| Arnaldo Carvalho de Melo | 27d7ff4 | 2007-03-31 11:55:19 -0300 | [diff] [blame] | 1236 | 	skb_copy_to_linear_data(buf, &fragm_hdr, INT_H_SIZE); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1237 | 	hsz = msg_hdr_sz(hdr); | 
| Arnaldo Carvalho de Melo | 27d7ff4 | 2007-03-31 11:55:19 -0300 | [diff] [blame] | 1238 | 	skb_copy_to_linear_data_offset(buf, INT_H_SIZE, hdr, hsz); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1239 |  | 
 | 1240 | 	/* Chop up message: */ | 
 | 1241 |  | 
 | 1242 | 	fragm_crs = INT_H_SIZE + hsz; | 
 | 1243 | 	fragm_rest = fragm_sz - hsz; | 
 | 1244 |  | 
 | 1245 | 	do {		/* For all sections */ | 
 | 1246 | 		u32 sz; | 
 | 1247 |  | 
 | 1248 | 		if (!sect_rest) { | 
 | 1249 | 			sect_rest = msg_sect[++curr_sect].iov_len; | 
 | 1250 | 			sect_crs = (const unchar *)msg_sect[curr_sect].iov_base; | 
 | 1251 | 		} | 
 | 1252 |  | 
 | 1253 | 		if (sect_rest < fragm_rest) | 
 | 1254 | 			sz = sect_rest; | 
 | 1255 | 		else | 
 | 1256 | 			sz = fragm_rest; | 
 | 1257 |  | 
 | 1258 | 		if (likely(!sender->user_port)) { | 
 | 1259 | 			if (copy_from_user(buf->data + fragm_crs, sect_crs, sz)) { | 
 | 1260 | error: | 
 | 1261 | 				for (; buf_chain; buf_chain = buf) { | 
 | 1262 | 					buf = buf_chain->next; | 
 | 1263 | 					buf_discard(buf_chain); | 
 | 1264 | 				} | 
 | 1265 | 				return -EFAULT; | 
 | 1266 | 			} | 
 | 1267 | 		} else | 
| Arnaldo Carvalho de Melo | 27d7ff4 | 2007-03-31 11:55:19 -0300 | [diff] [blame] | 1268 | 			skb_copy_to_linear_data_offset(buf, fragm_crs, | 
 | 1269 | 						       sect_crs, sz); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1270 | 		sect_crs += sz; | 
 | 1271 | 		sect_rest -= sz; | 
 | 1272 | 		fragm_crs += sz; | 
 | 1273 | 		fragm_rest -= sz; | 
 | 1274 | 		rest -= sz; | 
 | 1275 |  | 
 | 1276 | 		if (!fragm_rest && rest) { | 
 | 1277 |  | 
 | 1278 | 			/* Initiate new fragment: */ | 
 | 1279 | 			if (rest <= fragm_sz) { | 
 | 1280 | 				fragm_sz = rest; | 
| Allan Stephens | 0e65967 | 2010-12-31 18:59:32 +0000 | [diff] [blame] | 1281 | 				msg_set_type(&fragm_hdr, LAST_FRAGMENT); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1282 | 			} else { | 
 | 1283 | 				msg_set_type(&fragm_hdr, FRAGMENT); | 
 | 1284 | 			} | 
 | 1285 | 			msg_set_size(&fragm_hdr, fragm_sz + INT_H_SIZE); | 
 | 1286 | 			msg_set_fragm_no(&fragm_hdr, ++fragm_no); | 
 | 1287 | 			prev = buf; | 
| stephen hemminger | 31e3c3f | 2010-10-13 13:20:35 +0000 | [diff] [blame] | 1288 | 			buf = tipc_buf_acquire(fragm_sz + INT_H_SIZE); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1289 | 			if (!buf) | 
 | 1290 | 				goto error; | 
 | 1291 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1292 | 			buf->next = NULL; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1293 | 			prev->next = buf; | 
| Arnaldo Carvalho de Melo | 27d7ff4 | 2007-03-31 11:55:19 -0300 | [diff] [blame] | 1294 | 			skb_copy_to_linear_data(buf, &fragm_hdr, INT_H_SIZE); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1295 | 			fragm_crs = INT_H_SIZE; | 
 | 1296 | 			fragm_rest = fragm_sz; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1297 | 		} | 
| Allan Stephens | 0e65967 | 2010-12-31 18:59:32 +0000 | [diff] [blame] | 1298 | 	} while (rest > 0); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1299 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1300 | 	/* | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1301 | 	 * Now we have a buffer chain. Select a link and check | 
 | 1302 | 	 * that packet size is still OK | 
 | 1303 | 	 */ | 
| Allan Stephens | 51a8e4d | 2010-12-31 18:59:18 +0000 | [diff] [blame] | 1304 | 	node = tipc_node_find(destaddr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1305 | 	if (likely(node)) { | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1306 | 		tipc_node_lock(node); | 
| Allan Stephens | 23dd4cc | 2011-01-07 11:43:40 -0500 | [diff] [blame] | 1307 | 		l_ptr = node->active_links[sender->ref & 1]; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1308 | 		if (!l_ptr) { | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1309 | 			tipc_node_unlock(node); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1310 | 			goto reject; | 
 | 1311 | 		} | 
| Allan Stephens | 15e979d | 2010-05-11 14:30:10 +0000 | [diff] [blame] | 1312 | 		if (l_ptr->max_pkt < max_pkt) { | 
| Allan Stephens | 23dd4cc | 2011-01-07 11:43:40 -0500 | [diff] [blame] | 1313 | 			sender->max_pkt = l_ptr->max_pkt; | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1314 | 			tipc_node_unlock(node); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1315 | 			for (; buf_chain; buf_chain = buf) { | 
 | 1316 | 				buf = buf_chain->next; | 
 | 1317 | 				buf_discard(buf_chain); | 
 | 1318 | 			} | 
 | 1319 | 			goto again; | 
 | 1320 | 		} | 
 | 1321 | 	} else { | 
 | 1322 | reject: | 
 | 1323 | 		for (; buf_chain; buf_chain = buf) { | 
 | 1324 | 			buf = buf_chain->next; | 
 | 1325 | 			buf_discard(buf_chain); | 
 | 1326 | 		} | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1327 | 		return tipc_port_reject_sections(sender, hdr, msg_sect, num_sect, | 
| Allan Stephens | 2689690 | 2011-04-21 10:42:07 -0500 | [diff] [blame] | 1328 | 						 total_len, TIPC_ERR_NO_NODE); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1329 | 	} | 
 | 1330 |  | 
| Allan Stephens | dc63d91 | 2011-04-21 11:50:42 -0400 | [diff] [blame] | 1331 | 	/* Append chain of fragments to send queue & send them */ | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1332 |  | 
| Allan Stephens | e0f0859 | 2011-04-17 11:44:24 -0400 | [diff] [blame] | 1333 | 	l_ptr->long_msg_seq_no++; | 
| Allan Stephens | dc63d91 | 2011-04-21 11:50:42 -0400 | [diff] [blame] | 1334 | 	link_add_chain_to_outqueue(l_ptr, buf_chain, l_ptr->long_msg_seq_no); | 
 | 1335 | 	l_ptr->stats.sent_fragments += fragm_no; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1336 | 	l_ptr->stats.sent_fragmented++; | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1337 | 	tipc_link_push_queue(l_ptr); | 
 | 1338 | 	tipc_node_unlock(node); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1339 | 	return dsz; | 
 | 1340 | } | 
 | 1341 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1342 | /* | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1343 |  * tipc_link_push_packet: Push one unsent packet to the media | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1344 |  */ | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1345 | u32 tipc_link_push_packet(struct link *l_ptr) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1346 | { | 
 | 1347 | 	struct sk_buff *buf = l_ptr->first_out; | 
 | 1348 | 	u32 r_q_size = l_ptr->retransm_queue_size; | 
 | 1349 | 	u32 r_q_head = l_ptr->retransm_queue_head; | 
 | 1350 |  | 
 | 1351 | 	/* Step to position where retransmission failed, if any,    */ | 
 | 1352 | 	/* consider that buffers may have been released in meantime */ | 
 | 1353 |  | 
 | 1354 | 	if (r_q_size && buf) { | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1355 | 		u32 last = lesser(mod(r_q_head + r_q_size), | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1356 | 				  link_last_sent(l_ptr)); | 
 | 1357 | 		u32 first = msg_seqno(buf_msg(buf)); | 
 | 1358 |  | 
 | 1359 | 		while (buf && less(first, r_q_head)) { | 
 | 1360 | 			first = mod(first + 1); | 
 | 1361 | 			buf = buf->next; | 
 | 1362 | 		} | 
 | 1363 | 		l_ptr->retransm_queue_head = r_q_head = first; | 
 | 1364 | 		l_ptr->retransm_queue_size = r_q_size = mod(last - first); | 
 | 1365 | 	} | 
 | 1366 |  | 
 | 1367 | 	/* Continue retransmission now, if there is anything: */ | 
 | 1368 |  | 
| Neil Horman | ca50910 | 2010-03-15 07:58:45 +0000 | [diff] [blame] | 1369 | 	if (r_q_size && buf) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1370 | 		msg_set_ack(buf_msg(buf), mod(l_ptr->next_in_no - 1)); | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1371 | 		msg_set_bcast_ack(buf_msg(buf), l_ptr->owner->bclink.last_in); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1372 | 		if (tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr)) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1373 | 			l_ptr->retransm_queue_head = mod(++r_q_head); | 
 | 1374 | 			l_ptr->retransm_queue_size = --r_q_size; | 
 | 1375 | 			l_ptr->stats.retransmitted++; | 
| Allan Stephens | 0e35fd5 | 2008-07-14 22:44:01 -0700 | [diff] [blame] | 1376 | 			return 0; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1377 | 		} else { | 
 | 1378 | 			l_ptr->stats.bearer_congs++; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1379 | 			return PUSH_FAILED; | 
 | 1380 | 		} | 
 | 1381 | 	} | 
 | 1382 |  | 
 | 1383 | 	/* Send deferred protocol message, if any: */ | 
 | 1384 |  | 
 | 1385 | 	buf = l_ptr->proto_msg_queue; | 
 | 1386 | 	if (buf) { | 
 | 1387 | 		msg_set_ack(buf_msg(buf), mod(l_ptr->next_in_no - 1)); | 
| Allan Stephens | 0e65967 | 2010-12-31 18:59:32 +0000 | [diff] [blame] | 1388 | 		msg_set_bcast_ack(buf_msg(buf), l_ptr->owner->bclink.last_in); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1389 | 		if (tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr)) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1390 | 			l_ptr->unacked_window = 0; | 
 | 1391 | 			buf_discard(buf); | 
| Sam Ravnborg | 1fc54d8 | 2006-03-20 22:36:47 -0800 | [diff] [blame] | 1392 | 			l_ptr->proto_msg_queue = NULL; | 
| Allan Stephens | 0e35fd5 | 2008-07-14 22:44:01 -0700 | [diff] [blame] | 1393 | 			return 0; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1394 | 		} else { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1395 | 			l_ptr->stats.bearer_congs++; | 
 | 1396 | 			return PUSH_FAILED; | 
 | 1397 | 		} | 
 | 1398 | 	} | 
 | 1399 |  | 
 | 1400 | 	/* Send one deferred data message, if send window not full: */ | 
 | 1401 |  | 
 | 1402 | 	buf = l_ptr->next_out; | 
 | 1403 | 	if (buf) { | 
 | 1404 | 		struct tipc_msg *msg = buf_msg(buf); | 
 | 1405 | 		u32 next = msg_seqno(msg); | 
 | 1406 | 		u32 first = msg_seqno(buf_msg(l_ptr->first_out)); | 
 | 1407 |  | 
 | 1408 | 		if (mod(next - first) < l_ptr->queue_limit[0]) { | 
 | 1409 | 			msg_set_ack(msg, mod(l_ptr->next_in_no - 1)); | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1410 | 			msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1411 | 			if (tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr)) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1412 | 				if (msg_user(msg) == MSG_BUNDLER) | 
 | 1413 | 					msg_set_type(msg, CLOSED_MSG); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1414 | 				l_ptr->next_out = buf->next; | 
| Allan Stephens | 0e35fd5 | 2008-07-14 22:44:01 -0700 | [diff] [blame] | 1415 | 				return 0; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1416 | 			} else { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1417 | 				l_ptr->stats.bearer_congs++; | 
 | 1418 | 				return PUSH_FAILED; | 
 | 1419 | 			} | 
 | 1420 | 		} | 
 | 1421 | 	} | 
 | 1422 | 	return PUSH_FINISHED; | 
 | 1423 | } | 
 | 1424 |  | 
 | 1425 | /* | 
 | 1426 |  * push_queue(): push out the unsent messages of a link where | 
 | 1427 |  *               congestion has abated. Node is locked | 
 | 1428 |  */ | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1429 | void tipc_link_push_queue(struct link *l_ptr) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1430 | { | 
 | 1431 | 	u32 res; | 
 | 1432 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1433 | 	if (tipc_bearer_congested(l_ptr->b_ptr, l_ptr)) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1434 | 		return; | 
 | 1435 |  | 
 | 1436 | 	do { | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1437 | 		res = tipc_link_push_packet(l_ptr); | 
| Allan Stephens | 0e35fd5 | 2008-07-14 22:44:01 -0700 | [diff] [blame] | 1438 | 	} while (!res); | 
 | 1439 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1440 | 	if (res == PUSH_FAILED) | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1441 | 		tipc_bearer_schedule(l_ptr->b_ptr, l_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1442 | } | 
 | 1443 |  | 
| Allan Stephens | d356eeb | 2006-06-25 23:40:01 -0700 | [diff] [blame] | 1444 | static void link_reset_all(unsigned long addr) | 
 | 1445 | { | 
| David S. Miller | 6c00055 | 2008-09-02 23:38:32 -0700 | [diff] [blame] | 1446 | 	struct tipc_node *n_ptr; | 
| Allan Stephens | d356eeb | 2006-06-25 23:40:01 -0700 | [diff] [blame] | 1447 | 	char addr_string[16]; | 
 | 1448 | 	u32 i; | 
 | 1449 |  | 
 | 1450 | 	read_lock_bh(&tipc_net_lock); | 
 | 1451 | 	n_ptr = tipc_node_find((u32)addr); | 
 | 1452 | 	if (!n_ptr) { | 
 | 1453 | 		read_unlock_bh(&tipc_net_lock); | 
 | 1454 | 		return;	/* node no longer exists */ | 
 | 1455 | 	} | 
 | 1456 |  | 
 | 1457 | 	tipc_node_lock(n_ptr); | 
 | 1458 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1459 | 	warn("Resetting all links to %s\n", | 
| Allan Stephens | c68ca7b | 2010-05-11 14:30:12 +0000 | [diff] [blame] | 1460 | 	     tipc_addr_string_fill(addr_string, n_ptr->addr)); | 
| Allan Stephens | d356eeb | 2006-06-25 23:40:01 -0700 | [diff] [blame] | 1461 |  | 
 | 1462 | 	for (i = 0; i < MAX_BEARERS; i++) { | 
 | 1463 | 		if (n_ptr->links[i]) { | 
| Allan Stephens | 8d64a5b | 2010-12-31 18:59:27 +0000 | [diff] [blame] | 1464 | 			link_print(n_ptr->links[i], "Resetting link\n"); | 
| Allan Stephens | d356eeb | 2006-06-25 23:40:01 -0700 | [diff] [blame] | 1465 | 			tipc_link_reset(n_ptr->links[i]); | 
 | 1466 | 		} | 
 | 1467 | 	} | 
 | 1468 |  | 
 | 1469 | 	tipc_node_unlock(n_ptr); | 
 | 1470 | 	read_unlock_bh(&tipc_net_lock); | 
 | 1471 | } | 
 | 1472 |  | 
 | 1473 | static void link_retransmit_failure(struct link *l_ptr, struct sk_buff *buf) | 
 | 1474 | { | 
 | 1475 | 	struct tipc_msg *msg = buf_msg(buf); | 
 | 1476 |  | 
 | 1477 | 	warn("Retransmission failure on link <%s>\n", l_ptr->name); | 
| Allan Stephens | d356eeb | 2006-06-25 23:40:01 -0700 | [diff] [blame] | 1478 |  | 
 | 1479 | 	if (l_ptr->addr) { | 
 | 1480 |  | 
 | 1481 | 		/* Handle failure on standard link */ | 
 | 1482 |  | 
| Allan Stephens | 8d64a5b | 2010-12-31 18:59:27 +0000 | [diff] [blame] | 1483 | 		link_print(l_ptr, "Resetting link\n"); | 
| Allan Stephens | d356eeb | 2006-06-25 23:40:01 -0700 | [diff] [blame] | 1484 | 		tipc_link_reset(l_ptr); | 
 | 1485 |  | 
 | 1486 | 	} else { | 
 | 1487 |  | 
 | 1488 | 		/* Handle failure on broadcast link */ | 
 | 1489 |  | 
| David S. Miller | 6c00055 | 2008-09-02 23:38:32 -0700 | [diff] [blame] | 1490 | 		struct tipc_node *n_ptr; | 
| Allan Stephens | d356eeb | 2006-06-25 23:40:01 -0700 | [diff] [blame] | 1491 | 		char addr_string[16]; | 
 | 1492 |  | 
| Allan Stephens | 8d64a5b | 2010-12-31 18:59:27 +0000 | [diff] [blame] | 1493 | 		info("Msg seq number: %u,  ", msg_seqno(msg)); | 
 | 1494 | 		info("Outstanding acks: %lu\n", | 
 | 1495 | 		     (unsigned long) TIPC_SKB_CB(buf)->handle); | 
| Jeff Garzik | 617dbea | 2006-10-03 16:25:34 -0700 | [diff] [blame] | 1496 |  | 
| Allan Stephens | 01d83ed | 2011-01-18 13:53:16 -0500 | [diff] [blame] | 1497 | 		n_ptr = tipc_bclink_retransmit_to(); | 
| Allan Stephens | d356eeb | 2006-06-25 23:40:01 -0700 | [diff] [blame] | 1498 | 		tipc_node_lock(n_ptr); | 
 | 1499 |  | 
| Allan Stephens | c68ca7b | 2010-05-11 14:30:12 +0000 | [diff] [blame] | 1500 | 		tipc_addr_string_fill(addr_string, n_ptr->addr); | 
| Allan Stephens | 8d64a5b | 2010-12-31 18:59:27 +0000 | [diff] [blame] | 1501 | 		info("Multicast link info for %s\n", addr_string); | 
 | 1502 | 		info("Supported: %d,  ", n_ptr->bclink.supported); | 
 | 1503 | 		info("Acked: %u\n", n_ptr->bclink.acked); | 
 | 1504 | 		info("Last in: %u,  ", n_ptr->bclink.last_in); | 
 | 1505 | 		info("Gap after: %u,  ", n_ptr->bclink.gap_after); | 
 | 1506 | 		info("Gap to: %u\n", n_ptr->bclink.gap_to); | 
 | 1507 | 		info("Nack sync: %u\n\n", n_ptr->bclink.nack_sync); | 
| Allan Stephens | d356eeb | 2006-06-25 23:40:01 -0700 | [diff] [blame] | 1508 |  | 
 | 1509 | 		tipc_k_signal((Handler)link_reset_all, (unsigned long)n_ptr->addr); | 
 | 1510 |  | 
 | 1511 | 		tipc_node_unlock(n_ptr); | 
 | 1512 |  | 
 | 1513 | 		l_ptr->stale_count = 0; | 
 | 1514 | 	} | 
 | 1515 | } | 
 | 1516 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1517 | void tipc_link_retransmit(struct link *l_ptr, struct sk_buff *buf, | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1518 | 			  u32 retransmits) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1519 | { | 
 | 1520 | 	struct tipc_msg *msg; | 
 | 1521 |  | 
| Allan Stephens | d356eeb | 2006-06-25 23:40:01 -0700 | [diff] [blame] | 1522 | 	if (!buf) | 
 | 1523 | 		return; | 
 | 1524 |  | 
 | 1525 | 	msg = buf_msg(buf); | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1526 |  | 
| Allan Stephens | d356eeb | 2006-06-25 23:40:01 -0700 | [diff] [blame] | 1527 | 	if (tipc_bearer_congested(l_ptr->b_ptr, l_ptr)) { | 
| Neil Horman | ca50910 | 2010-03-15 07:58:45 +0000 | [diff] [blame] | 1528 | 		if (l_ptr->retransm_queue_size == 0) { | 
| Allan Stephens | d356eeb | 2006-06-25 23:40:01 -0700 | [diff] [blame] | 1529 | 			l_ptr->retransm_queue_head = msg_seqno(msg); | 
 | 1530 | 			l_ptr->retransm_queue_size = retransmits; | 
| Allan Stephens | d356eeb | 2006-06-25 23:40:01 -0700 | [diff] [blame] | 1531 | 		} else { | 
| Neil Horman | ca50910 | 2010-03-15 07:58:45 +0000 | [diff] [blame] | 1532 | 			err("Unexpected retransmit on link %s (qsize=%d)\n", | 
 | 1533 | 			    l_ptr->name, l_ptr->retransm_queue_size); | 
| Allan Stephens | d356eeb | 2006-06-25 23:40:01 -0700 | [diff] [blame] | 1534 | 		} | 
| Neil Horman | ca50910 | 2010-03-15 07:58:45 +0000 | [diff] [blame] | 1535 | 		return; | 
| Allan Stephens | d356eeb | 2006-06-25 23:40:01 -0700 | [diff] [blame] | 1536 | 	} else { | 
 | 1537 | 		/* Detect repeated retransmit failures on uncongested bearer */ | 
 | 1538 |  | 
 | 1539 | 		if (l_ptr->last_retransmitted == msg_seqno(msg)) { | 
 | 1540 | 			if (++l_ptr->stale_count > 100) { | 
 | 1541 | 				link_retransmit_failure(l_ptr, buf); | 
 | 1542 | 				return; | 
 | 1543 | 			} | 
 | 1544 | 		} else { | 
 | 1545 | 			l_ptr->last_retransmitted = msg_seqno(msg); | 
 | 1546 | 			l_ptr->stale_count = 1; | 
 | 1547 | 		} | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1548 | 	} | 
| Allan Stephens | d356eeb | 2006-06-25 23:40:01 -0700 | [diff] [blame] | 1549 |  | 
| Neil Horman | ca50910 | 2010-03-15 07:58:45 +0000 | [diff] [blame] | 1550 | 	while (retransmits && (buf != l_ptr->next_out) && buf) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1551 | 		msg = buf_msg(buf); | 
 | 1552 | 		msg_set_ack(msg, mod(l_ptr->next_in_no - 1)); | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1553 | 		msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1554 | 		if (tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr)) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1555 | 			buf = buf->next; | 
 | 1556 | 			retransmits--; | 
 | 1557 | 			l_ptr->stats.retransmitted++; | 
 | 1558 | 		} else { | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1559 | 			tipc_bearer_schedule(l_ptr->b_ptr, l_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1560 | 			l_ptr->stats.bearer_congs++; | 
 | 1561 | 			l_ptr->retransm_queue_head = msg_seqno(buf_msg(buf)); | 
 | 1562 | 			l_ptr->retransm_queue_size = retransmits; | 
 | 1563 | 			return; | 
 | 1564 | 		} | 
 | 1565 | 	} | 
| Allan Stephens | d356eeb | 2006-06-25 23:40:01 -0700 | [diff] [blame] | 1566 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1567 | 	l_ptr->retransm_queue_head = l_ptr->retransm_queue_size = 0; | 
 | 1568 | } | 
 | 1569 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1570 | /** | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1571 |  * link_insert_deferred_queue - insert deferred messages back into receive chain | 
 | 1572 |  */ | 
 | 1573 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1574 | static struct sk_buff *link_insert_deferred_queue(struct link *l_ptr, | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1575 | 						  struct sk_buff *buf) | 
 | 1576 | { | 
 | 1577 | 	u32 seq_no; | 
 | 1578 |  | 
 | 1579 | 	if (l_ptr->oldest_deferred_in == NULL) | 
 | 1580 | 		return buf; | 
 | 1581 |  | 
 | 1582 | 	seq_no = msg_seqno(buf_msg(l_ptr->oldest_deferred_in)); | 
 | 1583 | 	if (seq_no == mod(l_ptr->next_in_no)) { | 
 | 1584 | 		l_ptr->newest_deferred_in->next = buf; | 
 | 1585 | 		buf = l_ptr->oldest_deferred_in; | 
 | 1586 | 		l_ptr->oldest_deferred_in = NULL; | 
 | 1587 | 		l_ptr->deferred_inqueue_sz = 0; | 
 | 1588 | 	} | 
 | 1589 | 	return buf; | 
 | 1590 | } | 
 | 1591 |  | 
| Allan Stephens | 8503556 | 2008-04-15 19:04:54 -0700 | [diff] [blame] | 1592 | /** | 
 | 1593 |  * link_recv_buf_validate - validate basic format of received message | 
 | 1594 |  * | 
 | 1595 |  * This routine ensures a TIPC message has an acceptable header, and at least | 
 | 1596 |  * as much data as the header indicates it should.  The routine also ensures | 
 | 1597 |  * that the entire message header is stored in the main fragment of the message | 
 | 1598 |  * buffer, to simplify future access to message header fields. | 
 | 1599 |  * | 
 | 1600 |  * Note: Having extra info present in the message header or data areas is OK. | 
 | 1601 |  * TIPC will ignore the excess, under the assumption that it is optional info | 
 | 1602 |  * introduced by a later release of the protocol. | 
 | 1603 |  */ | 
 | 1604 |  | 
 | 1605 | static int link_recv_buf_validate(struct sk_buff *buf) | 
 | 1606 | { | 
 | 1607 | 	static u32 min_data_hdr_size[8] = { | 
| Allan Stephens | 741d9eb | 2011-05-31 15:03:18 -0400 | [diff] [blame] | 1608 | 		SHORT_H_SIZE, MCAST_H_SIZE, NAMED_H_SIZE, BASIC_H_SIZE, | 
| Allan Stephens | 8503556 | 2008-04-15 19:04:54 -0700 | [diff] [blame] | 1609 | 		MAX_H_SIZE, MAX_H_SIZE, MAX_H_SIZE, MAX_H_SIZE | 
 | 1610 | 		}; | 
 | 1611 |  | 
 | 1612 | 	struct tipc_msg *msg; | 
 | 1613 | 	u32 tipc_hdr[2]; | 
 | 1614 | 	u32 size; | 
 | 1615 | 	u32 hdr_size; | 
 | 1616 | 	u32 min_hdr_size; | 
 | 1617 |  | 
 | 1618 | 	if (unlikely(buf->len < MIN_H_SIZE)) | 
 | 1619 | 		return 0; | 
 | 1620 |  | 
 | 1621 | 	msg = skb_header_pointer(buf, 0, sizeof(tipc_hdr), tipc_hdr); | 
 | 1622 | 	if (msg == NULL) | 
 | 1623 | 		return 0; | 
 | 1624 |  | 
 | 1625 | 	if (unlikely(msg_version(msg) != TIPC_VERSION)) | 
 | 1626 | 		return 0; | 
 | 1627 |  | 
 | 1628 | 	size = msg_size(msg); | 
 | 1629 | 	hdr_size = msg_hdr_sz(msg); | 
 | 1630 | 	min_hdr_size = msg_isdata(msg) ? | 
 | 1631 | 		min_data_hdr_size[msg_type(msg)] : INT_H_SIZE; | 
 | 1632 |  | 
 | 1633 | 	if (unlikely((hdr_size < min_hdr_size) || | 
 | 1634 | 		     (size < hdr_size) || | 
 | 1635 | 		     (buf->len < size) || | 
 | 1636 | 		     (size - hdr_size > TIPC_MAX_USER_MSG_SIZE))) | 
 | 1637 | 		return 0; | 
 | 1638 |  | 
 | 1639 | 	return pskb_may_pull(buf, hdr_size); | 
 | 1640 | } | 
 | 1641 |  | 
| Allan Stephens | b02b69c | 2010-08-17 11:00:07 +0000 | [diff] [blame] | 1642 | /** | 
 | 1643 |  * tipc_recv_msg - process TIPC messages arriving from off-node | 
 | 1644 |  * @head: pointer to message buffer chain | 
 | 1645 |  * @tb_ptr: pointer to bearer message arrived on | 
 | 1646 |  * | 
 | 1647 |  * Invoked with no locks held.  Bearer pointer must point to a valid bearer | 
 | 1648 |  * structure (i.e. cannot be NULL), but bearer can be inactive. | 
 | 1649 |  */ | 
 | 1650 |  | 
| Allan Stephens | 2d627b9 | 2011-01-07 13:00:11 -0500 | [diff] [blame] | 1651 | void tipc_recv_msg(struct sk_buff *head, struct tipc_bearer *b_ptr) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1652 | { | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1653 | 	read_lock_bh(&tipc_net_lock); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1654 | 	while (head) { | 
| David S. Miller | 6c00055 | 2008-09-02 23:38:32 -0700 | [diff] [blame] | 1655 | 		struct tipc_node *n_ptr; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1656 | 		struct link *l_ptr; | 
 | 1657 | 		struct sk_buff *crs; | 
 | 1658 | 		struct sk_buff *buf = head; | 
| Allan Stephens | 8503556 | 2008-04-15 19:04:54 -0700 | [diff] [blame] | 1659 | 		struct tipc_msg *msg; | 
 | 1660 | 		u32 seq_no; | 
 | 1661 | 		u32 ackd; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1662 | 		u32 released = 0; | 
 | 1663 | 		int type; | 
 | 1664 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1665 | 		head = head->next; | 
| Allan Stephens | 8503556 | 2008-04-15 19:04:54 -0700 | [diff] [blame] | 1666 |  | 
| Allan Stephens | b02b69c | 2010-08-17 11:00:07 +0000 | [diff] [blame] | 1667 | 		/* Ensure bearer is still enabled */ | 
 | 1668 |  | 
 | 1669 | 		if (unlikely(!b_ptr->active)) | 
 | 1670 | 			goto cont; | 
 | 1671 |  | 
| Allan Stephens | 8503556 | 2008-04-15 19:04:54 -0700 | [diff] [blame] | 1672 | 		/* Ensure message is well-formed */ | 
 | 1673 |  | 
 | 1674 | 		if (unlikely(!link_recv_buf_validate(buf))) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1675 | 			goto cont; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1676 |  | 
| Allan Stephens | fe13dda | 2008-04-15 19:03:23 -0700 | [diff] [blame] | 1677 | 		/* Ensure message data is a single contiguous unit */ | 
 | 1678 |  | 
| Allan Stephens | a016892 | 2010-12-31 18:59:35 +0000 | [diff] [blame] | 1679 | 		if (unlikely(buf_linearize(buf))) | 
| Allan Stephens | fe13dda | 2008-04-15 19:03:23 -0700 | [diff] [blame] | 1680 | 			goto cont; | 
| Allan Stephens | fe13dda | 2008-04-15 19:03:23 -0700 | [diff] [blame] | 1681 |  | 
| Allan Stephens | 8503556 | 2008-04-15 19:04:54 -0700 | [diff] [blame] | 1682 | 		/* Handle arrival of a non-unicast link message */ | 
 | 1683 |  | 
 | 1684 | 		msg = buf_msg(buf); | 
 | 1685 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1686 | 		if (unlikely(msg_non_seq(msg))) { | 
| Allan Stephens | 1265a02 | 2008-06-04 17:32:35 -0700 | [diff] [blame] | 1687 | 			if (msg_user(msg) ==  LINK_CONFIG) | 
 | 1688 | 				tipc_disc_recv_msg(buf, b_ptr); | 
 | 1689 | 			else | 
 | 1690 | 				tipc_bclink_recv_pkt(buf); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1691 | 			continue; | 
 | 1692 | 		} | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1693 |  | 
| Allan Stephens | ed33a9c | 2011-04-05 15:15:04 -0400 | [diff] [blame] | 1694 | 		/* Discard unicast link messages destined for another node */ | 
 | 1695 |  | 
| Allan Stephens | 2600824 | 2006-06-25 23:39:31 -0700 | [diff] [blame] | 1696 | 		if (unlikely(!msg_short(msg) && | 
 | 1697 | 			     (msg_destnode(msg) != tipc_own_addr))) | 
 | 1698 | 			goto cont; | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1699 |  | 
| Allan Stephens | 5a68d5e | 2010-08-17 11:00:16 +0000 | [diff] [blame] | 1700 | 		/* Locate neighboring node that sent message */ | 
| Allan Stephens | 8503556 | 2008-04-15 19:04:54 -0700 | [diff] [blame] | 1701 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1702 | 		n_ptr = tipc_node_find(msg_prevnode(msg)); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1703 | 		if (unlikely(!n_ptr)) | 
 | 1704 | 			goto cont; | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1705 | 		tipc_node_lock(n_ptr); | 
| Allan Stephens | 8503556 | 2008-04-15 19:04:54 -0700 | [diff] [blame] | 1706 |  | 
| Allan Stephens | 5a68d5e | 2010-08-17 11:00:16 +0000 | [diff] [blame] | 1707 | 		/* Locate unicast link endpoint that should handle message */ | 
 | 1708 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1709 | 		l_ptr = n_ptr->links[b_ptr->identity]; | 
 | 1710 | 		if (unlikely(!l_ptr)) { | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1711 | 			tipc_node_unlock(n_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1712 | 			goto cont; | 
 | 1713 | 		} | 
| Allan Stephens | 8503556 | 2008-04-15 19:04:54 -0700 | [diff] [blame] | 1714 |  | 
| Allan Stephens | b4b5610 | 2011-05-27 11:00:51 -0400 | [diff] [blame] | 1715 | 		/* Verify that communication with node is currently allowed */ | 
 | 1716 |  | 
 | 1717 | 		if ((n_ptr->block_setup & WAIT_PEER_DOWN) && | 
 | 1718 | 			msg_user(msg) == LINK_PROTOCOL && | 
 | 1719 | 			(msg_type(msg) == RESET_MSG || | 
 | 1720 | 					msg_type(msg) == ACTIVATE_MSG) && | 
 | 1721 | 			!msg_redundant_link(msg)) | 
 | 1722 | 			n_ptr->block_setup &= ~WAIT_PEER_DOWN; | 
 | 1723 |  | 
 | 1724 | 		if (n_ptr->block_setup) { | 
 | 1725 | 			tipc_node_unlock(n_ptr); | 
 | 1726 | 			goto cont; | 
 | 1727 | 		} | 
 | 1728 |  | 
| Allan Stephens | 8503556 | 2008-04-15 19:04:54 -0700 | [diff] [blame] | 1729 | 		/* Validate message sequence number info */ | 
 | 1730 |  | 
 | 1731 | 		seq_no = msg_seqno(msg); | 
 | 1732 | 		ackd = msg_ack(msg); | 
 | 1733 |  | 
 | 1734 | 		/* Release acked messages */ | 
 | 1735 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1736 | 		if (less(n_ptr->bclink.acked, msg_bcast_ack(msg))) { | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1737 | 			if (tipc_node_is_up(n_ptr) && n_ptr->bclink.supported) | 
 | 1738 | 				tipc_bclink_acknowledge(n_ptr, msg_bcast_ack(msg)); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1739 | 		} | 
 | 1740 |  | 
 | 1741 | 		crs = l_ptr->first_out; | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1742 | 		while ((crs != l_ptr->next_out) && | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1743 | 		       less_eq(msg_seqno(buf_msg(crs)), ackd)) { | 
 | 1744 | 			struct sk_buff *next = crs->next; | 
 | 1745 |  | 
 | 1746 | 			buf_discard(crs); | 
 | 1747 | 			crs = next; | 
 | 1748 | 			released++; | 
 | 1749 | 		} | 
 | 1750 | 		if (released) { | 
 | 1751 | 			l_ptr->first_out = crs; | 
 | 1752 | 			l_ptr->out_queue_size -= released; | 
 | 1753 | 		} | 
| Allan Stephens | 8503556 | 2008-04-15 19:04:54 -0700 | [diff] [blame] | 1754 |  | 
 | 1755 | 		/* Try sending any messages link endpoint has pending */ | 
 | 1756 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1757 | 		if (unlikely(l_ptr->next_out)) | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1758 | 			tipc_link_push_queue(l_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1759 | 		if (unlikely(!list_empty(&l_ptr->waiting_ports))) | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1760 | 			tipc_link_wakeup_ports(l_ptr, 0); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1761 | 		if (unlikely(++l_ptr->unacked_window >= TIPC_MIN_LINK_WIN)) { | 
 | 1762 | 			l_ptr->stats.sent_acks++; | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1763 | 			tipc_link_send_proto_msg(l_ptr, STATE_MSG, 0, 0, 0, 0, 0); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1764 | 		} | 
 | 1765 |  | 
| Allan Stephens | 8503556 | 2008-04-15 19:04:54 -0700 | [diff] [blame] | 1766 | 		/* Now (finally!) process the incoming message */ | 
 | 1767 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1768 | protocol_check: | 
 | 1769 | 		if (likely(link_working_working(l_ptr))) { | 
 | 1770 | 			if (likely(seq_no == mod(l_ptr->next_in_no))) { | 
 | 1771 | 				l_ptr->next_in_no++; | 
 | 1772 | 				if (unlikely(l_ptr->oldest_deferred_in)) | 
 | 1773 | 					head = link_insert_deferred_queue(l_ptr, | 
 | 1774 | 									  head); | 
 | 1775 | 				if (likely(msg_is_dest(msg, tipc_own_addr))) { | 
 | 1776 | deliver: | 
 | 1777 | 					if (likely(msg_isdata(msg))) { | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1778 | 						tipc_node_unlock(n_ptr); | 
 | 1779 | 						tipc_port_recv_msg(buf); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1780 | 						continue; | 
 | 1781 | 					} | 
 | 1782 | 					switch (msg_user(msg)) { | 
 | 1783 | 					case MSG_BUNDLER: | 
 | 1784 | 						l_ptr->stats.recv_bundles++; | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1785 | 						l_ptr->stats.recv_bundled += | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1786 | 							msg_msgcnt(msg); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1787 | 						tipc_node_unlock(n_ptr); | 
 | 1788 | 						tipc_link_recv_bundle(buf); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1789 | 						continue; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1790 | 					case NAME_DISTRIBUTOR: | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1791 | 						tipc_node_unlock(n_ptr); | 
 | 1792 | 						tipc_named_recv(buf); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1793 | 						continue; | 
 | 1794 | 					case CONN_MANAGER: | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1795 | 						tipc_node_unlock(n_ptr); | 
 | 1796 | 						tipc_port_recv_proto_msg(buf); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1797 | 						continue; | 
 | 1798 | 					case MSG_FRAGMENTER: | 
 | 1799 | 						l_ptr->stats.recv_fragments++; | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1800 | 						if (tipc_link_recv_fragment(&l_ptr->defragm_buf, | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1801 | 									    &buf, &msg)) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1802 | 							l_ptr->stats.recv_fragmented++; | 
 | 1803 | 							goto deliver; | 
 | 1804 | 						} | 
 | 1805 | 						break; | 
 | 1806 | 					case CHANGEOVER_PROTOCOL: | 
 | 1807 | 						type = msg_type(msg); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1808 | 						if (link_recv_changeover_msg(&l_ptr, &buf)) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1809 | 							msg = buf_msg(buf); | 
 | 1810 | 							seq_no = msg_seqno(msg); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1811 | 							if (type == ORIGINAL_MSG) | 
 | 1812 | 								goto deliver; | 
 | 1813 | 							goto protocol_check; | 
 | 1814 | 						} | 
 | 1815 | 						break; | 
| Allan Stephens | 7945c1f | 2011-03-11 13:09:28 -0500 | [diff] [blame] | 1816 | 					default: | 
 | 1817 | 						buf_discard(buf); | 
 | 1818 | 						buf = NULL; | 
 | 1819 | 						break; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1820 | 					} | 
 | 1821 | 				} | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1822 | 				tipc_node_unlock(n_ptr); | 
 | 1823 | 				tipc_net_route_msg(buf); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1824 | 				continue; | 
 | 1825 | 			} | 
 | 1826 | 			link_handle_out_of_seq_msg(l_ptr, buf); | 
 | 1827 | 			head = link_insert_deferred_queue(l_ptr, head); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1828 | 			tipc_node_unlock(n_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1829 | 			continue; | 
 | 1830 | 		} | 
 | 1831 |  | 
 | 1832 | 		if (msg_user(msg) == LINK_PROTOCOL) { | 
 | 1833 | 			link_recv_proto_msg(l_ptr, buf); | 
 | 1834 | 			head = link_insert_deferred_queue(l_ptr, head); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1835 | 			tipc_node_unlock(n_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1836 | 			continue; | 
 | 1837 | 		} | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1838 | 		link_state_event(l_ptr, TRAFFIC_MSG_EVT); | 
 | 1839 |  | 
 | 1840 | 		if (link_working_working(l_ptr)) { | 
 | 1841 | 			/* Re-insert in front of queue */ | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1842 | 			buf->next = head; | 
 | 1843 | 			head = buf; | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1844 | 			tipc_node_unlock(n_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1845 | 			continue; | 
 | 1846 | 		} | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1847 | 		tipc_node_unlock(n_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1848 | cont: | 
 | 1849 | 		buf_discard(buf); | 
 | 1850 | 	} | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1851 | 	read_unlock_bh(&tipc_net_lock); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1852 | } | 
 | 1853 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1854 | /* | 
 | 1855 |  * link_defer_buf(): Sort a received out-of-sequence packet | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1856 |  *                   into the deferred reception queue. | 
 | 1857 |  * Returns the increase of the queue length,i.e. 0 or 1 | 
 | 1858 |  */ | 
 | 1859 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1860 | u32 tipc_link_defer_pkt(struct sk_buff **head, | 
 | 1861 | 			struct sk_buff **tail, | 
 | 1862 | 			struct sk_buff *buf) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1863 | { | 
| Sam Ravnborg | 1fc54d8 | 2006-03-20 22:36:47 -0800 | [diff] [blame] | 1864 | 	struct sk_buff *prev = NULL; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1865 | 	struct sk_buff *crs = *head; | 
 | 1866 | 	u32 seq_no = msg_seqno(buf_msg(buf)); | 
 | 1867 |  | 
 | 1868 | 	buf->next = NULL; | 
 | 1869 |  | 
 | 1870 | 	/* Empty queue ? */ | 
 | 1871 | 	if (*head == NULL) { | 
 | 1872 | 		*head = *tail = buf; | 
 | 1873 | 		return 1; | 
 | 1874 | 	} | 
 | 1875 |  | 
 | 1876 | 	/* Last ? */ | 
 | 1877 | 	if (less(msg_seqno(buf_msg(*tail)), seq_no)) { | 
 | 1878 | 		(*tail)->next = buf; | 
 | 1879 | 		*tail = buf; | 
 | 1880 | 		return 1; | 
 | 1881 | 	} | 
 | 1882 |  | 
 | 1883 | 	/* Scan through queue and sort it in */ | 
 | 1884 | 	do { | 
 | 1885 | 		struct tipc_msg *msg = buf_msg(crs); | 
 | 1886 |  | 
 | 1887 | 		if (less(seq_no, msg_seqno(msg))) { | 
 | 1888 | 			buf->next = crs; | 
 | 1889 | 			if (prev) | 
 | 1890 | 				prev->next = buf; | 
 | 1891 | 			else | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1892 | 				*head = buf; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1893 | 			return 1; | 
 | 1894 | 		} | 
| Allan Stephens | a016892 | 2010-12-31 18:59:35 +0000 | [diff] [blame] | 1895 | 		if (seq_no == msg_seqno(msg)) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1896 | 			break; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1897 | 		prev = crs; | 
 | 1898 | 		crs = crs->next; | 
| Allan Stephens | 0e65967 | 2010-12-31 18:59:32 +0000 | [diff] [blame] | 1899 | 	} while (crs); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1900 |  | 
 | 1901 | 	/* Message is a duplicate of an existing message */ | 
 | 1902 |  | 
 | 1903 | 	buf_discard(buf); | 
 | 1904 | 	return 0; | 
 | 1905 | } | 
 | 1906 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1907 | /** | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1908 |  * link_handle_out_of_seq_msg - handle arrival of out-of-sequence packet | 
 | 1909 |  */ | 
 | 1910 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1911 | static void link_handle_out_of_seq_msg(struct link *l_ptr, | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1912 | 				       struct sk_buff *buf) | 
 | 1913 | { | 
 | 1914 | 	u32 seq_no = msg_seqno(buf_msg(buf)); | 
 | 1915 |  | 
 | 1916 | 	if (likely(msg_user(buf_msg(buf)) == LINK_PROTOCOL)) { | 
 | 1917 | 		link_recv_proto_msg(l_ptr, buf); | 
 | 1918 | 		return; | 
 | 1919 | 	} | 
 | 1920 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1921 | 	/* Record OOS packet arrival (force mismatch on next timeout) */ | 
 | 1922 |  | 
 | 1923 | 	l_ptr->checkpoint--; | 
 | 1924 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1925 | 	/* | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1926 | 	 * Discard packet if a duplicate; otherwise add it to deferred queue | 
 | 1927 | 	 * and notify peer of gap as per protocol specification | 
 | 1928 | 	 */ | 
 | 1929 |  | 
 | 1930 | 	if (less(seq_no, mod(l_ptr->next_in_no))) { | 
 | 1931 | 		l_ptr->stats.duplicates++; | 
 | 1932 | 		buf_discard(buf); | 
 | 1933 | 		return; | 
 | 1934 | 	} | 
 | 1935 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1936 | 	if (tipc_link_defer_pkt(&l_ptr->oldest_deferred_in, | 
 | 1937 | 				&l_ptr->newest_deferred_in, buf)) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1938 | 		l_ptr->deferred_inqueue_sz++; | 
 | 1939 | 		l_ptr->stats.deferred_recv++; | 
 | 1940 | 		if ((l_ptr->deferred_inqueue_sz % 16) == 1) | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1941 | 			tipc_link_send_proto_msg(l_ptr, STATE_MSG, 0, 0, 0, 0, 0); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1942 | 	} else | 
 | 1943 | 		l_ptr->stats.duplicates++; | 
 | 1944 | } | 
 | 1945 |  | 
 | 1946 | /* | 
 | 1947 |  * Send protocol message to the other endpoint. | 
 | 1948 |  */ | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1949 | void tipc_link_send_proto_msg(struct link *l_ptr, u32 msg_typ, int probe_msg, | 
 | 1950 | 			      u32 gap, u32 tolerance, u32 priority, u32 ack_mtu) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1951 | { | 
| Sam Ravnborg | 1fc54d8 | 2006-03-20 22:36:47 -0800 | [diff] [blame] | 1952 | 	struct sk_buff *buf = NULL; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1953 | 	struct tipc_msg *msg = l_ptr->pmsg; | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1954 | 	u32 msg_size = sizeof(l_ptr->proto_msg); | 
| Allan Stephens | 75f0aa4 | 2011-02-28 15:30:20 -0500 | [diff] [blame] | 1955 | 	int r_flag; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1956 |  | 
 | 1957 | 	if (link_blocked(l_ptr)) | 
 | 1958 | 		return; | 
| Allan Stephens | b4b5610 | 2011-05-27 11:00:51 -0400 | [diff] [blame] | 1959 |  | 
 | 1960 | 	/* Abort non-RESET send if communication with node is prohibited */ | 
 | 1961 |  | 
 | 1962 | 	if ((l_ptr->owner->block_setup) && (msg_typ != RESET_MSG)) | 
 | 1963 | 		return; | 
 | 1964 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1965 | 	msg_set_type(msg, msg_typ); | 
 | 1966 | 	msg_set_net_plane(msg, l_ptr->b_ptr->net_plane); | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1967 | 	msg_set_bcast_ack(msg, mod(l_ptr->owner->bclink.last_in)); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1968 | 	msg_set_last_bcast(msg, tipc_bclink_get_last_sent()); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1969 |  | 
 | 1970 | 	if (msg_typ == STATE_MSG) { | 
 | 1971 | 		u32 next_sent = mod(l_ptr->next_out_no); | 
 | 1972 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 1973 | 		if (!tipc_link_is_up(l_ptr)) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1974 | 			return; | 
 | 1975 | 		if (l_ptr->next_out) | 
 | 1976 | 			next_sent = msg_seqno(buf_msg(l_ptr->next_out)); | 
 | 1977 | 		msg_set_next_sent(msg, next_sent); | 
 | 1978 | 		if (l_ptr->oldest_deferred_in) { | 
 | 1979 | 			u32 rec = msg_seqno(buf_msg(l_ptr->oldest_deferred_in)); | 
 | 1980 | 			gap = mod(rec - mod(l_ptr->next_in_no)); | 
 | 1981 | 		} | 
 | 1982 | 		msg_set_seq_gap(msg, gap); | 
 | 1983 | 		if (gap) | 
 | 1984 | 			l_ptr->stats.sent_nacks++; | 
 | 1985 | 		msg_set_link_tolerance(msg, tolerance); | 
 | 1986 | 		msg_set_linkprio(msg, priority); | 
 | 1987 | 		msg_set_max_pkt(msg, ack_mtu); | 
 | 1988 | 		msg_set_ack(msg, mod(l_ptr->next_in_no - 1)); | 
 | 1989 | 		msg_set_probe(msg, probe_msg != 0); | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1990 | 		if (probe_msg) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1991 | 			u32 mtu = l_ptr->max_pkt; | 
 | 1992 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1993 | 			if ((mtu < l_ptr->max_pkt_target) && | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 1994 | 			    link_working_working(l_ptr) && | 
 | 1995 | 			    l_ptr->fsm_msg_cnt) { | 
 | 1996 | 				msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3; | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 1997 | 				if (l_ptr->max_pkt_probes == 10) { | 
 | 1998 | 					l_ptr->max_pkt_target = (msg_size - 4); | 
 | 1999 | 					l_ptr->max_pkt_probes = 0; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2000 | 					msg_size = (mtu + (l_ptr->max_pkt_target - mtu)/2 + 2) & ~3; | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2001 | 				} | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2002 | 				l_ptr->max_pkt_probes++; | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2003 | 			} | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2004 |  | 
 | 2005 | 			l_ptr->stats.sent_probes++; | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2006 | 		} | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2007 | 		l_ptr->stats.sent_states++; | 
 | 2008 | 	} else {		/* RESET_MSG or ACTIVATE_MSG */ | 
 | 2009 | 		msg_set_ack(msg, mod(l_ptr->reset_checkpoint - 1)); | 
 | 2010 | 		msg_set_seq_gap(msg, 0); | 
 | 2011 | 		msg_set_next_sent(msg, 1); | 
| Allan Stephens | f23d9bf | 2011-01-18 15:15:34 -0500 | [diff] [blame] | 2012 | 		msg_set_probe(msg, 0); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2013 | 		msg_set_link_tolerance(msg, l_ptr->tolerance); | 
 | 2014 | 		msg_set_linkprio(msg, l_ptr->priority); | 
 | 2015 | 		msg_set_max_pkt(msg, l_ptr->max_pkt_target); | 
 | 2016 | 	} | 
 | 2017 |  | 
| Allan Stephens | 75f0aa4 | 2011-02-28 15:30:20 -0500 | [diff] [blame] | 2018 | 	r_flag = (l_ptr->owner->working_links > tipc_link_is_up(l_ptr)); | 
 | 2019 | 	msg_set_redundant_link(msg, r_flag); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2020 | 	msg_set_linkprio(msg, l_ptr->priority); | 
 | 2021 |  | 
 | 2022 | 	/* Ensure sequence number will not fit : */ | 
 | 2023 |  | 
 | 2024 | 	msg_set_seqno(msg, mod(l_ptr->next_out_no + (0xffff/2))); | 
 | 2025 |  | 
 | 2026 | 	/* Congestion? */ | 
 | 2027 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2028 | 	if (tipc_bearer_congested(l_ptr->b_ptr, l_ptr)) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2029 | 		if (!l_ptr->proto_msg_queue) { | 
 | 2030 | 			l_ptr->proto_msg_queue = | 
| stephen hemminger | 31e3c3f | 2010-10-13 13:20:35 +0000 | [diff] [blame] | 2031 | 				tipc_buf_acquire(sizeof(l_ptr->proto_msg)); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2032 | 		} | 
 | 2033 | 		buf = l_ptr->proto_msg_queue; | 
 | 2034 | 		if (!buf) | 
 | 2035 | 			return; | 
| Arnaldo Carvalho de Melo | 27d7ff4 | 2007-03-31 11:55:19 -0300 | [diff] [blame] | 2036 | 		skb_copy_to_linear_data(buf, msg, sizeof(l_ptr->proto_msg)); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2037 | 		return; | 
 | 2038 | 	} | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2039 |  | 
 | 2040 | 	/* Message can be sent */ | 
 | 2041 |  | 
| stephen hemminger | 31e3c3f | 2010-10-13 13:20:35 +0000 | [diff] [blame] | 2042 | 	buf = tipc_buf_acquire(msg_size); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2043 | 	if (!buf) | 
 | 2044 | 		return; | 
 | 2045 |  | 
| Arnaldo Carvalho de Melo | 27d7ff4 | 2007-03-31 11:55:19 -0300 | [diff] [blame] | 2046 | 	skb_copy_to_linear_data(buf, msg, sizeof(l_ptr->proto_msg)); | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2047 | 	msg_set_size(buf_msg(buf), msg_size); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2048 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2049 | 	if (tipc_bearer_send(l_ptr->b_ptr, buf, &l_ptr->media_addr)) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2050 | 		l_ptr->unacked_window = 0; | 
 | 2051 | 		buf_discard(buf); | 
 | 2052 | 		return; | 
 | 2053 | 	} | 
 | 2054 |  | 
 | 2055 | 	/* New congestion */ | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2056 | 	tipc_bearer_schedule(l_ptr->b_ptr, l_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2057 | 	l_ptr->proto_msg_queue = buf; | 
 | 2058 | 	l_ptr->stats.bearer_congs++; | 
 | 2059 | } | 
 | 2060 |  | 
 | 2061 | /* | 
 | 2062 |  * Receive protocol message : | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2063 |  * Note that network plane id propagates through the network, and may | 
 | 2064 |  * change at any time. The node with lowest address rules | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2065 |  */ | 
 | 2066 |  | 
 | 2067 | static void link_recv_proto_msg(struct link *l_ptr, struct sk_buff *buf) | 
 | 2068 | { | 
 | 2069 | 	u32 rec_gap = 0; | 
 | 2070 | 	u32 max_pkt_info; | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2071 | 	u32 max_pkt_ack; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2072 | 	u32 msg_tol; | 
 | 2073 | 	struct tipc_msg *msg = buf_msg(buf); | 
 | 2074 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2075 | 	if (link_blocked(l_ptr)) | 
 | 2076 | 		goto exit; | 
 | 2077 |  | 
 | 2078 | 	/* record unnumbered packet arrival (force mismatch on next timeout) */ | 
 | 2079 |  | 
 | 2080 | 	l_ptr->checkpoint--; | 
 | 2081 |  | 
 | 2082 | 	if (l_ptr->b_ptr->net_plane != msg_net_plane(msg)) | 
 | 2083 | 		if (tipc_own_addr > msg_prevnode(msg)) | 
 | 2084 | 			l_ptr->b_ptr->net_plane = msg_net_plane(msg); | 
 | 2085 |  | 
 | 2086 | 	l_ptr->owner->permit_changeover = msg_redundant_link(msg); | 
 | 2087 |  | 
 | 2088 | 	switch (msg_type(msg)) { | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2089 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2090 | 	case RESET_MSG: | 
| Allan Stephens | a686e68 | 2008-06-04 17:29:39 -0700 | [diff] [blame] | 2091 | 		if (!link_working_unknown(l_ptr) && | 
 | 2092 | 		    (l_ptr->peer_session != INVALID_SESSION)) { | 
| Allan Stephens | 641c218 | 2011-04-07 09:54:43 -0400 | [diff] [blame] | 2093 | 			if (less_eq(msg_session(msg), l_ptr->peer_session)) | 
 | 2094 | 				break; /* duplicate or old reset: ignore */ | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2095 | 		} | 
| Allan Stephens | b4b5610 | 2011-05-27 11:00:51 -0400 | [diff] [blame] | 2096 |  | 
 | 2097 | 		if (!msg_redundant_link(msg) && (link_working_working(l_ptr) || | 
 | 2098 | 				link_working_unknown(l_ptr))) { | 
 | 2099 | 			/* | 
 | 2100 | 			 * peer has lost contact -- don't allow peer's links | 
 | 2101 | 			 * to reactivate before we recognize loss & clean up | 
 | 2102 | 			 */ | 
 | 2103 | 			l_ptr->owner->block_setup = WAIT_NODE_DOWN; | 
 | 2104 | 		} | 
 | 2105 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2106 | 		/* fall thru' */ | 
 | 2107 | 	case ACTIVATE_MSG: | 
 | 2108 | 		/* Update link settings according other endpoint's values */ | 
 | 2109 |  | 
 | 2110 | 		strcpy((strrchr(l_ptr->name, ':') + 1), (char *)msg_data(msg)); | 
 | 2111 |  | 
| Allan Stephens | 2db9983 | 2010-12-31 18:59:33 +0000 | [diff] [blame] | 2112 | 		msg_tol = msg_link_tolerance(msg); | 
 | 2113 | 		if (msg_tol > l_ptr->tolerance) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2114 | 			link_set_supervision_props(l_ptr, msg_tol); | 
 | 2115 |  | 
 | 2116 | 		if (msg_linkprio(msg) > l_ptr->priority) | 
 | 2117 | 			l_ptr->priority = msg_linkprio(msg); | 
 | 2118 |  | 
 | 2119 | 		max_pkt_info = msg_max_pkt(msg); | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2120 | 		if (max_pkt_info) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2121 | 			if (max_pkt_info < l_ptr->max_pkt_target) | 
 | 2122 | 				l_ptr->max_pkt_target = max_pkt_info; | 
 | 2123 | 			if (l_ptr->max_pkt > l_ptr->max_pkt_target) | 
 | 2124 | 				l_ptr->max_pkt = l_ptr->max_pkt_target; | 
 | 2125 | 		} else { | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2126 | 			l_ptr->max_pkt = l_ptr->max_pkt_target; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2127 | 		} | 
 | 2128 | 		l_ptr->owner->bclink.supported = (max_pkt_info != 0); | 
 | 2129 |  | 
 | 2130 | 		link_state_event(l_ptr, msg_type(msg)); | 
 | 2131 |  | 
 | 2132 | 		l_ptr->peer_session = msg_session(msg); | 
 | 2133 | 		l_ptr->peer_bearer_id = msg_bearer_id(msg); | 
 | 2134 |  | 
 | 2135 | 		/* Synchronize broadcast sequence numbers */ | 
| Paul Gortmaker | 8f19afb | 2011-02-28 11:36:21 -0400 | [diff] [blame] | 2136 | 		if (!tipc_node_redundant_links(l_ptr->owner)) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2137 | 			l_ptr->owner->bclink.last_in = mod(msg_last_bcast(msg)); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2138 | 		break; | 
 | 2139 | 	case STATE_MSG: | 
 | 2140 |  | 
| Allan Stephens | 2db9983 | 2010-12-31 18:59:33 +0000 | [diff] [blame] | 2141 | 		msg_tol = msg_link_tolerance(msg); | 
 | 2142 | 		if (msg_tol) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2143 | 			link_set_supervision_props(l_ptr, msg_tol); | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2144 |  | 
 | 2145 | 		if (msg_linkprio(msg) && | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2146 | 		    (msg_linkprio(msg) != l_ptr->priority)) { | 
| Allan Stephens | a10bd92 | 2006-06-25 23:52:17 -0700 | [diff] [blame] | 2147 | 			warn("Resetting link <%s>, priority change %u->%u\n", | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2148 | 			     l_ptr->name, l_ptr->priority, msg_linkprio(msg)); | 
 | 2149 | 			l_ptr->priority = msg_linkprio(msg); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2150 | 			tipc_link_reset(l_ptr); /* Enforce change to take effect */ | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2151 | 			break; | 
 | 2152 | 		} | 
 | 2153 | 		link_state_event(l_ptr, TRAFFIC_MSG_EVT); | 
 | 2154 | 		l_ptr->stats.recv_states++; | 
 | 2155 | 		if (link_reset_unknown(l_ptr)) | 
 | 2156 | 			break; | 
 | 2157 |  | 
 | 2158 | 		if (less_eq(mod(l_ptr->next_in_no), msg_next_sent(msg))) { | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2159 | 			rec_gap = mod(msg_next_sent(msg) - | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2160 | 				      mod(l_ptr->next_in_no)); | 
 | 2161 | 		} | 
 | 2162 |  | 
 | 2163 | 		max_pkt_ack = msg_max_pkt(msg); | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2164 | 		if (max_pkt_ack > l_ptr->max_pkt) { | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2165 | 			l_ptr->max_pkt = max_pkt_ack; | 
 | 2166 | 			l_ptr->max_pkt_probes = 0; | 
 | 2167 | 		} | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2168 |  | 
 | 2169 | 		max_pkt_ack = 0; | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2170 | 		if (msg_probe(msg)) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2171 | 			l_ptr->stats.recv_probes++; | 
| Allan Stephens | a016892 | 2010-12-31 18:59:35 +0000 | [diff] [blame] | 2172 | 			if (msg_size(msg) > sizeof(l_ptr->proto_msg)) | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2173 | 				max_pkt_ack = msg_size(msg); | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2174 | 		} | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2175 |  | 
 | 2176 | 		/* Protocol message before retransmits, reduce loss risk */ | 
 | 2177 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2178 | 		tipc_bclink_check_gap(l_ptr->owner, msg_last_bcast(msg)); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2179 |  | 
 | 2180 | 		if (rec_gap || (msg_probe(msg))) { | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2181 | 			tipc_link_send_proto_msg(l_ptr, STATE_MSG, | 
 | 2182 | 						 0, rec_gap, 0, 0, max_pkt_ack); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2183 | 		} | 
 | 2184 | 		if (msg_seq_gap(msg)) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2185 | 			l_ptr->stats.recv_nacks++; | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2186 | 			tipc_link_retransmit(l_ptr, l_ptr->first_out, | 
 | 2187 | 					     msg_seq_gap(msg)); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2188 | 		} | 
 | 2189 | 		break; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2190 | 	} | 
 | 2191 | exit: | 
 | 2192 | 	buf_discard(buf); | 
 | 2193 | } | 
 | 2194 |  | 
 | 2195 |  | 
 | 2196 | /* | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2197 |  * tipc_link_tunnel(): Send one message via a link belonging to | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2198 |  * another bearer. Owner node is locked. | 
 | 2199 |  */ | 
| stephen hemminger | 31e3c3f | 2010-10-13 13:20:35 +0000 | [diff] [blame] | 2200 | static void tipc_link_tunnel(struct link *l_ptr, | 
 | 2201 | 			     struct tipc_msg *tunnel_hdr, | 
 | 2202 | 			     struct tipc_msg  *msg, | 
 | 2203 | 			     u32 selector) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2204 | { | 
 | 2205 | 	struct link *tunnel; | 
 | 2206 | 	struct sk_buff *buf; | 
 | 2207 | 	u32 length = msg_size(msg); | 
 | 2208 |  | 
 | 2209 | 	tunnel = l_ptr->owner->active_links[selector & 1]; | 
| Allan Stephens | 5392d64 | 2006-06-25 23:52:50 -0700 | [diff] [blame] | 2210 | 	if (!tipc_link_is_up(tunnel)) { | 
 | 2211 | 		warn("Link changeover error, " | 
 | 2212 | 		     "tunnel link no longer available\n"); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2213 | 		return; | 
| Allan Stephens | 5392d64 | 2006-06-25 23:52:50 -0700 | [diff] [blame] | 2214 | 	} | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2215 | 	msg_set_size(tunnel_hdr, length + INT_H_SIZE); | 
| stephen hemminger | 31e3c3f | 2010-10-13 13:20:35 +0000 | [diff] [blame] | 2216 | 	buf = tipc_buf_acquire(length + INT_H_SIZE); | 
| Allan Stephens | 5392d64 | 2006-06-25 23:52:50 -0700 | [diff] [blame] | 2217 | 	if (!buf) { | 
 | 2218 | 		warn("Link changeover error, " | 
 | 2219 | 		     "unable to send tunnel msg\n"); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2220 | 		return; | 
| Allan Stephens | 5392d64 | 2006-06-25 23:52:50 -0700 | [diff] [blame] | 2221 | 	} | 
| Arnaldo Carvalho de Melo | 27d7ff4 | 2007-03-31 11:55:19 -0300 | [diff] [blame] | 2222 | 	skb_copy_to_linear_data(buf, tunnel_hdr, INT_H_SIZE); | 
 | 2223 | 	skb_copy_to_linear_data_offset(buf, INT_H_SIZE, msg, length); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2224 | 	tipc_link_send_buf(tunnel, buf); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2225 | } | 
 | 2226 |  | 
 | 2227 |  | 
 | 2228 |  | 
 | 2229 | /* | 
 | 2230 |  * changeover(): Send whole message queue via the remaining link | 
 | 2231 |  *               Owner node is locked. | 
 | 2232 |  */ | 
 | 2233 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2234 | void tipc_link_changeover(struct link *l_ptr) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2235 | { | 
 | 2236 | 	u32 msgcount = l_ptr->out_queue_size; | 
 | 2237 | 	struct sk_buff *crs = l_ptr->first_out; | 
 | 2238 | 	struct link *tunnel = l_ptr->owner->active_links[0]; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2239 | 	struct tipc_msg tunnel_hdr; | 
| Allan Stephens | 5392d64 | 2006-06-25 23:52:50 -0700 | [diff] [blame] | 2240 | 	int split_bundles; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2241 |  | 
 | 2242 | 	if (!tunnel) | 
 | 2243 | 		return; | 
 | 2244 |  | 
| Allan Stephens | 5392d64 | 2006-06-25 23:52:50 -0700 | [diff] [blame] | 2245 | 	if (!l_ptr->owner->permit_changeover) { | 
 | 2246 | 		warn("Link changeover error, " | 
 | 2247 | 		     "peer did not permit changeover\n"); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2248 | 		return; | 
| Allan Stephens | 5392d64 | 2006-06-25 23:52:50 -0700 | [diff] [blame] | 2249 | 	} | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2250 |  | 
| Allan Stephens | c68ca7b | 2010-05-11 14:30:12 +0000 | [diff] [blame] | 2251 | 	tipc_msg_init(&tunnel_hdr, CHANGEOVER_PROTOCOL, | 
| Allan Stephens | 7571521 | 2008-06-04 17:37:34 -0700 | [diff] [blame] | 2252 | 		 ORIGINAL_MSG, INT_H_SIZE, l_ptr->addr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2253 | 	msg_set_bearer_id(&tunnel_hdr, l_ptr->peer_bearer_id); | 
 | 2254 | 	msg_set_msgcnt(&tunnel_hdr, msgcount); | 
| Allan Stephens | f131072 | 2006-06-25 23:51:37 -0700 | [diff] [blame] | 2255 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2256 | 	if (!l_ptr->first_out) { | 
 | 2257 | 		struct sk_buff *buf; | 
 | 2258 |  | 
| stephen hemminger | 31e3c3f | 2010-10-13 13:20:35 +0000 | [diff] [blame] | 2259 | 		buf = tipc_buf_acquire(INT_H_SIZE); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2260 | 		if (buf) { | 
| Arnaldo Carvalho de Melo | 27d7ff4 | 2007-03-31 11:55:19 -0300 | [diff] [blame] | 2261 | 			skb_copy_to_linear_data(buf, &tunnel_hdr, INT_H_SIZE); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2262 | 			msg_set_size(&tunnel_hdr, INT_H_SIZE); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2263 | 			tipc_link_send_buf(tunnel, buf); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2264 | 		} else { | 
| Allan Stephens | a10bd92 | 2006-06-25 23:52:17 -0700 | [diff] [blame] | 2265 | 			warn("Link changeover error, " | 
 | 2266 | 			     "unable to send changeover msg\n"); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2267 | 		} | 
 | 2268 | 		return; | 
 | 2269 | 	} | 
| Allan Stephens | f131072 | 2006-06-25 23:51:37 -0700 | [diff] [blame] | 2270 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2271 | 	split_bundles = (l_ptr->owner->active_links[0] != | 
| Allan Stephens | 5392d64 | 2006-06-25 23:52:50 -0700 | [diff] [blame] | 2272 | 			 l_ptr->owner->active_links[1]); | 
 | 2273 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2274 | 	while (crs) { | 
 | 2275 | 		struct tipc_msg *msg = buf_msg(crs); | 
 | 2276 |  | 
 | 2277 | 		if ((msg_user(msg) == MSG_BUNDLER) && split_bundles) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2278 | 			struct tipc_msg *m = msg_get_wrapped(msg); | 
| Allan Stephens | 0e65967 | 2010-12-31 18:59:32 +0000 | [diff] [blame] | 2279 | 			unchar *pos = (unchar *)m; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2280 |  | 
| Florian Westphal | d788d80 | 2007-08-02 19:28:06 -0700 | [diff] [blame] | 2281 | 			msgcount = msg_msgcnt(msg); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2282 | 			while (msgcount--) { | 
| Allan Stephens | 0e65967 | 2010-12-31 18:59:32 +0000 | [diff] [blame] | 2283 | 				msg_set_seqno(m, msg_seqno(msg)); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2284 | 				tipc_link_tunnel(l_ptr, &tunnel_hdr, m, | 
 | 2285 | 						 msg_link_selector(m)); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2286 | 				pos += align(msg_size(m)); | 
 | 2287 | 				m = (struct tipc_msg *)pos; | 
 | 2288 | 			} | 
 | 2289 | 		} else { | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2290 | 			tipc_link_tunnel(l_ptr, &tunnel_hdr, msg, | 
 | 2291 | 					 msg_link_selector(msg)); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2292 | 		} | 
 | 2293 | 		crs = crs->next; | 
 | 2294 | 	} | 
 | 2295 | } | 
 | 2296 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2297 | void tipc_link_send_duplicate(struct link *l_ptr, struct link *tunnel) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2298 | { | 
 | 2299 | 	struct sk_buff *iter; | 
 | 2300 | 	struct tipc_msg tunnel_hdr; | 
 | 2301 |  | 
| Allan Stephens | c68ca7b | 2010-05-11 14:30:12 +0000 | [diff] [blame] | 2302 | 	tipc_msg_init(&tunnel_hdr, CHANGEOVER_PROTOCOL, | 
| Allan Stephens | 7571521 | 2008-06-04 17:37:34 -0700 | [diff] [blame] | 2303 | 		 DUPLICATE_MSG, INT_H_SIZE, l_ptr->addr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2304 | 	msg_set_msgcnt(&tunnel_hdr, l_ptr->out_queue_size); | 
 | 2305 | 	msg_set_bearer_id(&tunnel_hdr, l_ptr->peer_bearer_id); | 
 | 2306 | 	iter = l_ptr->first_out; | 
 | 2307 | 	while (iter) { | 
 | 2308 | 		struct sk_buff *outbuf; | 
 | 2309 | 		struct tipc_msg *msg = buf_msg(iter); | 
 | 2310 | 		u32 length = msg_size(msg); | 
 | 2311 |  | 
 | 2312 | 		if (msg_user(msg) == MSG_BUNDLER) | 
 | 2313 | 			msg_set_type(msg, CLOSED_MSG); | 
 | 2314 | 		msg_set_ack(msg, mod(l_ptr->next_in_no - 1));	/* Update */ | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2315 | 		msg_set_bcast_ack(msg, l_ptr->owner->bclink.last_in); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2316 | 		msg_set_size(&tunnel_hdr, length + INT_H_SIZE); | 
| stephen hemminger | 31e3c3f | 2010-10-13 13:20:35 +0000 | [diff] [blame] | 2317 | 		outbuf = tipc_buf_acquire(length + INT_H_SIZE); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2318 | 		if (outbuf == NULL) { | 
| Allan Stephens | a10bd92 | 2006-06-25 23:52:17 -0700 | [diff] [blame] | 2319 | 			warn("Link changeover error, " | 
 | 2320 | 			     "unable to send duplicate msg\n"); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2321 | 			return; | 
 | 2322 | 		} | 
| Arnaldo Carvalho de Melo | 27d7ff4 | 2007-03-31 11:55:19 -0300 | [diff] [blame] | 2323 | 		skb_copy_to_linear_data(outbuf, &tunnel_hdr, INT_H_SIZE); | 
 | 2324 | 		skb_copy_to_linear_data_offset(outbuf, INT_H_SIZE, iter->data, | 
 | 2325 | 					       length); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2326 | 		tipc_link_send_buf(tunnel, outbuf); | 
 | 2327 | 		if (!tipc_link_is_up(l_ptr)) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2328 | 			return; | 
 | 2329 | 		iter = iter->next; | 
 | 2330 | 	} | 
 | 2331 | } | 
 | 2332 |  | 
 | 2333 |  | 
 | 2334 |  | 
 | 2335 | /** | 
 | 2336 |  * buf_extract - extracts embedded TIPC message from another message | 
 | 2337 |  * @skb: encapsulating message buffer | 
 | 2338 |  * @from_pos: offset to extract from | 
 | 2339 |  * | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2340 |  * Returns a new message buffer containing an embedded message.  The | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2341 |  * encapsulating message itself is left unchanged. | 
 | 2342 |  */ | 
 | 2343 |  | 
 | 2344 | static struct sk_buff *buf_extract(struct sk_buff *skb, u32 from_pos) | 
 | 2345 | { | 
 | 2346 | 	struct tipc_msg *msg = (struct tipc_msg *)(skb->data + from_pos); | 
 | 2347 | 	u32 size = msg_size(msg); | 
 | 2348 | 	struct sk_buff *eb; | 
 | 2349 |  | 
| stephen hemminger | 31e3c3f | 2010-10-13 13:20:35 +0000 | [diff] [blame] | 2350 | 	eb = tipc_buf_acquire(size); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2351 | 	if (eb) | 
| Arnaldo Carvalho de Melo | 27d7ff4 | 2007-03-31 11:55:19 -0300 | [diff] [blame] | 2352 | 		skb_copy_to_linear_data(eb, msg, size); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2353 | 	return eb; | 
 | 2354 | } | 
 | 2355 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2356 | /* | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2357 |  *  link_recv_changeover_msg(): Receive tunneled packet sent | 
 | 2358 |  *  via other link. Node is locked. Return extracted buffer. | 
 | 2359 |  */ | 
 | 2360 |  | 
 | 2361 | static int link_recv_changeover_msg(struct link **l_ptr, | 
 | 2362 | 				    struct sk_buff **buf) | 
 | 2363 | { | 
 | 2364 | 	struct sk_buff *tunnel_buf = *buf; | 
 | 2365 | 	struct link *dest_link; | 
 | 2366 | 	struct tipc_msg *msg; | 
 | 2367 | 	struct tipc_msg *tunnel_msg = buf_msg(tunnel_buf); | 
 | 2368 | 	u32 msg_typ = msg_type(tunnel_msg); | 
 | 2369 | 	u32 msg_count = msg_msgcnt(tunnel_msg); | 
 | 2370 |  | 
 | 2371 | 	dest_link = (*l_ptr)->owner->links[msg_bearer_id(tunnel_msg)]; | 
| Allan Stephens | b29f142 | 2010-12-31 18:59:25 +0000 | [diff] [blame] | 2372 | 	if (!dest_link) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2373 | 		goto exit; | 
| Allan Stephens | f131072 | 2006-06-25 23:51:37 -0700 | [diff] [blame] | 2374 | 	if (dest_link == *l_ptr) { | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2375 | 		err("Unexpected changeover message on link <%s>\n", | 
| Allan Stephens | f131072 | 2006-06-25 23:51:37 -0700 | [diff] [blame] | 2376 | 		    (*l_ptr)->name); | 
 | 2377 | 		goto exit; | 
 | 2378 | 	} | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2379 | 	*l_ptr = dest_link; | 
 | 2380 | 	msg = msg_get_wrapped(tunnel_msg); | 
 | 2381 |  | 
 | 2382 | 	if (msg_typ == DUPLICATE_MSG) { | 
| Allan Stephens | b29f142 | 2010-12-31 18:59:25 +0000 | [diff] [blame] | 2383 | 		if (less(msg_seqno(msg), mod(dest_link->next_in_no))) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2384 | 			goto exit; | 
| Allan Stephens | 0e65967 | 2010-12-31 18:59:32 +0000 | [diff] [blame] | 2385 | 		*buf = buf_extract(tunnel_buf, INT_H_SIZE); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2386 | 		if (*buf == NULL) { | 
| Allan Stephens | a10bd92 | 2006-06-25 23:52:17 -0700 | [diff] [blame] | 2387 | 			warn("Link changeover error, duplicate msg dropped\n"); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2388 | 			goto exit; | 
 | 2389 | 		} | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2390 | 		buf_discard(tunnel_buf); | 
 | 2391 | 		return 1; | 
 | 2392 | 	} | 
 | 2393 |  | 
 | 2394 | 	/* First original message ?: */ | 
 | 2395 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2396 | 	if (tipc_link_is_up(dest_link)) { | 
| Allan Stephens | a10bd92 | 2006-06-25 23:52:17 -0700 | [diff] [blame] | 2397 | 		info("Resetting link <%s>, changeover initiated by peer\n", | 
 | 2398 | 		     dest_link->name); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2399 | 		tipc_link_reset(dest_link); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2400 | 		dest_link->exp_msg_count = msg_count; | 
 | 2401 | 		if (!msg_count) | 
 | 2402 | 			goto exit; | 
 | 2403 | 	} else if (dest_link->exp_msg_count == START_CHANGEOVER) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2404 | 		dest_link->exp_msg_count = msg_count; | 
 | 2405 | 		if (!msg_count) | 
 | 2406 | 			goto exit; | 
 | 2407 | 	} | 
 | 2408 |  | 
 | 2409 | 	/* Receive original message */ | 
 | 2410 |  | 
 | 2411 | 	if (dest_link->exp_msg_count == 0) { | 
| Allan Stephens | 5392d64 | 2006-06-25 23:52:50 -0700 | [diff] [blame] | 2412 | 		warn("Link switchover error, " | 
 | 2413 | 		     "got too many tunnelled messages\n"); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2414 | 		goto exit; | 
 | 2415 | 	} | 
 | 2416 | 	dest_link->exp_msg_count--; | 
 | 2417 | 	if (less(msg_seqno(msg), dest_link->reset_checkpoint)) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2418 | 		goto exit; | 
 | 2419 | 	} else { | 
 | 2420 | 		*buf = buf_extract(tunnel_buf, INT_H_SIZE); | 
 | 2421 | 		if (*buf != NULL) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2422 | 			buf_discard(tunnel_buf); | 
 | 2423 | 			return 1; | 
 | 2424 | 		} else { | 
| Allan Stephens | a10bd92 | 2006-06-25 23:52:17 -0700 | [diff] [blame] | 2425 | 			warn("Link changeover error, original msg dropped\n"); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2426 | 		} | 
 | 2427 | 	} | 
 | 2428 | exit: | 
| Sam Ravnborg | 1fc54d8 | 2006-03-20 22:36:47 -0800 | [diff] [blame] | 2429 | 	*buf = NULL; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2430 | 	buf_discard(tunnel_buf); | 
 | 2431 | 	return 0; | 
 | 2432 | } | 
 | 2433 |  | 
 | 2434 | /* | 
 | 2435 |  *  Bundler functionality: | 
 | 2436 |  */ | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2437 | void tipc_link_recv_bundle(struct sk_buff *buf) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2438 | { | 
 | 2439 | 	u32 msgcount = msg_msgcnt(buf_msg(buf)); | 
 | 2440 | 	u32 pos = INT_H_SIZE; | 
 | 2441 | 	struct sk_buff *obuf; | 
 | 2442 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2443 | 	while (msgcount--) { | 
 | 2444 | 		obuf = buf_extract(buf, pos); | 
 | 2445 | 		if (obuf == NULL) { | 
| Allan Stephens | a10bd92 | 2006-06-25 23:52:17 -0700 | [diff] [blame] | 2446 | 			warn("Link unable to unbundle message(s)\n"); | 
 | 2447 | 			break; | 
| Stephen Hemminger | 3ff50b7 | 2007-04-20 17:09:22 -0700 | [diff] [blame] | 2448 | 		} | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2449 | 		pos += align(msg_size(buf_msg(obuf))); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2450 | 		tipc_net_route_msg(obuf); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2451 | 	} | 
 | 2452 | 	buf_discard(buf); | 
 | 2453 | } | 
 | 2454 |  | 
 | 2455 | /* | 
 | 2456 |  *  Fragmentation/defragmentation: | 
 | 2457 |  */ | 
 | 2458 |  | 
 | 2459 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2460 | /* | 
| stephen hemminger | 31e3c3f | 2010-10-13 13:20:35 +0000 | [diff] [blame] | 2461 |  * link_send_long_buf: Entry for buffers needing fragmentation. | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2462 |  * The buffer is complete, inclusive total message length. | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2463 |  * Returns user data length. | 
 | 2464 |  */ | 
| stephen hemminger | 31e3c3f | 2010-10-13 13:20:35 +0000 | [diff] [blame] | 2465 | static int link_send_long_buf(struct link *l_ptr, struct sk_buff *buf) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2466 | { | 
| Allan Stephens | 7756155 | 2011-04-17 13:06:23 -0400 | [diff] [blame] | 2467 | 	struct sk_buff *buf_chain = NULL; | 
 | 2468 | 	struct sk_buff *buf_chain_tail = (struct sk_buff *)&buf_chain; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2469 | 	struct tipc_msg *inmsg = buf_msg(buf); | 
 | 2470 | 	struct tipc_msg fragm_hdr; | 
 | 2471 | 	u32 insize = msg_size(inmsg); | 
 | 2472 | 	u32 dsz = msg_data_sz(inmsg); | 
 | 2473 | 	unchar *crs = buf->data; | 
 | 2474 | 	u32 rest = insize; | 
| Allan Stephens | 15e979d | 2010-05-11 14:30:10 +0000 | [diff] [blame] | 2475 | 	u32 pack_sz = l_ptr->max_pkt; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2476 | 	u32 fragm_sz = pack_sz - INT_H_SIZE; | 
| Allan Stephens | 7756155 | 2011-04-17 13:06:23 -0400 | [diff] [blame] | 2477 | 	u32 fragm_no = 0; | 
| Allan Stephens | 9c396a7 | 2008-06-04 17:36:58 -0700 | [diff] [blame] | 2478 | 	u32 destaddr; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2479 |  | 
 | 2480 | 	if (msg_short(inmsg)) | 
 | 2481 | 		destaddr = l_ptr->addr; | 
| Allan Stephens | 9c396a7 | 2008-06-04 17:36:58 -0700 | [diff] [blame] | 2482 | 	else | 
 | 2483 | 		destaddr = msg_destnode(inmsg); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2484 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2485 | 	/* Prepare reusable fragment header: */ | 
 | 2486 |  | 
| Allan Stephens | c68ca7b | 2010-05-11 14:30:12 +0000 | [diff] [blame] | 2487 | 	tipc_msg_init(&fragm_hdr, MSG_FRAGMENTER, FIRST_FRAGMENT, | 
| Allan Stephens | 7571521 | 2008-06-04 17:37:34 -0700 | [diff] [blame] | 2488 | 		 INT_H_SIZE, destaddr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2489 |  | 
 | 2490 | 	/* Chop up message: */ | 
 | 2491 |  | 
 | 2492 | 	while (rest > 0) { | 
 | 2493 | 		struct sk_buff *fragm; | 
 | 2494 |  | 
 | 2495 | 		if (rest <= fragm_sz) { | 
 | 2496 | 			fragm_sz = rest; | 
 | 2497 | 			msg_set_type(&fragm_hdr, LAST_FRAGMENT); | 
 | 2498 | 		} | 
| stephen hemminger | 31e3c3f | 2010-10-13 13:20:35 +0000 | [diff] [blame] | 2499 | 		fragm = tipc_buf_acquire(fragm_sz + INT_H_SIZE); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2500 | 		if (fragm == NULL) { | 
| Allan Stephens | 7756155 | 2011-04-17 13:06:23 -0400 | [diff] [blame] | 2501 | 			buf_discard(buf); | 
 | 2502 | 			while (buf_chain) { | 
 | 2503 | 				buf = buf_chain; | 
 | 2504 | 				buf_chain = buf_chain->next; | 
 | 2505 | 				buf_discard(buf); | 
 | 2506 | 			} | 
 | 2507 | 			return -ENOMEM; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2508 | 		} | 
 | 2509 | 		msg_set_size(&fragm_hdr, fragm_sz + INT_H_SIZE); | 
| Allan Stephens | 7756155 | 2011-04-17 13:06:23 -0400 | [diff] [blame] | 2510 | 		fragm_no++; | 
 | 2511 | 		msg_set_fragm_no(&fragm_hdr, fragm_no); | 
| Arnaldo Carvalho de Melo | 27d7ff4 | 2007-03-31 11:55:19 -0300 | [diff] [blame] | 2512 | 		skb_copy_to_linear_data(fragm, &fragm_hdr, INT_H_SIZE); | 
 | 2513 | 		skb_copy_to_linear_data_offset(fragm, INT_H_SIZE, crs, | 
 | 2514 | 					       fragm_sz); | 
| Allan Stephens | 7756155 | 2011-04-17 13:06:23 -0400 | [diff] [blame] | 2515 | 		buf_chain_tail->next = fragm; | 
 | 2516 | 		buf_chain_tail = fragm; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2517 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2518 | 		rest -= fragm_sz; | 
 | 2519 | 		crs += fragm_sz; | 
 | 2520 | 		msg_set_type(&fragm_hdr, FRAGMENT); | 
 | 2521 | 	} | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2522 | 	buf_discard(buf); | 
| Allan Stephens | 7756155 | 2011-04-17 13:06:23 -0400 | [diff] [blame] | 2523 |  | 
 | 2524 | 	/* Append chain of fragments to send queue & send them */ | 
 | 2525 |  | 
 | 2526 | 	l_ptr->long_msg_seq_no++; | 
 | 2527 | 	link_add_chain_to_outqueue(l_ptr, buf_chain, l_ptr->long_msg_seq_no); | 
 | 2528 | 	l_ptr->stats.sent_fragments += fragm_no; | 
 | 2529 | 	l_ptr->stats.sent_fragmented++; | 
 | 2530 | 	tipc_link_push_queue(l_ptr); | 
 | 2531 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2532 | 	return dsz; | 
 | 2533 | } | 
 | 2534 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2535 | /* | 
 | 2536 |  * A pending message being re-assembled must store certain values | 
 | 2537 |  * to handle subsequent fragments correctly. The following functions | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2538 |  * help storing these values in unused, available fields in the | 
| Lucas De Marchi | 25985ed | 2011-03-30 22:57:33 -0300 | [diff] [blame] | 2539 |  * pending message. This makes dynamic memory allocation unnecessary. | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2540 |  */ | 
 | 2541 |  | 
| Sam Ravnborg | 05790c6 | 2006-03-20 22:37:04 -0800 | [diff] [blame] | 2542 | static void set_long_msg_seqno(struct sk_buff *buf, u32 seqno) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2543 | { | 
 | 2544 | 	msg_set_seqno(buf_msg(buf), seqno); | 
 | 2545 | } | 
 | 2546 |  | 
| Sam Ravnborg | 05790c6 | 2006-03-20 22:37:04 -0800 | [diff] [blame] | 2547 | static u32 get_fragm_size(struct sk_buff *buf) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2548 | { | 
 | 2549 | 	return msg_ack(buf_msg(buf)); | 
 | 2550 | } | 
 | 2551 |  | 
| Sam Ravnborg | 05790c6 | 2006-03-20 22:37:04 -0800 | [diff] [blame] | 2552 | static void set_fragm_size(struct sk_buff *buf, u32 sz) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2553 | { | 
 | 2554 | 	msg_set_ack(buf_msg(buf), sz); | 
 | 2555 | } | 
 | 2556 |  | 
| Sam Ravnborg | 05790c6 | 2006-03-20 22:37:04 -0800 | [diff] [blame] | 2557 | static u32 get_expected_frags(struct sk_buff *buf) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2558 | { | 
 | 2559 | 	return msg_bcast_ack(buf_msg(buf)); | 
 | 2560 | } | 
 | 2561 |  | 
| Sam Ravnborg | 05790c6 | 2006-03-20 22:37:04 -0800 | [diff] [blame] | 2562 | static void set_expected_frags(struct sk_buff *buf, u32 exp) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2563 | { | 
 | 2564 | 	msg_set_bcast_ack(buf_msg(buf), exp); | 
 | 2565 | } | 
 | 2566 |  | 
| Sam Ravnborg | 05790c6 | 2006-03-20 22:37:04 -0800 | [diff] [blame] | 2567 | static u32 get_timer_cnt(struct sk_buff *buf) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2568 | { | 
 | 2569 | 	return msg_reroute_cnt(buf_msg(buf)); | 
 | 2570 | } | 
 | 2571 |  | 
| Sam Ravnborg | 05790c6 | 2006-03-20 22:37:04 -0800 | [diff] [blame] | 2572 | static void incr_timer_cnt(struct sk_buff *buf) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2573 | { | 
 | 2574 | 	msg_incr_reroute_cnt(buf_msg(buf)); | 
 | 2575 | } | 
 | 2576 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2577 | /* | 
 | 2578 |  * tipc_link_recv_fragment(): Called with node lock on. Returns | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2579 |  * the reassembled buffer if message is complete. | 
 | 2580 |  */ | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2581 | int tipc_link_recv_fragment(struct sk_buff **pending, struct sk_buff **fb, | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2582 | 			    struct tipc_msg **m) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2583 | { | 
| Sam Ravnborg | 1fc54d8 | 2006-03-20 22:36:47 -0800 | [diff] [blame] | 2584 | 	struct sk_buff *prev = NULL; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2585 | 	struct sk_buff *fbuf = *fb; | 
 | 2586 | 	struct tipc_msg *fragm = buf_msg(fbuf); | 
 | 2587 | 	struct sk_buff *pbuf = *pending; | 
 | 2588 | 	u32 long_msg_seq_no = msg_long_msgno(fragm); | 
 | 2589 |  | 
| Sam Ravnborg | 1fc54d8 | 2006-03-20 22:36:47 -0800 | [diff] [blame] | 2590 | 	*fb = NULL; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2591 |  | 
 | 2592 | 	/* Is there an incomplete message waiting for this fragment? */ | 
 | 2593 |  | 
| Joe Perches | f64f9e7 | 2009-11-29 16:55:45 -0800 | [diff] [blame] | 2594 | 	while (pbuf && ((msg_seqno(buf_msg(pbuf)) != long_msg_seq_no) || | 
 | 2595 | 			(msg_orignode(fragm) != msg_orignode(buf_msg(pbuf))))) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2596 | 		prev = pbuf; | 
 | 2597 | 		pbuf = pbuf->next; | 
 | 2598 | 	} | 
 | 2599 |  | 
 | 2600 | 	if (!pbuf && (msg_type(fragm) == FIRST_FRAGMENT)) { | 
 | 2601 | 		struct tipc_msg *imsg = (struct tipc_msg *)msg_data(fragm); | 
 | 2602 | 		u32 msg_sz = msg_size(imsg); | 
 | 2603 | 		u32 fragm_sz = msg_data_sz(fragm); | 
 | 2604 | 		u32 exp_fragm_cnt = msg_sz/fragm_sz + !!(msg_sz % fragm_sz); | 
| Allan Stephens | 741d9eb | 2011-05-31 15:03:18 -0400 | [diff] [blame] | 2605 | 		u32 max =  TIPC_MAX_USER_MSG_SIZE + NAMED_H_SIZE; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2606 | 		if (msg_type(imsg) == TIPC_MCAST_MSG) | 
 | 2607 | 			max = TIPC_MAX_USER_MSG_SIZE + MCAST_H_SIZE; | 
 | 2608 | 		if (msg_size(imsg) > max) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2609 | 			buf_discard(fbuf); | 
 | 2610 | 			return 0; | 
 | 2611 | 		} | 
| stephen hemminger | 31e3c3f | 2010-10-13 13:20:35 +0000 | [diff] [blame] | 2612 | 		pbuf = tipc_buf_acquire(msg_size(imsg)); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2613 | 		if (pbuf != NULL) { | 
 | 2614 | 			pbuf->next = *pending; | 
 | 2615 | 			*pending = pbuf; | 
| Arnaldo Carvalho de Melo | 27d7ff4 | 2007-03-31 11:55:19 -0300 | [diff] [blame] | 2616 | 			skb_copy_to_linear_data(pbuf, imsg, | 
 | 2617 | 						msg_data_sz(fragm)); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2618 | 			/*  Prepare buffer for subsequent fragments. */ | 
 | 2619 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2620 | 			set_long_msg_seqno(pbuf, long_msg_seq_no); | 
| Allan Stephens | 0e65967 | 2010-12-31 18:59:32 +0000 | [diff] [blame] | 2621 | 			set_fragm_size(pbuf, fragm_sz); | 
 | 2622 | 			set_expected_frags(pbuf, exp_fragm_cnt - 1); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2623 | 		} else { | 
| Allan Stephens | a10bd92 | 2006-06-25 23:52:17 -0700 | [diff] [blame] | 2624 | 			warn("Link unable to reassemble fragmented message\n"); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2625 | 		} | 
 | 2626 | 		buf_discard(fbuf); | 
 | 2627 | 		return 0; | 
 | 2628 | 	} else if (pbuf && (msg_type(fragm) != FIRST_FRAGMENT)) { | 
 | 2629 | 		u32 dsz = msg_data_sz(fragm); | 
 | 2630 | 		u32 fsz = get_fragm_size(pbuf); | 
 | 2631 | 		u32 crs = ((msg_fragm_no(fragm) - 1) * fsz); | 
 | 2632 | 		u32 exp_frags = get_expected_frags(pbuf) - 1; | 
| Arnaldo Carvalho de Melo | 27d7ff4 | 2007-03-31 11:55:19 -0300 | [diff] [blame] | 2633 | 		skb_copy_to_linear_data_offset(pbuf, crs, | 
 | 2634 | 					       msg_data(fragm), dsz); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2635 | 		buf_discard(fbuf); | 
 | 2636 |  | 
 | 2637 | 		/* Is message complete? */ | 
 | 2638 |  | 
 | 2639 | 		if (exp_frags == 0) { | 
 | 2640 | 			if (prev) | 
 | 2641 | 				prev->next = pbuf->next; | 
 | 2642 | 			else | 
 | 2643 | 				*pending = pbuf->next; | 
 | 2644 | 			msg_reset_reroute_cnt(buf_msg(pbuf)); | 
 | 2645 | 			*fb = pbuf; | 
 | 2646 | 			*m = buf_msg(pbuf); | 
 | 2647 | 			return 1; | 
 | 2648 | 		} | 
| Allan Stephens | 0e65967 | 2010-12-31 18:59:32 +0000 | [diff] [blame] | 2649 | 		set_expected_frags(pbuf, exp_frags); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2650 | 		return 0; | 
 | 2651 | 	} | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2652 | 	buf_discard(fbuf); | 
 | 2653 | 	return 0; | 
 | 2654 | } | 
 | 2655 |  | 
 | 2656 | /** | 
 | 2657 |  * link_check_defragm_bufs - flush stale incoming message fragments | 
 | 2658 |  * @l_ptr: pointer to link | 
 | 2659 |  */ | 
 | 2660 |  | 
 | 2661 | static void link_check_defragm_bufs(struct link *l_ptr) | 
 | 2662 | { | 
| Sam Ravnborg | 1fc54d8 | 2006-03-20 22:36:47 -0800 | [diff] [blame] | 2663 | 	struct sk_buff *prev = NULL; | 
 | 2664 | 	struct sk_buff *next = NULL; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2665 | 	struct sk_buff *buf = l_ptr->defragm_buf; | 
 | 2666 |  | 
 | 2667 | 	if (!buf) | 
 | 2668 | 		return; | 
 | 2669 | 	if (!link_working_working(l_ptr)) | 
 | 2670 | 		return; | 
 | 2671 | 	while (buf) { | 
 | 2672 | 		u32 cnt = get_timer_cnt(buf); | 
 | 2673 |  | 
 | 2674 | 		next = buf->next; | 
 | 2675 | 		if (cnt < 4) { | 
 | 2676 | 			incr_timer_cnt(buf); | 
 | 2677 | 			prev = buf; | 
 | 2678 | 		} else { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2679 | 			if (prev) | 
 | 2680 | 				prev->next = buf->next; | 
 | 2681 | 			else | 
 | 2682 | 				l_ptr->defragm_buf = buf->next; | 
 | 2683 | 			buf_discard(buf); | 
 | 2684 | 		} | 
 | 2685 | 		buf = next; | 
 | 2686 | 	} | 
 | 2687 | } | 
 | 2688 |  | 
 | 2689 |  | 
 | 2690 |  | 
 | 2691 | static void link_set_supervision_props(struct link *l_ptr, u32 tolerance) | 
 | 2692 | { | 
| Allan Stephens | 5413b4c | 2011-01-18 13:24:55 -0500 | [diff] [blame] | 2693 | 	if ((tolerance < TIPC_MIN_LINK_TOL) || (tolerance > TIPC_MAX_LINK_TOL)) | 
 | 2694 | 		return; | 
 | 2695 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2696 | 	l_ptr->tolerance = tolerance; | 
 | 2697 | 	l_ptr->continuity_interval = | 
 | 2698 | 		((tolerance / 4) > 500) ? 500 : tolerance / 4; | 
 | 2699 | 	l_ptr->abort_limit = tolerance / (l_ptr->continuity_interval / 4); | 
 | 2700 | } | 
 | 2701 |  | 
 | 2702 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2703 | void tipc_link_set_queue_limits(struct link *l_ptr, u32 window) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2704 | { | 
 | 2705 | 	/* Data messages from this node, inclusive FIRST_FRAGM */ | 
| Allan Stephens | 06d82c9 | 2008-03-06 15:06:55 -0800 | [diff] [blame] | 2706 | 	l_ptr->queue_limit[TIPC_LOW_IMPORTANCE] = window; | 
 | 2707 | 	l_ptr->queue_limit[TIPC_MEDIUM_IMPORTANCE] = (window / 3) * 4; | 
 | 2708 | 	l_ptr->queue_limit[TIPC_HIGH_IMPORTANCE] = (window / 3) * 5; | 
 | 2709 | 	l_ptr->queue_limit[TIPC_CRITICAL_IMPORTANCE] = (window / 3) * 6; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2710 | 	/* Transiting data messages,inclusive FIRST_FRAGM */ | 
| Allan Stephens | 06d82c9 | 2008-03-06 15:06:55 -0800 | [diff] [blame] | 2711 | 	l_ptr->queue_limit[TIPC_LOW_IMPORTANCE + 4] = 300; | 
 | 2712 | 	l_ptr->queue_limit[TIPC_MEDIUM_IMPORTANCE + 4] = 600; | 
 | 2713 | 	l_ptr->queue_limit[TIPC_HIGH_IMPORTANCE + 4] = 900; | 
 | 2714 | 	l_ptr->queue_limit[TIPC_CRITICAL_IMPORTANCE + 4] = 1200; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2715 | 	l_ptr->queue_limit[CONN_MANAGER] = 1200; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2716 | 	l_ptr->queue_limit[CHANGEOVER_PROTOCOL] = 2500; | 
 | 2717 | 	l_ptr->queue_limit[NAME_DISTRIBUTOR] = 3000; | 
 | 2718 | 	/* FRAGMENT and LAST_FRAGMENT packets */ | 
 | 2719 | 	l_ptr->queue_limit[MSG_FRAGMENTER] = 4000; | 
 | 2720 | } | 
 | 2721 |  | 
 | 2722 | /** | 
 | 2723 |  * link_find_link - locate link by name | 
 | 2724 |  * @name - ptr to link name string | 
 | 2725 |  * @node - ptr to area to be filled with ptr to associated node | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2726 |  * | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2727 |  * Caller must hold 'tipc_net_lock' to ensure node and bearer are not deleted; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2728 |  * this also prevents link deletion. | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2729 |  * | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2730 |  * Returns pointer to link (or 0 if invalid link name). | 
 | 2731 |  */ | 
 | 2732 |  | 
| David S. Miller | 6c00055 | 2008-09-02 23:38:32 -0700 | [diff] [blame] | 2733 | static struct link *link_find_link(const char *name, struct tipc_node **node) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2734 | { | 
 | 2735 | 	struct link_name link_name_parts; | 
| Allan Stephens | 2d627b9 | 2011-01-07 13:00:11 -0500 | [diff] [blame] | 2736 | 	struct tipc_bearer *b_ptr; | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2737 | 	struct link *l_ptr; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2738 |  | 
 | 2739 | 	if (!link_name_validate(name, &link_name_parts)) | 
| Sam Ravnborg | 1fc54d8 | 2006-03-20 22:36:47 -0800 | [diff] [blame] | 2740 | 		return NULL; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2741 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2742 | 	b_ptr = tipc_bearer_find_interface(link_name_parts.if_local); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2743 | 	if (!b_ptr) | 
| Sam Ravnborg | 1fc54d8 | 2006-03-20 22:36:47 -0800 | [diff] [blame] | 2744 | 		return NULL; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2745 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2746 | 	*node = tipc_node_find(link_name_parts.addr_peer); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2747 | 	if (!*node) | 
| Sam Ravnborg | 1fc54d8 | 2006-03-20 22:36:47 -0800 | [diff] [blame] | 2748 | 		return NULL; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2749 |  | 
 | 2750 | 	l_ptr = (*node)->links[b_ptr->identity]; | 
 | 2751 | 	if (!l_ptr || strcmp(l_ptr->name, name)) | 
| Sam Ravnborg | 1fc54d8 | 2006-03-20 22:36:47 -0800 | [diff] [blame] | 2752 | 		return NULL; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2753 |  | 
 | 2754 | 	return l_ptr; | 
 | 2755 | } | 
 | 2756 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2757 | struct sk_buff *tipc_link_cmd_config(const void *req_tlv_area, int req_tlv_space, | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2758 | 				     u16 cmd) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2759 | { | 
 | 2760 | 	struct tipc_link_config *args; | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2761 | 	u32 new_value; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2762 | 	struct link *l_ptr; | 
| David S. Miller | 6c00055 | 2008-09-02 23:38:32 -0700 | [diff] [blame] | 2763 | 	struct tipc_node *node; | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2764 | 	int res; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2765 |  | 
 | 2766 | 	if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_LINK_CONFIG)) | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2767 | 		return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2768 |  | 
 | 2769 | 	args = (struct tipc_link_config *)TLV_DATA(req_tlv_area); | 
 | 2770 | 	new_value = ntohl(args->value); | 
 | 2771 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2772 | 	if (!strcmp(args->name, tipc_bclink_name)) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2773 | 		if ((cmd == TIPC_CMD_SET_LINK_WINDOW) && | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2774 | 		    (tipc_bclink_set_queue_limits(new_value) == 0)) | 
 | 2775 | 			return tipc_cfg_reply_none(); | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2776 | 		return tipc_cfg_reply_error_string(TIPC_CFG_NOT_SUPPORTED | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2777 | 						   " (cannot change setting on broadcast link)"); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2778 | 	} | 
 | 2779 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2780 | 	read_lock_bh(&tipc_net_lock); | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2781 | 	l_ptr = link_find_link(args->name, &node); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2782 | 	if (!l_ptr) { | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2783 | 		read_unlock_bh(&tipc_net_lock); | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2784 | 		return tipc_cfg_reply_error_string("link not found"); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2785 | 	} | 
 | 2786 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2787 | 	tipc_node_lock(node); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2788 | 	res = -EINVAL; | 
 | 2789 | 	switch (cmd) { | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2790 | 	case TIPC_CMD_SET_LINK_TOL: | 
 | 2791 | 		if ((new_value >= TIPC_MIN_LINK_TOL) && | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2792 | 		    (new_value <= TIPC_MAX_LINK_TOL)) { | 
 | 2793 | 			link_set_supervision_props(l_ptr, new_value); | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2794 | 			tipc_link_send_proto_msg(l_ptr, STATE_MSG, | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2795 | 						 0, 0, new_value, 0, 0); | 
| Allan Stephens | 0e35fd5 | 2008-07-14 22:44:01 -0700 | [diff] [blame] | 2796 | 			res = 0; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2797 | 		} | 
 | 2798 | 		break; | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2799 | 	case TIPC_CMD_SET_LINK_PRI: | 
| Per Liden | 16cb4b3 | 2006-01-13 22:22:22 +0100 | [diff] [blame] | 2800 | 		if ((new_value >= TIPC_MIN_LINK_PRI) && | 
 | 2801 | 		    (new_value <= TIPC_MAX_LINK_PRI)) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2802 | 			l_ptr->priority = new_value; | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2803 | 			tipc_link_send_proto_msg(l_ptr, STATE_MSG, | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2804 | 						 0, 0, 0, new_value, 0); | 
| Allan Stephens | 0e35fd5 | 2008-07-14 22:44:01 -0700 | [diff] [blame] | 2805 | 			res = 0; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2806 | 		} | 
 | 2807 | 		break; | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2808 | 	case TIPC_CMD_SET_LINK_WINDOW: | 
 | 2809 | 		if ((new_value >= TIPC_MIN_LINK_WIN) && | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2810 | 		    (new_value <= TIPC_MAX_LINK_WIN)) { | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2811 | 			tipc_link_set_queue_limits(l_ptr, new_value); | 
| Allan Stephens | 0e35fd5 | 2008-07-14 22:44:01 -0700 | [diff] [blame] | 2812 | 			res = 0; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2813 | 		} | 
 | 2814 | 		break; | 
 | 2815 | 	} | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2816 | 	tipc_node_unlock(node); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2817 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2818 | 	read_unlock_bh(&tipc_net_lock); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2819 | 	if (res) | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2820 | 		return tipc_cfg_reply_error_string("cannot change link setting"); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2821 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2822 | 	return tipc_cfg_reply_none(); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2823 | } | 
 | 2824 |  | 
 | 2825 | /** | 
 | 2826 |  * link_reset_statistics - reset link statistics | 
 | 2827 |  * @l_ptr: pointer to link | 
 | 2828 |  */ | 
 | 2829 |  | 
 | 2830 | static void link_reset_statistics(struct link *l_ptr) | 
 | 2831 | { | 
 | 2832 | 	memset(&l_ptr->stats, 0, sizeof(l_ptr->stats)); | 
 | 2833 | 	l_ptr->stats.sent_info = l_ptr->next_out_no; | 
 | 2834 | 	l_ptr->stats.recv_info = l_ptr->next_in_no; | 
 | 2835 | } | 
 | 2836 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2837 | struct sk_buff *tipc_link_cmd_reset_stats(const void *req_tlv_area, int req_tlv_space) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2838 | { | 
 | 2839 | 	char *link_name; | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2840 | 	struct link *l_ptr; | 
| David S. Miller | 6c00055 | 2008-09-02 23:38:32 -0700 | [diff] [blame] | 2841 | 	struct tipc_node *node; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2842 |  | 
 | 2843 | 	if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_LINK_NAME)) | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2844 | 		return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2845 |  | 
 | 2846 | 	link_name = (char *)TLV_DATA(req_tlv_area); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2847 | 	if (!strcmp(link_name, tipc_bclink_name)) { | 
 | 2848 | 		if (tipc_bclink_reset_stats()) | 
 | 2849 | 			return tipc_cfg_reply_error_string("link not found"); | 
 | 2850 | 		return tipc_cfg_reply_none(); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2851 | 	} | 
 | 2852 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2853 | 	read_lock_bh(&tipc_net_lock); | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2854 | 	l_ptr = link_find_link(link_name, &node); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2855 | 	if (!l_ptr) { | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2856 | 		read_unlock_bh(&tipc_net_lock); | 
 | 2857 | 		return tipc_cfg_reply_error_string("link not found"); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2858 | 	} | 
 | 2859 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2860 | 	tipc_node_lock(node); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2861 | 	link_reset_statistics(l_ptr); | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2862 | 	tipc_node_unlock(node); | 
 | 2863 | 	read_unlock_bh(&tipc_net_lock); | 
 | 2864 | 	return tipc_cfg_reply_none(); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2865 | } | 
 | 2866 |  | 
 | 2867 | /** | 
 | 2868 |  * percent - convert count to a percentage of total (rounding up or down) | 
 | 2869 |  */ | 
 | 2870 |  | 
 | 2871 | static u32 percent(u32 count, u32 total) | 
 | 2872 | { | 
 | 2873 | 	return (count * 100 + (total / 2)) / total; | 
 | 2874 | } | 
 | 2875 |  | 
 | 2876 | /** | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2877 |  * tipc_link_stats - print link statistics | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2878 |  * @name: link name | 
 | 2879 |  * @buf: print buffer area | 
 | 2880 |  * @buf_size: size of print buffer area | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2881 |  * | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2882 |  * Returns length of print buffer data string (or 0 if error) | 
 | 2883 |  */ | 
 | 2884 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2885 | static int tipc_link_stats(const char *name, char *buf, const u32 buf_size) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2886 | { | 
 | 2887 | 	struct print_buf pb; | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2888 | 	struct link *l_ptr; | 
| David S. Miller | 6c00055 | 2008-09-02 23:38:32 -0700 | [diff] [blame] | 2889 | 	struct tipc_node *node; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2890 | 	char *status; | 
 | 2891 | 	u32 profile_total = 0; | 
 | 2892 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2893 | 	if (!strcmp(name, tipc_bclink_name)) | 
 | 2894 | 		return tipc_bclink_stats(buf, buf_size); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2895 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2896 | 	tipc_printbuf_init(&pb, buf, buf_size); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2897 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2898 | 	read_lock_bh(&tipc_net_lock); | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2899 | 	l_ptr = link_find_link(name, &node); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2900 | 	if (!l_ptr) { | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2901 | 		read_unlock_bh(&tipc_net_lock); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2902 | 		return 0; | 
 | 2903 | 	} | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2904 | 	tipc_node_lock(node); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2905 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2906 | 	if (tipc_link_is_active(l_ptr)) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2907 | 		status = "ACTIVE"; | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2908 | 	else if (tipc_link_is_up(l_ptr)) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2909 | 		status = "STANDBY"; | 
 | 2910 | 	else | 
 | 2911 | 		status = "DEFUNCT"; | 
 | 2912 | 	tipc_printf(&pb, "Link <%s>\n" | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2913 | 			 "  %s  MTU:%u  Priority:%u  Tolerance:%u ms" | 
 | 2914 | 			 "  Window:%u packets\n", | 
| Allan Stephens | 15e979d | 2010-05-11 14:30:10 +0000 | [diff] [blame] | 2915 | 		    l_ptr->name, status, l_ptr->max_pkt, | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2916 | 		    l_ptr->priority, l_ptr->tolerance, l_ptr->queue_limit[0]); | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2917 | 	tipc_printf(&pb, "  RX packets:%u fragments:%u/%u bundles:%u/%u\n", | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2918 | 		    l_ptr->next_in_no - l_ptr->stats.recv_info, | 
 | 2919 | 		    l_ptr->stats.recv_fragments, | 
 | 2920 | 		    l_ptr->stats.recv_fragmented, | 
 | 2921 | 		    l_ptr->stats.recv_bundles, | 
 | 2922 | 		    l_ptr->stats.recv_bundled); | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2923 | 	tipc_printf(&pb, "  TX packets:%u fragments:%u/%u bundles:%u/%u\n", | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2924 | 		    l_ptr->next_out_no - l_ptr->stats.sent_info, | 
 | 2925 | 		    l_ptr->stats.sent_fragments, | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2926 | 		    l_ptr->stats.sent_fragmented, | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2927 | 		    l_ptr->stats.sent_bundles, | 
 | 2928 | 		    l_ptr->stats.sent_bundled); | 
 | 2929 | 	profile_total = l_ptr->stats.msg_length_counts; | 
 | 2930 | 	if (!profile_total) | 
 | 2931 | 		profile_total = 1; | 
 | 2932 | 	tipc_printf(&pb, "  TX profile sample:%u packets  average:%u octets\n" | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2933 | 			 "  0-64:%u%% -256:%u%% -1024:%u%% -4096:%u%% " | 
| Allan Stephens | 0f305bf | 2011-05-30 15:36:56 -0400 | [diff] [blame] | 2934 | 			 "-16384:%u%% -32768:%u%% -66000:%u%%\n", | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2935 | 		    l_ptr->stats.msg_length_counts, | 
 | 2936 | 		    l_ptr->stats.msg_lengths_total / profile_total, | 
 | 2937 | 		    percent(l_ptr->stats.msg_length_profile[0], profile_total), | 
 | 2938 | 		    percent(l_ptr->stats.msg_length_profile[1], profile_total), | 
 | 2939 | 		    percent(l_ptr->stats.msg_length_profile[2], profile_total), | 
 | 2940 | 		    percent(l_ptr->stats.msg_length_profile[3], profile_total), | 
 | 2941 | 		    percent(l_ptr->stats.msg_length_profile[4], profile_total), | 
 | 2942 | 		    percent(l_ptr->stats.msg_length_profile[5], profile_total), | 
 | 2943 | 		    percent(l_ptr->stats.msg_length_profile[6], profile_total)); | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2944 | 	tipc_printf(&pb, "  RX states:%u probes:%u naks:%u defs:%u dups:%u\n", | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2945 | 		    l_ptr->stats.recv_states, | 
 | 2946 | 		    l_ptr->stats.recv_probes, | 
 | 2947 | 		    l_ptr->stats.recv_nacks, | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2948 | 		    l_ptr->stats.deferred_recv, | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2949 | 		    l_ptr->stats.duplicates); | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2950 | 	tipc_printf(&pb, "  TX states:%u probes:%u naks:%u acks:%u dups:%u\n", | 
 | 2951 | 		    l_ptr->stats.sent_states, | 
 | 2952 | 		    l_ptr->stats.sent_probes, | 
 | 2953 | 		    l_ptr->stats.sent_nacks, | 
 | 2954 | 		    l_ptr->stats.sent_acks, | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2955 | 		    l_ptr->stats.retransmitted); | 
 | 2956 | 	tipc_printf(&pb, "  Congestion bearer:%u link:%u  Send queue max:%u avg:%u\n", | 
 | 2957 | 		    l_ptr->stats.bearer_congs, | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2958 | 		    l_ptr->stats.link_congs, | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2959 | 		    l_ptr->stats.max_queue_sz, | 
 | 2960 | 		    l_ptr->stats.queue_sz_counts | 
 | 2961 | 		    ? (l_ptr->stats.accu_queue_sz / l_ptr->stats.queue_sz_counts) | 
 | 2962 | 		    : 0); | 
 | 2963 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2964 | 	tipc_node_unlock(node); | 
 | 2965 | 	read_unlock_bh(&tipc_net_lock); | 
 | 2966 | 	return tipc_printbuf_validate(&pb); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2967 | } | 
 | 2968 |  | 
 | 2969 | #define MAX_LINK_STATS_INFO 2000 | 
 | 2970 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2971 | struct sk_buff *tipc_link_cmd_show_stats(const void *req_tlv_area, int req_tlv_space) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2972 | { | 
 | 2973 | 	struct sk_buff *buf; | 
 | 2974 | 	struct tlv_desc *rep_tlv; | 
 | 2975 | 	int str_len; | 
 | 2976 |  | 
 | 2977 | 	if (!TLV_CHECK(req_tlv_area, req_tlv_space, TIPC_TLV_LINK_NAME)) | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2978 | 		return tipc_cfg_reply_error_string(TIPC_CFG_TLV_ERROR); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2979 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2980 | 	buf = tipc_cfg_reply_alloc(TLV_SPACE(MAX_LINK_STATS_INFO)); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2981 | 	if (!buf) | 
 | 2982 | 		return NULL; | 
 | 2983 |  | 
 | 2984 | 	rep_tlv = (struct tlv_desc *)buf->data; | 
 | 2985 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 2986 | 	str_len = tipc_link_stats((char *)TLV_DATA(req_tlv_area), | 
 | 2987 | 				  (char *)TLV_DATA(rep_tlv), MAX_LINK_STATS_INFO); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2988 | 	if (!str_len) { | 
 | 2989 | 		buf_discard(buf); | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 2990 | 		return tipc_cfg_reply_error_string("link not found"); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2991 | 	} | 
 | 2992 |  | 
 | 2993 | 	skb_put(buf, TLV_SPACE(str_len)); | 
 | 2994 | 	TLV_SET(rep_tlv, TIPC_TLV_ULTRA_STRING, NULL, str_len); | 
 | 2995 |  | 
 | 2996 | 	return buf; | 
 | 2997 | } | 
 | 2998 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 2999 | /** | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 3000 |  * tipc_link_get_max_pkt - get maximum packet size to use when sending to destination | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 3001 |  * @dest: network address of destination node | 
 | 3002 |  * @selector: used to select from set of active links | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 3003 |  * | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 3004 |  * If no active link can be found, uses default maximum packet size. | 
 | 3005 |  */ | 
 | 3006 |  | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 3007 | u32 tipc_link_get_max_pkt(u32 dest, u32 selector) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 3008 | { | 
| David S. Miller | 6c00055 | 2008-09-02 23:38:32 -0700 | [diff] [blame] | 3009 | 	struct tipc_node *n_ptr; | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 3010 | 	struct link *l_ptr; | 
 | 3011 | 	u32 res = MAX_PKT_DEFAULT; | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 3012 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 3013 | 	if (dest == tipc_own_addr) | 
 | 3014 | 		return MAX_MSG_SIZE; | 
 | 3015 |  | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 3016 | 	read_lock_bh(&tipc_net_lock); | 
| Allan Stephens | 51a8e4d | 2010-12-31 18:59:18 +0000 | [diff] [blame] | 3017 | 	n_ptr = tipc_node_find(dest); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 3018 | 	if (n_ptr) { | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 3019 | 		tipc_node_lock(n_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 3020 | 		l_ptr = n_ptr->active_links[selector & 1]; | 
 | 3021 | 		if (l_ptr) | 
| Allan Stephens | 15e979d | 2010-05-11 14:30:10 +0000 | [diff] [blame] | 3022 | 			res = l_ptr->max_pkt; | 
| Per Liden | 4323add | 2006-01-18 00:38:21 +0100 | [diff] [blame] | 3023 | 		tipc_node_unlock(n_ptr); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 3024 | 	} | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 3025 | 	read_unlock_bh(&tipc_net_lock); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 3026 | 	return res; | 
 | 3027 | } | 
 | 3028 |  | 
| Allan Stephens | 8d64a5b | 2010-12-31 18:59:27 +0000 | [diff] [blame] | 3029 | static void link_print(struct link *l_ptr, const char *str) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 3030 | { | 
| Allan Stephens | 8d64a5b | 2010-12-31 18:59:27 +0000 | [diff] [blame] | 3031 | 	char print_area[256]; | 
 | 3032 | 	struct print_buf pb; | 
 | 3033 | 	struct print_buf *buf = &pb; | 
 | 3034 |  | 
 | 3035 | 	tipc_printbuf_init(buf, print_area, sizeof(print_area)); | 
 | 3036 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 3037 | 	tipc_printf(buf, str); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 3038 | 	tipc_printf(buf, "Link %x<%s>:", | 
| Allan Stephens | 2d627b9 | 2011-01-07 13:00:11 -0500 | [diff] [blame] | 3039 | 		    l_ptr->addr, l_ptr->b_ptr->name); | 
| Allan Stephens | 8d64a5b | 2010-12-31 18:59:27 +0000 | [diff] [blame] | 3040 |  | 
 | 3041 | #ifdef CONFIG_TIPC_DEBUG | 
 | 3042 | 	if (link_reset_reset(l_ptr) || link_reset_unknown(l_ptr)) | 
 | 3043 | 		goto print_state; | 
 | 3044 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 3045 | 	tipc_printf(buf, ": NXO(%u):", mod(l_ptr->next_out_no)); | 
 | 3046 | 	tipc_printf(buf, "NXI(%u):", mod(l_ptr->next_in_no)); | 
 | 3047 | 	tipc_printf(buf, "SQUE"); | 
 | 3048 | 	if (l_ptr->first_out) { | 
 | 3049 | 		tipc_printf(buf, "[%u..", msg_seqno(buf_msg(l_ptr->first_out))); | 
 | 3050 | 		if (l_ptr->next_out) | 
 | 3051 | 			tipc_printf(buf, "%u..", | 
 | 3052 | 				    msg_seqno(buf_msg(l_ptr->next_out))); | 
| Allan Stephens | b82834e | 2010-05-11 14:30:04 +0000 | [diff] [blame] | 3053 | 		tipc_printf(buf, "%u]", msg_seqno(buf_msg(l_ptr->last_out))); | 
| YOSHIFUJI Hideaki | c430728 | 2007-02-09 23:25:21 +0900 | [diff] [blame] | 3054 | 		if ((mod(msg_seqno(buf_msg(l_ptr->last_out)) - | 
 | 3055 | 			 msg_seqno(buf_msg(l_ptr->first_out))) | 
| Joe Perches | f64f9e7 | 2009-11-29 16:55:45 -0800 | [diff] [blame] | 3056 | 		     != (l_ptr->out_queue_size - 1)) || | 
 | 3057 | 		    (l_ptr->last_out->next != NULL)) { | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 3058 | 			tipc_printf(buf, "\nSend queue inconsistency\n"); | 
| Allan Stephens | c8a61b5 | 2011-01-18 13:31:32 -0500 | [diff] [blame] | 3059 | 			tipc_printf(buf, "first_out= %p ", l_ptr->first_out); | 
 | 3060 | 			tipc_printf(buf, "next_out= %p ", l_ptr->next_out); | 
 | 3061 | 			tipc_printf(buf, "last_out= %p ", l_ptr->last_out); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 3062 | 		} | 
 | 3063 | 	} else | 
 | 3064 | 		tipc_printf(buf, "[]"); | 
 | 3065 | 	tipc_printf(buf, "SQSIZ(%u)", l_ptr->out_queue_size); | 
 | 3066 | 	if (l_ptr->oldest_deferred_in) { | 
 | 3067 | 		u32 o = msg_seqno(buf_msg(l_ptr->oldest_deferred_in)); | 
 | 3068 | 		u32 n = msg_seqno(buf_msg(l_ptr->newest_deferred_in)); | 
 | 3069 | 		tipc_printf(buf, ":RQUE[%u..%u]", o, n); | 
 | 3070 | 		if (l_ptr->deferred_inqueue_sz != mod((n + 1) - o)) { | 
 | 3071 | 			tipc_printf(buf, ":RQSIZ(%u)", | 
 | 3072 | 				    l_ptr->deferred_inqueue_sz); | 
 | 3073 | 		} | 
 | 3074 | 	} | 
| Allan Stephens | 8d64a5b | 2010-12-31 18:59:27 +0000 | [diff] [blame] | 3075 | print_state: | 
 | 3076 | #endif | 
 | 3077 |  | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 3078 | 	if (link_working_unknown(l_ptr)) | 
 | 3079 | 		tipc_printf(buf, ":WU"); | 
| Allan Stephens | 8d64a5b | 2010-12-31 18:59:27 +0000 | [diff] [blame] | 3080 | 	else if (link_reset_reset(l_ptr)) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 3081 | 		tipc_printf(buf, ":RR"); | 
| Allan Stephens | 8d64a5b | 2010-12-31 18:59:27 +0000 | [diff] [blame] | 3082 | 	else if (link_reset_unknown(l_ptr)) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 3083 | 		tipc_printf(buf, ":RU"); | 
| Allan Stephens | 8d64a5b | 2010-12-31 18:59:27 +0000 | [diff] [blame] | 3084 | 	else if (link_working_working(l_ptr)) | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 3085 | 		tipc_printf(buf, ":WW"); | 
 | 3086 | 	tipc_printf(buf, "\n"); | 
| Allan Stephens | 8d64a5b | 2010-12-31 18:59:27 +0000 | [diff] [blame] | 3087 |  | 
 | 3088 | 	tipc_printbuf_validate(buf); | 
 | 3089 | 	info("%s", print_area); | 
| Per Liden | b97bf3f | 2006-01-02 19:04:38 +0100 | [diff] [blame] | 3090 | } | 
 | 3091 |  |