br_fdb.c 23.4 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15
/*
 *	Forwarding database
 *	Linux ethernet bridge
 *
 *	Authors:
 *	Lennert Buytenhek		<buytenh@gnu.org>
 *
 *	This program is free software; you can redistribute it and/or
 *	modify it under the terms of the GNU General Public License
 *	as published by the Free Software Foundation; either version
 *	2 of the License, or (at your option) any later version.
 */

#include <linux/kernel.h>
#include <linux/init.h>
16
#include <linux/rculist.h>
L
Linus Torvalds 已提交
17 18 19 20 21
#include <linux/spinlock.h>
#include <linux/times.h>
#include <linux/netdevice.h>
#include <linux/etherdevice.h>
#include <linux/jhash.h>
22
#include <linux/random.h>
23
#include <linux/slab.h>
A
Arun Sharma 已提交
24
#include <linux/atomic.h>
25
#include <asm/unaligned.h>
26
#include <linux/if_vlan.h>
L
Linus Torvalds 已提交
27 28
#include "br_private.h"

29
static struct kmem_cache *br_fdb_cache __read_mostly;
30 31 32
static struct net_bridge_fdb_entry *fdb_find(struct hlist_head *head,
					     const unsigned char *addr,
					     __u16 vid);
L
Linus Torvalds 已提交
33
static int fdb_insert(struct net_bridge *br, struct net_bridge_port *source,
34
		      const unsigned char *addr, u16 vid);
35 36
static void fdb_notify(struct net_bridge *br,
		       const struct net_bridge_fdb_entry *, int);
L
Linus Torvalds 已提交
37

38 39
static u32 fdb_salt __read_mostly;

40
int __init br_fdb_init(void)
L
Linus Torvalds 已提交
41 42 43 44
{
	br_fdb_cache = kmem_cache_create("bridge_fdb_cache",
					 sizeof(struct net_bridge_fdb_entry),
					 0,
45
					 SLAB_HWCACHE_ALIGN, NULL);
46 47 48
	if (!br_fdb_cache)
		return -ENOMEM;

49
	get_random_bytes(&fdb_salt, sizeof(fdb_salt));
50
	return 0;
L
Linus Torvalds 已提交
51 52
}

A
Andrew Morton 已提交
53
void br_fdb_fini(void)
L
Linus Torvalds 已提交
54 55 56 57 58 59 60 61
{
	kmem_cache_destroy(br_fdb_cache);
}


/* if topology_changing then use forward_delay (default 15 sec)
 * otherwise keep longer (default 5 minutes)
 */
62
static inline unsigned long hold_time(const struct net_bridge *br)
L
Linus Torvalds 已提交
63 64 65 66
{
	return br->topology_change ? br->forward_delay : br->ageing_time;
}

67
static inline int has_expired(const struct net_bridge *br,
L
Linus Torvalds 已提交
68 69
				  const struct net_bridge_fdb_entry *fdb)
{
70
	return !fdb->is_static &&
71
		time_before_eq(fdb->updated + hold_time(br), jiffies);
L
Linus Torvalds 已提交
72 73
}

74
static inline int br_mac_hash(const unsigned char *mac, __u16 vid)
L
Linus Torvalds 已提交
75
{
76
	/* use 1 byte of OUI and 3 bytes of NIC */
77
	u32 key = get_unaligned((u32 *)(mac + 2));
78
	return jhash_2words(key, vid, fdb_salt) & (BR_HASH_SIZE - 1);
L
Linus Torvalds 已提交
79 80
}

81 82 83 84 85 86 87
static void fdb_rcu_free(struct rcu_head *head)
{
	struct net_bridge_fdb_entry *ent
		= container_of(head, struct net_bridge_fdb_entry, rcu);
	kmem_cache_free(br_fdb_cache, ent);
}

88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134
/* When a static FDB entry is added, the mac address from the entry is
 * added to the bridge private HW address list and all required ports
 * are then updated with the new information.
 * Called under RTNL.
 */
static void fdb_add_hw(struct net_bridge *br, const unsigned char *addr)
{
	int err;
	struct net_bridge_port *p, *tmp;

	ASSERT_RTNL();

	list_for_each_entry(p, &br->port_list, list) {
		if (!br_promisc_port(p)) {
			err = dev_uc_add(p->dev, addr);
			if (err)
				goto undo;
		}
	}

	return;
undo:
	list_for_each_entry(tmp, &br->port_list, list) {
		if (tmp == p)
			break;
		if (!br_promisc_port(tmp))
			dev_uc_del(tmp->dev, addr);
	}
}

/* When a static FDB entry is deleted, the HW address from that entry is
 * also removed from the bridge private HW address list and updates all
 * the ports with needed information.
 * Called under RTNL.
 */
static void fdb_del_hw(struct net_bridge *br, const unsigned char *addr)
{
	struct net_bridge_port *p;

	ASSERT_RTNL();

	list_for_each_entry(p, &br->port_list, list) {
		if (!br_promisc_port(p))
			dev_uc_del(p->dev, addr);
	}
}

