[linux-2.6-block.git] / net / bridge / br_netlink.c

/*
 *	Bridge netlink control interface
 *
 *	Authors:
 *	Stephen Hemminger		<shemminger@osdl.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/slab.h>
#include <linux/etherdevice.h>
#include <net/rtnetlink.h>
#include <net/net_namespace.h>
#include <net/sock.h>
#include <uapi/linux/if_bridge.h>

#include "br_private.h"
#include "br_private_stp.h"

static inline size_t br_port_info_size(void)
{
	return nla_total_size(1)	/* IFLA_BRPORT_STATE  */
		+ nla_total_size(2)	/* IFLA_BRPORT_PRIORITY */
		+ nla_total_size(4)	/* IFLA_BRPORT_COST */
		+ nla_total_size(1)	/* IFLA_BRPORT_MODE */
		+ nla_total_size(1)	/* IFLA_BRPORT_GUARD */
		+ nla_total_size(1)	/* IFLA_BRPORT_PROTECT */
		+ nla_total_size(1)	/* IFLA_BRPORT_FAST_LEAVE */
		+ nla_total_size(1)	/* IFLA_BRPORT_LEARNING */
		+ nla_total_size(1)	/* IFLA_BRPORT_UNICAST_FLOOD */
		+ 0;
}

static inline size_t br_nlmsg_size(void)
{
	return NLMSG_ALIGN(sizeof(struct ifinfomsg))
		+ nla_total_size(IFNAMSIZ) /* IFLA_IFNAME */
		+ nla_total_size(MAX_ADDR_LEN) /* IFLA_ADDRESS */
		+ nla_total_size(4) /* IFLA_MASTER */
		+ nla_total_size(4) /* IFLA_MTU */
		+ nla_total_size(4) /* IFLA_LINK */
		+ nla_total_size(1) /* IFLA_OPERSTATE */
		+ nla_total_size(br_port_info_size()); /* IFLA_PROTINFO */
}

static int br_port_fill_attrs(struct sk_buff *skb,
			      const struct net_bridge_port *p)
{
	u8 mode = !!(p->flags & BR_HAIRPIN_MODE);

	if (nla_put_u8(skb, IFLA_BRPORT_STATE, p->state) ||
	    nla_put_u16(skb, IFLA_BRPORT_PRIORITY, p->priority) ||
	    nla_put_u32(skb, IFLA_BRPORT_COST, p->path_cost) ||
	    nla_put_u8(skb, IFLA_BRPORT_MODE, mode) ||
	    nla_put_u8(skb, IFLA_BRPORT_GUARD, !!(p->flags & BR_BPDU_GUARD)) ||
	    nla_put_u8(skb, IFLA_BRPORT_PROTECT, !!(p->flags & BR_ROOT_BLOCK)) ||
	    nla_put_u8(skb, IFLA_BRPORT_FAST_LEAVE, !!(p->flags & BR_MULTICAST_FAST_LEAVE)) ||
	    nla_put_u8(skb, IFLA_BRPORT_LEARNING, !!(p->flags & BR_LEARNING)) ||
	    nla_put_u8(skb, IFLA_BRPORT_UNICAST_FLOOD, !!(p->flags & BR_FLOOD)))
		return -EMSGSIZE;

	return 0;
}

/*
 * Create one netlink message for one interface
 * Contains port and master info as well as carrier and bridge state.
 */
