xref: /openbmc/linux/net/bridge/br_netlink.c (revision 93df8a1e)
1 /*
2  *	Bridge netlink control interface
3  *
4  *	Authors:
5  *	Stephen Hemminger		<shemminger@osdl.org>
6  *
7  *	This program is free software; you can redistribute it and/or
8  *	modify it under the terms of the GNU General Public License
9  *	as published by the Free Software Foundation; either version
10  *	2 of the License, or (at your option) any later version.
11  */
12 
13 #include <linux/kernel.h>
14 #include <linux/slab.h>
15 #include <linux/etherdevice.h>
16 #include <net/rtnetlink.h>
17 #include <net/net_namespace.h>
18 #include <net/sock.h>
19 #include <net/switchdev.h>
20 #include <uapi/linux/if_bridge.h>
21 
22 #include "br_private.h"
23 #include "br_private_stp.h"
24 
25 static int br_get_num_vlan_infos(const struct net_port_vlans *pv,
26 				 u32 filter_mask)
27 {
28 	u16 vid_range_start = 0, vid_range_end = 0;
29 	u16 vid_range_flags = 0;
30 	u16 pvid, vid, flags;
31 	int num_vlans = 0;
32 
33 	if (filter_mask & RTEXT_FILTER_BRVLAN)
34 		return pv->num_vlans;
35 
36 	if (!(filter_mask & RTEXT_FILTER_BRVLAN_COMPRESSED))
37 		return 0;
38 
39 	/* Count number of vlan info's
40 	 */
41 	pvid = br_get_pvid(pv);
42 	for_each_set_bit(vid, pv->vlan_bitmap, VLAN_N_VID) {
43 		flags = 0;
44 		if (vid == pvid)
45 			flags |= BRIDGE_VLAN_INFO_PVID;
46 
47 		if (test_bit(vid, pv->untagged_bitmap))
48 			flags |= BRIDGE_VLAN_INFO_UNTAGGED;
49 
50 		if (vid_range_start == 0) {
51 			goto initvars;
52 		} else if ((vid - vid_range_end) == 1 &&
53 			flags == vid_range_flags) {
54 			vid_range_end = vid;
55 			continue;
56 		} else {
57 			if ((vid_range_end - vid_range_start) > 0)
58 				num_vlans += 2;
59 			else
60 				num_vlans += 1;
61 		}
62 initvars:
63 		vid_range_start = vid;
64 		vid_range_end = vid;
65 		vid_range_flags = flags;
66 	}
67 
68 	if (vid_range_start != 0) {
69 		if ((vid_range_end - vid_range_start) > 0)
70 			num_vlans += 2;
71 		else
72 			num_vlans += 1;
73 	}
74 
75 	return num_vlans;
76 }
77 
78 static size_t br_get_link_af_size_filtered(const struct net_device *dev,
79 					   u32 filter_mask)
80 {
81 	struct net_port_vlans *pv;
82 	int num_vlan_infos;
83 
84 	rcu_read_lock();
85 	if (br_port_exists(dev))
86 		pv = nbp_get_vlan_info(br_port_get_rcu(dev));
87 	else if (dev->priv_flags & IFF_EBRIDGE)
88 		pv = br_get_vlan_info((struct net_bridge *)netdev_priv(dev));
89 	else
90 		pv = NULL;
91 	if (pv)
92 		num_vlan_infos = br_get_num_vlan_infos(pv, filter_mask);
93 	else
94 		num_vlan_infos = 0;
95 	rcu_read_unlock();
96 
97 	if (!num_vlan_infos)
98 		return 0;
99 
100 	/* Each VLAN is returned in bridge_vlan_info along with flags */
101 	return num_vlan_infos * nla_total_size(sizeof(struct bridge_vlan_info));
102 }
103 
104 static inline size_t br_port_info_size(void)
105 {
106 	return nla_total_size(1)	/* IFLA_BRPORT_STATE  */
107 		+ nla_total_size(2)	/* IFLA_BRPORT_PRIORITY */
108 		+ nla_total_size(4)	/* IFLA_BRPORT_COST */
109 		+ nla_total_size(1)	/* IFLA_BRPORT_MODE */
110 		+ nla_total_size(1)	/* IFLA_BRPORT_GUARD */
111 		+ nla_total_size(1)	/* IFLA_BRPORT_PROTECT */
112 		+ nla_total_size(1)	/* IFLA_BRPORT_FAST_LEAVE */
113 		+ nla_total_size(1)	/* IFLA_BRPORT_LEARNING */
114 		+ nla_total_size(1)	/* IFLA_BRPORT_UNICAST_FLOOD */
115 		+ 0;
116 }
117 
118 static inline size_t br_nlmsg_size(struct net_device *dev, u32 filter_mask)
119 {
120 	return NLMSG_ALIGN(sizeof(struct ifinfomsg))
121 		+ nla_total_size(IFNAMSIZ) /* IFLA_IFNAME */
122 		+ nla_total_size(MAX_ADDR_LEN) /* IFLA_ADDRESS */
123 		+ nla_total_size(4) /* IFLA_MASTER */
124 		+ nla_total_size(4) /* IFLA_MTU */
125 		+ nla_total_size(4) /* IFLA_LINK */
126 		+ nla_total_size(1) /* IFLA_OPERSTATE */
127 		+ nla_total_size(br_port_info_size()) /* IFLA_PROTINFO */
128 		+ nla_total_size(br_get_link_af_size_filtered(dev,
129 				 filter_mask)); /* IFLA_AF_SPEC */
130 }
131 
132 static int br_port_fill_attrs(struct sk_buff *skb,
133 			      const struct net_bridge_port *p)
134 {
135 	u8 mode = !!(p->flags & BR_HAIRPIN_MODE);
136 
137 	if (nla_put_u8(skb, IFLA_BRPORT_STATE, p->state) ||
138 	    nla_put_u16(skb, IFLA_BRPORT_PRIORITY, p->priority) ||
139 	    nla_put_u32(skb, IFLA_BRPORT_COST, p->path_cost) ||
140 	    nla_put_u8(skb, IFLA_BRPORT_MODE, mode) ||
141 	    nla_put_u8(skb, IFLA_BRPORT_GUARD, !!(p->flags & BR_BPDU_GUARD)) ||
142 	    nla_put_u8(skb, IFLA_BRPORT_PROTECT, !!(p->flags & BR_ROOT_BLOCK)) ||
143 	    nla_put_u8(skb, IFLA_BRPORT_FAST_LEAVE, !!(p->flags & BR_MULTICAST_FAST_LEAVE)) ||
144 	    nla_put_u8(skb, IFLA_BRPORT_LEARNING, !!(p->flags & BR_LEARNING)) ||
145 	    nla_put_u8(skb, IFLA_BRPORT_UNICAST_FLOOD, !!(p->flags & BR_FLOOD)) ||
146 	    nla_put_u8(skb, IFLA_BRPORT_PROXYARP, !!(p->flags & BR_PROXYARP)) ||
147 	    nla_put_u8(skb, IFLA_BRPORT_PROXYARP_WIFI,
148 		       !!(p->flags & BR_PROXYARP_WIFI)))
149 		return -EMSGSIZE;
150 
151 	return 0;
152 }
153 
154 static int br_fill_ifvlaninfo_range(struct sk_buff *skb, u16 vid_start,
155 				    u16 vid_end, u16 flags)
156 {
157 	struct  bridge_vlan_info vinfo;
158 
159 	if ((vid_end - vid_start) > 0) {
160 		/* add range to skb */
161 		vinfo.vid = vid_start;
162 		vinfo.flags = flags | BRIDGE_VLAN_INFO_RANGE_BEGIN;
163 		if (nla_put(skb, IFLA_BRIDGE_VLAN_INFO,
164 			    sizeof(vinfo), &vinfo))
165 			goto nla_put_failure;
166 
167 		vinfo.flags &= ~BRIDGE_VLAN_INFO_RANGE_BEGIN;
168 
169 		vinfo.vid = vid_end;
170 		vinfo.flags = flags | BRIDGE_VLAN_INFO_RANGE_END;
171 		if (nla_put(skb, IFLA_BRIDGE_VLAN_INFO,
172 			    sizeof(vinfo), &vinfo))
173 			goto nla_put_failure;
174 	} else {
175 		vinfo.vid = vid_start;
176 		vinfo.flags = flags;
177 		if (nla_put(skb, IFLA_BRIDGE_VLAN_INFO,
178 			    sizeof(vinfo), &vinfo))
179 			goto nla_put_failure;
180 	}
181 
182 	return 0;
183 
184 nla_put_failure:
185 	return -EMSGSIZE;
186 }
187 
188 static int br_fill_ifvlaninfo_compressed(struct sk_buff *skb,
189 					 const struct net_port_vlans *pv)
190 {
191 	u16 vid_range_start = 0, vid_range_end = 0;
192 	u16 vid_range_flags = 0;
193 	u16 pvid, vid, flags;
194 	int err = 0;
195 
196 	/* Pack IFLA_BRIDGE_VLAN_INFO's for every vlan
197 	 * and mark vlan info with begin and end flags
198 	 * if vlaninfo represents a range
199 	 */
200 	pvid = br_get_pvid(pv);
201 	for_each_set_bit(vid, pv->vlan_bitmap, VLAN_N_VID) {
202 		flags = 0;
203 		if (vid == pvid)
204 			flags |= BRIDGE_VLAN_INFO_PVID;
205 
206 		if (test_bit(vid, pv->untagged_bitmap))
207 			flags |= BRIDGE_VLAN_INFO_UNTAGGED;
208 
209 		if (vid_range_start == 0) {
210 			goto initvars;
211 		} else if ((vid - vid_range_end) == 1 &&
212 			flags == vid_range_flags) {
213 			vid_range_end = vid;
214 			continue;
215 		} else {
216 			err = br_fill_ifvlaninfo_range(skb, vid_range_start,
217 						       vid_range_end,
218 						       vid_range_flags);
219 			if (err)
220 				return err;
221 		}
222 
223 initvars:
224 		vid_range_start = vid;
225 		vid_range_end = vid;
226 		vid_range_flags = flags;
227 	}
228 
229 	if (vid_range_start != 0) {
230 		/* Call it once more to send any left over vlans */
231 		err = br_fill_ifvlaninfo_range(skb, vid_range_start,
232 					       vid_range_end,
233 					       vid_range_flags);
234 		if (err)
235 			return err;
236 	}
237 
238 	return 0;
239 }
240 
241 static int br_fill_ifvlaninfo(struct sk_buff *skb,
242 			      const struct net_port_vlans *pv)
243 {
244 	struct bridge_vlan_info vinfo;
245 	u16 pvid, vid;
246 
247 	pvid = br_get_pvid(pv);
248 	for_each_set_bit(vid, pv->vlan_bitmap, VLAN_N_VID) {
249 		vinfo.vid = vid;
250 		vinfo.flags = 0;
251 		if (vid == pvid)
252 			vinfo.flags |= BRIDGE_VLAN_INFO_PVID;
253 
254 		if (test_bit(vid, pv->untagged_bitmap))
255 			vinfo.flags |= BRIDGE_VLAN_INFO_UNTAGGED;
256 
257 		if (nla_put(skb, IFLA_BRIDGE_VLAN_INFO,
258 			    sizeof(vinfo), &vinfo))
259 			goto nla_put_failure;
260 	}
261 
262 	return 0;
263 
264 nla_put_failure:
265 	return -EMSGSIZE;
266 }
267 
268 /*
269  * Create one netlink message for one interface
270  * Contains port and master info as well as carrier and bridge state.
271  */
272 static int br_fill_ifinfo(struct sk_buff *skb,
273 			  const struct net_bridge_port *port,
274 			  u32 pid, u32 seq, int event, unsigned int flags,
275 			  u32 filter_mask, const struct net_device *dev)
276 {
277 	const struct net_bridge *br;
278 	struct ifinfomsg *hdr;
279 	struct nlmsghdr *nlh;
280 	u8 operstate = netif_running(dev) ? dev->operstate : IF_OPER_DOWN;
281 
282 	if (port)
283 		br = port->br;
284 	else
285 		br = netdev_priv(dev);
286 
287 	br_debug(br, "br_fill_info event %d port %s master %s\n",
288 		     event, dev->name, br->dev->name);
289 
290 	nlh = nlmsg_put(skb, pid, seq, event, sizeof(*hdr), flags);
291 	if (nlh == NULL)
292 		return -EMSGSIZE;
293 
294 	hdr = nlmsg_data(nlh);
295 	hdr->ifi_family = AF_BRIDGE;
296 	hdr->__ifi_pad = 0;
297 	hdr->ifi_type = dev->type;
298 	hdr->ifi_index = dev->ifindex;
299 	hdr->ifi_flags = dev_get_flags(dev);
300 	hdr->ifi_change = 0;
301 
302 	if (nla_put_string(skb, IFLA_IFNAME, dev->name) ||
303 	    nla_put_u32(skb, IFLA_MASTER, br->dev->ifindex) ||
304 	    nla_put_u32(skb, IFLA_MTU, dev->mtu) ||
305 	    nla_put_u8(skb, IFLA_OPERSTATE, operstate) ||
306 	    (dev->addr_len &&
307 	     nla_put(skb, IFLA_ADDRESS, dev->addr_len, dev->dev_addr)) ||
308 	    (dev->ifindex != dev_get_iflink(dev) &&
309 	     nla_put_u32(skb, IFLA_LINK, dev_get_iflink(dev))))
310 		goto nla_put_failure;
311 
312 	if (event == RTM_NEWLINK && port) {
313 		struct nlattr *nest
314 			= nla_nest_start(skb, IFLA_PROTINFO | NLA_F_NESTED);
315 
316 		if (nest == NULL || br_port_fill_attrs(skb, port) < 0)
317 			goto nla_put_failure;
318 		nla_nest_end(skb, nest);
319 	}
320 
321 	/* Check if  the VID information is requested */
322 	if ((filter_mask & RTEXT_FILTER_BRVLAN) ||
323 	    (filter_mask & RTEXT_FILTER_BRVLAN_COMPRESSED)) {
324 		const struct net_port_vlans *pv;
325 		struct nlattr *af;
326 		int err;
327 
328 		if (port)
329 			pv = nbp_get_vlan_info(port);
330 		else
331 			pv = br_get_vlan_info(br);
332 
333 		if (!pv || bitmap_empty(pv->vlan_bitmap, VLAN_N_VID))
334 			goto done;
335 
336 		af = nla_nest_start(skb, IFLA_AF_SPEC);
337 		if (!af)
338 			goto nla_put_failure;
339 
340 		if (filter_mask & RTEXT_FILTER_BRVLAN_COMPRESSED)
341 			err = br_fill_ifvlaninfo_compressed(skb, pv);
342 		else
343 			err = br_fill_ifvlaninfo(skb, pv);
344 		if (err)
345 			goto nla_put_failure;
346 		nla_nest_end(skb, af);
347 	}
348 
349 done:
350 	nlmsg_end(skb, nlh);
351 	return 0;
352 
353 nla_put_failure:
354 	nlmsg_cancel(skb, nlh);
355 	return -EMSGSIZE;
356 }
357 
358 /*
359  * Notify listeners of a change in port information
360  */
361 void br_ifinfo_notify(int event, struct net_bridge_port *port)
362 {
363 	struct net *net;
364 	struct sk_buff *skb;
365 	int err = -ENOBUFS;
366 	u32 filter = RTEXT_FILTER_BRVLAN_COMPRESSED;
367 
368 	if (!port)
369 		return;
370 
371 	net = dev_net(port->dev);
372 	br_debug(port->br, "port %u(%s) event %d\n",
373 		 (unsigned int)port->port_no, port->dev->name, event);
374 
375 	skb = nlmsg_new(br_nlmsg_size(port->dev, filter), GFP_ATOMIC);
376 	if (skb == NULL)
377 		goto errout;
378 
379 	err = br_fill_ifinfo(skb, port, 0, 0, event, 0, filter, port->dev);
380 	if (err < 0) {
381 		/* -EMSGSIZE implies BUG in br_nlmsg_size() */
382 		WARN_ON(err == -EMSGSIZE);
383 		kfree_skb(skb);
384 		goto errout;
385 	}
386 	rtnl_notify(skb, net, 0, RTNLGRP_LINK, NULL, GFP_ATOMIC);
387 	return;
388 errout:
389 	rtnl_set_sk_err(net, RTNLGRP_LINK, err);
390 }
391 
392 
393 /*
394  * Dump information about all ports, in response to GETLINK
395  */
396 int br_getlink(struct sk_buff *skb, u32 pid, u32 seq,
397 	       struct net_device *dev, u32 filter_mask, int nlflags)
398 {
399 	struct net_bridge_port *port = br_port_get_rtnl(dev);
400 
401 	if (!port && !(filter_mask & RTEXT_FILTER_BRVLAN) &&
402 	    !(filter_mask & RTEXT_FILTER_BRVLAN_COMPRESSED))
403 		return 0;
404 
405 	return br_fill_ifinfo(skb, port, pid, seq, RTM_NEWLINK, nlflags,
406 			      filter_mask, dev);
407 }
408 
409 static int br_vlan_info(struct net_bridge *br, struct net_bridge_port *p,
410 			int cmd, struct bridge_vlan_info *vinfo)
411 {
412 	int err = 0;
413 
414 	switch (cmd) {
415 	case RTM_SETLINK:
416 		if (p) {
417 			err = nbp_vlan_add(p, vinfo->vid, vinfo->flags);
418 			if (err)
419 				break;
420 
421 			if (vinfo->flags & BRIDGE_VLAN_INFO_MASTER)
422 				err = br_vlan_add(p->br, vinfo->vid,
423 						  vinfo->flags);
424 		} else {
425 			err = br_vlan_add(br, vinfo->vid, vinfo->flags);
426 		}
427 		break;
428 
429 	case RTM_DELLINK:
430 		if (p) {
431 			nbp_vlan_delete(p, vinfo->vid);
432 			if (vinfo->flags & BRIDGE_VLAN_INFO_MASTER)
433 				br_vlan_delete(p->br, vinfo->vid);
434 		} else {
435 			br_vlan_delete(br, vinfo->vid);
436 		}
437 		break;
438 	}
439 
440 	return err;
441 }
442 
443 static int br_afspec(struct net_bridge *br,
444 		     struct net_bridge_port *p,
445 		     struct nlattr *af_spec,
446 		     int cmd)
447 {
448 	struct bridge_vlan_info *vinfo_start = NULL;
449 	struct bridge_vlan_info *vinfo = NULL;
450 	struct nlattr *attr;
451 	int err = 0;
452 	int rem;
453 
454 	nla_for_each_nested(attr, af_spec, rem) {
455 		if (nla_type(attr) != IFLA_BRIDGE_VLAN_INFO)
456 			continue;
457 		if (nla_len(attr) != sizeof(struct bridge_vlan_info))
458 			return -EINVAL;
459 		vinfo = nla_data(attr);
460 		if (!vinfo->vid || vinfo->vid >= VLAN_VID_MASK)
461 			return -EINVAL;
462 		if (vinfo->flags & BRIDGE_VLAN_INFO_RANGE_BEGIN) {
463 			if (vinfo_start)
464 				return -EINVAL;
465 			vinfo_start = vinfo;
466 			continue;
467 		}
468 
469 		if (vinfo_start) {
470 			struct bridge_vlan_info tmp_vinfo;
471 			int v;
472 
473 			if (!(vinfo->flags & BRIDGE_VLAN_INFO_RANGE_END))
474 				return -EINVAL;
475 
476 			if (vinfo->vid <= vinfo_start->vid)
477 				return -EINVAL;
478 
479 			memcpy(&tmp_vinfo, vinfo_start,
480 			       sizeof(struct bridge_vlan_info));
481 
482 			for (v = vinfo_start->vid; v <= vinfo->vid; v++) {
483 				tmp_vinfo.vid = v;
484 				err = br_vlan_info(br, p, cmd, &tmp_vinfo);
485 				if (err)
486 					break;
487 			}
488 			vinfo_start = NULL;
489 		} else {
490 			err = br_vlan_info(br, p, cmd, vinfo);
491 		}
492 		if (err)
493 			break;
494 	}
495 
496 	return err;
497 }
498 
499 static const struct nla_policy br_port_policy[IFLA_BRPORT_MAX + 1] = {
500 	[IFLA_BRPORT_STATE]	= { .type = NLA_U8 },
501 	[IFLA_BRPORT_COST]	= { .type = NLA_U32 },
502 	[IFLA_BRPORT_PRIORITY]	= { .type = NLA_U16 },
503 	[IFLA_BRPORT_MODE]	= { .type = NLA_U8 },
504 	[IFLA_BRPORT_GUARD]	= { .type = NLA_U8 },
505 	[IFLA_BRPORT_PROTECT]	= { .type = NLA_U8 },
506 	[IFLA_BRPORT_FAST_LEAVE]= { .type = NLA_U8 },
507 	[IFLA_BRPORT_LEARNING]	= { .type = NLA_U8 },
508 	[IFLA_BRPORT_UNICAST_FLOOD] = { .type = NLA_U8 },
509 };
510 
511 /* Change the state of the port and notify spanning tree */
512 static int br_set_port_state(struct net_bridge_port *p, u8 state)
513 {
514 	if (state > BR_STATE_BLOCKING)
515 		return -EINVAL;
516 
517 	/* if kernel STP is running, don't allow changes */
518 	if (p->br->stp_enabled == BR_KERNEL_STP)
519 		return -EBUSY;
520 
521 	/* if device is not up, change is not allowed
522 	 * if link is not present, only allowable state is disabled
523 	 */
524 	if (!netif_running(p->dev) ||
525 	    (!netif_oper_up(p->dev) && state != BR_STATE_DISABLED))
526 		return -ENETDOWN;
527 
528 	br_set_state(p, state);
529 	br_log_state(p);
530 	br_port_state_selection(p->br);
531 	return 0;
532 }
533 
534 /* Set/clear or port flags based on attribute */
535 static void br_set_port_flag(struct net_bridge_port *p, struct nlattr *tb[],
536 			   int attrtype, unsigned long mask)
537 {
538 	if (tb[attrtype]) {
539 		u8 flag = nla_get_u8(tb[attrtype]);
540 		if (flag)
541 			p->flags |= mask;
542 		else
543 			p->flags &= ~mask;
544 	}
545 }
546 
547 /* Process bridge protocol info on port */
548 static int br_setport(struct net_bridge_port *p, struct nlattr *tb[])
549 {
550 	int err;
551 	unsigned long old_flags = p->flags;
552 
553 	br_set_port_flag(p, tb, IFLA_BRPORT_MODE, BR_HAIRPIN_MODE);
554 	br_set_port_flag(p, tb, IFLA_BRPORT_GUARD, BR_BPDU_GUARD);
555 	br_set_port_flag(p, tb, IFLA_BRPORT_FAST_LEAVE, BR_MULTICAST_FAST_LEAVE);
556 	br_set_port_flag(p, tb, IFLA_BRPORT_PROTECT, BR_ROOT_BLOCK);
557 	br_set_port_flag(p, tb, IFLA_BRPORT_LEARNING, BR_LEARNING);
558 	br_set_port_flag(p, tb, IFLA_BRPORT_UNICAST_FLOOD, BR_FLOOD);
559 	br_set_port_flag(p, tb, IFLA_BRPORT_PROXYARP, BR_PROXYARP);
560 	br_set_port_flag(p, tb, IFLA_BRPORT_PROXYARP_WIFI, BR_PROXYARP_WIFI);
561 
562 	if (tb[IFLA_BRPORT_COST]) {
563 		err = br_stp_set_path_cost(p, nla_get_u32(tb[IFLA_BRPORT_COST]));
564 		if (err)
565 			return err;
566 	}
567 
568 	if (tb[IFLA_BRPORT_PRIORITY]) {
569 		err = br_stp_set_port_priority(p, nla_get_u16(tb[IFLA_BRPORT_PRIORITY]));
570 		if (err)
571 			return err;
572 	}
573 
574 	if (tb[IFLA_BRPORT_STATE]) {
575 		err = br_set_port_state(p, nla_get_u8(tb[IFLA_BRPORT_STATE]));
576 		if (err)
577 			return err;
578 	}
579 
580 	br_port_flags_change(p, old_flags ^ p->flags);
581 	return 0;
582 }
583 
584 /* Change state and parameters on port. */
585 int br_setlink(struct net_device *dev, struct nlmsghdr *nlh, u16 flags)
586 {
587 	struct nlattr *protinfo;
588 	struct nlattr *afspec;
589 	struct net_bridge_port *p;
590 	struct nlattr *tb[IFLA_BRPORT_MAX + 1];
591 	int err = 0;
592 
593 	protinfo = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_PROTINFO);
594 	afspec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC);
595 	if (!protinfo && !afspec)
596 		return 0;
597 
598 	p = br_port_get_rtnl(dev);
599 	/* We want to accept dev as bridge itself if the AF_SPEC
600 	 * is set to see if someone is setting vlan info on the bridge
601 	 */
602 	if (!p && !afspec)
603 		return -EINVAL;
604 
605 	if (p && protinfo) {
606 		if (protinfo->nla_type & NLA_F_NESTED) {
607 			err = nla_parse_nested(tb, IFLA_BRPORT_MAX,
608 					       protinfo, br_port_policy);
609 			if (err)
610 				return err;
611 
612 			spin_lock_bh(&p->br->lock);
613 			err = br_setport(p, tb);
614 			spin_unlock_bh(&p->br->lock);
615 		} else {
616 			/* Binary compatibility with old RSTP */
617 			if (nla_len(protinfo) < sizeof(u8))
618 				return -EINVAL;
619 
620 			spin_lock_bh(&p->br->lock);
621 			err = br_set_port_state(p, nla_get_u8(protinfo));
622 			spin_unlock_bh(&p->br->lock);
623 		}
624 		if (err)
625 			goto out;
626 	}
627 
628 	if (afspec) {
629 		err = br_afspec((struct net_bridge *)netdev_priv(dev), p,
630 				afspec, RTM_SETLINK);
631 	}
632 
633 	if (err == 0)
634 		br_ifinfo_notify(RTM_NEWLINK, p);
635 out:
636 	return err;
637 }
638 
639 /* Delete port information */
640 int br_dellink(struct net_device *dev, struct nlmsghdr *nlh, u16 flags)
641 {
642 	struct nlattr *afspec;
643 	struct net_bridge_port *p;
644 	int err = 0;
645 
646 	afspec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC);
647 	if (!afspec)
648 		return 0;
649 
650 	p = br_port_get_rtnl(dev);
651 	/* We want to accept dev as bridge itself as well */
652 	if (!p && !(dev->priv_flags & IFF_EBRIDGE))
653 		return -EINVAL;
654 
655 	err = br_afspec((struct net_bridge *)netdev_priv(dev), p,
656 			afspec, RTM_DELLINK);
657 	if (err == 0)
658 		/* Send RTM_NEWLINK because userspace
659 		 * expects RTM_NEWLINK for vlan dels
660 		 */
661 		br_ifinfo_notify(RTM_NEWLINK, p);
662 
663 	return err;
664 }
665 static int br_validate(struct nlattr *tb[], struct nlattr *data[])
666 {
667 	if (tb[IFLA_ADDRESS]) {
668 		if (nla_len(tb[IFLA_ADDRESS]) != ETH_ALEN)
669 			return -EINVAL;
670 		if (!is_valid_ether_addr(nla_data(tb[IFLA_ADDRESS])))
671 			return -EADDRNOTAVAIL;
672 	}
673 
674 	return 0;
675 }
676 
677 static int br_dev_newlink(struct net *src_net, struct net_device *dev,
678 			  struct nlattr *tb[], struct nlattr *data[])
679 {
680 	struct net_bridge *br = netdev_priv(dev);
681 
682 	if (tb[IFLA_ADDRESS]) {
683 		spin_lock_bh(&br->lock);
684 		br_stp_change_bridge_id(br, nla_data(tb[IFLA_ADDRESS]));
685 		spin_unlock_bh(&br->lock);
686 	}
687 
688 	return register_netdevice(dev);
689 }
690 
691 static int br_port_slave_changelink(struct net_device *brdev,
692 				    struct net_device *dev,
693 				    struct nlattr *tb[],
694 				    struct nlattr *data[])
695 {
696 	if (!data)
697 		return 0;
698 	return br_setport(br_port_get_rtnl(dev), data);
699 }
700 
701 static int br_port_fill_slave_info(struct sk_buff *skb,
702 				   const struct net_device *brdev,
703 				   const struct net_device *dev)
704 {
705 	return br_port_fill_attrs(skb, br_port_get_rtnl(dev));
706 }
707 
708 static size_t br_port_get_slave_size(const struct net_device *brdev,
709 				     const struct net_device *dev)
710 {
711 	return br_port_info_size();
712 }
713 
714 static const struct nla_policy br_policy[IFLA_BR_MAX + 1] = {
715 	[IFLA_BR_FORWARD_DELAY]	= { .type = NLA_U32 },
716 	[IFLA_BR_HELLO_TIME]	= { .type = NLA_U32 },
717 	[IFLA_BR_MAX_AGE]	= { .type = NLA_U32 },
718 	[IFLA_BR_AGEING_TIME] = { .type = NLA_U32 },
719 	[IFLA_BR_STP_STATE] = { .type = NLA_U32 },
720 	[IFLA_BR_PRIORITY] = { .type = NLA_U16 },
721 };
722 
723 static int br_changelink(struct net_device *brdev, struct nlattr *tb[],
724 			 struct nlattr *data[])
725 {
726 	struct net_bridge *br = netdev_priv(brdev);
727 	int err;
728 
729 	if (!data)
730 		return 0;
731 
732 	if (data[IFLA_BR_FORWARD_DELAY]) {
733 		err = br_set_forward_delay(br, nla_get_u32(data[IFLA_BR_FORWARD_DELAY]));
734 		if (err)
735 			return err;
736 	}
737 
738 	if (data[IFLA_BR_HELLO_TIME]) {
739 		err = br_set_hello_time(br, nla_get_u32(data[IFLA_BR_HELLO_TIME]));
740 		if (err)
741 			return err;
742 	}
743 
744 	if (data[IFLA_BR_MAX_AGE]) {
745 		err = br_set_max_age(br, nla_get_u32(data[IFLA_BR_MAX_AGE]));
746 		if (err)
747 			return err;
748 	}
749 
750 	if (data[IFLA_BR_AGEING_TIME]) {
751 		u32 ageing_time = nla_get_u32(data[IFLA_BR_AGEING_TIME]);
752 
753 		br->ageing_time = clock_t_to_jiffies(ageing_time);
754 	}
755 
756 	if (data[IFLA_BR_STP_STATE]) {
757 		u32 stp_enabled = nla_get_u32(data[IFLA_BR_STP_STATE]);
758 
759 		br_stp_set_enabled(br, stp_enabled);
760 	}
761 
762 	if (data[IFLA_BR_PRIORITY]) {
763 		u32 priority = nla_get_u16(data[IFLA_BR_PRIORITY]);
764 
765 		br_stp_set_bridge_priority(br, priority);
766 	}
767 
768 	return 0;
769 }
770 
771 static size_t br_get_size(const struct net_device *brdev)
772 {
773 	return nla_total_size(sizeof(u32)) +	/* IFLA_BR_FORWARD_DELAY  */
774 	       nla_total_size(sizeof(u32)) +	/* IFLA_BR_HELLO_TIME */
775 	       nla_total_size(sizeof(u32)) +	/* IFLA_BR_MAX_AGE */
776 	       nla_total_size(sizeof(u32)) +    /* IFLA_BR_AGEING_TIME */
777 	       nla_total_size(sizeof(u32)) +    /* IFLA_BR_STP_STATE */
778 	       nla_total_size(sizeof(u16)) +    /* IFLA_BR_PRIORITY */
779 	       0;
780 }
781 
782 static int br_fill_info(struct sk_buff *skb, const struct net_device *brdev)
783 {
784 	struct net_bridge *br = netdev_priv(brdev);
785 	u32 forward_delay = jiffies_to_clock_t(br->forward_delay);
786 	u32 hello_time = jiffies_to_clock_t(br->hello_time);
787 	u32 age_time = jiffies_to_clock_t(br->max_age);
788 	u32 ageing_time = jiffies_to_clock_t(br->ageing_time);
789 	u32 stp_enabled = br->stp_enabled;
790 	u16 priority = (br->bridge_id.prio[0] << 8) | br->bridge_id.prio[1];
791 
792 	if (nla_put_u32(skb, IFLA_BR_FORWARD_DELAY, forward_delay) ||
793 	    nla_put_u32(skb, IFLA_BR_HELLO_TIME, hello_time) ||
794 	    nla_put_u32(skb, IFLA_BR_MAX_AGE, age_time) ||
795 	    nla_put_u32(skb, IFLA_BR_AGEING_TIME, ageing_time) ||
796 	    nla_put_u32(skb, IFLA_BR_STP_STATE, stp_enabled) ||
797 	    nla_put_u16(skb, IFLA_BR_PRIORITY, priority))
798 		return -EMSGSIZE;
799 
800 	return 0;
801 }
802 
803 static size_t br_get_link_af_size(const struct net_device *dev)
804 {
805 	struct net_port_vlans *pv;
806 
807 	if (br_port_exists(dev))
808 		pv = nbp_get_vlan_info(br_port_get_rtnl(dev));
809 	else if (dev->priv_flags & IFF_EBRIDGE)
810 		pv = br_get_vlan_info((struct net_bridge *)netdev_priv(dev));
811 	else
812 		return 0;
813 
814 	if (!pv)
815 		return 0;
816 
817 	/* Each VLAN is returned in bridge_vlan_info along with flags */
818 	return pv->num_vlans * nla_total_size(sizeof(struct bridge_vlan_info));
819 }
820 
821 static struct rtnl_af_ops br_af_ops __read_mostly = {
822 	.family			= AF_BRIDGE,
823 	.get_link_af_size	= br_get_link_af_size,
824 };
825 
826 struct rtnl_link_ops br_link_ops __read_mostly = {
827 	.kind			= "bridge",
828 	.priv_size		= sizeof(struct net_bridge),
829 	.setup			= br_dev_setup,
830 	.maxtype		= IFLA_BRPORT_MAX,
831 	.policy			= br_policy,
832 	.validate		= br_validate,
833 	.newlink		= br_dev_newlink,
834 	.changelink		= br_changelink,
835 	.dellink		= br_dev_delete,
836 	.get_size		= br_get_size,
837 	.fill_info		= br_fill_info,
838 
839 	.slave_maxtype		= IFLA_BRPORT_MAX,
840 	.slave_policy		= br_port_policy,
841 	.slave_changelink	= br_port_slave_changelink,
842 	.get_slave_size		= br_port_get_slave_size,
843 	.fill_slave_info	= br_port_fill_slave_info,
844 };
845 
846 int __init br_netlink_init(void)
847 {
848 	int err;
849 
850 	br_mdb_init();
851 	rtnl_af_register(&br_af_ops);
852 
853 	err = rtnl_link_register(&br_link_ops);
854 	if (err)
855 		goto out_af;
856 
857 	return 0;
858 
859 out_af:
860 	rtnl_af_unregister(&br_af_ops);
861 	br_mdb_uninit();
862 	return err;
863 }
864 
865 void br_netlink_fini(void)
866 {
867 	br_mdb_uninit();
868 	rtnl_af_unregister(&br_af_ops);
869 	rtnl_link_unregister(&br_link_ops);
870 }
871