[mirror_ubuntu-jammy-kernel.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) {
			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) {
			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;

	err = vlan_changelink(dev, tb, data, extack);
	if (!err)
		err = register_vlan_dev(dev, extack);
	if (err)
		vlan_dev_uninit(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) {
	121	m = nla_data(attr);
	122	vlan_dev_set_ingress_priority(dev, m->to, m->from);
	123	}
	124	}
	125	if (data[IFLA_VLAN_EGRESS_QOS]) {
	126	nla_for_each_nested(attr, data[IFLA_VLAN_EGRESS_QOS], rem) {
	127	m = nla_data(attr);
eb8ef2a3 ED	128	err = vlan_dev_set_egress_priority(dev, m->from, m->to);
	129	if (err)
	130	return err;
07b5b17e PM	131	}
	132	}
	133	return 0;
	134	}
	135
81adee47	136	static int vlan_newlink(struct net src_net, struct net_device dev,
7a3f4a18 MS	137	struct nlattr tb[], struct nlattr data[],
7a3f4a18 MS	138	struct netlink_ext_ack *extack)
07b5b17e	139	{
7da82c06	140	struct vlan_dev_priv *vlan = vlan_dev_priv(dev);
07b5b17e	141	struct net_device *real_dev;
18d3df3e	142	unsigned int max_mtu;
8ad227ff	143	__be16 proto;
07b5b17e PM	144	int err;
07b5b17e PM	145
33fa3823 DA	146	if (!data[IFLA_VLAN_ID]) {
33fa3823 DA	147	NL_SET_ERR_MSG_MOD(extack, "VLAN id not specified");
07b5b17e	148	return -EINVAL;
33fa3823	149	}
07b5b17e	150
33fa3823 DA	151	if (!tb[IFLA_LINK]) {
33fa3823 DA	152	NL_SET_ERR_MSG_MOD(extack, "link not specified");
07b5b17e	153	return -EINVAL;
33fa3823 DA	154	}
33fa3823 DA	155
81adee47	156	real_dev = __dev_get_by_index(src_net, nla_get_u32(tb[IFLA_LINK]));
33fa3823 DA	157	if (!real_dev) {
33fa3823 DA	158	NL_SET_ERR_MSG_MOD(extack, "link does not exist");
07b5b17e	159	return -ENODEV;
33fa3823	160	}
07b5b17e	161
8ad227ff PM	162	if (data[IFLA_VLAN_PROTOCOL])
	163	proto = nla_get_be16(data[IFLA_VLAN_PROTOCOL]);
	164	else
	165	proto = htons(ETH_P_8021Q);
	166
	167	vlan->vlan_proto = proto;
1fd9b1fc PM	168	vlan->vlan_id = nla_get_u16(data[IFLA_VLAN_ID]);
1fd9b1fc PM	169	vlan->real_dev = real_dev;
9d917c20	170	dev->priv_flags \|= (real_dev->priv_flags & IFF_XMIT_DST_RELEASE);
1fd9b1fc	171	vlan->flags = VLAN_FLAG_REORDER_HDR;
07b5b17e	172
33fa3823 DA	173	err = vlan_check_real_dev(real_dev, vlan->vlan_proto, vlan->vlan_id,
33fa3823 DA	174	extack);
07b5b17e PM	175	if (err < 0)
	176	return err;
	177
18d3df3e PA	178	max_mtu = netif_reduces_vlan_mtu(real_dev) ? real_dev->mtu - VLAN_HLEN :
18d3df3e PA	179	real_dev->mtu;
07b5b17e	180	if (!tb[IFLA_MTU])
18d3df3e PA	181	dev->mtu = max_mtu;
18d3df3e PA	182	else if (dev->mtu > max_mtu)
07b5b17e PM	183	return -EINVAL;
07b5b17e PM	184
ad744b22	185	err = vlan_changelink(dev, tb, data, extack);
9bbd917e ED	186	if (!err)
	187	err = register_vlan_dev(dev, extack);
	188	if (err)
	189	vlan_dev_uninit(dev);
	190	return err;
07b5b17e PM	191	}
07b5b17e PM	192
07b5b17e PM	193	static inline size_t vlan_qos_map_size(unsigned int n)
	194	{
	195	if (n == 0)
	196	return 0;
	197	/* IFLA_VLAN_{EGRESS,INGRESS}_QOS + n * IFLA_VLAN_QOS_MAPPING */
	198	return nla_total_size(sizeof(struct nlattr)) +
	199	nla_total_size(sizeof(struct ifla_vlan_qos_mapping)) * n;
	200	}
	201
	202	static size_t vlan_get_size(const struct net_device *dev)
	203	{
7da82c06	204	struct vlan_dev_priv *vlan = vlan_dev_priv(dev);
07b5b17e	205
8ad227ff PM	206	return nla_total_size(2) + /* IFLA_VLAN_PROTOCOL */
8ad227ff PM	207	nla_total_size(2) + /* IFLA_VLAN_ID */
c33a39c5	208	nla_total_size(sizeof(struct ifla_vlan_flags)) + /* IFLA_VLAN_FLAGS */
07b5b17e PM	209	vlan_qos_map_size(vlan->nr_ingress_mappings) +
	210	vlan_qos_map_size(vlan->nr_egress_mappings);
	211	}
	212
	213	static int vlan_fill_info(struct sk_buff skb, const struct net_device dev)
	214	{
7da82c06	215	struct vlan_dev_priv *vlan = vlan_dev_priv(dev);
07b5b17e PM	216	struct vlan_priority_tci_mapping *pm;
	217	struct ifla_vlan_flags f;
	218	struct ifla_vlan_qos_mapping m;
	219	struct nlattr *nest;
	220	unsigned int i;
	221
8ad227ff PM	222	if (nla_put_be16(skb, IFLA_VLAN_PROTOCOL, vlan->vlan_proto) \|\|
8ad227ff PM	223	nla_put_u16(skb, IFLA_VLAN_ID, vlan->vlan_id))
61849dda	224	goto nla_put_failure;
07b5b17e PM	225	if (vlan->flags) {
	226	f.flags = vlan->flags;
	227	f.mask = ~0;
61849dda DM	228	if (nla_put(skb, IFLA_VLAN_FLAGS, sizeof(f), &f))
61849dda DM	229	goto nla_put_failure;
07b5b17e PM	230	}
07b5b17e PM	231	if (vlan->nr_ingress_mappings) {
ae0be8de	232	nest = nla_nest_start_noflag(skb, IFLA_VLAN_INGRESS_QOS);
07b5b17e PM	233	if (nest == NULL)
	234	goto nla_put_failure;
	235
	236	for (i = 0; i < ARRAY_SIZE(vlan->ingress_priority_map); i++) {
	237	if (!vlan->ingress_priority_map[i])
	238	continue;
	239
	240	m.from = i;
	241	m.to = vlan->ingress_priority_map[i];
61849dda DM	242	if (nla_put(skb, IFLA_VLAN_QOS_MAPPING,
	243	sizeof(m), &m))
	244	goto nla_put_failure;
07b5b17e PM	245	}
	246	nla_nest_end(skb, nest);
	247	}
	248
	249	if (vlan->nr_egress_mappings) {
ae0be8de	250	nest = nla_nest_start_noflag(skb, IFLA_VLAN_EGRESS_QOS);
07b5b17e PM	251	if (nest == NULL)
	252	goto nla_put_failure;
	253
	254	for (i = 0; i < ARRAY_SIZE(vlan->egress_priority_map); i++) {
	255	for (pm = vlan->egress_priority_map[i]; pm;
	256	pm = pm->next) {
	257	if (!pm->vlan_qos)
	258	continue;
	259
	260	m.from = pm->priority;
	261	m.to = (pm->vlan_qos >> 13) & 0x7;
61849dda DM	262	if (nla_put(skb, IFLA_VLAN_QOS_MAPPING,
	263	sizeof(m), &m))
	264	goto nla_put_failure;
07b5b17e PM	265	}
	266	}
	267	nla_nest_end(skb, nest);
	268	}
	269	return 0;
	270
	271	nla_put_failure:
	272	return -EMSGSIZE;
	273	}
	274
