Loading...
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#define SPX5_PSFP_SF_CNT 1024
11#define SPX5_PSFP_SG_CONFIG_CHANGE_SLEEP 1000
12#define SPX5_PSFP_SG_CONFIG_CHANGE_TIMEO 100000
13
14/* Pool of available service policers */
15static struct sparx5_pool_entry sparx5_psfp_fm_pool[SPX5_SDLB_CNT];
16
17/* Pool of available stream gates */
18static struct sparx5_pool_entry sparx5_psfp_sg_pool[SPX5_PSFP_SG_CNT];
19
20/* Pool of available stream filters */
21static struct sparx5_pool_entry sparx5_psfp_sf_pool[SPX5_PSFP_SF_CNT];
22
23static int sparx5_psfp_sf_get(struct sparx5 *sparx5, u32 *id)
24{
25 return sparx5_pool_get(sparx5_psfp_sf_pool,
26 sparx5->data->consts->n_filters, id);
27}
28
29static int sparx5_psfp_sf_put(struct sparx5 *sparx5, u32 id)
30{
31 return sparx5_pool_put(sparx5_psfp_sf_pool,
32 sparx5->data->consts->n_filters, id);
33}
34
35static int sparx5_psfp_sg_get(struct sparx5 *sparx5, u32 idx, u32 *id)
36{
37 return sparx5_pool_get_with_idx(sparx5_psfp_sg_pool,
38 sparx5->data->consts->n_gates, idx, id);
39}
40
41static int sparx5_psfp_sg_put(struct sparx5 *sparx5, u32 id)
42{
43 return sparx5_pool_put(sparx5_psfp_sg_pool,
44 sparx5->data->consts->n_gates, id);
45}
46
47static int sparx5_psfp_fm_get(struct sparx5 *sparx5, u32 idx, u32 *id)
48{
49 return sparx5_pool_get_with_idx(sparx5_psfp_fm_pool,
50 sparx5->data->consts->n_sdlbs, idx, id);
51}
52
53static int sparx5_psfp_fm_put(struct sparx5 *sparx5, u32 id)
54{
55 return sparx5_pool_put(sparx5_psfp_fm_pool,
56 sparx5->data->consts->n_sdlbs, id);
57}
58
59u32 sparx5_psfp_isdx_get_sf(struct sparx5 *sparx5, u32 isdx)
60{
61 return ANA_L2_TSN_CFG_TSN_SFID_GET(spx5_rd(sparx5,
62 ANA_L2_TSN_CFG(isdx)));
63}
64
65u32 sparx5_psfp_isdx_get_fm(struct sparx5 *sparx5, u32 isdx)
66{
67 return ANA_L2_DLB_CFG_DLB_IDX_GET(spx5_rd(sparx5,
68 ANA_L2_DLB_CFG(isdx)));
69}
70
71u32 sparx5_psfp_sf_get_sg(struct sparx5 *sparx5, u32 sfid)
72{
73 return ANA_AC_TSN_SF_CFG_TSN_SGID_GET(spx5_rd(sparx5,
74 ANA_AC_TSN_SF_CFG(sfid)));
75}
76
77void sparx5_isdx_conf_set(struct sparx5 *sparx5, u32 isdx, u32 sfid, u32 fmid)
78{
79 spx5_rmw(ANA_L2_TSN_CFG_TSN_SFID_SET(sfid), ANA_L2_TSN_CFG_TSN_SFID,
80 sparx5, ANA_L2_TSN_CFG(isdx));
81
82 spx5_rmw(ANA_L2_DLB_CFG_DLB_IDX_SET(fmid), ANA_L2_DLB_CFG_DLB_IDX,
83 sparx5, ANA_L2_DLB_CFG(isdx));
84}
85
86/* Internal priority value to internal priority selector */
87static u32 sparx5_psfp_ipv_to_ips(s32 ipv)
88{
89 return ipv > 0 ? (ipv | BIT(3)) : 0;
90}
91
92static int sparx5_psfp_sgid_get_status(struct sparx5 *sparx5)
93{
94 return spx5_rd(sparx5, ANA_AC_SG_ACCESS_CTRL);
95}
96
97static int sparx5_psfp_sgid_wait_for_completion(struct sparx5 *sparx5)
98{
99 u32 val;
100
101 return readx_poll_timeout(sparx5_psfp_sgid_get_status, sparx5, val,
102 !ANA_AC_SG_ACCESS_CTRL_CONFIG_CHANGE_GET(val),
103 SPX5_PSFP_SG_CONFIG_CHANGE_SLEEP,
104 SPX5_PSFP_SG_CONFIG_CHANGE_TIMEO);
105}
106
107static void sparx5_psfp_sg_config_change(struct sparx5 *sparx5, u32 id)
108{
109 spx5_wr(ANA_AC_SG_ACCESS_CTRL_SGID_SET(id), sparx5,
110 ANA_AC_SG_ACCESS_CTRL);
111
112 spx5_wr(ANA_AC_SG_ACCESS_CTRL_CONFIG_CHANGE_SET(1) |
113 ANA_AC_SG_ACCESS_CTRL_SGID_SET(id),
114 sparx5, ANA_AC_SG_ACCESS_CTRL);
115
116 if (sparx5_psfp_sgid_wait_for_completion(sparx5) < 0)
117 pr_debug("%s:%d timed out waiting for sgid completion",
118 __func__, __LINE__);
119}
120
121static void sparx5_psfp_sf_set(struct sparx5 *sparx5, u32 id,
122 const struct sparx5_psfp_sf *sf)
123{
124 /* Configure stream gate*/
125 spx5_rmw(ANA_AC_TSN_SF_CFG_TSN_SGID_SET(sf->sgid) |
126 ANA_AC_TSN_SF_CFG_TSN_MAX_SDU_SET(sf->max_sdu) |
127 ANA_AC_TSN_SF_CFG_BLOCK_OVERSIZE_STATE_SET(sf->sblock_osize) |
128 ANA_AC_TSN_SF_CFG_BLOCK_OVERSIZE_ENA_SET(sf->sblock_osize_ena),
129 ANA_AC_TSN_SF_CFG_TSN_SGID | ANA_AC_TSN_SF_CFG_TSN_MAX_SDU |
130 ANA_AC_TSN_SF_CFG_BLOCK_OVERSIZE_STATE |
131 ANA_AC_TSN_SF_CFG_BLOCK_OVERSIZE_ENA,
132 sparx5, ANA_AC_TSN_SF_CFG(id));
133}
134
135static int sparx5_psfp_sg_set(struct sparx5 *sparx5, u32 id,
136 const struct sparx5_psfp_sg *sg)
137{
138 u32 ips, base_lsb, base_msb, accum_time_interval = 0;
139 const struct sparx5_psfp_gce *gce;
140 int i;
141
142 ips = sparx5_psfp_ipv_to_ips(sg->ipv);
143 base_lsb = sg->basetime.tv_sec & 0xffffffff;
144 base_msb = sg->basetime.tv_sec >> 32;
145
146 /* Set stream gate id */
147 spx5_wr(ANA_AC_SG_ACCESS_CTRL_SGID_SET(id), sparx5,
148 ANA_AC_SG_ACCESS_CTRL);
149
150 /* Write AdminPSFP values */
151 spx5_wr(sg->basetime.tv_nsec, sparx5, ANA_AC_SG_CONFIG_REG_1);
152 spx5_wr(base_lsb, sparx5, ANA_AC_SG_CONFIG_REG_2);
153
154 spx5_rmw(ANA_AC_SG_CONFIG_REG_3_BASE_TIME_SEC_MSB_SET(base_msb) |
155 ANA_AC_SG_CONFIG_REG_3_INIT_IPS_SET(ips) |
156 ANA_AC_SG_CONFIG_REG_3_LIST_LENGTH_SET(sg->num_entries) |
157 ANA_AC_SG_CONFIG_REG_3_INIT_GATE_STATE_SET(sg->gate_state) |
158 ANA_AC_SG_CONFIG_REG_3_GATE_ENABLE_SET(1),
159 ANA_AC_SG_CONFIG_REG_3_BASE_TIME_SEC_MSB |
160 ANA_AC_SG_CONFIG_REG_3_INIT_IPS |
161 ANA_AC_SG_CONFIG_REG_3_LIST_LENGTH |
162 ANA_AC_SG_CONFIG_REG_3_INIT_GATE_STATE |
163 ANA_AC_SG_CONFIG_REG_3_GATE_ENABLE,
164 sparx5, ANA_AC_SG_CONFIG_REG_3);
165
166 spx5_wr(sg->cycletime, sparx5, ANA_AC_SG_CONFIG_REG_4);
167 spx5_wr(sg->cycletimeext, sparx5, ANA_AC_SG_CONFIG_REG_5);
168
169 /* For each scheduling entry */
170 for (i = 0; i < sg->num_entries; i++) {
171 gce = &sg->gce[i];
172 ips = sparx5_psfp_ipv_to_ips(gce->ipv);
173 /* hardware needs TimeInterval to be cumulative */
174 accum_time_interval += gce->interval;
175 /* Set gate state */
176 spx5_wr(ANA_AC_SG_GCL_GS_CONFIG_IPS_SET(ips) |
177 ANA_AC_SG_GCL_GS_CONFIG_GATE_STATE_SET(gce->gate_state),
178 sparx5, ANA_AC_SG_GCL_GS_CONFIG(i));
179
180 /* Set time interval */
181 spx5_wr(accum_time_interval, sparx5,
182 ANA_AC_SG_GCL_TI_CONFIG(i));
183
184 /* Set maximum octets */
185 spx5_wr(gce->maxoctets, sparx5, ANA_AC_SG_GCL_OCT_CONFIG(i));
186 }
187
188 return 0;
189}
190
191static int sparx5_sdlb_conf_set(struct sparx5 *sparx5,
192 struct sparx5_psfp_fm *fm)
193{
194 int (*sparx5_sdlb_group_action)(struct sparx5 *sparx5, u32 group,
195 u32 idx);
196
197 if (!fm->pol.rate && !fm->pol.burst)
198 sparx5_sdlb_group_action = &sparx5_sdlb_group_del;
199 else
200 sparx5_sdlb_group_action = &sparx5_sdlb_group_add;
201
202 sparx5_policer_conf_set(sparx5, &fm->pol);
203
204 return sparx5_sdlb_group_action(sparx5, fm->pol.group, fm->pol.idx);
205}
206
207int sparx5_psfp_sf_add(struct sparx5 *sparx5, const struct sparx5_psfp_sf *sf,
208 u32 *id)
209{
210 int ret;
211
212 ret = sparx5_psfp_sf_get(sparx5, id);
213 if (ret < 0)
214 return ret;
215
216 sparx5_psfp_sf_set(sparx5, *id, sf);
217
218 return 0;
219}
220
221int sparx5_psfp_sf_del(struct sparx5 *sparx5, u32 id)
222{
223 const struct sparx5_psfp_sf sf = { 0 };
224
225 sparx5_psfp_sf_set(sparx5, id, &sf);
226
227 return sparx5_psfp_sf_put(sparx5, id);
228}
229
230int sparx5_psfp_sg_add(struct sparx5 *sparx5, u32 uidx,
231 struct sparx5_psfp_sg *sg, u32 *id)
232{
233 ktime_t basetime;
234 int ret;
235
236 ret = sparx5_psfp_sg_get(sparx5, uidx, id);
237 if (ret < 0)
238 return ret;
239 /* Was already in use, no need to reconfigure */
240 if (ret > 1)
241 return 0;
242
243 /* Calculate basetime for this stream gate */
244 sparx5_new_base_time(sparx5, sg->cycletime, 0, &basetime);
245 sg->basetime = ktime_to_timespec64(basetime);
246
247 sparx5_psfp_sg_set(sparx5, *id, sg);
248
249 /* Signal hardware to copy AdminPSFP values into OperPSFP values */
250 sparx5_psfp_sg_config_change(sparx5, *id);
251
252 return 0;
253}
254
255int sparx5_psfp_sg_del(struct sparx5 *sparx5, u32 id)
256{
257 const struct sparx5_psfp_sg sg = { 0 };
258 int ret;
259
260 ret = sparx5_psfp_sg_put(sparx5, id);
261 if (ret < 0)
262 return ret;
263 /* Stream gate still in use ? */
264 if (ret > 0)
265 return 0;
266
267 return sparx5_psfp_sg_set(sparx5, id, &sg);
268}
269
270int sparx5_psfp_fm_add(struct sparx5 *sparx5, u32 uidx,
271 struct sparx5_psfp_fm *fm, u32 *id)
272{
273 struct sparx5_policer *pol = &fm->pol;
274 int ret;
275
276 /* Get flow meter */
277 ret = sparx5_psfp_fm_get(sparx5, uidx, &fm->pol.idx);
278 if (ret < 0)
279 return ret;
280 /* Was already in use, no need to reconfigure */
281 if (ret > 1)
282 return 0;
283
284 ret = sparx5_sdlb_group_get_by_rate(sparx5, pol->rate, pol->burst);
285 if (ret < 0)
286 return ret;
287
288 fm->pol.group = ret;
289
290 ret = sparx5_sdlb_conf_set(sparx5, fm);
291 if (ret < 0)
292 return ret;
293
294 *id = fm->pol.idx;
295
296 return 0;
297}
298
299int sparx5_psfp_fm_del(struct sparx5 *sparx5, u32 id)
300{
301 struct sparx5_psfp_fm fm = { .pol.idx = id,
302 .pol.type = SPX5_POL_SERVICE };
303 int ret;
304
305 /* Find the group that this lb belongs to */
306 ret = sparx5_sdlb_group_get_by_index(sparx5, id, &fm.pol.group);
307 if (ret < 0)
308 return ret;
309
310 ret = sparx5_psfp_fm_put(sparx5, id);
311 if (ret < 0)
312 return ret;
313 /* Do not reset flow-meter if still in use. */
314 if (ret > 0)
315 return 0;
316
317 return sparx5_sdlb_conf_set(sparx5, &fm);
318}
319
320void sparx5_psfp_init(struct sparx5 *sparx5)
321{
322 const struct sparx5_ops *ops = sparx5->data->ops;
323 const struct sparx5_sdlb_group *group;
324 int i;
325
326 for (i = 0; i < sparx5->data->consts->n_lb_groups; i++) {
327 group = ops->get_sdlb_group(i);
328 sparx5_sdlb_group_init(sparx5, group->max_rate,
329 group->min_burst, group->frame_size, i);
330 }
331
332 spx5_wr(ANA_AC_SG_CYCLETIME_UPDATE_PERIOD_SG_CT_UPDATE_ENA_SET(1),
333 sparx5, ANA_AC_SG_CYCLETIME_UPDATE_PERIOD);
334
335 spx5_rmw(ANA_L2_FWD_CFG_ISDX_LOOKUP_ENA_SET(1),
336 ANA_L2_FWD_CFG_ISDX_LOOKUP_ENA, sparx5, ANA_L2_FWD_CFG);
337}
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#define SPX5_PSFP_SF_CNT 1024
11#define SPX5_PSFP_SG_CONFIG_CHANGE_SLEEP 1000
12#define SPX5_PSFP_SG_CONFIG_CHANGE_TIMEO 100000
13
14/* Pool of available service policers */
15static struct sparx5_pool_entry sparx5_psfp_fm_pool[SPX5_SDLB_CNT];
16
17/* Pool of available stream gates */
18static struct sparx5_pool_entry sparx5_psfp_sg_pool[SPX5_PSFP_SG_CNT];
19
20/* Pool of available stream filters */
21static struct sparx5_pool_entry sparx5_psfp_sf_pool[SPX5_PSFP_SF_CNT];
22
23static int sparx5_psfp_sf_get(u32 *id)
24{
25 return sparx5_pool_get(sparx5_psfp_sf_pool, SPX5_PSFP_SF_CNT, id);
26}
27
28static int sparx5_psfp_sf_put(u32 id)
29{
30 return sparx5_pool_put(sparx5_psfp_sf_pool, SPX5_PSFP_SF_CNT, id);
31}
32
33static int sparx5_psfp_sg_get(u32 idx, u32 *id)
34{
35 return sparx5_pool_get_with_idx(sparx5_psfp_sg_pool, SPX5_PSFP_SG_CNT,
36 idx, id);
37}
38
39static int sparx5_psfp_sg_put(u32 id)
40{
41 return sparx5_pool_put(sparx5_psfp_sg_pool, SPX5_PSFP_SG_CNT, id);
42}
43
44static int sparx5_psfp_fm_get(u32 idx, u32 *id)
45{
46 return sparx5_pool_get_with_idx(sparx5_psfp_fm_pool, SPX5_SDLB_CNT, idx,
47 id);
48}
49
50static int sparx5_psfp_fm_put(u32 id)
51{
52 return sparx5_pool_put(sparx5_psfp_fm_pool, SPX5_SDLB_CNT, id);
53}
54
55u32 sparx5_psfp_isdx_get_sf(struct sparx5 *sparx5, u32 isdx)
56{
57 return ANA_L2_TSN_CFG_TSN_SFID_GET(spx5_rd(sparx5,
58 ANA_L2_TSN_CFG(isdx)));
59}
60
61u32 sparx5_psfp_isdx_get_fm(struct sparx5 *sparx5, u32 isdx)
62{
63 return ANA_L2_DLB_CFG_DLB_IDX_GET(spx5_rd(sparx5,
64 ANA_L2_DLB_CFG(isdx)));
65}
66
67u32 sparx5_psfp_sf_get_sg(struct sparx5 *sparx5, u32 sfid)
68{
69 return ANA_AC_TSN_SF_CFG_TSN_SGID_GET(spx5_rd(sparx5,
70 ANA_AC_TSN_SF_CFG(sfid)));
71}
72
73void sparx5_isdx_conf_set(struct sparx5 *sparx5, u32 isdx, u32 sfid, u32 fmid)
74{
75 spx5_rmw(ANA_L2_TSN_CFG_TSN_SFID_SET(sfid), ANA_L2_TSN_CFG_TSN_SFID,
76 sparx5, ANA_L2_TSN_CFG(isdx));
77
78 spx5_rmw(ANA_L2_DLB_CFG_DLB_IDX_SET(fmid), ANA_L2_DLB_CFG_DLB_IDX,
79 sparx5, ANA_L2_DLB_CFG(isdx));
80}
81
82/* Internal priority value to internal priority selector */
83static u32 sparx5_psfp_ipv_to_ips(s32 ipv)
84{
85 return ipv > 0 ? (ipv | BIT(3)) : 0;
86}
87
88static int sparx5_psfp_sgid_get_status(struct sparx5 *sparx5)
89{
90 return spx5_rd(sparx5, ANA_AC_SG_ACCESS_CTRL);
91}
92
93static int sparx5_psfp_sgid_wait_for_completion(struct sparx5 *sparx5)
94{
95 u32 val;
96
97 return readx_poll_timeout(sparx5_psfp_sgid_get_status, sparx5, val,
98 !ANA_AC_SG_ACCESS_CTRL_CONFIG_CHANGE_GET(val),
99 SPX5_PSFP_SG_CONFIG_CHANGE_SLEEP,
100 SPX5_PSFP_SG_CONFIG_CHANGE_TIMEO);
101}
102
103static void sparx5_psfp_sg_config_change(struct sparx5 *sparx5, u32 id)
104{
105 spx5_wr(ANA_AC_SG_ACCESS_CTRL_SGID_SET(id), sparx5,
106 ANA_AC_SG_ACCESS_CTRL);
107
108 spx5_wr(ANA_AC_SG_ACCESS_CTRL_CONFIG_CHANGE_SET(1) |
109 ANA_AC_SG_ACCESS_CTRL_SGID_SET(id),
110 sparx5, ANA_AC_SG_ACCESS_CTRL);
111
112 if (sparx5_psfp_sgid_wait_for_completion(sparx5) < 0)
113 pr_debug("%s:%d timed out waiting for sgid completion",
114 __func__, __LINE__);
115}
116
117static void sparx5_psfp_sf_set(struct sparx5 *sparx5, u32 id,
118 const struct sparx5_psfp_sf *sf)
119{
120 /* Configure stream gate*/
121 spx5_rmw(ANA_AC_TSN_SF_CFG_TSN_SGID_SET(sf->sgid) |
122 ANA_AC_TSN_SF_CFG_TSN_MAX_SDU_SET(sf->max_sdu) |
123 ANA_AC_TSN_SF_CFG_BLOCK_OVERSIZE_STATE_SET(sf->sblock_osize) |
124 ANA_AC_TSN_SF_CFG_BLOCK_OVERSIZE_ENA_SET(sf->sblock_osize_ena),
125 ANA_AC_TSN_SF_CFG_TSN_SGID | ANA_AC_TSN_SF_CFG_TSN_MAX_SDU |
126 ANA_AC_TSN_SF_CFG_BLOCK_OVERSIZE_STATE |
127 ANA_AC_TSN_SF_CFG_BLOCK_OVERSIZE_ENA,
128 sparx5, ANA_AC_TSN_SF_CFG(id));
129}
130
131static int sparx5_psfp_sg_set(struct sparx5 *sparx5, u32 id,
132 const struct sparx5_psfp_sg *sg)
133{
134 u32 ips, base_lsb, base_msb, accum_time_interval = 0;
135 const struct sparx5_psfp_gce *gce;
136 int i;
137
138 ips = sparx5_psfp_ipv_to_ips(sg->ipv);
139 base_lsb = sg->basetime.tv_sec & 0xffffffff;
140 base_msb = sg->basetime.tv_sec >> 32;
141
142 /* Set stream gate id */
143 spx5_wr(ANA_AC_SG_ACCESS_CTRL_SGID_SET(id), sparx5,
144 ANA_AC_SG_ACCESS_CTRL);
145
146 /* Write AdminPSFP values */
147 spx5_wr(sg->basetime.tv_nsec, sparx5, ANA_AC_SG_CONFIG_REG_1);
148 spx5_wr(base_lsb, sparx5, ANA_AC_SG_CONFIG_REG_2);
149
150 spx5_rmw(ANA_AC_SG_CONFIG_REG_3_BASE_TIME_SEC_MSB_SET(base_msb) |
151 ANA_AC_SG_CONFIG_REG_3_INIT_IPS_SET(ips) |
152 ANA_AC_SG_CONFIG_REG_3_LIST_LENGTH_SET(sg->num_entries) |
153 ANA_AC_SG_CONFIG_REG_3_INIT_GATE_STATE_SET(sg->gate_state) |
154 ANA_AC_SG_CONFIG_REG_3_GATE_ENABLE_SET(1),
155 ANA_AC_SG_CONFIG_REG_3_BASE_TIME_SEC_MSB |
156 ANA_AC_SG_CONFIG_REG_3_INIT_IPS |
157 ANA_AC_SG_CONFIG_REG_3_LIST_LENGTH |
158 ANA_AC_SG_CONFIG_REG_3_INIT_GATE_STATE |
159 ANA_AC_SG_CONFIG_REG_3_GATE_ENABLE,
160 sparx5, ANA_AC_SG_CONFIG_REG_3);
161
162 spx5_wr(sg->cycletime, sparx5, ANA_AC_SG_CONFIG_REG_4);
163 spx5_wr(sg->cycletimeext, sparx5, ANA_AC_SG_CONFIG_REG_5);
164
165 /* For each scheduling entry */
166 for (i = 0; i < sg->num_entries; i++) {
167 gce = &sg->gce[i];
168 ips = sparx5_psfp_ipv_to_ips(gce->ipv);
169 /* hardware needs TimeInterval to be cumulative */
170 accum_time_interval += gce->interval;
171 /* Set gate state */
172 spx5_wr(ANA_AC_SG_GCL_GS_CONFIG_IPS_SET(ips) |
173 ANA_AC_SG_GCL_GS_CONFIG_GATE_STATE_SET(gce->gate_state),
174 sparx5, ANA_AC_SG_GCL_GS_CONFIG(i));
175
176 /* Set time interval */
177 spx5_wr(accum_time_interval, sparx5,
178 ANA_AC_SG_GCL_TI_CONFIG(i));
179
180 /* Set maximum octets */
181 spx5_wr(gce->maxoctets, sparx5, ANA_AC_SG_GCL_OCT_CONFIG(i));
182 }
183
184 return 0;
185}
186
187static int sparx5_sdlb_conf_set(struct sparx5 *sparx5,
188 struct sparx5_psfp_fm *fm)
189{
190 int (*sparx5_sdlb_group_action)(struct sparx5 *sparx5, u32 group,
191 u32 idx);
192
193 if (!fm->pol.rate && !fm->pol.burst)
194 sparx5_sdlb_group_action = &sparx5_sdlb_group_del;
195 else
196 sparx5_sdlb_group_action = &sparx5_sdlb_group_add;
197
198 sparx5_policer_conf_set(sparx5, &fm->pol);
199
200 return sparx5_sdlb_group_action(sparx5, fm->pol.group, fm->pol.idx);
201}
202
203int sparx5_psfp_sf_add(struct sparx5 *sparx5, const struct sparx5_psfp_sf *sf,
204 u32 *id)
205{
206 int ret;
207
208 ret = sparx5_psfp_sf_get(id);
209 if (ret < 0)
210 return ret;
211
212 sparx5_psfp_sf_set(sparx5, *id, sf);
213
214 return 0;
215}
216
217int sparx5_psfp_sf_del(struct sparx5 *sparx5, u32 id)
218{
219 const struct sparx5_psfp_sf sf = { 0 };
220
221 sparx5_psfp_sf_set(sparx5, id, &sf);
222
223 return sparx5_psfp_sf_put(id);
224}
225
226int sparx5_psfp_sg_add(struct sparx5 *sparx5, u32 uidx,
227 struct sparx5_psfp_sg *sg, u32 *id)
228{
229 ktime_t basetime;
230 int ret;
231
232 ret = sparx5_psfp_sg_get(uidx, id);
233 if (ret < 0)
234 return ret;
235 /* Was already in use, no need to reconfigure */
236 if (ret > 1)
237 return 0;
238
239 /* Calculate basetime for this stream gate */
240 sparx5_new_base_time(sparx5, sg->cycletime, 0, &basetime);
241 sg->basetime = ktime_to_timespec64(basetime);
242
243 sparx5_psfp_sg_set(sparx5, *id, sg);
244
245 /* Signal hardware to copy AdminPSFP values into OperPSFP values */
246 sparx5_psfp_sg_config_change(sparx5, *id);
247
248 return 0;
249}
250
251int sparx5_psfp_sg_del(struct sparx5 *sparx5, u32 id)
252{
253 const struct sparx5_psfp_sg sg = { 0 };
254 int ret;
255
256 ret = sparx5_psfp_sg_put(id);
257 if (ret < 0)
258 return ret;
259 /* Stream gate still in use ? */
260 if (ret > 0)
261 return 0;
262
263 return sparx5_psfp_sg_set(sparx5, id, &sg);
264}
265
266int sparx5_psfp_fm_add(struct sparx5 *sparx5, u32 uidx,
267 struct sparx5_psfp_fm *fm, u32 *id)
268{
269 struct sparx5_policer *pol = &fm->pol;
270 int ret;
271
272 /* Get flow meter */
273 ret = sparx5_psfp_fm_get(uidx, &fm->pol.idx);
274 if (ret < 0)
275 return ret;
276 /* Was already in use, no need to reconfigure */
277 if (ret > 1)
278 return 0;
279
280 ret = sparx5_sdlb_group_get_by_rate(sparx5, pol->rate, pol->burst);
281 if (ret < 0)
282 return ret;
283
284 fm->pol.group = ret;
285
286 ret = sparx5_sdlb_conf_set(sparx5, fm);
287 if (ret < 0)
288 return ret;
289
290 *id = fm->pol.idx;
291
292 return 0;
293}
294
295int sparx5_psfp_fm_del(struct sparx5 *sparx5, u32 id)
296{
297 struct sparx5_psfp_fm fm = { .pol.idx = id,
298 .pol.type = SPX5_POL_SERVICE };
299 int ret;
300
301 /* Find the group that this lb belongs to */
302 ret = sparx5_sdlb_group_get_by_index(sparx5, id, &fm.pol.group);
303 if (ret < 0)
304 return ret;
305
306 ret = sparx5_psfp_fm_put(id);
307 if (ret < 0)
308 return ret;
309 /* Do not reset flow-meter if still in use. */
310 if (ret > 0)
311 return 0;
312
313 return sparx5_sdlb_conf_set(sparx5, &fm);
314}
315
316void sparx5_psfp_init(struct sparx5 *sparx5)
317{
318 const struct sparx5_sdlb_group *group;
319 int i;
320
321 for (i = 0; i < SPX5_SDLB_GROUP_CNT; i++) {
322 group = &sdlb_groups[i];
323 sparx5_sdlb_group_init(sparx5, group->max_rate,
324 group->min_burst, group->frame_size, i);
325 }
326
327 spx5_wr(ANA_AC_SG_CYCLETIME_UPDATE_PERIOD_SG_CT_UPDATE_ENA_SET(1),
328 sparx5, ANA_AC_SG_CYCLETIME_UPDATE_PERIOD);
329
330 spx5_rmw(ANA_L2_FWD_CFG_ISDX_LOOKUP_ENA_SET(1),
331 ANA_L2_FWD_CFG_ISDX_LOOKUP_ENA, sparx5, ANA_L2_FWD_CFG);
332}