[linux-2.6-block.git] / net / 8021q / vlan_netlink.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 *	VLAN netlink control interface
 *
 * 	Copyright (c) 2007 Patrick McHardy <kaber@trash.net>
 */

#include <linux/kernel.h>
#include <linux/netdevice.h>
#include <linux/if_vlan.h>
#include <linux/module.h>
#include <net/net_namespace.h>
#include <net/netlink.h>
#include <net/rtnetlink.h>
#include "vlan.h"


static const struct nla_policy vlan_policy[IFLA_VLAN_MAX + 1] = {
	[IFLA_VLAN_ID]		= { .type = NLA_U16 },
	[IFLA_VLAN_FLAGS]	= { .len = sizeof(struct ifla_vlan_flags) },
	[IFLA_VLAN_EGRESS_QOS]	= { .type = NLA_NESTED },
	[IFLA_VLAN_INGRESS_QOS] = { .type = NLA_NESTED },
	[IFLA_VLAN_PROTOCOL]	= { .type = NLA_U16 },
};

static const struct nla_policy vlan_map_policy[IFLA_VLAN_QOS_MAX + 1] = {
	[IFLA_VLAN_QOS_MAPPING] = { .len = sizeof(struct ifla_vlan_qos_mapping) },
};


static inline int vlan_validate_qos_map(struct nlattr *attr)
{
	if (!attr)
		return 0;
	return nla_validate_nested_deprecated(attr, IFLA_VLAN_QOS_MAX,
					      vlan_map_policy, NULL);
}

static int vlan_validate(struct nlattr *tb[], struct nlattr *data[],
			 struct netlink_ext_ack *extack)
{
	struct ifla_vlan_flags *flags;
	u16 id;
	int err;

	if (tb[IFLA_ADDRESS]) {
		if (nla_len(tb[IFLA_ADDRESS]) != ETH_ALEN) {
			NL_SET_ERR_MSG_MOD(extack, "Invalid link address");
			return -EINVAL;
		}
		if (!is_valid_ether_addr(nla_data(tb[IFLA_ADDRESS]))) {
			NL_SET_ERR_MSG_MOD(extack, "Invalid link address");
			return -EADDRNOTAVAIL;
		}
	}

	if (!data) {
		NL_SET_ERR_MSG_MOD(extack, "VLAN properties not specified");
		return -EINVAL;
	}

	if (data[IFLA_VLAN_PROTOCOL]) {
		switch (nla_get_be16(data[IFLA_VLAN_PROTOCOL])) {
		case htons(ETH_P_8021Q):
		case htons(ETH_P_8021AD):
			break;
		default:
			NL_SET_ERR_MSG_MOD(extack, "Invalid VLAN protocol");
			return -EPROTONOSUPPORT;
		}
	}

	if (data[IFLA_VLAN_ID]) {
		id = nla_get_u16(data[IFLA_VLAN_ID]);
		if (id >= VLAN_VID_MASK) {
			NL_SET_ERR_MSG_MOD(extack, "Invalid VLAN id");
			return -ERANGE;
		}
	}
	if (data[IFLA_VLAN_FLAGS]) {
		flags = nla_data(data[IFLA_VLAN_FLAGS]);
		if ((flags->flags & flags->mask) &
		    ~(VLAN_FLAG_REORDER_HDR | VLAN_FLAG_GVRP |
		      VLAN_FLAG_LOOSE_BINDING | VLAN_FLAG_MVRP |
		      VLAN_FLAG_BRIDGE_BINDING)) {
			NL_SET_ERR_MSG_MOD(extack, "Invalid VLAN flags");
			return -EINVAL;
		}
	}

	err = vlan_validate_qos_map(data[IFLA_VLAN_INGRESS_QOS]);
	if (err < 0) {
		NL_SET_ERR_MSG_MOD(extack, "Invalid ingress QOS map");
		return err;
	}
	err = vlan_validate_qos_map(data[IFLA_VLAN_EGRESS_QOS]);
	if (err < 0) {
		NL_SET_ERR_MSG_MOD(extack, "Invalid egress QOS map");
		return err;
	}
	return 0;
}

