aboutsummaryrefslogtreecommitdiffstats
path: root/drivers/net/bonding/bond_3ad.c
diff options
context:
space:
mode:
authorLinus Torvalds <torvalds@ppc970.osdl.org>2005-04-16 18:20:36 -0400
committerLinus Torvalds <torvalds@ppc970.osdl.org>2005-04-16 18:20:36 -0400
commit1da177e4c3f41524e886b7f1b8a0c1fc7321cac2 (patch)
tree0bba044c4ce775e45a88a51686b5d9f90697ea9d /drivers/net/bonding/bond_3ad.c
Linux-2.6.12-rc2v2.6.12-rc2
Initial git repository build. I'm not bothering with the full history, even though we have it. We can create a separate "historical" git archive of that later if we want to, and in the meantime it's about 3.2GB when imported into git - space that would just make the early git days unnecessarily complicated, when we don't have a lot of good infrastructure for it. Let it rip!
Diffstat (limited to 'drivers/net/bonding/bond_3ad.c')
-rw-r--r--drivers/net/bonding/bond_3ad.c2451
1 files changed, 2451 insertions, 0 deletions
diff --git a/drivers/net/bonding/bond_3ad.c b/drivers/net/bonding/bond_3ad.c
new file mode 100644
index 000000000000..6233c4ffb805
--- /dev/null
+++ b/drivers/net/bonding/bond_3ad.c
@@ -0,0 +1,2451 @@
1/*
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 *
21 *
22 * Changes:
23 *
24 * 2003/05/01 - Tsippy Mendelson <tsippy.mendelson at intel dot com> and
25 * Amir Noam <amir.noam at intel dot com>
26 * - Added support for lacp_rate module param.
27 *
28 * 2003/05/01 - Shmulik Hen <shmulik.hen at intel dot com>
29 * - Based on discussion on mailing list, changed locking scheme
30 * to use lock/unlock or lock_bh/unlock_bh appropriately instead
31 * of lock_irqsave/unlock_irqrestore. The new scheme helps exposing
32 * hidden bugs and solves system hangs that occurred due to the fact
33 * that holding lock_irqsave doesn't prevent softirqs from running.
34 * This also increases total throughput since interrupts are not
35 * blocked on each transmitted packets or monitor timeout.
36 *
37 * 2003/05/01 - Shmulik Hen <shmulik.hen at intel dot com>
38 * - Renamed bond_3ad_link_status_changed() to
39 * bond_3ad_handle_link_change() for compatibility with TLB.
40 *
41 * 2003/05/20 - Amir Noam <amir.noam at intel dot com>
42 * - Fix long fail over time when releasing last slave of an active
43 * aggregator - send LACPDU on unbind of slave to tell partner this
44 * port is no longer aggregatable.
45 *
46 * 2003/06/25 - Tsippy Mendelson <tsippy.mendelson at intel dot com>
47 * - Send LACPDU as highest priority packet to further fix the above
48 * problem on very high Tx traffic load where packets may get dropped
49 * by the slave.
50 *
51 * 2003/12/01 - Shmulik Hen <shmulik.hen at intel dot com>
52 * - Code cleanup and style changes
53 */
54
55//#define BONDING_DEBUG 1
56
57#include <linux/skbuff.h>
58#include <linux/if_ether.h>
59#include <linux/netdevice.h>
60#include <linux/spinlock.h>
61#include <linux/ethtool.h>
62#include <linux/if_bonding.h>
63#include <linux/pkt_sched.h>
64#include "bonding.h"
65#include "bond_3ad.h"
66
67// General definitions
68#define AD_SHORT_TIMEOUT 1
69#define AD_LONG_TIMEOUT 0
70#define AD_STANDBY 0x2
71#define AD_MAX_TX_IN_SECOND 3
72#define AD_COLLECTOR_MAX_DELAY 0
73
74// Timer definitions(43.4.4 in the 802.3ad standard)
75#define AD_FAST_PERIODIC_TIME 1
76#define AD_SLOW_PERIODIC_TIME 30
77#define AD_SHORT_TIMEOUT_TIME (3*AD_FAST_PERIODIC_TIME)
78#define AD_LONG_TIMEOUT_TIME (3*AD_SLOW_PERIODIC_TIME)
79#define AD_CHURN_DETECTION_TIME 60
80#define AD_AGGREGATE_WAIT_TIME 2
81
82// Port state definitions(43.4.2.2 in the 802.3ad standard)
83#define AD_STATE_LACP_ACTIVITY 0x1
84#define AD_STATE_LACP_TIMEOUT 0x2
85#define AD_STATE_AGGREGATION 0x4
86#define AD_STATE_SYNCHRONIZATION 0x8
87#define AD_STATE_COLLECTING 0x10
88#define AD_STATE_DISTRIBUTING 0x20
89#define AD_STATE_DEFAULTED 0x40
90#define AD_STATE_EXPIRED 0x80
91
92// Port Variables definitions used by the State Machines(43.4.7 in the 802.3ad standard)
93#define AD_PORT_BEGIN 0x1
94#define AD_PORT_LACP_ENABLED 0x2
95#define AD_PORT_ACTOR_CHURN 0x4
96#define AD_PORT_PARTNER_CHURN 0x8
97#define AD_PORT_READY 0x10
98#define AD_PORT_READY_N 0x20
99#define AD_PORT_MATCHED 0x40
100#define AD_PORT_STANDBY 0x80
101#define AD_PORT_SELECTED 0x100
102#define AD_PORT_MOVED 0x200
103
104// Port Key definitions
105// key is determined according to the link speed, duplex and
106// user key(which is yet not supported)
107// ------------------------------------------------------------
108// Port key : | User key | Speed |Duplex|
109// ------------------------------------------------------------
110// 16 6 1 0
111#define AD_DUPLEX_KEY_BITS 0x1
112#define AD_SPEED_KEY_BITS 0x3E
113#define AD_USER_KEY_BITS 0xFFC0
114
115//dalloun
116#define AD_LINK_SPEED_BITMASK_1MBPS 0x1
117#define AD_LINK_SPEED_BITMASK_10MBPS 0x2
118#define AD_LINK_SPEED_BITMASK_100MBPS 0x4
119#define AD_LINK_SPEED_BITMASK_1000MBPS 0x8
120//endalloun
121
122// compare MAC addresses
123#define MAC_ADDRESS_COMPARE(A, B) memcmp(A, B, ETH_ALEN)
124
125static struct mac_addr null_mac_addr = {{0, 0, 0, 0, 0, 0}};
126static u16 ad_ticks_per_sec;
127static const int ad_delta_in_ticks = (AD_TIMER_INTERVAL * HZ) / 1000;
128
129// ================= 3AD api to bonding and kernel code ==================
130static u16 __get_link_speed(struct port *port);
131static u8 __get_duplex(struct port *port);
132static inline void __initialize_port_locks(struct port *port);
133//conversions
134static void __ntohs_lacpdu(struct lacpdu *lacpdu);
135static u16 __ad_timer_to_ticks(u16 timer_type, u16 Par);
136
137
138// ================= ad code helper functions ==================
139//needed by ad_rx_machine(...)
140static void __record_pdu(struct lacpdu *lacpdu, struct port *port);
141static void __record_default(struct port *port);
142static void __update_selected(struct lacpdu *lacpdu, struct port *port);
143static void __update_default_selected(struct port *port);
144static void __choose_matched(struct lacpdu *lacpdu, struct port *port);
145static void __update_ntt(struct lacpdu *lacpdu, struct port *port);
146
147//needed for ad_mux_machine(..)
148static void __attach_bond_to_agg(struct port *port);
149static void __detach_bond_from_agg(struct port *port);
150static int __agg_ports_are_ready(struct aggregator *aggregator);
151static void __set_agg_ports_ready(struct aggregator *aggregator, int val);
152
153//needed for ad_agg_selection_logic(...)
154static u32 __get_agg_bandwidth(struct aggregator *aggregator);
155static struct aggregator *__get_active_agg(struct aggregator *aggregator);
156
157
158// ================= main 802.3ad protocol functions ==================
159static int ad_lacpdu_send(struct port *port);
160static int ad_marker_send(struct port *port, struct marker *marker);
161static void ad_mux_machine(struct port *port);
162static void ad_rx_machine(struct lacpdu *lacpdu, struct port *port);
163static void ad_tx_machine(struct port *port);
164static void ad_periodic_machine(struct port *port);
165static void ad_port_selection_logic(struct port *port);
166static void ad_agg_selection_logic(struct aggregator *aggregator);
167static void ad_clear_agg(struct aggregator *aggregator);
168static void ad_initialize_agg(struct aggregator *aggregator);
169static void ad_initialize_port(struct port *port, int lacp_fast);
170static void ad_initialize_lacpdu(struct lacpdu *Lacpdu);
171static void ad_enable_collecting_distributing(struct port *port);
172static void ad_disable_collecting_distributing(struct port *port);
173static void ad_marker_info_received(struct marker *marker_info, struct port *port);
174static void ad_marker_response_received(struct marker *marker, struct port *port);
175
176
177/////////////////////////////////////////////////////////////////////////////////
178// ================= api to bonding and kernel code ==================
179/////////////////////////////////////////////////////////////////////////////////
180
181/**
182 * __get_bond_by_port - get the port's bonding struct
183 * @port: the port we're looking at
184 *
185 * Return @port's bonding struct, or %NULL if it can't be found.
186 */
187static inline struct bonding *__get_bond_by_port(struct port *port)
188{
189 if (port->slave == NULL) {
190 return NULL;
191 }
192
193 return bond_get_bond_by_slave(port->slave);
194}
195
196/**
197 * __get_first_port - get the first port in the bond
198 * @bond: the bond we're looking at
199 *
200 * Return the port of the first slave in @bond, or %NULL if it can't be found.
201 */
202static inline struct port *__get_first_port(struct bonding *bond)
203{
204 if (bond->slave_cnt == 0) {
205 return NULL;
206 }
207
208 return &(SLAVE_AD_INFO(bond->first_slave).port);
209}
210
211/**
212 * __get_next_port - get the next port in the bond
213 * @port: the port we're looking at
214 *
215 * Return the port of the slave that is next in line of @port's slave in the
216 * bond, or %NULL if it can't be found.
217 */
218static inline struct port *__get_next_port(struct port *port)
219{
220 struct bonding *bond = __get_bond_by_port(port);
221 struct slave *slave = port->slave;
222
223 // If there's no bond for this port, or this is the last slave
224 if ((bond == NULL) || (slave->next == bond->first_slave)) {
225 return NULL;
226 }
227
228 return &(SLAVE_AD_INFO(slave->next).port);
229}
230
231/**
232 * __get_first_agg - get the first aggregator in the bond
233 * @bond: the bond we're looking at
234 *
235 * Return the aggregator of the first slave in @bond, or %NULL if it can't be
236 * found.
237 */
238static inline struct aggregator *__get_first_agg(struct port *port)
239{
240 struct bonding *bond = __get_bond_by_port(port);
241
242 // If there's no bond for this port, or bond has no slaves
243 if ((bond == NULL) || (bond->slave_cnt == 0)) {
244 return NULL;
245 }
246
247 return &(SLAVE_AD_INFO(bond->first_slave).aggregator);
248}
249
250/**
251 * __get_next_agg - get the next aggregator in the bond
252 * @aggregator: the aggregator we're looking at
253 *
254 * Return the aggregator of the slave that is next in line of @aggregator's
255 * slave in the bond, or %NULL if it can't be found.
256 */
257static inline struct aggregator *__get_next_agg(struct aggregator *aggregator)
258{
259 struct slave *slave = aggregator->slave;
260 struct bonding *bond = bond_get_bond_by_slave(slave);
261
262 // If there's no bond for this aggregator, or this is the last slave
263 if ((bond == NULL) || (slave->next == bond->first_slave)) {
264 return NULL;
265 }
266
267 return &(SLAVE_AD_INFO(slave->next).aggregator);
268}
269
270/**
271 * __disable_port - disable the port's slave
272 * @port: the port we're looking at
273 *
274 */
275static inline void __disable_port(struct port *port)
276{
277 bond_set_slave_inactive_flags(port->slave);
278}
279
280/**
281 * __enable_port - enable the port's slave, if it's up
282 * @port: the port we're looking at
283 *
284 */
285static inline void __enable_port(struct port *port)
286{
287 struct slave *slave = port->slave;
288
289 if ((slave->link == BOND_LINK_UP) && IS_UP(slave->dev)) {
290 bond_set_slave_active_flags(slave);
291 }
292}
293
294/**
295 * __port_is_enabled - check if the port's slave is in active state
296 * @port: the port we're looking at
297 *
298 */
299static inline int __port_is_enabled(struct port *port)
300{
301 return(port->slave->state == BOND_STATE_ACTIVE);
302}
303
304/**
305 * __get_agg_selection_mode - get the aggregator selection mode
306 * @port: the port we're looking at
307 *
308 * Get the aggregator selection mode. Can be %BANDWIDTH or %COUNT.
309 */
310static inline u32 __get_agg_selection_mode(struct port *port)
311{
312 struct bonding *bond = __get_bond_by_port(port);
313
314 if (bond == NULL) {
315 return AD_BANDWIDTH;
316 }
317
318 return BOND_AD_INFO(bond).agg_select_mode;
319}
320
321/**
322 * __check_agg_selection_timer - check if the selection timer has expired
323 * @port: the port we're looking at
324 *
325 */
326static inline int __check_agg_selection_timer(struct port *port)
327{
328 struct bonding *bond = __get_bond_by_port(port);
329
330 if (bond == NULL) {
331 return 0;
332 }
333
334 return BOND_AD_INFO(bond).agg_select_timer ? 1 : 0;
335}
336
337/**
338 * __get_rx_machine_lock - lock the port's RX machine
339 * @port: the port we're looking at
340 *
341 */
342static inline void __get_rx_machine_lock(struct port *port)
343{
344 spin_lock(&(SLAVE_AD_INFO(port->slave).rx_machine_lock));
345}
346
347/**
348 * __release_rx_machine_lock - unlock the port's RX machine
349 * @port: the port we're looking at
350 *
351 */
352static inline void __release_rx_machine_lock(struct port *port)
353{
354 spin_unlock(&(SLAVE_AD_INFO(port->slave).rx_machine_lock));
355}
356
357/**
358 * __get_link_speed - get a port's speed
359 * @port: the port we're looking at
360 *
361 * Return @port's speed in 802.3ad bitmask format. i.e. one of:
362 * 0,
363 * %AD_LINK_SPEED_BITMASK_10MBPS,
364 * %AD_LINK_SPEED_BITMASK_100MBPS,
365 * %AD_LINK_SPEED_BITMASK_1000MBPS
366 */
367static u16 __get_link_speed(struct port *port)
368{
369 struct slave *slave = port->slave;
370 u16 speed;
371
372 /* this if covers only a special case: when the configuration starts with
373 * link down, it sets the speed to 0.
374 * This is done in spite of the fact that the e100 driver reports 0 to be
375 * compatible with MVT in the future.*/
376 if (slave->link != BOND_LINK_UP) {
377 speed=0;
378 } else {
379 switch (slave->speed) {
380 case SPEED_10:
381 speed = AD_LINK_SPEED_BITMASK_10MBPS;
382 break;
383
384 case SPEED_100:
385 speed = AD_LINK_SPEED_BITMASK_100MBPS;
386 break;
387
388 case SPEED_1000:
389 speed = AD_LINK_SPEED_BITMASK_1000MBPS;
390 break;
391
392 default:
393 speed = 0; // unknown speed value from ethtool. shouldn't happen
394 break;
395 }
396 }
397
398 dprintk("Port %d Received link speed %d update from adapter\n", port->actor_port_number, speed);
399 return speed;
400}
401
402/**
403 * __get_duplex - get a port's duplex
404 * @port: the port we're looking at
405 *
406 * Return @port's duplex in 802.3ad bitmask format. i.e.:
407 * 0x01 if in full duplex
408 * 0x00 otherwise
409 */
410static u8 __get_duplex(struct port *port)
411{
412 struct slave *slave = port->slave;
413
414 u8 retval;
415
416 // handling a special case: when the configuration starts with
417 // link down, it sets the duplex to 0.
418 if (slave->link != BOND_LINK_UP) {
419 retval=0x0;
420 } else {
421 switch (slave->duplex) {
422 case DUPLEX_FULL:
423 retval=0x1;
424 dprintk("Port %d Received status full duplex update from adapter\n", port->actor_port_number);
425 break;
426 case DUPLEX_HALF:
427 default:
428 retval=0x0;
429 dprintk("Port %d Received status NOT full duplex update from adapter\n", port->actor_port_number);
430 break;
431 }
432 }
433 return retval;
434}
435
436/**
437 * __initialize_port_locks - initialize a port's RX machine spinlock
438 * @port: the port we're looking at
439 *
440 */
441static inline void __initialize_port_locks(struct port *port)
442{
443 // make sure it isn't called twice
444 spin_lock_init(&(SLAVE_AD_INFO(port->slave).rx_machine_lock));
445}
446
447//conversions
448/**
449 * __ntohs_lacpdu - convert the contents of a LACPDU to host byte order
450 * @lacpdu: the speicifed lacpdu
451 *
452 * For each multi-byte field in the lacpdu, convert its content
453 */
454static void __ntohs_lacpdu(struct lacpdu *lacpdu)
455{
456 if (lacpdu) {
457 lacpdu->actor_system_priority = ntohs(lacpdu->actor_system_priority);
458 lacpdu->actor_key = ntohs(lacpdu->actor_key);
459 lacpdu->actor_port_priority = ntohs(lacpdu->actor_port_priority);
460 lacpdu->actor_port = ntohs(lacpdu->actor_port);
461 lacpdu->partner_system_priority = ntohs(lacpdu->partner_system_priority);
462 lacpdu->partner_key = ntohs(lacpdu->partner_key);
463 lacpdu->partner_port_priority = ntohs(lacpdu->partner_port_priority);
464 lacpdu->partner_port = ntohs(lacpdu->partner_port);
465 lacpdu->collector_max_delay = ntohs(lacpdu->collector_max_delay);
466 }
467}
468
469/**
470 * __ad_timer_to_ticks - convert a given timer type to AD module ticks
471 * @timer_type: which timer to operate
472 * @par: timer parameter. see below
473 *
474 * If @timer_type is %current_while_timer, @par indicates long/short timer.
475 * If @timer_type is %periodic_timer, @par is one of %FAST_PERIODIC_TIME,
476 * %SLOW_PERIODIC_TIME.
477 */
478static u16 __ad_timer_to_ticks(u16 timer_type, u16 par)
479{
480 u16 retval=0; //to silence the compiler
481
482 switch (timer_type) {
483 case AD_CURRENT_WHILE_TIMER: // for rx machine usage
484 if (par) { // for short or long timeout
485 retval = (AD_SHORT_TIMEOUT_TIME*ad_ticks_per_sec); // short timeout
486 } else {
487 retval = (AD_LONG_TIMEOUT_TIME*ad_ticks_per_sec); // long timeout
488 }
489 break;
490 case AD_ACTOR_CHURN_TIMER: // for local churn machine
491 retval = (AD_CHURN_DETECTION_TIME*ad_ticks_per_sec);
492 break;
493 case AD_PERIODIC_TIMER: // for periodic machine
494 retval = (par*ad_ticks_per_sec); // long timeout
495 break;
496 case AD_PARTNER_CHURN_TIMER: // for remote churn machine
497 retval = (AD_CHURN_DETECTION_TIME*ad_ticks_per_sec);
498 break;
499 case AD_WAIT_WHILE_TIMER: // for selection machine
500 retval = (AD_AGGREGATE_WAIT_TIME*ad_ticks_per_sec);
501 break;
502 }
503 return retval;
504}
505
506
507/////////////////////////////////////////////////////////////////////////////////
508// ================= ad_rx_machine helper functions ==================
509/////////////////////////////////////////////////////////////////////////////////
510
511/**
512 * __record_pdu - record parameters from a received lacpdu
513 * @lacpdu: the lacpdu we've received
514 * @port: the port we're looking at
515 *
516 * Record the parameter values for the Actor carried in a received lacpdu as
517 * the current partner operational parameter values and sets
518 * actor_oper_port_state.defaulted to FALSE.
519 */
520static void __record_pdu(struct lacpdu *lacpdu, struct port *port)
521{
522 // validate lacpdu and port
523 if (lacpdu && port) {
524 // record the new parameter values for the partner operational
525 port->partner_oper_port_number = lacpdu->actor_port;
526 port->partner_oper_port_priority = lacpdu->actor_port_priority;
527 port->partner_oper_system = lacpdu->actor_system;
528 port->partner_oper_system_priority = lacpdu->actor_system_priority;
529 port->partner_oper_key = lacpdu->actor_key;
530 // zero partener's lase states
531 port->partner_oper_port_state = 0;
532 port->partner_oper_port_state |= (lacpdu->actor_state & AD_STATE_LACP_ACTIVITY);
533 port->partner_oper_port_state |= (lacpdu->actor_state & AD_STATE_LACP_TIMEOUT);
534 port->partner_oper_port_state |= (lacpdu->actor_state & AD_STATE_AGGREGATION);
535 port->partner_oper_port_state |= (lacpdu->actor_state & AD_STATE_SYNCHRONIZATION);
536 port->partner_oper_port_state |= (lacpdu->actor_state & AD_STATE_COLLECTING);
537 port->partner_oper_port_state |= (lacpdu->actor_state & AD_STATE_DISTRIBUTING);
538 port->partner_oper_port_state |= (lacpdu->actor_state & AD_STATE_DEFAULTED);
539 port->partner_oper_port_state |= (lacpdu->actor_state & AD_STATE_EXPIRED);
540
541 // set actor_oper_port_state.defaulted to FALSE
542 port->actor_oper_port_state &= ~AD_STATE_DEFAULTED;
543
544 // set the partner sync. to on if the partner is sync. and the port is matched
545 if ((port->sm_vars & AD_PORT_MATCHED) && (lacpdu->actor_state & AD_STATE_SYNCHRONIZATION)) {
546 port->partner_oper_port_state |= AD_STATE_SYNCHRONIZATION;
547 } else {
548 port->partner_oper_port_state &= ~AD_STATE_SYNCHRONIZATION;
549 }
550 }
551}
552
553/**
554 * __record_default - record default parameters
555 * @port: the port we're looking at
556 *
557 * This function records the default parameter values for the partner carried
558 * in the Partner Admin parameters as the current partner operational parameter
559 * values and sets actor_oper_port_state.defaulted to TRUE.
560 */
561static void __record_default(struct port *port)
562{
563 // validate the port
564 if (port) {
565 // record the partner admin parameters
566 port->partner_oper_port_number = port->partner_admin_port_number;
567 port->partner_oper_port_priority = port->partner_admin_port_priority;
568 port->partner_oper_system = port->partner_admin_system;
569 port->partner_oper_system_priority = port->partner_admin_system_priority;
570 port->partner_oper_key = port->partner_admin_key;
571 port->partner_oper_port_state = port->partner_admin_port_state;
572
573 // set actor_oper_port_state.defaulted to true
574 port->actor_oper_port_state |= AD_STATE_DEFAULTED;
575 }
576}
577
578/**
579 * __update_selected - update a port's Selected variable from a received lacpdu
580 * @lacpdu: the lacpdu we've received
581 * @port: the port we're looking at
582 *
583 * Update the value of the selected variable, using parameter values from a
584 * newly received lacpdu. The parameter values for the Actor carried in the
585 * received PDU are compared with the corresponding operational parameter
586 * values for the ports partner. If one or more of the comparisons shows that
587 * the value(s) received in the PDU differ from the current operational values,
588 * then selected is set to FALSE and actor_oper_port_state.synchronization is
589 * set to out_of_sync. Otherwise, selected remains unchanged.
590 */
591static void __update_selected(struct lacpdu *lacpdu, struct port *port)
592{
593 // validate lacpdu and port
594 if (lacpdu && port) {
595 // check if any parameter is different
596 if ((lacpdu->actor_port != port->partner_oper_port_number) ||
597 (lacpdu->actor_port_priority != port->partner_oper_port_priority) ||
598 MAC_ADDRESS_COMPARE(&(lacpdu->actor_system), &(port->partner_oper_system)) ||
599 (lacpdu->actor_system_priority != port->partner_oper_system_priority) ||
600 (lacpdu->actor_key != port->partner_oper_key) ||
601 ((lacpdu->actor_state & AD_STATE_AGGREGATION) != (port->partner_oper_port_state & AD_STATE_AGGREGATION))
602 ) {
603 // update the state machine Selected variable
604 port->sm_vars &= ~AD_PORT_SELECTED;
605 }
606 }
607}
608
609/**
610 * __update_default_selected - update a port's Selected variable from Partner
611 * @port: the port we're looking at
612 *
613 * This function updates the value of the selected variable, using the partner
614 * administrative parameter values. The administrative values are compared with
615 * the corresponding operational parameter values for the partner. If one or
616 * more of the comparisons shows that the administrative value(s) differ from
617 * the current operational values, then Selected is set to FALSE and
618 * actor_oper_port_state.synchronization is set to OUT_OF_SYNC. Otherwise,
619 * Selected remains unchanged.
620 */
621static void __update_default_selected(struct port *port)
622{
623 // validate the port
624 if (port) {
625 // check if any parameter is different
626 if ((port->partner_admin_port_number != port->partner_oper_port_number) ||
627 (port->partner_admin_port_priority != port->partner_oper_port_priority) ||
628 MAC_ADDRESS_COMPARE(&(port->partner_admin_system), &(port->partner_oper_system)) ||
629 (port->partner_admin_system_priority != port->partner_oper_system_priority) ||
630 (port->partner_admin_key != port->partner_oper_key) ||
631 ((port->partner_admin_port_state & AD_STATE_AGGREGATION) != (port->partner_oper_port_state & AD_STATE_AGGREGATION))
632 ) {
633 // update the state machine Selected variable
634 port->sm_vars &= ~AD_PORT_SELECTED;
635 }
636 }
637}
638
639/**
640 * __choose_matched - update a port's matched variable from a received lacpdu
641 * @lacpdu: the lacpdu we've received
642 * @port: the port we're looking at
643 *
644 * Update the value of the matched variable, using parameter values from a
645 * newly received lacpdu. Parameter values for the partner carried in the
646 * received PDU are compared with the corresponding operational parameter
647 * values for the actor. Matched is set to TRUE if all of these parameters
648 * match and the PDU parameter partner_state.aggregation has the same value as
649 * actor_oper_port_state.aggregation and lacp will actively maintain the link
650 * in the aggregation. Matched is also set to TRUE if the value of
651 * actor_state.aggregation in the received PDU is set to FALSE, i.e., indicates
652 * an individual link and lacp will actively maintain the link. Otherwise,
653 * matched is set to FALSE. LACP is considered to be actively maintaining the
654 * link if either the PDU's actor_state.lacp_activity variable is TRUE or both
655 * the actor's actor_oper_port_state.lacp_activity and the PDU's
656 * partner_state.lacp_activity variables are TRUE.
657 */
658static void __choose_matched(struct lacpdu *lacpdu, struct port *port)
659{
660 // validate lacpdu and port
661 if (lacpdu && port) {
662 // check if all parameters are alike
663 if (((lacpdu->partner_port == port->actor_port_number) &&
664 (lacpdu->partner_port_priority == port->actor_port_priority) &&
665 !MAC_ADDRESS_COMPARE(&(lacpdu->partner_system), &(port->actor_system)) &&
666 (lacpdu->partner_system_priority == port->actor_system_priority) &&
667 (lacpdu->partner_key == port->actor_oper_port_key) &&
668 ((lacpdu->partner_state & AD_STATE_AGGREGATION) == (port->actor_oper_port_state & AD_STATE_AGGREGATION))) ||
669 // or this is individual link(aggregation == FALSE)
670 ((lacpdu->actor_state & AD_STATE_AGGREGATION) == 0)
671 ) {
672 // update the state machine Matched variable
673 port->sm_vars |= AD_PORT_MATCHED;
674 } else {
675 port->sm_vars &= ~AD_PORT_MATCHED;
676 }
677 }
678}
679
680/**
681 * __update_ntt - update a port's ntt variable from a received lacpdu
682 * @lacpdu: the lacpdu we've received
683 * @port: the port we're looking at
684 *
685 * Updates the value of the ntt variable, using parameter values from a newly
686 * received lacpdu. The parameter values for the partner carried in the
687 * received PDU are compared with the corresponding operational parameter
688 * values for the Actor. If one or more of the comparisons shows that the
689 * value(s) received in the PDU differ from the current operational values,
690 * then ntt is set to TRUE. Otherwise, ntt remains unchanged.
691 */
692static void __update_ntt(struct lacpdu *lacpdu, struct port *port)
693{
694 // validate lacpdu and port
695 if (lacpdu && port) {
696 // check if any parameter is different
697 if ((lacpdu->partner_port != port->actor_port_number) ||
698 (lacpdu->partner_port_priority != port->actor_port_priority) ||
699 MAC_ADDRESS_COMPARE(&(lacpdu->partner_system), &(port->actor_system)) ||
700 (lacpdu->partner_system_priority != port->actor_system_priority) ||
701 (lacpdu->partner_key != port->actor_oper_port_key) ||
702 ((lacpdu->partner_state & AD_STATE_LACP_ACTIVITY) != (port->actor_oper_port_state & AD_STATE_LACP_ACTIVITY)) ||
703 ((lacpdu->partner_state & AD_STATE_LACP_TIMEOUT) != (port->actor_oper_port_state & AD_STATE_LACP_TIMEOUT)) ||
704 ((lacpdu->partner_state & AD_STATE_SYNCHRONIZATION) != (port->actor_oper_port_state & AD_STATE_SYNCHRONIZATION)) ||
705 ((lacpdu->partner_state & AD_STATE_AGGREGATION) != (port->actor_oper_port_state & AD_STATE_AGGREGATION))
706 ) {
707 // set ntt to be TRUE
708 port->ntt = 1;
709 }
710 }
711}
712
713/**
714 * __attach_bond_to_agg
715 * @port: the port we're looking at
716 *
717 * Handle the attaching of the port's control parser/multiplexer and the
718 * aggregator. This function does nothing since the parser/multiplexer of the
719 * receive and the parser/multiplexer of the aggregator are already combined.
720 */
721static void __attach_bond_to_agg(struct port *port)
722{
723 port=NULL; // just to satisfy the compiler
724 // This function does nothing since the parser/multiplexer of the receive
725 // and the parser/multiplexer of the aggregator are already combined
726}
727
728/**
729 * __detach_bond_from_agg
730 * @port: the port we're looking at
731 *
732 * Handle the detaching of the port's control parser/multiplexer from the
733 * aggregator. This function does nothing since the parser/multiplexer of the
734 * receive and the parser/multiplexer of the aggregator are already combined.
735 */
736static void __detach_bond_from_agg(struct port *port)
737{
738 port=NULL; // just to satisfy the compiler
739 // This function does nothing sience the parser/multiplexer of the receive
740 // and the parser/multiplexer of the aggregator are already combined
741}
742
743/**
744 * __agg_ports_are_ready - check if all ports in an aggregator are ready
745 * @aggregator: the aggregator we're looking at
746 *
747 */
748static int __agg_ports_are_ready(struct aggregator *aggregator)
749{
750 struct port *port;
751 int retval = 1;
752
753 if (aggregator) {
754 // scan all ports in this aggregator to verfy if they are all ready
755 for (port=aggregator->lag_ports; port; port=port->next_port_in_aggregator) {
756 if (!(port->sm_vars & AD_PORT_READY_N)) {
757 retval = 0;
758 break;
759 }
760 }
761 }
762
763 return retval;
764}
765
766/**
767 * __set_agg_ports_ready - set value of Ready bit in all ports of an aggregator
768 * @aggregator: the aggregator we're looking at
769 * @val: Should the ports' ready bit be set on or off
770 *
771 */
772static void __set_agg_ports_ready(struct aggregator *aggregator, int val)
773{
774 struct port *port;
775
776 for (port=aggregator->lag_ports; port; port=port->next_port_in_aggregator) {
777 if (val) {
778 port->sm_vars |= AD_PORT_READY;
779 } else {
780 port->sm_vars &= ~AD_PORT_READY;
781 }
782 }
783}
784
785/**
786 * __get_agg_bandwidth - get the total bandwidth of an aggregator
787 * @aggregator: the aggregator we're looking at
788 *
789 */
790static u32 __get_agg_bandwidth(struct aggregator *aggregator)
791{
792 u32 bandwidth=0;
793 u32 basic_speed;
794
795 if (aggregator->num_of_ports) {
796 basic_speed = __get_link_speed(aggregator->lag_ports);
797 switch (basic_speed) {
798 case AD_LINK_SPEED_BITMASK_1MBPS:
799 bandwidth = aggregator->num_of_ports;
800 break;
801 case AD_LINK_SPEED_BITMASK_10MBPS:
802 bandwidth = aggregator->num_of_ports * 10;
803 break;
804 case AD_LINK_SPEED_BITMASK_100MBPS:
805 bandwidth = aggregator->num_of_ports * 100;
806 break;
807 case AD_LINK_SPEED_BITMASK_1000MBPS:
808 bandwidth = aggregator->num_of_ports * 1000;
809 break;
810 default:
811 bandwidth=0; // to silent the compilor ....
812 }
813 }
814 return bandwidth;
815}
816
817/**
818 * __get_active_agg - get the current active aggregator
819 * @aggregator: the aggregator we're looking at
820 *
821 */
822static struct aggregator *__get_active_agg(struct aggregator *aggregator)
823{
824 struct aggregator *retval = NULL;
825
826 for (; aggregator; aggregator = __get_next_agg(aggregator)) {
827 if (aggregator->is_active) {
828 retval = aggregator;
829 break;
830 }
831 }
832
833 return retval;
834}
835
836/**
837 * __update_lacpdu_from_port - update a port's lacpdu fields
838 * @port: the port we're looking at
839 *
840 */
841static inline void __update_lacpdu_from_port(struct port *port)
842{
843 struct lacpdu *lacpdu = &port->lacpdu;
844
845 /* update current actual Actor parameters */
846 /* lacpdu->subtype initialized
847 * lacpdu->version_number initialized
848 * lacpdu->tlv_type_actor_info initialized
849 * lacpdu->actor_information_length initialized
850 */
851
852 lacpdu->actor_system_priority = port->actor_system_priority;
853 lacpdu->actor_system = port->actor_system;
854 lacpdu->actor_key = port->actor_oper_port_key;
855 lacpdu->actor_port_priority = port->actor_port_priority;
856 lacpdu->actor_port = port->actor_port_number;
857 lacpdu->actor_state = port->actor_oper_port_state;
858
859 /* lacpdu->reserved_3_1 initialized
860 * lacpdu->tlv_type_partner_info initialized
861 * lacpdu->partner_information_length initialized
862 */
863
864 lacpdu->partner_system_priority = port->partner_oper_system_priority;
865 lacpdu->partner_system = port->partner_oper_system;
866 lacpdu->partner_key = port->partner_oper_key;
867 lacpdu->partner_port_priority = port->partner_oper_port_priority;
868 lacpdu->partner_port = port->partner_oper_port_number;
869 lacpdu->partner_state = port->partner_oper_port_state;
870
871 /* lacpdu->reserved_3_2 initialized
872 * lacpdu->tlv_type_collector_info initialized
873 * lacpdu->collector_information_length initialized
874 * collector_max_delay initialized
875 * reserved_12[12] initialized
876 * tlv_type_terminator initialized
877 * terminator_length initialized
878 * reserved_50[50] initialized
879 */
880
881 /* Convert all non u8 parameters to Big Endian for transmit */
882 __ntohs_lacpdu(lacpdu);
883}
884
885//////////////////////////////////////////////////////////////////////////////////////
886// ================= main 802.3ad protocol code ======================================
887//////////////////////////////////////////////////////////////////////////////////////
888
889/**
890 * ad_lacpdu_send - send out a lacpdu packet on a given port
891 * @port: the port we're looking at
892 *
893 * Returns: 0 on success
894 * < 0 on error
895 */
896static int ad_lacpdu_send(struct port *port)
897{
898 struct slave *slave = port->slave;
899 struct sk_buff *skb;
900 struct lacpdu_header *lacpdu_header;
901 int length = sizeof(struct lacpdu_header);
902 struct mac_addr lacpdu_multicast_address = AD_MULTICAST_LACPDU_ADDR;
903
904 skb = dev_alloc_skb(length);
905 if (!skb) {
906 return -ENOMEM;
907 }
908
909 skb->dev = slave->dev;
910 skb->mac.raw = skb->data;
911 skb->nh.raw = skb->data + ETH_HLEN;
912 skb->protocol = PKT_TYPE_LACPDU;
913 skb->priority = TC_PRIO_CONTROL;
914
915 lacpdu_header = (struct lacpdu_header *)skb_put(skb, length);
916
917 lacpdu_header->ad_header.destination_address = lacpdu_multicast_address;
918 /* Note: source addres is set to be the member's PERMANENT address, because we use it
919 to identify loopback lacpdus in receive. */
920 lacpdu_header->ad_header.source_address = *((struct mac_addr *)(slave->perm_hwaddr));
921 lacpdu_header->ad_header.length_type = PKT_TYPE_LACPDU;
922
923 lacpdu_header->lacpdu = port->lacpdu; // struct copy
924
925 dev_queue_xmit(skb);
926
927 return 0;
928}
929
930/**
931 * ad_marker_send - send marker information/response on a given port
932 * @port: the port we're looking at
933 * @marker: marker data to send
934 *
935 * Returns: 0 on success
936 * < 0 on error
937 */
938static int ad_marker_send(struct port *port, struct marker *marker)
939{
940 struct slave *slave = port->slave;
941 struct sk_buff *skb;
942 struct marker_header *marker_header;
943 int length = sizeof(struct marker_header);
944 struct mac_addr lacpdu_multicast_address = AD_MULTICAST_LACPDU_ADDR;
945
946 skb = dev_alloc_skb(length + 16);
947 if (!skb) {
948 return -ENOMEM;
949 }
950
951 skb_reserve(skb, 16);
952
953 skb->dev = slave->dev;
954 skb->mac.raw = skb->data;
955 skb->nh.raw = skb->data + ETH_HLEN;
956 skb->protocol = PKT_TYPE_LACPDU;
957
958 marker_header = (struct marker_header *)skb_put(skb, length);
959
960 marker_header->ad_header.destination_address = lacpdu_multicast_address;
961 /* Note: source addres is set to be the member's PERMANENT address, because we use it
962 to identify loopback MARKERs in receive. */
963 marker_header->ad_header.source_address = *((struct mac_addr *)(slave->perm_hwaddr));
964 marker_header->ad_header.length_type = PKT_TYPE_LACPDU;
965
966 marker_header->marker = *marker; // struct copy
967
968 dev_queue_xmit(skb);
969
970 return 0;
971}
972
973/**
974 * ad_mux_machine - handle a port's mux state machine
975 * @port: the port we're looking at
976 *
977 */
978static void ad_mux_machine(struct port *port)
979{
980 mux_states_t last_state;
981
982 // keep current State Machine state to compare later if it was changed
983 last_state = port->sm_mux_state;
984
985 if (port->sm_vars & AD_PORT_BEGIN) {
986 port->sm_mux_state = AD_MUX_DETACHED; // next state
987 } else {
988 switch (port->sm_mux_state) {
989 case AD_MUX_DETACHED:
990 if ((port->sm_vars & AD_PORT_SELECTED) || (port->sm_vars & AD_PORT_STANDBY)) { // if SELECTED or STANDBY
991 port->sm_mux_state = AD_MUX_WAITING; // next state
992 }
993 break;
994 case AD_MUX_WAITING:
995 // if SELECTED == FALSE return to DETACH state
996 if (!(port->sm_vars & AD_PORT_SELECTED)) { // if UNSELECTED
997 port->sm_vars &= ~AD_PORT_READY_N;
998 // in order to withhold the Selection Logic to check all ports READY_N value
999 // every callback cycle to update ready variable, we check READY_N and update READY here
1000 __set_agg_ports_ready(port->aggregator, __agg_ports_are_ready(port->aggregator));
1001 port->sm_mux_state = AD_MUX_DETACHED; // next state
1002 break;
1003 }
1004
1005 // check if the wait_while_timer expired
1006 if (port->sm_mux_timer_counter && !(--port->sm_mux_timer_counter)) {
1007 port->sm_vars |= AD_PORT_READY_N;
1008 }
1009
1010 // in order to withhold the selection logic to check all ports READY_N value
1011 // every callback cycle to update ready variable, we check READY_N and update READY here
1012 __set_agg_ports_ready(port->aggregator, __agg_ports_are_ready(port->aggregator));
1013
1014 // if the wait_while_timer expired, and the port is in READY state, move to ATTACHED state
1015 if ((port->sm_vars & AD_PORT_READY) && !port->sm_mux_timer_counter) {
1016 port->sm_mux_state = AD_MUX_ATTACHED; // next state
1017 }
1018 break;
1019 case AD_MUX_ATTACHED:
1020 // check also if agg_select_timer expired(so the edable port will take place only after this timer)
1021 if ((port->sm_vars & AD_PORT_SELECTED) && (port->partner_oper_port_state & AD_STATE_SYNCHRONIZATION) && !__check_agg_selection_timer(port)) {
1022 port->sm_mux_state = AD_MUX_COLLECTING_DISTRIBUTING;// next state
1023 } else if (!(port->sm_vars & AD_PORT_SELECTED) || (port->sm_vars & AD_PORT_STANDBY)) { // if UNSELECTED or STANDBY
1024 port->sm_vars &= ~AD_PORT_READY_N;
1025 // in order to withhold the selection logic to check all ports READY_N value
1026 // every callback cycle to update ready variable, we check READY_N and update READY here
1027 __set_agg_ports_ready(port->aggregator, __agg_ports_are_ready(port->aggregator));
1028 port->sm_mux_state = AD_MUX_DETACHED;// next state
1029 }
1030 break;
1031 case AD_MUX_COLLECTING_DISTRIBUTING:
1032 if (!(port->sm_vars & AD_PORT_SELECTED) || (port->sm_vars & AD_PORT_STANDBY) ||
1033 !(port->partner_oper_port_state & AD_STATE_SYNCHRONIZATION)
1034 ) {
1035 port->sm_mux_state = AD_MUX_ATTACHED;// next state
1036
1037 } else {
1038 // if port state hasn't changed make
1039 // sure that a collecting distributing
1040 // port in an active aggregator is enabled
1041 if (port->aggregator &&
1042 port->aggregator->is_active &&
1043 !__port_is_enabled(port)) {
1044
1045 __enable_port(port);
1046 }
1047 }
1048 break;
1049 default: //to silence the compiler
1050 break;
1051 }
1052 }
1053
1054 // check if the state machine was changed
1055 if (port->sm_mux_state != last_state) {
1056 dprintk("Mux Machine: Port=%d, Last State=%d, Curr State=%d\n", port->actor_port_number, last_state, port->sm_mux_state);
1057 switch (port->sm_mux_state) {
1058 case AD_MUX_DETACHED:
1059 __detach_bond_from_agg(port);
1060 port->actor_oper_port_state &= ~AD_STATE_SYNCHRONIZATION;
1061 ad_disable_collecting_distributing(port);
1062 port->actor_oper_port_state &= ~AD_STATE_COLLECTING;
1063 port->actor_oper_port_state &= ~AD_STATE_DISTRIBUTING;
1064 port->ntt = 1;
1065 break;
1066 case AD_MUX_WAITING:
1067 port->sm_mux_timer_counter = __ad_timer_to_ticks(AD_WAIT_WHILE_TIMER, 0);
1068 break;
1069 case AD_MUX_ATTACHED:
1070 __attach_bond_to_agg(port);
1071 port->actor_oper_port_state |= AD_STATE_SYNCHRONIZATION;
1072 port->actor_oper_port_state &= ~AD_STATE_COLLECTING;
1073 port->actor_oper_port_state &= ~AD_STATE_DISTRIBUTING;
1074 ad_disable_collecting_distributing(port);
1075 port->ntt = 1;
1076 break;
1077 case AD_MUX_COLLECTING_DISTRIBUTING:
1078 port->actor_oper_port_state |= AD_STATE_COLLECTING;
1079 port->actor_oper_port_state |= AD_STATE_DISTRIBUTING;
1080 ad_enable_collecting_distributing(port);
1081 port->ntt = 1;
1082 break;
1083 default: //to silence the compiler
1084 break;
1085 }
1086 }
1087}
1088
1089/**
1090 * ad_rx_machine - handle a port's rx State Machine
1091 * @lacpdu: the lacpdu we've received
1092 * @port: the port we're looking at
1093 *
1094 * If lacpdu arrived, stop previous timer (if exists) and set the next state as
1095 * CURRENT. If timer expired set the state machine in the proper state.
1096 * In other cases, this function checks if we need to switch to other state.
1097 */
1098static void ad_rx_machine(struct lacpdu *lacpdu, struct port *port)
1099{
1100 rx_states_t last_state;
1101
1102 // Lock to prevent 2 instances of this function to run simultaneously(rx interrupt and periodic machine callback)
1103 __get_rx_machine_lock(port);
1104
1105 // keep current State Machine state to compare later if it was changed
1106 last_state = port->sm_rx_state;
1107
1108 // check if state machine should change state
1109 // first, check if port was reinitialized
1110 if (port->sm_vars & AD_PORT_BEGIN) {
1111 port->sm_rx_state = AD_RX_INITIALIZE; // next state
1112 }
1113 // check if port is not enabled
1114 else if (!(port->sm_vars & AD_PORT_BEGIN) && !port->is_enabled && !(port->sm_vars & AD_PORT_MOVED)) {
1115 port->sm_rx_state = AD_RX_PORT_DISABLED; // next state
1116 }
1117 // check if new lacpdu arrived
1118 else if (lacpdu && ((port->sm_rx_state == AD_RX_EXPIRED) || (port->sm_rx_state == AD_RX_DEFAULTED) || (port->sm_rx_state == AD_RX_CURRENT))) {
1119 port->sm_rx_timer_counter = 0; // zero timer
1120 port->sm_rx_state = AD_RX_CURRENT;
1121 } else {
1122 // if timer is on, and if it is expired
1123 if (port->sm_rx_timer_counter && !(--port->sm_rx_timer_counter)) {
1124 switch (port->sm_rx_state) {
1125 case AD_RX_EXPIRED:
1126 port->sm_rx_state = AD_RX_DEFAULTED; // next state
1127 break;
1128 case AD_RX_CURRENT:
1129 port->sm_rx_state = AD_RX_EXPIRED; // next state
1130 break;
1131 default: //to silence the compiler
1132 break;
1133 }
1134 } else {
1135 // if no lacpdu arrived and no timer is on
1136 switch (port->sm_rx_state) {
1137 case AD_RX_PORT_DISABLED:
1138 if (port->sm_vars & AD_PORT_MOVED) {
1139 port->sm_rx_state = AD_RX_INITIALIZE; // next state
1140 } else if (port->is_enabled && (port->sm_vars & AD_PORT_LACP_ENABLED)) {
1141 port->sm_rx_state = AD_RX_EXPIRED; // next state
1142 } else if (port->is_enabled && ((port->sm_vars & AD_PORT_LACP_ENABLED) == 0)) {
1143 port->sm_rx_state = AD_RX_LACP_DISABLED; // next state
1144 }
1145 break;
1146 default: //to silence the compiler
1147 break;
1148
1149 }
1150 }
1151 }
1152
1153 // check if the State machine was changed or new lacpdu arrived
1154 if ((port->sm_rx_state != last_state) || (lacpdu)) {
1155 dprintk("Rx Machine: Port=%d, Last State=%d, Curr State=%d\n", port->actor_port_number, last_state, port->sm_rx_state);
1156 switch (port->sm_rx_state) {
1157 case AD_RX_INITIALIZE:
1158 if (!(port->actor_oper_port_key & AD_DUPLEX_KEY_BITS)) {
1159 port->sm_vars &= ~AD_PORT_LACP_ENABLED;
1160 } else {
1161 port->sm_vars |= AD_PORT_LACP_ENABLED;
1162 }
1163 port->sm_vars &= ~AD_PORT_SELECTED;
1164 __record_default(port);
1165 port->actor_oper_port_state &= ~AD_STATE_EXPIRED;
1166 port->sm_vars &= ~AD_PORT_MOVED;
1167 port->sm_rx_state = AD_RX_PORT_DISABLED; // next state
1168
1169 /*- Fall Through -*/
1170
1171 case AD_RX_PORT_DISABLED:
1172 port->sm_vars &= ~AD_PORT_MATCHED;
1173 break;
1174 case AD_RX_LACP_DISABLED:
1175 port->sm_vars &= ~AD_PORT_SELECTED;
1176 __record_default(port);
1177 port->partner_oper_port_state &= ~AD_STATE_AGGREGATION;
1178 port->sm_vars |= AD_PORT_MATCHED;
1179 port->actor_oper_port_state &= ~AD_STATE_EXPIRED;
1180 break;
1181 case AD_RX_EXPIRED:
1182 //Reset of the Synchronization flag. (Standard 43.4.12)
1183 //This reset cause to disable this port in the COLLECTING_DISTRIBUTING state of the
1184 //mux machine in case of EXPIRED even if LINK_DOWN didn't arrive for the port.
1185 port->partner_oper_port_state &= ~AD_STATE_SYNCHRONIZATION;
1186 port->sm_vars &= ~AD_PORT_MATCHED;
1187 port->partner_oper_port_state |= AD_SHORT_TIMEOUT;
1188 port->sm_rx_timer_counter = __ad_timer_to_ticks(AD_CURRENT_WHILE_TIMER, (u16)(AD_SHORT_TIMEOUT));
1189 port->actor_oper_port_state |= AD_STATE_EXPIRED;
1190 break;
1191 case AD_RX_DEFAULTED:
1192 __update_default_selected(port);
1193 __record_default(port);
1194 port->sm_vars |= AD_PORT_MATCHED;
1195 port->actor_oper_port_state &= ~AD_STATE_EXPIRED;
1196 break;
1197 case AD_RX_CURRENT:
1198 // detect loopback situation
1199 if (!MAC_ADDRESS_COMPARE(&(lacpdu->actor_system), &(port->actor_system))) {
1200 // INFO_RECEIVED_LOOPBACK_FRAMES
1201 printk(KERN_ERR DRV_NAME ": An illegal loopback occurred on adapter (%s)\n",
1202 port->slave->dev->name);
1203 printk(KERN_ERR "Check the configuration to verify that all Adapters "
1204 "are connected to 802.3ad compliant switch ports\n");
1205 __release_rx_machine_lock(port);
1206 return;
1207 }
1208 __update_selected(lacpdu, port);
1209 __update_ntt(lacpdu, port);
1210 __record_pdu(lacpdu, port);
1211 __choose_matched(lacpdu, port);
1212 port->sm_rx_timer_counter = __ad_timer_to_ticks(AD_CURRENT_WHILE_TIMER, (u16)(port->actor_oper_port_state & AD_STATE_LACP_TIMEOUT));
1213 port->actor_oper_port_state &= ~AD_STATE_EXPIRED;
1214 // verify that if the aggregator is enabled, the port is enabled too.
1215 //(because if the link goes down for a short time, the 802.3ad will not
1216 // catch it, and the port will continue to be disabled)
1217 if (port->aggregator && port->aggregator->is_active && !__port_is_enabled(port)) {
1218 __enable_port(port);
1219 }
1220 break;
1221 default: //to silence the compiler
1222 break;
1223 }
1224 }
1225 __release_rx_machine_lock(port);
1226}
1227
1228/**
1229 * ad_tx_machine - handle a port's tx state machine
1230 * @port: the port we're looking at
1231 *
1232 */
1233static void ad_tx_machine(struct port *port)
1234{
1235 // check if tx timer expired, to verify that we do not send more than 3 packets per second
1236 if (port->sm_tx_timer_counter && !(--port->sm_tx_timer_counter)) {
1237 // check if there is something to send
1238 if (port->ntt && (port->sm_vars & AD_PORT_LACP_ENABLED)) {
1239 __update_lacpdu_from_port(port);
1240 // send the lacpdu
1241 if (ad_lacpdu_send(port) >= 0) {
1242 dprintk("Sent LACPDU on port %d\n", port->actor_port_number);
1243 // mark ntt as false, so it will not be sent again until demanded
1244 port->ntt = 0;
1245 }
1246 }
1247 // restart tx timer(to verify that we will not exceed AD_MAX_TX_IN_SECOND
1248 port->sm_tx_timer_counter=ad_ticks_per_sec/AD_MAX_TX_IN_SECOND;
1249 }
1250}
1251
1252/**
1253 * ad_periodic_machine - handle a port's periodic state machine
1254 * @port: the port we're looking at
1255 *
1256 * Turn ntt flag on priodically to perform periodic transmission of lacpdu's.
1257 */
1258static void ad_periodic_machine(struct port *port)
1259{
1260 periodic_states_t last_state;
1261
1262 // keep current state machine state to compare later if it was changed
1263 last_state = port->sm_periodic_state;
1264
1265 // check if port was reinitialized
1266 if (((port->sm_vars & AD_PORT_BEGIN) || !(port->sm_vars & AD_PORT_LACP_ENABLED) || !port->is_enabled) ||
1267 (!(port->actor_oper_port_state & AD_STATE_LACP_ACTIVITY) && !(port->partner_oper_port_state & AD_STATE_LACP_ACTIVITY))
1268 ) {
1269 port->sm_periodic_state = AD_NO_PERIODIC; // next state
1270 }
1271 // check if state machine should change state
1272 else if (port->sm_periodic_timer_counter) {
1273 // check if periodic state machine expired
1274 if (!(--port->sm_periodic_timer_counter)) {
1275 // if expired then do tx
1276 port->sm_periodic_state = AD_PERIODIC_TX; // next state
1277 } else {
1278 // If not expired, check if there is some new timeout parameter from the partner state
1279 switch (port->sm_periodic_state) {
1280 case AD_FAST_PERIODIC:
1281 if (!(port->partner_oper_port_state & AD_STATE_LACP_TIMEOUT)) {
1282 port->sm_periodic_state = AD_SLOW_PERIODIC; // next state
1283 }
1284 break;
1285 case AD_SLOW_PERIODIC:
1286 if ((port->partner_oper_port_state & AD_STATE_LACP_TIMEOUT)) {
1287 // stop current timer
1288 port->sm_periodic_timer_counter = 0;
1289 port->sm_periodic_state = AD_PERIODIC_TX; // next state
1290 }
1291 break;
1292 default: //to silence the compiler
1293 break;
1294 }
1295 }
1296 } else {
1297 switch (port->sm_periodic_state) {
1298 case AD_NO_PERIODIC:
1299 port->sm_periodic_state = AD_FAST_PERIODIC; // next state
1300 break;
1301 case AD_PERIODIC_TX:
1302 if (!(port->partner_oper_port_state & AD_STATE_LACP_TIMEOUT)) {
1303 port->sm_periodic_state = AD_SLOW_PERIODIC; // next state
1304 } else {
1305 port->sm_periodic_state = AD_FAST_PERIODIC; // next state
1306 }
1307 break;
1308 default: //to silence the compiler
1309 break;
1310 }
1311 }
1312
1313 // check if the state machine was changed
1314 if (port->sm_periodic_state != last_state) {
1315 dprintk("Periodic Machine: Port=%d, Last State=%d, Curr State=%d\n", port->actor_port_number, last_state, port->sm_periodic_state);
1316 switch (port->sm_periodic_state) {
1317 case AD_NO_PERIODIC:
1318 port->sm_periodic_timer_counter = 0; // zero timer
1319 break;
1320 case AD_FAST_PERIODIC:
1321 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
1322 break;
1323 case AD_SLOW_PERIODIC:
1324 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
1325 break;
1326 case AD_PERIODIC_TX:
1327 port->ntt = 1;
1328 break;
1329 default: //to silence the compiler
1330 break;
1331 }
1332 }
1333}
1334
1335/**
1336 * ad_port_selection_logic - select aggregation groups
1337 * @port: the port we're looking at
1338 *
1339 * Select aggregation groups, and assign each port for it's aggregetor. The
1340 * selection logic is called in the inititalization (after all the handshkes),
1341 * and after every lacpdu receive (if selected is off).
1342 */
1343static void ad_port_selection_logic(struct port *port)
1344{
1345 struct aggregator *aggregator, *free_aggregator = NULL, *temp_aggregator;
1346 struct port *last_port = NULL, *curr_port;
1347 int found = 0;
1348
1349 // if the port is already Selected, do nothing
1350 if (port->sm_vars & AD_PORT_SELECTED) {
1351 return;
1352 }
1353
1354 // if the port is connected to other aggregator, detach it
1355 if (port->aggregator) {
1356 // detach the port from its former aggregator
1357 temp_aggregator=port->aggregator;
1358 for (curr_port=temp_aggregator->lag_ports; curr_port; last_port=curr_port, curr_port=curr_port->next_port_in_aggregator) {
1359 if (curr_port == port) {
1360 temp_aggregator->num_of_ports--;
1361 if (!last_port) {// if it is the first port attached to the aggregator
1362 temp_aggregator->lag_ports=port->next_port_in_aggregator;
1363 } else {// not the first port attached to the aggregator
1364 last_port->next_port_in_aggregator=port->next_port_in_aggregator;
1365 }
1366
1367 // clear the port's relations to this aggregator
1368 port->aggregator = NULL;
1369 port->next_port_in_aggregator=NULL;
1370 port->actor_port_aggregator_identifier=0;
1371
1372 dprintk("Port %d left LAG %d\n", port->actor_port_number, temp_aggregator->aggregator_identifier);
1373 // if the aggregator is empty, clear its parameters, and set it ready to be attached
1374 if (!temp_aggregator->lag_ports) {
1375 ad_clear_agg(temp_aggregator);
1376 }
1377 break;
1378 }
1379 }
1380 if (!curr_port) { // meaning: the port was related to an aggregator but was not on the aggregator port list
1381 printk(KERN_WARNING DRV_NAME ": Warning: Port %d (on %s) was "
1382 "related to aggregator %d but was not on its port list\n",
1383 port->actor_port_number, port->slave->dev->name,
1384 port->aggregator->aggregator_identifier);
1385 }
1386 }
1387 // search on all aggregators for a suitable aggregator for this port
1388 for (aggregator = __get_first_agg(port); aggregator;
1389 aggregator = __get_next_agg(aggregator)) {
1390
1391 // keep a free aggregator for later use(if needed)
1392 if (!aggregator->lag_ports) {
1393 if (!free_aggregator) {
1394 free_aggregator=aggregator;
1395 }
1396 continue;
1397 }
1398 // check if current aggregator suits us
1399 if (((aggregator->actor_oper_aggregator_key == port->actor_oper_port_key) && // if all parameters match AND
1400 !MAC_ADDRESS_COMPARE(&(aggregator->partner_system), &(port->partner_oper_system)) &&
1401 (aggregator->partner_system_priority == port->partner_oper_system_priority) &&
1402 (aggregator->partner_oper_aggregator_key == port->partner_oper_key)
1403 ) &&
1404 ((MAC_ADDRESS_COMPARE(&(port->partner_oper_system), &(null_mac_addr)) && // partner answers
1405 !aggregator->is_individual) // but is not individual OR
1406 )
1407 ) {
1408 // attach to the founded aggregator
1409 port->aggregator = aggregator;
1410 port->actor_port_aggregator_identifier=port->aggregator->aggregator_identifier;
1411 port->next_port_in_aggregator=aggregator->lag_ports;
1412 port->aggregator->num_of_ports++;
1413 aggregator->lag_ports=port;
1414 dprintk("Port %d joined LAG %d(existing LAG)\n", port->actor_port_number, port->aggregator->aggregator_identifier);
1415
1416 // mark this port as selected
1417 port->sm_vars |= AD_PORT_SELECTED;
1418 found = 1;
1419 break;
1420 }
1421 }
1422
1423 // the port couldn't find an aggregator - attach it to a new aggregator
1424 if (!found) {
1425 if (free_aggregator) {
1426 // assign port a new aggregator
1427 port->aggregator = free_aggregator;
1428 port->actor_port_aggregator_identifier=port->aggregator->aggregator_identifier;
1429
1430 // update the new aggregator's parameters
1431 // if port was responsed from the end-user
1432 if (port->actor_oper_port_key & AD_DUPLEX_KEY_BITS) {// if port is full duplex
1433 port->aggregator->is_individual = 0;
1434 } else {
1435 port->aggregator->is_individual = 1;
1436 }
1437
1438 port->aggregator->actor_admin_aggregator_key = port->actor_admin_port_key;
1439 port->aggregator->actor_oper_aggregator_key = port->actor_oper_port_key;
1440 port->aggregator->partner_system=port->partner_oper_system;
1441 port->aggregator->partner_system_priority = port->partner_oper_system_priority;
1442 port->aggregator->partner_oper_aggregator_key = port->partner_oper_key;
1443 port->aggregator->receive_state = 1;
1444 port->aggregator->transmit_state = 1;
1445 port->aggregator->lag_ports = port;
1446 port->aggregator->num_of_ports++;
1447
1448 // mark this port as selected
1449 port->sm_vars |= AD_PORT_SELECTED;
1450
1451 dprintk("Port %d joined LAG %d(new LAG)\n", port->actor_port_number, port->aggregator->aggregator_identifier);
1452 } else {
1453 printk(KERN_ERR DRV_NAME ": Port %d (on %s) did not find a suitable aggregator\n",
1454 port->actor_port_number, port->slave->dev->name);
1455 }
1456 }
1457 // if all aggregator's ports are READY_N == TRUE, set ready=TRUE in all aggregator's ports
1458 // else set ready=FALSE in all aggregator's ports
1459 __set_agg_ports_ready(port->aggregator, __agg_ports_are_ready(port->aggregator));
1460
1461 if (!__check_agg_selection_timer(port) && (aggregator = __get_first_agg(port))) {
1462 ad_agg_selection_logic(aggregator);
1463 }
1464}
1465
1466/**
1467 * ad_agg_selection_logic - select an aggregation group for a team
1468 * @aggregator: the aggregator we're looking at
1469 *
1470 * It is assumed that only one aggregator may be selected for a team.
1471 * The logic of this function is to select (at first time) the aggregator with
1472 * the most ports attached to it, and to reselect the active aggregator only if
1473 * the previous aggregator has no more ports related to it.
1474 *
1475 * FIXME: this function MUST be called with the first agg in the bond, or
1476 * __get_active_agg() won't work correctly. This function should be better
1477 * called with the bond itself, and retrieve the first agg from it.
1478 */
1479static void ad_agg_selection_logic(struct aggregator *aggregator)
1480{
1481 struct aggregator *best_aggregator = NULL, *active_aggregator = NULL;
1482 struct aggregator *last_active_aggregator = NULL, *origin_aggregator;
1483 struct port *port;
1484 u16 num_of_aggs=0;
1485
1486 origin_aggregator = aggregator;
1487
1488 //get current active aggregator
1489 last_active_aggregator = __get_active_agg(aggregator);
1490
1491 // search for the aggregator with the most ports attached to it.
1492 do {
1493 // count how many candidate lag's we have
1494 if (aggregator->lag_ports) {
1495 num_of_aggs++;
1496 }
1497 if (aggregator->is_active && !aggregator->is_individual && // if current aggregator is the active aggregator
1498 MAC_ADDRESS_COMPARE(&(aggregator->partner_system), &(null_mac_addr))) { // and partner answers to 802.3ad PDUs
1499 if (aggregator->num_of_ports) { // if any ports attached to the current aggregator
1500 best_aggregator=NULL; // disregard the best aggregator that was chosen by now
1501 break; // stop the selection of other aggregator if there are any ports attached to this active aggregator
1502 } else { // no ports attached to this active aggregator
1503 aggregator->is_active = 0; // mark this aggregator as not active anymore
1504 }
1505 }
1506 if (aggregator->num_of_ports) { // if any ports attached
1507 if (best_aggregator) { // if there is a candidte aggregator
1508 //The reasons for choosing new best aggregator:
1509 // 1. if current agg is NOT individual and the best agg chosen so far is individual OR
1510 // current and best aggs are both individual or both not individual, AND
1511 // 2a. current agg partner reply but best agg partner do not reply OR
1512 // 2b. current agg partner reply OR current agg partner do not reply AND best agg partner also do not reply AND
1513 // current has more ports/bandwidth, or same amount of ports but current has faster ports, THEN
1514 // current agg become best agg so far
1515
1516 //if current agg is NOT individual and the best agg chosen so far is individual change best_aggregator
1517 if (!aggregator->is_individual && best_aggregator->is_individual) {
1518 best_aggregator=aggregator;
1519 }
1520 // current and best aggs are both individual or both not individual
1521 else if ((aggregator->is_individual && best_aggregator->is_individual) ||
1522 (!aggregator->is_individual && !best_aggregator->is_individual)) {
1523 // current and best aggs are both individual or both not individual AND
1524 // current agg partner reply but best agg partner do not reply
1525 if ((MAC_ADDRESS_COMPARE(&(aggregator->partner_system), &(null_mac_addr)) &&
1526 !MAC_ADDRESS_COMPARE(&(best_aggregator->partner_system), &(null_mac_addr)))) {
1527 best_aggregator=aggregator;
1528 }
1529 // current agg partner reply OR current agg partner do not reply AND best agg partner also do not reply
1530 else if (! (!MAC_ADDRESS_COMPARE(&(aggregator->partner_system), &(null_mac_addr)) &&
1531 MAC_ADDRESS_COMPARE(&(best_aggregator->partner_system), &(null_mac_addr)))) {
1532 if ((__get_agg_selection_mode(aggregator->lag_ports) == AD_BANDWIDTH)&&
1533 (__get_agg_bandwidth(aggregator) > __get_agg_bandwidth(best_aggregator))) {
1534 best_aggregator=aggregator;
1535 } else if (__get_agg_selection_mode(aggregator->lag_ports) == AD_COUNT) {
1536 if (((aggregator->num_of_ports > best_aggregator->num_of_ports) &&
1537 (aggregator->actor_oper_aggregator_key & AD_SPEED_KEY_BITS))||
1538 ((aggregator->num_of_ports == best_aggregator->num_of_ports) &&
1539 ((u16)(aggregator->actor_oper_aggregator_key & AD_SPEED_KEY_BITS) >
1540 (u16)(best_aggregator->actor_oper_aggregator_key & AD_SPEED_KEY_BITS)))) {
1541 best_aggregator=aggregator;
1542 }
1543 }
1544 }
1545 }
1546 } else {
1547 best_aggregator=aggregator;
1548 }
1549 }
1550 aggregator->is_active = 0; // mark all aggregators as not active anymore
1551 } while ((aggregator = __get_next_agg(aggregator)));
1552
1553 // if we have new aggregator selected, don't replace the old aggregator if it has an answering partner,
1554 // or if both old aggregator and new aggregator don't have answering partner
1555 if (best_aggregator) {
1556 if (last_active_aggregator && last_active_aggregator->lag_ports && last_active_aggregator->lag_ports->is_enabled &&
1557 (MAC_ADDRESS_COMPARE(&(last_active_aggregator->partner_system), &(null_mac_addr)) || // partner answers OR
1558 (!MAC_ADDRESS_COMPARE(&(last_active_aggregator->partner_system), &(null_mac_addr)) && // both old and new
1559 !MAC_ADDRESS_COMPARE(&(best_aggregator->partner_system), &(null_mac_addr)))) // partner do not answer
1560 ) {
1561 // if new aggregator has link, and old aggregator does not, replace old aggregator.(do nothing)
1562 // -> don't replace otherwise.
1563 if (!(!last_active_aggregator->actor_oper_aggregator_key && best_aggregator->actor_oper_aggregator_key)) {
1564 best_aggregator=NULL;
1565 last_active_aggregator->is_active = 1; // don't replace good old aggregator
1566
1567 }
1568 }
1569 }
1570
1571 // if there is new best aggregator, activate it
1572 if (best_aggregator) {
1573 for (aggregator = __get_first_agg(best_aggregator->lag_ports);
1574 aggregator;
1575 aggregator = __get_next_agg(aggregator)) {
1576
1577 dprintk("Agg=%d; Ports=%d; a key=%d; p key=%d; Indiv=%d; Active=%d\n",
1578 aggregator->aggregator_identifier, aggregator->num_of_ports,
1579 aggregator->actor_oper_aggregator_key, aggregator->partner_oper_aggregator_key,
1580 aggregator->is_individual, aggregator->is_active);
1581 }
1582
1583 // check if any partner replys
1584 if (best_aggregator->is_individual) {
1585 printk(KERN_WARNING DRV_NAME ": Warning: No 802.3ad response from the link partner "
1586 "for any adapters in the bond\n");
1587 }
1588
1589 // check if there are more than one aggregator
1590 if (num_of_aggs > 1) {
1591 dprintk("Warning: More than one Link Aggregation Group was "
1592 "found in the bond. Only one group will function in the bond\n");
1593 }
1594
1595 best_aggregator->is_active = 1;
1596 dprintk("LAG %d choosed as the active LAG\n", best_aggregator->aggregator_identifier);
1597 dprintk("Agg=%d; Ports=%d; a key=%d; p key=%d; Indiv=%d; Active=%d\n",
1598 best_aggregator->aggregator_identifier, best_aggregator->num_of_ports,
1599 best_aggregator->actor_oper_aggregator_key, best_aggregator->partner_oper_aggregator_key,
1600 best_aggregator->is_individual, best_aggregator->is_active);
1601
1602 // disable the ports that were related to the former active_aggregator
1603 if (last_active_aggregator) {
1604 for (port=last_active_aggregator->lag_ports; port; port=port->next_port_in_aggregator) {
1605 __disable_port(port);
1606 }
1607 }
1608 }
1609
1610 // if the selected aggregator is of join individuals(partner_system is NULL), enable their ports
1611 active_aggregator = __get_active_agg(origin_aggregator);
1612
1613 if (active_aggregator) {
1614 if (!MAC_ADDRESS_COMPARE(&(active_aggregator->partner_system), &(null_mac_addr))) {
1615 for (port=active_aggregator->lag_ports; port; port=port->next_port_in_aggregator) {
1616 __enable_port(port);
1617 }
1618 }
1619 }
1620}
1621
1622/**
1623 * ad_clear_agg - clear a given aggregator's parameters
1624 * @aggregator: the aggregator we're looking at
1625 *
1626 */
1627static void ad_clear_agg(struct aggregator *aggregator)
1628{
1629 if (aggregator) {
1630 aggregator->is_individual = 0;
1631 aggregator->actor_admin_aggregator_key = 0;
1632 aggregator->actor_oper_aggregator_key = 0;
1633 aggregator->partner_system = null_mac_addr;
1634 aggregator->partner_system_priority = 0;
1635 aggregator->partner_oper_aggregator_key = 0;
1636 aggregator->receive_state = 0;
1637 aggregator->transmit_state = 0;
1638 aggregator->lag_ports = NULL;
1639 aggregator->is_active = 0;
1640 aggregator->num_of_ports = 0;
1641 dprintk("LAG %d was cleared\n", aggregator->aggregator_identifier);
1642 }
1643}
1644
1645/**
1646 * ad_initialize_agg - initialize a given aggregator's parameters
1647 * @aggregator: the aggregator we're looking at
1648 *
1649 */
1650static void ad_initialize_agg(struct aggregator *aggregator)
1651{
1652 if (aggregator) {
1653 ad_clear_agg(aggregator);
1654
1655 aggregator->aggregator_mac_address = null_mac_addr;
1656 aggregator->aggregator_identifier = 0;
1657 aggregator->slave = NULL;
1658 }
1659}
1660
1661/**
1662 * ad_initialize_port - initialize a given port's parameters
1663 * @aggregator: the aggregator we're looking at
1664 * @lacp_fast: boolean. whether fast periodic should be used
1665 *
1666 */
1667static void ad_initialize_port(struct port *port, int lacp_fast)
1668{
1669 if (port) {
1670 port->actor_port_number = 1;
1671 port->actor_port_priority = 0xff;
1672 port->actor_system = null_mac_addr;
1673 port->actor_system_priority = 0xffff;
1674 port->actor_port_aggregator_identifier = 0;
1675 port->ntt = 0;
1676 port->actor_admin_port_key = 1;
1677 port->actor_oper_port_key = 1;
1678 port->actor_admin_port_state = AD_STATE_AGGREGATION | AD_STATE_LACP_ACTIVITY;
1679 port->actor_oper_port_state = AD_STATE_AGGREGATION | AD_STATE_LACP_ACTIVITY;
1680
1681 if (lacp_fast) {
1682 port->actor_oper_port_state |= AD_STATE_LACP_TIMEOUT;
1683 }
1684
1685 port->partner_admin_system = null_mac_addr;
1686 port->partner_oper_system = null_mac_addr;
1687 port->partner_admin_system_priority = 0xffff;
1688 port->partner_oper_system_priority = 0xffff;
1689 port->partner_admin_key = 1;
1690 port->partner_oper_key = 1;
1691 port->partner_admin_port_number = 1;
1692 port->partner_oper_port_number = 1;
1693 port->partner_admin_port_priority = 0xff;
1694 port->partner_oper_port_priority = 0xff;
1695 port->partner_admin_port_state = 1;
1696 port->partner_oper_port_state = 1;
1697 port->is_enabled = 1;
1698 // ****** private parameters ******
1699 port->sm_vars = 0x3;
1700 port->sm_rx_state = 0;
1701 port->sm_rx_timer_counter = 0;
1702 port->sm_periodic_state = 0;
1703 port->sm_periodic_timer_counter = 0;
1704 port->sm_mux_state = 0;
1705 port->sm_mux_timer_counter = 0;
1706 port->sm_tx_state = 0;
1707 port->sm_tx_timer_counter = 0;
1708 port->slave = NULL;
1709 port->aggregator = NULL;
1710 port->next_port_in_aggregator = NULL;
1711 port->transaction_id = 0;
1712
1713 ad_initialize_lacpdu(&(port->lacpdu));
1714 }
1715}
1716
1717/**
1718 * ad_enable_collecting_distributing - enable a port's transmit/receive
1719 * @port: the port we're looking at
1720 *
1721 * Enable @port if it's in an active aggregator
1722 */
1723static void ad_enable_collecting_distributing(struct port *port)
1724{
1725 if (port->aggregator->is_active) {
1726 dprintk("Enabling port %d(LAG %d)\n", port->actor_port_number, port->aggregator->aggregator_identifier);
1727 __enable_port(port);
1728 }
1729}
1730
1731/**
1732 * ad_disable_collecting_distributing - disable a port's transmit/receive
1733 * @port: the port we're looking at
1734 *
1735 */
1736static void ad_disable_collecting_distributing(struct port *port)
1737{
1738 if (port->aggregator && MAC_ADDRESS_COMPARE(&(port->aggregator->partner_system), &(null_mac_addr))) {
1739 dprintk("Disabling port %d(LAG %d)\n", port->actor_port_number, port->aggregator->aggregator_identifier);
1740 __disable_port(port);
1741 }
1742}
1743
1744#if 0
1745/**
1746 * ad_marker_info_send - send a marker information frame
1747 * @port: the port we're looking at
1748 *
1749 * This function does nothing since we decided not to implement send and handle
1750 * response for marker PDU's, in this stage, but only to respond to marker
1751 * information.
1752 */
1753static void ad_marker_info_send(struct port *port)
1754{
1755 struct marker marker;
1756 u16 index;
1757
1758 // fill the marker PDU with the appropriate values
1759 marker.subtype = 0x02;
1760 marker.version_number = 0x01;
1761 marker.tlv_type = AD_MARKER_INFORMATION_SUBTYPE;
1762 marker.marker_length = 0x16;
1763 // convert requester_port to Big Endian
1764 marker.requester_port = (((port->actor_port_number & 0xFF) << 8) |((u16)(port->actor_port_number & 0xFF00) >> 8));
1765 marker.requester_system = port->actor_system;
1766 // convert requester_port(u32) to Big Endian
1767 marker.requester_transaction_id = (((++port->transaction_id & 0xFF) << 24) |((port->transaction_id & 0xFF00) << 8) |((port->transaction_id & 0xFF0000) >> 8) |((port->transaction_id & 0xFF000000) >> 24));
1768 marker.pad = 0;
1769 marker.tlv_type_terminator = 0x00;
1770 marker.terminator_length = 0x00;
1771 for (index=0; index<90; index++) {
1772 marker.reserved_90[index]=0;
1773 }
1774
1775 // send the marker information
1776 if (ad_marker_send(port, &marker) >= 0) {
1777 dprintk("Sent Marker Information on port %d\n", port->actor_port_number);
1778 }
1779}
1780#endif
1781
1782/**
1783 * ad_marker_info_received - handle receive of a Marker information frame
1784 * @marker_info: Marker info received
1785 * @port: the port we're looking at
1786 *
1787 */
1788static void ad_marker_info_received(struct marker *marker_info,struct port *port)
1789{
1790 struct marker marker;
1791
1792 // copy the received marker data to the response marker
1793 //marker = *marker_info;
1794 memcpy(&marker, marker_info, sizeof(struct marker));
1795 // change the marker subtype to marker response
1796 marker.tlv_type=AD_MARKER_RESPONSE_SUBTYPE;
1797 // send the marker response
1798
1799 if (ad_marker_send(port, &marker) >= 0) {
1800 dprintk("Sent Marker Response on port %d\n", port->actor_port_number);
1801 }
1802}
1803
1804/**
1805 * ad_marker_response_received - handle receive of a marker response frame
1806 * @marker: marker PDU received
1807 * @port: the port we're looking at
1808 *
1809 * This function does nothing since we decided not to implement send and handle
1810 * response for marker PDU's, in this stage, but only to respond to marker
1811 * information.
1812 */
1813static void ad_marker_response_received(struct marker *marker, struct port *port)
1814{
1815 marker=NULL; // just to satisfy the compiler
1816 port=NULL; // just to satisfy the compiler
1817 // DO NOTHING, SINCE WE DECIDED NOT TO IMPLEMENT THIS FEATURE FOR NOW
1818}
1819
1820/**
1821 * ad_initialize_lacpdu - initialize a given lacpdu structure
1822 * @lacpdu: lacpdu structure to initialize
1823 *
1824 */
1825static void ad_initialize_lacpdu(struct lacpdu *lacpdu)
1826{
1827 u16 index;
1828
1829 // initialize lacpdu data
1830 lacpdu->subtype = 0x01;
1831 lacpdu->version_number = 0x01;
1832 lacpdu->tlv_type_actor_info = 0x01;
1833 lacpdu->actor_information_length = 0x14;
1834 // lacpdu->actor_system_priority updated on send
1835 // lacpdu->actor_system updated on send
1836 // lacpdu->actor_key updated on send
1837 // lacpdu->actor_port_priority updated on send
1838 // lacpdu->actor_port updated on send
1839 // lacpdu->actor_state updated on send
1840 lacpdu->tlv_type_partner_info = 0x02;
1841 lacpdu->partner_information_length = 0x14;
1842 for (index=0; index<=2; index++) {
1843 lacpdu->reserved_3_1[index]=0;
1844 }
1845 // lacpdu->partner_system_priority updated on send
1846 // lacpdu->partner_system updated on send
1847 // lacpdu->partner_key updated on send
1848 // lacpdu->partner_port_priority updated on send
1849 // lacpdu->partner_port updated on send
1850 // lacpdu->partner_state updated on send
1851 for (index=0; index<=2; index++) {
1852 lacpdu->reserved_3_2[index]=0;
1853 }
1854 lacpdu->tlv_type_collector_info = 0x03;
1855 lacpdu->collector_information_length= 0x10;
1856 lacpdu->collector_max_delay = AD_COLLECTOR_MAX_DELAY;
1857 for (index=0; index<=11; index++) {
1858 lacpdu->reserved_12[index]=0;
1859 }
1860 lacpdu->tlv_type_terminator = 0x00;
1861 lacpdu->terminator_length = 0;
1862 for (index=0; index<=49; index++) {
1863 lacpdu->reserved_50[index]=0;
1864 }
1865}
1866
1867//////////////////////////////////////////////////////////////////////////////////////
1868// ================= AD exported functions to the main bonding code ==================
1869//////////////////////////////////////////////////////////////////////////////////////
1870
1871// Check aggregators status in team every T seconds
1872#define AD_AGGREGATOR_SELECTION_TIMER 8
1873
1874static u16 aggregator_identifier;
1875
1876/**
1877 * bond_3ad_initialize - initialize a bond's 802.3ad parameters and structures
1878 * @bond: bonding struct to work on
1879 * @tick_resolution: tick duration (millisecond resolution)
1880 * @lacp_fast: boolean. whether fast periodic should be used
1881 *
1882 * Can be called only after the mac address of the bond is set.
1883 */
1884void bond_3ad_initialize(struct bonding *bond, u16 tick_resolution, int lacp_fast)
1885{
1886 // check that the bond is not initialized yet
1887 if (MAC_ADDRESS_COMPARE(&(BOND_AD_INFO(bond).system.sys_mac_addr), &(bond->dev->dev_addr))) {
1888
1889 aggregator_identifier = 0;
1890
1891 BOND_AD_INFO(bond).lacp_fast = lacp_fast;
1892 BOND_AD_INFO(bond).system.sys_priority = 0xFFFF;
1893 BOND_AD_INFO(bond).system.sys_mac_addr = *((struct mac_addr *)bond->dev->dev_addr);
1894
1895 // initialize how many times this module is called in one second(should be about every 100ms)
1896 ad_ticks_per_sec = tick_resolution;
1897
1898 // initialize the aggregator selection timer(to activate an aggregation selection after initialize)
1899 BOND_AD_INFO(bond).agg_select_timer = (AD_AGGREGATOR_SELECTION_TIMER * ad_ticks_per_sec);
1900 BOND_AD_INFO(bond).agg_select_mode = AD_BANDWIDTH;
1901 }
1902}
1903
1904/**
1905 * bond_3ad_bind_slave - initialize a slave's port
1906 * @slave: slave struct to work on
1907 *
1908 * Returns: 0 on success
1909 * < 0 on error
1910 */
1911int bond_3ad_bind_slave(struct slave *slave)
1912{
1913 struct bonding *bond = bond_get_bond_by_slave(slave);
1914 struct port *port;
1915 struct aggregator *aggregator;
1916
1917 if (bond == NULL) {
1918 printk(KERN_ERR "The slave %s is not attached to its bond\n", slave->dev->name);
1919 return -1;
1920 }
1921
1922 //check that the slave has not been intialized yet.
1923 if (SLAVE_AD_INFO(slave).port.slave != slave) {
1924
1925 // port initialization
1926 port = &(SLAVE_AD_INFO(slave).port);
1927
1928 ad_initialize_port(port, BOND_AD_INFO(bond).lacp_fast);
1929
1930 port->slave = slave;
1931 port->actor_port_number = SLAVE_AD_INFO(slave).id;
1932 // key is determined according to the link speed, duplex and user key(which is yet not supported)
1933 // ------------------------------------------------------------
1934 // Port key : | User key | Speed |Duplex|
1935 // ------------------------------------------------------------
1936 // 16 6 1 0
1937 port->actor_admin_port_key = 0; // initialize this parameter
1938 port->actor_admin_port_key |= __get_duplex(port);
1939 port->actor_admin_port_key |= (__get_link_speed(port) << 1);
1940 port->actor_oper_port_key = port->actor_admin_port_key;
1941 // if the port is not full duplex, then the port should be not lacp Enabled
1942 if (!(port->actor_oper_port_key & AD_DUPLEX_KEY_BITS)) {
1943 port->sm_vars &= ~AD_PORT_LACP_ENABLED;
1944 }
1945 // actor system is the bond's system
1946 port->actor_system = BOND_AD_INFO(bond).system.sys_mac_addr;
1947 // tx timer(to verify that no more than MAX_TX_IN_SECOND lacpdu's are sent in one second)
1948 port->sm_tx_timer_counter = ad_ticks_per_sec/AD_MAX_TX_IN_SECOND;
1949 port->aggregator = NULL;
1950 port->next_port_in_aggregator = NULL;
1951
1952 __disable_port(port);
1953 __initialize_port_locks(port);
1954
1955
1956 // aggregator initialization
1957 aggregator = &(SLAVE_AD_INFO(slave).aggregator);
1958
1959 ad_initialize_agg(aggregator);
1960
1961 aggregator->aggregator_mac_address = *((struct mac_addr *)bond->dev->dev_addr);
1962 aggregator->aggregator_identifier = (++aggregator_identifier);
1963 aggregator->slave = slave;
1964 aggregator->is_active = 0;
1965 aggregator->num_of_ports = 0;
1966 }
1967
1968 return 0;
1969}
1970
1971/**
1972 * bond_3ad_unbind_slave - deinitialize a slave's port
1973 * @slave: slave struct to work on
1974 *
1975 * Search for the aggregator that is related to this port, remove the
1976 * aggregator and assign another aggregator for other port related to it
1977 * (if any), and remove the port.
1978 */
1979void bond_3ad_unbind_slave(struct slave *slave)
1980{
1981 struct port *port, *prev_port, *temp_port;
1982 struct aggregator *aggregator, *new_aggregator, *temp_aggregator;
1983 int select_new_active_agg = 0;
1984
1985 // find the aggregator related to this slave
1986 aggregator = &(SLAVE_AD_INFO(slave).aggregator);
1987
1988 // find the port related to this slave
1989 port = &(SLAVE_AD_INFO(slave).port);
1990
1991 // if slave is null, the whole port is not initialized
1992 if (!port->slave) {
1993 printk(KERN_WARNING DRV_NAME ": Trying to unbind an uninitialized port on %s\n", slave->dev->name);
1994 return;
1995 }
1996
1997 dprintk("Unbinding Link Aggregation Group %d\n", aggregator->aggregator_identifier);
1998
1999 /* Tell the partner that this port is not suitable for aggregation */
2000 port->actor_oper_port_state &= ~AD_STATE_AGGREGATION;
2001 __update_lacpdu_from_port(port);
2002 ad_lacpdu_send(port);
2003
2004 // check if this aggregator is occupied
2005 if (aggregator->lag_ports) {
2006 // check if there are other ports related to this aggregator except
2007 // the port related to this slave(thats ensure us that there is a
2008 // reason to search for new aggregator, and that we will find one
2009 if ((aggregator->lag_ports != port) || (aggregator->lag_ports->next_port_in_aggregator)) {
2010 // find new aggregator for the related port(s)
2011 new_aggregator = __get_first_agg(port);
2012 for (; new_aggregator; new_aggregator = __get_next_agg(new_aggregator)) {
2013 // if the new aggregator is empty, or it connected to to our port only
2014 if (!new_aggregator->lag_ports || ((new_aggregator->lag_ports == port) && !new_aggregator->lag_ports->next_port_in_aggregator)) {
2015 break;
2016 }
2017 }
2018 // if new aggregator found, copy the aggregator's parameters
2019 // and connect the related lag_ports to the new aggregator
2020 if ((new_aggregator) && ((!new_aggregator->lag_ports) || ((new_aggregator->lag_ports == port) && !new_aggregator->lag_ports->next_port_in_aggregator))) {
2021 dprintk("Some port(s) related to LAG %d - replaceing with LAG %d\n", aggregator->aggregator_identifier, new_aggregator->aggregator_identifier);
2022
2023 if ((new_aggregator->lag_ports == port) && new_aggregator->is_active) {
2024 printk(KERN_INFO DRV_NAME ": Removing an active aggregator\n");
2025 // select new active aggregator
2026 select_new_active_agg = 1;
2027 }
2028
2029 new_aggregator->is_individual = aggregator->is_individual;
2030 new_aggregator->actor_admin_aggregator_key = aggregator->actor_admin_aggregator_key;
2031 new_aggregator->actor_oper_aggregator_key = aggregator->actor_oper_aggregator_key;
2032 new_aggregator->partner_system = aggregator->partner_system;
2033 new_aggregator->partner_system_priority = aggregator->partner_system_priority;
2034 new_aggregator->partner_oper_aggregator_key = aggregator->partner_oper_aggregator_key;
2035 new_aggregator->receive_state = aggregator->receive_state;
2036 new_aggregator->transmit_state = aggregator->transmit_state;
2037 new_aggregator->lag_ports = aggregator->lag_ports;
2038 new_aggregator->is_active = aggregator->is_active;
2039 new_aggregator->num_of_ports = aggregator->num_of_ports;
2040
2041 // update the information that is written on the ports about the aggregator
2042 for (temp_port=aggregator->lag_ports; temp_port; temp_port=temp_port->next_port_in_aggregator) {
2043 temp_port->aggregator=new_aggregator;
2044 temp_port->actor_port_aggregator_identifier = new_aggregator->aggregator_identifier;
2045 }
2046
2047 // clear the aggregator
2048 ad_clear_agg(aggregator);
2049
2050 if (select_new_active_agg) {
2051 ad_agg_selection_logic(__get_first_agg(port));
2052 }
2053 } else {
2054 printk(KERN_WARNING DRV_NAME ": Warning: unbinding aggregator, "
2055 "and could not find a new aggregator for its ports\n");
2056 }
2057 } else { // in case that the only port related to this aggregator is the one we want to remove
2058 select_new_active_agg = aggregator->is_active;
2059 // clear the aggregator
2060 ad_clear_agg(aggregator);
2061 if (select_new_active_agg) {
2062 printk(KERN_INFO "Removing an active aggregator\n");
2063 // select new active aggregator
2064 ad_agg_selection_logic(__get_first_agg(port));
2065 }
2066 }
2067 }
2068
2069 dprintk("Unbinding port %d\n", port->actor_port_number);
2070 // find the aggregator that this port is connected to
2071 temp_aggregator = __get_first_agg(port);
2072 for (; temp_aggregator; temp_aggregator = __get_next_agg(temp_aggregator)) {
2073 prev_port = NULL;
2074 // search the port in the aggregator's related ports
2075 for (temp_port=temp_aggregator->lag_ports; temp_port; prev_port=temp_port, temp_port=temp_port->next_port_in_aggregator) {
2076 if (temp_port == port) { // the aggregator found - detach the port from this aggregator
2077 if (prev_port) {
2078 prev_port->next_port_in_aggregator = temp_port->next_port_in_aggregator;
2079 } else {
2080 temp_aggregator->lag_ports = temp_port->next_port_in_aggregator;
2081 }
2082 temp_aggregator->num_of_ports--;
2083 if (temp_aggregator->num_of_ports==0) {
2084 select_new_active_agg = temp_aggregator->is_active;
2085 // clear the aggregator
2086 ad_clear_agg(temp_aggregator);
2087 if (select_new_active_agg) {
2088 printk(KERN_INFO "Removing an active aggregator\n");
2089 // select new active aggregator
2090 ad_agg_selection_logic(__get_first_agg(port));
2091 }
2092 }
2093 break;
2094 }
2095 }
2096 }
2097 port->slave=NULL;
2098}
2099
2100/**
2101 * bond_3ad_state_machine_handler - handle state machines timeout
2102 * @bond: bonding struct to work on
2103 *
2104 * The state machine handling concept in this module is to check every tick
2105 * which state machine should operate any function. The execution order is
2106 * round robin, so when we have an interaction between state machines, the
2107 * reply of one to each other might be delayed until next tick.
2108 *
2109 * This function also complete the initialization when the agg_select_timer
2110 * times out, and it selects an aggregator for the ports that are yet not
2111 * related to any aggregator, and selects the active aggregator for a bond.
2112 */
2113void bond_3ad_state_machine_handler(struct bonding *bond)
2114{
2115 struct port *port;
2116 struct aggregator *aggregator;
2117
2118 read_lock(&bond->lock);
2119
2120 if (bond->kill_timers) {
2121 goto out;
2122 }
2123
2124 //check if there are any slaves
2125 if (bond->slave_cnt == 0) {
2126 goto re_arm;
2127 }
2128
2129 // check if agg_select_timer timer after initialize is timed out
2130 if (BOND_AD_INFO(bond).agg_select_timer && !(--BOND_AD_INFO(bond).agg_select_timer)) {
2131 // select the active aggregator for the bond
2132 if ((port = __get_first_port(bond))) {
2133 if (!port->slave) {
2134 printk(KERN_WARNING DRV_NAME ": Warning: bond's first port is uninitialized\n");
2135 goto re_arm;
2136 }
2137
2138 aggregator = __get_first_agg(port);
2139 ad_agg_selection_logic(aggregator);
2140 }
2141 }
2142
2143 // for each port run the state machines
2144 for (port = __get_first_port(bond); port; port = __get_next_port(port)) {
2145 if (!port->slave) {
2146 printk(KERN_WARNING DRV_NAME ": Warning: Found an uninitialized port\n");
2147 goto re_arm;
2148 }
2149
2150 ad_rx_machine(NULL, port);
2151 ad_periodic_machine(port);
2152 ad_port_selection_logic(port);
2153 ad_mux_machine(port);
2154 ad_tx_machine(port);
2155
2156 // turn off the BEGIN bit, since we already handled it
2157 if (port->sm_vars & AD_PORT_BEGIN) {
2158 port->sm_vars &= ~AD_PORT_BEGIN;
2159 }
2160 }
2161
2162re_arm:
2163 mod_timer(&(BOND_AD_INFO(bond).ad_timer), jiffies + ad_delta_in_ticks);
2164out:
2165 read_unlock(&bond->lock);
2166}
2167
2168/**
2169 * bond_3ad_rx_indication - handle a received frame
2170 * @lacpdu: received lacpdu
2171 * @slave: slave struct to work on
2172 * @length: length of the data received
2173 *
2174 * It is assumed that frames that were sent on this NIC don't returned as new
2175 * received frames (loopback). Since only the payload is given to this
2176 * function, it check for loopback.
2177 */
2178static void bond_3ad_rx_indication(struct lacpdu *lacpdu, struct slave *slave, u16 length)
2179{
2180 struct port *port;
2181
2182 if (length >= sizeof(struct lacpdu)) {
2183
2184 port = &(SLAVE_AD_INFO(slave).port);
2185
2186 if (!port->slave) {
2187 printk(KERN_WARNING DRV_NAME ": Warning: port of slave %s is uninitialized\n", slave->dev->name);
2188 return;
2189 }
2190
2191 switch (lacpdu->subtype) {
2192 case AD_TYPE_LACPDU:
2193 __ntohs_lacpdu(lacpdu);
2194 dprintk("Received LACPDU on port %d\n", port->actor_port_number);
2195 ad_rx_machine(lacpdu, port);
2196 break;
2197
2198 case AD_TYPE_MARKER:
2199 // No need to convert fields to Little Endian since we don't use the marker's fields.
2200
2201 switch (((struct marker *)lacpdu)->tlv_type) {
2202 case AD_MARKER_INFORMATION_SUBTYPE:
2203 dprintk("Received Marker Information on port %d\n", port->actor_port_number);
2204 ad_marker_info_received((struct marker *)lacpdu, port);
2205 break;
2206
2207 case AD_MARKER_RESPONSE_SUBTYPE:
2208 dprintk("Received Marker Response on port %d\n", port->actor_port_number);
2209 ad_marker_response_received((struct marker *)lacpdu, port);
2210 break;
2211
2212 default:
2213 dprintk("Received an unknown Marker subtype on slot %d\n", port->actor_port_number);
2214 }
2215 }
2216 }
2217}
2218
2219/**
2220 * bond_3ad_adapter_speed_changed - handle a slave's speed change indication
2221 * @slave: slave struct to work on
2222 *
2223 * Handle reselection of aggregator (if needed) for this port.
2224 */
2225void bond_3ad_adapter_speed_changed(struct slave *slave)
2226{
2227 struct port *port;
2228
2229 port = &(SLAVE_AD_INFO(slave).port);
2230
2231 // if slave is null, the whole port is not initialized
2232 if (!port->slave) {
2233 printk(KERN_WARNING DRV_NAME ": Warning: speed changed for uninitialized port on %s\n",
2234 slave->dev->name);
2235 return;
2236 }
2237
2238 port->actor_admin_port_key &= ~AD_SPEED_KEY_BITS;
2239 port->actor_oper_port_key=port->actor_admin_port_key |= (__get_link_speed(port) << 1);
2240 dprintk("Port %d changed speed\n", port->actor_port_number);
2241 // there is no need to reselect a new aggregator, just signal the
2242 // state machines to reinitialize
2243 port->sm_vars |= AD_PORT_BEGIN;
2244}
2245
2246/**
2247 * bond_3ad_adapter_duplex_changed - handle a slave's duplex change indication
2248 * @slave: slave struct to work on
2249 *
2250 * Handle reselection of aggregator (if needed) for this port.
2251 */
2252void bond_3ad_adapter_duplex_changed(struct slave *slave)
2253{
2254 struct port *port;
2255
2256 port=&(SLAVE_AD_INFO(slave).port);
2257
2258 // if slave is null, the whole port is not initialized
2259 if (!port->slave) {
2260 printk(KERN_WARNING DRV_NAME ": Warning: duplex changed for uninitialized port on %s\n",
2261 slave->dev->name);
2262 return;
2263 }
2264
2265 port->actor_admin_port_key &= ~AD_DUPLEX_KEY_BITS;
2266 port->actor_oper_port_key=port->actor_admin_port_key |= __get_duplex(port);
2267 dprintk("Port %d changed duplex\n", port->actor_port_number);
2268 // there is no need to reselect a new aggregator, just signal the
2269 // state machines to reinitialize
2270 port->sm_vars |= AD_PORT_BEGIN;
2271}
2272
2273/**
2274 * bond_3ad_handle_link_change - handle a slave's link status change indication
2275 * @slave: slave struct to work on
2276 * @status: whether the link is now up or down
2277 *
2278 * Handle reselection of aggregator (if needed) for this port.
2279 */
2280void bond_3ad_handle_link_change(struct slave *slave, char link)
2281{
2282 struct port *port;
2283
2284 port = &(SLAVE_AD_INFO(slave).port);
2285
2286 // if slave is null, the whole port is not initialized
2287 if (!port->slave) {
2288 printk(KERN_WARNING DRV_NAME ": Warning: link status changed for uninitialized port on %s\n",
2289 slave->dev->name);
2290 return;
2291 }
2292
2293 // 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)
2294 // on link up we are forcing recheck on the duplex and speed since some of he adaptors(ce1000.lan) report
2295 if (link == BOND_LINK_UP) {
2296 port->is_enabled = 1;
2297 port->actor_admin_port_key &= ~AD_DUPLEX_KEY_BITS;
2298 port->actor_oper_port_key=port->actor_admin_port_key |= __get_duplex(port);
2299 port->actor_admin_port_key &= ~AD_SPEED_KEY_BITS;
2300 port->actor_oper_port_key=port->actor_admin_port_key |= (__get_link_speed(port) << 1);
2301 } else {
2302 /* link has failed */
2303 port->is_enabled = 0;
2304 port->actor_admin_port_key &= ~AD_DUPLEX_KEY_BITS;
2305 port->actor_oper_port_key= (port->actor_admin_port_key &= ~AD_SPEED_KEY_BITS);
2306 }
2307 //BOND_PRINT_DBG(("Port %d changed link status to %s", port->actor_port_number, ((link == BOND_LINK_UP)?"UP":"DOWN")));
2308 // there is no need to reselect a new aggregator, just signal the
2309 // state machines to reinitialize
2310 port->sm_vars |= AD_PORT_BEGIN;
2311}
2312
2313/**
2314 * bond_3ad_get_active_agg_info - get information of the active aggregator
2315 * @bond: bonding struct to work on
2316 * @ad_info: ad_info struct to fill with the bond's info
2317 *
2318 * Returns: 0 on success
2319 * < 0 on error
2320 */
2321int bond_3ad_get_active_agg_info(struct bonding *bond, struct ad_info *ad_info)
2322{
2323 struct aggregator *aggregator = NULL;
2324 struct port *port;
2325
2326 for (port = __get_first_port(bond); port; port = __get_next_port(port)) {
2327 if (port->aggregator && port->aggregator->is_active) {
2328 aggregator = port->aggregator;
2329 break;
2330 }
2331 }
2332
2333 if (aggregator) {
2334 ad_info->aggregator_id = aggregator->aggregator_identifier;
2335 ad_info->ports = aggregator->num_of_ports;
2336 ad_info->actor_key = aggregator->actor_oper_aggregator_key;
2337 ad_info->partner_key = aggregator->partner_oper_aggregator_key;
2338 memcpy(ad_info->partner_system, aggregator->partner_system.mac_addr_value, ETH_ALEN);
2339 return 0;
2340 }
2341
2342 return -1;
2343}
2344
2345int bond_3ad_xmit_xor(struct sk_buff *skb, struct net_device *dev)
2346{
2347 struct slave *slave, *start_at;
2348 struct bonding *bond = dev->priv;
2349 struct ethhdr *data = (struct ethhdr *)skb->data;
2350 int slave_agg_no;
2351 int slaves_in_agg;
2352 int agg_id;
2353 int i;
2354 struct ad_info ad_info;
2355 int res = 1;
2356
2357 /* make sure that the slaves list will
2358 * not change during tx
2359 */
2360 read_lock(&bond->lock);
2361
2362 if (!BOND_IS_OK(bond)) {
2363 goto out;
2364 }
2365
2366 if (bond_3ad_get_active_agg_info(bond, &ad_info)) {
2367 printk(KERN_DEBUG "ERROR: bond_3ad_get_active_agg_info failed\n");
2368 goto out;
2369 }
2370
2371 slaves_in_agg = ad_info.ports;
2372 agg_id = ad_info.aggregator_id;
2373
2374 if (slaves_in_agg == 0) {
2375 /*the aggregator is empty*/
2376 printk(KERN_DEBUG "ERROR: active aggregator is empty\n");
2377 goto out;
2378 }
2379
2380 slave_agg_no = (data->h_dest[5]^bond->dev->dev_addr[5]) % slaves_in_agg;
2381
2382 bond_for_each_slave(bond, slave, i) {
2383 struct aggregator *agg = SLAVE_AD_INFO(slave).port.aggregator;
2384
2385 if (agg && (agg->aggregator_identifier == agg_id)) {
2386 slave_agg_no--;
2387 if (slave_agg_no < 0) {
2388 break;
2389 }
2390 }
2391 }
2392
2393 if (slave_agg_no >= 0) {
2394 printk(KERN_ERR DRV_NAME ": Error: Couldn't find a slave to tx on for aggregator ID %d\n", agg_id);
2395 goto out;
2396 }
2397
2398 start_at = slave;
2399
2400 bond_for_each_slave_from(bond, slave, i, start_at) {
2401 int slave_agg_id = 0;
2402 struct aggregator *agg = SLAVE_AD_INFO(slave).port.aggregator;
2403
2404 if (agg) {
2405 slave_agg_id = agg->aggregator_identifier;
2406 }
2407
2408 if (SLAVE_IS_OK(slave) && agg && (slave_agg_id == agg_id)) {
2409 res = bond_dev_queue_xmit(bond, skb, slave->dev);
2410 break;
2411 }
2412 }
2413
2414out:
2415 if (res) {
2416 /* no suitable interface, frame not sent */
2417 dev_kfree_skb(skb);
2418 }
2419 read_unlock(&bond->lock);
2420 return 0;
2421}
2422
2423int bond_3ad_lacpdu_recv(struct sk_buff *skb, struct net_device *dev, struct packet_type* ptype)
2424{
2425 struct bonding *bond = dev->priv;
2426 struct slave *slave = NULL;
2427 int ret = NET_RX_DROP;
2428
2429 if (!(dev->flags & IFF_MASTER)) {
2430 goto out;
2431 }
2432
2433 read_lock(&bond->lock);
2434 slave = bond_get_slave_by_dev((struct bonding *)dev->priv,
2435 skb->real_dev);
2436 if (slave == NULL) {
2437 goto out_unlock;
2438 }
2439
2440 bond_3ad_rx_indication((struct lacpdu *) skb->data, slave, skb->len);
2441
2442 ret = NET_RX_SUCCESS;
2443
2444out_unlock:
2445 read_unlock(&bond->lock);
2446out:
2447 dev_kfree_skb(skb);
2448
2449 return ret;
2450}
2451
generated by cgit v1.2.2 (git 2.25.0) at 2024-12-24 05:52:48 -0500