net/bridge/br_netlink_tunnel.c

   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,
 231                                attr, vlan_tunnel_policy);
 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 }