static int br_fill_ifinfo(struct sk_buff *skb,
			  const struct net_bridge_port *port,
			  u32 pid, u32 seq, int event, unsigned int flags,
			  u32 filter_mask, const struct net_device *dev)
{
	const struct net_bridge *br;
	struct ifinfomsg *hdr;
	struct nlmsghdr *nlh;
	u8 operstate = netif_running(dev) ? dev->operstate : IF_OPER_DOWN;

	if (port)
		br = port->br;
	else
		br = netdev_priv(dev);

	br_debug(br, "br_fill_info event %d port %s master %s\n",
		     event, dev->name, br->dev->name);

	nlh = nlmsg_put(skb, pid, seq, event, sizeof(*hdr), flags);
	if (nlh == NULL)
		return -EMSGSIZE;

	hdr = nlmsg_data(nlh);
	hdr->ifi_family = AF_BRIDGE;
	hdr->__ifi_pad = 0;
	hdr->ifi_type = dev->type;
	hdr->ifi_index = dev->ifindex;
	hdr->ifi_flags = dev_get_flags(dev);
	hdr->ifi_change = 0;

	if (nla_put_string(skb, IFLA_IFNAME, dev->name) ||
	    nla_put_u32(skb, IFLA_MASTER, br->dev->ifindex) ||
	    nla_put_u32(skb, IFLA_MTU, dev->mtu) ||
	    nla_put_u8(skb, IFLA_OPERSTATE, operstate) ||
	    (dev->addr_len &&
	     nla_put(skb, IFLA_ADDRESS, dev->addr_len, dev->dev_addr)) ||
	    (dev->ifindex != dev->iflink &&
	     nla_put_u32(skb, IFLA_LINK, dev->iflink)))
		goto nla_put_failure;

	if (event == RTM_NEWLINK && port) {
		struct nlattr *nest
			= nla_nest_start(skb, IFLA_PROTINFO | NLA_F_NESTED);

		if (nest == NULL || br_port_fill_attrs(skb, port) < 0)
			goto nla_put_failure;
		nla_nest_end(skb, nest);
	}

	/* Check if  the VID information is requested */
	if (filter_mask & RTEXT_FILTER_BRVLAN) {
		struct nlattr *af;
		const struct net_port_vlans *pv;
		struct bridge_vlan_info vinfo;
		u16 vid;
		u16 pvid;

		if (port)
			pv = nbp_get_vlan_info(port);
		else
			pv = br_get_vlan_info(br);

		if (!pv || bitmap_empty(pv->vlan_bitmap, VLAN_N_VID))
			goto done;

		af = nla_nest_start(skb, IFLA_AF_SPEC);
		if (!af)
			goto nla_put_failure;

		pvid = br_get_pvid(pv);
		for_each_set_bit(vid, pv->vlan_bitmap, VLAN_N_VID) {
			vinfo.vid = vid;
			vinfo.flags = 0;
			if (vid == pvid)
				vinfo.flags |= BRIDGE_VLAN_INFO_PVID;

			if (test_bit(vid, pv->untagged_bitmap))
				vinfo.flags |= BRIDGE_VLAN_INFO_UNTAGGED;

			if (nla_put(skb, IFLA_BRIDGE_VLAN_INFO,
				    sizeof(vinfo), &vinfo))
				goto nla_put_failure;
		}

		nla_nest_end(skb, af);
	}

done:
	return nlmsg_end(skb, nlh);

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

/*
 * Notify listeners of a change in port information
 */
void br_ifinfo_notify(int event, struct net_bridge_port *port)
{
	struct net *net;
	struct sk_buff *skb;
	int err = -ENOBUFS;

	if (!port)
		return;

	net = dev_net(port->dev);
	br_debug(port->br, "port %u(%s) event %d\n",
		 (unsigned int)port->port_no, port->dev->name, event);

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

	err = br_fill_ifinfo(skb, port, 0, 0, event, 0, 0, port->dev);
	if (err < 0) {
		/* -EMSGSIZE implies BUG in br_nlmsg_size() */
		WARN_ON(err == -EMSGSIZE);
		kfree_skb(skb);
		goto errout;
	}
	rtnl_notify(skb, net, 0, RTNLGRP_LINK, NULL, GFP_ATOMIC);
	return;
errout:
	if (err < 0)
		rtnl_set_sk_err(net, RTNLGRP_LINK, err);
}


/*
 * Dump information about all ports, in response to GETLINK
 */
int br_getlink(struct sk_buff *skb, u32 pid, u32 seq,
	       struct net_device *dev, u32 filter_mask)
{
	int err = 0;
	struct net_bridge_port *port = br_port_get_rcu(dev);

	/* not a bridge port and  */
	if (!port && !(filter_mask & RTEXT_FILTER_BRVLAN))
		goto out;

	err = br_fill_ifinfo(skb, port, pid, seq, RTM_NEWLINK, NLM_F_MULTI,
			     filter_mask, dev);
out:
	return err;
}

static const struct nla_policy ifla_br_policy[IFLA_MAX+1] = {
	[IFLA_BRIDGE_FLAGS]	= { .type = NLA_U16 },
	[IFLA_BRIDGE_MODE]	= { .type = NLA_U16 },
	[IFLA_BRIDGE_VLAN_INFO]	= { .type = NLA_BINARY,
				    .len = sizeof(struct bridge_vlan_info), },
};

static int br_afspec(struct net_bridge *br,
		     struct net_bridge_port *p,
		     struct nlattr *af_spec,
		     int cmd)
{
	struct nlattr *tb[IFLA_BRIDGE_MAX+1];
	int err = 0;

	err = nla_parse_nested(tb, IFLA_BRIDGE_MAX, af_spec, ifla_br_policy);
	if (err)
		return err;

	if (tb[IFLA_BRIDGE_VLAN_INFO]) {
		struct bridge_vlan_info *vinfo;

		vinfo = nla_data(tb[IFLA_BRIDGE_VLAN_INFO]);

		if (vinfo->vid >= VLAN_N_VID)
			return -EINVAL;

		switch (cmd) {
		case RTM_SETLINK:
			if (p) {
				err = nbp_vlan_add(p, vinfo->vid, vinfo->flags);
				if (err)
					break;

				if (vinfo->flags & BRIDGE_VLAN_INFO_MASTER)
					err = br_vlan_add(p->br, vinfo->vid,
							  vinfo->flags);
			} else
				err = br_vlan_add(br, vinfo->vid, vinfo->flags);

			if (err)
				break;

			break;

		case RTM_DELLINK:
			if (p) {
				nbp_vlan_delete(p, vinfo->vid);
				if (vinfo->flags & BRIDGE_VLAN_INFO_MASTER)
					br_vlan_delete(p->br, vinfo->vid);
			} else
				br_vlan_delete(br, vinfo->vid);
			break;
		}
	}

	return err;
}

static const struct nla_policy ifla_brport_policy[IFLA_BRPORT_MAX + 1] = {
	[IFLA_BRPORT_STATE]	= { .type = NLA_U8 },
	[IFLA_BRPORT_COST]	= { .type = NLA_U32 },
	[IFLA_BRPORT_PRIORITY]	= { .type = NLA_U16 },
	[IFLA_BRPORT_MODE]	= { .type = NLA_U8 },
	[IFLA_BRPORT_GUARD]	= { .type = NLA_U8 },
	[IFLA_BRPORT_PROTECT]	= { .type = NLA_U8 },
	[IFLA_BRPORT_LEARNING]	= { .type = NLA_U8 },
	[IFLA_BRPORT_UNICAST_FLOOD] = { .type = NLA_U8 },
};

/* Change the state of the port and notify spanning tree */
static int br_set_port_state(struct net_bridge_port *p, u8 state)
{
	if (state > BR_STATE_BLOCKING)
		return -EINVAL;

	/* if kernel STP is running, don't allow changes */
	if (p->br->stp_enabled == BR_KERNEL_STP)
		return -EBUSY;

	/* if device is not up, change is not allowed
	 * if link is not present, only allowable state is disabled
	 */
	if (!netif_running(p->dev) ||
	    (!netif_oper_up(p->dev) && state != BR_STATE_DISABLED))
		return -ENETDOWN;

	p->state = state;
	br_log_state(p);
	br_port_state_selection(p->br);
	return 0;
}

/* Set/clear or port flags based on attribute */
static void br_set_port_flag(struct net_bridge_port *p, struct nlattr *tb[],
			   int attrtype, unsigned long mask)
{
	if (tb[attrtype]) {
		u8 flag = nla_get_u8(tb[attrtype]);
		if (flag)
			p->flags |= mask;
		else
			p->flags &= ~mask;
	}
}

/* Process bridge protocol info on port */
static int br_setport(struct net_bridge_port *p, struct nlattr *tb[])
{
	int err;

	br_set_port_flag(p, tb, IFLA_BRPORT_MODE, BR_HAIRPIN_MODE);
	br_set_port_flag(p, tb, IFLA_BRPORT_GUARD, BR_BPDU_GUARD);
	br_set_port_flag(p, tb, IFLA_BRPORT_FAST_LEAVE, BR_MULTICAST_FAST_LEAVE);
	br_set_port_flag(p, tb, IFLA_BRPORT_PROTECT, BR_ROOT_BLOCK);
	br_set_port_flag(p, tb, IFLA_BRPORT_LEARNING, BR_LEARNING);
	br_set_port_flag(p, tb, IFLA_BRPORT_UNICAST_FLOOD, BR_FLOOD);

	if (tb[IFLA_BRPORT_COST]) {
		err = br_stp_set_path_cost(p, nla_get_u32(tb[IFLA_BRPORT_COST]));
		if (err)
			return err;
	}

	if (tb[IFLA_BRPORT_PRIORITY]) {
		err = br_stp_set_port_priority(p, nla_get_u16(tb[IFLA_BRPORT_PRIORITY]));
		if (err)
			return err;
	}

	if (tb[IFLA_BRPORT_STATE]) {
		err = br_set_port_state(p, nla_get_u8(tb[IFLA_BRPORT_STATE]));
		if (err)
			return err;
	}
	return 0;
}

/* Change state and parameters on port. */
int br_setlink(struct net_device *dev, struct nlmsghdr *nlh)
{
	struct nlattr *protinfo;
	struct nlattr *afspec;
	struct net_bridge_port *p;
	struct nlattr *tb[IFLA_BRPORT_MAX + 1];
	int err = 0;

	protinfo = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_PROTINFO);
	afspec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC);
	if (!protinfo && !afspec)
		return 0;

	p = br_port_get_rtnl(dev);
	/* We want to accept dev as bridge itself if the AF_SPEC
	 * is set to see if someone is setting vlan info on the brigde
	 */
	if (!p && !afspec)
		return -EINVAL;

	if (p && protinfo) {
		if (protinfo->nla_type & NLA_F_NESTED) {
			err = nla_parse_nested(tb, IFLA_BRPORT_MAX,
					       protinfo, ifla_brport_policy);
			if (err)
				return err;

			spin_lock_bh(&p->br->lock);
			err = br_setport(p, tb);
			spin_unlock_bh(&p->br->lock);
		} else {
			/* Binary compatability with old RSTP */
			if (nla_len(protinfo) < sizeof(u8))
				return -EINVAL;

			spin_lock_bh(&p->br->lock);
			err = br_set_port_state(p, nla_get_u8(protinfo));
			spin_unlock_bh(&p->br->lock);
		}
		if (err)
			goto out;
	}

	if (afspec) {
		err = br_afspec((struct net_bridge *)netdev_priv(dev), p,
				afspec, RTM_SETLINK);
	}

	if (err == 0)
		br_ifinfo_notify(RTM_NEWLINK, p);

