Quelle  spectrum1_mr_tcam.c   Sprache: C

// SPDX-License-Identifier: BSD-3-Clause OR GPL-2.0
/* Copyright (c) 2017-2018 Mellanox Technologies. All rights reserved */

#include <linux/kernel.h>
#include <linux/parman.h>

#include "reg.h"
#include "spectrum.h"
#include "core_acl_flex_actions.h"
#include "spectrum_mr.h"

struct mlxsw_sp1_mr_tcam_region {
 struct mlxsw_sp *mlxsw_sp;
 enum mlxsw_reg_rtar_key_type rtar_key_type;
 struct parman *parman;
 struct parman_prio *parman_prios;
};

struct mlxsw_sp1_mr_tcam {
 struct mlxsw_sp1_mr_tcam_region tcam_regions[MLXSW_SP_L3_PROTO_MAX];
};

struct mlxsw_sp1_mr_tcam_route {
 struct parman_item parman_item;
 struct parman_prio *parman_prio;
};

static int mlxsw_sp1_mr_tcam_route_replace(struct mlxsw_sp *mlxsw_sp,
        struct parman_item *parman_item,
        struct mlxsw_sp_mr_route_key *key,
        struct mlxsw_afa_block *afa_block)
{
 char rmft2_pl[MLXSW_REG_RMFT2_LEN];

 switch (key->proto) {
 case MLXSW_SP_L3_PROTO_IPV4:
  mlxsw_reg_rmft2_ipv4_pack(rmft2_pl, true, parman_item->index,
       key->vrid,
       MLXSW_REG_RMFT2_IRIF_MASK_IGNORE, 0,
       ntohl(key->group.addr4),
       ntohl(key->group_mask.addr4),
       ntohl(key->source.addr4),
       ntohl(key->source_mask.addr4),
       mlxsw_afa_block_first_set(afa_block));
  break;
 case MLXSW_SP_L3_PROTO_IPV6:
  mlxsw_reg_rmft2_ipv6_pack(rmft2_pl, true, parman_item->index,
       key->vrid,
       MLXSW_REG_RMFT2_IRIF_MASK_IGNORE, 0,
       key->group.addr6,
       key->group_mask.addr6,
       key->source.addr6,
       key->source_mask.addr6,
       mlxsw_afa_block_first_set(afa_block));
 }

 return mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(rmft2), rmft2_pl);
}

static int mlxsw_sp1_mr_tcam_route_remove(struct mlxsw_sp *mlxsw_sp,
       struct parman_item *parman_item,
       struct mlxsw_sp_mr_route_key *key)
{
 struct in6_addr zero_addr = IN6ADDR_ANY_INIT;
 char rmft2_pl[MLXSW_REG_RMFT2_LEN];

 switch (key->proto) {
 case MLXSW_SP_L3_PROTO_IPV4:
  mlxsw_reg_rmft2_ipv4_pack(rmft2_pl, false, parman_item->index,
       key->vrid, 0, 0, 0, 0, 0, 0, NULL);
  break;
 case MLXSW_SP_L3_PROTO_IPV6:
  mlxsw_reg_rmft2_ipv6_pack(rmft2_pl, false, parman_item->index,
       key->vrid, 0, 0, zero_addr, zero_addr,
       zero_addr, zero_addr, NULL);
  break;
 }

 return mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(rmft2), rmft2_pl);
}

static struct mlxsw_sp1_mr_tcam_region *
mlxsw_sp1_mr_tcam_protocol_region(struct mlxsw_sp1_mr_tcam *mr_tcam,
      enum mlxsw_sp_l3proto proto)
{
 return &mr_tcam->tcam_regions[proto];
}

static int
mlxsw_sp1_mr_tcam_route_parman_item_add(struct mlxsw_sp1_mr_tcam *mr_tcam,
     struct mlxsw_sp1_mr_tcam_route *route,
     struct mlxsw_sp_mr_route_key *key,
     enum mlxsw_sp_mr_route_prio prio)
{
 struct mlxsw_sp1_mr_tcam_region *tcam_region;
 int err;

 tcam_region = mlxsw_sp1_mr_tcam_protocol_region(mr_tcam, key->proto);
 err = parman_item_add(tcam_region->parman,
         &tcam_region->parman_prios[prio],
         &route->parman_item);
 if (err)
  return err;

 route->parman_prio = &tcam_region->parman_prios[prio];
 return 0;
}

static void
mlxsw_sp1_mr_tcam_route_parman_item_remove(struct mlxsw_sp1_mr_tcam *mr_tcam,
        struct mlxsw_sp1_mr_tcam_route *route,
        struct mlxsw_sp_mr_route_key *key)
{
 struct mlxsw_sp1_mr_tcam_region *tcam_region;

 tcam_region = mlxsw_sp1_mr_tcam_protocol_region(mr_tcam, key->proto);
 parman_item_remove(tcam_region->parman,
      route->parman_prio, &route->parman_item);
}

