Merge branch 'next-general' of git://git.kernel.org/pub/scm/linux/kernel/git/jmorris...
[linux-2.6-microblaze.git] / net / bridge / br_fdb.c
1 /*
2  *      Forwarding database
3  *      Linux ethernet bridge
4  *
5  *      Authors:
6  *      Lennert Buytenhek               <buytenh@gnu.org>
7  *
8  *      This program is free software; you can redistribute it and/or
9  *      modify it under the terms of the GNU General Public License
10  *      as published by the Free Software Foundation; either version
11  *      2 of the License, or (at your option) any later version.
12  */
13
14 #include <linux/kernel.h>
15 #include <linux/init.h>
16 #include <linux/rculist.h>
17 #include <linux/spinlock.h>
18 #include <linux/times.h>
19 #include <linux/netdevice.h>
20 #include <linux/etherdevice.h>
21 #include <linux/jhash.h>
22 #include <linux/random.h>
23 #include <linux/slab.h>
24 #include <linux/atomic.h>
25 #include <asm/unaligned.h>
26 #include <linux/if_vlan.h>
27 #include <net/switchdev.h>
28 #include <trace/events/bridge.h>
29 #include "br_private.h"
30
31 static const struct rhashtable_params br_fdb_rht_params = {
32         .head_offset = offsetof(struct net_bridge_fdb_entry, rhnode),
33         .key_offset = offsetof(struct net_bridge_fdb_entry, key),
34         .key_len = sizeof(struct net_bridge_fdb_key),
35         .automatic_shrinking = true,
36         .locks_mul = 1,
37 };
38
39 static struct kmem_cache *br_fdb_cache __read_mostly;
40 static int fdb_insert(struct net_bridge *br, struct net_bridge_port *source,
41                       const unsigned char *addr, u16 vid);
42 static void fdb_notify(struct net_bridge *br,
43                        const struct net_bridge_fdb_entry *, int, bool);
44
45 int __init br_fdb_init(void)
46 {
47         br_fdb_cache = kmem_cache_create("bridge_fdb_cache",
48                                          sizeof(struct net_bridge_fdb_entry),
49                                          0,
50                                          SLAB_HWCACHE_ALIGN, NULL);
51         if (!br_fdb_cache)
52                 return -ENOMEM;
53
54         return 0;
55 }
56
57 void br_fdb_fini(void)
58 {
59         kmem_cache_destroy(br_fdb_cache);
60 }
61
62 int br_fdb_hash_init(struct net_bridge *br)
63 {
64         return rhashtable_init(&br->fdb_hash_tbl, &br_fdb_rht_params);
65 }
66
67 void br_fdb_hash_fini(struct net_bridge *br)
68 {
69         rhashtable_destroy(&br->fdb_hash_tbl);
70 }
71
72 /* if topology_changing then use forward_delay (default 15 sec)
73  * otherwise keep longer (default 5 minutes)
74  */
75 static inline unsigned long hold_time(const struct net_bridge *br)
76 {
77         return br->topology_change ? br->forward_delay : br->ageing_time;
78 }
79
80 static inline int has_expired(const struct net_bridge *br,
81                                   const struct net_bridge_fdb_entry *fdb)
82 {
83         return !fdb->is_static && !fdb->added_by_external_learn &&
84                 time_before_eq(fdb->updated + hold_time(br), jiffies);
85 }
86
87 static void fdb_rcu_free(struct rcu_head *head)
88 {
89         struct net_bridge_fdb_entry *ent
90                 = container_of(head, struct net_bridge_fdb_entry, rcu);
91         kmem_cache_free(br_fdb_cache, ent);
92 }
93
94 static struct net_bridge_fdb_entry *fdb_find_rcu(struct rhashtable *tbl,
95                                                  const unsigned char *addr,
96                                                  __u16 vid)
97 {
98         struct net_bridge_fdb_key key;
99
100         WARN_ON_ONCE(!rcu_read_lock_held());
101
102         key.vlan_id = vid;
103         memcpy(key.addr.addr, addr, sizeof(key.addr.addr));
104
105         return rhashtable_lookup(tbl, &key, br_fdb_rht_params);
106 }
107
108 /* requires bridge hash_lock */
109 static struct net_bridge_fdb_entry *br_fdb_find(struct net_bridge *br,
110                                                 const unsigned char *addr,
111                                                 __u16 vid)
112 {
113         struct net_bridge_fdb_entry *fdb;
114
115         lockdep_assert_held_once(&br->hash_lock);
116
117         rcu_read_lock();
118         fdb = fdb_find_rcu(&br->fdb_hash_tbl, addr, vid);
119         rcu_read_unlock();
120
121         return fdb;
122 }
123
124 struct net_device *br_fdb_find_port(const struct net_device *br_dev,
125                                     const unsigned char *addr,
126                                     __u16 vid)
127 {
128         struct net_bridge_fdb_entry *f;
129         struct net_device *dev = NULL;
130         struct net_bridge *br;
131
132         ASSERT_RTNL();
133
134         if (!netif_is_bridge_master(br_dev))
135                 return NULL;
136
137         br = netdev_priv(br_dev);
138         rcu_read_lock();
139         f = br_fdb_find_rcu(br, addr, vid);
140         if (f && f->dst)
141                 dev = f->dst->dev;
142         rcu_read_unlock();
143
144         return dev;
145 }
146 EXPORT_SYMBOL_GPL(br_fdb_find_port);
147
148 struct net_bridge_fdb_entry *br_fdb_find_rcu(struct net_bridge *br,
149                                              const unsigned char *addr,
150                                              __u16 vid)
151 {
152         return fdb_find_rcu(&br->fdb_hash_tbl, addr, vid);
153 }
154
155 /* When a static FDB entry is added, the mac address from the entry is
156  * added to the bridge private HW address list and all required ports
157  * are then updated with the new information.
158  * Called under RTNL.
159  */
160 static void fdb_add_hw_addr(struct net_bridge *br, const unsigned char *addr)
161 {
162         int err;
163         struct net_bridge_port *p;
164
165         ASSERT_RTNL();
166
167         list_for_each_entry(p, &br->port_list, list) {
168                 if (!br_promisc_port(p)) {
169                         err = dev_uc_add(p->dev, addr);
170                         if (err)
171                                 goto undo;
172                 }
173         }
174
175         return;
176 undo:
177         list_for_each_entry_continue_reverse(p, &br->port_list, list) {
178                 if (!br_promisc_port(p))
179                         dev_uc_del(p->dev, addr);
180         }
181 }
182
183 /* When a static FDB entry is deleted, the HW address from that entry is
184  * also removed from the bridge private HW address list and updates all
185  * the ports with needed information.
186  * Called under RTNL.
187  */
188 static void fdb_del_hw_addr(struct net_bridge *br, const unsigned char *addr)
189 {
190         struct net_bridge_port *p;
191
192         ASSERT_RTNL();
193
194         list_for_each_entry(p, &br->port_list, list) {
195                 if (!br_promisc_port(p))
196                         dev_uc_del(p->dev, addr);
197         }
198 }
199
200 static void fdb_delete(struct net_bridge *br, struct net_bridge_fdb_entry *f,
201                        bool swdev_notify)
202 {
203         trace_fdb_delete(br, f);
204
205         if (f->is_static)
206                 fdb_del_hw_addr(br, f->key.addr.addr);
207
208         hlist_del_init_rcu(&f->fdb_node);
209         rhashtable_remove_fast(&br->fdb_hash_tbl, &f->rhnode,
210                                br_fdb_rht_params);
211         fdb_notify(br, f, RTM_DELNEIGH, swdev_notify);
212         call_rcu(&f->rcu, fdb_rcu_free);
213 }
214
215 /* Delete a local entry if no other port had the same address. */
216 static void fdb_delete_local(struct net_bridge *br,
217                              const struct net_bridge_port *p,
218                              struct net_bridge_fdb_entry *f)
219 {
220         const unsigned char *addr = f->key.addr.addr;
221         struct net_bridge_vlan_group *vg;
222         const struct net_bridge_vlan *v;
223         struct net_bridge_port *op;
224         u16 vid = f->key.vlan_id;
225
226         /* Maybe another port has same hw addr? */
227         list_for_each_entry(op, &br->port_list, list) {
228                 vg = nbp_vlan_group(op);
229                 if (op != p && ether_addr_equal(op->dev->dev_addr, addr) &&
230                     (!vid || br_vlan_find(vg, vid))) {
231                         f->dst = op;
232                         f->added_by_user = 0;
233                         return;
234                 }
235         }
236
237         vg = br_vlan_group(br);
238         v = br_vlan_find(vg, vid);
239         /* Maybe bridge device has same hw addr? */
240         if (p && ether_addr_equal(br->dev->dev_addr, addr) &&
241             (!vid || (v && br_vlan_should_use(v)))) {
242                 f->dst = NULL;
243                 f->added_by_user = 0;
244                 return;
245         }
246
247         fdb_delete(br, f, true);
248 }
249
250 void br_fdb_find_delete_local(struct net_bridge *br,
251                               const struct net_bridge_port *p,
252                               const unsigned char *addr, u16 vid)
253 {
254         struct net_bridge_fdb_entry *f;
255
256         spin_lock_bh(&br->hash_lock);
257         f = br_fdb_find(br, addr, vid);
258         if (f && f->is_local && !f->added_by_user && f->dst == p)
259                 fdb_delete_local(br, p, f);
260         spin_unlock_bh(&br->hash_lock);
261 }
262
263 void br_fdb_changeaddr(struct net_bridge_port *p, const unsigned char *newaddr)
264 {
265         struct net_bridge_vlan_group *vg;
266         struct net_bridge_fdb_entry *f;
267         struct net_bridge *br = p->br;
268         struct net_bridge_vlan *v;
269
270         spin_lock_bh(&br->hash_lock);
271         vg = nbp_vlan_group(p);
272         hlist_for_each_entry(f, &br->fdb_list, fdb_node) {
273                 if (f->dst == p && f->is_local && !f->added_by_user) {
274                         /* delete old one */
275                         fdb_delete_local(br, p, f);
276
277                         /* if this port has no vlan information
278                          * configured, we can safely be done at
279                          * this point.
280                          */
281                         if (!vg || !vg->num_vlans)
282                                 goto insert;
283                 }
284         }
285
286 insert:
287         /* insert new address,  may fail if invalid address or dup. */
288         fdb_insert(br, p, newaddr, 0);
289
290         if (!vg || !vg->num_vlans)
291                 goto done;
292
293         /* Now add entries for every VLAN configured on the port.
294          * This function runs under RTNL so the bitmap will not change
295          * from under us.
296          */
297         list_for_each_entry(v, &vg->vlan_list, vlist)
298                 fdb_insert(br, p, newaddr, v->vid);
299
300 done:
301         spin_unlock_bh(&br->hash_lock);
302 }
303
304 void br_fdb_change_mac_address(struct net_bridge *br, const u8 *newaddr)
305 {
306         struct net_bridge_vlan_group *vg;
307         struct net_bridge_fdb_entry *f;
308         struct net_bridge_vlan *v;
309
310         spin_lock_bh(&br->hash_lock);
311
312         /* If old entry was unassociated with any port, then delete it. */
313         f = br_fdb_find(br, br->dev->dev_addr, 0);
314         if (f && f->is_local && !f->dst && !f->added_by_user)
315                 fdb_delete_local(br, NULL, f);
316
317         fdb_insert(br, NULL, newaddr, 0);
318         vg = br_vlan_group(br);
319         if (!vg || !vg->num_vlans)
320                 goto out;
321         /* Now remove and add entries for every VLAN configured on the
322          * bridge.  This function runs under RTNL so the bitmap will not
323          * change from under us.
324          */
325         list_for_each_entry(v, &vg->vlan_list, vlist) {
326                 if (!br_vlan_should_use(v))
327                         continue;
328                 f = br_fdb_find(br, br->dev->dev_addr, v->vid);
329                 if (f && f->is_local && !f->dst && !f->added_by_user)
330                         fdb_delete_local(br, NULL, f);
331                 fdb_insert(br, NULL, newaddr, v->vid);
332         }
333 out:
334         spin_unlock_bh(&br->hash_lock);
335 }
336
337 void br_fdb_cleanup(struct work_struct *work)
338 {
339         struct net_bridge *br = container_of(work, struct net_bridge,
340                                              gc_work.work);
341         struct net_bridge_fdb_entry *f = NULL;
342         unsigned long delay = hold_time(br);
343         unsigned long work_delay = delay;
344         unsigned long now = jiffies;
345
346         /* this part is tricky, in order to avoid blocking learning and
347          * consequently forwarding, we rely on rcu to delete objects with
348          * delayed freeing allowing us to continue traversing
349          */
350         rcu_read_lock();
351         hlist_for_each_entry_rcu(f, &br->fdb_list, fdb_node) {
352                 unsigned long this_timer;
353
354                 if (f->is_static || f->added_by_external_learn)
355                         continue;
356                 this_timer = f->updated + delay;
357                 if (time_after(this_timer, now)) {
358                         work_delay = min(work_delay, this_timer - now);
359                 } else {
360                         spin_lock_bh(&br->hash_lock);
361                         if (!hlist_unhashed(&f->fdb_node))
362                                 fdb_delete(br, f, true);
363                         spin_unlock_bh(&br->hash_lock);
364                 }
365         }
366         rcu_read_unlock();
367
368         /* Cleanup minimum 10 milliseconds apart */
369         work_delay = max_t(unsigned long, work_delay, msecs_to_jiffies(10));
370         mod_delayed_work(system_long_wq, &br->gc_work, work_delay);
371 }
372
373 /* Completely flush all dynamic entries in forwarding database.*/
374 void br_fdb_flush(struct net_bridge *br)
375 {
376         struct net_bridge_fdb_entry *f;
377         struct hlist_node *tmp;
378
379         spin_lock_bh(&br->hash_lock);
380         hlist_for_each_entry_safe(f, tmp, &br->fdb_list, fdb_node) {
381                 if (!f->is_static)
382                         fdb_delete(br, f, true);
383         }
384         spin_unlock_bh(&br->hash_lock);
385 }
386
387 /* Flush all entries referring to a specific port.
388  * if do_all is set also flush static entries
389  * if vid is set delete all entries that match the vlan_id
390  */
391 void br_fdb_delete_by_port(struct net_bridge *br,
392                            const struct net_bridge_port *p,
393                            u16 vid,
394                            int do_all)
395 {
396         struct net_bridge_fdb_entry *f;
397         struct hlist_node *tmp;
398
399         spin_lock_bh(&br->hash_lock);
400         hlist_for_each_entry_safe(f, tmp, &br->fdb_list, fdb_node) {
401                 if (f->dst != p)
402                         continue;
403
404                 if (!do_all)
405                         if (f->is_static || (vid && f->key.vlan_id != vid))
406                                 continue;
407
408                 if (f->is_local)
409                         fdb_delete_local(br, p, f);
410                 else
411                         fdb_delete(br, f, true);
412         }
413         spin_unlock_bh(&br->hash_lock);
414 }
415
416 #if IS_ENABLED(CONFIG_ATM_LANE)
417 /* Interface used by ATM LANE hook to test
418  * if an addr is on some other bridge port */
419 int br_fdb_test_addr(struct net_device *dev, unsigned char *addr)
420 {
421         struct net_bridge_fdb_entry *fdb;
422         struct net_bridge_port *port;
423         int ret;
424
425         rcu_read_lock();
426         port = br_port_get_rcu(dev);
427         if (!port)
428                 ret = 0;
429         else {
430                 fdb = br_fdb_find_rcu(port->br, addr, 0);
431                 ret = fdb && fdb->dst && fdb->dst->dev != dev &&
432                         fdb->dst->state == BR_STATE_FORWARDING;
433         }
434         rcu_read_unlock();
435
436         return ret;
437 }
438 #endif /* CONFIG_ATM_LANE */
439
440 /*
441  * Fill buffer with forwarding table records in
442  * the API format.
443  */
444 int br_fdb_fillbuf(struct net_bridge *br, void *buf,
445                    unsigned long maxnum, unsigned long skip)
446 {
447         struct net_bridge_fdb_entry *f;
448         struct __fdb_entry *fe = buf;
449         int num = 0;
450
451         memset(buf, 0, maxnum*sizeof(struct __fdb_entry));
452
453         rcu_read_lock();
454         hlist_for_each_entry_rcu(f, &br->fdb_list, fdb_node) {
455                 if (num >= maxnum)
456                         break;
457
458                 if (has_expired(br, f))
459                         continue;
460
461                 /* ignore pseudo entry for local MAC address */
462                 if (!f->dst)
463                         continue;
464
465                 if (skip) {
466                         --skip;
467                         continue;
468                 }
469
470                 /* convert from internal format to API */
471                 memcpy(fe->mac_addr, f->key.addr.addr, ETH_ALEN);
472
473                 /* due to ABI compat need to split into hi/lo */
474                 fe->port_no = f->dst->port_no;
475                 fe->port_hi = f->dst->port_no >> 8;
476
477                 fe->is_local = f->is_local;
478                 if (!f->is_static)
479                         fe->ageing_timer_value = jiffies_delta_to_clock_t(jiffies - f->updated);
480                 ++fe;
481                 ++num;
482         }
483         rcu_read_unlock();
484
485         return num;
486 }
487
488 static struct net_bridge_fdb_entry *fdb_create(struct net_bridge *br,
489                                                struct net_bridge_port *source,
490                                                const unsigned char *addr,
491                                                __u16 vid,
492                                                unsigned char is_local,
493                                                unsigned char is_static)
494 {
495         struct net_bridge_fdb_entry *fdb;
496
497         fdb = kmem_cache_alloc(br_fdb_cache, GFP_ATOMIC);
498         if (fdb) {
499                 memcpy(fdb->key.addr.addr, addr, ETH_ALEN);
500                 fdb->dst = source;
501                 fdb->key.vlan_id = vid;
502                 fdb->is_local = is_local;
503                 fdb->is_static = is_static;
504                 fdb->added_by_user = 0;
505                 fdb->added_by_external_learn = 0;
506                 fdb->offloaded = 0;
507                 fdb->is_sticky = 0;
508                 fdb->updated = fdb->used = jiffies;
509                 if (rhashtable_lookup_insert_fast(&br->fdb_hash_tbl,
510                                                   &fdb->rhnode,
511                                                   br_fdb_rht_params)) {
512                         kmem_cache_free(br_fdb_cache, fdb);
513                         fdb = NULL;
514                 } else {
515                         hlist_add_head_rcu(&fdb->fdb_node, &br->fdb_list);
516                 }
517         }
518         return fdb;
519 }
520
521 static int fdb_insert(struct net_bridge *br, struct net_bridge_port *source,
522                   const unsigned char *addr, u16 vid)
523 {
524         struct net_bridge_fdb_entry *fdb;
525
526         if (!is_valid_ether_addr(addr))
527                 return -EINVAL;
528
529         fdb = br_fdb_find(br, addr, vid);
530         if (fdb) {
531                 /* it is okay to have multiple ports with same
532                  * address, just use the first one.
533                  */
534                 if (fdb->is_local)
535                         return 0;
536                 br_warn(br, "adding interface %s with same address as a received packet (addr:%pM, vlan:%u)\n",
537                        source ? source->dev->name : br->dev->name, addr, vid);
538                 fdb_delete(br, fdb, true);
539         }
540
541         fdb = fdb_create(br, source, addr, vid, 1, 1);
542         if (!fdb)
543                 return -ENOMEM;
544
545         fdb_add_hw_addr(br, addr);
546         fdb_notify(br, fdb, RTM_NEWNEIGH, true);
547         return 0;
548 }
549
550 /* Add entry for local address of interface */
551 int br_fdb_insert(struct net_bridge *br, struct net_bridge_port *source,
552                   const unsigned char *addr, u16 vid)
553 {
554         int ret;
555
556         spin_lock_bh(&br->hash_lock);
557         ret = fdb_insert(br, source, addr, vid);
558         spin_unlock_bh(&br->hash_lock);
559         return ret;
560 }
561
562 void br_fdb_update(struct net_bridge *br, struct net_bridge_port *source,
563                    const unsigned char *addr, u16 vid, bool added_by_user)
564 {
565         struct net_bridge_fdb_entry *fdb;
566         bool fdb_modified = false;
567
568         /* some users want to always flood. */
569         if (hold_time(br) == 0)
570                 return;
571
572         /* ignore packets unless we are using this port */
573         if (!(source->state == BR_STATE_LEARNING ||
574               source->state == BR_STATE_FORWARDING))
575                 return;
576
577         fdb = fdb_find_rcu(&br->fdb_hash_tbl, addr, vid);
578         if (likely(fdb)) {
579                 /* attempt to update an entry for a local interface */
580                 if (unlikely(fdb->is_local)) {
581                         if (net_ratelimit())
582                                 br_warn(br, "received packet on %s with own address as source address (addr:%pM, vlan:%u)\n",
583                                         source->dev->name, addr, vid);
584                 } else {
585                         unsigned long now = jiffies;
586
587                         /* fastpath: update of existing entry */
588                         if (unlikely(source != fdb->dst && !fdb->is_sticky)) {
589                                 fdb->dst = source;
590                                 fdb_modified = true;
591                                 /* Take over HW learned entry */
592                                 if (unlikely(fdb->added_by_external_learn))
593                                         fdb->added_by_external_learn = 0;
594                         }
595                         if (now != fdb->updated)
596                                 fdb->updated = now;
597                         if (unlikely(added_by_user))
598                                 fdb->added_by_user = 1;
599                         if (unlikely(fdb_modified)) {
600                                 trace_br_fdb_update(br, source, addr, vid, added_by_user);
601                                 fdb_notify(br, fdb, RTM_NEWNEIGH, true);
602                         }
603                 }
604         } else {
605                 spin_lock(&br->hash_lock);
606                 fdb = fdb_create(br, source, addr, vid, 0, 0);
607                 if (fdb) {
608                         if (unlikely(added_by_user))
609                                 fdb->added_by_user = 1;
610                         trace_br_fdb_update(br, source, addr, vid,
611                                             added_by_user);
612                         fdb_notify(br, fdb, RTM_NEWNEIGH, true);
613                 }
614                 /* else  we lose race and someone else inserts
615                  * it first, don't bother updating
616                  */
617                 spin_unlock(&br->hash_lock);
618         }
619 }
620
621 static int fdb_to_nud(const struct net_bridge *br,
622                       const struct net_bridge_fdb_entry *fdb)
623 {
624         if (fdb->is_local)
625                 return NUD_PERMANENT;
626         else if (fdb->is_static)
627                 return NUD_NOARP;
628         else if (has_expired(br, fdb))
629                 return NUD_STALE;
630         else
631                 return NUD_REACHABLE;
632 }
633
634 static int fdb_fill_info(struct sk_buff *skb, const struct net_bridge *br,
635                          const struct net_bridge_fdb_entry *fdb,
636                          u32 portid, u32 seq, int type, unsigned int flags)
637 {
638         unsigned long now = jiffies;
639         struct nda_cacheinfo ci;
640         struct nlmsghdr *nlh;
641         struct ndmsg *ndm;
642
643         nlh = nlmsg_put(skb, portid, seq, type, sizeof(*ndm), flags);
644         if (nlh == NULL)
645                 return -EMSGSIZE;
646
647         ndm = nlmsg_data(nlh);
648         ndm->ndm_family  = AF_BRIDGE;
649         ndm->ndm_pad1    = 0;
650         ndm->ndm_pad2    = 0;
651         ndm->ndm_flags   = 0;
652         ndm->ndm_type    = 0;
653         ndm->ndm_ifindex = fdb->dst ? fdb->dst->dev->ifindex : br->dev->ifindex;
654         ndm->ndm_state   = fdb_to_nud(br, fdb);
655
656         if (fdb->offloaded)
657                 ndm->ndm_flags |= NTF_OFFLOADED;
658         if (fdb->added_by_external_learn)
659                 ndm->ndm_flags |= NTF_EXT_LEARNED;
660         if (fdb->is_sticky)
661                 ndm->ndm_flags |= NTF_STICKY;
662
663         if (nla_put(skb, NDA_LLADDR, ETH_ALEN, &fdb->key.addr))
664                 goto nla_put_failure;
665         if (nla_put_u32(skb, NDA_MASTER, br->dev->ifindex))
666                 goto nla_put_failure;
667         ci.ndm_used      = jiffies_to_clock_t(now - fdb->used);
668         ci.ndm_confirmed = 0;
669         ci.ndm_updated   = jiffies_to_clock_t(now - fdb->updated);
670         ci.ndm_refcnt    = 0;
671         if (nla_put(skb, NDA_CACHEINFO, sizeof(ci), &ci))
672                 goto nla_put_failure;
673
674         if (fdb->key.vlan_id && nla_put(skb, NDA_VLAN, sizeof(u16),
675                                         &fdb->key.vlan_id))
676                 goto nla_put_failure;
677
678         nlmsg_end(skb, nlh);
679         return 0;
680
681 nla_put_failure:
682         nlmsg_cancel(skb, nlh);
683         return -EMSGSIZE;
684 }
685
686 static inline size_t fdb_nlmsg_size(void)
687 {
688         return NLMSG_ALIGN(sizeof(struct ndmsg))
689                 + nla_total_size(ETH_ALEN) /* NDA_LLADDR */
690                 + nla_total_size(sizeof(u32)) /* NDA_MASTER */
691                 + nla_total_size(sizeof(u16)) /* NDA_VLAN */
692                 + nla_total_size(sizeof(struct nda_cacheinfo));
693 }
694
695 static void fdb_notify(struct net_bridge *br,
696                        const struct net_bridge_fdb_entry *fdb, int type,
697                        bool swdev_notify)
698 {
699         struct net *net = dev_net(br->dev);
700         struct sk_buff *skb;
701         int err = -ENOBUFS;
702
703         if (swdev_notify)
704                 br_switchdev_fdb_notify(fdb, type);
705
706         skb = nlmsg_new(fdb_nlmsg_size(), GFP_ATOMIC);
707         if (skb == NULL)
708                 goto errout;
709
710         err = fdb_fill_info(skb, br, fdb, 0, 0, type, 0);
711         if (err < 0) {
712                 /* -EMSGSIZE implies BUG in fdb_nlmsg_size() */
713                 WARN_ON(err == -EMSGSIZE);
714                 kfree_skb(skb);
715                 goto errout;
716         }
717         rtnl_notify(skb, net, 0, RTNLGRP_NEIGH, NULL, GFP_ATOMIC);
718         return;
719 errout:
720         rtnl_set_sk_err(net, RTNLGRP_NEIGH, err);
721 }
722
723 /* Dump information about entries, in response to GETNEIGH */
724 int br_fdb_dump(struct sk_buff *skb,
725                 struct netlink_callback *cb,
726                 struct net_device *dev,
727                 struct net_device *filter_dev,
728                 int *idx)
729 {
730         struct net_bridge *br = netdev_priv(dev);
731         struct net_bridge_fdb_entry *f;
732         int err = 0;
733
734         if (!(dev->priv_flags & IFF_EBRIDGE))
735                 return err;
736
737         if (!filter_dev) {
738                 err = ndo_dflt_fdb_dump(skb, cb, dev, NULL, idx);
739                 if (err < 0)
740                         return err;
741         }
742
743         rcu_read_lock();
744         hlist_for_each_entry_rcu(f, &br->fdb_list, fdb_node) {
745                 if (*idx < cb->args[2])
746                         goto skip;
747                 if (filter_dev && (!f->dst || f->dst->dev != filter_dev)) {
748                         if (filter_dev != dev)
749                                 goto skip;
750                         /* !f->dst is a special case for bridge
751                          * It means the MAC belongs to the bridge
752                          * Therefore need a little more filtering
753                          * we only want to dump the !f->dst case
754                          */
755                         if (f->dst)
756                                 goto skip;
757                 }
758                 if (!filter_dev && f->dst)
759                         goto skip;
760
761                 err = fdb_fill_info(skb, br, f,
762                                     NETLINK_CB(cb->skb).portid,
763                                     cb->nlh->nlmsg_seq,
764                                     RTM_NEWNEIGH,
765                                     NLM_F_MULTI);
766                 if (err < 0)
767                         break;
768 skip:
769                 *idx += 1;
770         }
771         rcu_read_unlock();
772
773         return err;
774 }
775
776 /* Update (create or replace) forwarding database entry */
777 static int fdb_add_entry(struct net_bridge *br, struct net_bridge_port *source,
778                          const u8 *addr, u16 state, u16 flags, u16 vid,
779                          u8 ndm_flags)
780 {
781         u8 is_sticky = !!(ndm_flags & NTF_STICKY);
782         struct net_bridge_fdb_entry *fdb;
783         bool modified = false;
784
785         /* If the port cannot learn allow only local and static entries */
786         if (source && !(state & NUD_PERMANENT) && !(state & NUD_NOARP) &&
787             !(source->state == BR_STATE_LEARNING ||
788               source->state == BR_STATE_FORWARDING))
789                 return -EPERM;
790
791         if (!source && !(state & NUD_PERMANENT)) {
792                 pr_info("bridge: RTM_NEWNEIGH %s without NUD_PERMANENT\n",
793                         br->dev->name);
794                 return -EINVAL;
795         }
796
797         if (is_sticky && (state & NUD_PERMANENT))
798                 return -EINVAL;
799
800         fdb = br_fdb_find(br, addr, vid);
801         if (fdb == NULL) {
802                 if (!(flags & NLM_F_CREATE))
803                         return -ENOENT;
804
805                 fdb = fdb_create(br, source, addr, vid, 0, 0);
806                 if (!fdb)
807                         return -ENOMEM;
808
809                 modified = true;
810         } else {
811                 if (flags & NLM_F_EXCL)
812                         return -EEXIST;
813
814                 if (fdb->dst != source) {
815                         fdb->dst = source;
816                         modified = true;
817                 }
818         }
819
820         if (fdb_to_nud(br, fdb) != state) {
821                 if (state & NUD_PERMANENT) {
822                         fdb->is_local = 1;
823                         if (!fdb->is_static) {
824                                 fdb->is_static = 1;
825                                 fdb_add_hw_addr(br, addr);
826                         }
827                 } else if (state & NUD_NOARP) {
828                         fdb->is_local = 0;
829                         if (!fdb->is_static) {
830                                 fdb->is_static = 1;
831                                 fdb_add_hw_addr(br, addr);
832                         }
833                 } else {
834                         fdb->is_local = 0;
835                         if (fdb->is_static) {
836                                 fdb->is_static = 0;
837                                 fdb_del_hw_addr(br, addr);
838                         }
839                 }
840
841                 modified = true;
842         }
843
844         if (is_sticky != fdb->is_sticky) {
845                 fdb->is_sticky = is_sticky;
846                 modified = true;
847         }
848
849         fdb->added_by_user = 1;
850
851         fdb->used = jiffies;
852         if (modified) {
853                 fdb->updated = jiffies;
854                 fdb_notify(br, fdb, RTM_NEWNEIGH, true);
855         }
856
857         return 0;
858 }
859
860 static int __br_fdb_add(struct ndmsg *ndm, struct net_bridge *br,
861                         struct net_bridge_port *p, const unsigned char *addr,
862                         u16 nlh_flags, u16 vid)
863 {
864         int err = 0;
865
866         if (ndm->ndm_flags & NTF_USE) {
867                 if (!p) {
868                         pr_info("bridge: RTM_NEWNEIGH %s with NTF_USE is not supported\n",
869                                 br->dev->name);
870                         return -EINVAL;
871                 }
872                 local_bh_disable();
873                 rcu_read_lock();
874                 br_fdb_update(br, p, addr, vid, true);
875                 rcu_read_unlock();
876                 local_bh_enable();
877         } else if (ndm->ndm_flags & NTF_EXT_LEARNED) {
878                 err = br_fdb_external_learn_add(br, p, addr, vid, true);
879         } else {
880                 spin_lock_bh(&br->hash_lock);
881                 err = fdb_add_entry(br, p, addr, ndm->ndm_state,
882                                     nlh_flags, vid, ndm->ndm_flags);
883                 spin_unlock_bh(&br->hash_lock);
884         }
885
886         return err;
887 }
888
889 /* Add new permanent fdb entry with RTM_NEWNEIGH */
890 int br_fdb_add(struct ndmsg *ndm, struct nlattr *tb[],
891                struct net_device *dev,
892                const unsigned char *addr, u16 vid, u16 nlh_flags)
893 {
894         struct net_bridge_vlan_group *vg;
895         struct net_bridge_port *p = NULL;
896         struct net_bridge_vlan *v;
897         struct net_bridge *br = NULL;
898         int err = 0;
899
900         trace_br_fdb_add(ndm, dev, addr, vid, nlh_flags);
901
902         if (!(ndm->ndm_state & (NUD_PERMANENT|NUD_NOARP|NUD_REACHABLE))) {
903                 pr_info("bridge: RTM_NEWNEIGH with invalid state %#x\n", ndm->ndm_state);
904                 return -EINVAL;
905         }
906
907         if (is_zero_ether_addr(addr)) {
908                 pr_info("bridge: RTM_NEWNEIGH with invalid ether address\n");
909                 return -EINVAL;
910         }
911
912         if (dev->priv_flags & IFF_EBRIDGE) {
913                 br = netdev_priv(dev);
914                 vg = br_vlan_group(br);
915         } else {
916                 p = br_port_get_rtnl(dev);
917                 if (!p) {
918                         pr_info("bridge: RTM_NEWNEIGH %s not a bridge port\n",
919                                 dev->name);
920                         return -EINVAL;
921                 }
922                 br = p->br;
923                 vg = nbp_vlan_group(p);
924         }
925
926         if (vid) {
927                 v = br_vlan_find(vg, vid);
928                 if (!v || !br_vlan_should_use(v)) {
929                         pr_info("bridge: RTM_NEWNEIGH with unconfigured vlan %d on %s\n", vid, dev->name);
930                         return -EINVAL;
931                 }
932
933                 /* VID was specified, so use it. */
934                 err = __br_fdb_add(ndm, br, p, addr, nlh_flags, vid);
935         } else {
936                 err = __br_fdb_add(ndm, br, p, addr, nlh_flags, 0);
937                 if (err || !vg || !vg->num_vlans)
938                         goto out;
939
940                 /* We have vlans configured on this port and user didn't
941                  * specify a VLAN.  To be nice, add/update entry for every
942                  * vlan on this port.
943                  */
944                 list_for_each_entry(v, &vg->vlan_list, vlist) {
945                         if (!br_vlan_should_use(v))
946                                 continue;
947                         err = __br_fdb_add(ndm, br, p, addr, nlh_flags, v->vid);
948                         if (err)
949                                 goto out;
950                 }
951         }
952
953 out:
954         return err;
955 }
956
957 static int fdb_delete_by_addr_and_port(struct net_bridge *br,
958                                        const struct net_bridge_port *p,
959                                        const u8 *addr, u16 vlan)
960 {
961         struct net_bridge_fdb_entry *fdb;
962
963         fdb = br_fdb_find(br, addr, vlan);
964         if (!fdb || fdb->dst != p)
965                 return -ENOENT;
966
967         fdb_delete(br, fdb, true);
968
969         return 0;
970 }
971
972 static int __br_fdb_delete(struct net_bridge *br,
973                            const struct net_bridge_port *p,
974                            const unsigned char *addr, u16 vid)
975 {
976         int err;
977
978         spin_lock_bh(&br->hash_lock);
979         err = fdb_delete_by_addr_and_port(br, p, addr, vid);
980         spin_unlock_bh(&br->hash_lock);
981
982         return err;
983 }
984
985 /* Remove neighbor entry with RTM_DELNEIGH */
986 int br_fdb_delete(struct ndmsg *ndm, struct nlattr *tb[],
987                   struct net_device *dev,
988                   const unsigned char *addr, u16 vid)
989 {
990         struct net_bridge_vlan_group *vg;
991         struct net_bridge_port *p = NULL;
992         struct net_bridge_vlan *v;
993         struct net_bridge *br;
994         int err;
995
996         if (dev->priv_flags & IFF_EBRIDGE) {
997                 br = netdev_priv(dev);
998                 vg = br_vlan_group(br);
999         } else {
1000                 p = br_port_get_rtnl(dev);
1001                 if (!p) {
1002                         pr_info("bridge: RTM_DELNEIGH %s not a bridge port\n",
1003                                 dev->name);
1004                         return -EINVAL;
1005                 }
1006                 vg = nbp_vlan_group(p);
1007                 br = p->br;
1008         }
1009
1010         if (vid) {
1011                 v = br_vlan_find(vg, vid);
1012                 if (!v) {
1013                         pr_info("bridge: RTM_DELNEIGH with unconfigured vlan %d on %s\n", vid, dev->name);
1014                         return -EINVAL;
1015                 }
1016
1017                 err = __br_fdb_delete(br, p, addr, vid);
1018         } else {
1019                 err = -ENOENT;
1020                 err &= __br_fdb_delete(br, p, addr, 0);
1021                 if (!vg || !vg->num_vlans)
1022                         return err;
1023
1024                 list_for_each_entry(v, &vg->vlan_list, vlist) {
1025                         if (!br_vlan_should_use(v))
1026                                 continue;
1027                         err &= __br_fdb_delete(br, p, addr, v->vid);
1028                 }
1029         }
1030
1031         return err;
1032 }
1033
1034 int br_fdb_sync_static(struct net_bridge *br, struct net_bridge_port *p)
1035 {
1036         struct net_bridge_fdb_entry *f, *tmp;
1037         int err = 0;
1038
1039         ASSERT_RTNL();
1040
1041         /* the key here is that static entries change only under rtnl */
1042         rcu_read_lock();
1043         hlist_for_each_entry_rcu(f, &br->fdb_list, fdb_node) {
1044                 /* We only care for static entries */
1045                 if (!f->is_static)
1046                         continue;
1047                 err = dev_uc_add(p->dev, f->key.addr.addr);
1048                 if (err)
1049                         goto rollback;
1050         }
1051 done:
1052         rcu_read_unlock();
1053
1054         return err;
1055
1056 rollback:
1057         hlist_for_each_entry_rcu(tmp, &br->fdb_list, fdb_node) {
1058                 /* We only care for static entries */
1059                 if (!tmp->is_static)
1060                         continue;
1061                 if (tmp == f)
1062                         break;
1063                 dev_uc_del(p->dev, tmp->key.addr.addr);
1064         }
1065
1066         goto done;
1067 }
1068
1069 void br_fdb_unsync_static(struct net_bridge *br, struct net_bridge_port *p)
1070 {
1071         struct net_bridge_fdb_entry *f;
1072
1073         ASSERT_RTNL();
1074
1075         rcu_read_lock();
1076         hlist_for_each_entry_rcu(f, &br->fdb_list, fdb_node) {
1077                 /* We only care for static entries */
1078                 if (!f->is_static)
1079                         continue;
1080
1081                 dev_uc_del(p->dev, f->key.addr.addr);
1082         }
1083         rcu_read_unlock();
1084 }
1085
1086 int br_fdb_external_learn_add(struct net_bridge *br, struct net_bridge_port *p,
1087                               const unsigned char *addr, u16 vid,
1088                               bool swdev_notify)
1089 {
1090         struct net_bridge_fdb_entry *fdb;
1091         bool modified = false;
1092         int err = 0;
1093
1094         trace_br_fdb_external_learn_add(br, p, addr, vid);
1095
1096         spin_lock_bh(&br->hash_lock);
1097
1098         fdb = br_fdb_find(br, addr, vid);
1099         if (!fdb) {
1100                 fdb = fdb_create(br, p, addr, vid, 0, 0);
1101                 if (!fdb) {
1102                         err = -ENOMEM;
1103                         goto err_unlock;
1104                 }
1105                 fdb->added_by_external_learn = 1;
1106                 fdb_notify(br, fdb, RTM_NEWNEIGH, swdev_notify);
1107         } else {
1108                 fdb->updated = jiffies;
1109
1110                 if (fdb->dst != p) {
1111                         fdb->dst = p;
1112                         modified = true;
1113                 }
1114
1115                 if (fdb->added_by_external_learn) {
1116                         /* Refresh entry */
1117                         fdb->used = jiffies;
1118                 } else if (!fdb->added_by_user) {
1119                         /* Take over SW learned entry */
1120                         fdb->added_by_external_learn = 1;
1121                         modified = true;
1122                 }
1123
1124                 if (modified)
1125                         fdb_notify(br, fdb, RTM_NEWNEIGH, swdev_notify);
1126         }
1127
1128 err_unlock:
1129         spin_unlock_bh(&br->hash_lock);
1130
1131         return err;
1132 }
1133
1134 int br_fdb_external_learn_del(struct net_bridge *br, struct net_bridge_port *p,
1135                               const unsigned char *addr, u16 vid,
1136                               bool swdev_notify)
1137 {
1138         struct net_bridge_fdb_entry *fdb;
1139         int err = 0;
1140
1141         spin_lock_bh(&br->hash_lock);
1142
1143         fdb = br_fdb_find(br, addr, vid);
1144         if (fdb && fdb->added_by_external_learn)
1145                 fdb_delete(br, fdb, swdev_notify);
1146         else
1147                 err = -ENOENT;
1148
1149         spin_unlock_bh(&br->hash_lock);
1150
1151         return err;
1152 }
1153
1154 void br_fdb_offloaded_set(struct net_bridge *br, struct net_bridge_port *p,
1155                           const unsigned char *addr, u16 vid, bool offloaded)
1156 {
1157         struct net_bridge_fdb_entry *fdb;
1158
1159         spin_lock_bh(&br->hash_lock);
1160
1161         fdb = br_fdb_find(br, addr, vid);
1162         if (fdb)
1163                 fdb->offloaded = offloaded;
1164
1165         spin_unlock_bh(&br->hash_lock);
1166 }