out:
	return err;
}

/* Delete port information */
int br_dellink(struct net_device *dev, struct nlmsghdr *nlh)
{
	struct nlattr *afspec;
	struct net_bridge_port *p;
	int err;

	afspec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC);
	if (!afspec)
		return 0;

	p = br_port_get_rtnl(dev);
	/* We want to accept dev as bridge itself as well */
	if (!p && !(dev->priv_flags & IFF_EBRIDGE))
		return -EINVAL;

	err = br_afspec((struct net_bridge *)netdev_priv(dev), p,
			afspec, RTM_DELLINK);

	return err;
}
static int br_validate(struct nlattr *tb[], struct nlattr *data[])
{
	if (tb[IFLA_ADDRESS]) {
		if (nla_len(tb[IFLA_ADDRESS]) != ETH_ALEN)
			return -EINVAL;
		if (!is_valid_ether_addr(nla_data(tb[IFLA_ADDRESS])))
			return -EADDRNOTAVAIL;
	}

	return 0;
}

static size_t br_get_link_af_size(const struct net_device *dev)
{
	struct net_port_vlans *pv;

	if (br_port_exists(dev))
		pv = nbp_get_vlan_info(br_port_get_rcu(dev));
	else if (dev->priv_flags & IFF_EBRIDGE)
		pv = br_get_vlan_info((struct net_bridge *)netdev_priv(dev));
	else
		return 0;

	if (!pv)
		return 0;

	/* Each VLAN is returned in bridge_vlan_info along with flags */
	return pv->num_vlans * nla_total_size(sizeof(struct bridge_vlan_info));
}

