1
2
3
4
5
6#include <linux/skbuff.h>
7#include <linux/netdevice.h>
8#include <linux/etherdevice.h>
9#include <linux/pkt_sched.h>
10#include <linux/spinlock.h>
11#include <linux/slab.h>
12#include <linux/timer.h>
13#include <linux/ip.h>
14#include <linux/ipv6.h>
15#include <linux/if_arp.h>
16#include <linux/if_ether.h>
17#include <linux/if_bonding.h>
18#include <linux/if_vlan.h>
19#include <linux/in.h>
20#include <net/arp.h>
21#include <net/ipv6.h>
22#include <asm/byteorder.h>
23#include <net/bonding.h>
24#include <net/bond_alb.h>
25
26static const u8 mac_v6_allmcast[ETH_ALEN + 2] __long_aligned = {
27 0x33, 0x33, 0x00, 0x00, 0x00, 0x01
28};
29static const int alb_delta_in_ticks = HZ / ALB_TIMER_TICKS_PER_SEC;
30
31#pragma pack(1)
32struct learning_pkt {
33 u8 mac_dst[ETH_ALEN];
34 u8 mac_src[ETH_ALEN];
35 __be16 type;
36 u8 padding[ETH_ZLEN - ETH_HLEN];
37};
38
39struct arp_pkt {
40 __be16 hw_addr_space;
41 __be16 prot_addr_space;
42 u8 hw_addr_len;
43 u8 prot_addr_len;
44 __be16 op_code;
45 u8 mac_src[ETH_ALEN];
46 __be32 ip_src;
47 u8 mac_dst[ETH_ALEN];
48 __be32 ip_dst;
49};
50#pragma pack()
51
52
53static void alb_send_learning_packets(struct slave *slave, u8 mac_addr[],
54 bool strict_match);
55static void rlb_purge_src_ip(struct bonding *bond, struct arp_pkt *arp);
56static void rlb_src_unlink(struct bonding *bond, u32 index);
57static void rlb_src_link(struct bonding *bond, u32 ip_src_hash,
58 u32 ip_dst_hash);
59
60static inline u8 _simple_hash(const u8 *hash_start, int hash_size)
61{
62 int i;
63 u8 hash = 0;
64
65 for (i = 0; i < hash_size; i++)
66 hash ^= hash_start[i];
67
68 return hash;
69}
70
71
72
73static inline void tlb_init_table_entry(struct tlb_client_info *entry, int save_load)
74{
75 if (save_load) {
76 entry->load_history = 1 + entry->tx_bytes /
77 BOND_TLB_REBALANCE_INTERVAL;
78 entry->tx_bytes = 0;
79 }
80
81 entry->tx_slave = NULL;
82 entry->next = TLB_NULL_INDEX;
83 entry->prev = TLB_NULL_INDEX;
84}
85
86static inline void tlb_init_slave(struct slave *slave)
87{
88 SLAVE_TLB_INFO(slave).load = 0;
89 SLAVE_TLB_INFO(slave).head = TLB_NULL_INDEX;
90}
91
92static void __tlb_clear_slave(struct bonding *bond, struct slave *slave,
93 int save_load)
94{
95 struct tlb_client_info *tx_hash_table;
96 u32 index;
97
98
99 tx_hash_table = BOND_ALB_INFO(bond).tx_hashtbl;
100
101
102 if (tx_hash_table) {
103 index = SLAVE_TLB_INFO(slave).head;
104 while (index != TLB_NULL_INDEX) {
105 u32 next_index = tx_hash_table[index].next;
106
107 tlb_init_table_entry(&tx_hash_table[index], save_load);
108 index = next_index;
109 }
110 }
111
112 tlb_init_slave(slave);
113}
114
115static void tlb_clear_slave(struct bonding *bond, struct slave *slave,
116 int save_load)
117{
118 spin_lock_bh(&bond->mode_lock);
119 __tlb_clear_slave(bond, slave, save_load);
120 spin_unlock_bh(&bond->mode_lock);
121}
122
123
124static int tlb_initialize(struct bonding *bond)
125{
126 struct alb_bond_info *bond_info = &(BOND_ALB_INFO(bond));
127 int size = TLB_HASH_TABLE_SIZE * sizeof(struct tlb_client_info);
128 struct tlb_client_info *new_hashtbl;
129 int i;
130
131 new_hashtbl = kzalloc(size, GFP_KERNEL);
132 if (!new_hashtbl)
133 return -ENOMEM;
134
135 spin_lock_bh(&bond->mode_lock);
136
137 bond_info->tx_hashtbl = new_hashtbl;
138
139 for (i = 0; i < TLB_HASH_TABLE_SIZE; i++)
140 tlb_init_table_entry(&bond_info->tx_hashtbl[i], 0);
141
142 spin_unlock_bh(&bond->mode_lock);
143
144 return 0;
145}
146
147
148static void tlb_deinitialize(struct bonding *bond)
149{
150 struct alb_bond_info *bond_info = &(BOND_ALB_INFO(bond));
151
152 spin_lock_bh(&bond->mode_lock);
153
154 kfree(bond_info->tx_hashtbl);
155 bond_info->tx_hashtbl = NULL;
156
157 spin_unlock_bh(&bond->mode_lock);
158}
159
160static long long compute_gap(struct slave *slave)
161{
162 return (s64) (slave->speed << 20) -
163 (s64) (SLAVE_TLB_INFO(slave).load << 3);
164}
165
166static struct slave *tlb_get_least_loaded_slave(struct bonding *bond)
167{
168 struct slave *slave, *least_loaded;
169 struct list_head *iter;
170 long long max_gap;
171
172 least_loaded = NULL;
173 max_gap = LLONG_MIN;
174
175
176 bond_for_each_slave_rcu(bond, slave, iter) {
177 if (bond_slave_can_tx(slave)) {
178 long long gap = compute_gap(slave);
179
180 if (max_gap < gap) {
181 least_loaded = slave;
182 max_gap = gap;
183 }
184 }
185 }
186
187 return least_loaded;
188}
189
190static struct slave *__tlb_choose_channel(struct bonding *bond, u32 hash_index,
191 u32 skb_len)
192{
193 struct alb_bond_info *bond_info = &(BOND_ALB_INFO(bond));
194 struct tlb_client_info *hash_table;
195 struct slave *assigned_slave;
196
197 hash_table = bond_info->tx_hashtbl;
198 assigned_slave = hash_table[hash_index].tx_slave;
199 if (!assigned_slave) {
200 assigned_slave = tlb_get_least_loaded_slave(bond);
201
202 if (assigned_slave) {
203 struct tlb_slave_info *slave_info =
204 &(SLAVE_TLB_INFO(assigned_slave));
205 u32 next_index = slave_info->head;
206
207 hash_table[hash_index].tx_slave = assigned_slave;
208 hash_table[hash_index].next = next_index;
209 hash_table[hash_index].prev = TLB_NULL_INDEX;
210
211 if (next_index != TLB_NULL_INDEX)
212 hash_table[next_index].prev = hash_index;
213
214 slave_info->head = hash_index;
215 slave_info->load +=
216 hash_table[hash_index].load_history;
217 }
218 }
219
220 if (assigned_slave)
221 hash_table[hash_index].tx_bytes += skb_len;
222
223 return assigned_slave;
224}
225
226static struct slave *tlb_choose_channel(struct bonding *bond, u32 hash_index,
227 u32 skb_len)
228{
229 struct slave *tx_slave;
230
231
232
233
234
235 spin_lock(&bond->mode_lock);
236 tx_slave = __tlb_choose_channel(bond, hash_index, skb_len);
237 spin_unlock(&bond->mode_lock);
238
239 return tx_slave;
240}
241
242
243
244
245
246
247static void rlb_update_entry_from_arp(struct bonding *bond, struct arp_pkt *arp)
248{
249 struct alb_bond_info *bond_info = &(BOND_ALB_INFO(bond));
250 struct rlb_client_info *client_info;
251 u32 hash_index;
252
253 spin_lock_bh(&bond->mode_lock);
254
255 hash_index = _simple_hash((u8 *)&(arp->ip_src), sizeof(arp->ip_src));
256 client_info = &(bond_info->rx_hashtbl[hash_index]);
257
258 if ((client_info->assigned) &&
259 (client_info->ip_src == arp->ip_dst) &&
260 (client_info->ip_dst == arp->ip_src) &&
261 (!ether_addr_equal_64bits(client_info->mac_dst, arp->mac_src))) {
262
263 ether_addr_copy(client_info->mac_dst, arp->mac_src);
264 client_info->ntt = 1;
265 bond_info->rx_ntt = 1;
266 }
267
268 spin_unlock_bh(&bond->mode_lock);
269}
270
271static int rlb_arp_recv(const struct sk_buff *skb, struct bonding *bond,
272 struct slave *slave)
273{
274 struct arp_pkt *arp, _arp;
275
276 if (skb->protocol != cpu_to_be16(ETH_P_ARP))
277 goto out;
278
279 arp = skb_header_pointer(skb, 0, sizeof(_arp), &_arp);
280 if (!arp)
281 goto out;
282
283
284
285
286
287
288
289
290
291
292
293 rlb_purge_src_ip(bond, arp);
294
295 if (arp->op_code == htons(ARPOP_REPLY)) {
296
297 rlb_update_entry_from_arp(bond, arp);
298 slave_dbg(bond->dev, slave->dev, "Server received an ARP Reply from client\n");
299 }
300out:
301 return RX_HANDLER_ANOTHER;
302}
303
304
305static struct slave *__rlb_next_rx_slave(struct bonding *bond)
306{
307 struct alb_bond_info *bond_info = &(BOND_ALB_INFO(bond));
308 struct slave *before = NULL, *rx_slave = NULL, *slave;
309 struct list_head *iter;
310 bool found = false;
311
312 bond_for_each_slave_rcu(bond, slave, iter) {
313 if (!bond_slave_can_tx(slave))
314 continue;
315 if (!found) {
316 if (!before || before->speed < slave->speed)
317 before = slave;
318 } else {
319 if (!rx_slave || rx_slave->speed < slave->speed)
320 rx_slave = slave;
321 }
322 if (slave == bond_info->rx_slave)
323 found = true;
324 }
325
326
327
328 if (!rx_slave || (before && rx_slave->speed < before->speed))
329 rx_slave = before;
330
331 if (rx_slave)
332 bond_info->rx_slave = rx_slave;
333
334 return rx_slave;
335}
336
337
338static struct slave *rlb_next_rx_slave(struct bonding *bond)
339{
340 struct slave *rx_slave;
341
342 ASSERT_RTNL();
343
344 rcu_read_lock();
345 rx_slave = __rlb_next_rx_slave(bond);
346 rcu_read_unlock();
347
348 return rx_slave;
349}
350
351
352
353
354
355
356static void rlb_teach_disabled_mac_on_primary(struct bonding *bond, u8 addr[])
357{
358 struct slave *curr_active = rtnl_dereference(bond->curr_active_slave);
359
360 if (!curr_active)
361 return;
362
363 if (!bond->alb_info.primary_is_promisc) {
364 if (!dev_set_promiscuity(curr_active->dev, 1))
365 bond->alb_info.primary_is_promisc = 1;
366 else
367 bond->alb_info.primary_is_promisc = 0;
368 }
369
370 bond->alb_info.rlb_promisc_timeout_counter = 0;
371
372 alb_send_learning_packets(curr_active, addr, true);
373}
374
375
376
377
378
379static void rlb_clear_slave(struct bonding *bond, struct slave *slave)
380{
381 struct alb_bond_info *bond_info = &(BOND_ALB_INFO(bond));
382 struct rlb_client_info *rx_hash_table;
383 u32 index, next_index;
384
385
386 spin_lock_bh(&bond->mode_lock);
387
388 rx_hash_table = bond_info->rx_hashtbl;
389 index = bond_info->rx_hashtbl_used_head;
390 for (; index != RLB_NULL_INDEX; index = next_index) {
391 next_index = rx_hash_table[index].used_next;
392 if (rx_hash_table[index].slave == slave) {
393 struct slave *assigned_slave = rlb_next_rx_slave(bond);
394
395 if (assigned_slave) {
396 rx_hash_table[index].slave = assigned_slave;
397 if (is_valid_ether_addr(rx_hash_table[index].mac_dst)) {
398 bond_info->rx_hashtbl[index].ntt = 1;
399 bond_info->rx_ntt = 1;
400
401
402
403
404
405
406
407 bond_info->rlb_update_retry_counter =
408 RLB_UPDATE_RETRY;
409 }
410 } else {
411 rx_hash_table[index].slave = NULL;
412 }
413 }
414 }
415
416 spin_unlock_bh(&bond->mode_lock);
417
418 if (slave != rtnl_dereference(bond->curr_active_slave))
419 rlb_teach_disabled_mac_on_primary(bond, slave->dev->dev_addr);
420}
421
422static void rlb_update_client(struct rlb_client_info *client_info)
423{
424 int i;
425
426 if (!client_info->slave || !is_valid_ether_addr(client_info->mac_dst))
427 return;
428
429 for (i = 0; i < RLB_ARP_BURST_SIZE; i++) {
430 struct sk_buff *skb;
431
432 skb = arp_create(ARPOP_REPLY, ETH_P_ARP,
433 client_info->ip_dst,
434 client_info->slave->dev,
435 client_info->ip_src,
436 client_info->mac_dst,
437 client_info->slave->dev->dev_addr,
438 client_info->mac_dst);
439 if (!skb) {
440 slave_err(client_info->slave->bond->dev,
441 client_info->slave->dev,
442 "failed to create an ARP packet\n");
443 continue;
444 }
445
446 skb->dev = client_info->slave->dev;
447
448 if (client_info->vlan_id) {
449 __vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q),
450 client_info->vlan_id);
451 }
452
453 arp_xmit(skb);
454 }
455}
456
457
458static void rlb_update_rx_clients(struct bonding *bond)
459{
460 struct alb_bond_info *bond_info = &(BOND_ALB_INFO(bond));
461 struct rlb_client_info *client_info;
462 u32 hash_index;
463
464 spin_lock_bh(&bond->mode_lock);
465
466 hash_index = bond_info->rx_hashtbl_used_head;
467 for (; hash_index != RLB_NULL_INDEX;
468 hash_index = client_info->used_next) {
469 client_info = &(bond_info->rx_hashtbl[hash_index]);
470 if (client_info->ntt) {
471 rlb_update_client(client_info);
472 if (bond_info->rlb_update_retry_counter == 0)
473 client_info->ntt = 0;
474 }
475 }
476
477
478
479
480 bond_info->rlb_update_delay_counter = RLB_UPDATE_DELAY;
481
482 spin_unlock_bh(&bond->mode_lock);
483}
484
485
486static void rlb_req_update_slave_clients(struct bonding *bond, struct slave *slave)
487{
488 struct alb_bond_info *bond_info = &(BOND_ALB_INFO(bond));
489 struct rlb_client_info *client_info;
490 int ntt = 0;
491 u32 hash_index;
492
493 spin_lock_bh(&bond->mode_lock);
494
495 hash_index = bond_info->rx_hashtbl_used_head;
496 for (; hash_index != RLB_NULL_INDEX;
497 hash_index = client_info->used_next) {
498 client_info = &(bond_info->rx_hashtbl[hash_index]);
499
500 if ((client_info->slave == slave) &&
501 is_valid_ether_addr(client_info->mac_dst)) {
502 client_info->ntt = 1;
503 ntt = 1;
504 }
505 }
506
507
508 if (ntt) {
509 bond_info->rx_ntt = 1;
510
511 bond_info->rlb_update_retry_counter = RLB_UPDATE_RETRY;
512 }
513
514 spin_unlock_bh(&bond->mode_lock);
515}
516
517
518static void rlb_req_update_subnet_clients(struct bonding *bond, __be32 src_ip)
519{
520 struct alb_bond_info *bond_info = &(BOND_ALB_INFO(bond));
521 struct rlb_client_info *client_info;
522 u32 hash_index;
523
524 spin_lock(&bond->mode_lock);
525
526 hash_index = bond_info->rx_hashtbl_used_head;
527 for (; hash_index != RLB_NULL_INDEX;
528 hash_index = client_info->used_next) {
529 client_info = &(bond_info->rx_hashtbl[hash_index]);
530
531 if (!client_info->slave) {
532 netdev_err(bond->dev, "found a client with no channel in the client's hash table\n");
533 continue;
534 }
535
536
537
538
539 if ((client_info->ip_src == src_ip) &&
540 !ether_addr_equal_64bits(client_info->slave->dev->dev_addr,
541 bond->dev->dev_addr) &&
542 is_valid_ether_addr(client_info->mac_dst)) {
543 client_info->ntt = 1;
544 bond_info->rx_ntt = 1;
545 }
546 }
547
548 spin_unlock(&bond->mode_lock);
549}
550
551static struct slave *rlb_choose_channel(struct sk_buff *skb,
552 struct bonding *bond,
553 const struct arp_pkt *arp)
554{
555 struct alb_bond_info *bond_info = &(BOND_ALB_INFO(bond));
556 struct slave *assigned_slave, *curr_active_slave;
557 struct rlb_client_info *client_info;
558 u32 hash_index = 0;
559
560 spin_lock(&bond->mode_lock);
561
562 curr_active_slave = rcu_dereference(bond->curr_active_slave);
563
564 hash_index = _simple_hash((u8 *)&arp->ip_dst, sizeof(arp->ip_dst));
565 client_info = &(bond_info->rx_hashtbl[hash_index]);
566
567 if (client_info->assigned) {
568 if ((client_info->ip_src == arp->ip_src) &&
569 (client_info->ip_dst == arp->ip_dst)) {
570
571 if (!is_broadcast_ether_addr(arp->mac_dst)) {
572
573 ether_addr_copy(client_info->mac_dst, arp->mac_dst);
574 }
575 ether_addr_copy(client_info->mac_src, arp->mac_src);
576
577 assigned_slave = client_info->slave;
578 if (assigned_slave) {
579 spin_unlock(&bond->mode_lock);
580 return assigned_slave;
581 }
582 } else {
583
584
585
586
587 if (curr_active_slave &&
588 client_info->slave != curr_active_slave) {
589 client_info->slave = curr_active_slave;
590 rlb_update_client(client_info);
591 }
592 }
593 }
594
595 assigned_slave = __rlb_next_rx_slave(bond);
596
597 if (assigned_slave) {
598 if (!(client_info->assigned &&
599 client_info->ip_src == arp->ip_src)) {
600
601
602
603 u32 hash_src = _simple_hash((u8 *)&arp->ip_src,
604 sizeof(arp->ip_src));
605 rlb_src_unlink(bond, hash_index);
606 rlb_src_link(bond, hash_src, hash_index);
607 }
608
609 client_info->ip_src = arp->ip_src;
610 client_info->ip_dst = arp->ip_dst;
611
612
613
614
615 ether_addr_copy(client_info->mac_dst, arp->mac_dst);
616 ether_addr_copy(client_info->mac_src, arp->mac_src);
617 client_info->slave = assigned_slave;
618
619 if (is_valid_ether_addr(client_info->mac_dst)) {
620 client_info->ntt = 1;
621 bond->alb_info.rx_ntt = 1;
622 } else {
623 client_info->ntt = 0;
624 }
625
626 if (vlan_get_tag(skb, &client_info->vlan_id))
627 client_info->vlan_id = 0;
628
629 if (!client_info->assigned) {
630 u32 prev_tbl_head = bond_info->rx_hashtbl_used_head;
631
632 bond_info->rx_hashtbl_used_head = hash_index;
633 client_info->used_next = prev_tbl_head;
634 if (prev_tbl_head != RLB_NULL_INDEX) {
635 bond_info->rx_hashtbl[prev_tbl_head].used_prev =
636 hash_index;
637 }
638 client_info->assigned = 1;
639 }
640 }
641
642 spin_unlock(&bond->mode_lock);
643
644 return assigned_slave;
645}
646
647
648
649
650
651static struct slave *rlb_arp_xmit(struct sk_buff *skb, struct bonding *bond)
652{
653 struct slave *tx_slave = NULL;
654 struct arp_pkt *arp;
655
656 if (!pskb_network_may_pull(skb, sizeof(*arp)))
657 return NULL;
658 arp = (struct arp_pkt *)skb_network_header(skb);
659
660
661
662
663 if (!bond_slave_has_mac_rx(bond, arp->mac_src))
664 return NULL;
665
666 if (arp->op_code == htons(ARPOP_REPLY)) {
667
668 tx_slave = rlb_choose_channel(skb, bond, arp);
669 if (tx_slave)
670 bond_hw_addr_copy(arp->mac_src, tx_slave->dev->dev_addr,
671 tx_slave->dev->addr_len);
672 netdev_dbg(bond->dev, "(slave %s): Server sent ARP Reply packet\n",
673 tx_slave ? tx_slave->dev->name : "NULL");
674 } else if (arp->op_code == htons(ARPOP_REQUEST)) {
675
676
677
678
679
680 tx_slave = rlb_choose_channel(skb, bond, arp);
681
682
683
684
685 bond->alb_info.rlb_update_delay_counter = RLB_UPDATE_DELAY;
686
687
688
689
690
691
692 rlb_req_update_subnet_clients(bond, arp->ip_src);
693 netdev_dbg(bond->dev, "(slave %s): Server sent ARP Request packet\n",
694 tx_slave ? tx_slave->dev->name : "NULL");
695 }
696
697 return tx_slave;
698}
699
700static void rlb_rebalance(struct bonding *bond)
701{
702 struct alb_bond_info *bond_info = &(BOND_ALB_INFO(bond));
703 struct slave *assigned_slave;
704 struct rlb_client_info *client_info;
705 int ntt;
706 u32 hash_index;
707
708 spin_lock_bh(&bond->mode_lock);
709
710 ntt = 0;
711 hash_index = bond_info->rx_hashtbl_used_head;
712 for (; hash_index != RLB_NULL_INDEX;
713 hash_index = client_info->used_next) {
714 client_info = &(bond_info->rx_hashtbl[hash_index]);
715 assigned_slave = __rlb_next_rx_slave(bond);
716 if (assigned_slave && (client_info->slave != assigned_slave)) {
717 client_info->slave = assigned_slave;
718 if (!is_zero_ether_addr(client_info->mac_dst)) {
719 client_info->ntt = 1;
720 ntt = 1;
721 }
722 }
723 }
724
725
726 if (ntt)
727 bond_info->rx_ntt = 1;
728 spin_unlock_bh(&bond->mode_lock);
729}
730
731
732static void rlb_init_table_entry_dst(struct rlb_client_info *entry)
733{
734 entry->used_next = RLB_NULL_INDEX;
735 entry->used_prev = RLB_NULL_INDEX;
736 entry->assigned = 0;
737 entry->slave = NULL;
738 entry->vlan_id = 0;
739}
740static void rlb_init_table_entry_src(struct rlb_client_info *entry)
741{
742 entry->src_first = RLB_NULL_INDEX;
743 entry->src_prev = RLB_NULL_INDEX;
744 entry->src_next = RLB_NULL_INDEX;
745}
746
747static void rlb_init_table_entry(struct rlb_client_info *entry)
748{
749 memset(entry, 0, sizeof(struct rlb_client_info));
750 rlb_init_table_entry_dst(entry);
751 rlb_init_table_entry_src(entry);
752}
753
754static void rlb_delete_table_entry_dst(struct bonding *bond, u32 index)
755{
756 struct alb_bond_info *bond_info = &(BOND_ALB_INFO(bond));
757 u32 next_index = bond_info->rx_hashtbl[index].used_next;
758 u32 prev_index = bond_info->rx_hashtbl[index].used_prev;
759
760 if (index == bond_info->rx_hashtbl_used_head)
761 bond_info->rx_hashtbl_used_head = next_index;
762 if (prev_index != RLB_NULL_INDEX)
763 bond_info->rx_hashtbl[prev_index].used_next = next_index;
764 if (next_index != RLB_NULL_INDEX)
765 bond_info->rx_hashtbl[next_index].used_prev = prev_index;
766}
767
768
769static void rlb_src_unlink(struct bonding *bond, u32 index)
770{
771 struct alb_bond_info *bond_info = &(BOND_ALB_INFO(bond));
772 u32 next_index = bond_info->rx_hashtbl[index].src_next;
773 u32 prev_index = bond_info->rx_hashtbl[index].src_prev;
774
775 bond_info->rx_hashtbl[index].src_next = RLB_NULL_INDEX;
776 bond_info->rx_hashtbl[index].src_prev = RLB_NULL_INDEX;
777
778 if (next_index != RLB_NULL_INDEX)
779 bond_info->rx_hashtbl[next_index].src_prev = prev_index;
780
781 if (prev_index == RLB_NULL_INDEX)
782 return;
783
784
785 if (bond_info->rx_hashtbl[prev_index].src_first == index)
786 bond_info->rx_hashtbl[prev_index].src_first = next_index;
787 else
788 bond_info->rx_hashtbl[prev_index].src_next = next_index;
789
790}
791
792static void rlb_delete_table_entry(struct bonding *bond, u32 index)
793{
794 struct alb_bond_info *bond_info = &(BOND_ALB_INFO(bond));
795 struct rlb_client_info *entry = &(bond_info->rx_hashtbl[index]);
796
797 rlb_delete_table_entry_dst(bond, index);
798 rlb_init_table_entry_dst(entry);
799
800 rlb_src_unlink(bond, index);
801}
802
803
804
805
806static void rlb_src_link(struct bonding *bond, u32 ip_src_hash, u32 ip_dst_hash)
807{
808 struct alb_bond_info *bond_info = &(BOND_ALB_INFO(bond));
809 u32 next;
810
811 bond_info->rx_hashtbl[ip_dst_hash].src_prev = ip_src_hash;
812 next = bond_info->rx_hashtbl[ip_src_hash].src_first;
813 bond_info->rx_hashtbl[ip_dst_hash].src_next = next;
814 if (next != RLB_NULL_INDEX)
815 bond_info->rx_hashtbl[next].src_prev = ip_dst_hash;
816 bond_info->rx_hashtbl[ip_src_hash].src_first = ip_dst_hash;
817}
818
819
820
821
822static void rlb_purge_src_ip(struct bonding *bond, struct arp_pkt *arp)
823{
824 struct alb_bond_info *bond_info = &(BOND_ALB_INFO(bond));
825 u32 ip_src_hash = _simple_hash((u8 *)&(arp->ip_src), sizeof(arp->ip_src));
826 u32 index;
827
828 spin_lock_bh(&bond->mode_lock);
829
830 index = bond_info->rx_hashtbl[ip_src_hash].src_first;
831 while (index != RLB_NULL_INDEX) {
832 struct rlb_client_info *entry = &(bond_info->rx_hashtbl[index]);
833 u32 next_index = entry->src_next;
834
835 if (entry->ip_src == arp->ip_src &&
836 !ether_addr_equal_64bits(arp->mac_src, entry->mac_src))
837 rlb_delete_table_entry(bond, index);
838 index = next_index;
839 }
840 spin_unlock_bh(&bond->mode_lock);
841}
842
843static int rlb_initialize(struct bonding *bond)
844{
845 struct alb_bond_info *bond_info = &(BOND_ALB_INFO(bond));
846 struct rlb_client_info *new_hashtbl;
847 int size = RLB_HASH_TABLE_SIZE * sizeof(struct rlb_client_info);
848 int i;
849
850 new_hashtbl = kmalloc(size, GFP_KERNEL);
851 if (!new_hashtbl)
852 return -1;
853
854 spin_lock_bh(&bond->mode_lock);
855
856 bond_info->rx_hashtbl = new_hashtbl;
857
858 bond_info->rx_hashtbl_used_head = RLB_NULL_INDEX;
859
860 for (i = 0; i < RLB_HASH_TABLE_SIZE; i++)
861 rlb_init_table_entry(bond_info->rx_hashtbl + i);
862
863 spin_unlock_bh(&bond->mode_lock);
864
865
866 bond->recv_probe = rlb_arp_recv;
867
868 return 0;
869}
870
871static void rlb_deinitialize(struct bonding *bond)
872{
873 struct alb_bond_info *bond_info = &(BOND_ALB_INFO(bond));
874
875 spin_lock_bh(&bond->mode_lock);
876
877 kfree(bond_info->rx_hashtbl);
878 bond_info->rx_hashtbl = NULL;
879 bond_info->rx_hashtbl_used_head = RLB_NULL_INDEX;
880
881 spin_unlock_bh(&bond->mode_lock);
882}
883
884static void rlb_clear_vlan(struct bonding *bond, unsigned short vlan_id)
885{
886 struct alb_bond_info *bond_info = &(BOND_ALB_INFO(bond));
887 u32 curr_index;
888
889 spin_lock_bh(&bond->mode_lock);
890
891 curr_index = bond_info->rx_hashtbl_used_head;
892 while (curr_index != RLB_NULL_INDEX) {
893 struct rlb_client_info *curr = &(bond_info->rx_hashtbl[curr_index]);
894 u32 next_index = bond_info->rx_hashtbl[curr_index].used_next;
895
896 if (curr->vlan_id == vlan_id)
897 rlb_delete_table_entry(bond, curr_index);
898
899 curr_index = next_index;
900 }
901
902 spin_unlock_bh(&bond->mode_lock);
903}
904
905
906
907static void alb_send_lp_vid(struct slave *slave, u8 mac_addr[],
908 __be16 vlan_proto, u16 vid)
909{
910 struct learning_pkt pkt;
911 struct sk_buff *skb;
912 int size = sizeof(struct learning_pkt);
913
914 memset(&pkt, 0, size);
915 ether_addr_copy(pkt.mac_dst, mac_addr);
916 ether_addr_copy(pkt.mac_src, mac_addr);
917 pkt.type = cpu_to_be16(ETH_P_LOOPBACK);
918
919 skb = dev_alloc_skb(size);
920 if (!skb)
921 return;
922
923 skb_put_data(skb, &pkt, size);
924
925 skb_reset_mac_header(skb);
926 skb->network_header = skb->mac_header + ETH_HLEN;
927 skb->protocol = pkt.type;
928 skb->priority = TC_PRIO_CONTROL;
929 skb->dev = slave->dev;
930
931 slave_dbg(slave->bond->dev, slave->dev,
932 "Send learning packet: mac %pM vlan %d\n", mac_addr, vid);
933
934 if (vid)
935 __vlan_hwaccel_put_tag(skb, vlan_proto, vid);
936
937 dev_queue_xmit(skb);
938}
939
940struct alb_walk_data {
941 struct bonding *bond;
942 struct slave *slave;
943 u8 *mac_addr;
944 bool strict_match;
945};
946
947static int alb_upper_dev_walk(struct net_device *upper,
948 struct netdev_nested_priv *priv)
949{
950 struct alb_walk_data *data = (struct alb_walk_data *)priv->data;
951 bool strict_match = data->strict_match;
952 struct bonding *bond = data->bond;
953 struct slave *slave = data->slave;
954 u8 *mac_addr = data->mac_addr;
955 struct bond_vlan_tag *tags;
956
957 if (is_vlan_dev(upper) &&
958 bond->dev->lower_level == upper->lower_level - 1) {
959 if (upper->addr_assign_type == NET_ADDR_STOLEN) {
960 alb_send_lp_vid(slave, mac_addr,
961 vlan_dev_vlan_proto(upper),
962 vlan_dev_vlan_id(upper));
963 } else {
964 alb_send_lp_vid(slave, upper->dev_addr,
965 vlan_dev_vlan_proto(upper),
966 vlan_dev_vlan_id(upper));
967 }
968 }
969
970
971
972
973 if (netif_is_macvlan(upper) && !strict_match) {
974 tags = bond_verify_device_path(bond->dev, upper, 0);
975 if (IS_ERR_OR_NULL(tags))
976 BUG();
977 alb_send_lp_vid(slave, upper->dev_addr,
978 tags[0].vlan_proto, tags[0].vlan_id);
979 kfree(tags);
980 }
981
982 return 0;
983}
984
985static void alb_send_learning_packets(struct slave *slave, u8 mac_addr[],
986 bool strict_match)
987{
988 struct bonding *bond = bond_get_bond_by_slave(slave);
989 struct netdev_nested_priv priv;
990 struct alb_walk_data data = {
991 .strict_match = strict_match,
992 .mac_addr = mac_addr,
993 .slave = slave,
994 .bond = bond,
995 };
996
997 priv.data = (void *)&data;
998
999 alb_send_lp_vid(slave, mac_addr, 0, 0);
1000
1001
1002
1003
1004 rcu_read_lock();
1005 netdev_walk_all_upper_dev_rcu(bond->dev, alb_upper_dev_walk, &priv);
1006 rcu_read_unlock();
1007}
1008
1009static int alb_set_slave_mac_addr(struct slave *slave, u8 addr[],
1010 unsigned int len)
1011{
1012 struct net_device *dev = slave->dev;
1013 struct sockaddr_storage ss;
1014
1015 if (BOND_MODE(slave->bond) == BOND_MODE_TLB) {
1016 memcpy(dev->dev_addr, addr, len);
1017 return 0;
1018 }
1019
1020
1021
1022
1023 memcpy(ss.__data, addr, len);
1024 ss.ss_family = dev->type;
1025 if (dev_set_mac_address(dev, (struct sockaddr *)&ss, NULL)) {
1026 slave_err(slave->bond->dev, dev, "dev_set_mac_address on slave failed! ALB mode requires that the base driver support setting the hw address also when the network device's interface is open\n");
1027 return -EOPNOTSUPP;
1028 }
1029 return 0;
1030}
1031
1032
1033
1034
1035
1036static void alb_swap_mac_addr(struct slave *slave1, struct slave *slave2)
1037{
1038 u8 tmp_mac_addr[MAX_ADDR_LEN];
1039
1040 bond_hw_addr_copy(tmp_mac_addr, slave1->dev->dev_addr,
1041 slave1->dev->addr_len);
1042 alb_set_slave_mac_addr(slave1, slave2->dev->dev_addr,
1043 slave2->dev->addr_len);
1044 alb_set_slave_mac_addr(slave2, tmp_mac_addr,
1045 slave1->dev->addr_len);
1046
1047}
1048
1049
1050
1051
1052
1053static void alb_fasten_mac_swap(struct bonding *bond, struct slave *slave1,
1054 struct slave *slave2)
1055{
1056 int slaves_state_differ = (bond_slave_can_tx(slave1) != bond_slave_can_tx(slave2));
1057 struct slave *disabled_slave = NULL;
1058
1059 ASSERT_RTNL();
1060
1061
1062 if (bond_slave_can_tx(slave1)) {
1063 alb_send_learning_packets(slave1, slave1->dev->dev_addr, false);
1064 if (bond->alb_info.rlb_enabled) {
1065
1066
1067
1068 rlb_req_update_slave_clients(bond, slave1);
1069 }
1070 } else {
1071 disabled_slave = slave1;
1072 }
1073
1074 if (bond_slave_can_tx(slave2)) {
1075 alb_send_learning_packets(slave2, slave2->dev->dev_addr, false);
1076 if (bond->alb_info.rlb_enabled) {
1077
1078
1079
1080 rlb_req_update_slave_clients(bond, slave2);
1081 }
1082 } else {
1083 disabled_slave = slave2;
1084 }
1085
1086 if (bond->alb_info.rlb_enabled && slaves_state_differ) {
1087
1088 rlb_teach_disabled_mac_on_primary(bond,
1089 disabled_slave->dev->dev_addr);
1090 }
1091}
1092
1093
1094
1095
1096
1097
1098
1099
1100
1101
1102
1103
1104
1105
1106
1107static void alb_change_hw_addr_on_detach(struct bonding *bond, struct slave *slave)
1108{
1109 int perm_curr_diff;
1110 int perm_bond_diff;
1111 struct slave *found_slave;
1112
1113 perm_curr_diff = !ether_addr_equal_64bits(slave->perm_hwaddr,
1114 slave->dev->dev_addr);
1115 perm_bond_diff = !ether_addr_equal_64bits(slave->perm_hwaddr,
1116 bond->dev->dev_addr);
1117
1118 if (perm_curr_diff && perm_bond_diff) {
1119 found_slave = bond_slave_has_mac(bond, slave->perm_hwaddr);
1120
1121 if (found_slave) {
1122 alb_swap_mac_addr(slave, found_slave);
1123 alb_fasten_mac_swap(bond, slave, found_slave);
1124 }
1125 }
1126}
1127
1128
1129
1130
1131
1132
1133
1134
1135
1136
1137
1138
1139
1140
1141
1142
1143
1144
1145
1146
1147
1148
1149
1150static int alb_handle_addr_collision_on_attach(struct bonding *bond, struct slave *slave)
1151{
1152 struct slave *has_bond_addr = rcu_access_pointer(bond->curr_active_slave);
1153 struct slave *tmp_slave1, *free_mac_slave = NULL;
1154 struct list_head *iter;
1155
1156 if (!bond_has_slaves(bond)) {
1157
1158 return 0;
1159 }
1160
1161
1162
1163
1164
1165 if (!ether_addr_equal_64bits(slave->perm_hwaddr, bond->dev->dev_addr)) {
1166 if (!bond_slave_has_mac(bond, slave->dev->dev_addr))
1167 return 0;
1168
1169
1170
1171
1172 alb_set_slave_mac_addr(slave, bond->dev->dev_addr,
1173 bond->dev->addr_len);
1174 }
1175
1176
1177
1178
1179 bond_for_each_slave(bond, tmp_slave1, iter) {
1180 if (!bond_slave_has_mac(bond, tmp_slave1->perm_hwaddr)) {
1181
1182
1183
1184 free_mac_slave = tmp_slave1;
1185 break;
1186 }
1187
1188 if (!has_bond_addr) {
1189 if (ether_addr_equal_64bits(tmp_slave1->dev->dev_addr,
1190 bond->dev->dev_addr)) {
1191
1192 has_bond_addr = tmp_slave1;
1193 }
1194 }
1195 }
1196
1197 if (free_mac_slave) {
1198 alb_set_slave_mac_addr(slave, free_mac_slave->perm_hwaddr,
1199 free_mac_slave->dev->addr_len);
1200
1201 slave_warn(bond->dev, slave->dev, "the slave hw address is in use by the bond; giving it the hw address of %s\n",
1202 free_mac_slave->dev->name);
1203
1204 } else if (has_bond_addr) {
1205 slave_err(bond->dev, slave->dev, "the slave hw address is in use by the bond; couldn't find a slave with a free hw address to give it (this should not have happened)\n");
1206 return -EFAULT;
1207 }
1208
1209 return 0;
1210}
1211
1212
1213
1214
1215
1216
1217
1218
1219
1220
1221
1222
1223
1224
1225
1226static int alb_set_mac_address(struct bonding *bond, void *addr)
1227{
1228 struct slave *slave, *rollback_slave;
1229 struct list_head *iter;
1230 struct sockaddr_storage ss;
1231 char tmp_addr[MAX_ADDR_LEN];
1232 int res;
1233
1234 if (bond->alb_info.rlb_enabled)
1235 return 0;
1236
1237 bond_for_each_slave(bond, slave, iter) {
1238
1239 bond_hw_addr_copy(tmp_addr, slave->dev->dev_addr,
1240 slave->dev->addr_len);
1241
1242 res = dev_set_mac_address(slave->dev, addr, NULL);
1243
1244
1245 bond_hw_addr_copy(slave->dev->dev_addr, tmp_addr,
1246 slave->dev->addr_len);
1247
1248 if (res)
1249 goto unwind;
1250 }
1251
1252 return 0;
1253
1254unwind:
1255 memcpy(ss.__data, bond->dev->dev_addr, bond->dev->addr_len);
1256 ss.ss_family = bond->dev->type;
1257
1258
1259 bond_for_each_slave(bond, rollback_slave, iter) {
1260 if (rollback_slave == slave)
1261 break;
1262 bond_hw_addr_copy(tmp_addr, rollback_slave->dev->dev_addr,
1263 rollback_slave->dev->addr_len);
1264 dev_set_mac_address(rollback_slave->dev,
1265 (struct sockaddr *)&ss, NULL);
1266 bond_hw_addr_copy(rollback_slave->dev->dev_addr, tmp_addr,
1267 rollback_slave->dev->addr_len);
1268 }
1269
1270 return res;
1271}
1272
1273
1274
1275int bond_alb_initialize(struct bonding *bond, int rlb_enabled)
1276{
1277 int res;
1278
1279 res = tlb_initialize(bond);
1280 if (res)
1281 return res;
1282
1283 if (rlb_enabled) {
1284 bond->alb_info.rlb_enabled = 1;
1285 res = rlb_initialize(bond);
1286 if (res) {
1287 tlb_deinitialize(bond);
1288 return res;
1289 }
1290 } else {
1291 bond->alb_info.rlb_enabled = 0;
1292 }
1293
1294 return 0;
1295}
1296
1297void bond_alb_deinitialize(struct bonding *bond)
1298{
1299 struct alb_bond_info *bond_info = &(BOND_ALB_INFO(bond));
1300
1301 tlb_deinitialize(bond);
1302
1303 if (bond_info->rlb_enabled)
1304 rlb_deinitialize(bond);
1305}
1306
1307static netdev_tx_t bond_do_alb_xmit(struct sk_buff *skb, struct bonding *bond,
1308 struct slave *tx_slave)
1309{
1310 struct alb_bond_info *bond_info = &(BOND_ALB_INFO(bond));
1311 struct ethhdr *eth_data = eth_hdr(skb);
1312
1313 if (!tx_slave) {
1314
1315 tx_slave = rcu_dereference(bond->curr_active_slave);
1316 if (bond->params.tlb_dynamic_lb)
1317 bond_info->unbalanced_load += skb->len;
1318 }
1319
1320 if (tx_slave && bond_slave_can_tx(tx_slave)) {
1321 if (tx_slave != rcu_access_pointer(bond->curr_active_slave)) {
1322 ether_addr_copy(eth_data->h_source,
1323 tx_slave->dev->dev_addr);
1324 }
1325
1326 return bond_dev_queue_xmit(bond, skb, tx_slave->dev);
1327 }
1328
1329 if (tx_slave && bond->params.tlb_dynamic_lb) {
1330 spin_lock(&bond->mode_lock);
1331 __tlb_clear_slave(bond, tx_slave, 0);
1332 spin_unlock(&bond->mode_lock);
1333 }
1334
1335
1336 return bond_tx_drop(bond->dev, skb);
1337}
1338
1339struct slave *bond_xmit_tlb_slave_get(struct bonding *bond,
1340 struct sk_buff *skb)
1341{
1342 struct slave *tx_slave = NULL;
1343 struct ethhdr *eth_data;
1344 u32 hash_index;
1345
1346 skb_reset_mac_header(skb);
1347 eth_data = eth_hdr(skb);
1348
1349
1350 if (!is_multicast_ether_addr(eth_data->h_dest)) {
1351 switch (skb->protocol) {
1352 case htons(ETH_P_IP):
1353 case htons(ETH_P_IPV6):
1354 hash_index = bond_xmit_hash(bond, skb);
1355 if (bond->params.tlb_dynamic_lb) {
1356 tx_slave = tlb_choose_channel(bond,
1357 hash_index & 0xFF,
1358 skb->len);
1359 } else {
1360 struct bond_up_slave *slaves;
1361 unsigned int count;
1362
1363 slaves = rcu_dereference(bond->usable_slaves);
1364 count = slaves ? READ_ONCE(slaves->count) : 0;
1365 if (likely(count))
1366 tx_slave = slaves->arr[hash_index %
1367 count];
1368 }
1369 break;
1370 }
1371 }
1372 return tx_slave;
1373}
1374
1375netdev_tx_t bond_tlb_xmit(struct sk_buff *skb, struct net_device *bond_dev)
1376{
1377 struct bonding *bond = netdev_priv(bond_dev);
1378 struct slave *tx_slave;
1379
1380 tx_slave = bond_xmit_tlb_slave_get(bond, skb);
1381 return bond_do_alb_xmit(skb, bond, tx_slave);
1382}
1383
1384struct slave *bond_xmit_alb_slave_get(struct bonding *bond,
1385 struct sk_buff *skb)
1386{
1387 struct alb_bond_info *bond_info = &(BOND_ALB_INFO(bond));
1388 static const __be32 ip_bcast = htonl(0xffffffff);
1389 struct slave *tx_slave = NULL;
1390 const u8 *hash_start = NULL;
1391 bool do_tx_balance = true;
1392 struct ethhdr *eth_data;
1393 u32 hash_index = 0;
1394 int hash_size = 0;
1395
1396 skb_reset_mac_header(skb);
1397 eth_data = eth_hdr(skb);
1398
1399 switch (ntohs(skb->protocol)) {
1400 case ETH_P_IP: {
1401 const struct iphdr *iph;
1402
1403 if (is_broadcast_ether_addr(eth_data->h_dest) ||
1404 !pskb_network_may_pull(skb, sizeof(*iph))) {
1405 do_tx_balance = false;
1406 break;
1407 }
1408 iph = ip_hdr(skb);
1409 if (iph->daddr == ip_bcast || iph->protocol == IPPROTO_IGMP) {
1410 do_tx_balance = false;
1411 break;
1412 }
1413 hash_start = (char *)&(iph->daddr);
1414 hash_size = sizeof(iph->daddr);
1415 break;
1416 }
1417 case ETH_P_IPV6: {
1418 const struct ipv6hdr *ip6hdr;
1419
1420
1421
1422
1423 if (is_broadcast_ether_addr(eth_data->h_dest)) {
1424 do_tx_balance = false;
1425 break;
1426 }
1427
1428
1429
1430
1431 if (ether_addr_equal_64bits(eth_data->h_dest, mac_v6_allmcast)) {
1432 do_tx_balance = false;
1433 break;
1434 }
1435
1436 if (!pskb_network_may_pull(skb, sizeof(*ip6hdr))) {
1437 do_tx_balance = false;
1438 break;
1439 }
1440
1441
1442
1443
1444 ip6hdr = ipv6_hdr(skb);
1445 if (ipv6_addr_any(&ip6hdr->saddr)) {
1446 do_tx_balance = false;
1447 break;
1448 }
1449
1450 hash_start = (char *)&ip6hdr->daddr;
1451 hash_size = sizeof(ip6hdr->daddr);
1452 break;
1453 }
1454 case ETH_P_ARP:
1455 do_tx_balance = false;
1456 if (bond_info->rlb_enabled)
1457 tx_slave = rlb_arp_xmit(skb, bond);
1458 break;
1459 default:
1460 do_tx_balance = false;
1461 break;
1462 }
1463
1464 if (do_tx_balance) {
1465 if (bond->params.tlb_dynamic_lb) {
1466 hash_index = _simple_hash(hash_start, hash_size);
1467 tx_slave = tlb_choose_channel(bond, hash_index, skb->len);
1468 } else {
1469
1470
1471
1472
1473
1474 struct bond_up_slave *slaves;
1475 unsigned int count;
1476
1477 slaves = rcu_dereference(bond->usable_slaves);
1478 count = slaves ? READ_ONCE(slaves->count) : 0;
1479 if (likely(count))
1480 tx_slave = slaves->arr[bond_xmit_hash(bond, skb) %
1481 count];
1482 }
1483 }
1484 return tx_slave;
1485}
1486
1487netdev_tx_t bond_alb_xmit(struct sk_buff *skb, struct net_device *bond_dev)
1488{
1489 struct bonding *bond = netdev_priv(bond_dev);
1490 struct slave *tx_slave = NULL;
1491
1492 tx_slave = bond_xmit_alb_slave_get(bond, skb);
1493 return bond_do_alb_xmit(skb, bond, tx_slave);
1494}
1495
1496void bond_alb_monitor(struct work_struct *work)
1497{
1498 struct bonding *bond = container_of(work, struct bonding,
1499 alb_work.work);
1500 struct alb_bond_info *bond_info = &(BOND_ALB_INFO(bond));
1501 struct list_head *iter;
1502 struct slave *slave;
1503
1504 if (!bond_has_slaves(bond)) {
1505 bond_info->tx_rebalance_counter = 0;
1506 bond_info->lp_counter = 0;
1507 goto re_arm;
1508 }
1509
1510 rcu_read_lock();
1511
1512 bond_info->tx_rebalance_counter++;
1513 bond_info->lp_counter++;
1514
1515
1516 if (bond_info->lp_counter >= BOND_ALB_LP_TICKS(bond)) {
1517 bool strict_match;
1518
1519 bond_for_each_slave_rcu(bond, slave, iter) {
1520
1521
1522
1523
1524
1525 strict_match = (slave != rcu_access_pointer(bond->curr_active_slave) ||
1526 bond_info->rlb_enabled);
1527 alb_send_learning_packets(slave, slave->dev->dev_addr,
1528 strict_match);
1529 }
1530 bond_info->lp_counter = 0;
1531 }
1532
1533
1534 if (bond_info->tx_rebalance_counter >= BOND_TLB_REBALANCE_TICKS) {
1535 bond_for_each_slave_rcu(bond, slave, iter) {
1536 tlb_clear_slave(bond, slave, 1);
1537 if (slave == rcu_access_pointer(bond->curr_active_slave)) {
1538 SLAVE_TLB_INFO(slave).load =
1539 bond_info->unbalanced_load /
1540 BOND_TLB_REBALANCE_INTERVAL;
1541 bond_info->unbalanced_load = 0;
1542 }
1543 }
1544 bond_info->tx_rebalance_counter = 0;
1545 }
1546
1547 if (bond_info->rlb_enabled) {
1548 if (bond_info->primary_is_promisc &&
1549 (++bond_info->rlb_promisc_timeout_counter >= RLB_PROMISC_TIMEOUT)) {
1550
1551
1552
1553
1554 rcu_read_unlock();
1555 if (!rtnl_trylock())
1556 goto re_arm;
1557
1558 bond_info->rlb_promisc_timeout_counter = 0;
1559
1560
1561
1562
1563
1564 dev_set_promiscuity(rtnl_dereference(bond->curr_active_slave)->dev,
1565 -1);
1566 bond_info->primary_is_promisc = 0;
1567
1568 rtnl_unlock();
1569 rcu_read_lock();
1570 }
1571
1572 if (bond_info->rlb_rebalance) {
1573 bond_info->rlb_rebalance = 0;
1574 rlb_rebalance(bond);
1575 }
1576
1577
1578 if (bond_info->rx_ntt) {
1579 if (bond_info->rlb_update_delay_counter) {
1580 --bond_info->rlb_update_delay_counter;
1581 } else {
1582 rlb_update_rx_clients(bond);
1583 if (bond_info->rlb_update_retry_counter)
1584 --bond_info->rlb_update_retry_counter;
1585 else
1586 bond_info->rx_ntt = 0;
1587 }
1588 }
1589 }
1590 rcu_read_unlock();
1591re_arm:
1592 queue_delayed_work(bond->wq, &bond->alb_work, alb_delta_in_ticks);
1593}
1594
1595
1596
1597
1598int bond_alb_init_slave(struct bonding *bond, struct slave *slave)
1599{
1600 int res;
1601
1602 res = alb_set_slave_mac_addr(slave, slave->perm_hwaddr,
1603 slave->dev->addr_len);
1604 if (res)
1605 return res;
1606
1607 res = alb_handle_addr_collision_on_attach(bond, slave);
1608 if (res)
1609 return res;
1610
1611 tlb_init_slave(slave);
1612
1613
1614 bond->alb_info.tx_rebalance_counter = BOND_TLB_REBALANCE_TICKS;
1615
1616 if (bond->alb_info.rlb_enabled)
1617 bond->alb_info.rlb_rebalance = 1;
1618
1619 return 0;
1620}
1621
1622
1623
1624
1625
1626
1627void bond_alb_deinit_slave(struct bonding *bond, struct slave *slave)
1628{
1629 if (bond_has_slaves(bond))
1630 alb_change_hw_addr_on_detach(bond, slave);
1631
1632 tlb_clear_slave(bond, slave, 0);
1633
1634 if (bond->alb_info.rlb_enabled) {
1635 bond->alb_info.rx_slave = NULL;
1636 rlb_clear_slave(bond, slave);
1637 }
1638
1639}
1640
1641void bond_alb_handle_link_change(struct bonding *bond, struct slave *slave, char link)
1642{
1643 struct alb_bond_info *bond_info = &(BOND_ALB_INFO(bond));
1644
1645 if (link == BOND_LINK_DOWN) {
1646 tlb_clear_slave(bond, slave, 0);
1647 if (bond->alb_info.rlb_enabled)
1648 rlb_clear_slave(bond, slave);
1649 } else if (link == BOND_LINK_UP) {
1650
1651 bond_info->tx_rebalance_counter = BOND_TLB_REBALANCE_TICKS;
1652 if (bond->alb_info.rlb_enabled) {
1653 bond->alb_info.rlb_rebalance = 1;
1654
1655
1656
1657
1658
1659 }
1660 }
1661
1662 if (bond_is_nondyn_tlb(bond)) {
1663 if (bond_update_slave_arr(bond, NULL))
1664 pr_err("Failed to build slave-array for TLB mode.\n");
1665 }
1666}
1667
1668
1669
1670
1671
1672
1673
1674
1675
1676
1677
1678void bond_alb_handle_active_change(struct bonding *bond, struct slave *new_slave)
1679{
1680 struct slave *swap_slave;
1681 struct slave *curr_active;
1682
1683 curr_active = rtnl_dereference(bond->curr_active_slave);
1684 if (curr_active == new_slave)
1685 return;
1686
1687 if (curr_active && bond->alb_info.primary_is_promisc) {
1688 dev_set_promiscuity(curr_active->dev, -1);
1689 bond->alb_info.primary_is_promisc = 0;
1690 bond->alb_info.rlb_promisc_timeout_counter = 0;
1691 }
1692
1693 swap_slave = curr_active;
1694 rcu_assign_pointer(bond->curr_active_slave, new_slave);
1695
1696 if (!new_slave || !bond_has_slaves(bond))
1697 return;
1698
1699
1700
1701
1702 if (!swap_slave)
1703 swap_slave = bond_slave_has_mac(bond, bond->dev->dev_addr);
1704
1705
1706
1707
1708
1709 if (swap_slave)
1710 tlb_clear_slave(bond, swap_slave, 1);
1711 tlb_clear_slave(bond, new_slave, 1);
1712
1713
1714
1715
1716 if (BOND_MODE(bond) == BOND_MODE_TLB) {
1717 struct sockaddr_storage ss;
1718 u8 tmp_addr[MAX_ADDR_LEN];
1719
1720 bond_hw_addr_copy(tmp_addr, new_slave->dev->dev_addr,
1721 new_slave->dev->addr_len);
1722
1723 bond_hw_addr_copy(ss.__data, bond->dev->dev_addr,
1724 bond->dev->addr_len);
1725 ss.ss_family = bond->dev->type;
1726
1727 dev_set_mac_address(new_slave->dev, (struct sockaddr *)&ss,
1728 NULL);
1729
1730 bond_hw_addr_copy(new_slave->dev->dev_addr, tmp_addr,
1731 new_slave->dev->addr_len);
1732 }
1733
1734
1735 if (swap_slave) {
1736
1737 alb_swap_mac_addr(swap_slave, new_slave);
1738 alb_fasten_mac_swap(bond, swap_slave, new_slave);
1739 } else {
1740
1741 alb_set_slave_mac_addr(new_slave, bond->dev->dev_addr,
1742 bond->dev->addr_len);
1743 alb_send_learning_packets(new_slave, bond->dev->dev_addr,
1744 false);
1745 }
1746}
1747
1748
1749int bond_alb_set_mac_address(struct net_device *bond_dev, void *addr)
1750{
1751 struct bonding *bond = netdev_priv(bond_dev);
1752 struct sockaddr_storage *ss = addr;
1753 struct slave *curr_active;
1754 struct slave *swap_slave;
1755 int res;
1756
1757 if (!is_valid_ether_addr(ss->__data))
1758 return -EADDRNOTAVAIL;
1759
1760 res = alb_set_mac_address(bond, addr);
1761 if (res)
1762 return res;
1763
1764 bond_hw_addr_copy(bond_dev->dev_addr, ss->__data, bond_dev->addr_len);
1765
1766
1767
1768
1769
1770 curr_active = rtnl_dereference(bond->curr_active_slave);
1771 if (!curr_active)
1772 return 0;
1773
1774 swap_slave = bond_slave_has_mac(bond, bond_dev->dev_addr);
1775
1776 if (swap_slave) {
1777 alb_swap_mac_addr(swap_slave, curr_active);
1778 alb_fasten_mac_swap(bond, swap_slave, curr_active);
1779 } else {
1780 alb_set_slave_mac_addr(curr_active, bond_dev->dev_addr,
1781 bond_dev->addr_len);
1782
1783 alb_send_learning_packets(curr_active,
1784 bond_dev->dev_addr, false);
1785 if (bond->alb_info.rlb_enabled) {
1786
1787 rlb_req_update_slave_clients(bond, curr_active);
1788 }
1789 }
1790
1791 return 0;
1792}
1793
1794void bond_alb_clear_vlan(struct bonding *bond, unsigned short vlan_id)
1795{
1796 if (bond->alb_info.rlb_enabled)
1797 rlb_clear_vlan(bond, vlan_id);
1798}
1799
1800