[linux-block.git] / net / bridge / br_vlan_options.c

// SPDX-License-Identifier: GPL-2.0-only
// Copyright (c) 2020, Nikolay Aleksandrov <nikolay@cumulusnetworks.com>
#include <linux/kernel.h>
#include <linux/netdevice.h>
#include <linux/rtnetlink.h>
#include <linux/slab.h>
#include <net/ip_tunnels.h>

#include "br_private.h"
#include "br_private_tunnel.h"

static bool __vlan_tun_put(struct sk_buff *skb, const struct net_bridge_vlan *v)
{
	__be32 tid = tunnel_id_to_key32(v->tinfo.tunnel_id);
	struct nlattr *nest;

	if (!v->tinfo.tunnel_dst)
		return true;

	nest = nla_nest_start(skb, BRIDGE_VLANDB_ENTRY_TUNNEL_INFO);
	if (!nest)
		return false;
	if (nla_put_u32(skb, BRIDGE_VLANDB_TINFO_ID, be32_to_cpu(tid))) {
		nla_nest_cancel(skb, nest);
		return false;
	}
	nla_nest_end(skb, nest);

	return true;
}

static bool __vlan_tun_can_enter_range(const struct net_bridge_vlan *v_curr,
				       const struct net_bridge_vlan *range_end)
{
	return (!v_curr->tinfo.tunnel_dst && !range_end->tinfo.tunnel_dst) ||
	       vlan_tunid_inrange(v_curr, range_end);
}

/* check if the options' state of v_curr allow it to enter the range */
bool br_vlan_opts_eq_range(const struct net_bridge_vlan *v_curr,
			   const struct net_bridge_vlan *range_end)
{
	return v_curr->state == range_end->state &&
	       __vlan_tun_can_enter_range(v_curr, range_end);
}

bool br_vlan_opts_fill(struct sk_buff *skb, const struct net_bridge_vlan *v)
{
	return !nla_put_u8(skb, BRIDGE_VLANDB_ENTRY_STATE,
			   br_vlan_get_state(v)) &&
	       __vlan_tun_put(skb, v);
}

size_t br_vlan_opts_nl_size(void)
{
	return nla_total_size(sizeof(u8)) /* BRIDGE_VLANDB_ENTRY_STATE */
	       + nla_total_size(0) /* BRIDGE_VLANDB_ENTRY_TUNNEL_INFO */
	       + nla_total_size(sizeof(u32)); /* BRIDGE_VLANDB_TINFO_ID */
}

static int br_vlan_modify_state(struct net_bridge_vlan_group *vg,
				struct net_bridge_vlan *v,
				u8 state,
				bool *changed,
				struct netlink_ext_ack *extack)
{
	struct net_bridge *br;

	ASSERT_RTNL();

	if (state > BR_STATE_BLOCKING) {
		NL_SET_ERR_MSG_MOD(extack, "Invalid vlan state");
		return -EINVAL;
	}

	if (br_vlan_is_brentry(v))
		br = v->br;
	else
		br = v->port->br;

	if (br->stp_enabled == BR_KERNEL_STP) {
		NL_SET_ERR_MSG_MOD(extack, "Can't modify vlan state when using kernel STP");
		return -EBUSY;
	}

	if (v->state == state)
		return 0;

	if (v->vid == br_get_pvid(vg))
		br_vlan_set_pvid_state(vg, state);

	br_vlan_set_state(v, state);
	*changed = true;

	return 0;
}

static const struct nla_policy br_vlandb_tinfo_pol[BRIDGE_VLANDB_TINFO_MAX + 1] = {
	[BRIDGE_VLANDB_TINFO_ID]	= { .type = NLA_U32 },
	[BRIDGE_VLANDB_TINFO_CMD]	= { .type = NLA_U32 },
};

static int br_vlan_modify_tunnel(const struct net_bridge_port *p,
				 struct net_bridge_vlan *v,
				 struct nlattr **tb,
				 bool *changed,
				 struct netlink_ext_ack *extack)
{
	struct nlattr *tun_tb[BRIDGE_VLANDB_TINFO_MAX + 1], *attr;
	struct bridge_vlan_info *vinfo;
	u32 tun_id = 0;
	int cmd, err;