135
static void fdb_delete(struct net_bridge *br, struct net_bridge_fdb_entry *f)
L
Linus Torvalds 已提交
136
{
137 138 139
	if (f->is_static)
		fdb_del_hw(br, f->addr.addr);

L
Linus Torvalds 已提交
140
	hlist_del_rcu(&f->hlist);
141
	fdb_notify(br, f, RTM_DELNEIGH);
142
	call_rcu(&f->rcu, fdb_rcu_free);
L
Linus Torvalds 已提交
143 144
}

145 146 147 148 149 150 151 152 153 154 155 156 157 158
/* Delete a local entry if no other port had the same address. */
static void fdb_delete_local(struct net_bridge *br,
			     const struct net_bridge_port *p,
			     struct net_bridge_fdb_entry *f)
{
	const unsigned char *addr = f->addr.addr;
	u16 vid = f->vlan_id;
	struct net_bridge_port *op;

	/* Maybe another port has same hw addr? */
	list_for_each_entry(op, &br->port_list, list) {
		if (op != p && ether_addr_equal(op->dev->dev_addr, addr) &&
		    (!vid || nbp_vlan_find(op, vid))) {
			f->dst = op;
159
			f->added_by_user = 0;
160 161 162 163 164 165 166 167
			return;
		}
	}

	/* Maybe bridge device has same hw addr? */
	if (p && ether_addr_equal(br->dev->dev_addr, addr) &&
	    (!vid || br_vlan_find(br, vid))) {
		f->dst = NULL;
168
		f->added_by_user = 0;
169 170 171 172 173 174
		return;
	}

	fdb_delete(br, f);
}

175 176 177 178 179 180 181 182 183 184 185 186 187 188
void br_fdb_find_delete_local(struct net_bridge *br,
			      const struct net_bridge_port *p,
			      const unsigned char *addr, u16 vid)
{
	struct hlist_head *head = &br->hash[br_mac_hash(addr, vid)];
	struct net_bridge_fdb_entry *f;

	spin_lock_bh(&br->hash_lock);
	f = fdb_find(head, addr, vid);
	if (f && f->is_local && !f->added_by_user && f->dst == p)
		fdb_delete_local(br, p, f);
	spin_unlock_bh(&br->hash_lock);
}

L
Linus Torvalds 已提交
189 190 191
void br_fdb_changeaddr(struct net_bridge_port *p, const unsigned char *newaddr)
{
	struct net_bridge *br = p->br;
192 193
	struct net_port_vlans *pv = nbp_get_vlan_info(p);
	bool no_vlan = !pv;
L
Linus Torvalds 已提交
194
	int i;
195
	u16 vid;
196

L
Linus Torvalds 已提交
197 198 199 200 201 202 203 204 205
	spin_lock_bh(&br->hash_lock);

	/* Search all chains since old address/hash is unknown */
	for (i = 0; i < BR_HASH_SIZE; i++) {
		struct hlist_node *h;
		hlist_for_each(h, &br->hash[i]) {
			struct net_bridge_fdb_entry *f;

			f = hlist_entry(h, struct net_bridge_fdb_entry, hlist);
206
			if (f->dst == p && f->is_local && !f->added_by_user) {
L
Linus Torvalds 已提交
207
				/* delete old one */
208 209
				fdb_delete_local(br, p, f);

210 211 212 213 214
				/* if this port has no vlan information
				 * configured, we can safely be done at
				 * this point.
				 */
				if (no_vlan)
215
					goto insert;
L
Linus Torvalds 已提交
216 217 218 219
			}
		}
	}

220 221 222 223 224 225 226 227 228 229 230 231 232 233
insert:
	/* insert new address,  may fail if invalid address or dup. */
	fdb_insert(br, p, newaddr, 0);

	if (no_vlan)
		goto done;

	/* Now add entries for every VLAN configured on the port.
	 * This function runs under RTNL so the bitmap will not change
	 * from under us.
	 */
	for_each_set_bit(vid, pv->vlan_bitmap, VLAN_N_VID)
		fdb_insert(br, p, newaddr, vid);

234
done:
L
Linus Torvalds 已提交
235 236 237
	spin_unlock_bh(&br->hash_lock);
}

238 239 240
void br_fdb_change_mac_address(struct net_bridge *br, const u8 *newaddr)
{
	struct net_bridge_fdb_entry *f;
241 242
	struct net_port_vlans *pv;
	u16 vid = 0;
243

244 245
	spin_lock_bh(&br->hash_lock);

246
	/* If old entry was unassociated with any port, then delete it. */
247
	f = __br_fdb_get(br, br->dev->dev_addr, 0);
248
	if (f && f->is_local && !f->dst)
249
		fdb_delete_local(br, NULL, f);
250

251 252 253 254 255 256 257 258
	fdb_insert(br, NULL, newaddr, 0);

	/* Now remove and add entries for every VLAN configured on the
	 * bridge.  This function runs under RTNL so the bitmap will not
	 * change from under us.
	 */
	pv = br_get_vlan_info(br);
	if (!pv)
259
		goto out;
260

261
	for_each_set_bit_from(vid, pv->vlan_bitmap, VLAN_N_VID) {
262 263
		f = __br_fdb_get(br, br->dev->dev_addr, vid);
		if (f && f->is_local && !f->dst)
264
			fdb_delete_local(br, NULL, f);
265 266
		fdb_insert(br, NULL, newaddr, vid);
	}
267 268
out:
	spin_unlock_bh(&br->hash_lock);
269 270
}