static int vlan_changelink(struct net_device *dev, struct nlattr *tb[],
			   struct nlattr *data[],
			   struct netlink_ext_ack *extack)
{
	struct ifla_vlan_flags *flags;
	struct ifla_vlan_qos_mapping *m;
	struct nlattr *attr;
	int rem, err;

	if (data[IFLA_VLAN_FLAGS]) {
		flags = nla_data(data[IFLA_VLAN_FLAGS]);
		err = vlan_dev_change_flags(dev, flags->flags, flags->mask);
		if (err)
			return err;
	}
	if (data[IFLA_VLAN_INGRESS_QOS]) {
		nla_for_each_nested(attr, data[IFLA_VLAN_INGRESS_QOS], rem) {
			if (nla_type(attr) != IFLA_VLAN_QOS_MAPPING)
				continue;
			m = nla_data(attr);
			vlan_dev_set_ingress_priority(dev, m->to, m->from);
		}
	}
	if (data[IFLA_VLAN_EGRESS_QOS]) {
		nla_for_each_nested(attr, data[IFLA_VLAN_EGRESS_QOS], rem) {
			if (nla_type(attr) != IFLA_VLAN_QOS_MAPPING)
				continue;
			m = nla_data(attr);
			err = vlan_dev_set_egress_priority(dev, m->from, m->to);
			if (err)
				return err;
		}
	}
	return 0;
}

static int vlan_newlink(struct net *src_net, struct net_device *dev,
			struct nlattr *tb[], struct nlattr *data[],
			struct netlink_ext_ack *extack)
{
	struct vlan_dev_priv *vlan = vlan_dev_priv(dev);
	struct net_device *real_dev;
	unsigned int max_mtu;
	__be16 proto;
	int err;

	if (!data[IFLA_VLAN_ID]) {
		NL_SET_ERR_MSG_MOD(extack, "VLAN id not specified");
		return -EINVAL;
	}

	if (!tb[IFLA_LINK]) {
		NL_SET_ERR_MSG_MOD(extack, "link not specified");
		return -EINVAL;
	}

	real_dev = __dev_get_by_index(src_net, nla_get_u32(tb[IFLA_LINK]));
	if (!real_dev) {
		NL_SET_ERR_MSG_MOD(extack, "link does not exist");
		return -ENODEV;
	}

	if (data[IFLA_VLAN_PROTOCOL])
		proto = nla_get_be16(data[IFLA_VLAN_PROTOCOL]);
	else
		proto = htons(ETH_P_8021Q);

	vlan->vlan_proto = proto;
	vlan->vlan_id	 = nla_get_u16(data[IFLA_VLAN_ID]);
	vlan->real_dev	 = real_dev;
	dev->priv_flags |= (real_dev->priv_flags & IFF_XMIT_DST_RELEASE);
	vlan->flags	 = VLAN_FLAG_REORDER_HDR;

	err = vlan_check_real_dev(real_dev, vlan->vlan_proto, vlan->vlan_id,
				  extack);
	if (err < 0)
		return err;

	max_mtu = netif_reduces_vlan_mtu(real_dev) ? real_dev->mtu - VLAN_HLEN :
						     real_dev->mtu;
	if (!tb[IFLA_MTU])
		dev->mtu = max_mtu;
	else if (dev->mtu > max_mtu)
		return -EINVAL;

	/* Note: If this initial vlan_changelink() fails, we need
	 * to call vlan_dev_free_egress_priority() to free memory.
	 */
	err = vlan_changelink(dev, tb, data, extack);

	if (!err)
		err = register_vlan_dev(dev, extack);

	if (err)
		vlan_dev_free_egress_priority(dev);
	return err;
}

static inline size_t vlan_qos_map_size(unsigned int n)
{
	if (n == 0)
		return 0;
	/* IFLA_VLAN_{EGRESS,INGRESS}_QOS + n * IFLA_VLAN_QOS_MAPPING */
	return nla_total_size(sizeof(struct nlattr)) +
	       nla_total_size(sizeof(struct ifla_vlan_qos_mapping)) * n;
}

