sys/dev/mlx5/mlx5_core/mlx5_mpfs.c

   1 /*-
   2  * Copyright (c) 2019, Mellanox Technologies, Ltd.  All rights reserved.
   3  *
   4  * Redistribution and use in source and binary forms, with or without
   5  * modification, are permitted provided that the following conditions
   6  * are met:
   7  * 1. Redistributions of source code must retain the above copyright
   8  *    notice, this list of conditions and the following disclaimer.
   9  * 2. Redistributions in binary form must reproduce the above copyright
  10  *    notice, this list of conditions and the following disclaimer in the
  11  *    documentation and/or other materials provided with the distribution.
  12  *
  13  * THIS SOFTWARE IS PROVIDED BY AUTHOR AND CONTRIBUTORS `AS IS' AND
  14  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  15  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  16  * ARE DISCLAIMED.  IN NO EVENT SHALL AUTHOR OR CONTRIBUTORS BE LIABLE
  17  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  18  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  19  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  20  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  21  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  22  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  23  * SUCH DAMAGE.
  24  *
  25  * $FreeBSD$
  26  */
  27
  28 #include <linux/types.h>
  29 #include <linux/etherdevice.h>
  30
  31 #include <dev/mlx5/mlx5_ifc.h>
  32 #include <dev/mlx5/device.h>
  33 #include <dev/mlx5/mpfs.h>
  34 #include <dev/mlx5/driver.h>
  35
  36 #include "mlx5_core.h"
  37
  38 #define MPFS_LOCK(dev) spin_lock(&(dev)->mpfs.spinlock)
  39 #define MPFS_UNLOCK(dev) spin_unlock(&(dev)->mpfs.spinlock)
  40
  41 int
  42 mlx5_mpfs_add_mac(struct mlx5_core_dev *dev, u32 *p_index, const u8 *mac,
  43     u8 vlan_valid, u16 vlan)
  44 {
  45         const u32 l2table_size = MIN(1U << MLX5_CAP_GEN(dev, log_max_l2_table),
  46             MLX5_MPFS_TABLE_MAX);
  47         u32 in[MLX5_ST_SZ_DW(set_l2_table_entry_in)] = {};
  48         u32 out[MLX5_ST_SZ_DW(set_l2_table_entry_out)] = {};
  49         u8 *in_mac_addr;
  50         u32 index;
  51         int err;
  52
  53         if (!MLX5_CAP_GEN(dev, eswitch_flow_table)) {
  54                 *p_index = 0;
  55                 return (0);
  56         }
  57
  58         MPFS_LOCK(dev);
  59         index = find_first_zero_bit(dev->mpfs.bitmap, l2table_size);
  60         if (index < l2table_size)
  61                 set_bit(index, dev->mpfs.bitmap);
  62         MPFS_UNLOCK(dev);
  63
  64         if (index >= l2table_size)
  65                 return (-ENOMEM);
  66
  67         MLX5_SET(set_l2_table_entry_in, in, opcode, MLX5_CMD_OP_SET_L2_TABLE_ENTRY);
  68         MLX5_SET(set_l2_table_entry_in, in, table_index, index);
  69         MLX5_SET(set_l2_table_entry_in, in, vlan_valid, vlan_valid);
  70         MLX5_SET(set_l2_table_entry_in, in, vlan, vlan);
  71
  72         in_mac_addr = MLX5_ADDR_OF(set_l2_table_entry_in, in, mac_address);
  73         ether_addr_copy(&in_mac_addr[2], mac);
  74
  75         err = mlx5_cmd_exec(dev, in, sizeof(in), out, sizeof(out));
  76         if (err != 0) {
  77                 MPFS_LOCK(dev);
  78                 clear_bit(index, dev->mpfs.bitmap);
  79                 MPFS_UNLOCK(dev);
  80         } else {
  81                 *p_index = index;
  82         }
  83         return (err);
  84 }
  85
  86 int
  87 mlx5_mpfs_del_mac(struct mlx5_core_dev *dev, u32 index)
  88 {
  89         u32 in[MLX5_ST_SZ_DW(delete_l2_table_entry_in)] = {};
  90         u32 out[MLX5_ST_SZ_DW(delete_l2_table_entry_out)] = {};
  91         int err;
  92
  93         if (!MLX5_CAP_GEN(dev, eswitch_flow_table)) {
  94                 if (index != 0)
  95                         return (-EINVAL);
  96                 return (0);
  97         }
  98
  99         MLX5_SET(delete_l2_table_entry_in, in, opcode, MLX5_CMD_OP_DELETE_L2_TABLE_ENTRY);
 100         MLX5_SET(delete_l2_table_entry_in, in, table_index, index);
 101
 102         err = mlx5_cmd_exec(dev, in, sizeof(in), out, sizeof(out));
 103         if (err == 0) {
 104                 MPFS_LOCK(dev);
 105                 clear_bit(index, dev->mpfs.bitmap);
 106                 MPFS_UNLOCK(dev);
 107         }
 108         return (err);
 109 }
 110
 111 int
 112 mlx5_mpfs_init(struct mlx5_core_dev *dev)
 113 {
 114
 115         spin_lock_init(&dev->mpfs.spinlock);
 116         bitmap_zero(dev->mpfs.bitmap, MLX5_MPFS_TABLE_MAX);
 117         return (0);
 118 }
 119
 120 void
 121 mlx5_mpfs_destroy(struct mlx5_core_dev *dev)
 122 {
 123         u32 num;
 124
 125         num = bitmap_weight(dev->mpfs.bitmap, MLX5_MPFS_TABLE_MAX);
 126         if (num != 0)
 127                 mlx5_core_err(dev, "Leaking %u MPFS MAC table entries\n", num);
 128
 129         spin_lock_destroy(&dev->mpfs.spinlock);
 130 }