static struct rtnl_af_ops br_af_ops = {
	.family			= AF_BRIDGE,
	.get_link_af_size	= br_get_link_af_size,
};

struct rtnl_link_ops br_link_ops __read_mostly = {
	.kind		= "bridge",
	.priv_size	= sizeof(struct net_bridge),
	.setup		= br_dev_setup,
	.validate	= br_validate,
	.dellink	= br_dev_delete,
};

int __init br_netlink_init(void)
{
	int err;

	br_mdb_init();
	err = rtnl_af_register(&br_af_ops);
	if (err)
		goto out;

	err = rtnl_link_register(&br_link_ops);
	if (err)
		goto out_af;

	return 0;

out_af:
	rtnl_af_unregister(&br_af_ops);
out:
	br_mdb_uninit();
	return err;
}

void __exit br_netlink_fini(void)
{
	br_mdb_uninit();
	rtnl_af_unregister(&br_af_ops);
	rtnl_link_unregister(&br_link_ops);
}
Commit	Line	Data
11dc1f36 SH	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>
5a0e3ad6	14	#include <linux/slab.h>
bb900b27	15	#include <linux/etherdevice.h>
32fe21c0	16	#include <net/rtnetlink.h>
881d966b	17	#include <net/net_namespace.h>
b854272b	18	#include <net/sock.h>
407af329	19	#include <uapi/linux/if_bridge.h>
bb900b27	20
11dc1f36	21	#include "br_private.h"
b03b6dd5	22	#include "br_private_stp.h"
11dc1f36	23
25c71c75	24	static inline size_t br_port_info_size(void)
	25	{
	26	return nla_total_size(1) /* IFLA_BRPORT_STATE */
	27	+ nla_total_size(2) /* IFLA_BRPORT_PRIORITY */
	28	+ nla_total_size(4) /* IFLA_BRPORT_COST */
	29	+ nla_total_size(1) /* IFLA_BRPORT_MODE */
a2e01a65	30	+ nla_total_size(1) /* IFLA_BRPORT_GUARD */
1007dd1a	31	+ nla_total_size(1) /* IFLA_BRPORT_PROTECT */
3da889b6	32	+ nla_total_size(1) /* IFLA_BRPORT_FAST_LEAVE */
9ba18891	33	+ nla_total_size(1) /* IFLA_BRPORT_LEARNING */
867a5943	34	+ nla_total_size(1) /* IFLA_BRPORT_UNICAST_FLOOD */
25c71c75	35	+ 0;
	36	}
	37
339bf98f TG	38	static inline size_t br_nlmsg_size(void)
	39	{
	40	return NLMSG_ALIGN(sizeof(struct ifinfomsg))
25c71c75	41	+ nla_total_size(IFNAMSIZ) /* IFLA_IFNAME */
	42	+ nla_total_size(MAX_ADDR_LEN) /* IFLA_ADDRESS */
	43	+ nla_total_size(4) /* IFLA_MASTER */
	44	+ nla_total_size(4) /* IFLA_MTU */
	45	+ nla_total_size(4) /* IFLA_LINK */
	46	+ nla_total_size(1) /* IFLA_OPERSTATE */
	47	+ nla_total_size(br_port_info_size()); /* IFLA_PROTINFO */
	48	}
	49
	50	static int br_port_fill_attrs(struct sk_buff *skb,
	51	const struct net_bridge_port *p)
	52	{
	53	u8 mode = !!(p->flags & BR_HAIRPIN_MODE);
	54
	55	if (nla_put_u8(skb, IFLA_BRPORT_STATE, p->state) \|\|
	56	nla_put_u16(skb, IFLA_BRPORT_PRIORITY, p->priority) \|\|
	57	nla_put_u32(skb, IFLA_BRPORT_COST, p->path_cost) \|\|
a2e01a65	58	nla_put_u8(skb, IFLA_BRPORT_MODE, mode) \|\|
1007dd1a	59	nla_put_u8(skb, IFLA_BRPORT_GUARD, !!(p->flags & BR_BPDU_GUARD)) \|\|
c2d3babf	60	nla_put_u8(skb, IFLA_BRPORT_PROTECT, !!(p->flags & BR_ROOT_BLOCK)) \|\|
9ba18891	61	nla_put_u8(skb, IFLA_BRPORT_FAST_LEAVE, !!(p->flags & BR_MULTICAST_FAST_LEAVE)) \|\|
867a5943 VY	62	nla_put_u8(skb, IFLA_BRPORT_LEARNING, !!(p->flags & BR_LEARNING)) \|\|
867a5943 VY	63	nla_put_u8(skb, IFLA_BRPORT_UNICAST_FLOOD, !!(p->flags & BR_FLOOD)))
25c71c75	64	return -EMSGSIZE;
	65
	66	return 0;
339bf98f TG	67	}
339bf98f TG	68
11dc1f36 SH	69	/*
	70	* Create one netlink message for one interface
	71	* Contains port and master info as well as carrier and bridge state.
	72	*/
