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