L
Linus Torvalds 已提交
271 272 273 274
void br_fdb_cleanup(unsigned long _data)
{
	struct net_bridge *br = (struct net_bridge *)_data;
	unsigned long delay = hold_time(br);
275
	unsigned long next_timer = jiffies + br->ageing_time;
L
Linus Torvalds 已提交
276 277
	int i;

278
	spin_lock(&br->hash_lock);
L
Linus Torvalds 已提交
279 280
	for (i = 0; i < BR_HASH_SIZE; i++) {
		struct net_bridge_fdb_entry *f;
281
		struct hlist_node *n;
L
Linus Torvalds 已提交
282

283
		hlist_for_each_entry_safe(f, n, &br->hash[i], hlist) {
284 285 286
			unsigned long this_timer;
			if (f->is_static)
				continue;
287
			this_timer = f->updated + delay;
288
			if (time_before_eq(this_timer, jiffies))
289
				fdb_delete(br, f);
290
			else if (time_before(this_timer, next_timer))
291
				next_timer = this_timer;
L
Linus Torvalds 已提交
292 293
		}
	}
294
	spin_unlock(&br->hash_lock);
L
Linus Torvalds 已提交
295

296
	mod_timer(&br->gc_timer, round_jiffies_up(next_timer));
L
Linus Torvalds 已提交
297 298
}

299 300 301 302 303 304 305 306
/* Completely flush all dynamic entries in forwarding database.*/
void br_fdb_flush(struct net_bridge *br)
{
	int i;

	spin_lock_bh(&br->hash_lock);
	for (i = 0; i < BR_HASH_SIZE; i++) {
		struct net_bridge_fdb_entry *f;
307 308
		struct hlist_node *n;
		hlist_for_each_entry_safe(f, n, &br->hash[i], hlist) {
309
			if (!f->is_static)
310
				fdb_delete(br, f);
311 312 313 314
		}
	}
	spin_unlock_bh(&br->hash_lock);
}
315

L
Lucas De Marchi 已提交
316
/* Flush all entries referring to a specific port.
317 318
 * if do_all is set also flush static entries
 */
319 320 321
void br_fdb_delete_by_port(struct net_bridge *br,
			   const struct net_bridge_port *p,
			   int do_all)
L
Linus Torvalds 已提交
322 323 324 325 326 327
{
	int i;

	spin_lock_bh(&br->hash_lock);
	for (i = 0; i < BR_HASH_SIZE; i++) {
		struct hlist_node *h, *g;
328

L
Linus Torvalds 已提交
329 330 331
		hlist_for_each_safe(h, g, &br->hash[i]) {
			struct net_bridge_fdb_entry *f
				= hlist_entry(h, struct net_bridge_fdb_entry, hlist);
332
			if (f->dst != p)
L
Linus Torvalds 已提交
333 334
				continue;

335 336
			if (f->is_static && !do_all)
				continue;
L
Linus Torvalds 已提交
337

338 339 340 341
			if (f->is_local)
				fdb_delete_local(br, p, f);
			else
				fdb_delete(br, f);
L
Linus Torvalds 已提交
342 343 344 345 346
		}
	}
	spin_unlock_bh(&br->hash_lock);
}

347
/* No locking or refcounting, assumes caller has rcu_read_lock */
L
Linus Torvalds 已提交
348
struct net_bridge_fdb_entry *__br_fdb_get(struct net_bridge *br,
349 350
					  const unsigned char *addr,
					  __u16 vid)
L
Linus Torvalds 已提交
351 352 353
{
	struct net_bridge_fdb_entry *fdb;

354
	hlist_for_each_entry_rcu(fdb,
355 356 357
				&br->hash[br_mac_hash(addr, vid)], hlist) {
		if (ether_addr_equal(fdb->addr.addr, addr) &&
		    fdb->vlan_id == vid) {
L
Linus Torvalds 已提交
358 359 360 361 362 363 364 365 366
			if (unlikely(has_expired(br, fdb)))
				break;
			return fdb;
		}
	}

	return NULL;
}

I
Igor Maravić 已提交
367
#if IS_ENABLED(CONFIG_ATM_LANE)
368 369 370
/* Interface used by ATM LANE hook to test
 * if an addr is on some other bridge port */