6cbdceeb VY	73	static int br_fill_ifinfo(struct sk_buff *skb,
	74	const struct net_bridge_port *port,
	75	u32 pid, u32 seq, int event, unsigned int flags,
	76	u32 filter_mask, const struct net_device *dev)
11dc1f36	77	{
6cbdceeb	78	const struct net_bridge *br;
74685962	79	struct ifinfomsg *hdr;
11dc1f36	80	struct nlmsghdr *nlh;
11dc1f36	81	u8 operstate = netif_running(dev) ? dev->operstate : IF_OPER_DOWN;
11dc1f36	82
6cbdceeb VY	83	if (port)
	84	br = port->br;
	85	else
	86	br = netdev_priv(dev);
	87
28a16c97	88	br_debug(br, "br_fill_info event %d port %s master %s\n",
28a16c97	89	event, dev->name, br->dev->name);
11dc1f36	90
74685962 TG	91	nlh = nlmsg_put(skb, pid, seq, event, sizeof(*hdr), flags);
74685962 TG	92	if (nlh == NULL)
26932566	93	return -EMSGSIZE;
11dc1f36	94
74685962 TG	95	hdr = nlmsg_data(nlh);
	96	hdr->ifi_family = AF_BRIDGE;
	97	hdr->__ifi_pad = 0;
	98	hdr->ifi_type = dev->type;
	99	hdr->ifi_index = dev->ifindex;
	100	hdr->ifi_flags = dev_get_flags(dev);
	101	hdr->ifi_change = 0;
11dc1f36	102
2eb812e6 DM	103	if (nla_put_string(skb, IFLA_IFNAME, dev->name) \|\|
	104	nla_put_u32(skb, IFLA_MASTER, br->dev->ifindex) \|\|
	105	nla_put_u32(skb, IFLA_MTU, dev->mtu) \|\|
	106	nla_put_u8(skb, IFLA_OPERSTATE, operstate) \|\|
	107	(dev->addr_len &&
	108	nla_put(skb, IFLA_ADDRESS, dev->addr_len, dev->dev_addr)) \|\|
	109	(dev->ifindex != dev->iflink &&
25c71c75	110	nla_put_u32(skb, IFLA_LINK, dev->iflink)))
2eb812e6	111	goto nla_put_failure;
25c71c75	112
6cbdceeb	113	if (event == RTM_NEWLINK && port) {
25c71c75	114	struct nlattr *nest
	115	= nla_nest_start(skb, IFLA_PROTINFO \| NLA_F_NESTED);
	116
	117	if (nest == NULL \|\| br_port_fill_attrs(skb, port) < 0)
	118	goto nla_put_failure;
	119	nla_nest_end(skb, nest);
	120	}
	121
6cbdceeb VY	122	/* Check if the VID information is requested */
	123	if (filter_mask & RTEXT_FILTER_BRVLAN) {
	124	struct nlattr *af;
	125	const struct net_port_vlans *pv;
	126	struct bridge_vlan_info vinfo;
	127	u16 vid;
552406c4	128	u16 pvid;
6cbdceeb VY	129
	130	if (port)
	131	pv = nbp_get_vlan_info(port);
	132	else
	133	pv = br_get_vlan_info(br);
	134
ef40b7ef	135	if (!pv \|\| bitmap_empty(pv->vlan_bitmap, VLAN_N_VID))
6cbdceeb VY	136	goto done;
	137
	138	af = nla_nest_start(skb, IFLA_AF_SPEC);
	139	if (!af)
	140	goto nla_put_failure;
	141
552406c4	142	pvid = br_get_pvid(pv);
ef40b7ef	143	for_each_set_bit(vid, pv->vlan_bitmap, VLAN_N_VID) {
6cbdceeb VY	144	vinfo.vid = vid;
6cbdceeb VY	145	vinfo.flags = 0;
552406c4 VY	146	if (vid == pvid)
552406c4 VY	147	vinfo.flags \|= BRIDGE_VLAN_INFO_PVID;
35e03f3a VY	148
	149	if (test_bit(vid, pv->untagged_bitmap))
	150	vinfo.flags \|= BRIDGE_VLAN_INFO_UNTAGGED;
	151
6cbdceeb VY	152	if (nla_put(skb, IFLA_BRIDGE_VLAN_INFO,
	153	sizeof(vinfo), &vinfo))
	154	goto nla_put_failure;
	155	}
	156
	157	nla_nest_end(skb, af);
	158	}
	159
	160	done:
74685962	161	return nlmsg_end(skb, nlh);
11dc1f36	162
74685962	163	nla_put_failure:
26932566 PM	164	nlmsg_cancel(skb, nlh);
26932566 PM	165	return -EMSGSIZE;
11dc1f36 SH	166	}
	167
	168	/*
	169	* Notify listeners of a change in port information
	170	*/
	171	void br_ifinfo_notify(int event, struct net_bridge_port *port)
	172	{
407af329	173	struct net *net;
11dc1f36	174	struct sk_buff *skb;
280a306c	175	int err = -ENOBUFS;
11dc1f36	176
407af329 VY	177	if (!port)
	178	return;
	179
	180	net = dev_net(port->dev);
28a16c97	181	br_debug(port->br, "port %u(%s) event %d\n",
95c96174	182	(unsigned int)port->port_no, port->dev->name, event);
28a16c97	183
339bf98f	184	skb = nlmsg_new(br_nlmsg_size(), GFP_ATOMIC);
280a306c TG	185	if (skb == NULL)
	186	goto errout;
	187
6cbdceeb	188	err = br_fill_ifinfo(skb, port, 0, 0, event, 0, 0, port->dev);
26932566 PM	189	if (err < 0) {
	190	/* -EMSGSIZE implies BUG in br_nlmsg_size() */
	191	WARN_ON(err == -EMSGSIZE);
	192	kfree_skb(skb);
	193	goto errout;
	194	}
1ce85fe4 PNA	195	rtnl_notify(skb, net, 0, RTNLGRP_LINK, NULL, GFP_ATOMIC);
1ce85fe4 PNA	196	return;
280a306c	197	errout:
bea1b42e	198	if (err < 0)
4aa678ba	199	rtnl_set_sk_err(net, RTNLGRP_LINK, err);
11dc1f36 SH	200	}
11dc1f36 SH	201
407af329	202
11dc1f36 SH	203	/*
	204	* Dump information about all ports, in response to GETLINK
	205	*/
