2 * VLAN netlink control interface
4 * Copyright (c) 2007 Patrick McHardy <kaber@trash.net>
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License
8 * version 2 as published by the Free Software Foundation.
11 #include <linux/kernel.h>
12 #include <linux/netdevice.h>
13 #include <linux/if_vlan.h>
14 #include <net/net_namespace.h>
15 #include <net/netlink.h>
16 #include <net/rtnetlink.h>
20 static const struct nla_policy vlan_policy
[IFLA_VLAN_MAX
+ 1] = {
21 [IFLA_VLAN_ID
] = { .type
= NLA_U16
},
22 [IFLA_VLAN_FLAGS
] = { .len
= sizeof(struct ifla_vlan_flags
) },
23 [IFLA_VLAN_EGRESS_QOS
] = { .type
= NLA_NESTED
},
24 [IFLA_VLAN_INGRESS_QOS
] = { .type
= NLA_NESTED
},
27 static const struct nla_policy vlan_map_policy
[IFLA_VLAN_QOS_MAX
+ 1] = {
28 [IFLA_VLAN_QOS_MAPPING
] = { .len
= sizeof(struct ifla_vlan_qos_mapping
) },
32 static inline int vlan_validate_qos_map(struct nlattr
*attr
)
36 return nla_validate_nested(attr
, IFLA_VLAN_QOS_MAX
, vlan_map_policy
);
39 static int vlan_validate(struct nlattr
*tb
[], struct nlattr
*data
[])
41 struct ifla_vlan_flags
*flags
;
45 if (tb
[IFLA_ADDRESS
]) {
46 if (nla_len(tb
[IFLA_ADDRESS
]) != ETH_ALEN
)
48 if (!is_valid_ether_addr(nla_data(tb
[IFLA_ADDRESS
])))
49 return -EADDRNOTAVAIL
;
55 if (data
[IFLA_VLAN_ID
]) {
56 id
= nla_get_u16(data
[IFLA_VLAN_ID
]);
57 if (id
>= VLAN_VID_MASK
)
60 if (data
[IFLA_VLAN_FLAGS
]) {
61 flags
= nla_data(data
[IFLA_VLAN_FLAGS
]);
62 if ((flags
->flags
& flags
->mask
) & ~VLAN_FLAG_REORDER_HDR
)
66 err
= vlan_validate_qos_map(data
[IFLA_VLAN_INGRESS_QOS
]);
69 err
= vlan_validate_qos_map(data
[IFLA_VLAN_EGRESS_QOS
]);
75 static int vlan_changelink(struct net_device
*dev
,
76 struct nlattr
*tb
[], struct nlattr
*data
[])
78 struct vlan_dev_info
*vlan
= VLAN_DEV_INFO(dev
);
79 struct ifla_vlan_flags
*flags
;
80 struct ifla_vlan_qos_mapping
*m
;
84 if (data
[IFLA_VLAN_FLAGS
]) {
85 flags
= nla_data(data
[IFLA_VLAN_FLAGS
]);
86 vlan
->flags
= (vlan
->flags
& ~flags
->mask
) |
87 (flags
->flags
& flags
->mask
);
89 if (data
[IFLA_VLAN_INGRESS_QOS
]) {
90 nla_for_each_nested(attr
, data
[IFLA_VLAN_INGRESS_QOS
], rem
) {
92 vlan_dev_set_ingress_priority(dev
, m
->to
, m
->from
);
95 if (data
[IFLA_VLAN_EGRESS_QOS
]) {
96 nla_for_each_nested(attr
, data
[IFLA_VLAN_EGRESS_QOS
], rem
) {
98 vlan_dev_set_egress_priority(dev
, m
->from
, m
->to
);
104 static int vlan_newlink(struct net_device
*dev
,
105 struct nlattr
*tb
[], struct nlattr
*data
[])
107 struct vlan_dev_info
*vlan
= VLAN_DEV_INFO(dev
);
108 struct net_device
*real_dev
;
111 if (!data
[IFLA_VLAN_ID
])
116 real_dev
= __dev_get_by_index(&init_net
, nla_get_u32(tb
[IFLA_LINK
]));
120 vlan
->vlan_id
= nla_get_u16(data
[IFLA_VLAN_ID
]);
121 vlan
->real_dev
= real_dev
;
122 vlan
->flags
= VLAN_FLAG_REORDER_HDR
;
124 err
= vlan_check_real_dev(real_dev
, vlan
->vlan_id
);
129 dev
->mtu
= real_dev
->mtu
;
130 else if (dev
->mtu
> real_dev
->mtu
)
133 err
= vlan_changelink(dev
, tb
, data
);
137 return register_vlan_dev(dev
);
140 static void vlan_dellink(struct net_device
*dev
)
142 unregister_vlan_device(dev
);
145 static inline size_t vlan_qos_map_size(unsigned int n
)
149 /* IFLA_VLAN_{EGRESS,INGRESS}_QOS + n * IFLA_VLAN_QOS_MAPPING */
150 return nla_total_size(sizeof(struct nlattr
)) +
151 nla_total_size(sizeof(struct ifla_vlan_qos_mapping
)) * n
;
154 static size_t vlan_get_size(const struct net_device
*dev
)
156 struct vlan_dev_info
*vlan
= VLAN_DEV_INFO(dev
);
158 return nla_total_size(2) + /* IFLA_VLAN_ID */
159 vlan_qos_map_size(vlan
->nr_ingress_mappings
) +
160 vlan_qos_map_size(vlan
->nr_egress_mappings
);
163 static int vlan_fill_info(struct sk_buff
*skb
, const struct net_device
*dev
)
165 struct vlan_dev_info
*vlan
= VLAN_DEV_INFO(dev
);
166 struct vlan_priority_tci_mapping
*pm
;
167 struct ifla_vlan_flags f
;
168 struct ifla_vlan_qos_mapping m
;
172 NLA_PUT_U16(skb
, IFLA_VLAN_ID
, VLAN_DEV_INFO(dev
)->vlan_id
);
174 f
.flags
= vlan
->flags
;
176 NLA_PUT(skb
, IFLA_VLAN_FLAGS
, sizeof(f
), &f
);
178 if (vlan
->nr_ingress_mappings
) {
179 nest
= nla_nest_start(skb
, IFLA_VLAN_INGRESS_QOS
);
181 goto nla_put_failure
;
183 for (i
= 0; i
< ARRAY_SIZE(vlan
->ingress_priority_map
); i
++) {
184 if (!vlan
->ingress_priority_map
[i
])
188 m
.to
= vlan
->ingress_priority_map
[i
];
189 NLA_PUT(skb
, IFLA_VLAN_QOS_MAPPING
,
192 nla_nest_end(skb
, nest
);
195 if (vlan
->nr_egress_mappings
) {
196 nest
= nla_nest_start(skb
, IFLA_VLAN_EGRESS_QOS
);
198 goto nla_put_failure
;
200 for (i
= 0; i
< ARRAY_SIZE(vlan
->egress_priority_map
); i
++) {
201 for (pm
= vlan
->egress_priority_map
[i
]; pm
;
206 m
.from
= pm
->priority
;
207 m
.to
= (pm
->vlan_qos
>> 13) & 0x7;
208 NLA_PUT(skb
, IFLA_VLAN_QOS_MAPPING
,
212 nla_nest_end(skb
, nest
);
220 struct rtnl_link_ops vlan_link_ops __read_mostly
= {
222 .maxtype
= IFLA_VLAN_MAX
,
223 .policy
= vlan_policy
,
224 .priv_size
= sizeof(struct vlan_dev_info
),
226 .validate
= vlan_validate
,
227 .newlink
= vlan_newlink
,
228 .changelink
= vlan_changelink
,
229 .dellink
= vlan_dellink
,
230 .get_size
= vlan_get_size
,
231 .fill_info
= vlan_fill_info
,
234 int __init
vlan_netlink_init(void)
236 return rtnl_link_register(&vlan_link_ops
);
239 void __exit
vlan_netlink_fini(void)
241 rtnl_link_unregister(&vlan_link_ops
);
244 MODULE_ALIAS_RTNL_LINK("vlan");