static size_t vlan_get_size(const struct net_device *dev)
{
	struct vlan_dev_priv *vlan = vlan_dev_priv(dev);

	return nla_total_size(2) +	/* IFLA_VLAN_PROTOCOL */
	       nla_total_size(2) +	/* IFLA_VLAN_ID */
	       nla_total_size(sizeof(struct ifla_vlan_flags)) + /* IFLA_VLAN_FLAGS */
	       vlan_qos_map_size(vlan->nr_ingress_mappings) +
	       vlan_qos_map_size(vlan->nr_egress_mappings);
}

static int vlan_fill_info(struct sk_buff *skb, const struct net_device *dev)
{
	struct vlan_dev_priv *vlan = vlan_dev_priv(dev);
	struct vlan_priority_tci_mapping *pm;
	struct ifla_vlan_flags f;
	struct ifla_vlan_qos_mapping m;
	struct nlattr *nest;
	unsigned int i;

	if (nla_put_be16(skb, IFLA_VLAN_PROTOCOL, vlan->vlan_proto) ||
	    nla_put_u16(skb, IFLA_VLAN_ID, vlan->vlan_id))
		goto nla_put_failure;
	if (vlan->flags) {
		f.flags = vlan->flags;
		f.mask  = ~0;
		if (nla_put(skb, IFLA_VLAN_FLAGS, sizeof(f), &f))
			goto nla_put_failure;
	}
	if (vlan->nr_ingress_mappings) {
		nest = nla_nest_start_noflag(skb, IFLA_VLAN_INGRESS_QOS);
		if (nest == NULL)
			goto nla_put_failure;

		for (i = 0; i < ARRAY_SIZE(vlan->ingress_priority_map); i++) {
			if (!vlan->ingress_priority_map[i])
				continue;

			m.from = i;
			m.to   = vlan->ingress_priority_map[i];
			if (nla_put(skb, IFLA_VLAN_QOS_MAPPING,
				    sizeof(m), &m))
				goto nla_put_failure;
		}
		nla_nest_end(skb, nest);
	}

	if (vlan->nr_egress_mappings) {
		nest = nla_nest_start_noflag(skb, IFLA_VLAN_EGRESS_QOS);
		if (nest == NULL)
			goto nla_put_failure;

		for (i = 0; i < ARRAY_SIZE(vlan->egress_priority_map); i++) {
			for (pm = vlan->egress_priority_map[i]; pm;
			     pm = pm->next) {
				if (!pm->vlan_qos)
					continue;

				m.from = pm->priority;
				m.to   = (pm->vlan_qos >> 13) & 0x7;
				if (nla_put(skb, IFLA_VLAN_QOS_MAPPING,
					    sizeof(m), &m))
					goto nla_put_failure;
			}
		}
		nla_nest_end(skb, nest);
	}
	return 0;

nla_put_failure:
	return -EMSGSIZE;
}

static struct net *vlan_get_link_net(const struct net_device *dev)
{
	struct net_device *real_dev = vlan_dev_priv(dev)->real_dev;

	return dev_net(real_dev);
}

struct rtnl_link_ops vlan_link_ops __read_mostly = {
	.kind		= "vlan",
	.maxtype	= IFLA_VLAN_MAX,
	.policy		= vlan_policy,
	.priv_size	= sizeof(struct vlan_dev_priv),
	.setup		= vlan_setup,
	.validate	= vlan_validate,
	.newlink	= vlan_newlink,
	.changelink	= vlan_changelink,
	.dellink	= unregister_vlan_dev,
	.get_size	= vlan_get_size,
	.fill_info	= vlan_fill_info,
	.get_link_net	= vlan_get_link_net,
};

int __init vlan_netlink_init(void)
{
	return rtnl_link_register(&vlan_link_ops);
}

void __exit vlan_netlink_fini(void)
{
	rtnl_link_unregister(&vlan_link_ops);
}

MODULE_ALIAS_RTNL_LINK("vlan");
Commit	Line	Data
d2912cb1	1	// SPDX-License-Identifier: GPL-2.0-only
07b5b17e PM	2	/*
	3	* VLAN netlink control interface
	4	*
	5	* Copyright (c) 2007 Patrick McHardy <kaber@trash.net>
07b5b17e PM	6	*/
	7
	8	#include <linux/kernel.h>
	9	#include <linux/netdevice.h>
	10	#include <linux/if_vlan.h>