int br_fdb_test_addr(struct net_device *dev, unsigned char *addr)
L
Linus Torvalds 已提交
371 372
{
	struct net_bridge_fdb_entry *fdb;
373
	struct net_bridge_port *port;
374 375
	int ret;

L
Linus Torvalds 已提交
376
	rcu_read_lock();
377 378 379 380
	port = br_port_get_rcu(dev);
	if (!port)
		ret = 0;
	else {
381
		fdb = __br_fdb_get(port->br, addr, 0);
382
		ret = fdb && fdb->dst && fdb->dst->dev != dev &&
383 384
			fdb->dst->state == BR_STATE_FORWARDING;
	}
L
Linus Torvalds 已提交
385 386
	rcu_read_unlock();

387
	return ret;
L
Linus Torvalds 已提交
388
}
389
#endif /* CONFIG_ATM_LANE */
L
Linus Torvalds 已提交
390 391

/*
392
 * Fill buffer with forwarding table records in
L
Linus Torvalds 已提交
393 394 395 396 397 398 399 400 401 402 403 404 405
 * the API format.
 */
int br_fdb_fillbuf(struct net_bridge *br, void *buf,
		   unsigned long maxnum, unsigned long skip)
{
	struct __fdb_entry *fe = buf;
	int i, num = 0;
	struct net_bridge_fdb_entry *f;

	memset(buf, 0, maxnum*sizeof(struct __fdb_entry));

	rcu_read_lock();
	for (i = 0; i < BR_HASH_SIZE; i++) {
406
		hlist_for_each_entry_rcu(f, &br->hash[i], hlist) {
L
Linus Torvalds 已提交
407 408 409
			if (num >= maxnum)
				goto out;

410
			if (has_expired(br, f))
L
Linus Torvalds 已提交
411 412
				continue;

413 414 415 416
			/* ignore pseudo entry for local MAC address */
			if (!f->dst)
				continue;

L
Linus Torvalds 已提交
417 418 419 420 421 422 423
			if (skip) {
				--skip;
				continue;
			}

			/* convert from internal format to API */
			memcpy(fe->mac_addr, f->addr.addr, ETH_ALEN);
424 425

			/* due to ABI compat need to split into hi/lo */
L
Linus Torvalds 已提交
426
			fe->port_no = f->dst->port_no;
427 428
			fe->port_hi = f->dst->port_no >> 8;

L
Linus Torvalds 已提交
429 430
			fe->is_local = f->is_local;
			if (!f->is_static)
431
				fe->ageing_timer_value = jiffies_delta_to_clock_t(jiffies - f->updated);
L
Linus Torvalds 已提交
432 433 434 435 436 437 438 439 440 441 442
			++fe;
			++num;
		}
	}

 out:
	rcu_read_unlock();

	return num;
}

443
static struct net_bridge_fdb_entry *fdb_find(struct hlist_head *head,
444 445
					     const unsigned char *addr,
					     __u16 vid)
446 447 448
{
	struct net_bridge_fdb_entry *fdb;

449
	hlist_for_each_entry(fdb, head, hlist) {
450 451
		if (ether_addr_equal(fdb->addr.addr, addr) &&
		    fdb->vlan_id == vid)
452 453 454 455 456 457
			return fdb;
	}
	return NULL;
}

static struct net_bridge_fdb_entry *fdb_find_rcu(struct hlist_head *head,
458 459
						 const unsigned char *addr,
						 __u16 vid)
L
Linus Torvalds 已提交
460 461 462
{
	struct net_bridge_fdb_entry *fdb;

463
	hlist_for_each_entry_rcu(fdb, head, hlist) {
464 465
		if (ether_addr_equal(fdb->addr.addr, addr) &&
		    fdb->vlan_id == vid)
L
Linus Torvalds 已提交
466 467 468 469 470 471 472
			return fdb;
	}
	return NULL;
}

static struct net_bridge_fdb_entry *fdb_create(struct hlist_head *head,
					       struct net_bridge_port *source,
473 474
					       const unsigned char *addr,
					       __u16 vid)
L
Linus Torvalds 已提交
475 476 477 478 479 480 481
{
	struct net_bridge_fdb_entry *fdb;

	fdb = kmem_cache_alloc(br_fdb_cache, GFP_ATOMIC);
	if (fdb) {
		memcpy(fdb->addr.addr, addr, ETH_ALEN);
		fdb->dst = source;
482
		fdb->vlan_id = vid;
483 484
		fdb->is_local = 0;
		fdb->is_static = 0;
485
		fdb->added_by_user = 0;
486
		fdb->updated = fdb->used = jiffies;
487
		hlist_add_head_rcu(&fdb->hlist, head);
L
Linus Torvalds 已提交
488 489 490 491 492
	}
	return fdb;
}

static int fdb_insert(struct net_bridge *br, struct net_bridge_port *source,
493
		  const unsigned char *addr, u16 vid)