	if (!p) {
		NL_SET_ERR_MSG_MOD(extack, "Can't modify tunnel mapping of non-port vlans");
		return -EINVAL;
	}
	if (!(p->flags & BR_VLAN_TUNNEL)) {
		NL_SET_ERR_MSG_MOD(extack, "Port doesn't have tunnel flag set");
		return -EINVAL;
	}

	attr = tb[BRIDGE_VLANDB_ENTRY_TUNNEL_INFO];
	err = nla_parse_nested(tun_tb, BRIDGE_VLANDB_TINFO_MAX, attr,
			       br_vlandb_tinfo_pol, extack);
	if (err)
		return err;

	if (!tun_tb[BRIDGE_VLANDB_TINFO_CMD]) {
		NL_SET_ERR_MSG_MOD(extack, "Missing tunnel command attribute");
		return -ENOENT;
	}
	cmd = nla_get_u32(tun_tb[BRIDGE_VLANDB_TINFO_CMD]);
	switch (cmd) {
	case RTM_SETLINK:
		if (!tun_tb[BRIDGE_VLANDB_TINFO_ID]) {
			NL_SET_ERR_MSG_MOD(extack, "Missing tunnel id attribute");
			return -ENOENT;
		}
		/* when working on vlan ranges this is the starting tunnel id */
		tun_id = nla_get_u32(tun_tb[BRIDGE_VLANDB_TINFO_ID]);
		/* vlan info attr is guaranteed by br_vlan_rtm_process_one */
		vinfo = nla_data(tb[BRIDGE_VLANDB_ENTRY_INFO]);
		/* tunnel ids are mapped to each vlan in increasing order,
		 * the starting vlan is in BRIDGE_VLANDB_ENTRY_INFO and v is the
		 * current vlan, so we compute: tun_id + v - vinfo->vid
		 */
		tun_id += v->vid - vinfo->vid;
		break;
	case RTM_DELLINK:
		break;
	default:
		NL_SET_ERR_MSG_MOD(extack, "Unsupported tunnel command");
		return -EINVAL;
	}

	return br_vlan_tunnel_info(p, cmd, v->vid, tun_id, changed);
}

static int br_vlan_process_one_opts(const struct net_bridge *br,
				    const struct net_bridge_port *p,
				    struct net_bridge_vlan_group *vg,
				    struct net_bridge_vlan *v,
				    struct nlattr **tb,
				    bool *changed,
				    struct netlink_ext_ack *extack)
{
	int err;

	*changed = false;
	if (tb[BRIDGE_VLANDB_ENTRY_STATE]) {
		u8 state = nla_get_u8(tb[BRIDGE_VLANDB_ENTRY_STATE]);

		err = br_vlan_modify_state(vg, v, state, changed, extack);
		if (err)
			return err;
	}
	if (tb[BRIDGE_VLANDB_ENTRY_TUNNEL_INFO]) {
		err = br_vlan_modify_tunnel(p, v, tb, changed, extack);
		if (err)
			return err;
	}

	return 0;
}

int br_vlan_process_options(const struct net_bridge *br,
			    const struct net_bridge_port *p,
			    struct net_bridge_vlan *range_start,
			    struct net_bridge_vlan *range_end,
			    struct nlattr **tb,
			    struct netlink_ext_ack *extack)
{
	struct net_bridge_vlan *v, *curr_start = NULL, *curr_end = NULL;
	struct net_bridge_vlan_group *vg;
	int vid, err = 0;
	u16 pvid;

	if (p)
		vg = nbp_vlan_group(p);
	else
		vg = br_vlan_group(br);

	if (!range_start || !br_vlan_should_use(range_start)) {
		NL_SET_ERR_MSG_MOD(extack, "Vlan range start doesn't exist, can't process options");
		return -ENOENT;
	}
	if (!range_end || !br_vlan_should_use(range_end)) {
		NL_SET_ERR_MSG_MOD(extack, "Vlan range end doesn't exist, can't process options");
		return -ENOENT;
	}