e5a55a89	206	int br_getlink(struct sk_buff *skb, u32 pid, u32 seq,
6cbdceeb	207	struct net_device *dev, u32 filter_mask)
11dc1f36	208	{
e5a55a89 JF	209	int err = 0;
	210	struct net_bridge_port *port = br_port_get_rcu(dev);
	211
6cbdceeb VY	212	/* not a bridge port and */
6cbdceeb VY	213	if (!port && !(filter_mask & RTEXT_FILTER_BRVLAN))
e5a55a89	214	goto out;
11dc1f36	215
6cbdceeb VY	216	err = br_fill_ifinfo(skb, port, pid, seq, RTM_NEWLINK, NLM_F_MULTI,
6cbdceeb VY	217	filter_mask, dev);
e5a55a89 JF	218	out:
e5a55a89 JF	219	return err;
11dc1f36 SH	220	}
11dc1f36 SH	221
15004cab	222	static const struct nla_policy ifla_br_policy[IFLA_MAX+1] = {
407af329 VY	223	[IFLA_BRIDGE_FLAGS] = { .type = NLA_U16 },
	224	[IFLA_BRIDGE_MODE] = { .type = NLA_U16 },
	225	[IFLA_BRIDGE_VLAN_INFO] = { .type = NLA_BINARY,
	226	.len = sizeof(struct bridge_vlan_info), },
	227	};
	228
	229	static int br_afspec(struct net_bridge *br,
	230	struct net_bridge_port *p,
	231	struct nlattr *af_spec,
	232	int cmd)
	233	{
	234	struct nlattr *tb[IFLA_BRIDGE_MAX+1];
	235	int err = 0;
	236
	237	err = nla_parse_nested(tb, IFLA_BRIDGE_MAX, af_spec, ifla_br_policy);
	238	if (err)
	239	return err;
	240
	241	if (tb[IFLA_BRIDGE_VLAN_INFO]) {
	242	struct bridge_vlan_info *vinfo;
	243
	244	vinfo = nla_data(tb[IFLA_BRIDGE_VLAN_INFO]);
	245
	246	if (vinfo->vid >= VLAN_N_VID)
	247	return -EINVAL;
	248
	249	switch (cmd) {
	250	case RTM_SETLINK:
	251	if (p) {
552406c4	252	err = nbp_vlan_add(p, vinfo->vid, vinfo->flags);
407af329 VY	253	if (err)
	254	break;
	255
	256	if (vinfo->flags & BRIDGE_VLAN_INFO_MASTER)
552406c4 VY	257	err = br_vlan_add(p->br, vinfo->vid,
552406c4 VY	258	vinfo->flags);
407af329	259	} else
552406c4	260	err = br_vlan_add(br, vinfo->vid, vinfo->flags);
407af329 VY	261
	262	if (err)
	263	break;
	264
	265	break;
	266
	267	case RTM_DELLINK:
	268	if (p) {
	269	nbp_vlan_delete(p, vinfo->vid);
	270	if (vinfo->flags & BRIDGE_VLAN_INFO_MASTER)
	271	br_vlan_delete(p->br, vinfo->vid);
	272	} else
	273	br_vlan_delete(br, vinfo->vid);
	274	break;
	275	}
	276	}
	277
	278	return err;
	279	}
	280