L
Linus Torvalds 已提交
494
{
495
	struct hlist_head *head = &br->hash[br_mac_hash(addr, vid)];
L
Linus Torvalds 已提交
496 497 498 499 500
	struct net_bridge_fdb_entry *fdb;

	if (!is_valid_ether_addr(addr))
		return -EINVAL;

501
	fdb = fdb_find(head, addr, vid);
L
Linus Torvalds 已提交
502
	if (fdb) {
503
		/* it is okay to have multiple ports with same
L
Linus Torvalds 已提交
504 505
		 * address, just use the first one.
		 */
506
		if (fdb->is_local)
L
Linus Torvalds 已提交
507
			return 0;
508
		br_warn(br, "adding interface %s with same address "
L
Linus Torvalds 已提交
509
		       "as a received packet\n",
510
		       source ? source->dev->name : br->dev->name);
511
		fdb_delete(br, fdb);
512
	}
L
Linus Torvalds 已提交
513

514
	fdb = fdb_create(head, source, addr, vid);
515
	if (!fdb)
L
Linus Torvalds 已提交
516 517
		return -ENOMEM;

518
	fdb->is_local = fdb->is_static = 1;
519
	fdb_add_hw(br, addr);
520
	fdb_notify(br, fdb, RTM_NEWNEIGH);
L
Linus Torvalds 已提交
521 522 523
	return 0;
}

524
/* Add entry for local address of interface */
L
Linus Torvalds 已提交
525
int br_fdb_insert(struct net_bridge *br, struct net_bridge_port *source,
526
		  const unsigned char *addr, u16 vid)
L
Linus Torvalds 已提交
527 528 529 530
{
	int ret;

	spin_lock_bh(&br->hash_lock);
531
	ret = fdb_insert(br, source, addr, vid);
L
Linus Torvalds 已提交
532 533 534 535 536
	spin_unlock_bh(&br->hash_lock);
	return ret;
}

void br_fdb_update(struct net_bridge *br, struct net_bridge_port *source,
537
		   const unsigned char *addr, u16 vid, bool added_by_user)
L
Linus Torvalds 已提交
538
{
539
	struct hlist_head *head = &br->hash[br_mac_hash(addr, vid)];
L
Linus Torvalds 已提交
540
	struct net_bridge_fdb_entry *fdb;
541
	bool fdb_modified = false;
L
Linus Torvalds 已提交
542 543 544 545 546

	/* some users want to always flood. */
	if (hold_time(br) == 0)
		return;

547 548 549 550 551
	/* ignore packets unless we are using this port */
	if (!(source->state == BR_STATE_LEARNING ||
	      source->state == BR_STATE_FORWARDING))
		return;

552
	fdb = fdb_find_rcu(head, addr, vid);
L
Linus Torvalds 已提交
553 554 555
	if (likely(fdb)) {
		/* attempt to update an entry for a local interface */
		if (unlikely(fdb->is_local)) {
556
			if (net_ratelimit())
557 558 559
				br_warn(br, "received packet on %s with "
					"own address as source address\n",
					source->dev->name);
L
Linus Torvalds 已提交
560 561
		} else {
			/* fastpath: update of existing entry */
562 563 564 565
			if (unlikely(source != fdb->dst)) {
				fdb->dst = source;
				fdb_modified = true;
			}
566
			fdb->updated = jiffies;
567 568
			if (unlikely(added_by_user))
				fdb->added_by_user = 1;
569 570
			if (unlikely(fdb_modified))
				fdb_notify(br, fdb, RTM_NEWNEIGH);
L
Linus Torvalds 已提交
571 572
		}
	} else {
573
		spin_lock(&br->hash_lock);
574 575
		if (likely(!fdb_find(head, addr, vid))) {
			fdb = fdb_create(head, source, addr, vid);
576 577 578
			if (fdb) {
				if (unlikely(added_by_user))
					fdb->added_by_user = 1;
579
				fdb_notify(br, fdb, RTM_NEWNEIGH);
580
			}
S
stephen hemminger 已提交
581
		}
L
Linus Torvalds 已提交
582 583 584
		/* else  we lose race and someone else inserts
		 * it first, don't bother updating
		 */
585
		spin_unlock(&br->hash_lock);
L
Linus Torvalds 已提交
586 587
	}
}
588 589 590 591 592 593 594 595 596 597 598 599 600

static int fdb_to_nud(const struct net_bridge_fdb_entry *fdb)
{
	if (fdb->is_local)
		return NUD_PERMANENT;
	else if (fdb->is_static)
		return NUD_NOARP;
	else if (has_expired(fdb->dst->br, fdb))
		return NUD_STALE;
	else
		return NUD_REACHABLE;
}

601
static int fdb_fill_info(struct sk_buff *skb, const struct net_bridge *br,
602
			 const struct net_bridge_fdb_entry *fdb,
603
			 u32 portid, u32 seq, int type, unsigned int flags)
