drivers/net/ethernet/mellanox/mlx5/core/vxlan.c

   1 /*
   2  * Copyright (c) 2016, Mellanox Technologies, Ltd.  All rights reserved.
   3  *
   4  * This software is available to you under a choice of one of two
   5  * licenses.  You may choose to be licensed under the terms of the GNU
   6  * General Public License (GPL) Version 2, available from the file
   7  * COPYING in the main directory of this source tree, or the
   8  * OpenIB.org BSD license below:
   9  *
  10  *     Redistribution and use in source and binary forms, with or
  11  *     without modification, are permitted provided that the following
  12  *     conditions are met:
  13  *
  14  *      - Redistributions of source code must retain the above
  15  *        copyright notice, this list of conditions and the following
  16  *        disclaimer.
  17  *
  18  *      - Redistributions in binary form must reproduce the above
  19  *        copyright notice, this list of conditions and the following
  20  *        disclaimer in the documentation and/or other materials
  21  *        provided with the distribution.
  22  *
  23  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  24  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  25  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  26  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  27  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  28  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  29  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  30  * SOFTWARE.
  31  */
  32
  33 #include <linux/kernel.h>
  34 #include <linux/module.h>
  35 #include <linux/mlx5/driver.h>
  36 #include "mlx5_core.h"
  37 #include "vxlan.h"
  38
  39 void mlx5e_vxlan_init(struct mlx5e_priv *priv)
  40 {
  41         struct mlx5e_vxlan_db *vxlan_db = &priv->vxlan;
  42
  43         spin_lock_init(&vxlan_db->lock);
  44         INIT_RADIX_TREE(&vxlan_db->tree, GFP_ATOMIC);
  45 }
  46
  47 static int mlx5e_vxlan_core_add_port_cmd(struct mlx5_core_dev *mdev, u16 port)
  48 {
  49         struct mlx5_outbox_hdr *hdr;
  50         int err;
  51
  52         u32 in[MLX5_ST_SZ_DW(add_vxlan_udp_dport_in)];
  53         u32 out[MLX5_ST_SZ_DW(add_vxlan_udp_dport_out)];
  54
  55         memset(in, 0, sizeof(in));
  56         memset(out, 0, sizeof(out));
  57
  58         MLX5_SET(add_vxlan_udp_dport_in, in, opcode,
  59                  MLX5_CMD_OP_ADD_VXLAN_UDP_DPORT);
  60         MLX5_SET(add_vxlan_udp_dport_in, in, vxlan_udp_port, port);
  61
  62         err = mlx5_cmd_exec(mdev, in, sizeof(in), out, sizeof(out));
  63         if (err)
  64                 return err;
  65
  66         hdr = (struct mlx5_outbox_hdr *)out;
  67         return hdr->status ? -ENOMEM : 0;
  68 }
  69
  70 static int mlx5e_vxlan_core_del_port_cmd(struct mlx5_core_dev *mdev, u16 port)
  71 {
  72         u32 in[MLX5_ST_SZ_DW(delete_vxlan_udp_dport_in)];
  73         u32 out[MLX5_ST_SZ_DW(delete_vxlan_udp_dport_out)];
  74
  75         memset(&in, 0, sizeof(in));
  76         memset(&out, 0, sizeof(out));
  77
  78         MLX5_SET(delete_vxlan_udp_dport_in, in, opcode,
  79                  MLX5_CMD_OP_DELETE_VXLAN_UDP_DPORT);
  80         MLX5_SET(delete_vxlan_udp_dport_in, in, vxlan_udp_port, port);
  81
  82         return mlx5_cmd_exec_check_status(mdev, in, sizeof(in), out,
  83                                           sizeof(out));
  84 }
  85
  86 struct mlx5e_vxlan *mlx5e_vxlan_lookup_port(struct mlx5e_priv *priv, u16 port)
  87 {
  88         struct mlx5e_vxlan_db *vxlan_db = &priv->vxlan;
  89         struct mlx5e_vxlan *vxlan;
  90
  91         spin_lock(&vxlan_db->lock);
  92         vxlan = radix_tree_lookup(&vxlan_db->tree, port);
  93         spin_unlock(&vxlan_db->lock);
  94
  95         return vxlan;
  96 }
  97
  98 int mlx5e_vxlan_add_port(struct mlx5e_priv *priv, u16 port)
  99 {
 100         struct mlx5e_vxlan_db *vxlan_db = &priv->vxlan;
 101         struct mlx5e_vxlan *vxlan;
 102         int err;
 103
 104         err = mlx5e_vxlan_core_add_port_cmd(priv->mdev, port);
 105         if (err)
 106                 return err;
 107
 108         vxlan = kzalloc(sizeof(*vxlan), GFP_KERNEL);
 109         if (!vxlan) {
 110                 err = -ENOMEM;
 111                 goto err_delete_port;
 112         }
 113
 114         vxlan->udp_port = port;
 115
 116         spin_lock_irq(&vxlan_db->lock);
 117         err = radix_tree_insert(&vxlan_db->tree, vxlan->udp_port, vxlan);
 118         spin_unlock_irq(&vxlan_db->lock);
 119         if (err)
 120                 goto err_free;
 121
 122         return 0;
 123
 124 err_free:
 125         kfree(vxlan);
 126 err_delete_port:
 127         mlx5e_vxlan_core_del_port_cmd(priv->mdev, port);
 128         return err;
 129 }
 130
 131 static void __mlx5e_vxlan_core_del_port(struct mlx5e_priv *priv, u16 port)
 132 {
 133         struct mlx5e_vxlan_db *vxlan_db = &priv->vxlan;
 134         struct mlx5e_vxlan *vxlan;
 135
 136         spin_lock_irq(&vxlan_db->lock);
 137         vxlan = radix_tree_delete(&vxlan_db->tree, port);
 138         spin_unlock_irq(&vxlan_db->lock);
 139
 140         if (!vxlan)
 141                 return;
 142
 143         mlx5e_vxlan_core_del_port_cmd(priv->mdev, vxlan->udp_port);
 144
 145         kfree(vxlan);
 146 }
 147
 148 void mlx5e_vxlan_del_port(struct mlx5e_priv *priv, u16 port)
 149 {
 150         if (!mlx5e_vxlan_lookup_port(priv, port))
 151                 return;
 152
 153         __mlx5e_vxlan_core_del_port(priv, port);
 154 }
 155
 156 void mlx5e_vxlan_cleanup(struct mlx5e_priv *priv)
 157 {
 158         struct mlx5e_vxlan_db *vxlan_db = &priv->vxlan;
 159         struct mlx5e_vxlan *vxlan;
 160         unsigned int port = 0;
 161
 162         spin_lock_irq(&vxlan_db->lock);
 163         while (radix_tree_gang_lookup(&vxlan_db->tree, (void **)&vxlan, port, 1)) {
 164                 port = vxlan->udp_port;
 165                 spin_unlock_irq(&vxlan_db->lock);
 166                 __mlx5e_vxlan_core_del_port(priv, (u16)port);
 167                 spin_lock_irq(&vxlan_db->lock);
 168         }
 169         spin_unlock_irq(&vxlan_db->lock);
 170 }