25c71c75	281	static const struct nla_policy ifla_brport_policy[IFLA_BRPORT_MAX + 1] = {
	282	[IFLA_BRPORT_STATE] = { .type = NLA_U8 },
	283	[IFLA_BRPORT_COST] = { .type = NLA_U32 },
	284	[IFLA_BRPORT_PRIORITY] = { .type = NLA_U16 },
	285	[IFLA_BRPORT_MODE] = { .type = NLA_U8 },
a2e01a65	286	[IFLA_BRPORT_GUARD] = { .type = NLA_U8 },
1007dd1a	287	[IFLA_BRPORT_PROTECT] = { .type = NLA_U8 },
9ba18891	288	[IFLA_BRPORT_LEARNING] = { .type = NLA_U8 },
867a5943	289	[IFLA_BRPORT_UNICAST_FLOOD] = { .type = NLA_U8 },
25c71c75	290	};
	291
	292	/* Change the state of the port and notify spanning tree */
	293	static int br_set_port_state(struct net_bridge_port *p, u8 state)
	294	{
	295	if (state > BR_STATE_BLOCKING)
	296	return -EINVAL;
	297
	298	/* if kernel STP is running, don't allow changes */
	299	if (p->br->stp_enabled == BR_KERNEL_STP)
	300	return -EBUSY;
	301
576eb625	302	/* if device is not up, change is not allowed
	303	* if link is not present, only allowable state is disabled
	304	*/
25c71c75	305	if (!netif_running(p->dev) \|\|
576eb625	306	(!netif_oper_up(p->dev) && state != BR_STATE_DISABLED))
25c71c75	307	return -ENETDOWN;
	308
	309	p->state = state;
	310	br_log_state(p);
	311	br_port_state_selection(p->br);
	312	return 0;
	313	}
	314
	315	/* Set/clear or port flags based on attribute */
	316	static void br_set_port_flag(struct net_bridge_port p, struct nlattr tb[],
	317	int attrtype, unsigned long mask)
	318	{
	319	if (tb[attrtype]) {
	320	u8 flag = nla_get_u8(tb[attrtype]);
	321	if (flag)
	322	p->flags \|= mask;
	323	else
	324	p->flags &= ~mask;
	325	}
	326	}
	327
	328	/* Process bridge protocol info on port */
	329	static int br_setport(struct net_bridge_port p, struct nlattr tb[])
	330	{
	331	int err;
	332
	333	br_set_port_flag(p, tb, IFLA_BRPORT_MODE, BR_HAIRPIN_MODE);
a2e01a65	334	br_set_port_flag(p, tb, IFLA_BRPORT_GUARD, BR_BPDU_GUARD);
c2d3babf	335	br_set_port_flag(p, tb, IFLA_BRPORT_FAST_LEAVE, BR_MULTICAST_FAST_LEAVE);
3d84fa98	336	br_set_port_flag(p, tb, IFLA_BRPORT_PROTECT, BR_ROOT_BLOCK);
9ba18891	337	br_set_port_flag(p, tb, IFLA_BRPORT_LEARNING, BR_LEARNING);
867a5943	338	br_set_port_flag(p, tb, IFLA_BRPORT_UNICAST_FLOOD, BR_FLOOD);
25c71c75	339
	340	if (tb[IFLA_BRPORT_COST]) {
	341	err = br_stp_set_path_cost(p, nla_get_u32(tb[IFLA_BRPORT_COST]));
	342	if (err)
	343	return err;
	344	}
	345
	346	if (tb[IFLA_BRPORT_PRIORITY]) {
	347	err = br_stp_set_port_priority(p, nla_get_u16(tb[IFLA_BRPORT_PRIORITY]));
	348	if (err)
	349	return err;
	350	}
	351
	352	if (tb[IFLA_BRPORT_STATE]) {
	353	err = br_set_port_state(p, nla_get_u8(tb[IFLA_BRPORT_STATE]));
	354	if (err)
	355	return err;
	356	}
	357	return 0;
	358	}
	359
	360	/* Change state and parameters on port. */
e5a55a89	361	int br_setlink(struct net_device dev, struct nlmsghdr nlh)
11dc1f36	362	{
74685962	363	struct nlattr *protinfo;
407af329	364	struct nlattr *afspec;
11dc1f36	365	struct net_bridge_port *p;
2062cc20	366	struct nlattr *tb[IFLA_BRPORT_MAX + 1];
7b99a993	367	int err = 0;
11dc1f36	368
c60ee67f H	369	protinfo = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_PROTINFO);
c60ee67f H	370	afspec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC);
407af329	371	if (!protinfo && !afspec)
25c71c75	372	return 0;
11dc1f36	373
ec1e5610	374	p = br_port_get_rtnl(dev);
407af329 VY	375	/* We want to accept dev as bridge itself if the AF_SPEC
	376	* is set to see if someone is setting vlan info on the brigde
	377	*/