604 605 606 607 608 609
{
	unsigned long now = jiffies;
	struct nda_cacheinfo ci;
	struct nlmsghdr *nlh;
	struct ndmsg *ndm;

610
	nlh = nlmsg_put(skb, portid, seq, type, sizeof(*ndm), flags);
611 612 613 614 615 616 617 618 619
	if (nlh == NULL)
		return -EMSGSIZE;

	ndm = nlmsg_data(nlh);
	ndm->ndm_family	 = AF_BRIDGE;
	ndm->ndm_pad1    = 0;
	ndm->ndm_pad2    = 0;
	ndm->ndm_flags	 = 0;
	ndm->ndm_type	 = 0;
620
	ndm->ndm_ifindex = fdb->dst ? fdb->dst->dev->ifindex : br->dev->ifindex;
621 622
	ndm->ndm_state   = fdb_to_nud(fdb);

D
David S. Miller 已提交
623 624
	if (nla_put(skb, NDA_LLADDR, ETH_ALEN, &fdb->addr))
		goto nla_put_failure;
625 626
	if (nla_put_u32(skb, NDA_MASTER, br->dev->ifindex))
		goto nla_put_failure;
627 628 629 630
	ci.ndm_used	 = jiffies_to_clock_t(now - fdb->used);
	ci.ndm_confirmed = 0;
	ci.ndm_updated	 = jiffies_to_clock_t(now - fdb->updated);
	ci.ndm_refcnt	 = 0;
D
David S. Miller 已提交
631 632
	if (nla_put(skb, NDA_CACHEINFO, sizeof(ci), &ci))
		goto nla_put_failure;
633 634 635 636

	if (nla_put(skb, NDA_VLAN, sizeof(u16), &fdb->vlan_id))
		goto nla_put_failure;

637 638 639 640 641 642 643 644 645 646 647
	return nlmsg_end(skb, nlh);

nla_put_failure:
	nlmsg_cancel(skb, nlh);
	return -EMSGSIZE;
}

static inline size_t fdb_nlmsg_size(void)
{
	return NLMSG_ALIGN(sizeof(struct ndmsg))
		+ nla_total_size(ETH_ALEN) /* NDA_LLADDR */
648
		+ nla_total_size(sizeof(u32)) /* NDA_MASTER */
649
		+ nla_total_size(sizeof(u16)) /* NDA_VLAN */
650 651 652
		+ nla_total_size(sizeof(struct nda_cacheinfo));
}

653 654
static void fdb_notify(struct net_bridge *br,
		       const struct net_bridge_fdb_entry *fdb, int type)
655
{
656
	struct net *net = dev_net(br->dev);
657 658 659 660 661 662 663
	struct sk_buff *skb;
	int err = -ENOBUFS;

	skb = nlmsg_new(fdb_nlmsg_size(), GFP_ATOMIC);
	if (skb == NULL)
		goto errout;

664
	err = fdb_fill_info(skb, br, fdb, 0, 0, type, 0);
665 666 667 668 669 670 671 672 673
	if (err < 0) {
		/* -EMSGSIZE implies BUG in fdb_nlmsg_size() */
		WARN_ON(err == -EMSGSIZE);
		kfree_skb(skb);
		goto errout;
	}
	rtnl_notify(skb, net, 0, RTNLGRP_NEIGH, NULL, GFP_ATOMIC);
	return;
errout:
674
	rtnl_set_sk_err(net, RTNLGRP_NEIGH, err);
675 676 677
}

/* Dump information about entries, in response to GETNEIGH */
678 679 680 681
int br_fdb_dump(struct sk_buff *skb,
		struct netlink_callback *cb,
		struct net_device *dev,
		int idx)
682
{
683 684
	struct net_bridge *br = netdev_priv(dev);
	int i;
685

686 687
	if (!(dev->priv_flags & IFF_EBRIDGE))
		goto out;
688

689 690
	for (i = 0; i < BR_HASH_SIZE; i++) {
		struct net_bridge_fdb_entry *f;
691

692
		hlist_for_each_entry_rcu(f, &br->hash[i], hlist) {
693 694 695 696
			if (idx < cb->args[0])
				goto skip;

			if (fdb_fill_info(skb, br, f,
697
					  NETLINK_CB(cb->skb).portid,
698 699 700 701
					  cb->nlh->nlmsg_seq,
					  RTM_NEWNEIGH,
					  NLM_F_MULTI) < 0)
				break;
702
skip:
703
			++idx;
704 705 706
		}
	}

707 708
out:
	return idx;
709
}
710

S
stephen hemminger 已提交
711
/* Update (create or replace) forwarding database entry */
712
static int fdb_add_entry(struct net_bridge_port *source, const __u8 *addr,
713
			 __u16 state, __u16 flags, __u16 vid)
