drivers/net/ethernet/microchip/sparx5/sparx5_police.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /* Microchip Sparx5 Switch driver
   3  *
   4  * Copyright (c) 2023 Microchip Technology Inc. and its subsidiaries.
   5  */
   6
   7 #include "sparx5_main_regs.h"
   8 #include "sparx5_main.h"
   9
  10 static int sparx5_policer_service_conf_set(struct sparx5 *sparx5,
  11                                            struct sparx5_policer *pol)
  12 {
  13         u32 idx, pup_tokens, max_pup_tokens, burst, thres;
  14         const struct sparx5_ops *ops = sparx5->data->ops;
  15         struct sparx5_sdlb_group *g;
  16         u64 rate;
  17
  18         g = ops->get_sdlb_group(pol->group);
  19         idx = pol->idx;
  20
  21         rate = pol->rate * 1000;
  22         burst = pol->burst;
  23
  24         pup_tokens = sparx5_sdlb_pup_token_get(sparx5, g->pup_interval, rate);
  25         max_pup_tokens =
  26                 sparx5_sdlb_pup_token_get(sparx5, g->pup_interval, g->max_rate);
  27
  28         thres = DIV_ROUND_UP(burst, g->min_burst);
  29
  30         spx5_wr(ANA_AC_SDLB_PUP_TOKENS_PUP_TOKENS_SET(pup_tokens), sparx5,
  31                 ANA_AC_SDLB_PUP_TOKENS(idx, 0));
  32
  33         spx5_rmw(ANA_AC_SDLB_INH_CTRL_PUP_TOKENS_MAX_SET(max_pup_tokens),
  34                  ANA_AC_SDLB_INH_CTRL_PUP_TOKENS_MAX, sparx5,
  35                  ANA_AC_SDLB_INH_CTRL(idx, 0));
  36
  37         spx5_rmw(ANA_AC_SDLB_THRES_THRES_SET(thres), ANA_AC_SDLB_THRES_THRES,
  38                  sparx5, ANA_AC_SDLB_THRES(idx, 0));
  39
  40         return 0;
  41 }
  42
  43 int sparx5_policer_conf_set(struct sparx5 *sparx5, struct sparx5_policer *pol)
  44 {
  45         /* More policer types will be added later */
  46         switch (pol->type) {
  47         case SPX5_POL_SERVICE:
  48                 return sparx5_policer_service_conf_set(sparx5, pol);
  49         default:
  50                 break;
  51         }
  52
  53         return 0;
  54 }