	pvid = br_get_pvid(vg);
	for (vid = range_start->vid; vid <= range_end->vid; vid++) {
		bool changed = false;

		v = br_vlan_find(vg, vid);
		if (!v || !br_vlan_should_use(v)) {
			NL_SET_ERR_MSG_MOD(extack, "Vlan in range doesn't exist, can't process options");
			err = -ENOENT;
			break;
		}

		err = br_vlan_process_one_opts(br, p, vg, v, tb, &changed,
					       extack);
		if (err)
			break;

		if (changed) {
			/* vlan options changed, check for range */
			if (!curr_start) {
				curr_start = v;
				curr_end = v;
				continue;
			}

			if (v->vid == pvid ||
			    !br_vlan_can_enter_range(v, curr_end)) {
				br_vlan_notify(br, p, curr_start->vid,
					       curr_end->vid, RTM_NEWVLAN);
				curr_start = v;
			}
			curr_end = v;
		} else {
			/* nothing changed and nothing to notify yet */
			if (!curr_start)
				continue;

			br_vlan_notify(br, p, curr_start->vid, curr_end->vid,
				       RTM_NEWVLAN);
			curr_start = NULL;
			curr_end = NULL;
		}
	}
	if (curr_start)
		br_vlan_notify(br, p, curr_start->vid, curr_end->vid,
			       RTM_NEWVLAN);

	return err;
}
Commit	Line	Data
7a53e718 NA	1	// SPDX-License-Identifier: GPL-2.0-only
	2	// Copyright (c) 2020, Nikolay Aleksandrov <nikolay@cumulusnetworks.com>
	3	#include <linux/kernel.h>
	4	#include <linux/netdevice.h>
	5	#include <linux/rtnetlink.h>
	6	#include <linux/slab.h>
188c67dd	7	#include <net/ip_tunnels.h>
7a53e718 NA	8
7a53e718 NA	9	#include "br_private.h"
188c67dd NA	10	#include "br_private_tunnel.h"
	11
	12	static bool __vlan_tun_put(struct sk_buff skb, const struct net_bridge_vlan v)
	13	{
	14	__be32 tid = tunnel_id_to_key32(v->tinfo.tunnel_id);
fa388f29	15	struct nlattr *nest;
188c67dd NA	16
	17	if (!v->tinfo.tunnel_dst)
	18	return true;
	19
fa388f29 NA	20	nest = nla_nest_start(skb, BRIDGE_VLANDB_ENTRY_TUNNEL_INFO);
	21	if (!nest)
	22	return false;
	23	if (nla_put_u32(skb, BRIDGE_VLANDB_TINFO_ID, be32_to_cpu(tid))) {
	24	nla_nest_cancel(skb, nest);
	25	return false;
	26	}
	27	nla_nest_end(skb, nest);
	28
	29	return true;
188c67dd NA	30	}
	31
	32	static bool __vlan_tun_can_enter_range(const struct net_bridge_vlan *v_curr,
	33	const struct net_bridge_vlan *range_end)
	34	{
	35	return (!v_curr->tinfo.tunnel_dst && !range_end->tinfo.tunnel_dst) \|\|
	36	vlan_tunid_inrange(v_curr, range_end);
	37	}
7a53e718	38
99f7c5e0 NA	39	/* check if the options' state of v_curr allow it to enter the range */
	40	bool br_vlan_opts_eq_range(const struct net_bridge_vlan *v_curr,
	41	const struct net_bridge_vlan *range_end)