static int
mlxsw_sp1_mr_tcam_route_create(struct mlxsw_sp *mlxsw_sp, void *priv,
          void *route_priv,
          struct mlxsw_sp_mr_route_key *key,
          struct mlxsw_afa_block *afa_block,
          enum mlxsw_sp_mr_route_prio prio)
{
 struct mlxsw_sp1_mr_tcam_route *route = route_priv;
 struct mlxsw_sp1_mr_tcam *mr_tcam = priv;
 int err;

 err = mlxsw_sp1_mr_tcam_route_parman_item_add(mr_tcam, route,
            key, prio);
 if (err)
  return err;

 err = mlxsw_sp1_mr_tcam_route_replace(mlxsw_sp, &route->parman_item,
           key, afa_block);
 if (err)
  goto err_route_replace;
 return 0;

err_route_replace:
 mlxsw_sp1_mr_tcam_route_parman_item_remove(mr_tcam, route, key);
 return err;
}

static void
mlxsw_sp1_mr_tcam_route_destroy(struct mlxsw_sp *mlxsw_sp, void *priv,
    void *route_priv,
    struct mlxsw_sp_mr_route_key *key)
{
 struct mlxsw_sp1_mr_tcam_route *route = route_priv;
 struct mlxsw_sp1_mr_tcam *mr_tcam = priv;

 mlxsw_sp1_mr_tcam_route_remove(mlxsw_sp, &route->parman_item, key);
 mlxsw_sp1_mr_tcam_route_parman_item_remove(mr_tcam, route, key);
}

static int
mlxsw_sp1_mr_tcam_route_update(struct mlxsw_sp *mlxsw_sp,
          void *route_priv,
          struct mlxsw_sp_mr_route_key *key,
          struct mlxsw_afa_block *afa_block)
{
 struct mlxsw_sp1_mr_tcam_route *route = route_priv;

 return mlxsw_sp1_mr_tcam_route_replace(mlxsw_sp, &route->parman_item,
            key, afa_block);
}

#define MLXSW_SP1_MR_TCAM_REGION_BASE_COUNT 16
#define MLXSW_SP1_MR_TCAM_REGION_RESIZE_STEP 16

static int
mlxsw_sp1_mr_tcam_region_alloc(struct mlxsw_sp1_mr_tcam_region *mr_tcam_region)
{
 struct mlxsw_sp *mlxsw_sp = mr_tcam_region->mlxsw_sp;
 char rtar_pl[MLXSW_REG_RTAR_LEN];

 mlxsw_reg_rtar_pack(rtar_pl, MLXSW_REG_RTAR_OP_ALLOCATE,
       mr_tcam_region->rtar_key_type,
       MLXSW_SP1_MR_TCAM_REGION_BASE_COUNT);
 return mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(rtar), rtar_pl);
}

static void
mlxsw_sp1_mr_tcam_region_free(struct mlxsw_sp1_mr_tcam_region *mr_tcam_region)
{
 struct mlxsw_sp *mlxsw_sp = mr_tcam_region->mlxsw_sp;
 char rtar_pl[MLXSW_REG_RTAR_LEN];

 mlxsw_reg_rtar_pack(rtar_pl, MLXSW_REG_RTAR_OP_DEALLOCATE,
       mr_tcam_region->rtar_key_type, 0);
 mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(rtar), rtar_pl);
}

static int mlxsw_sp1_mr_tcam_region_parman_resize(void *priv,
        unsigned long new_count)
{
 struct mlxsw_sp1_mr_tcam_region *mr_tcam_region = priv;
 struct mlxsw_sp *mlxsw_sp = mr_tcam_region->mlxsw_sp;
 char rtar_pl[MLXSW_REG_RTAR_LEN];
 u64 max_tcam_rules;

 max_tcam_rules = MLXSW_CORE_RES_GET(mlxsw_sp->core, ACL_MAX_TCAM_RULES);
 if (new_count > max_tcam_rules)
  return -EINVAL;
 mlxsw_reg_rtar_pack(rtar_pl, MLXSW_REG_RTAR_OP_RESIZE,
       mr_tcam_region->rtar_key_type, new_count);
 return mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(rtar), rtar_pl);
}

static void mlxsw_sp1_mr_tcam_region_parman_move(void *priv,
       unsigned long from_index,
       unsigned long to_index,
       unsigned long count)
{
 struct mlxsw_sp1_mr_tcam_region *mr_tcam_region = priv;
 struct mlxsw_sp *mlxsw_sp = mr_tcam_region->mlxsw_sp;
 char rrcr_pl[MLXSW_REG_RRCR_LEN];

 mlxsw_reg_rrcr_pack(rrcr_pl, MLXSW_REG_RRCR_OP_MOVE,
       from_index, count,
       mr_tcam_region->rtar_key_type, to_index);
 mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(rrcr), rrcr_pl);
}