3a9a231d	11	#include <linux/module.h>
881d966b	12	#include <net/net_namespace.h>
07b5b17e PM	13	#include <net/netlink.h>
	14	#include <net/rtnetlink.h>
	15	#include "vlan.h"
	16
	17
	18	static const struct nla_policy vlan_policy[IFLA_VLAN_MAX + 1] = {
	19	[IFLA_VLAN_ID] = { .type = NLA_U16 },
	20	[IFLA_VLAN_FLAGS] = { .len = sizeof(struct ifla_vlan_flags) },
	21	[IFLA_VLAN_EGRESS_QOS] = { .type = NLA_NESTED },
	22	[IFLA_VLAN_INGRESS_QOS] = { .type = NLA_NESTED },
8ad227ff	23	[IFLA_VLAN_PROTOCOL] = { .type = NLA_U16 },
07b5b17e PM	24	};
	25
	26	static const struct nla_policy vlan_map_policy[IFLA_VLAN_QOS_MAX + 1] = {
	27	[IFLA_VLAN_QOS_MAPPING] = { .len = sizeof(struct ifla_vlan_qos_mapping) },
	28	};
	29
	30
	31	static inline int vlan_validate_qos_map(struct nlattr *attr)
	32	{
	33	if (!attr)
	34	return 0;
8cb08174 JB	35	return nla_validate_nested_deprecated(attr, IFLA_VLAN_QOS_MAX,
8cb08174 JB	36	vlan_map_policy, NULL);
07b5b17e PM	37	}
07b5b17e PM	38
a8b8a889 MS	39	static int vlan_validate(struct nlattr tb[], struct nlattr data[],
a8b8a889 MS	40	struct netlink_ext_ack *extack)
07b5b17e PM	41	{
	42	struct ifla_vlan_flags *flags;
	43	u16 id;
	44	int err;
	45
0e06877c	46	if (tb[IFLA_ADDRESS]) {
33fa3823 DA	47	if (nla_len(tb[IFLA_ADDRESS]) != ETH_ALEN) {
33fa3823 DA	48	NL_SET_ERR_MSG_MOD(extack, "Invalid link address");
0e06877c	49	return -EINVAL;
33fa3823 DA	50	}
	51	if (!is_valid_ether_addr(nla_data(tb[IFLA_ADDRESS]))) {
	52	NL_SET_ERR_MSG_MOD(extack, "Invalid link address");
0e06877c	53	return -EADDRNOTAVAIL;
33fa3823	54	}
0e06877c PM	55	}
0e06877c PM	56
33fa3823 DA	57	if (!data) {
33fa3823 DA	58	NL_SET_ERR_MSG_MOD(extack, "VLAN properties not specified");
07b5b17e	59	return -EINVAL;
33fa3823	60	}
07b5b17e	61
8ad227ff PM	62	if (data[IFLA_VLAN_PROTOCOL]) {
8ad227ff PM	63	switch (nla_get_be16(data[IFLA_VLAN_PROTOCOL])) {
f0e78826 JP	64	case htons(ETH_P_8021Q):
f0e78826 JP	65	case htons(ETH_P_8021AD):
8ad227ff PM	66	break;
8ad227ff PM	67	default:
33fa3823	68	NL_SET_ERR_MSG_MOD(extack, "Invalid VLAN protocol");
8ad227ff PM	69	return -EPROTONOSUPPORT;
	70	}
	71	}
	72
07b5b17e PM	73	if (data[IFLA_VLAN_ID]) {
07b5b17e PM	74	id = nla_get_u16(data[IFLA_VLAN_ID]);
33fa3823 DA	75	if (id >= VLAN_VID_MASK) {
33fa3823 DA	76	NL_SET_ERR_MSG_MOD(extack, "Invalid VLAN id");
07b5b17e	77	return -ERANGE;
33fa3823	78	}
07b5b17e PM	79	}
	80	if (data[IFLA_VLAN_FLAGS]) {
	81	flags = nla_data(data[IFLA_VLAN_FLAGS]);
70c03b49	82	if ((flags->flags & flags->mask) &
5e756593	83	~(VLAN_FLAG_REORDER_HDR \| VLAN_FLAG_GVRP \|
8c8b3458 MM	84	VLAN_FLAG_LOOSE_BINDING \| VLAN_FLAG_MVRP \|
8c8b3458 MM	85	VLAN_FLAG_BRIDGE_BINDING)) {
33fa3823	86	NL_SET_ERR_MSG_MOD(extack, "Invalid VLAN flags");
07b5b17e	87	return -EINVAL;
33fa3823	88	}
07b5b17e PM	89	}
	90
	91	err = vlan_validate_qos_map(data[IFLA_VLAN_INGRESS_QOS]);
33fa3823 DA	92	if (err < 0) {
33fa3823 DA	93	NL_SET_ERR_MSG_MOD(extack, "Invalid ingress QOS map");
07b5b17e	94	return err;
33fa3823	95	}
07b5b17e	96	err = vlan_validate_qos_map(data[IFLA_VLAN_EGRESS_QOS]);
33fa3823 DA	97	if (err < 0) {
33fa3823 DA	98	NL_SET_ERR_MSG_MOD(extack, "Invalid egress QOS map");
07b5b17e	99	return err;
33fa3823	100	}
07b5b17e PM	101	return 0;
	102	}
	103
