~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

TOMOYO Linux Cross Reference
Linux/net/bridge/br_netlink_tunnel.c

Version: ~ [ linux-5.4-rc3 ] ~ [ linux-5.3.6 ] ~ [ linux-5.2.21 ] ~ [ linux-5.1.21 ] ~ [ linux-5.0.21 ] ~ [ linux-4.20.17 ] ~ [ linux-4.19.79 ] ~ [ linux-4.18.20 ] ~ [ linux-4.17.19 ] ~ [ linux-4.16.18 ] ~ [ linux-4.15.18 ] ~ [ linux-4.14.149 ] ~ [ linux-4.13.16 ] ~ [ linux-4.12.14 ] ~ [ linux-4.11.12 ] ~ [ linux-4.10.17 ] ~ [ linux-4.9.196 ] ~ [ linux-4.8.17 ] ~ [ linux-4.7.10 ] ~ [ linux-4.6.7 ] ~ [ linux-4.5.7 ] ~ [ linux-4.4.196 ] ~ [ linux-4.3.6 ] ~ [ linux-4.2.8 ] ~ [ linux-4.1.52 ] ~ [ linux-4.0.9 ] ~ [ linux-3.19.8 ] ~ [ linux-3.18.140 ] ~ [ linux-3.17.8 ] ~ [ linux-3.16.75 ] ~ [ linux-3.15.10 ] ~ [ linux-3.14.79 ] ~ [ linux-3.13.11 ] ~ [ linux-3.12.74 ] ~ [ linux-3.11.10 ] ~ [ linux-3.10.108 ] ~ [ linux-3.9.11 ] ~ [ linux-3.8.13 ] ~ [ linux-3.7.10 ] ~ [ linux-3.6.11 ] ~ [ linux-3.5.7 ] ~ [ linux-3.4.113 ] ~ [ linux-3.3.8 ] ~ [ linux-3.2.102 ] ~ [ linux-3.1.10 ] ~ [ linux-3.0.101 ] ~ [ linux-2.6.32.71 ] ~ [ linux-2.6.0 ] ~ [ linux-2.4.37.11 ] ~ [ unix-v6-master ] ~ [ ccs-tools-1.8.5 ] ~ [ policy-sample ] ~
Architecture: ~ [ i386 ] ~ [ alpha ] ~ [ m68k ] ~ [ mips ] ~ [ ppc ] ~ [ sparc ] ~ [ sparc64 ] ~

  1 /*
  2  *      Bridge per vlan tunnel port dst_metadata netlink control interface
  3  *
  4  *      Authors:
  5  *      Roopa Prabhu            <roopa@cumulusnetworks.com>
  6  *
  7  *      This program is free software; you can redistribute it and/or
  8  *      modify it under the terms of the GNU General Public License
  9  *      as published by the Free Software Foundation; either version
 10  *      2 of the License, or (at your option) any later version.
 11  */
 12 
 13 #include <linux/kernel.h>
 14 #include <linux/slab.h>
 15 #include <linux/etherdevice.h>
 16 #include <net/rtnetlink.h>
 17 #include <net/net_namespace.h>
 18 #include <net/sock.h>
 19 #include <uapi/linux/if_bridge.h>
 20 #include <net/dst_metadata.h>
 21 
 22 #include "br_private.h"
 23 #include "br_private_tunnel.h"
 24 
 25 static size_t __get_vlan_tinfo_size(void)
 26 {
 27         return nla_total_size(0) + /* nest IFLA_BRIDGE_VLAN_TUNNEL_INFO */
 28                   nla_total_size(sizeof(u32)) + /* IFLA_BRIDGE_VLAN_TUNNEL_ID */
 29                   nla_total_size(sizeof(u16)) + /* IFLA_BRIDGE_VLAN_TUNNEL_VID */
 30                   nla_total_size(sizeof(u16)); /* IFLA_BRIDGE_VLAN_TUNNEL_FLAGS */
 31 }
 32 
 33 static bool vlan_tunid_inrange(struct net_bridge_vlan *v_curr,
 34                                struct net_bridge_vlan *v_last)
 35 {
 36         __be32 tunid_curr = tunnel_id_to_key32(v_curr->tinfo.tunnel_id);
 37         __be32 tunid_last = tunnel_id_to_key32(v_last->tinfo.tunnel_id);
 38 
 39         return (be32_to_cpu(tunid_curr) - be32_to_cpu(tunid_last)) == 1;
 40 }
 41 
 42 static int __get_num_vlan_tunnel_infos(struct net_bridge_vlan_group *vg)
 43 {
 44         struct net_bridge_vlan *v, *vtbegin = NULL, *vtend = NULL;
 45         int num_tinfos = 0;
 46 
 47         /* Count number of vlan infos */
 48         list_for_each_entry_rcu(v, &vg->vlan_list, vlist) {
 49                 /* only a context, bridge vlan not activated */
 50                 if (!br_vlan_should_use(v) || !v->tinfo.tunnel_id)
 51                         continue;
 52 
 53                 if (!vtbegin) {
 54                         goto initvars;
 55                 } else if ((v->vid - vtend->vid) == 1 &&
 56                            vlan_tunid_inrange(v, vtend)) {
 57                         vtend = v;
 58                         continue;
 59                 } else {
 60                         if ((vtend->vid - vtbegin->vid) > 0)
 61                                 num_tinfos += 2;
 62                         else
 63                                 num_tinfos += 1;
 64                 }
 65 initvars:
 66                 vtbegin = v;
 67                 vtend = v;
 68         }
 69 
 70         if (vtbegin && vtend) {
 71                 if ((vtend->vid - vtbegin->vid) > 0)
 72                         num_tinfos += 2;
 73                 else
 74                         num_tinfos += 1;
 75         }
 76 
 77         return num_tinfos;
 78 }
 79 
 80 int br_get_vlan_tunnel_info_size(struct net_bridge_vlan_group *vg)
 81 {
 82         int num_tinfos;
 83 
 84         if (!vg)
 85                 return 0;
 86 
 87         rcu_read_lock();
 88         num_tinfos = __get_num_vlan_tunnel_infos(vg);
 89         rcu_read_unlock();
 90 
 91         return num_tinfos * __get_vlan_tinfo_size();
 92 }
 93 
 94 static int br_fill_vlan_tinfo(struct sk_buff *skb, u16 vid,
 95                               __be64 tunnel_id, u16 flags)
 96 {
 97         __be32 tid = tunnel_id_to_key32(tunnel_id);
 98         struct nlattr *tmap;
 99 
100         tmap = nla_nest_start(skb, IFLA_BRIDGE_VLAN_TUNNEL_INFO);
101         if (!tmap)
102                 return -EMSGSIZE;
103         if (nla_put_u32(skb, IFLA_BRIDGE_VLAN_TUNNEL_ID,
104                         be32_to_cpu(tid)))
105                 goto nla_put_failure;
106         if (nla_put_u16(skb, IFLA_BRIDGE_VLAN_TUNNEL_VID,
107                         vid))
108                 goto nla_put_failure;
109         if (nla_put_u16(skb, IFLA_BRIDGE_VLAN_TUNNEL_FLAGS,
110                         flags))
111                 goto nla_put_failure;
112         nla_nest_end(skb, tmap);
113 
114         return 0;
115 
116 nla_put_failure:
117         nla_nest_cancel(skb, tmap);
118 
119         return -EMSGSIZE;
120 }
121 
122 static int br_fill_vlan_tinfo_range(struct sk_buff *skb,
123                                     struct net_bridge_vlan *vtbegin,
124                                     struct net_bridge_vlan *vtend)
125 {
126         int err;
127 
128         if (vtend && (vtend->vid - vtbegin->vid) > 0) {
129                 /* add range to skb */
130                 err = br_fill_vlan_tinfo(skb, vtbegin->vid,
131                                          vtbegin->tinfo.tunnel_id,
132                                          BRIDGE_VLAN_INFO_RANGE_BEGIN);
133                 if (err)
134                         return err;
135 
136                 err = br_fill_vlan_tinfo(skb, vtend->vid,
137                                          vtend->tinfo.tunnel_id,
138                                          BRIDGE_VLAN_INFO_RANGE_END);
139                 if (err)
140                         return err;
141         } else {
142                 err = br_fill_vlan_tinfo(skb, vtbegin->vid,
143                                          vtbegin->tinfo.tunnel_id,
144                                          0);
145                 if (err)
146                         return err;
147         }
148 
149         return 0;
150 }
151 
152 int br_fill_vlan_tunnel_info(struct sk_buff *skb,
153                              struct net_bridge_vlan_group *vg)
154 {
155         struct net_bridge_vlan *vtbegin = NULL;
156         struct net_bridge_vlan *vtend = NULL;
157         struct net_bridge_vlan *v;
158         int err;
159 
160         /* Count number of vlan infos */
161         list_for_each_entry_rcu(v, &vg->vlan_list, vlist) {
162                 /* only a context, bridge vlan not activated */
163                 if (!br_vlan_should_use(v))
164                         continue;
165 
166                 if (!v->tinfo.tunnel_dst)
167                         continue;
168 
169                 if (!vtbegin) {
170                         goto initvars;
171                 } else if ((v->vid - vtend->vid) == 1 &&
172                             vlan_tunid_inrange(v, vtend)) {
173                         vtend = v;
174                         continue;
175                 } else {
176                         err = br_fill_vlan_tinfo_range(skb, vtbegin, vtend);
177                         if (err)
178                                 return err;
179                 }
180 initvars:
181                 vtbegin = v;
182                 vtend = v;
183         }
184 
185         if (vtbegin) {
186                 err = br_fill_vlan_tinfo_range(skb, vtbegin, vtend);
187                 if (err)
188                         return err;
189         }
190 
191         return 0;
192 }
193 
194 static const struct nla_policy vlan_tunnel_policy[IFLA_BRIDGE_VLAN_TUNNEL_MAX + 1] = {
195         [IFLA_BRIDGE_VLAN_TUNNEL_ID] = { .type = NLA_U32 },
196         [IFLA_BRIDGE_VLAN_TUNNEL_VID] = { .type = NLA_U16 },
197         [IFLA_BRIDGE_VLAN_TUNNEL_FLAGS] = { .type = NLA_U16 },
198 };
199 
200 static int br_vlan_tunnel_info(struct net_bridge_port *p, int cmd,
201                                u16 vid, u32 tun_id)
202 {
203         int err = 0;
204 
205         if (!p)
206                 return -EINVAL;
207 
208         switch (cmd) {
209         case RTM_SETLINK:
210                 err = nbp_vlan_tunnel_info_add(p, vid, tun_id);
211                 break;
212         case RTM_DELLINK:
213                 nbp_vlan_tunnel_info_delete(p, vid);
214                 break;
215         }
216 
217         return err;
218 }
219 
220 int br_parse_vlan_tunnel_info(struct nlattr *attr,
221                               struct vtunnel_info *tinfo)
222 {
223         struct nlattr *tb[IFLA_BRIDGE_VLAN_TUNNEL_MAX + 1];
224         u32 tun_id;
225         u16 vid, flags = 0;
226         int err;
227 
228         memset(tinfo, 0, sizeof(*tinfo));
229 
230         err = nla_parse_nested(tb, IFLA_BRIDGE_VLAN_TUNNEL_MAX, attr,
231                                vlan_tunnel_policy, NULL);
232         if (err < 0)
233                 return err;
234 
235         if (!tb[IFLA_BRIDGE_VLAN_TUNNEL_ID] ||
236             !tb[IFLA_BRIDGE_VLAN_TUNNEL_VID])
237                 return -EINVAL;
238 
239         tun_id = nla_get_u32(tb[IFLA_BRIDGE_VLAN_TUNNEL_ID]);
240         vid = nla_get_u16(tb[IFLA_BRIDGE_VLAN_TUNNEL_VID]);
241         if (vid >= VLAN_VID_MASK)
242                 return -ERANGE;
243 
244         if (tb[IFLA_BRIDGE_VLAN_TUNNEL_FLAGS])
245                 flags = nla_get_u16(tb[IFLA_BRIDGE_VLAN_TUNNEL_FLAGS]);
246 
247         tinfo->tunid = tun_id;
248         tinfo->vid = vid;
249         tinfo->flags = flags;
250 
251         return 0;
252 }
253 
254 int br_process_vlan_tunnel_info(struct net_bridge *br,
255                                 struct net_bridge_port *p, int cmd,
256                                 struct vtunnel_info *tinfo_curr,
257                                 struct vtunnel_info *tinfo_last)
258 {
259         int err;
260 
261         if (tinfo_curr->flags & BRIDGE_VLAN_INFO_RANGE_BEGIN) {
262                 if (tinfo_last->flags & BRIDGE_VLAN_INFO_RANGE_BEGIN)
263                         return -EINVAL;
264                 memcpy(tinfo_last, tinfo_curr, sizeof(struct vtunnel_info));
265         } else if (tinfo_curr->flags & BRIDGE_VLAN_INFO_RANGE_END) {
266                 int t, v;
267 
268                 if (!(tinfo_last->flags & BRIDGE_VLAN_INFO_RANGE_BEGIN))
269                         return -EINVAL;
270                 if ((tinfo_curr->vid - tinfo_last->vid) !=
271                     (tinfo_curr->tunid - tinfo_last->tunid))
272                         return -EINVAL;
273                 t = tinfo_last->tunid;
274                 for (v = tinfo_last->vid; v <= tinfo_curr->vid; v++) {
275                         err = br_vlan_tunnel_info(p, cmd, v, t);
276                         if (err)
277                                 return err;
278                         t++;
279                 }
280                 memset(tinfo_last, 0, sizeof(struct vtunnel_info));
281                 memset(tinfo_curr, 0, sizeof(struct vtunnel_info));
282         } else {
283                 if (tinfo_last->flags)
284                         return -EINVAL;
285                 err = br_vlan_tunnel_info(p, cmd, tinfo_curr->vid,
286                                           tinfo_curr->tunid);
287                 if (err)
288                         return err;
289                 memset(tinfo_last, 0, sizeof(struct vtunnel_info));
290                 memset(tinfo_curr, 0, sizeof(struct vtunnel_info));
291         }
292 
293         return 0;
294 }
295 

~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

kernel.org | git.kernel.org | LWN.net | Project Home | Wiki (Japanese) | Wiki (English) | SVN repository | Mail admin

Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.

osdn.jp