static const struct parman_ops mlxsw_sp1_mr_tcam_region_parman_ops = {
 .base_count = MLXSW_SP1_MR_TCAM_REGION_BASE_COUNT,
 .resize_step = MLXSW_SP1_MR_TCAM_REGION_RESIZE_STEP,
 .resize  = mlxsw_sp1_mr_tcam_region_parman_resize,
 .move  = mlxsw_sp1_mr_tcam_region_parman_move,
 .algo  = PARMAN_ALGO_TYPE_LSORT,
};

static int
mlxsw_sp1_mr_tcam_region_init(struct mlxsw_sp *mlxsw_sp,
         struct mlxsw_sp1_mr_tcam_region *mr_tcam_region,
         enum mlxsw_reg_rtar_key_type rtar_key_type)
{
 struct parman_prio *parman_prios;
 struct parman *parman;
 int err;
 int i;

 mr_tcam_region->rtar_key_type = rtar_key_type;
 mr_tcam_region->mlxsw_sp = mlxsw_sp;

 err = mlxsw_sp1_mr_tcam_region_alloc(mr_tcam_region);
 if (err)
  return err;

 parman = parman_create(&mlxsw_sp1_mr_tcam_region_parman_ops,
          mr_tcam_region);
 if (!parman) {
  err = -ENOMEM;
  goto err_parman_create;
 }
 mr_tcam_region->parman = parman;

 parman_prios = kmalloc_array(MLXSW_SP_MR_ROUTE_PRIO_MAX + 1,
         sizeof(*parman_prios), GFP_KERNEL);
 if (!parman_prios) {
  err = -ENOMEM;
  goto err_parman_prios_alloc;
 }
 mr_tcam_region->parman_prios = parman_prios;

 for (i = 0; i < MLXSW_SP_MR_ROUTE_PRIO_MAX + 1; i++)
  parman_prio_init(mr_tcam_region->parman,
     &mr_tcam_region->parman_prios[i], i);
 return 0;

err_parman_prios_alloc:
 parman_destroy(parman);
err_parman_create:
 mlxsw_sp1_mr_tcam_region_free(mr_tcam_region);
 return err;
}

static void
mlxsw_sp1_mr_tcam_region_fini(struct mlxsw_sp1_mr_tcam_region *mr_tcam_region)
{
 int i;

 for (i = 0; i < MLXSW_SP_MR_ROUTE_PRIO_MAX + 1; i++)
  parman_prio_fini(&mr_tcam_region->parman_prios[i]);
 kfree(mr_tcam_region->parman_prios);
 parman_destroy(mr_tcam_region->parman);
 mlxsw_sp1_mr_tcam_region_free(mr_tcam_region);
}

static int mlxsw_sp1_mr_tcam_init(struct mlxsw_sp *mlxsw_sp, void *priv)
{
 struct mlxsw_sp1_mr_tcam *mr_tcam = priv;
 struct mlxsw_sp1_mr_tcam_region *region = &mr_tcam->tcam_regions[0];
 u32 rtar_key;
 int err;

 if (!MLXSW_CORE_RES_VALID(mlxsw_sp->core, ACL_MAX_TCAM_RULES))
  return -EIO;

 rtar_key = MLXSW_REG_RTAR_KEY_TYPE_IPV4_MULTICAST;
 err = mlxsw_sp1_mr_tcam_region_init(mlxsw_sp,
         ®ion[MLXSW_SP_L3_PROTO_IPV4],
         rtar_key);
 if (err)
  return err;

 rtar_key = MLXSW_REG_RTAR_KEY_TYPE_IPV6_MULTICAST;
 err = mlxsw_sp1_mr_tcam_region_init(mlxsw_sp,
         ®ion[MLXSW_SP_L3_PROTO_IPV6],
         rtar_key);
 if (err)
  goto err_ipv6_region_init;

 return 0;

err_ipv6_region_init:
 mlxsw_sp1_mr_tcam_region_fini(®ion[MLXSW_SP_L3_PROTO_IPV4]);
 return err;
}

static void mlxsw_sp1_mr_tcam_fini(void *priv)
{
 struct mlxsw_sp1_mr_tcam *mr_tcam = priv;
 struct mlxsw_sp1_mr_tcam_region *region = &mr_tcam->tcam_regions[0];

 mlxsw_sp1_mr_tcam_region_fini(®ion[MLXSW_SP_L3_PROTO_IPV6]);
 mlxsw_sp1_mr_tcam_region_fini(®ion[MLXSW_SP_L3_PROTO_IPV4]);
}

const struct mlxsw_sp_mr_tcam_ops mlxsw_sp1_mr_tcam_ops = {
 .priv_size = sizeof(struct mlxsw_sp1_mr_tcam),
 .init = mlxsw_sp1_mr_tcam_init,
 .fini = mlxsw_sp1_mr_tcam_fini,
 .route_priv_size = sizeof(struct mlxsw_sp1_mr_tcam_route),
 .route_create = mlxsw_sp1_mr_tcam_route_create,
 .route_destroy = mlxsw_sp1_mr_tcam_route_destroy,
 .route_update = mlxsw_sp1_mr_tcam_route_update,
};