1f17257b ND	275	static struct net vlan_get_link_net(const struct net_device dev)
	276	{
	277	struct net_device *real_dev = vlan_dev_priv(dev)->real_dev;
	278
	279	return dev_net(real_dev);
	280	}
	281
07b5b17e PM	282	struct rtnl_link_ops vlan_link_ops __read_mostly = {
	283	.kind = "vlan",
	284	.maxtype = IFLA_VLAN_MAX,
	285	.policy = vlan_policy,
7da82c06	286	.priv_size = sizeof(struct vlan_dev_priv),
07b5b17e PM	287	.setup = vlan_setup,
	288	.validate = vlan_validate,
	289	.newlink = vlan_newlink,
	290	.changelink = vlan_changelink,
af301517	291	.dellink = unregister_vlan_dev,
07b5b17e PM	292	.get_size = vlan_get_size,
07b5b17e PM	293	.fill_info = vlan_fill_info,
1f17257b	294	.get_link_net = vlan_get_link_net,
07b5b17e PM	295	};
	296
	297	int __init vlan_netlink_init(void)
	298	{
	299	return rtnl_link_register(&vlan_link_ops);
	300	}
	301
	302	void __exit vlan_netlink_fini(void)
	303	{
	304	rtnl_link_unregister(&vlan_link_ops);
	305	}
	306
	307	MODULE_ALIAS_RTNL_LINK("vlan");