ad744b22 MS	104	static int vlan_changelink(struct net_device dev, struct nlattr tb[],
	105	struct nlattr *data[],
	106	struct netlink_ext_ack *extack)
07b5b17e	107	{
07b5b17e PM	108	struct ifla_vlan_flags *flags;
	109	struct ifla_vlan_qos_mapping *m;
	110	struct nlattr *attr;
eb8ef2a3	111	int rem, err;
07b5b17e PM	112
	113	if (data[IFLA_VLAN_FLAGS]) {
	114	flags = nla_data(data[IFLA_VLAN_FLAGS]);
eb8ef2a3 ED	115	err = vlan_dev_change_flags(dev, flags->flags, flags->mask);
	116	if (err)
	117	return err;
07b5b17e PM	118	}
	119	if (data[IFLA_VLAN_INGRESS_QOS]) {
	120	nla_for_each_nested(attr, data[IFLA_VLAN_INGRESS_QOS], rem) {
6c21660f LM	121	if (nla_type(attr) != IFLA_VLAN_QOS_MAPPING)
6c21660f LM	122	continue;
07b5b17e PM	123	m = nla_data(attr);
	124	vlan_dev_set_ingress_priority(dev, m->to, m->from);
	125	}
	126	}
	127	if (data[IFLA_VLAN_EGRESS_QOS]) {
	128	nla_for_each_nested(attr, data[IFLA_VLAN_EGRESS_QOS], rem) {
6c21660f LM	129	if (nla_type(attr) != IFLA_VLAN_QOS_MAPPING)
6c21660f LM	130	continue;
07b5b17e	131	m = nla_data(attr);
eb8ef2a3 ED	132	err = vlan_dev_set_egress_priority(dev, m->from, m->to);
	133	if (err)
	134	return err;
07b5b17e PM	135	}
	136	}
	137	return 0;
	138	}
	139