714 715
{
	struct net_bridge *br = source->br;
716
	struct hlist_head *head = &br->hash[br_mac_hash(addr, vid)];
717
	struct net_bridge_fdb_entry *fdb;
718
	bool modified = false;
719

720
	fdb = fdb_find(head, addr, vid);
721 722 723
	if (fdb == NULL) {
		if (!(flags & NLM_F_CREATE))
			return -ENOENT;
724

725
		fdb = fdb_create(head, source, addr, vid);
726 727
		if (!fdb)
			return -ENOMEM;
728 729

		modified = true;
730 731 732
	} else {
		if (flags & NLM_F_EXCL)
			return -EEXIST;
733 734 735 736 737

		if (fdb->dst != source) {
			fdb->dst = source;
			modified = true;
		}
S
stephen hemminger 已提交
738 739 740
	}

	if (fdb_to_nud(fdb) != state) {
741 742 743 744 745 746 747 748 749 750 751 752 753
		if (state & NUD_PERMANENT) {
			fdb->is_local = 1;
			if (!fdb->is_static) {
				fdb->is_static = 1;
				fdb_add_hw(br, addr);
			}
		} else if (state & NUD_NOARP) {
			fdb->is_local = 0;
			if (!fdb->is_static) {
				fdb->is_static = 1;
				fdb_add_hw(br, addr);
			}
		} else {
S
stephen hemminger 已提交
754
			fdb->is_local = 0;
755 756 757 758 759
			if (fdb->is_static) {
				fdb->is_static = 0;
				fdb_del_hw(br, addr);
			}
		}
760

761 762
		modified = true;
	}
763
	fdb->added_by_user = 1;
764 765 766 767

	fdb->used = jiffies;
	if (modified) {
		fdb->updated = jiffies;
768
		fdb_notify(br, fdb, RTM_NEWNEIGH);
769
	}
770 771 772 773

	return 0;
}

774 775 776 777 778 779 780
static int __br_fdb_add(struct ndmsg *ndm, struct net_bridge_port *p,
	       const unsigned char *addr, u16 nlh_flags, u16 vid)
{
	int err = 0;

	if (ndm->ndm_flags & NTF_USE) {
		rcu_read_lock();
781
		br_fdb_update(p->br, p, addr, vid, true);
782 783 784 785 786 787 788 789 790 791 792
		rcu_read_unlock();
	} else {
		spin_lock_bh(&p->br->hash_lock);
		err = fdb_add_entry(p, addr, ndm->ndm_state,
				    nlh_flags, vid);
		spin_unlock_bh(&p->br->hash_lock);
	}

	return err;
}

793
/* Add new permanent fdb entry with RTM_NEWNEIGH */
794 795
int br_fdb_add(struct ndmsg *ndm, struct nlattr *tb[],
	       struct net_device *dev,
796
	       const unsigned char *addr, u16 nlh_flags)
797 798
{
	struct net_bridge_port *p;
799
	int err = 0;
800 801
	struct net_port_vlans *pv;
	unsigned short vid = VLAN_N_VID;
802

S
stephen hemminger 已提交
803 804 805 806 807
	if (!(ndm->ndm_state & (NUD_PERMANENT|NUD_NOARP|NUD_REACHABLE))) {
		pr_info("bridge: RTM_NEWNEIGH with invalid state %#x\n", ndm->ndm_state);
		return -EINVAL;
	}

808 809 810 811 812 813 814 815
	if (tb[NDA_VLAN]) {
		if (nla_len(tb[NDA_VLAN]) != sizeof(unsigned short)) {
			pr_info("bridge: RTM_NEWNEIGH with invalid vlan\n");
			return -EINVAL;
		}

		vid = nla_get_u16(tb[NDA_VLAN]);

816
		if (!vid || vid >= VLAN_VID_MASK) {
817 818 819 820 821 822
			pr_info("bridge: RTM_NEWNEIGH with invalid vlan id %d\n",
				vid);
			return -EINVAL;
		}
	}

823 824 825 826 827
	if (is_zero_ether_addr(addr)) {
		pr_info("bridge: RTM_NEWNEIGH with invalid ether address\n");
		return -EINVAL;
	}

828 829 830 831 832 833 834
	p = br_port_get_rtnl(dev);
	if (p == NULL) {
		pr_info("bridge: RTM_NEWNEIGH %s not a bridge port\n",
			dev->name);
		return -EINVAL;
	}

835 836 837 838 839 840 841 842 843 844
	pv = nbp_get_vlan_info(p);
	if (vid != VLAN_N_VID) {
		if (!pv || !test_bit(vid, pv->vlan_bitmap)) {
			pr_info("bridge: RTM_NEWNEIGH with unconfigured "
				"vlan %d on port %s\n", vid, dev->name);
			return -EINVAL;
		}

		/* VID was specified, so use it. */
		err = __br_fdb_add(ndm, p, addr, nlh_flags, vid);
S
stephen hemminger 已提交
845
	} else {
846
		if (!pv || bitmap_empty(pv->vlan_bitmap, VLAN_N_VID)) {
847 848 849 850 851 852 853 854
			err = __br_fdb_add(ndm, p, addr, nlh_flags, 0);
			goto out;
		}

		/* We have vlans configured on this port and user didn't
		 * specify a VLAN.  To be nice, add/update entry for every
		 * vlan on this port.
		 */
855
		for_each_set_bit(vid, pv->vlan_bitmap, VLAN_N_VID) {
856 857 858 859
			err = __br_fdb_add(ndm, p, addr, nlh_flags, vid);
			if (err)
				goto out;
		}
S
stephen hemminger 已提交
860
	}
861

862
out:
863 864 865
	return err;
}

