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> 7 8 #include "br_private.h" 9 10 /* check if the options' state of v_curr allow it to enter the range */ 11 bool br_vlan_opts_eq_range(const struct net_bridge_vlan *v_curr, 12 const struct net_bridge_vlan *range_end) 13 { 14 return v_curr->state == range_end->state; 15 } 16 17 bool br_vlan_opts_fill(struct sk_buff *skb, const struct net_bridge_vlan *v) 18 { 19 return !nla_put_u8(skb, BRIDGE_VLANDB_ENTRY_STATE, 20 br_vlan_get_state(v)); 21 } 22 23 size_t br_vlan_opts_nl_size(void) 24 { 25 return nla_total_size(sizeof(u8)); /* BRIDGE_VLANDB_ENTRY_STATE */ 26 } 27 28 static int br_vlan_modify_state(struct net_bridge_vlan_group *vg, 29 struct net_bridge_vlan *v, 30 u8 state, 31 bool *changed, 32 struct netlink_ext_ack *extack) 33 { 34 struct net_bridge *br; 35 36 ASSERT_RTNL(); 37 38 if (state > BR_STATE_BLOCKING) { 39 NL_SET_ERR_MSG_MOD(extack, "Invalid vlan state"); 40 return -EINVAL; 41 } 42 43 if (br_vlan_is_brentry(v)) 44 br = v->br; 45 else 46 br = v->port->br; 47 48 if (br->stp_enabled == BR_KERNEL_STP) { 49 NL_SET_ERR_MSG_MOD(extack, "Can't modify vlan state when using kernel STP"); 50 return -EBUSY; 51 } 52 53 if (v->state == state) 54 return 0; 55 56 if (v->vid == br_get_pvid(vg)) 57 br_vlan_set_pvid_state(vg, state); 58 59 br_vlan_set_state(v, state); 60 *changed = true; 61 62 return 0; 63 } 64 65 static int br_vlan_process_one_opts(const struct net_bridge *br, 66 const struct net_bridge_port *p, 67 struct net_bridge_vlan_group *vg, 68 struct net_bridge_vlan *v, 69 struct nlattr **tb, 70 bool *changed, 71 struct netlink_ext_ack *extack) 72 { 73 int err; 74 75 *changed = false; 76 if (tb[BRIDGE_VLANDB_ENTRY_STATE]) { 77 u8 state = nla_get_u8(tb[BRIDGE_VLANDB_ENTRY_STATE]); 78 79 err = br_vlan_modify_state(vg, v, state, changed, extack); 80 if (err) 81 return err; 82 } 83 84 return 0; 85 } 86 87 int br_vlan_process_options(const struct net_bridge *br, 88 const struct net_bridge_port *p, 89 struct net_bridge_vlan *range_start, 90 struct net_bridge_vlan *range_end, 91 struct nlattr **tb, 92 struct netlink_ext_ack *extack) 93 { 94 struct net_bridge_vlan *v, *curr_start = NULL, *curr_end = NULL; 95 struct net_bridge_vlan_group *vg; 96 int vid, err = 0; 97 u16 pvid; 98 99 if (p) 100 vg = nbp_vlan_group(p); 101 else 102 vg = br_vlan_group(br); 103 104 if (!range_start || !br_vlan_should_use(range_start)) { 105 NL_SET_ERR_MSG_MOD(extack, "Vlan range start doesn't exist, can't process options"); 106 return -ENOENT; 107 } 108 if (!range_end || !br_vlan_should_use(range_end)) { 109 NL_SET_ERR_MSG_MOD(extack, "Vlan range end doesn't exist, can't process options"); 110 return -ENOENT; 111 } 112 113 pvid = br_get_pvid(vg); 114 for (vid = range_start->vid; vid <= range_end->vid; vid++) { 115 bool changed = false; 116 117 v = br_vlan_find(vg, vid); 118 if (!v || !br_vlan_should_use(v)) { 119 NL_SET_ERR_MSG_MOD(extack, "Vlan in range doesn't exist, can't process options"); 120 err = -ENOENT; 121 break; 122 } 123 124 err = br_vlan_process_one_opts(br, p, vg, v, tb, &changed, 125 extack); 126 if (err) 127 break; 128 129 if (changed) { 130 /* vlan options changed, check for range */ 131 if (!curr_start) { 132 curr_start = v; 133 curr_end = v; 134 continue; 135 } 136 137 if (v->vid == pvid || 138 !br_vlan_can_enter_range(v, curr_end)) { 139 br_vlan_notify(br, p, curr_start->vid, 140 curr_end->vid, RTM_NEWVLAN); 141 curr_start = v; 142 } 143 curr_end = v; 144 } else { 145 /* nothing changed and nothing to notify yet */ 146 if (!curr_start) 147 continue; 148 149 br_vlan_notify(br, p, curr_start->vid, curr_end->vid, 150 RTM_NEWVLAN); 151 curr_start = NULL; 152 curr_end = NULL; 153 } 154 } 155 if (curr_start) 156 br_vlan_notify(br, p, curr_start->vid, curr_end->vid, 157 RTM_NEWVLAN); 158 159 return err; 160 } 161