81adee47	140	static int vlan_newlink(struct net src_net, struct net_device dev,
7a3f4a18 MS	141	struct nlattr tb[], struct nlattr data[],
7a3f4a18 MS	142	struct netlink_ext_ack *extack)
07b5b17e	143	{
7da82c06	144	struct vlan_dev_priv *vlan = vlan_dev_priv(dev);
07b5b17e	145	struct net_device *real_dev;
18d3df3e	146	unsigned int max_mtu;
8ad227ff	147	__be16 proto;
07b5b17e PM	148	int err;
07b5b17e PM	149
33fa3823 DA	150	if (!data[IFLA_VLAN_ID]) {
33fa3823 DA	151	NL_SET_ERR_MSG_MOD(extack, "VLAN id not specified");
07b5b17e	152	return -EINVAL;
33fa3823	153	}
07b5b17e	154
33fa3823 DA	155	if (!tb[IFLA_LINK]) {
33fa3823 DA	156	NL_SET_ERR_MSG_MOD(extack, "link not specified");
07b5b17e	157	return -EINVAL;
33fa3823 DA	158	}
33fa3823 DA	159
81adee47	160	real_dev = __dev_get_by_index(src_net, nla_get_u32(tb[IFLA_LINK]));
33fa3823 DA	161	if (!real_dev) {
33fa3823 DA	162	NL_SET_ERR_MSG_MOD(extack, "link does not exist");
07b5b17e	163	return -ENODEV;
33fa3823	164	}
07b5b17e	165
8ad227ff PM	166	if (data[IFLA_VLAN_PROTOCOL])
	167	proto = nla_get_be16(data[IFLA_VLAN_PROTOCOL]);
	168	else
	169	proto = htons(ETH_P_8021Q);
	170
	171	vlan->vlan_proto = proto;
1fd9b1fc PM	172	vlan->vlan_id = nla_get_u16(data[IFLA_VLAN_ID]);
1fd9b1fc PM	173	vlan->real_dev = real_dev;
9d917c20	174	dev->priv_flags \|= (real_dev->priv_flags & IFF_XMIT_DST_RELEASE);
1fd9b1fc	175	vlan->flags = VLAN_FLAG_REORDER_HDR;
07b5b17e	176
33fa3823 DA	177	err = vlan_check_real_dev(real_dev, vlan->vlan_proto, vlan->vlan_id,
33fa3823 DA	178	extack);
07b5b17e PM	179	if (err < 0)
	180	return err;
	181
18d3df3e PA	182	max_mtu = netif_reduces_vlan_mtu(real_dev) ? real_dev->mtu - VLAN_HLEN :
18d3df3e PA	183	real_dev->mtu;
07b5b17e	184	if (!tb[IFLA_MTU])
18d3df3e PA	185	dev->mtu = max_mtu;
18d3df3e PA	186	else if (dev->mtu > max_mtu)
07b5b17e PM	187	return -EINVAL;
07b5b17e PM	188
72a0b329 ED	189	/* Note: If this initial vlan_changelink() fails, we need
	190	* to call vlan_dev_free_egress_priority() to free memory.
	191	*/
ad744b22	192	err = vlan_changelink(dev, tb, data, extack);
72a0b329 ED	193
	194	if (!err)
	195	err = register_vlan_dev(dev, extack);
	196
37aa50c5 XL	197	if (err)
37aa50c5 XL	198	vlan_dev_free_egress_priority(dev);
9bbd917e	199	return err;
07b5b17e PM	200	}
07b5b17e PM	201
07b5b17e PM	202	static inline size_t vlan_qos_map_size(unsigned int n)
	203	{
	204	if (n == 0)
	205	return 0;
	206	/* IFLA_VLAN_{EGRESS,INGRESS}_QOS + n * IFLA_VLAN_QOS_MAPPING */
	207	return nla_total_size(sizeof(struct nlattr)) +
	208	nla_total_size(sizeof(struct ifla_vlan_qos_mapping)) * n;
	209	}
	210
	211	static size_t vlan_get_size(const struct net_device *dev)
	212	{
7da82c06	213	struct vlan_dev_priv *vlan = vlan_dev_priv(dev);
07b5b17e	214
8ad227ff PM	215	return nla_total_size(2) + /* IFLA_VLAN_PROTOCOL */
8ad227ff PM	216	nla_total_size(2) + /* IFLA_VLAN_ID */
c33a39c5	217	nla_total_size(sizeof(struct ifla_vlan_flags)) + /* IFLA_VLAN_FLAGS */
07b5b17e PM	218	vlan_qos_map_size(vlan->nr_ingress_mappings) +
	219	vlan_qos_map_size(vlan->nr_egress_mappings);
	220	}
	221
	222	static int vlan_fill_info(struct sk_buff skb, const struct net_device dev)
	223	{
7da82c06	224	struct vlan_dev_priv *vlan = vlan_dev_priv(dev);
07b5b17e PM	225	struct vlan_priority_tci_mapping *pm;
	226	struct ifla_vlan_flags f;
	227	struct ifla_vlan_qos_mapping m;
	228	struct nlattr *nest;
	229	unsigned int i;
	230
8ad227ff PM	231	if (nla_put_be16(skb, IFLA_VLAN_PROTOCOL, vlan->vlan_proto) \|\|
8ad227ff PM	232	nla_put_u16(skb, IFLA_VLAN_ID, vlan->vlan_id))
61849dda	233	goto nla_put_failure;
07b5b17e PM	234	if (vlan->flags) {
	235	f.flags = vlan->flags;
	236	f.mask = ~0;
61849dda DM	237	if (nla_put(skb, IFLA_VLAN_FLAGS, sizeof(f), &f))
61849dda DM	238	goto nla_put_failure;
07b5b17e PM	239	}
07b5b17e PM	240	if (vlan->nr_ingress_mappings) {
ae0be8de	241	nest = nla_nest_start_noflag(skb, IFLA_VLAN_INGRESS_QOS);
07b5b17e PM	242	if (nest == NULL)
	243	goto nla_put_failure;
	244
	245	for (i = 0; i < ARRAY_SIZE(vlan->ingress_priority_map); i++) {
	246	if (!vlan->ingress_priority_map[i])
	247	continue;
	248
	249	m.from = i;
	250	m.to = vlan->ingress_priority_map[i];
61849dda DM	251	if (nla_put(skb, IFLA_VLAN_QOS_MAPPING,
	252	sizeof(m), &m))
	253	goto nla_put_failure;
07b5b17e PM	254	}
	255	nla_nest_end(skb, nest);
	256	}
	257
	258	if (vlan->nr_egress_mappings) {
ae0be8de	259	nest = nla_nest_start_noflag(skb, IFLA_VLAN_EGRESS_QOS);
07b5b17e PM	260	if (nest == NULL)
	261	goto nla_put_failure;
	262
	263	for (i = 0; i < ARRAY_SIZE(vlan->egress_priority_map); i++) {
	264	for (pm = vlan->egress_priority_map[i]; pm;
	265	pm = pm->next) {
	266	if (!pm->vlan_qos)
	267	continue;
	268
	269	m.from = pm->priority;
	270	m.to = (pm->vlan_qos >> 13) & 0x7;
61849dda DM	271	if (nla_put(skb, IFLA_VLAN_QOS_MAPPING,
	272	sizeof(m), &m))
	273	goto nla_put_failure;
07b5b17e PM	274	}
	275	}
	276	nla_nest_end(skb, nest);
	277	}
	278	return 0;
	279
	280	nla_put_failure:
	281	return -EMSGSIZE;
	282	}
	283
