blob: 881914bc4e9c0177a371c76c9781568aa0b4ffdd [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * Copyright(c) 1999 - 2004 Intel Corporation. All rights reserved.
3 *
4 * This program is free software; you can redistribute it and/or modify it
5 * under the terms of the GNU General Public License as published by the Free
6 * Software Foundation; either version 2 of the License, or (at your option)
7 * any later version.
8 *
9 * This program is distributed in the hope that it will be useful, but WITHOUT
10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
12 * more details.
13 *
14 * You should have received a copy of the GNU General Public License along with
15 * this program; if not, write to the Free Software Foundation, Inc., 59
16 * Temple Place - Suite 330, Boston, MA 02111-1307, USA.
17 *
18 * The full GNU General Public License is included in this distribution in the
19 * file called LICENSE.
20 *
Linus Torvalds1da177e2005-04-16 15:20:36 -070021 */
22
Joe Perchesa4aee5c2009-12-13 20:06:07 -080023#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
24
Linus Torvalds1da177e2005-04-16 15:20:36 -070025#include <linux/skbuff.h>
26#include <linux/if_ether.h>
27#include <linux/netdevice.h>
28#include <linux/spinlock.h>
29#include <linux/ethtool.h>
Jay Vosburghfd989c82008-11-04 17:51:16 -080030#include <linux/etherdevice.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070031#include <linux/if_bonding.h>
32#include <linux/pkt_sched.h>
Eric W. Biedermane730c152007-09-17 11:53:39 -070033#include <net/net_namespace.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070034#include "bonding.h"
35#include "bond_3ad.h"
36
37// General definitions
38#define AD_SHORT_TIMEOUT 1
39#define AD_LONG_TIMEOUT 0
40#define AD_STANDBY 0x2
41#define AD_MAX_TX_IN_SECOND 3
42#define AD_COLLECTOR_MAX_DELAY 0
43
44// Timer definitions(43.4.4 in the 802.3ad standard)
45#define AD_FAST_PERIODIC_TIME 1
46#define AD_SLOW_PERIODIC_TIME 30
47#define AD_SHORT_TIMEOUT_TIME (3*AD_FAST_PERIODIC_TIME)
48#define AD_LONG_TIMEOUT_TIME (3*AD_SLOW_PERIODIC_TIME)
49#define AD_CHURN_DETECTION_TIME 60
50#define AD_AGGREGATE_WAIT_TIME 2
51
52// Port state definitions(43.4.2.2 in the 802.3ad standard)
53#define AD_STATE_LACP_ACTIVITY 0x1
54#define AD_STATE_LACP_TIMEOUT 0x2
55#define AD_STATE_AGGREGATION 0x4
56#define AD_STATE_SYNCHRONIZATION 0x8
57#define AD_STATE_COLLECTING 0x10
58#define AD_STATE_DISTRIBUTING 0x20
59#define AD_STATE_DEFAULTED 0x40
60#define AD_STATE_EXPIRED 0x80
61
62// Port Variables definitions used by the State Machines(43.4.7 in the 802.3ad standard)
63#define AD_PORT_BEGIN 0x1
64#define AD_PORT_LACP_ENABLED 0x2
65#define AD_PORT_ACTOR_CHURN 0x4
66#define AD_PORT_PARTNER_CHURN 0x8
67#define AD_PORT_READY 0x10
68#define AD_PORT_READY_N 0x20
69#define AD_PORT_MATCHED 0x40
70#define AD_PORT_STANDBY 0x80
71#define AD_PORT_SELECTED 0x100
72#define AD_PORT_MOVED 0x200
73
74// Port Key definitions
75// key is determined according to the link speed, duplex and
76// user key(which is yet not supported)
77// ------------------------------------------------------------
78// Port key : | User key | Speed |Duplex|
79// ------------------------------------------------------------
80// 16 6 1 0
81#define AD_DUPLEX_KEY_BITS 0x1
82#define AD_SPEED_KEY_BITS 0x3E
83#define AD_USER_KEY_BITS 0xFFC0
84
85//dalloun
86#define AD_LINK_SPEED_BITMASK_1MBPS 0x1
87#define AD_LINK_SPEED_BITMASK_10MBPS 0x2
88#define AD_LINK_SPEED_BITMASK_100MBPS 0x4
89#define AD_LINK_SPEED_BITMASK_1000MBPS 0x8
Jay Vosburgh94dbffd2006-09-22 21:52:15 -070090#define AD_LINK_SPEED_BITMASK_10000MBPS 0x10
Linus Torvalds1da177e2005-04-16 15:20:36 -070091//endalloun
92
93// compare MAC addresses
94#define MAC_ADDRESS_COMPARE(A, B) memcmp(A, B, ETH_ALEN)
95
Bandan Das128ea6c2010-10-16 20:19:58 +000096static struct mac_addr null_mac_addr = { { 0, 0, 0, 0, 0, 0 } };
Linus Torvalds1da177e2005-04-16 15:20:36 -070097static u16 ad_ticks_per_sec;
98static const int ad_delta_in_ticks = (AD_TIMER_INTERVAL * HZ) / 1000;
99
Holger Eitzenbergere4ac4322008-12-26 13:40:48 -0800100static const u8 lacpdu_mcast_addr[ETH_ALEN] = MULTICAST_LACPDU_ADDR;
101
Linus Torvalds1da177e2005-04-16 15:20:36 -0700102// ================= main 802.3ad protocol functions ==================
103static int ad_lacpdu_send(struct port *port);
Mathieu Desnoyers1c3f0b82007-10-18 23:41:04 -0700104static int ad_marker_send(struct port *port, struct bond_marker *marker);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700105static void ad_mux_machine(struct port *port);
106static void ad_rx_machine(struct lacpdu *lacpdu, struct port *port);
107static void ad_tx_machine(struct port *port);
108static void ad_periodic_machine(struct port *port);
109static void ad_port_selection_logic(struct port *port);
110static void ad_agg_selection_logic(struct aggregator *aggregator);
111static void ad_clear_agg(struct aggregator *aggregator);
112static void ad_initialize_agg(struct aggregator *aggregator);
113static void ad_initialize_port(struct port *port, int lacp_fast);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700114static void ad_enable_collecting_distributing(struct port *port);
115static void ad_disable_collecting_distributing(struct port *port);
Mathieu Desnoyers1c3f0b82007-10-18 23:41:04 -0700116static void ad_marker_info_received(struct bond_marker *marker_info, struct port *port);
117static void ad_marker_response_received(struct bond_marker *marker, struct port *port);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700118
119
120/////////////////////////////////////////////////////////////////////////////////
121// ================= api to bonding and kernel code ==================
122/////////////////////////////////////////////////////////////////////////////////
123
124/**
125 * __get_bond_by_port - get the port's bonding struct
126 * @port: the port we're looking at
127 *
128 * Return @port's bonding struct, or %NULL if it can't be found.
129 */
130static inline struct bonding *__get_bond_by_port(struct port *port)
131{
Bandan Das7bfc4752010-10-16 20:19:59 +0000132 if (port->slave == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700133 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700134
135 return bond_get_bond_by_slave(port->slave);
136}
137
138/**
139 * __get_first_port - get the first port in the bond
140 * @bond: the bond we're looking at
141 *
142 * Return the port of the first slave in @bond, or %NULL if it can't be found.
143 */
144static inline struct port *__get_first_port(struct bonding *bond)
145{
Bandan Das7bfc4752010-10-16 20:19:59 +0000146 if (bond->slave_cnt == 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700147 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700148
149 return &(SLAVE_AD_INFO(bond->first_slave).port);
150}
151
152/**
153 * __get_next_port - get the next port in the bond
154 * @port: the port we're looking at
155 *
156 * Return the port of the slave that is next in line of @port's slave in the
157 * bond, or %NULL if it can't be found.
158 */
159static inline struct port *__get_next_port(struct port *port)
160{
161 struct bonding *bond = __get_bond_by_port(port);
162 struct slave *slave = port->slave;
163
164 // If there's no bond for this port, or this is the last slave
Bandan Das7bfc4752010-10-16 20:19:59 +0000165 if ((bond == NULL) || (slave->next == bond->first_slave))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700166 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700167
168 return &(SLAVE_AD_INFO(slave->next).port);
169}
170
171/**
172 * __get_first_agg - get the first aggregator in the bond
173 * @bond: the bond we're looking at
174 *
175 * Return the aggregator of the first slave in @bond, or %NULL if it can't be
176 * found.
177 */
178static inline struct aggregator *__get_first_agg(struct port *port)
179{
180 struct bonding *bond = __get_bond_by_port(port);
181
182 // If there's no bond for this port, or bond has no slaves
Bandan Das7bfc4752010-10-16 20:19:59 +0000183 if ((bond == NULL) || (bond->slave_cnt == 0))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700184 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700185
186 return &(SLAVE_AD_INFO(bond->first_slave).aggregator);
187}
188
189/**
190 * __get_next_agg - get the next aggregator in the bond
191 * @aggregator: the aggregator we're looking at
192 *
193 * Return the aggregator of the slave that is next in line of @aggregator's
194 * slave in the bond, or %NULL if it can't be found.
195 */
196static inline struct aggregator *__get_next_agg(struct aggregator *aggregator)
197{
198 struct slave *slave = aggregator->slave;
199 struct bonding *bond = bond_get_bond_by_slave(slave);
200
201 // If there's no bond for this aggregator, or this is the last slave
Bandan Das7bfc4752010-10-16 20:19:59 +0000202 if ((bond == NULL) || (slave->next == bond->first_slave))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700203 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700204
205 return &(SLAVE_AD_INFO(slave->next).aggregator);
206}
207
Jay Vosburghfd989c82008-11-04 17:51:16 -0800208/*
209 * __agg_has_partner
210 *
211 * Return nonzero if aggregator has a partner (denoted by a non-zero ether
212 * address for the partner). Return 0 if not.
213 */
214static inline int __agg_has_partner(struct aggregator *agg)
215{
216 return !is_zero_ether_addr(agg->partner_system.mac_addr_value);
217}
218
Linus Torvalds1da177e2005-04-16 15:20:36 -0700219/**
220 * __disable_port - disable the port's slave
221 * @port: the port we're looking at
222 *
223 */
224static inline void __disable_port(struct port *port)
225{
226 bond_set_slave_inactive_flags(port->slave);
227}
228
229/**
230 * __enable_port - enable the port's slave, if it's up
231 * @port: the port we're looking at
232 *
233 */
234static inline void __enable_port(struct port *port)
235{
236 struct slave *slave = port->slave;
237
Bandan Das7bfc4752010-10-16 20:19:59 +0000238 if ((slave->link == BOND_LINK_UP) && IS_UP(slave->dev))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700239 bond_set_slave_active_flags(slave);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700240}
241
242/**
243 * __port_is_enabled - check if the port's slave is in active state
244 * @port: the port we're looking at
245 *
246 */
247static inline int __port_is_enabled(struct port *port)
248{
Eric Dumazet807540b2010-09-23 05:40:09 +0000249 return port->slave->state == BOND_STATE_ACTIVE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700250}
251
252/**
253 * __get_agg_selection_mode - get the aggregator selection mode
254 * @port: the port we're looking at
255 *
Jay Vosburghfd989c82008-11-04 17:51:16 -0800256 * Get the aggregator selection mode. Can be %STABLE, %BANDWIDTH or %COUNT.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700257 */
258static inline u32 __get_agg_selection_mode(struct port *port)
259{
260 struct bonding *bond = __get_bond_by_port(port);
261
Bandan Das7bfc4752010-10-16 20:19:59 +0000262 if (bond == NULL)
Jay Vosburghfd989c82008-11-04 17:51:16 -0800263 return BOND_AD_STABLE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700264
265 return BOND_AD_INFO(bond).agg_select_mode;
266}
267
268/**
269 * __check_agg_selection_timer - check if the selection timer has expired
270 * @port: the port we're looking at
271 *
272 */
273static inline int __check_agg_selection_timer(struct port *port)
274{
275 struct bonding *bond = __get_bond_by_port(port);
276
Bandan Das7bfc4752010-10-16 20:19:59 +0000277 if (bond == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700278 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700279
280 return BOND_AD_INFO(bond).agg_select_timer ? 1 : 0;
281}
282
283/**
284 * __get_rx_machine_lock - lock the port's RX machine
285 * @port: the port we're looking at
286 *
287 */
288static inline void __get_rx_machine_lock(struct port *port)
289{
Jay Vosburgh2bf86b72008-03-21 22:29:33 -0700290 spin_lock_bh(&(SLAVE_AD_INFO(port->slave).rx_machine_lock));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700291}
292
293/**
294 * __release_rx_machine_lock - unlock the port's RX machine
295 * @port: the port we're looking at
296 *
297 */
298static inline void __release_rx_machine_lock(struct port *port)
299{
Jay Vosburgh2bf86b72008-03-21 22:29:33 -0700300 spin_unlock_bh(&(SLAVE_AD_INFO(port->slave).rx_machine_lock));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700301}
302
303/**
304 * __get_link_speed - get a port's speed
305 * @port: the port we're looking at
306 *
307 * Return @port's speed in 802.3ad bitmask format. i.e. one of:
308 * 0,
309 * %AD_LINK_SPEED_BITMASK_10MBPS,
310 * %AD_LINK_SPEED_BITMASK_100MBPS,
Jay Vosburgh94dbffd2006-09-22 21:52:15 -0700311 * %AD_LINK_SPEED_BITMASK_1000MBPS,
312 * %AD_LINK_SPEED_BITMASK_10000MBPS
Linus Torvalds1da177e2005-04-16 15:20:36 -0700313 */
314static u16 __get_link_speed(struct port *port)
315{
316 struct slave *slave = port->slave;
317 u16 speed;
318
319 /* this if covers only a special case: when the configuration starts with
320 * link down, it sets the speed to 0.
321 * This is done in spite of the fact that the e100 driver reports 0 to be
322 * compatible with MVT in the future.*/
Bandan Das7bfc4752010-10-16 20:19:59 +0000323 if (slave->link != BOND_LINK_UP)
Bandan Das128ea6c2010-10-16 20:19:58 +0000324 speed = 0;
Bandan Das7bfc4752010-10-16 20:19:59 +0000325 else {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700326 switch (slave->speed) {
327 case SPEED_10:
328 speed = AD_LINK_SPEED_BITMASK_10MBPS;
329 break;
330
331 case SPEED_100:
332 speed = AD_LINK_SPEED_BITMASK_100MBPS;
333 break;
334
335 case SPEED_1000:
336 speed = AD_LINK_SPEED_BITMASK_1000MBPS;
337 break;
338
Jay Vosburgh94dbffd2006-09-22 21:52:15 -0700339 case SPEED_10000:
340 speed = AD_LINK_SPEED_BITMASK_10000MBPS;
341 break;
342
Linus Torvalds1da177e2005-04-16 15:20:36 -0700343 default:
344 speed = 0; // unknown speed value from ethtool. shouldn't happen
345 break;
346 }
347 }
348
Joe Perchesa4aee5c2009-12-13 20:06:07 -0800349 pr_debug("Port %d Received link speed %d update from adapter\n",
350 port->actor_port_number, speed);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700351 return speed;
352}
353
354/**
355 * __get_duplex - get a port's duplex
356 * @port: the port we're looking at
357 *
358 * Return @port's duplex in 802.3ad bitmask format. i.e.:
359 * 0x01 if in full duplex
360 * 0x00 otherwise
361 */
362static u8 __get_duplex(struct port *port)
363{
364 struct slave *slave = port->slave;
365
366 u8 retval;
367
368 // handling a special case: when the configuration starts with
369 // link down, it sets the duplex to 0.
Bandan Das7bfc4752010-10-16 20:19:59 +0000370 if (slave->link != BOND_LINK_UP)
Bandan Das128ea6c2010-10-16 20:19:58 +0000371 retval = 0x0;
Bandan Das7bfc4752010-10-16 20:19:59 +0000372 else {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700373 switch (slave->duplex) {
374 case DUPLEX_FULL:
Bandan Das128ea6c2010-10-16 20:19:58 +0000375 retval = 0x1;
Joe Perchesa4aee5c2009-12-13 20:06:07 -0800376 pr_debug("Port %d Received status full duplex update from adapter\n",
377 port->actor_port_number);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700378 break;
379 case DUPLEX_HALF:
380 default:
Bandan Das128ea6c2010-10-16 20:19:58 +0000381 retval = 0x0;
Joe Perchesa4aee5c2009-12-13 20:06:07 -0800382 pr_debug("Port %d Received status NOT full duplex update from adapter\n",
383 port->actor_port_number);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700384 break;
385 }
386 }
387 return retval;
388}
389
390/**
391 * __initialize_port_locks - initialize a port's RX machine spinlock
392 * @port: the port we're looking at
393 *
394 */
395static inline void __initialize_port_locks(struct port *port)
396{
397 // make sure it isn't called twice
398 spin_lock_init(&(SLAVE_AD_INFO(port->slave).rx_machine_lock));
399}
400
401//conversions
Linus Torvalds1da177e2005-04-16 15:20:36 -0700402
403/**
404 * __ad_timer_to_ticks - convert a given timer type to AD module ticks
405 * @timer_type: which timer to operate
406 * @par: timer parameter. see below
407 *
408 * If @timer_type is %current_while_timer, @par indicates long/short timer.
409 * If @timer_type is %periodic_timer, @par is one of %FAST_PERIODIC_TIME,
410 * %SLOW_PERIODIC_TIME.
411 */
412static u16 __ad_timer_to_ticks(u16 timer_type, u16 par)
413{
Bandan Das128ea6c2010-10-16 20:19:58 +0000414 u16 retval = 0; /* to silence the compiler */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700415
416 switch (timer_type) {
417 case AD_CURRENT_WHILE_TIMER: // for rx machine usage
Bandan Das7bfc4752010-10-16 20:19:59 +0000418 if (par)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700419 retval = (AD_SHORT_TIMEOUT_TIME*ad_ticks_per_sec); // short timeout
Bandan Das7bfc4752010-10-16 20:19:59 +0000420 else
Linus Torvalds1da177e2005-04-16 15:20:36 -0700421 retval = (AD_LONG_TIMEOUT_TIME*ad_ticks_per_sec); // long timeout
Linus Torvalds1da177e2005-04-16 15:20:36 -0700422 break;
423 case AD_ACTOR_CHURN_TIMER: // for local churn machine
424 retval = (AD_CHURN_DETECTION_TIME*ad_ticks_per_sec);
425 break;
426 case AD_PERIODIC_TIMER: // for periodic machine
427 retval = (par*ad_ticks_per_sec); // long timeout
428 break;
429 case AD_PARTNER_CHURN_TIMER: // for remote churn machine
430 retval = (AD_CHURN_DETECTION_TIME*ad_ticks_per_sec);
431 break;
432 case AD_WAIT_WHILE_TIMER: // for selection machine
433 retval = (AD_AGGREGATE_WAIT_TIME*ad_ticks_per_sec);
434 break;
435 }
436 return retval;
437}
438
439
440/////////////////////////////////////////////////////////////////////////////////
441// ================= ad_rx_machine helper functions ==================
442/////////////////////////////////////////////////////////////////////////////////
443
444/**
Jay Vosburgh2d6682d2009-11-13 13:13:01 +0000445 * __choose_matched - update a port's matched variable from a received lacpdu
446 * @lacpdu: the lacpdu we've received
447 * @port: the port we're looking at
448 *
449 * Update the value of the matched variable, using parameter values from a
450 * newly received lacpdu. Parameter values for the partner carried in the
451 * received PDU are compared with the corresponding operational parameter
452 * values for the actor. Matched is set to TRUE if all of these parameters
453 * match and the PDU parameter partner_state.aggregation has the same value as
454 * actor_oper_port_state.aggregation and lacp will actively maintain the link
455 * in the aggregation. Matched is also set to TRUE if the value of
456 * actor_state.aggregation in the received PDU is set to FALSE, i.e., indicates
457 * an individual link and lacp will actively maintain the link. Otherwise,
458 * matched is set to FALSE. LACP is considered to be actively maintaining the
459 * link if either the PDU's actor_state.lacp_activity variable is TRUE or both
460 * the actor's actor_oper_port_state.lacp_activity and the PDU's
461 * partner_state.lacp_activity variables are TRUE.
462 *
463 * Note: the AD_PORT_MATCHED "variable" is not specified by 802.3ad; it is
464 * used here to implement the language from 802.3ad 43.4.9 that requires
465 * recordPDU to "match" the LACPDU parameters to the stored values.
466 */
467static void __choose_matched(struct lacpdu *lacpdu, struct port *port)
468{
469 // check if all parameters are alike
470 if (((ntohs(lacpdu->partner_port) == port->actor_port_number) &&
471 (ntohs(lacpdu->partner_port_priority) == port->actor_port_priority) &&
472 !MAC_ADDRESS_COMPARE(&(lacpdu->partner_system), &(port->actor_system)) &&
473 (ntohs(lacpdu->partner_system_priority) == port->actor_system_priority) &&
474 (ntohs(lacpdu->partner_key) == port->actor_oper_port_key) &&
475 ((lacpdu->partner_state & AD_STATE_AGGREGATION) == (port->actor_oper_port_state & AD_STATE_AGGREGATION))) ||
476 // or this is individual link(aggregation == FALSE)
477 ((lacpdu->actor_state & AD_STATE_AGGREGATION) == 0)
478 ) {
479 // update the state machine Matched variable
480 port->sm_vars |= AD_PORT_MATCHED;
481 } else {
482 port->sm_vars &= ~AD_PORT_MATCHED;
483 }
484}
485
486/**
Linus Torvalds1da177e2005-04-16 15:20:36 -0700487 * __record_pdu - record parameters from a received lacpdu
488 * @lacpdu: the lacpdu we've received
489 * @port: the port we're looking at
490 *
491 * Record the parameter values for the Actor carried in a received lacpdu as
492 * the current partner operational parameter values and sets
493 * actor_oper_port_state.defaulted to FALSE.
494 */
495static void __record_pdu(struct lacpdu *lacpdu, struct port *port)
496{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700497 if (lacpdu && port) {
Holger Eitzenbergerb99d6ba2008-12-17 19:08:14 -0800498 struct port_params *partner = &port->partner_oper;
499
Jay Vosburgh2d6682d2009-11-13 13:13:01 +0000500 __choose_matched(lacpdu, port);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700501 // record the new parameter values for the partner operational
Holger Eitzenbergerb99d6ba2008-12-17 19:08:14 -0800502 partner->port_number = ntohs(lacpdu->actor_port);
503 partner->port_priority = ntohs(lacpdu->actor_port_priority);
504 partner->system = lacpdu->actor_system;
505 partner->system_priority = ntohs(lacpdu->actor_system_priority);
506 partner->key = ntohs(lacpdu->actor_key);
507 partner->port_state = lacpdu->actor_state;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700508
509 // set actor_oper_port_state.defaulted to FALSE
510 port->actor_oper_port_state &= ~AD_STATE_DEFAULTED;
511
512 // set the partner sync. to on if the partner is sync. and the port is matched
Bandan Das7bfc4752010-10-16 20:19:59 +0000513 if ((port->sm_vars & AD_PORT_MATCHED)
514 && (lacpdu->actor_state & AD_STATE_SYNCHRONIZATION))
Holger Eitzenbergerb99d6ba2008-12-17 19:08:14 -0800515 partner->port_state |= AD_STATE_SYNCHRONIZATION;
Bandan Das7bfc4752010-10-16 20:19:59 +0000516 else
Holger Eitzenbergerb99d6ba2008-12-17 19:08:14 -0800517 partner->port_state &= ~AD_STATE_SYNCHRONIZATION;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700518 }
519}
520
521/**
522 * __record_default - record default parameters
523 * @port: the port we're looking at
524 *
525 * This function records the default parameter values for the partner carried
526 * in the Partner Admin parameters as the current partner operational parameter
527 * values and sets actor_oper_port_state.defaulted to TRUE.
528 */
529static void __record_default(struct port *port)
530{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700531 if (port) {
532 // record the partner admin parameters
Holger Eitzenberger5eefd1a2008-12-17 19:08:46 -0800533 memcpy(&port->partner_oper, &port->partner_admin,
534 sizeof(struct port_params));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700535
536 // set actor_oper_port_state.defaulted to true
537 port->actor_oper_port_state |= AD_STATE_DEFAULTED;
538 }
539}
540
541/**
542 * __update_selected - update a port's Selected variable from a received lacpdu
543 * @lacpdu: the lacpdu we've received
544 * @port: the port we're looking at
545 *
546 * Update the value of the selected variable, using parameter values from a
547 * newly received lacpdu. The parameter values for the Actor carried in the
548 * received PDU are compared with the corresponding operational parameter
549 * values for the ports partner. If one or more of the comparisons shows that
550 * the value(s) received in the PDU differ from the current operational values,
551 * then selected is set to FALSE and actor_oper_port_state.synchronization is
552 * set to out_of_sync. Otherwise, selected remains unchanged.
553 */
554static void __update_selected(struct lacpdu *lacpdu, struct port *port)
555{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700556 if (lacpdu && port) {
Holger Eitzenbergerce6a49a2008-12-17 19:13:07 -0800557 const struct port_params *partner = &port->partner_oper;
558
Linus Torvalds1da177e2005-04-16 15:20:36 -0700559 // check if any parameter is different
Joe Perches8e95a202009-12-03 07:58:21 +0000560 if (ntohs(lacpdu->actor_port) != partner->port_number ||
561 ntohs(lacpdu->actor_port_priority) != partner->port_priority ||
562 MAC_ADDRESS_COMPARE(&lacpdu->actor_system, &partner->system) ||
563 ntohs(lacpdu->actor_system_priority) != partner->system_priority ||
564 ntohs(lacpdu->actor_key) != partner->key ||
565 (lacpdu->actor_state & AD_STATE_AGGREGATION) != (partner->port_state & AD_STATE_AGGREGATION)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700566 // update the state machine Selected variable
567 port->sm_vars &= ~AD_PORT_SELECTED;
568 }
569 }
570}
571
572/**
573 * __update_default_selected - update a port's Selected variable from Partner
574 * @port: the port we're looking at
575 *
576 * This function updates the value of the selected variable, using the partner
577 * administrative parameter values. The administrative values are compared with
578 * the corresponding operational parameter values for the partner. If one or
579 * more of the comparisons shows that the administrative value(s) differ from
580 * the current operational values, then Selected is set to FALSE and
581 * actor_oper_port_state.synchronization is set to OUT_OF_SYNC. Otherwise,
582 * Selected remains unchanged.
583 */
584static void __update_default_selected(struct port *port)
585{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700586 if (port) {
Holger Eitzenberger3c520652008-12-17 19:13:27 -0800587 const struct port_params *admin = &port->partner_admin;
588 const struct port_params *oper = &port->partner_oper;
589
Linus Torvalds1da177e2005-04-16 15:20:36 -0700590 // check if any parameter is different
Joe Perches8e95a202009-12-03 07:58:21 +0000591 if (admin->port_number != oper->port_number ||
592 admin->port_priority != oper->port_priority ||
593 MAC_ADDRESS_COMPARE(&admin->system, &oper->system) ||
594 admin->system_priority != oper->system_priority ||
595 admin->key != oper->key ||
596 (admin->port_state & AD_STATE_AGGREGATION)
Holger Eitzenberger3c520652008-12-17 19:13:27 -0800597 != (oper->port_state & AD_STATE_AGGREGATION)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700598 // update the state machine Selected variable
599 port->sm_vars &= ~AD_PORT_SELECTED;
600 }
601 }
602}
603
604/**
Linus Torvalds1da177e2005-04-16 15:20:36 -0700605 * __update_ntt - update a port's ntt variable from a received lacpdu
606 * @lacpdu: the lacpdu we've received
607 * @port: the port we're looking at
608 *
609 * Updates the value of the ntt variable, using parameter values from a newly
610 * received lacpdu. The parameter values for the partner carried in the
611 * received PDU are compared with the corresponding operational parameter
612 * values for the Actor. If one or more of the comparisons shows that the
613 * value(s) received in the PDU differ from the current operational values,
614 * then ntt is set to TRUE. Otherwise, ntt remains unchanged.
615 */
616static void __update_ntt(struct lacpdu *lacpdu, struct port *port)
617{
618 // validate lacpdu and port
619 if (lacpdu && port) {
620 // check if any parameter is different
Jay Vosburgh89cc76f2006-09-22 21:55:32 -0700621 if ((ntohs(lacpdu->partner_port) != port->actor_port_number) ||
622 (ntohs(lacpdu->partner_port_priority) != port->actor_port_priority) ||
Linus Torvalds1da177e2005-04-16 15:20:36 -0700623 MAC_ADDRESS_COMPARE(&(lacpdu->partner_system), &(port->actor_system)) ||
Jay Vosburgh89cc76f2006-09-22 21:55:32 -0700624 (ntohs(lacpdu->partner_system_priority) != port->actor_system_priority) ||
625 (ntohs(lacpdu->partner_key) != port->actor_oper_port_key) ||
Linus Torvalds1da177e2005-04-16 15:20:36 -0700626 ((lacpdu->partner_state & AD_STATE_LACP_ACTIVITY) != (port->actor_oper_port_state & AD_STATE_LACP_ACTIVITY)) ||
627 ((lacpdu->partner_state & AD_STATE_LACP_TIMEOUT) != (port->actor_oper_port_state & AD_STATE_LACP_TIMEOUT)) ||
628 ((lacpdu->partner_state & AD_STATE_SYNCHRONIZATION) != (port->actor_oper_port_state & AD_STATE_SYNCHRONIZATION)) ||
629 ((lacpdu->partner_state & AD_STATE_AGGREGATION) != (port->actor_oper_port_state & AD_STATE_AGGREGATION))
630 ) {
Holger Eitzenbergerd238d452008-12-26 11:18:15 -0800631
632 port->ntt = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700633 }
634 }
635}
636
637/**
638 * __attach_bond_to_agg
639 * @port: the port we're looking at
640 *
641 * Handle the attaching of the port's control parser/multiplexer and the
642 * aggregator. This function does nothing since the parser/multiplexer of the
643 * receive and the parser/multiplexer of the aggregator are already combined.
644 */
645static void __attach_bond_to_agg(struct port *port)
646{
Bandan Das128ea6c2010-10-16 20:19:58 +0000647 port = NULL; /* just to satisfy the compiler */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700648 // This function does nothing since the parser/multiplexer of the receive
649 // and the parser/multiplexer of the aggregator are already combined
650}
651
652/**
653 * __detach_bond_from_agg
654 * @port: the port we're looking at
655 *
656 * Handle the detaching of the port's control parser/multiplexer from the
657 * aggregator. This function does nothing since the parser/multiplexer of the
658 * receive and the parser/multiplexer of the aggregator are already combined.
659 */
660static void __detach_bond_from_agg(struct port *port)
661{
Bandan Das128ea6c2010-10-16 20:19:58 +0000662 port = NULL; /* just to satisfy the compiler */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700663 // This function does nothing sience the parser/multiplexer of the receive
664 // and the parser/multiplexer of the aggregator are already combined
665}
666
667/**
668 * __agg_ports_are_ready - check if all ports in an aggregator are ready
669 * @aggregator: the aggregator we're looking at
670 *
671 */
672static int __agg_ports_are_ready(struct aggregator *aggregator)
673{
674 struct port *port;
675 int retval = 1;
676
677 if (aggregator) {
678 // scan all ports in this aggregator to verfy if they are all ready
Bandan Das128ea6c2010-10-16 20:19:58 +0000679 for (port = aggregator->lag_ports;
680 port;
681 port = port->next_port_in_aggregator) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700682 if (!(port->sm_vars & AD_PORT_READY_N)) {
683 retval = 0;
684 break;
685 }
686 }
687 }
688
689 return retval;
690}
691
692/**
693 * __set_agg_ports_ready - set value of Ready bit in all ports of an aggregator
694 * @aggregator: the aggregator we're looking at
695 * @val: Should the ports' ready bit be set on or off
696 *
697 */
698static void __set_agg_ports_ready(struct aggregator *aggregator, int val)
699{
700 struct port *port;
701
Bandan Das128ea6c2010-10-16 20:19:58 +0000702 for (port = aggregator->lag_ports; port;
703 port = port->next_port_in_aggregator) {
Bandan Das7bfc4752010-10-16 20:19:59 +0000704 if (val)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700705 port->sm_vars |= AD_PORT_READY;
Bandan Das7bfc4752010-10-16 20:19:59 +0000706 else
Linus Torvalds1da177e2005-04-16 15:20:36 -0700707 port->sm_vars &= ~AD_PORT_READY;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700708 }
709}
710
711/**
712 * __get_agg_bandwidth - get the total bandwidth of an aggregator
713 * @aggregator: the aggregator we're looking at
714 *
715 */
716static u32 __get_agg_bandwidth(struct aggregator *aggregator)
717{
Bandan Das128ea6c2010-10-16 20:19:58 +0000718 u32 bandwidth = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700719 u32 basic_speed;
720
721 if (aggregator->num_of_ports) {
722 basic_speed = __get_link_speed(aggregator->lag_ports);
723 switch (basic_speed) {
724 case AD_LINK_SPEED_BITMASK_1MBPS:
725 bandwidth = aggregator->num_of_ports;
726 break;
727 case AD_LINK_SPEED_BITMASK_10MBPS:
728 bandwidth = aggregator->num_of_ports * 10;
729 break;
730 case AD_LINK_SPEED_BITMASK_100MBPS:
731 bandwidth = aggregator->num_of_ports * 100;
732 break;
733 case AD_LINK_SPEED_BITMASK_1000MBPS:
734 bandwidth = aggregator->num_of_ports * 1000;
735 break;
Jay Vosburgh94dbffd2006-09-22 21:52:15 -0700736 case AD_LINK_SPEED_BITMASK_10000MBPS:
737 bandwidth = aggregator->num_of_ports * 10000;
738 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700739 default:
Bandan Das128ea6c2010-10-16 20:19:58 +0000740 bandwidth = 0; /*to silence the compiler ....*/
Linus Torvalds1da177e2005-04-16 15:20:36 -0700741 }
742 }
743 return bandwidth;
744}
745
746/**
747 * __get_active_agg - get the current active aggregator
748 * @aggregator: the aggregator we're looking at
749 *
750 */
751static struct aggregator *__get_active_agg(struct aggregator *aggregator)
752{
753 struct aggregator *retval = NULL;
754
755 for (; aggregator; aggregator = __get_next_agg(aggregator)) {
756 if (aggregator->is_active) {
757 retval = aggregator;
758 break;
759 }
760 }
761
762 return retval;
763}
764
765/**
766 * __update_lacpdu_from_port - update a port's lacpdu fields
767 * @port: the port we're looking at
768 *
769 */
770static inline void __update_lacpdu_from_port(struct port *port)
771{
772 struct lacpdu *lacpdu = &port->lacpdu;
Holger Eitzenberger3b5b35d2008-12-17 19:13:53 -0800773 const struct port_params *partner = &port->partner_oper;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700774
775 /* update current actual Actor parameters */
776 /* lacpdu->subtype initialized
777 * lacpdu->version_number initialized
778 * lacpdu->tlv_type_actor_info initialized
779 * lacpdu->actor_information_length initialized
780 */
781
Al Virod3bb52b2007-08-22 20:06:58 -0400782 lacpdu->actor_system_priority = htons(port->actor_system_priority);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700783 lacpdu->actor_system = port->actor_system;
Al Virod3bb52b2007-08-22 20:06:58 -0400784 lacpdu->actor_key = htons(port->actor_oper_port_key);
785 lacpdu->actor_port_priority = htons(port->actor_port_priority);
786 lacpdu->actor_port = htons(port->actor_port_number);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700787 lacpdu->actor_state = port->actor_oper_port_state;
788
789 /* lacpdu->reserved_3_1 initialized
790 * lacpdu->tlv_type_partner_info initialized
791 * lacpdu->partner_information_length initialized
792 */
793
Holger Eitzenberger3b5b35d2008-12-17 19:13:53 -0800794 lacpdu->partner_system_priority = htons(partner->system_priority);
795 lacpdu->partner_system = partner->system;
796 lacpdu->partner_key = htons(partner->key);
797 lacpdu->partner_port_priority = htons(partner->port_priority);
798 lacpdu->partner_port = htons(partner->port_number);
799 lacpdu->partner_state = partner->port_state;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700800
801 /* lacpdu->reserved_3_2 initialized
802 * lacpdu->tlv_type_collector_info initialized
803 * lacpdu->collector_information_length initialized
804 * collector_max_delay initialized
805 * reserved_12[12] initialized
806 * tlv_type_terminator initialized
807 * terminator_length initialized
808 * reserved_50[50] initialized
809 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700810}
811
812//////////////////////////////////////////////////////////////////////////////////////
813// ================= main 802.3ad protocol code ======================================
814//////////////////////////////////////////////////////////////////////////////////////
815
816/**
817 * ad_lacpdu_send - send out a lacpdu packet on a given port
818 * @port: the port we're looking at
819 *
820 * Returns: 0 on success
821 * < 0 on error
822 */
823static int ad_lacpdu_send(struct port *port)
824{
825 struct slave *slave = port->slave;
826 struct sk_buff *skb;
827 struct lacpdu_header *lacpdu_header;
828 int length = sizeof(struct lacpdu_header);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700829
830 skb = dev_alloc_skb(length);
Bandan Das7bfc4752010-10-16 20:19:59 +0000831 if (!skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700832 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700833
834 skb->dev = slave->dev;
Arnaldo Carvalho de Melo459a98e2007-03-19 15:30:44 -0700835 skb_reset_mac_header(skb);
Arnaldo Carvalho de Melob0e380b2007-04-10 21:21:55 -0700836 skb->network_header = skb->mac_header + ETH_HLEN;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700837 skb->protocol = PKT_TYPE_LACPDU;
838 skb->priority = TC_PRIO_CONTROL;
839
840 lacpdu_header = (struct lacpdu_header *)skb_put(skb, length);
841
Holger Eitzenbergere7271492008-12-26 13:41:53 -0800842 memcpy(lacpdu_header->hdr.h_dest, lacpdu_mcast_addr, ETH_ALEN);
Holger Eitzenbergere4ac4322008-12-26 13:40:48 -0800843 /* Note: source addres is set to be the member's PERMANENT address,
844 because we use it to identify loopback lacpdus in receive. */
Holger Eitzenbergere7271492008-12-26 13:41:53 -0800845 memcpy(lacpdu_header->hdr.h_source, slave->perm_hwaddr, ETH_ALEN);
846 lacpdu_header->hdr.h_proto = PKT_TYPE_LACPDU;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700847
848 lacpdu_header->lacpdu = port->lacpdu; // struct copy
849
850 dev_queue_xmit(skb);
851
852 return 0;
853}
854
855/**
856 * ad_marker_send - send marker information/response on a given port
857 * @port: the port we're looking at
858 * @marker: marker data to send
859 *
860 * Returns: 0 on success
861 * < 0 on error
862 */
Mathieu Desnoyers1c3f0b82007-10-18 23:41:04 -0700863static int ad_marker_send(struct port *port, struct bond_marker *marker)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700864{
865 struct slave *slave = port->slave;
866 struct sk_buff *skb;
Mathieu Desnoyers1c3f0b82007-10-18 23:41:04 -0700867 struct bond_marker_header *marker_header;
868 int length = sizeof(struct bond_marker_header);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700869
870 skb = dev_alloc_skb(length + 16);
Bandan Das7bfc4752010-10-16 20:19:59 +0000871 if (!skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700872 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700873
874 skb_reserve(skb, 16);
875
876 skb->dev = slave->dev;
Arnaldo Carvalho de Melo459a98e2007-03-19 15:30:44 -0700877 skb_reset_mac_header(skb);
Arnaldo Carvalho de Melob0e380b2007-04-10 21:21:55 -0700878 skb->network_header = skb->mac_header + ETH_HLEN;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700879 skb->protocol = PKT_TYPE_LACPDU;
880
Mathieu Desnoyers1c3f0b82007-10-18 23:41:04 -0700881 marker_header = (struct bond_marker_header *)skb_put(skb, length);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700882
Holger Eitzenbergere7271492008-12-26 13:41:53 -0800883 memcpy(marker_header->hdr.h_dest, lacpdu_mcast_addr, ETH_ALEN);
Holger Eitzenbergere4ac4322008-12-26 13:40:48 -0800884 /* Note: source addres is set to be the member's PERMANENT address,
885 because we use it to identify loopback MARKERs in receive. */
Holger Eitzenbergere7271492008-12-26 13:41:53 -0800886 memcpy(marker_header->hdr.h_source, slave->perm_hwaddr, ETH_ALEN);
887 marker_header->hdr.h_proto = PKT_TYPE_LACPDU;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700888
889 marker_header->marker = *marker; // struct copy
890
891 dev_queue_xmit(skb);
892
893 return 0;
894}
895
896/**
897 * ad_mux_machine - handle a port's mux state machine
898 * @port: the port we're looking at
899 *
900 */
901static void ad_mux_machine(struct port *port)
902{
903 mux_states_t last_state;
904
905 // keep current State Machine state to compare later if it was changed
906 last_state = port->sm_mux_state;
907
908 if (port->sm_vars & AD_PORT_BEGIN) {
909 port->sm_mux_state = AD_MUX_DETACHED; // next state
910 } else {
911 switch (port->sm_mux_state) {
912 case AD_MUX_DETACHED:
Bandan Das7bfc4752010-10-16 20:19:59 +0000913 if ((port->sm_vars & AD_PORT_SELECTED)
914 || (port->sm_vars & AD_PORT_STANDBY))
915 /* if SELECTED or STANDBY */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700916 port->sm_mux_state = AD_MUX_WAITING; // next state
Linus Torvalds1da177e2005-04-16 15:20:36 -0700917 break;
918 case AD_MUX_WAITING:
919 // if SELECTED == FALSE return to DETACH state
920 if (!(port->sm_vars & AD_PORT_SELECTED)) { // if UNSELECTED
921 port->sm_vars &= ~AD_PORT_READY_N;
922 // in order to withhold the Selection Logic to check all ports READY_N value
923 // every callback cycle to update ready variable, we check READY_N and update READY here
924 __set_agg_ports_ready(port->aggregator, __agg_ports_are_ready(port->aggregator));
925 port->sm_mux_state = AD_MUX_DETACHED; // next state
926 break;
927 }
928
929 // check if the wait_while_timer expired
Bandan Das7bfc4752010-10-16 20:19:59 +0000930 if (port->sm_mux_timer_counter
931 && !(--port->sm_mux_timer_counter))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700932 port->sm_vars |= AD_PORT_READY_N;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700933
934 // in order to withhold the selection logic to check all ports READY_N value
935 // every callback cycle to update ready variable, we check READY_N and update READY here
936 __set_agg_ports_ready(port->aggregator, __agg_ports_are_ready(port->aggregator));
937
938 // if the wait_while_timer expired, and the port is in READY state, move to ATTACHED state
Bandan Das7bfc4752010-10-16 20:19:59 +0000939 if ((port->sm_vars & AD_PORT_READY)
940 && !port->sm_mux_timer_counter)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700941 port->sm_mux_state = AD_MUX_ATTACHED; // next state
Linus Torvalds1da177e2005-04-16 15:20:36 -0700942 break;
943 case AD_MUX_ATTACHED:
944 // check also if agg_select_timer expired(so the edable port will take place only after this timer)
Holger Eitzenberger1055c9a2008-12-17 19:07:38 -0800945 if ((port->sm_vars & AD_PORT_SELECTED) && (port->partner_oper.port_state & AD_STATE_SYNCHRONIZATION) && !__check_agg_selection_timer(port)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700946 port->sm_mux_state = AD_MUX_COLLECTING_DISTRIBUTING;// next state
947 } else if (!(port->sm_vars & AD_PORT_SELECTED) || (port->sm_vars & AD_PORT_STANDBY)) { // if UNSELECTED or STANDBY
948 port->sm_vars &= ~AD_PORT_READY_N;
949 // in order to withhold the selection logic to check all ports READY_N value
950 // every callback cycle to update ready variable, we check READY_N and update READY here
951 __set_agg_ports_ready(port->aggregator, __agg_ports_are_ready(port->aggregator));
952 port->sm_mux_state = AD_MUX_DETACHED;// next state
953 }
954 break;
955 case AD_MUX_COLLECTING_DISTRIBUTING:
956 if (!(port->sm_vars & AD_PORT_SELECTED) || (port->sm_vars & AD_PORT_STANDBY) ||
Holger Eitzenberger1055c9a2008-12-17 19:07:38 -0800957 !(port->partner_oper.port_state & AD_STATE_SYNCHRONIZATION)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700958 ) {
959 port->sm_mux_state = AD_MUX_ATTACHED;// next state
960
961 } else {
962 // if port state hasn't changed make
963 // sure that a collecting distributing
964 // port in an active aggregator is enabled
965 if (port->aggregator &&
966 port->aggregator->is_active &&
967 !__port_is_enabled(port)) {
968
969 __enable_port(port);
970 }
971 }
972 break;
973 default: //to silence the compiler
974 break;
975 }
976 }
977
978 // check if the state machine was changed
979 if (port->sm_mux_state != last_state) {
Joe Perchesa4aee5c2009-12-13 20:06:07 -0800980 pr_debug("Mux Machine: Port=%d, Last State=%d, Curr State=%d\n",
981 port->actor_port_number, last_state,
982 port->sm_mux_state);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700983 switch (port->sm_mux_state) {
984 case AD_MUX_DETACHED:
985 __detach_bond_from_agg(port);
986 port->actor_oper_port_state &= ~AD_STATE_SYNCHRONIZATION;
987 ad_disable_collecting_distributing(port);
988 port->actor_oper_port_state &= ~AD_STATE_COLLECTING;
989 port->actor_oper_port_state &= ~AD_STATE_DISTRIBUTING;
Holger Eitzenbergerd238d452008-12-26 11:18:15 -0800990 port->ntt = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700991 break;
992 case AD_MUX_WAITING:
993 port->sm_mux_timer_counter = __ad_timer_to_ticks(AD_WAIT_WHILE_TIMER, 0);
994 break;
995 case AD_MUX_ATTACHED:
996 __attach_bond_to_agg(port);
997 port->actor_oper_port_state |= AD_STATE_SYNCHRONIZATION;
998 port->actor_oper_port_state &= ~AD_STATE_COLLECTING;
999 port->actor_oper_port_state &= ~AD_STATE_DISTRIBUTING;
1000 ad_disable_collecting_distributing(port);
Holger Eitzenbergerd238d452008-12-26 11:18:15 -08001001 port->ntt = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001002 break;
1003 case AD_MUX_COLLECTING_DISTRIBUTING:
1004 port->actor_oper_port_state |= AD_STATE_COLLECTING;
1005 port->actor_oper_port_state |= AD_STATE_DISTRIBUTING;
1006 ad_enable_collecting_distributing(port);
Holger Eitzenbergerd238d452008-12-26 11:18:15 -08001007 port->ntt = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001008 break;
1009 default: //to silence the compiler
1010 break;
1011 }
1012 }
1013}
1014
1015/**
1016 * ad_rx_machine - handle a port's rx State Machine
1017 * @lacpdu: the lacpdu we've received
1018 * @port: the port we're looking at
1019 *
1020 * If lacpdu arrived, stop previous timer (if exists) and set the next state as
1021 * CURRENT. If timer expired set the state machine in the proper state.
1022 * In other cases, this function checks if we need to switch to other state.
1023 */
1024static void ad_rx_machine(struct lacpdu *lacpdu, struct port *port)
1025{
1026 rx_states_t last_state;
1027
1028 // Lock to prevent 2 instances of this function to run simultaneously(rx interrupt and periodic machine callback)
1029 __get_rx_machine_lock(port);
1030
1031 // keep current State Machine state to compare later if it was changed
1032 last_state = port->sm_rx_state;
1033
1034 // check if state machine should change state
1035 // first, check if port was reinitialized
Bandan Das7bfc4752010-10-16 20:19:59 +00001036 if (port->sm_vars & AD_PORT_BEGIN)
1037 /* next state */
1038 port->sm_rx_state = AD_RX_INITIALIZE;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001039 // check if port is not enabled
Bandan Das7bfc4752010-10-16 20:19:59 +00001040 else if (!(port->sm_vars & AD_PORT_BEGIN)
1041 && !port->is_enabled && !(port->sm_vars & AD_PORT_MOVED))
1042 /* next state */
1043 port->sm_rx_state = AD_RX_PORT_DISABLED;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001044 // check if new lacpdu arrived
1045 else if (lacpdu && ((port->sm_rx_state == AD_RX_EXPIRED) || (port->sm_rx_state == AD_RX_DEFAULTED) || (port->sm_rx_state == AD_RX_CURRENT))) {
1046 port->sm_rx_timer_counter = 0; // zero timer
1047 port->sm_rx_state = AD_RX_CURRENT;
1048 } else {
1049 // if timer is on, and if it is expired
1050 if (port->sm_rx_timer_counter && !(--port->sm_rx_timer_counter)) {
1051 switch (port->sm_rx_state) {
1052 case AD_RX_EXPIRED:
1053 port->sm_rx_state = AD_RX_DEFAULTED; // next state
1054 break;
1055 case AD_RX_CURRENT:
1056 port->sm_rx_state = AD_RX_EXPIRED; // next state
1057 break;
1058 default: //to silence the compiler
1059 break;
1060 }
1061 } else {
1062 // if no lacpdu arrived and no timer is on
1063 switch (port->sm_rx_state) {
1064 case AD_RX_PORT_DISABLED:
Bandan Das7bfc4752010-10-16 20:19:59 +00001065 if (port->sm_vars & AD_PORT_MOVED)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001066 port->sm_rx_state = AD_RX_INITIALIZE; // next state
Bandan Das7bfc4752010-10-16 20:19:59 +00001067 else if (port->is_enabled
1068 && (port->sm_vars
1069 & AD_PORT_LACP_ENABLED))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001070 port->sm_rx_state = AD_RX_EXPIRED; // next state
Bandan Das7bfc4752010-10-16 20:19:59 +00001071 else if (port->is_enabled
1072 && ((port->sm_vars
1073 & AD_PORT_LACP_ENABLED) == 0))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001074 port->sm_rx_state = AD_RX_LACP_DISABLED; // next state
Linus Torvalds1da177e2005-04-16 15:20:36 -07001075 break;
1076 default: //to silence the compiler
1077 break;
1078
1079 }
1080 }
1081 }
1082
1083 // check if the State machine was changed or new lacpdu arrived
1084 if ((port->sm_rx_state != last_state) || (lacpdu)) {
Joe Perchesa4aee5c2009-12-13 20:06:07 -08001085 pr_debug("Rx Machine: Port=%d, Last State=%d, Curr State=%d\n",
1086 port->actor_port_number, last_state,
1087 port->sm_rx_state);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001088 switch (port->sm_rx_state) {
1089 case AD_RX_INITIALIZE:
Bandan Das7bfc4752010-10-16 20:19:59 +00001090 if (!(port->actor_oper_port_key & AD_DUPLEX_KEY_BITS))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001091 port->sm_vars &= ~AD_PORT_LACP_ENABLED;
Bandan Das7bfc4752010-10-16 20:19:59 +00001092 else
Linus Torvalds1da177e2005-04-16 15:20:36 -07001093 port->sm_vars |= AD_PORT_LACP_ENABLED;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001094 port->sm_vars &= ~AD_PORT_SELECTED;
1095 __record_default(port);
1096 port->actor_oper_port_state &= ~AD_STATE_EXPIRED;
1097 port->sm_vars &= ~AD_PORT_MOVED;
1098 port->sm_rx_state = AD_RX_PORT_DISABLED; // next state
1099
1100 /*- Fall Through -*/
1101
1102 case AD_RX_PORT_DISABLED:
1103 port->sm_vars &= ~AD_PORT_MATCHED;
1104 break;
1105 case AD_RX_LACP_DISABLED:
1106 port->sm_vars &= ~AD_PORT_SELECTED;
1107 __record_default(port);
Holger Eitzenberger1055c9a2008-12-17 19:07:38 -08001108 port->partner_oper.port_state &= ~AD_STATE_AGGREGATION;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001109 port->sm_vars |= AD_PORT_MATCHED;
1110 port->actor_oper_port_state &= ~AD_STATE_EXPIRED;
1111 break;
1112 case AD_RX_EXPIRED:
1113 //Reset of the Synchronization flag. (Standard 43.4.12)
1114 //This reset cause to disable this port in the COLLECTING_DISTRIBUTING state of the
1115 //mux machine in case of EXPIRED even if LINK_DOWN didn't arrive for the port.
Holger Eitzenberger1055c9a2008-12-17 19:07:38 -08001116 port->partner_oper.port_state &= ~AD_STATE_SYNCHRONIZATION;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001117 port->sm_vars &= ~AD_PORT_MATCHED;
Julia Lawall8e321c42009-07-11 10:03:55 +00001118 port->partner_oper.port_state |=
1119 AD_STATE_LACP_ACTIVITY;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001120 port->sm_rx_timer_counter = __ad_timer_to_ticks(AD_CURRENT_WHILE_TIMER, (u16)(AD_SHORT_TIMEOUT));
1121 port->actor_oper_port_state |= AD_STATE_EXPIRED;
1122 break;
1123 case AD_RX_DEFAULTED:
1124 __update_default_selected(port);
1125 __record_default(port);
1126 port->sm_vars |= AD_PORT_MATCHED;
1127 port->actor_oper_port_state &= ~AD_STATE_EXPIRED;
1128 break;
1129 case AD_RX_CURRENT:
1130 // detect loopback situation
1131 if (!MAC_ADDRESS_COMPARE(&(lacpdu->actor_system), &(port->actor_system))) {
1132 // INFO_RECEIVED_LOOPBACK_FRAMES
Joe Perchesa4aee5c2009-12-13 20:06:07 -08001133 pr_err("%s: An illegal loopback occurred on adapter (%s).\n"
1134 "Check the configuration to verify that all adapters are connected to 802.3ad compliant switch ports\n",
Mitch Williams4e0952c2005-11-09 10:34:57 -08001135 port->slave->dev->master->name, port->slave->dev->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001136 __release_rx_machine_lock(port);
1137 return;
1138 }
1139 __update_selected(lacpdu, port);
1140 __update_ntt(lacpdu, port);
1141 __record_pdu(lacpdu, port);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001142 port->sm_rx_timer_counter = __ad_timer_to_ticks(AD_CURRENT_WHILE_TIMER, (u16)(port->actor_oper_port_state & AD_STATE_LACP_TIMEOUT));
1143 port->actor_oper_port_state &= ~AD_STATE_EXPIRED;
1144 // verify that if the aggregator is enabled, the port is enabled too.
1145 //(because if the link goes down for a short time, the 802.3ad will not
1146 // catch it, and the port will continue to be disabled)
Bandan Das7bfc4752010-10-16 20:19:59 +00001147 if (port->aggregator
1148 && port->aggregator->is_active
1149 && !__port_is_enabled(port))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001150 __enable_port(port);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001151 break;
1152 default: //to silence the compiler
1153 break;
1154 }
1155 }
1156 __release_rx_machine_lock(port);
1157}
1158
1159/**
1160 * ad_tx_machine - handle a port's tx state machine
1161 * @port: the port we're looking at
1162 *
1163 */
1164static void ad_tx_machine(struct port *port)
1165{
1166 // check if tx timer expired, to verify that we do not send more than 3 packets per second
1167 if (port->sm_tx_timer_counter && !(--port->sm_tx_timer_counter)) {
1168 // check if there is something to send
1169 if (port->ntt && (port->sm_vars & AD_PORT_LACP_ENABLED)) {
1170 __update_lacpdu_from_port(port);
Holger Eitzenbergerd238d452008-12-26 11:18:15 -08001171
Linus Torvalds1da177e2005-04-16 15:20:36 -07001172 if (ad_lacpdu_send(port) >= 0) {
Joe Perchesa4aee5c2009-12-13 20:06:07 -08001173 pr_debug("Sent LACPDU on port %d\n",
1174 port->actor_port_number);
Holger Eitzenbergerd238d452008-12-26 11:18:15 -08001175
1176 /* mark ntt as false, so it will not be sent again until
1177 demanded */
1178 port->ntt = false;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001179 }
1180 }
1181 // restart tx timer(to verify that we will not exceed AD_MAX_TX_IN_SECOND
Bandan Das128ea6c2010-10-16 20:19:58 +00001182 port->sm_tx_timer_counter =
1183 ad_ticks_per_sec/AD_MAX_TX_IN_SECOND;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001184 }
1185}
1186
1187/**
1188 * ad_periodic_machine - handle a port's periodic state machine
1189 * @port: the port we're looking at
1190 *
1191 * Turn ntt flag on priodically to perform periodic transmission of lacpdu's.
1192 */
1193static void ad_periodic_machine(struct port *port)
1194{
1195 periodic_states_t last_state;
1196
1197 // keep current state machine state to compare later if it was changed
1198 last_state = port->sm_periodic_state;
1199
1200 // check if port was reinitialized
1201 if (((port->sm_vars & AD_PORT_BEGIN) || !(port->sm_vars & AD_PORT_LACP_ENABLED) || !port->is_enabled) ||
Holger Eitzenberger1055c9a2008-12-17 19:07:38 -08001202 (!(port->actor_oper_port_state & AD_STATE_LACP_ACTIVITY) && !(port->partner_oper.port_state & AD_STATE_LACP_ACTIVITY))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001203 ) {
1204 port->sm_periodic_state = AD_NO_PERIODIC; // next state
1205 }
1206 // check if state machine should change state
1207 else if (port->sm_periodic_timer_counter) {
1208 // check if periodic state machine expired
1209 if (!(--port->sm_periodic_timer_counter)) {
1210 // if expired then do tx
1211 port->sm_periodic_state = AD_PERIODIC_TX; // next state
1212 } else {
1213 // If not expired, check if there is some new timeout parameter from the partner state
1214 switch (port->sm_periodic_state) {
1215 case AD_FAST_PERIODIC:
Bandan Das7bfc4752010-10-16 20:19:59 +00001216 if (!(port->partner_oper.port_state
1217 & AD_STATE_LACP_TIMEOUT))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001218 port->sm_periodic_state = AD_SLOW_PERIODIC; // next state
Linus Torvalds1da177e2005-04-16 15:20:36 -07001219 break;
1220 case AD_SLOW_PERIODIC:
Holger Eitzenberger1055c9a2008-12-17 19:07:38 -08001221 if ((port->partner_oper.port_state & AD_STATE_LACP_TIMEOUT)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001222 // stop current timer
1223 port->sm_periodic_timer_counter = 0;
1224 port->sm_periodic_state = AD_PERIODIC_TX; // next state
1225 }
1226 break;
1227 default: //to silence the compiler
1228 break;
1229 }
1230 }
1231 } else {
1232 switch (port->sm_periodic_state) {
1233 case AD_NO_PERIODIC:
1234 port->sm_periodic_state = AD_FAST_PERIODIC; // next state
1235 break;
1236 case AD_PERIODIC_TX:
Bandan Das7bfc4752010-10-16 20:19:59 +00001237 if (!(port->partner_oper.port_state
1238 & AD_STATE_LACP_TIMEOUT))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001239 port->sm_periodic_state = AD_SLOW_PERIODIC; // next state
Bandan Das7bfc4752010-10-16 20:19:59 +00001240 else
Linus Torvalds1da177e2005-04-16 15:20:36 -07001241 port->sm_periodic_state = AD_FAST_PERIODIC; // next state
Linus Torvalds1da177e2005-04-16 15:20:36 -07001242 break;
1243 default: //to silence the compiler
1244 break;
1245 }
1246 }
1247
1248 // check if the state machine was changed
1249 if (port->sm_periodic_state != last_state) {
Joe Perchesa4aee5c2009-12-13 20:06:07 -08001250 pr_debug("Periodic Machine: Port=%d, Last State=%d, Curr State=%d\n",
1251 port->actor_port_number, last_state,
1252 port->sm_periodic_state);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001253 switch (port->sm_periodic_state) {
1254 case AD_NO_PERIODIC:
1255 port->sm_periodic_timer_counter = 0; // zero timer
1256 break;
1257 case AD_FAST_PERIODIC:
1258 port->sm_periodic_timer_counter = __ad_timer_to_ticks(AD_PERIODIC_TIMER, (u16)(AD_FAST_PERIODIC_TIME))-1; // decrement 1 tick we lost in the PERIODIC_TX cycle
1259 break;
1260 case AD_SLOW_PERIODIC:
1261 port->sm_periodic_timer_counter = __ad_timer_to_ticks(AD_PERIODIC_TIMER, (u16)(AD_SLOW_PERIODIC_TIME))-1; // decrement 1 tick we lost in the PERIODIC_TX cycle
1262 break;
1263 case AD_PERIODIC_TX:
Holger Eitzenbergerd238d452008-12-26 11:18:15 -08001264 port->ntt = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001265 break;
1266 default: //to silence the compiler
1267 break;
1268 }
1269 }
1270}
1271
1272/**
1273 * ad_port_selection_logic - select aggregation groups
1274 * @port: the port we're looking at
1275 *
1276 * Select aggregation groups, and assign each port for it's aggregetor. The
1277 * selection logic is called in the inititalization (after all the handshkes),
1278 * and after every lacpdu receive (if selected is off).
1279 */
1280static void ad_port_selection_logic(struct port *port)
1281{
1282 struct aggregator *aggregator, *free_aggregator = NULL, *temp_aggregator;
1283 struct port *last_port = NULL, *curr_port;
1284 int found = 0;
1285
1286 // if the port is already Selected, do nothing
Bandan Das7bfc4752010-10-16 20:19:59 +00001287 if (port->sm_vars & AD_PORT_SELECTED)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001288 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001289
1290 // if the port is connected to other aggregator, detach it
1291 if (port->aggregator) {
1292 // detach the port from its former aggregator
Bandan Das128ea6c2010-10-16 20:19:58 +00001293 temp_aggregator = port->aggregator;
1294 for (curr_port = temp_aggregator->lag_ports; curr_port;
1295 last_port = curr_port,
1296 curr_port = curr_port->next_port_in_aggregator) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001297 if (curr_port == port) {
1298 temp_aggregator->num_of_ports--;
1299 if (!last_port) {// if it is the first port attached to the aggregator
Bandan Das128ea6c2010-10-16 20:19:58 +00001300 temp_aggregator->lag_ports =
1301 port->next_port_in_aggregator;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001302 } else {// not the first port attached to the aggregator
Bandan Das128ea6c2010-10-16 20:19:58 +00001303 last_port->next_port_in_aggregator =
1304 port->next_port_in_aggregator;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001305 }
1306
1307 // clear the port's relations to this aggregator
1308 port->aggregator = NULL;
Bandan Das128ea6c2010-10-16 20:19:58 +00001309 port->next_port_in_aggregator = NULL;
1310 port->actor_port_aggregator_identifier = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001311
Joe Perchesa4aee5c2009-12-13 20:06:07 -08001312 pr_debug("Port %d left LAG %d\n",
1313 port->actor_port_number,
1314 temp_aggregator->aggregator_identifier);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001315 // if the aggregator is empty, clear its parameters, and set it ready to be attached
Bandan Das7bfc4752010-10-16 20:19:59 +00001316 if (!temp_aggregator->lag_ports)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001317 ad_clear_agg(temp_aggregator);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001318 break;
1319 }
1320 }
1321 if (!curr_port) { // meaning: the port was related to an aggregator but was not on the aggregator port list
Joe Perchesa4aee5c2009-12-13 20:06:07 -08001322 pr_warning("%s: Warning: Port %d (on %s) was related to aggregator %d but was not on its port list\n",
Jiri Pirkoe5e2a8f2009-08-13 04:11:52 +00001323 port->slave->dev->master->name,
1324 port->actor_port_number,
1325 port->slave->dev->name,
1326 port->aggregator->aggregator_identifier);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001327 }
1328 }
1329 // search on all aggregators for a suitable aggregator for this port
1330 for (aggregator = __get_first_agg(port); aggregator;
1331 aggregator = __get_next_agg(aggregator)) {
1332
1333 // keep a free aggregator for later use(if needed)
1334 if (!aggregator->lag_ports) {
Bandan Das7bfc4752010-10-16 20:19:59 +00001335 if (!free_aggregator)
Bandan Das128ea6c2010-10-16 20:19:58 +00001336 free_aggregator = aggregator;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001337 continue;
1338 }
1339 // check if current aggregator suits us
1340 if (((aggregator->actor_oper_aggregator_key == port->actor_oper_port_key) && // if all parameters match AND
Holger Eitzenberger1055c9a2008-12-17 19:07:38 -08001341 !MAC_ADDRESS_COMPARE(&(aggregator->partner_system), &(port->partner_oper.system)) &&
1342 (aggregator->partner_system_priority == port->partner_oper.system_priority) &&
1343 (aggregator->partner_oper_aggregator_key == port->partner_oper.key)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001344 ) &&
Holger Eitzenberger1055c9a2008-12-17 19:07:38 -08001345 ((MAC_ADDRESS_COMPARE(&(port->partner_oper.system), &(null_mac_addr)) && // partner answers
Linus Torvalds1da177e2005-04-16 15:20:36 -07001346 !aggregator->is_individual) // but is not individual OR
1347 )
1348 ) {
1349 // attach to the founded aggregator
1350 port->aggregator = aggregator;
Bandan Das128ea6c2010-10-16 20:19:58 +00001351 port->actor_port_aggregator_identifier =
1352 port->aggregator->aggregator_identifier;
1353 port->next_port_in_aggregator = aggregator->lag_ports;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001354 port->aggregator->num_of_ports++;
Bandan Das128ea6c2010-10-16 20:19:58 +00001355 aggregator->lag_ports = port;
Joe Perchesa4aee5c2009-12-13 20:06:07 -08001356 pr_debug("Port %d joined LAG %d(existing LAG)\n",
1357 port->actor_port_number,
1358 port->aggregator->aggregator_identifier);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001359
1360 // mark this port as selected
1361 port->sm_vars |= AD_PORT_SELECTED;
1362 found = 1;
1363 break;
1364 }
1365 }
1366
1367 // the port couldn't find an aggregator - attach it to a new aggregator
1368 if (!found) {
1369 if (free_aggregator) {
1370 // assign port a new aggregator
1371 port->aggregator = free_aggregator;
Bandan Das128ea6c2010-10-16 20:19:58 +00001372 port->actor_port_aggregator_identifier =
1373 port->aggregator->aggregator_identifier;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001374
1375 // update the new aggregator's parameters
1376 // if port was responsed from the end-user
Bandan Das7bfc4752010-10-16 20:19:59 +00001377 if (port->actor_oper_port_key & AD_DUPLEX_KEY_BITS)
1378 /* if port is full duplex */
Holger Eitzenberger1624db72008-12-26 13:27:21 -08001379 port->aggregator->is_individual = false;
Bandan Das7bfc4752010-10-16 20:19:59 +00001380 else
Holger Eitzenberger1624db72008-12-26 13:27:21 -08001381 port->aggregator->is_individual = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001382
1383 port->aggregator->actor_admin_aggregator_key = port->actor_admin_port_key;
1384 port->aggregator->actor_oper_aggregator_key = port->actor_oper_port_key;
Bandan Das128ea6c2010-10-16 20:19:58 +00001385 port->aggregator->partner_system =
1386 port->partner_oper.system;
1387 port->aggregator->partner_system_priority =
1388 port->partner_oper.system_priority;
Holger Eitzenberger1055c9a2008-12-17 19:07:38 -08001389 port->aggregator->partner_oper_aggregator_key = port->partner_oper.key;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001390 port->aggregator->receive_state = 1;
1391 port->aggregator->transmit_state = 1;
1392 port->aggregator->lag_ports = port;
1393 port->aggregator->num_of_ports++;
1394
1395 // mark this port as selected
1396 port->sm_vars |= AD_PORT_SELECTED;
1397
Joe Perchesa4aee5c2009-12-13 20:06:07 -08001398 pr_debug("Port %d joined LAG %d(new LAG)\n",
1399 port->actor_port_number,
1400 port->aggregator->aggregator_identifier);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001401 } else {
Joe Perchesa4aee5c2009-12-13 20:06:07 -08001402 pr_err("%s: Port %d (on %s) did not find a suitable aggregator\n",
Mitch Williams4e0952c2005-11-09 10:34:57 -08001403 port->slave->dev->master->name,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001404 port->actor_port_number, port->slave->dev->name);
1405 }
1406 }
1407 // if all aggregator's ports are READY_N == TRUE, set ready=TRUE in all aggregator's ports
1408 // else set ready=FALSE in all aggregator's ports
1409 __set_agg_ports_ready(port->aggregator, __agg_ports_are_ready(port->aggregator));
1410
Jay Vosburghfd989c82008-11-04 17:51:16 -08001411 aggregator = __get_first_agg(port);
1412 ad_agg_selection_logic(aggregator);
1413}
1414
1415/*
1416 * Decide if "agg" is a better choice for the new active aggregator that
1417 * the current best, according to the ad_select policy.
1418 */
1419static struct aggregator *ad_agg_selection_test(struct aggregator *best,
1420 struct aggregator *curr)
1421{
1422 /*
1423 * 0. If no best, select current.
1424 *
1425 * 1. If the current agg is not individual, and the best is
1426 * individual, select current.
1427 *
1428 * 2. If current agg is individual and the best is not, keep best.
1429 *
1430 * 3. Therefore, current and best are both individual or both not
1431 * individual, so:
1432 *
1433 * 3a. If current agg partner replied, and best agg partner did not,
1434 * select current.
1435 *
1436 * 3b. If current agg partner did not reply and best agg partner
1437 * did reply, keep best.
1438 *
1439 * 4. Therefore, current and best both have partner replies or
1440 * both do not, so perform selection policy:
1441 *
1442 * BOND_AD_COUNT: Select by count of ports. If count is equal,
1443 * select by bandwidth.
1444 *
1445 * BOND_AD_STABLE, BOND_AD_BANDWIDTH: Select by bandwidth.
1446 */
1447 if (!best)
1448 return curr;
1449
1450 if (!curr->is_individual && best->is_individual)
1451 return curr;
1452
1453 if (curr->is_individual && !best->is_individual)
1454 return best;
1455
1456 if (__agg_has_partner(curr) && !__agg_has_partner(best))
1457 return curr;
1458
1459 if (!__agg_has_partner(curr) && __agg_has_partner(best))
1460 return best;
1461
1462 switch (__get_agg_selection_mode(curr->lag_ports)) {
1463 case BOND_AD_COUNT:
1464 if (curr->num_of_ports > best->num_of_ports)
1465 return curr;
1466
1467 if (curr->num_of_ports < best->num_of_ports)
1468 return best;
1469
1470 /*FALLTHROUGH*/
1471 case BOND_AD_STABLE:
1472 case BOND_AD_BANDWIDTH:
1473 if (__get_agg_bandwidth(curr) > __get_agg_bandwidth(best))
1474 return curr;
1475
1476 break;
1477
1478 default:
Joe Perchesa4aee5c2009-12-13 20:06:07 -08001479 pr_warning("%s: Impossible agg select mode %d\n",
Jiri Pirkoe5e2a8f2009-08-13 04:11:52 +00001480 curr->slave->dev->master->name,
1481 __get_agg_selection_mode(curr->lag_ports));
Jay Vosburghfd989c82008-11-04 17:51:16 -08001482 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001483 }
Jay Vosburghfd989c82008-11-04 17:51:16 -08001484
1485 return best;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001486}
1487
Stephen Hemminger4cd6fe12009-05-15 08:44:32 +00001488static int agg_device_up(const struct aggregator *agg)
1489{
1490 return (netif_running(agg->slave->dev) &&
1491 netif_carrier_ok(agg->slave->dev));
1492}
1493
Linus Torvalds1da177e2005-04-16 15:20:36 -07001494/**
1495 * ad_agg_selection_logic - select an aggregation group for a team
1496 * @aggregator: the aggregator we're looking at
1497 *
1498 * It is assumed that only one aggregator may be selected for a team.
Jay Vosburghfd989c82008-11-04 17:51:16 -08001499 *
1500 * The logic of this function is to select the aggregator according to
1501 * the ad_select policy:
1502 *
1503 * BOND_AD_STABLE: select the aggregator with the most ports attached to
1504 * it, and to reselect the active aggregator only if the previous
1505 * aggregator has no more ports related to it.
1506 *
1507 * BOND_AD_BANDWIDTH: select the aggregator with the highest total
1508 * bandwidth, and reselect whenever a link state change takes place or the
1509 * set of slaves in the bond changes.
1510 *
1511 * BOND_AD_COUNT: select the aggregator with largest number of ports
1512 * (slaves), and reselect whenever a link state change takes place or the
1513 * set of slaves in the bond changes.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001514 *
1515 * FIXME: this function MUST be called with the first agg in the bond, or
1516 * __get_active_agg() won't work correctly. This function should be better
1517 * called with the bond itself, and retrieve the first agg from it.
1518 */
Jay Vosburghfd989c82008-11-04 17:51:16 -08001519static void ad_agg_selection_logic(struct aggregator *agg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001520{
Jay Vosburghfd989c82008-11-04 17:51:16 -08001521 struct aggregator *best, *active, *origin;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001522 struct port *port;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001523
Jay Vosburghfd989c82008-11-04 17:51:16 -08001524 origin = agg;
Jay Vosburghfd989c82008-11-04 17:51:16 -08001525 active = __get_active_agg(agg);
Stephen Hemminger4cd6fe12009-05-15 08:44:32 +00001526 best = (active && agg_device_up(active)) ? active : NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001527
Linus Torvalds1da177e2005-04-16 15:20:36 -07001528 do {
Jay Vosburghfd989c82008-11-04 17:51:16 -08001529 agg->is_active = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001530
Stephen Hemminger4cd6fe12009-05-15 08:44:32 +00001531 if (agg->num_of_ports && agg_device_up(agg))
Jay Vosburghfd989c82008-11-04 17:51:16 -08001532 best = ad_agg_selection_test(best, agg);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001533
Jay Vosburghfd989c82008-11-04 17:51:16 -08001534 } while ((agg = __get_next_agg(agg)));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001535
Jay Vosburghfd989c82008-11-04 17:51:16 -08001536 if (best &&
1537 __get_agg_selection_mode(best->lag_ports) == BOND_AD_STABLE) {
1538 /*
1539 * For the STABLE policy, don't replace the old active
1540 * aggregator if it's still active (it has an answering
1541 * partner) or if both the best and active don't have an
1542 * answering partner.
1543 */
1544 if (active && active->lag_ports &&
1545 active->lag_ports->is_enabled &&
1546 (__agg_has_partner(active) ||
1547 (!__agg_has_partner(active) && !__agg_has_partner(best)))) {
1548 if (!(!active->actor_oper_aggregator_key &&
1549 best->actor_oper_aggregator_key)) {
1550 best = NULL;
1551 active->is_active = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001552 }
1553 }
1554 }
1555
Jay Vosburghfd989c82008-11-04 17:51:16 -08001556 if (best && (best == active)) {
1557 best = NULL;
1558 active->is_active = 1;
1559 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001560
Jay Vosburghfd989c82008-11-04 17:51:16 -08001561 // if there is new best aggregator, activate it
1562 if (best) {
Holger Eitzenberger5a03cdb2008-12-09 23:09:22 -08001563 pr_debug("best Agg=%d; P=%d; a k=%d; p k=%d; Ind=%d; Act=%d\n",
Joe Perchesa4aee5c2009-12-13 20:06:07 -08001564 best->aggregator_identifier, best->num_of_ports,
1565 best->actor_oper_aggregator_key,
1566 best->partner_oper_aggregator_key,
1567 best->is_individual, best->is_active);
Holger Eitzenberger5a03cdb2008-12-09 23:09:22 -08001568 pr_debug("best ports %p slave %p %s\n",
Joe Perchesa4aee5c2009-12-13 20:06:07 -08001569 best->lag_ports, best->slave,
1570 best->slave ? best->slave->dev->name : "NULL");
Jay Vosburghfd989c82008-11-04 17:51:16 -08001571
1572 for (agg = __get_first_agg(best->lag_ports); agg;
1573 agg = __get_next_agg(agg)) {
1574
Holger Eitzenberger5a03cdb2008-12-09 23:09:22 -08001575 pr_debug("Agg=%d; P=%d; a k=%d; p k=%d; Ind=%d; Act=%d\n",
Joe Perchesa4aee5c2009-12-13 20:06:07 -08001576 agg->aggregator_identifier, agg->num_of_ports,
1577 agg->actor_oper_aggregator_key,
1578 agg->partner_oper_aggregator_key,
1579 agg->is_individual, agg->is_active);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001580 }
1581
1582 // check if any partner replys
Jay Vosburghfd989c82008-11-04 17:51:16 -08001583 if (best->is_individual) {
Joe Perchesa4aee5c2009-12-13 20:06:07 -08001584 pr_warning("%s: Warning: No 802.3ad response from the link partner for any adapters in the bond\n",
Dan Carpenterc99a3d22009-12-23 03:27:10 +00001585 best->slave ? best->slave->dev->master->name : "NULL");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001586 }
1587
Jay Vosburghfd989c82008-11-04 17:51:16 -08001588 best->is_active = 1;
Holger Eitzenberger5a03cdb2008-12-09 23:09:22 -08001589 pr_debug("LAG %d chosen as the active LAG\n",
Joe Perchesa4aee5c2009-12-13 20:06:07 -08001590 best->aggregator_identifier);
Holger Eitzenberger5a03cdb2008-12-09 23:09:22 -08001591 pr_debug("Agg=%d; P=%d; a k=%d; p k=%d; Ind=%d; Act=%d\n",
Joe Perchesa4aee5c2009-12-13 20:06:07 -08001592 best->aggregator_identifier, best->num_of_ports,
1593 best->actor_oper_aggregator_key,
1594 best->partner_oper_aggregator_key,
1595 best->is_individual, best->is_active);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001596
1597 // disable the ports that were related to the former active_aggregator
Jay Vosburghfd989c82008-11-04 17:51:16 -08001598 if (active) {
1599 for (port = active->lag_ports; port;
1600 port = port->next_port_in_aggregator) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001601 __disable_port(port);
1602 }
1603 }
1604 }
1605
Jay Vosburghfd989c82008-11-04 17:51:16 -08001606 /*
1607 * if the selected aggregator is of join individuals
1608 * (partner_system is NULL), enable their ports
1609 */
1610 active = __get_active_agg(origin);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001611
Jay Vosburghfd989c82008-11-04 17:51:16 -08001612 if (active) {
1613 if (!__agg_has_partner(active)) {
1614 for (port = active->lag_ports; port;
1615 port = port->next_port_in_aggregator) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001616 __enable_port(port);
1617 }
1618 }
1619 }
Jay Vosburghfd989c82008-11-04 17:51:16 -08001620
1621 if (origin->slave) {
1622 struct bonding *bond;
1623
1624 bond = bond_get_bond_by_slave(origin->slave);
1625 if (bond)
1626 bond_3ad_set_carrier(bond);
1627 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001628}
1629
1630/**
1631 * ad_clear_agg - clear a given aggregator's parameters
1632 * @aggregator: the aggregator we're looking at
1633 *
1634 */
1635static void ad_clear_agg(struct aggregator *aggregator)
1636{
1637 if (aggregator) {
Holger Eitzenberger1624db72008-12-26 13:27:21 -08001638 aggregator->is_individual = false;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001639 aggregator->actor_admin_aggregator_key = 0;
1640 aggregator->actor_oper_aggregator_key = 0;
1641 aggregator->partner_system = null_mac_addr;
1642 aggregator->partner_system_priority = 0;
1643 aggregator->partner_oper_aggregator_key = 0;
1644 aggregator->receive_state = 0;
1645 aggregator->transmit_state = 0;
1646 aggregator->lag_ports = NULL;
1647 aggregator->is_active = 0;
1648 aggregator->num_of_ports = 0;
Joe Perchesa4aee5c2009-12-13 20:06:07 -08001649 pr_debug("LAG %d was cleared\n",
1650 aggregator->aggregator_identifier);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001651 }
1652}
1653
1654/**
1655 * ad_initialize_agg - initialize a given aggregator's parameters
1656 * @aggregator: the aggregator we're looking at
1657 *
1658 */
1659static void ad_initialize_agg(struct aggregator *aggregator)
1660{
1661 if (aggregator) {
1662 ad_clear_agg(aggregator);
1663
1664 aggregator->aggregator_mac_address = null_mac_addr;
1665 aggregator->aggregator_identifier = 0;
1666 aggregator->slave = NULL;
1667 }
1668}
1669
1670/**
1671 * ad_initialize_port - initialize a given port's parameters
1672 * @aggregator: the aggregator we're looking at
1673 * @lacp_fast: boolean. whether fast periodic should be used
1674 *
1675 */
1676static void ad_initialize_port(struct port *port, int lacp_fast)
1677{
Holger Eitzenbergerc7e703d2008-12-17 19:12:07 -08001678 static const struct port_params tmpl = {
1679 .system_priority = 0xffff,
1680 .key = 1,
1681 .port_number = 1,
1682 .port_priority = 0xff,
1683 .port_state = 1,
1684 };
Holger Eitzenberger7addeef2008-12-26 13:28:33 -08001685 static const struct lacpdu lacpdu = {
1686 .subtype = 0x01,
1687 .version_number = 0x01,
1688 .tlv_type_actor_info = 0x01,
1689 .actor_information_length = 0x14,
1690 .tlv_type_partner_info = 0x02,
1691 .partner_information_length = 0x14,
1692 .tlv_type_collector_info = 0x03,
1693 .collector_information_length = 0x10,
1694 .collector_max_delay = htons(AD_COLLECTOR_MAX_DELAY),
1695 };
Holger Eitzenbergerc7e703d2008-12-17 19:12:07 -08001696
Linus Torvalds1da177e2005-04-16 15:20:36 -07001697 if (port) {
1698 port->actor_port_number = 1;
1699 port->actor_port_priority = 0xff;
1700 port->actor_system = null_mac_addr;
1701 port->actor_system_priority = 0xffff;
1702 port->actor_port_aggregator_identifier = 0;
Holger Eitzenbergerd238d452008-12-26 11:18:15 -08001703 port->ntt = false;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001704 port->actor_admin_port_key = 1;
1705 port->actor_oper_port_key = 1;
1706 port->actor_admin_port_state = AD_STATE_AGGREGATION | AD_STATE_LACP_ACTIVITY;
1707 port->actor_oper_port_state = AD_STATE_AGGREGATION | AD_STATE_LACP_ACTIVITY;
1708
Bandan Das7bfc4752010-10-16 20:19:59 +00001709 if (lacp_fast)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001710 port->actor_oper_port_state |= AD_STATE_LACP_TIMEOUT;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001711
Holger Eitzenbergerc7e703d2008-12-17 19:12:07 -08001712 memcpy(&port->partner_admin, &tmpl, sizeof(tmpl));
1713 memcpy(&port->partner_oper, &tmpl, sizeof(tmpl));
1714
Holger Eitzenbergerf48127b2008-12-26 13:26:54 -08001715 port->is_enabled = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001716 // ****** private parameters ******
1717 port->sm_vars = 0x3;
1718 port->sm_rx_state = 0;
1719 port->sm_rx_timer_counter = 0;
1720 port->sm_periodic_state = 0;
1721 port->sm_periodic_timer_counter = 0;
1722 port->sm_mux_state = 0;
1723 port->sm_mux_timer_counter = 0;
1724 port->sm_tx_state = 0;
1725 port->sm_tx_timer_counter = 0;
1726 port->slave = NULL;
1727 port->aggregator = NULL;
1728 port->next_port_in_aggregator = NULL;
1729 port->transaction_id = 0;
1730
Holger Eitzenberger7addeef2008-12-26 13:28:33 -08001731 memcpy(&port->lacpdu, &lacpdu, sizeof(lacpdu));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001732 }
1733}
1734
1735/**
1736 * ad_enable_collecting_distributing - enable a port's transmit/receive
1737 * @port: the port we're looking at
1738 *
1739 * Enable @port if it's in an active aggregator
1740 */
1741static void ad_enable_collecting_distributing(struct port *port)
1742{
1743 if (port->aggregator->is_active) {
Joe Perchesa4aee5c2009-12-13 20:06:07 -08001744 pr_debug("Enabling port %d(LAG %d)\n",
1745 port->actor_port_number,
1746 port->aggregator->aggregator_identifier);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001747 __enable_port(port);
1748 }
1749}
1750
1751/**
1752 * ad_disable_collecting_distributing - disable a port's transmit/receive
1753 * @port: the port we're looking at
1754 *
1755 */
1756static void ad_disable_collecting_distributing(struct port *port)
1757{
1758 if (port->aggregator && MAC_ADDRESS_COMPARE(&(port->aggregator->partner_system), &(null_mac_addr))) {
Joe Perchesa4aee5c2009-12-13 20:06:07 -08001759 pr_debug("Disabling port %d(LAG %d)\n",
1760 port->actor_port_number,
1761 port->aggregator->aggregator_identifier);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001762 __disable_port(port);
1763 }
1764}
1765
1766#if 0
1767/**
1768 * ad_marker_info_send - send a marker information frame
1769 * @port: the port we're looking at
1770 *
1771 * This function does nothing since we decided not to implement send and handle
1772 * response for marker PDU's, in this stage, but only to respond to marker
1773 * information.
1774 */
1775static void ad_marker_info_send(struct port *port)
1776{
Mathieu Desnoyers1c3f0b82007-10-18 23:41:04 -07001777 struct bond_marker marker;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001778 u16 index;
1779
1780 // fill the marker PDU with the appropriate values
1781 marker.subtype = 0x02;
1782 marker.version_number = 0x01;
1783 marker.tlv_type = AD_MARKER_INFORMATION_SUBTYPE;
1784 marker.marker_length = 0x16;
1785 // convert requester_port to Big Endian
1786 marker.requester_port = (((port->actor_port_number & 0xFF) << 8) |((u16)(port->actor_port_number & 0xFF00) >> 8));
1787 marker.requester_system = port->actor_system;
1788 // convert requester_port(u32) to Big Endian
Bandan Das128ea6c2010-10-16 20:19:58 +00001789 marker.requester_transaction_id =
1790 (((++port->transaction_id & 0xFF) << 24)
1791 | ((port->transaction_id & 0xFF00) << 8)
1792 | ((port->transaction_id & 0xFF0000) >> 8)
1793 | ((port->transaction_id & 0xFF000000) >> 24));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001794 marker.pad = 0;
1795 marker.tlv_type_terminator = 0x00;
1796 marker.terminator_length = 0x00;
Bandan Das128ea6c2010-10-16 20:19:58 +00001797 for (index = 0; index < 90; index++)
1798 marker.reserved_90[index] = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001799
1800 // send the marker information
1801 if (ad_marker_send(port, &marker) >= 0) {
Joe Perchesa4aee5c2009-12-13 20:06:07 -08001802 pr_debug("Sent Marker Information on port %d\n",
1803 port->actor_port_number);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001804 }
1805}
1806#endif
1807
1808/**
1809 * ad_marker_info_received - handle receive of a Marker information frame
1810 * @marker_info: Marker info received
1811 * @port: the port we're looking at
1812 *
1813 */
Mathieu Desnoyers1c3f0b82007-10-18 23:41:04 -07001814static void ad_marker_info_received(struct bond_marker *marker_info,
1815 struct port *port)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001816{
Mathieu Desnoyers1c3f0b82007-10-18 23:41:04 -07001817 struct bond_marker marker;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001818
1819 // copy the received marker data to the response marker
1820 //marker = *marker_info;
Mathieu Desnoyers1c3f0b82007-10-18 23:41:04 -07001821 memcpy(&marker, marker_info, sizeof(struct bond_marker));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001822 // change the marker subtype to marker response
Bandan Das128ea6c2010-10-16 20:19:58 +00001823 marker.tlv_type = AD_MARKER_RESPONSE_SUBTYPE;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001824 // send the marker response
1825
1826 if (ad_marker_send(port, &marker) >= 0) {
Joe Perchesa4aee5c2009-12-13 20:06:07 -08001827 pr_debug("Sent Marker Response on port %d\n",
1828 port->actor_port_number);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001829 }
1830}
1831
1832/**
1833 * ad_marker_response_received - handle receive of a marker response frame
1834 * @marker: marker PDU received
1835 * @port: the port we're looking at
1836 *
1837 * This function does nothing since we decided not to implement send and handle
1838 * response for marker PDU's, in this stage, but only to respond to marker
1839 * information.
1840 */
Mathieu Desnoyers1c3f0b82007-10-18 23:41:04 -07001841static void ad_marker_response_received(struct bond_marker *marker,
1842 struct port *port)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001843{
Bandan Das128ea6c2010-10-16 20:19:58 +00001844 marker = NULL; /* just to satisfy the compiler */
1845 port = NULL; /* just to satisfy the compiler */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001846 // DO NOTHING, SINCE WE DECIDED NOT TO IMPLEMENT THIS FEATURE FOR NOW
1847}
1848
Linus Torvalds1da177e2005-04-16 15:20:36 -07001849//////////////////////////////////////////////////////////////////////////////////////
1850// ================= AD exported functions to the main bonding code ==================
1851//////////////////////////////////////////////////////////////////////////////////////
1852
1853// Check aggregators status in team every T seconds
1854#define AD_AGGREGATOR_SELECTION_TIMER 8
1855
Jay Vosburghfd989c82008-11-04 17:51:16 -08001856/*
1857 * bond_3ad_initiate_agg_selection(struct bonding *bond)
1858 *
1859 * Set the aggregation selection timer, to initiate an agg selection in
1860 * the very near future. Called during first initialization, and during
1861 * any down to up transitions of the bond.
1862 */
1863void bond_3ad_initiate_agg_selection(struct bonding *bond, int timeout)
1864{
1865 BOND_AD_INFO(bond).agg_select_timer = timeout;
1866 BOND_AD_INFO(bond).agg_select_mode = bond->params.ad_select;
1867}
1868
Linus Torvalds1da177e2005-04-16 15:20:36 -07001869static u16 aggregator_identifier;
1870
1871/**
1872 * bond_3ad_initialize - initialize a bond's 802.3ad parameters and structures
1873 * @bond: bonding struct to work on
1874 * @tick_resolution: tick duration (millisecond resolution)
1875 * @lacp_fast: boolean. whether fast periodic should be used
1876 *
1877 * Can be called only after the mac address of the bond is set.
1878 */
1879void bond_3ad_initialize(struct bonding *bond, u16 tick_resolution, int lacp_fast)
Jiri Pirko3a6d54c2009-05-11 23:37:15 +00001880{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001881 // check that the bond is not initialized yet
Jiri Pirko3a6d54c2009-05-11 23:37:15 +00001882 if (MAC_ADDRESS_COMPARE(&(BOND_AD_INFO(bond).system.sys_mac_addr),
1883 bond->dev->dev_addr)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001884
1885 aggregator_identifier = 0;
1886
1887 BOND_AD_INFO(bond).lacp_fast = lacp_fast;
1888 BOND_AD_INFO(bond).system.sys_priority = 0xFFFF;
1889 BOND_AD_INFO(bond).system.sys_mac_addr = *((struct mac_addr *)bond->dev->dev_addr);
1890
1891 // initialize how many times this module is called in one second(should be about every 100ms)
1892 ad_ticks_per_sec = tick_resolution;
1893
Jay Vosburghfd989c82008-11-04 17:51:16 -08001894 bond_3ad_initiate_agg_selection(bond,
1895 AD_AGGREGATOR_SELECTION_TIMER *
1896 ad_ticks_per_sec);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001897 }
1898}
1899
1900/**
1901 * bond_3ad_bind_slave - initialize a slave's port
1902 * @slave: slave struct to work on
1903 *
1904 * Returns: 0 on success
1905 * < 0 on error
1906 */
1907int bond_3ad_bind_slave(struct slave *slave)
1908{
1909 struct bonding *bond = bond_get_bond_by_slave(slave);
1910 struct port *port;
1911 struct aggregator *aggregator;
1912
1913 if (bond == NULL) {
Joe Perchesa4aee5c2009-12-13 20:06:07 -08001914 pr_err("%s: The slave %s is not attached to its bond\n",
Mitch Williams4e0952c2005-11-09 10:34:57 -08001915 slave->dev->master->name, slave->dev->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001916 return -1;
1917 }
1918
1919 //check that the slave has not been intialized yet.
1920 if (SLAVE_AD_INFO(slave).port.slave != slave) {
1921
1922 // port initialization
1923 port = &(SLAVE_AD_INFO(slave).port);
1924
1925 ad_initialize_port(port, BOND_AD_INFO(bond).lacp_fast);
1926
1927 port->slave = slave;
1928 port->actor_port_number = SLAVE_AD_INFO(slave).id;
1929 // key is determined according to the link speed, duplex and user key(which is yet not supported)
1930 // ------------------------------------------------------------
1931 // Port key : | User key | Speed |Duplex|
1932 // ------------------------------------------------------------
1933 // 16 6 1 0
1934 port->actor_admin_port_key = 0; // initialize this parameter
1935 port->actor_admin_port_key |= __get_duplex(port);
1936 port->actor_admin_port_key |= (__get_link_speed(port) << 1);
1937 port->actor_oper_port_key = port->actor_admin_port_key;
1938 // if the port is not full duplex, then the port should be not lacp Enabled
Bandan Das7bfc4752010-10-16 20:19:59 +00001939 if (!(port->actor_oper_port_key & AD_DUPLEX_KEY_BITS))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001940 port->sm_vars &= ~AD_PORT_LACP_ENABLED;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001941 // actor system is the bond's system
1942 port->actor_system = BOND_AD_INFO(bond).system.sys_mac_addr;
1943 // tx timer(to verify that no more than MAX_TX_IN_SECOND lacpdu's are sent in one second)
1944 port->sm_tx_timer_counter = ad_ticks_per_sec/AD_MAX_TX_IN_SECOND;
1945 port->aggregator = NULL;
1946 port->next_port_in_aggregator = NULL;
1947
1948 __disable_port(port);
1949 __initialize_port_locks(port);
1950
1951
1952 // aggregator initialization
1953 aggregator = &(SLAVE_AD_INFO(slave).aggregator);
1954
1955 ad_initialize_agg(aggregator);
1956
1957 aggregator->aggregator_mac_address = *((struct mac_addr *)bond->dev->dev_addr);
1958 aggregator->aggregator_identifier = (++aggregator_identifier);
1959 aggregator->slave = slave;
1960 aggregator->is_active = 0;
1961 aggregator->num_of_ports = 0;
1962 }
1963
1964 return 0;
1965}
1966
1967/**
1968 * bond_3ad_unbind_slave - deinitialize a slave's port
1969 * @slave: slave struct to work on
1970 *
1971 * Search for the aggregator that is related to this port, remove the
1972 * aggregator and assign another aggregator for other port related to it
1973 * (if any), and remove the port.
1974 */
1975void bond_3ad_unbind_slave(struct slave *slave)
1976{
1977 struct port *port, *prev_port, *temp_port;
1978 struct aggregator *aggregator, *new_aggregator, *temp_aggregator;
1979 int select_new_active_agg = 0;
Jasper Spaansa361c832009-10-23 04:09:24 +00001980
Linus Torvalds1da177e2005-04-16 15:20:36 -07001981 // find the aggregator related to this slave
1982 aggregator = &(SLAVE_AD_INFO(slave).aggregator);
1983
1984 // find the port related to this slave
1985 port = &(SLAVE_AD_INFO(slave).port);
1986
1987 // if slave is null, the whole port is not initialized
1988 if (!port->slave) {
Joe Perchesa4aee5c2009-12-13 20:06:07 -08001989 pr_warning("Warning: %s: Trying to unbind an uninitialized port on %s\n",
Jiri Pirkoe5e2a8f2009-08-13 04:11:52 +00001990 slave->dev->master->name, slave->dev->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001991 return;
1992 }
1993
Joe Perchesa4aee5c2009-12-13 20:06:07 -08001994 pr_debug("Unbinding Link Aggregation Group %d\n",
1995 aggregator->aggregator_identifier);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001996
1997 /* Tell the partner that this port is not suitable for aggregation */
1998 port->actor_oper_port_state &= ~AD_STATE_AGGREGATION;
1999 __update_lacpdu_from_port(port);
2000 ad_lacpdu_send(port);
2001
2002 // check if this aggregator is occupied
2003 if (aggregator->lag_ports) {
2004 // check if there are other ports related to this aggregator except
2005 // the port related to this slave(thats ensure us that there is a
2006 // reason to search for new aggregator, and that we will find one
2007 if ((aggregator->lag_ports != port) || (aggregator->lag_ports->next_port_in_aggregator)) {
2008 // find new aggregator for the related port(s)
2009 new_aggregator = __get_first_agg(port);
2010 for (; new_aggregator; new_aggregator = __get_next_agg(new_aggregator)) {
Anand Gadiyarfd589a82009-07-16 17:13:03 +02002011 // if the new aggregator is empty, or it is connected to our port only
Bandan Das7bfc4752010-10-16 20:19:59 +00002012 if (!new_aggregator->lag_ports
2013 || ((new_aggregator->lag_ports == port)
2014 && !new_aggregator->lag_ports->next_port_in_aggregator))
Linus Torvalds1da177e2005-04-16 15:20:36 -07002015 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002016 }
2017 // if new aggregator found, copy the aggregator's parameters
2018 // and connect the related lag_ports to the new aggregator
2019 if ((new_aggregator) && ((!new_aggregator->lag_ports) || ((new_aggregator->lag_ports == port) && !new_aggregator->lag_ports->next_port_in_aggregator))) {
Joe Perchesa4aee5c2009-12-13 20:06:07 -08002020 pr_debug("Some port(s) related to LAG %d - replaceing with LAG %d\n",
2021 aggregator->aggregator_identifier,
2022 new_aggregator->aggregator_identifier);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002023
2024 if ((new_aggregator->lag_ports == port) && new_aggregator->is_active) {
Joe Perchesa4aee5c2009-12-13 20:06:07 -08002025 pr_info("%s: Removing an active aggregator\n",
Jiri Pirkoe5e2a8f2009-08-13 04:11:52 +00002026 aggregator->slave->dev->master->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002027 // select new active aggregator
2028 select_new_active_agg = 1;
2029 }
2030
2031 new_aggregator->is_individual = aggregator->is_individual;
2032 new_aggregator->actor_admin_aggregator_key = aggregator->actor_admin_aggregator_key;
2033 new_aggregator->actor_oper_aggregator_key = aggregator->actor_oper_aggregator_key;
2034 new_aggregator->partner_system = aggregator->partner_system;
2035 new_aggregator->partner_system_priority = aggregator->partner_system_priority;
2036 new_aggregator->partner_oper_aggregator_key = aggregator->partner_oper_aggregator_key;
2037 new_aggregator->receive_state = aggregator->receive_state;
2038 new_aggregator->transmit_state = aggregator->transmit_state;
2039 new_aggregator->lag_ports = aggregator->lag_ports;
2040 new_aggregator->is_active = aggregator->is_active;
2041 new_aggregator->num_of_ports = aggregator->num_of_ports;
2042
2043 // update the information that is written on the ports about the aggregator
Bandan Das128ea6c2010-10-16 20:19:58 +00002044 for (temp_port = aggregator->lag_ports; temp_port;
2045 temp_port = temp_port->next_port_in_aggregator) {
2046 temp_port->aggregator = new_aggregator;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002047 temp_port->actor_port_aggregator_identifier = new_aggregator->aggregator_identifier;
2048 }
2049
2050 // clear the aggregator
2051 ad_clear_agg(aggregator);
Jasper Spaansa361c832009-10-23 04:09:24 +00002052
Bandan Das7bfc4752010-10-16 20:19:59 +00002053 if (select_new_active_agg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002054 ad_agg_selection_logic(__get_first_agg(port));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002055 } else {
Joe Perchesa4aee5c2009-12-13 20:06:07 -08002056 pr_warning("%s: Warning: unbinding aggregator, and could not find a new aggregator for its ports\n",
Jiri Pirkoe5e2a8f2009-08-13 04:11:52 +00002057 slave->dev->master->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002058 }
2059 } else { // in case that the only port related to this aggregator is the one we want to remove
2060 select_new_active_agg = aggregator->is_active;
2061 // clear the aggregator
2062 ad_clear_agg(aggregator);
2063 if (select_new_active_agg) {
Joe Perchesa4aee5c2009-12-13 20:06:07 -08002064 pr_info("%s: Removing an active aggregator\n",
Jiri Pirkoe5e2a8f2009-08-13 04:11:52 +00002065 slave->dev->master->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002066 // select new active aggregator
2067 ad_agg_selection_logic(__get_first_agg(port));
2068 }
2069 }
2070 }
2071
Holger Eitzenberger5a03cdb2008-12-09 23:09:22 -08002072 pr_debug("Unbinding port %d\n", port->actor_port_number);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002073 // find the aggregator that this port is connected to
2074 temp_aggregator = __get_first_agg(port);
2075 for (; temp_aggregator; temp_aggregator = __get_next_agg(temp_aggregator)) {
2076 prev_port = NULL;
2077 // search the port in the aggregator's related ports
Bandan Das128ea6c2010-10-16 20:19:58 +00002078 for (temp_port = temp_aggregator->lag_ports; temp_port;
2079 prev_port = temp_port,
2080 temp_port = temp_port->next_port_in_aggregator) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002081 if (temp_port == port) { // the aggregator found - detach the port from this aggregator
Bandan Das7bfc4752010-10-16 20:19:59 +00002082 if (prev_port)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002083 prev_port->next_port_in_aggregator = temp_port->next_port_in_aggregator;
Bandan Das7bfc4752010-10-16 20:19:59 +00002084 else
Linus Torvalds1da177e2005-04-16 15:20:36 -07002085 temp_aggregator->lag_ports = temp_port->next_port_in_aggregator;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002086 temp_aggregator->num_of_ports--;
Bandan Das128ea6c2010-10-16 20:19:58 +00002087 if (temp_aggregator->num_of_ports == 0) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002088 select_new_active_agg = temp_aggregator->is_active;
2089 // clear the aggregator
2090 ad_clear_agg(temp_aggregator);
2091 if (select_new_active_agg) {
Joe Perchesa4aee5c2009-12-13 20:06:07 -08002092 pr_info("%s: Removing an active aggregator\n",
Jiri Pirkoe5e2a8f2009-08-13 04:11:52 +00002093 slave->dev->master->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002094 // select new active aggregator
2095 ad_agg_selection_logic(__get_first_agg(port));
2096 }
2097 }
2098 break;
2099 }
2100 }
2101 }
Bandan Das128ea6c2010-10-16 20:19:58 +00002102 port->slave = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002103}
2104
2105/**
2106 * bond_3ad_state_machine_handler - handle state machines timeout
2107 * @bond: bonding struct to work on
2108 *
2109 * The state machine handling concept in this module is to check every tick
2110 * which state machine should operate any function. The execution order is
2111 * round robin, so when we have an interaction between state machines, the
2112 * reply of one to each other might be delayed until next tick.
2113 *
2114 * This function also complete the initialization when the agg_select_timer
2115 * times out, and it selects an aggregator for the ports that are yet not
2116 * related to any aggregator, and selects the active aggregator for a bond.
2117 */
Jay Vosburgh1b76b312007-10-17 17:37:45 -07002118void bond_3ad_state_machine_handler(struct work_struct *work)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002119{
Jay Vosburgh1b76b312007-10-17 17:37:45 -07002120 struct bonding *bond = container_of(work, struct bonding,
2121 ad_work.work);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002122 struct port *port;
2123 struct aggregator *aggregator;
2124
2125 read_lock(&bond->lock);
2126
Bandan Das7bfc4752010-10-16 20:19:59 +00002127 if (bond->kill_timers)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002128 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002129
2130 //check if there are any slaves
Bandan Das7bfc4752010-10-16 20:19:59 +00002131 if (bond->slave_cnt == 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002132 goto re_arm;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002133
2134 // check if agg_select_timer timer after initialize is timed out
2135 if (BOND_AD_INFO(bond).agg_select_timer && !(--BOND_AD_INFO(bond).agg_select_timer)) {
2136 // select the active aggregator for the bond
2137 if ((port = __get_first_port(bond))) {
2138 if (!port->slave) {
Joe Perchesa4aee5c2009-12-13 20:06:07 -08002139 pr_warning("%s: Warning: bond's first port is uninitialized\n",
2140 bond->dev->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002141 goto re_arm;
2142 }
2143
2144 aggregator = __get_first_agg(port);
2145 ad_agg_selection_logic(aggregator);
2146 }
Jay Vosburghf0c76d62008-07-02 18:21:58 -07002147 bond_3ad_set_carrier(bond);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002148 }
2149
2150 // for each port run the state machines
2151 for (port = __get_first_port(bond); port; port = __get_next_port(port)) {
2152 if (!port->slave) {
Joe Perchesa4aee5c2009-12-13 20:06:07 -08002153 pr_warning("%s: Warning: Found an uninitialized port\n",
2154 bond->dev->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002155 goto re_arm;
2156 }
2157
2158 ad_rx_machine(NULL, port);
2159 ad_periodic_machine(port);
2160 ad_port_selection_logic(port);
2161 ad_mux_machine(port);
2162 ad_tx_machine(port);
2163
2164 // turn off the BEGIN bit, since we already handled it
Bandan Das7bfc4752010-10-16 20:19:59 +00002165 if (port->sm_vars & AD_PORT_BEGIN)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002166 port->sm_vars &= ~AD_PORT_BEGIN;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002167 }
2168
2169re_arm:
Jay Vosburgh1b76b312007-10-17 17:37:45 -07002170 queue_delayed_work(bond->wq, &bond->ad_work, ad_delta_in_ticks);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002171out:
2172 read_unlock(&bond->lock);
2173}
2174
2175/**
2176 * bond_3ad_rx_indication - handle a received frame
2177 * @lacpdu: received lacpdu
2178 * @slave: slave struct to work on
2179 * @length: length of the data received
2180 *
2181 * It is assumed that frames that were sent on this NIC don't returned as new
2182 * received frames (loopback). Since only the payload is given to this
2183 * function, it check for loopback.
2184 */
2185static void bond_3ad_rx_indication(struct lacpdu *lacpdu, struct slave *slave, u16 length)
2186{
2187 struct port *port;
2188
2189 if (length >= sizeof(struct lacpdu)) {
2190
2191 port = &(SLAVE_AD_INFO(slave).port);
2192
2193 if (!port->slave) {
Joe Perchesa4aee5c2009-12-13 20:06:07 -08002194 pr_warning("%s: Warning: port of slave %s is uninitialized\n",
Jiri Pirkoe5e2a8f2009-08-13 04:11:52 +00002195 slave->dev->name, slave->dev->master->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002196 return;
2197 }
2198
2199 switch (lacpdu->subtype) {
2200 case AD_TYPE_LACPDU:
Joe Perchesa4aee5c2009-12-13 20:06:07 -08002201 pr_debug("Received LACPDU on port %d\n",
2202 port->actor_port_number);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002203 ad_rx_machine(lacpdu, port);
2204 break;
2205
2206 case AD_TYPE_MARKER:
2207 // No need to convert fields to Little Endian since we don't use the marker's fields.
2208
Mathieu Desnoyers1c3f0b82007-10-18 23:41:04 -07002209 switch (((struct bond_marker *)lacpdu)->tlv_type) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002210 case AD_MARKER_INFORMATION_SUBTYPE:
Joe Perchesa4aee5c2009-12-13 20:06:07 -08002211 pr_debug("Received Marker Information on port %d\n",
2212 port->actor_port_number);
Mathieu Desnoyers1c3f0b82007-10-18 23:41:04 -07002213 ad_marker_info_received((struct bond_marker *)lacpdu, port);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002214 break;
2215
2216 case AD_MARKER_RESPONSE_SUBTYPE:
Joe Perchesa4aee5c2009-12-13 20:06:07 -08002217 pr_debug("Received Marker Response on port %d\n",
2218 port->actor_port_number);
Mathieu Desnoyers1c3f0b82007-10-18 23:41:04 -07002219 ad_marker_response_received((struct bond_marker *)lacpdu, port);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002220 break;
2221
2222 default:
Joe Perchesa4aee5c2009-12-13 20:06:07 -08002223 pr_debug("Received an unknown Marker subtype on slot %d\n",
2224 port->actor_port_number);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002225 }
2226 }
2227 }
2228}
2229
2230/**
2231 * bond_3ad_adapter_speed_changed - handle a slave's speed change indication
2232 * @slave: slave struct to work on
2233 *
2234 * Handle reselection of aggregator (if needed) for this port.
2235 */
2236void bond_3ad_adapter_speed_changed(struct slave *slave)
2237{
2238 struct port *port;
2239
2240 port = &(SLAVE_AD_INFO(slave).port);
2241
2242 // if slave is null, the whole port is not initialized
2243 if (!port->slave) {
Joe Perchesa4aee5c2009-12-13 20:06:07 -08002244 pr_warning("Warning: %s: speed changed for uninitialized port on %s\n",
Jiri Pirkoe5e2a8f2009-08-13 04:11:52 +00002245 slave->dev->master->name, slave->dev->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002246 return;
2247 }
2248
2249 port->actor_admin_port_key &= ~AD_SPEED_KEY_BITS;
Bandan Das128ea6c2010-10-16 20:19:58 +00002250 port->actor_oper_port_key = port->actor_admin_port_key |=
2251 (__get_link_speed(port) << 1);
Holger Eitzenberger5a03cdb2008-12-09 23:09:22 -08002252 pr_debug("Port %d changed speed\n", port->actor_port_number);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002253 // there is no need to reselect a new aggregator, just signal the
2254 // state machines to reinitialize
2255 port->sm_vars |= AD_PORT_BEGIN;
2256}
2257
2258/**
2259 * bond_3ad_adapter_duplex_changed - handle a slave's duplex change indication
2260 * @slave: slave struct to work on
2261 *
2262 * Handle reselection of aggregator (if needed) for this port.
2263 */
2264void bond_3ad_adapter_duplex_changed(struct slave *slave)
2265{
2266 struct port *port;
2267
Bandan Das128ea6c2010-10-16 20:19:58 +00002268 port = &(SLAVE_AD_INFO(slave).port);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002269
2270 // if slave is null, the whole port is not initialized
2271 if (!port->slave) {
Joe Perchesa4aee5c2009-12-13 20:06:07 -08002272 pr_warning("%s: Warning: duplex changed for uninitialized port on %s\n",
Jiri Pirkoe5e2a8f2009-08-13 04:11:52 +00002273 slave->dev->master->name, slave->dev->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002274 return;
2275 }
2276
2277 port->actor_admin_port_key &= ~AD_DUPLEX_KEY_BITS;
Bandan Das128ea6c2010-10-16 20:19:58 +00002278 port->actor_oper_port_key = port->actor_admin_port_key |=
2279 __get_duplex(port);
Holger Eitzenberger5a03cdb2008-12-09 23:09:22 -08002280 pr_debug("Port %d changed duplex\n", port->actor_port_number);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002281 // there is no need to reselect a new aggregator, just signal the
2282 // state machines to reinitialize
2283 port->sm_vars |= AD_PORT_BEGIN;
2284}
2285
2286/**
2287 * bond_3ad_handle_link_change - handle a slave's link status change indication
2288 * @slave: slave struct to work on
2289 * @status: whether the link is now up or down
2290 *
2291 * Handle reselection of aggregator (if needed) for this port.
2292 */
2293void bond_3ad_handle_link_change(struct slave *slave, char link)
2294{
2295 struct port *port;
2296
2297 port = &(SLAVE_AD_INFO(slave).port);
2298
2299 // if slave is null, the whole port is not initialized
2300 if (!port->slave) {
Joe Perchesa4aee5c2009-12-13 20:06:07 -08002301 pr_warning("Warning: %s: link status changed for uninitialized port on %s\n",
Jiri Pirkoe5e2a8f2009-08-13 04:11:52 +00002302 slave->dev->master->name, slave->dev->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002303 return;
2304 }
2305
2306 // on link down we are zeroing duplex and speed since some of the adaptors(ce1000.lan) report full duplex/speed instead of N/A(duplex) / 0(speed)
2307 // on link up we are forcing recheck on the duplex and speed since some of he adaptors(ce1000.lan) report
2308 if (link == BOND_LINK_UP) {
Holger Eitzenbergerf48127b2008-12-26 13:26:54 -08002309 port->is_enabled = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002310 port->actor_admin_port_key &= ~AD_DUPLEX_KEY_BITS;
Bandan Das128ea6c2010-10-16 20:19:58 +00002311 port->actor_oper_port_key = port->actor_admin_port_key |=
2312 __get_duplex(port);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002313 port->actor_admin_port_key &= ~AD_SPEED_KEY_BITS;
Bandan Das128ea6c2010-10-16 20:19:58 +00002314 port->actor_oper_port_key = port->actor_admin_port_key |=
2315 (__get_link_speed(port) << 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002316 } else {
2317 /* link has failed */
Holger Eitzenbergerf48127b2008-12-26 13:26:54 -08002318 port->is_enabled = false;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002319 port->actor_admin_port_key &= ~AD_DUPLEX_KEY_BITS;
Bandan Das128ea6c2010-10-16 20:19:58 +00002320 port->actor_oper_port_key = (port->actor_admin_port_key &=
2321 ~AD_SPEED_KEY_BITS);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002322 }
2323 //BOND_PRINT_DBG(("Port %d changed link status to %s", port->actor_port_number, ((link == BOND_LINK_UP)?"UP":"DOWN")));
2324 // there is no need to reselect a new aggregator, just signal the
2325 // state machines to reinitialize
2326 port->sm_vars |= AD_PORT_BEGIN;
2327}
2328
Jay Vosburghff59c452006-03-27 13:27:43 -08002329/*
Jasper Spaansa361c832009-10-23 04:09:24 +00002330 * set link state for bonding master: if we have an active
Jay Vosburghff59c452006-03-27 13:27:43 -08002331 * aggregator, we're up, if not, we're down. Presumes that we cannot
2332 * have an active aggregator if there are no slaves with link up.
2333 *
Jay Vosburgh031ae4d2007-06-13 22:11:34 -07002334 * This behavior complies with IEEE 802.3 section 43.3.9.
2335 *
Jay Vosburghff59c452006-03-27 13:27:43 -08002336 * Called by bond_set_carrier(). Return zero if carrier state does not
2337 * change, nonzero if it does.
2338 */
2339int bond_3ad_set_carrier(struct bonding *bond)
2340{
Jay Vosburgh031ae4d2007-06-13 22:11:34 -07002341 if (__get_active_agg(&(SLAVE_AD_INFO(bond->first_slave).aggregator))) {
Jay Vosburghff59c452006-03-27 13:27:43 -08002342 if (!netif_carrier_ok(bond->dev)) {
2343 netif_carrier_on(bond->dev);
2344 return 1;
2345 }
2346 return 0;
2347 }
2348
2349 if (netif_carrier_ok(bond->dev)) {
2350 netif_carrier_off(bond->dev);
2351 return 1;
2352 }
2353 return 0;
2354}
2355
Linus Torvalds1da177e2005-04-16 15:20:36 -07002356/**
2357 * bond_3ad_get_active_agg_info - get information of the active aggregator
2358 * @bond: bonding struct to work on
2359 * @ad_info: ad_info struct to fill with the bond's info
2360 *
2361 * Returns: 0 on success
2362 * < 0 on error
2363 */
2364int bond_3ad_get_active_agg_info(struct bonding *bond, struct ad_info *ad_info)
2365{
2366 struct aggregator *aggregator = NULL;
2367 struct port *port;
2368
2369 for (port = __get_first_port(bond); port; port = __get_next_port(port)) {
2370 if (port->aggregator && port->aggregator->is_active) {
2371 aggregator = port->aggregator;
2372 break;
2373 }
2374 }
2375
2376 if (aggregator) {
2377 ad_info->aggregator_id = aggregator->aggregator_identifier;
2378 ad_info->ports = aggregator->num_of_ports;
2379 ad_info->actor_key = aggregator->actor_oper_aggregator_key;
2380 ad_info->partner_key = aggregator->partner_oper_aggregator_key;
2381 memcpy(ad_info->partner_system, aggregator->partner_system.mac_addr_value, ETH_ALEN);
2382 return 0;
2383 }
2384
2385 return -1;
2386}
2387
2388int bond_3ad_xmit_xor(struct sk_buff *skb, struct net_device *dev)
2389{
2390 struct slave *slave, *start_at;
Wang Chen454d7c92008-11-12 23:37:49 -08002391 struct bonding *bond = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002392 int slave_agg_no;
2393 int slaves_in_agg;
2394 int agg_id;
2395 int i;
2396 struct ad_info ad_info;
2397 int res = 1;
2398
2399 /* make sure that the slaves list will
2400 * not change during tx
2401 */
2402 read_lock(&bond->lock);
2403
Bandan Das7bfc4752010-10-16 20:19:59 +00002404 if (!BOND_IS_OK(bond))
Linus Torvalds1da177e2005-04-16 15:20:36 -07002405 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002406
2407 if (bond_3ad_get_active_agg_info(bond, &ad_info)) {
Joe Perchesa4aee5c2009-12-13 20:06:07 -08002408 pr_debug("%s: Error: bond_3ad_get_active_agg_info failed\n",
2409 dev->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002410 goto out;
2411 }
2412
2413 slaves_in_agg = ad_info.ports;
2414 agg_id = ad_info.aggregator_id;
2415
2416 if (slaves_in_agg == 0) {
2417 /*the aggregator is empty*/
Joe Perchesa4aee5c2009-12-13 20:06:07 -08002418 pr_debug("%s: Error: active aggregator is empty\n", dev->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002419 goto out;
2420 }
2421
Jasper Spaansa361c832009-10-23 04:09:24 +00002422 slave_agg_no = bond->xmit_hash_policy(skb, slaves_in_agg);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002423
2424 bond_for_each_slave(bond, slave, i) {
2425 struct aggregator *agg = SLAVE_AD_INFO(slave).port.aggregator;
2426
2427 if (agg && (agg->aggregator_identifier == agg_id)) {
2428 slave_agg_no--;
Bandan Das7bfc4752010-10-16 20:19:59 +00002429 if (slave_agg_no < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002430 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002431 }
2432 }
2433
2434 if (slave_agg_no >= 0) {
Joe Perchesa4aee5c2009-12-13 20:06:07 -08002435 pr_err("%s: Error: Couldn't find a slave to tx on for aggregator ID %d\n",
2436 dev->name, agg_id);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002437 goto out;
2438 }
2439
2440 start_at = slave;
2441
2442 bond_for_each_slave_from(bond, slave, i, start_at) {
2443 int slave_agg_id = 0;
2444 struct aggregator *agg = SLAVE_AD_INFO(slave).port.aggregator;
2445
Bandan Das7bfc4752010-10-16 20:19:59 +00002446 if (agg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002447 slave_agg_id = agg->aggregator_identifier;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002448
2449 if (SLAVE_IS_OK(slave) && agg && (slave_agg_id == agg_id)) {
2450 res = bond_dev_queue_xmit(bond, skb, slave->dev);
2451 break;
2452 }
2453 }
2454
2455out:
2456 if (res) {
2457 /* no suitable interface, frame not sent */
2458 dev_kfree_skb(skb);
2459 }
2460 read_unlock(&bond->lock);
Patrick McHardyec634fe2009-07-05 19:23:38 -07002461 return NETDEV_TX_OK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002462}
2463
David S. Millerf2ccd8f2005-08-09 19:34:12 -07002464int bond_3ad_lacpdu_recv(struct sk_buff *skb, struct net_device *dev, struct packet_type* ptype, struct net_device *orig_dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002465{
Wang Chen454d7c92008-11-12 23:37:49 -08002466 struct bonding *bond = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002467 struct slave *slave = NULL;
2468 int ret = NET_RX_DROP;
2469
David S. Millerf2ccd8f2005-08-09 19:34:12 -07002470 if (!(dev->flags & IFF_MASTER))
Linus Torvalds1da177e2005-04-16 15:20:36 -07002471 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002472
Andy Gospodarekab128112010-09-10 11:43:20 +00002473 if (!pskb_may_pull(skb, sizeof(struct lacpdu)))
2474 goto out;
2475
Linus Torvalds1da177e2005-04-16 15:20:36 -07002476 read_lock(&bond->lock);
Wang Chen454d7c92008-11-12 23:37:49 -08002477 slave = bond_get_slave_by_dev((struct bonding *)netdev_priv(dev),
2478 orig_dev);
David S. Millerf2ccd8f2005-08-09 19:34:12 -07002479 if (!slave)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002480 goto out_unlock;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002481
2482 bond_3ad_rx_indication((struct lacpdu *) skb->data, slave, skb->len);
2483
2484 ret = NET_RX_SUCCESS;
2485
2486out_unlock:
2487 read_unlock(&bond->lock);
2488out:
2489 dev_kfree_skb(skb);
2490
2491 return ret;
2492}