7a53e718	42	{
188c67dd NA	43	return v_curr->state == range_end->state &&
188c67dd NA	44	__vlan_tun_can_enter_range(v_curr, range_end);
7a53e718 NA	45	}
	46
	47	bool br_vlan_opts_fill(struct sk_buff skb, const struct net_bridge_vlan v)
	48	{
a580c76d	49	return !nla_put_u8(skb, BRIDGE_VLANDB_ENTRY_STATE,
188c67dd NA	50	br_vlan_get_state(v)) &&
188c67dd NA	51	__vlan_tun_put(skb, v);
7a53e718 NA	52	}
	53
	54	size_t br_vlan_opts_nl_size(void)
	55	{
188c67dd	56	return nla_total_size(sizeof(u8)) /* BRIDGE_VLANDB_ENTRY_STATE */
fa388f29 NA	57	+ nla_total_size(0) /* BRIDGE_VLANDB_ENTRY_TUNNEL_INFO */
fa388f29 NA	58	+ nla_total_size(sizeof(u32)); /* BRIDGE_VLANDB_TINFO_ID */
a580c76d NA	59	}
	60
	61	static int br_vlan_modify_state(struct net_bridge_vlan_group *vg,
	62	struct net_bridge_vlan *v,
	63	u8 state,
	64	bool *changed,
	65	struct netlink_ext_ack *extack)
	66	{
	67	struct net_bridge *br;
	68
	69	ASSERT_RTNL();
	70
	71	if (state > BR_STATE_BLOCKING) {
	72	NL_SET_ERR_MSG_MOD(extack, "Invalid vlan state");
	73	return -EINVAL;
	74	}
	75
	76	if (br_vlan_is_brentry(v))
	77	br = v->br;
	78	else
	79	br = v->port->br;
	80
	81	if (br->stp_enabled == BR_KERNEL_STP) {
	82	NL_SET_ERR_MSG_MOD(extack, "Can't modify vlan state when using kernel STP");
	83	return -EBUSY;
	84	}
	85
	86	if (v->state == state)
	87	return 0;
	88
	89	if (v->vid == br_get_pvid(vg))
	90	br_vlan_set_pvid_state(vg, state);
	91
	92	br_vlan_set_state(v, state);
	93	*changed = true;
	94
7a53e718 NA	95	return 0;
7a53e718 NA	96	}
a5d29ae2	97
fa388f29 NA	98	static const struct nla_policy br_vlandb_tinfo_pol[BRIDGE_VLANDB_TINFO_MAX + 1] = {
fa388f29 NA	99	[BRIDGE_VLANDB_TINFO_ID] = { .type = NLA_U32 },
c443758b	100	[BRIDGE_VLANDB_TINFO_CMD] = { .type = NLA_U32 },
fa388f29 NA	101	};
fa388f29 NA	102
569da082 NA	103	static int br_vlan_modify_tunnel(const struct net_bridge_port *p,
	104	struct net_bridge_vlan *v,
	105	struct nlattr **tb,
	106	bool *changed,
	107	struct netlink_ext_ack *extack)
	108	{
fa388f29	109	struct nlattr tun_tb[BRIDGE_VLANDB_TINFO_MAX + 1], attr;
569da082	110	struct bridge_vlan_info *vinfo;
c443758b NA	111	u32 tun_id = 0;
c443758b NA	112	int cmd, err;
569da082 NA	113
	114	if (!p) {
	115	NL_SET_ERR_MSG_MOD(extack, "Can't modify tunnel mapping of non-port vlans");
	116	return -EINVAL;
	117	}
	118	if (!(p->flags & BR_VLAN_TUNNEL)) {
	119	NL_SET_ERR_MSG_MOD(extack, "Port doesn't have tunnel flag set");
	120	return -EINVAL;
	121	}
	122
fa388f29 NA	123	attr = tb[BRIDGE_VLANDB_ENTRY_TUNNEL_INFO];
	124	err = nla_parse_nested(tun_tb, BRIDGE_VLANDB_TINFO_MAX, attr,
	125	br_vlandb_tinfo_pol, extack);
	126	if (err)
	127	return err;
	128
c443758b NA	129	if (!tun_tb[BRIDGE_VLANDB_TINFO_CMD]) {
c443758b NA	130	NL_SET_ERR_MSG_MOD(extack, "Missing tunnel command attribute");
fa388f29 NA	131	return -ENOENT;
fa388f29 NA	132	}
c443758b NA	133	cmd = nla_get_u32(tun_tb[BRIDGE_VLANDB_TINFO_CMD]);
	134	switch (cmd) {
	135	case RTM_SETLINK:
	136	if (!tun_tb[BRIDGE_VLANDB_TINFO_ID]) {
	137	NL_SET_ERR_MSG_MOD(extack, "Missing tunnel id attribute");
	138	return -ENOENT;
	139	}
	140	/* when working on vlan ranges this is the starting tunnel id */
	141	tun_id = nla_get_u32(tun_tb[BRIDGE_VLANDB_TINFO_ID]);
	142	/* vlan info attr is guaranteed by br_vlan_rtm_process_one */
	143	vinfo = nla_data(tb[BRIDGE_VLANDB_ENTRY_INFO]);
	144	/* tunnel ids are mapped to each vlan in increasing order,
	145	* the starting vlan is in BRIDGE_VLANDB_ENTRY_INFO and v is the
	146	* current vlan, so we compute: tun_id + v - vinfo->vid
	147	*/
	148	tun_id += v->vid - vinfo->vid;
	149	break;
	150	case RTM_DELLINK:
	151	break;
	152	default:
	153	NL_SET_ERR_MSG_MOD(extack, "Unsupported tunnel command");
	154	return -EINVAL;
	155	}
	156
	157	return br_vlan_tunnel_info(p, cmd, v->vid, tun_id, changed);
569da082 NA	158	}
569da082 NA	159
a5d29ae2 NA	160	static int br_vlan_process_one_opts(const struct net_bridge *br,
	161	const struct net_bridge_port *p,
	162	struct net_bridge_vlan_group *vg,
	163	struct net_bridge_vlan *v,
	164	struct nlattr **tb,
	165	bool *changed,
	166	struct netlink_ext_ack *extack)
	167	{
a580c76d NA	168	int err;
a580c76d NA	169
a5d29ae2	170	*changed = false;
a580c76d NA	171	if (tb[BRIDGE_VLANDB_ENTRY_STATE]) {
	172	u8 state = nla_get_u8(tb[BRIDGE_VLANDB_ENTRY_STATE]);
	173
	174	err = br_vlan_modify_state(vg, v, state, changed, extack);
	175	if (err)
	176	return err;
	177	}
fa388f29	178	if (tb[BRIDGE_VLANDB_ENTRY_TUNNEL_INFO]) {
569da082 NA	179	err = br_vlan_modify_tunnel(p, v, tb, changed, extack);
	180	if (err)
	181	return err;
	182	}
a580c76d	183
a5d29ae2 NA	184	return 0;
	185	}
	186
	187	int br_vlan_process_options(const struct net_bridge *br,
	188	const struct net_bridge_port *p,
	189	struct net_bridge_vlan *range_start,
	190	struct net_bridge_vlan *range_end,
	191	struct nlattr **tb,
	192	struct netlink_ext_ack *extack)
	193	{
	194	struct net_bridge_vlan v, curr_start = NULL, *curr_end = NULL;
	195	struct net_bridge_vlan_group *vg;
	196	int vid, err = 0;
	197	u16 pvid;
	198
	199	if (p)
	200	vg = nbp_vlan_group(p);
	201	else
	202	vg = br_vlan_group(br);
	203
	204	if (!range_start \|\| !br_vlan_should_use(range_start)) {
	205	NL_SET_ERR_MSG_MOD(extack, "Vlan range start doesn't exist, can't process options");
	206	return -ENOENT;
	207	}
	208	if (!range_end \|\| !br_vlan_should_use(range_end)) {
	209	NL_SET_ERR_MSG_MOD(extack, "Vlan range end doesn't exist, can't process options");
	210	return -ENOENT;
	211	}
	212
	213	pvid = br_get_pvid(vg);
	214	for (vid = range_start->vid; vid <= range_end->vid; vid++) {
	215	bool changed = false;
	216
	217	v = br_vlan_find(vg, vid);
	218	if (!v \|\| !br_vlan_should_use(v)) {
	219	NL_SET_ERR_MSG_MOD(extack, "Vlan in range doesn't exist, can't process options");
	220	err = -ENOENT;
	221	break;
	222	}
	223
	224	err = br_vlan_process_one_opts(br, p, vg, v, tb, &changed,
	225	extack);
	226	if (err)
	227	break;
	228
	229	if (changed) {
	230	/* vlan options changed, check for range */
	231	if (!curr_start) {
	232	curr_start = v;
	233	curr_end = v;
	234	continue;
	235	}
	236
	237	if (v->vid == pvid \|\|
	238	!br_vlan_can_enter_range(v, curr_end)) {
	239	br_vlan_notify(br, p, curr_start->vid,
	240	curr_end->vid, RTM_NEWVLAN);
	241	curr_start = v;
	242	}
	243	curr_end = v;
	244	} else {
	245	/* nothing changed and nothing to notify yet */
	246	if (!curr_start)
	247	continue;
248
249	br_vlan_notify(br, p, curr_start->vid, curr_end->vid,
250	RTM_NEWVLAN);
251	curr_start = NULL;
252	curr_end = NULL;
253	}
254	}
255	if (curr_start)
256	br_vlan_notify(br, p, curr_start->vid, curr_end->vid,
257	RTM_NEWVLAN);
258
259	return err;
260	}