866
static int fdb_delete_by_addr(struct net_bridge *br, const u8 *addr, u16 vlan)
867
{
868
	struct hlist_head *head = &br->hash[br_mac_hash(addr, vlan)];
869 870
	struct net_bridge_fdb_entry *fdb;

871
	fdb = fdb_find(head, addr, vlan);
872 873 874
	if (!fdb)
		return -ENOENT;

875
	fdb_delete(br, fdb);
876 877 878
	return 0;
}

879 880 881 882 883 884 885 886 887 888 889 890
static int __br_fdb_delete(struct net_bridge_port *p,
			   const unsigned char *addr, u16 vid)
{
	int err;

	spin_lock_bh(&p->br->hash_lock);
	err = fdb_delete_by_addr(p->br, addr, vid);
	spin_unlock_bh(&p->br->hash_lock);

	return err;
}

891
/* Remove neighbor entry with RTM_DELNEIGH */
892 893
int br_fdb_delete(struct ndmsg *ndm, struct nlattr *tb[],
		  struct net_device *dev,
894
		  const unsigned char *addr)
895 896 897
{
	struct net_bridge_port *p;
	int err;
898 899
	struct net_port_vlans *pv;
	unsigned short vid = VLAN_N_VID;
900

901 902 903 904 905 906 907 908
	if (tb[NDA_VLAN]) {
		if (nla_len(tb[NDA_VLAN]) != sizeof(unsigned short)) {
			pr_info("bridge: RTM_NEWNEIGH with invalid vlan\n");
			return -EINVAL;
		}

		vid = nla_get_u16(tb[NDA_VLAN]);

909
		if (!vid || vid >= VLAN_VID_MASK) {
910 911 912 913 914
			pr_info("bridge: RTM_NEWNEIGH with invalid vlan id %d\n",
				vid);
			return -EINVAL;
		}
	}
915 916 917 918 919 920 921
	p = br_port_get_rtnl(dev);
	if (p == NULL) {
		pr_info("bridge: RTM_DELNEIGH %s not a bridge port\n",
			dev->name);
		return -EINVAL;
	}

922 923 924 925 926 927 928
	pv = nbp_get_vlan_info(p);
	if (vid != VLAN_N_VID) {
		if (!pv || !test_bit(vid, pv->vlan_bitmap)) {
			pr_info("bridge: RTM_DELNEIGH with unconfigured "
				"vlan %d on port %s\n", vid, dev->name);
			return -EINVAL;
		}
929

930 931
		err = __br_fdb_delete(p, addr, vid);
	} else {
932
		if (!pv || bitmap_empty(pv->vlan_bitmap, VLAN_N_VID)) {
933 934 935 936 937 938 939 940 941
			err = __br_fdb_delete(p, addr, 0);
			goto out;
		}

		/* We have vlans configured on this port and user didn't
		 * specify a VLAN.  To be nice, add/update entry for every
		 * vlan on this port.
		 */
		err = -ENOENT;
942
		for_each_set_bit(vid, pv->vlan_bitmap, VLAN_N_VID) {
943 944 945 946
			err &= __br_fdb_delete(p, addr, vid);
		}
	}
out:
947 948
	return err;
}
949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004

int br_fdb_sync_static(struct net_bridge *br, struct net_bridge_port *p)
{
	struct net_bridge_fdb_entry *fdb, *tmp;
	int i;
	int err;

	ASSERT_RTNL();

	for (i = 0; i < BR_HASH_SIZE; i++) {
		hlist_for_each_entry(fdb, &br->hash[i], hlist) {
			/* We only care for static entries */
			if (!fdb->is_static)
				continue;

			err = dev_uc_add(p->dev, fdb->addr.addr);
			if (err)
				goto rollback;
		}
	}
	return 0;

rollback:
	for (i = 0; i < BR_HASH_SIZE; i++) {
		hlist_for_each_entry(tmp, &br->hash[i], hlist) {
			/* If we reached the fdb that failed, we can stop */
			if (tmp == fdb)
				break;

			/* We only care for static entries */
			if (!tmp->is_static)
				continue;

			dev_uc_del(p->dev, tmp->addr.addr);
		}
	}
	return err;
}

void br_fdb_unsync_static(struct net_bridge *br, struct net_bridge_port *p)
{
	struct net_bridge_fdb_entry *fdb;
	int i;

	ASSERT_RTNL();

	for (i = 0; i < BR_HASH_SIZE; i++) {
		hlist_for_each_entry_rcu(fdb, &br->hash[i], hlist) {
			/* We only care for static entries */
			if (!fdb->is_static)
				continue;

			dev_uc_del(p->dev, fdb->addr.addr);
		}
	}
}