Merge tag 'iio-for-5.8a' of git://git.kernel.org/pub/scm/linux/kernel/git/jic23/iio...
[linux-2.6-microblaze.git] / net / bridge / br_vlan_options.c
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 #include <net/ip_tunnels.h>
8
9 #include "br_private.h"
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);
15         struct nlattr *nest;
16
17         if (!v->tinfo.tunnel_dst)
18                 return true;
19
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;
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 }
38
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)
42 {
43         return v_curr->state == range_end->state &&
44                __vlan_tun_can_enter_range(v_curr, range_end);
45 }
46
47 bool br_vlan_opts_fill(struct sk_buff *skb, const struct net_bridge_vlan *v)
48 {
49         return !nla_put_u8(skb, BRIDGE_VLANDB_ENTRY_STATE,
50                            br_vlan_get_state(v)) &&
51                __vlan_tun_put(skb, v);
52 }
53
54 size_t br_vlan_opts_nl_size(void)
55 {
56         return nla_total_size(sizeof(u8)) /* BRIDGE_VLANDB_ENTRY_STATE */
57                + nla_total_size(0) /* BRIDGE_VLANDB_ENTRY_TUNNEL_INFO */
58                + nla_total_size(sizeof(u32)); /* BRIDGE_VLANDB_TINFO_ID */
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
95         return 0;
96 }
97
98 static const struct nla_policy br_vlandb_tinfo_pol[BRIDGE_VLANDB_TINFO_MAX + 1] = {
99         [BRIDGE_VLANDB_TINFO_ID]        = { .type = NLA_U32 },
100         [BRIDGE_VLANDB_TINFO_CMD]       = { .type = NLA_U32 },
101 };
102
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 {
109         struct nlattr *tun_tb[BRIDGE_VLANDB_TINFO_MAX + 1], *attr;
110         struct bridge_vlan_info *vinfo;
111         u32 tun_id = 0;
112         int cmd, err;
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
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
129         if (!tun_tb[BRIDGE_VLANDB_TINFO_CMD]) {
130                 NL_SET_ERR_MSG_MOD(extack, "Missing tunnel command attribute");
131                 return -ENOENT;
132         }
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);
158 }
159
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 {
168         int err;
169
170         *changed = false;
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         }
178         if (tb[BRIDGE_VLANDB_ENTRY_TUNNEL_INFO]) {
179                 err = br_vlan_modify_tunnel(p, v, tb, changed, extack);
180                 if (err)
181                         return err;
182         }
183
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 }