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 {
  44         const u32 l2table_size = MIN(1U << MLX5_CAP_GEN(dev, log_max_l2_table),
  45             MLX5_MPFS_TABLE_MAX);
  46         u32 in[MLX5_ST_SZ_DW(set_l2_table_entry_in)] = {};
  47         u32 out[MLX5_ST_SZ_DW(set_l2_table_entry_out)] = {};
  48         u8 *in_mac_addr;
  49         u32 index;
  50         int err;
  51
  52         if (!MLX5_CAP_GEN(dev, eswitch_flow_table)) {
  53                 *p_index = 0;
  54                 return (0);
  55         }
  56
  57         MPFS_LOCK(dev);
  58         index = find_first_zero_bit(dev->mpfs.bitmap, l2table_size);
  59         if (index < l2table_size)
  60                 set_bit(index, dev->mpfs.bitmap);
  61         MPFS_UNLOCK(dev);
  62
  63         if (index >= l2table_size)
  64                 return (-ENOMEM);
  65
  66         MLX5_SET(set_l2_table_entry_in, in, opcode, MLX5_CMD_OP_SET_L2_TABLE_ENTRY);
  67         MLX5_SET(set_l2_table_entry_in, in, table_index, index);
  68
  69         in_mac_addr = MLX5_ADDR_OF(set_l2_table_entry_in, in, mac_address);
  70         ether_addr_copy(&in_mac_addr[2], mac);
  71
  72         err = mlx5_cmd_exec(dev, in, sizeof(in), out, sizeof(out));
  73         if (err != 0) {
  74                 MPFS_LOCK(dev);
  75                 clear_bit(index, dev->mpfs.bitmap);
  76                 MPFS_UNLOCK(dev);
  77         } else {
  78                 *p_index = index;
  79         }
  80         return (err);
  81 }
  82
  83 int
  84 mlx5_mpfs_del_mac(struct mlx5_core_dev *dev, u32 index)
  85 {
  86         u32 in[MLX5_ST_SZ_DW(delete_l2_table_entry_in)] = {};
  87         u32 out[MLX5_ST_SZ_DW(delete_l2_table_entry_out)] = {};
  88         int err;
  89
  90         if (!MLX5_CAP_GEN(dev, eswitch_flow_table)) {
  91                 if (index != 0)
  92                         return (-EINVAL);
  93                 return (0);
  94         }
  95
  96         MLX5_SET(delete_l2_table_entry_in, in, opcode, MLX5_CMD_OP_DELETE_L2_TABLE_ENTRY);
  97         MLX5_SET(delete_l2_table_entry_in, in, table_index, index);
  98
  99         err = mlx5_cmd_exec(dev, in, sizeof(in), out, sizeof(out));
 100         if (err == 0) {
 101                 MPFS_LOCK(dev);
 102                 clear_bit(index, dev->mpfs.bitmap);
 103                 MPFS_UNLOCK(dev);
 104         }
 105         return (err);
 106 }
 107
 108 int
 109 mlx5_mpfs_init(struct mlx5_core_dev *dev)
 110 {
 111
 112         spin_lock_init(&dev->mpfs.spinlock);
 113         bitmap_zero(dev->mpfs.bitmap, MLX5_MPFS_TABLE_MAX);
 114         return (0);
 115 }
 116
 117 void
 118 mlx5_mpfs_destroy(struct mlx5_core_dev *dev)
 119 {
 120         u32 num;
 121
 122         num = bitmap_weight(dev->mpfs.bitmap, MLX5_MPFS_TABLE_MAX);
 123         if (num != 0)
 124                 mlx5_core_err(dev, "Leaking %u MPFS MAC table entries\n", num);
 125
 126         spin_lock_destroy(&dev->mpfs.spinlock);
 127 }