1f17257b ND	284	static struct net vlan_get_link_net(const struct net_device dev)
	285	{
	286	struct net_device *real_dev = vlan_dev_priv(dev)->real_dev;
	287
	288	return dev_net(real_dev);
	289	}
	290
07b5b17e PM	291	struct rtnl_link_ops vlan_link_ops __read_mostly = {
	292	.kind = "vlan",
	293	.maxtype = IFLA_VLAN_MAX,
	294	.policy = vlan_policy,
7da82c06	295	.priv_size = sizeof(struct vlan_dev_priv),
07b5b17e PM	296	.setup = vlan_setup,
	297	.validate = vlan_validate,
	298	.newlink = vlan_newlink,
	299	.changelink = vlan_changelink,
af301517	300	.dellink = unregister_vlan_dev,
07b5b17e PM	301	.get_size = vlan_get_size,
07b5b17e PM	302	.fill_info = vlan_fill_info,
1f17257b	303	.get_link_net = vlan_get_link_net,
07b5b17e PM	304	};
	305
	306	int __init vlan_netlink_init(void)
	307	{
	308	return rtnl_link_register(&vlan_link_ops);
	309	}
	310
	311	void __exit vlan_netlink_fini(void)
	312	{
	313	rtnl_link_unregister(&vlan_link_ops);
	314	}
	315
	316	MODULE_ALIAS_RTNL_LINK("vlan");