7b99a993	378	if (!p && !afspec)
b5ed54e9	379	return -EINVAL;
11dc1f36	380
407af329 VY	381	if (p && protinfo) {
	382	if (protinfo->nla_type & NLA_F_NESTED) {
	383	err = nla_parse_nested(tb, IFLA_BRPORT_MAX,
	384	protinfo, ifla_brport_policy);
	385	if (err)
	386	return err;
	387
	388	spin_lock_bh(&p->br->lock);
	389	err = br_setport(p, tb);
	390	spin_unlock_bh(&p->br->lock);
	391	} else {
	392	/* Binary compatability with old RSTP */
	393	if (nla_len(protinfo) < sizeof(u8))
	394	return -EINVAL;
	395
	396	spin_lock_bh(&p->br->lock);
	397	err = br_set_port_state(p, nla_get_u8(protinfo));
	398	spin_unlock_bh(&p->br->lock);
	399	}
25c71c75	400	if (err)
407af329 VY	401	goto out;
407af329 VY	402	}
11dc1f36	403
407af329 VY	404	if (afspec) {
	405	err = br_afspec((struct net_bridge *)netdev_priv(dev), p,
	406	afspec, RTM_SETLINK);
25c71c75	407	}
b03b6dd5	408
25c71c75	409	if (err == 0)
25c71c75	410	br_ifinfo_notify(RTM_NEWLINK, p);
b03b6dd5	411
407af329	412	out:
25c71c75	413	return err;
11dc1f36 SH	414	}
11dc1f36 SH	415
407af329 VY	416	/* Delete port information */
	417	int br_dellink(struct net_device dev, struct nlmsghdr nlh)
	418	{
407af329 VY	419	struct nlattr *afspec;
	420	struct net_bridge_port *p;
	421	int err;
	422
c60ee67f	423	afspec = nlmsg_find_attr(nlh, sizeof(struct ifinfomsg), IFLA_AF_SPEC);
407af329 VY	424	if (!afspec)
	425	return 0;
	426
	427	p = br_port_get_rtnl(dev);
	428	/* We want to accept dev as bridge itself as well */
	429	if (!p && !(dev->priv_flags & IFF_EBRIDGE))
	430	return -EINVAL;
	431
	432	err = br_afspec((struct net_bridge *)netdev_priv(dev), p,
	433	afspec, RTM_DELLINK);
	434
	435	return err;
	436	}
bb900b27	437	static int br_validate(struct nlattr tb[], struct nlattr data[])
	438	{
	439	if (tb[IFLA_ADDRESS]) {
	440	if (nla_len(tb[IFLA_ADDRESS]) != ETH_ALEN)
	441	return -EINVAL;
	442	if (!is_valid_ether_addr(nla_data(tb[IFLA_ADDRESS])))
	443	return -EADDRNOTAVAIL;
	444	}
	445
	446	return 0;
	447	}
	448
6cbdceeb VY	449	static size_t br_get_link_af_size(const struct net_device *dev)
	450	{
	451	struct net_port_vlans *pv;
	452
	453	if (br_port_exists(dev))
	454	pv = nbp_get_vlan_info(br_port_get_rcu(dev));
	455	else if (dev->priv_flags & IFF_EBRIDGE)
	456	pv = br_get_vlan_info((struct net_bridge *)netdev_priv(dev));
	457	else
	458	return 0;
	459
	460	if (!pv)
	461	return 0;
	462
	463	/* Each VLAN is returned in bridge_vlan_info along with flags */
	464	return pv->num_vlans * nla_total_size(sizeof(struct bridge_vlan_info));
	465	}
	466
15004cab	467	static struct rtnl_af_ops br_af_ops = {
6cbdceeb VY	468	.family = AF_BRIDGE,
	469	.get_link_af_size = br_get_link_af_size,
	470	};
	471
149ddd83	472	struct rtnl_link_ops br_link_ops __read_mostly = {
bb900b27	473	.kind = "bridge",
	474	.priv_size = sizeof(struct net_bridge),
	475	.setup = br_dev_setup,
	476	.validate = br_validate,
1ce5cce8	477	.dellink = br_dev_delete,
bb900b27	478	};
11dc1f36	479
32fe21c0	480	int __init br_netlink_init(void)
11dc1f36	481	{
3ec8e9f0 VY	482	int err;
	483
	484	br_mdb_init();
6cbdceeb	485	err = rtnl_af_register(&br_af_ops);
3ec8e9f0 VY	486	if (err)
	487	goto out;
	488
6cbdceeb VY	489	err = rtnl_link_register(&br_link_ops);
	490	if (err)
	491	goto out_af;
	492
3ec8e9f0	493	return 0;
6cbdceeb VY	494
	495	out_af:
	496	rtnl_af_unregister(&br_af_ops);
3ec8e9f0 VY	497	out:
	498	br_mdb_uninit();
	499	return err;
11dc1f36 SH	500	}
	501
	502	void __exit br_netlink_fini(void)
	503	{
3ec8e9f0	504	br_mdb_uninit();
6cbdceeb	505	rtnl_af_unregister(&br_af_ops);
bb900b27	506	rtnl_link_unregister(&br_link_ops);
11dc1f36	507	}