1 // SPDX-License-Identifier: BSD-3-Clause OR GPL-2.0
2 /* Copyright (c) 2015-2018 Mellanox Technologies. All rights reserved */
3 
4 #include <linux/kernel.h>
5 #include <linux/types.h>
6 #include <linux/dcbnl.h>
7 #include <linux/if_ether.h>
8 #include <linux/list.h>
9 #include <linux/netlink.h>
10 
11 #include "spectrum.h"
12 #include "core.h"
13 #include "port.h"
14 #include "reg.h"
15 
16 struct mlxsw_sp_sb_pr {
17 	enum mlxsw_reg_sbpr_mode mode;
18 	u32 size;
19 	u8 freeze_mode:1,
20 	   freeze_size:1;
21 };
22 
23 struct mlxsw_cp_sb_occ {
24 	u32 cur;
25 	u32 max;
26 };
27 
28 struct mlxsw_sp_sb_cm {
29 	u32 min_buff;
30 	u32 max_buff;
31 	u16 pool_index;
32 	struct mlxsw_cp_sb_occ occ;
33 	u8 freeze_pool:1,
34 	   freeze_thresh:1;
35 };
36 
37 #define MLXSW_SP_SB_INFI -1U
38 #define MLXSW_SP_SB_REST -2U
39 
40 struct mlxsw_sp_sb_pm {
41 	u32 min_buff;
42 	u32 max_buff;
43 	struct mlxsw_cp_sb_occ occ;
44 };
45 
46 struct mlxsw_sp_sb_mm {
47 	u32 min_buff;
48 	u32 max_buff;
49 	u16 pool_index;
50 };
51 
52 struct mlxsw_sp_sb_pool_des {
53 	enum mlxsw_reg_sbxx_dir dir;
54 	u8 pool;
55 };
56 
57 #define MLXSW_SP_SB_POOL_ING		0
58 #define MLXSW_SP_SB_POOL_EGR		4
59 #define MLXSW_SP_SB_POOL_EGR_MC		8
60 #define MLXSW_SP_SB_POOL_ING_CPU	9
61 #define MLXSW_SP_SB_POOL_EGR_CPU	10
62 
63 static const struct mlxsw_sp_sb_pool_des mlxsw_sp1_sb_pool_dess[] = {
64 	{MLXSW_REG_SBXX_DIR_INGRESS, 0},
65 	{MLXSW_REG_SBXX_DIR_INGRESS, 1},
66 	{MLXSW_REG_SBXX_DIR_INGRESS, 2},
67 	{MLXSW_REG_SBXX_DIR_INGRESS, 3},
68 	{MLXSW_REG_SBXX_DIR_EGRESS, 0},
69 	{MLXSW_REG_SBXX_DIR_EGRESS, 1},
70 	{MLXSW_REG_SBXX_DIR_EGRESS, 2},
71 	{MLXSW_REG_SBXX_DIR_EGRESS, 3},
72 	{MLXSW_REG_SBXX_DIR_EGRESS, 15},
73 	{MLXSW_REG_SBXX_DIR_INGRESS, 4},
74 	{MLXSW_REG_SBXX_DIR_EGRESS, 4},
75 };
76 
77 static const struct mlxsw_sp_sb_pool_des mlxsw_sp2_sb_pool_dess[] = {
78 	{MLXSW_REG_SBXX_DIR_INGRESS, 0},
79 	{MLXSW_REG_SBXX_DIR_INGRESS, 1},
80 	{MLXSW_REG_SBXX_DIR_INGRESS, 2},
81 	{MLXSW_REG_SBXX_DIR_INGRESS, 3},
82 	{MLXSW_REG_SBXX_DIR_EGRESS, 0},
83 	{MLXSW_REG_SBXX_DIR_EGRESS, 1},
84 	{MLXSW_REG_SBXX_DIR_EGRESS, 2},
85 	{MLXSW_REG_SBXX_DIR_EGRESS, 3},
86 	{MLXSW_REG_SBXX_DIR_EGRESS, 15},
87 	{MLXSW_REG_SBXX_DIR_INGRESS, 4},
88 	{MLXSW_REG_SBXX_DIR_EGRESS, 4},
89 };
90 
91 #define MLXSW_SP_SB_ING_TC_COUNT 8
92 #define MLXSW_SP_SB_EG_TC_COUNT 16
93 
94 struct mlxsw_sp_sb_port {
95 	struct mlxsw_sp_sb_cm ing_cms[MLXSW_SP_SB_ING_TC_COUNT];
96 	struct mlxsw_sp_sb_cm eg_cms[MLXSW_SP_SB_EG_TC_COUNT];
97 	struct mlxsw_sp_sb_pm *pms;
98 };
99 
100 struct mlxsw_sp_sb {
101 	struct mlxsw_sp_sb_pr *prs;
102 	struct mlxsw_sp_sb_port *ports;
103 	u32 cell_size;
104 	u32 max_headroom_cells;
105 	u64 sb_size;
106 };
107 
108 struct mlxsw_sp_sb_vals {
109 	unsigned int pool_count;
110 	const struct mlxsw_sp_sb_pool_des *pool_dess;
111 	const struct mlxsw_sp_sb_pm *pms;
112 	const struct mlxsw_sp_sb_pm *pms_cpu;
113 	const struct mlxsw_sp_sb_pr *prs;
114 	const struct mlxsw_sp_sb_mm *mms;
115 	const struct mlxsw_sp_sb_cm *cms_ingress;
116 	const struct mlxsw_sp_sb_cm *cms_egress;
117 	const struct mlxsw_sp_sb_cm *cms_cpu;
118 	unsigned int mms_count;
119 	unsigned int cms_ingress_count;
120 	unsigned int cms_egress_count;
121 	unsigned int cms_cpu_count;
122 };
123 
124 struct mlxsw_sp_sb_ops {
125 	u32 (*int_buf_size_get)(int mtu, u32 speed);
126 };
127 
128 u32 mlxsw_sp_cells_bytes(const struct mlxsw_sp *mlxsw_sp, u32 cells)
129 {
130 	return mlxsw_sp->sb->cell_size * cells;
131 }
132 
133 u32 mlxsw_sp_bytes_cells(const struct mlxsw_sp *mlxsw_sp, u32 bytes)
134 {
135 	return DIV_ROUND_UP(bytes, mlxsw_sp->sb->cell_size);
136 }
137 
138 static u32 mlxsw_sp_port_headroom_8x_adjust(const struct mlxsw_sp_port *mlxsw_sp_port,
139 					    u32 size_cells)
140 {
141 	/* Ports with eight lanes use two headroom buffers between which the
142 	 * configured headroom size is split. Therefore, multiply the calculated
143 	 * headroom size by two.
144 	 */
145 	return mlxsw_sp_port->mapping.width == 8 ? 2 * size_cells : size_cells;
146 }
147 
148 static struct mlxsw_sp_sb_pr *mlxsw_sp_sb_pr_get(struct mlxsw_sp *mlxsw_sp,
149 						 u16 pool_index)
150 {
151 	return &mlxsw_sp->sb->prs[pool_index];
152 }
153 
154 static bool mlxsw_sp_sb_cm_exists(u8 pg_buff, enum mlxsw_reg_sbxx_dir dir)
155 {
156 	if (dir == MLXSW_REG_SBXX_DIR_INGRESS)
157 		return pg_buff < MLXSW_SP_SB_ING_TC_COUNT;
158 	else
159 		return pg_buff < MLXSW_SP_SB_EG_TC_COUNT;
160 }
161 
162 static struct mlxsw_sp_sb_cm *mlxsw_sp_sb_cm_get(struct mlxsw_sp *mlxsw_sp,
163 						 u16 local_port, u8 pg_buff,
164 						 enum mlxsw_reg_sbxx_dir dir)
165 {
166 	struct mlxsw_sp_sb_port *sb_port = &mlxsw_sp->sb->ports[local_port];
167 
168 	WARN_ON(!mlxsw_sp_sb_cm_exists(pg_buff, dir));
169 	if (dir == MLXSW_REG_SBXX_DIR_INGRESS)
170 		return &sb_port->ing_cms[pg_buff];
171 	else
172 		return &sb_port->eg_cms[pg_buff];
173 }
174 
175 static struct mlxsw_sp_sb_pm *mlxsw_sp_sb_pm_get(struct mlxsw_sp *mlxsw_sp,
176 						 u16 local_port, u16 pool_index)
177 {
178 	return &mlxsw_sp->sb->ports[local_port].pms[pool_index];
179 }
180 
181 static int mlxsw_sp_sb_pr_write(struct mlxsw_sp *mlxsw_sp, u16 pool_index,
182 				enum mlxsw_reg_sbpr_mode mode,
183 				u32 size, bool infi_size)
184 {
185 	const struct mlxsw_sp_sb_pool_des *des =
186 		&mlxsw_sp->sb_vals->pool_dess[pool_index];
187 	char sbpr_pl[MLXSW_REG_SBPR_LEN];
188 	struct mlxsw_sp_sb_pr *pr;
189 	int err;
190 
191 	mlxsw_reg_sbpr_pack(sbpr_pl, des->pool, des->dir, mode,
192 			    size, infi_size);
193 	err = mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(sbpr), sbpr_pl);
194 	if (err)
195 		return err;
196 
197 	if (infi_size)
198 		size = mlxsw_sp_bytes_cells(mlxsw_sp, mlxsw_sp->sb->sb_size);
199 	pr = mlxsw_sp_sb_pr_get(mlxsw_sp, pool_index);
200 	pr->mode = mode;
201 	pr->size = size;
202 	return 0;
203 }
204 
205 static int mlxsw_sp_sb_pr_desc_write(struct mlxsw_sp *mlxsw_sp,
206 				     enum mlxsw_reg_sbxx_dir dir,
207 				     enum mlxsw_reg_sbpr_mode mode,
208 				     u32 size, bool infi_size)
209 {
210 	char sbpr_pl[MLXSW_REG_SBPR_LEN];
211 
212 	/* The FW default descriptor buffer configuration uses only pool 14 for
213 	 * descriptors.
214 	 */
215 	mlxsw_reg_sbpr_pack(sbpr_pl, 14, dir, mode, size, infi_size);
216 	mlxsw_reg_sbpr_desc_set(sbpr_pl, true);
217 	return mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(sbpr), sbpr_pl);
218 }
219 
220 static int mlxsw_sp_sb_cm_write(struct mlxsw_sp *mlxsw_sp, u16 local_port,
221 				u8 pg_buff, u32 min_buff, u32 max_buff,
222 				bool infi_max, u16 pool_index)
223 {
224 	const struct mlxsw_sp_sb_pool_des *des =
225 		&mlxsw_sp->sb_vals->pool_dess[pool_index];
226 	char sbcm_pl[MLXSW_REG_SBCM_LEN];
227 	struct mlxsw_sp_sb_cm *cm;
228 	int err;
229 
230 	mlxsw_reg_sbcm_pack(sbcm_pl, local_port, pg_buff, des->dir,
231 			    min_buff, max_buff, infi_max, des->pool);
232 	err = mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(sbcm), sbcm_pl);
233 	if (err)
234 		return err;
235 
236 	if (mlxsw_sp_sb_cm_exists(pg_buff, des->dir)) {
237 		if (infi_max)
238 			max_buff = mlxsw_sp_bytes_cells(mlxsw_sp,
239 							mlxsw_sp->sb->sb_size);
240 
241 		cm = mlxsw_sp_sb_cm_get(mlxsw_sp, local_port, pg_buff,
242 					des->dir);
243 		cm->min_buff = min_buff;
244 		cm->max_buff = max_buff;
245 		cm->pool_index = pool_index;
246 	}
247 	return 0;
248 }
249 
250 static int mlxsw_sp_sb_pm_write(struct mlxsw_sp *mlxsw_sp, u16 local_port,
251 				u16 pool_index, u32 min_buff, u32 max_buff)
252 {
253 	const struct mlxsw_sp_sb_pool_des *des =
254 		&mlxsw_sp->sb_vals->pool_dess[pool_index];
255 	char sbpm_pl[MLXSW_REG_SBPM_LEN];
256 	struct mlxsw_sp_sb_pm *pm;
257 	int err;
258 
259 	mlxsw_reg_sbpm_pack(sbpm_pl, local_port, des->pool, des->dir, false,
260 			    min_buff, max_buff);
261 	err = mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(sbpm), sbpm_pl);
262 	if (err)
263 		return err;
264 
265 	pm = mlxsw_sp_sb_pm_get(mlxsw_sp, local_port, pool_index);
266 	pm->min_buff = min_buff;
267 	pm->max_buff = max_buff;
268 	return 0;
269 }
270 
271 static int mlxsw_sp_sb_pm_occ_clear(struct mlxsw_sp *mlxsw_sp, u16 local_port,
272 				    u16 pool_index, struct list_head *bulk_list)
273 {
274 	const struct mlxsw_sp_sb_pool_des *des =
275 		&mlxsw_sp->sb_vals->pool_dess[pool_index];
276 	char sbpm_pl[MLXSW_REG_SBPM_LEN];
277 
278 	if (local_port == MLXSW_PORT_CPU_PORT &&
279 	    des->dir == MLXSW_REG_SBXX_DIR_INGRESS)
280 		return 0;
281 
282 	mlxsw_reg_sbpm_pack(sbpm_pl, local_port, des->pool, des->dir,
283 			    true, 0, 0);
284 	return mlxsw_reg_trans_query(mlxsw_sp->core, MLXSW_REG(sbpm), sbpm_pl,
285 				     bulk_list, NULL, 0);
286 }
287 
288 static void mlxsw_sp_sb_pm_occ_query_cb(struct mlxsw_core *mlxsw_core,
289 					char *sbpm_pl, size_t sbpm_pl_len,
290 					unsigned long cb_priv)
291 {
292 	struct mlxsw_sp_sb_pm *pm = (struct mlxsw_sp_sb_pm *) cb_priv;
293 
294 	mlxsw_reg_sbpm_unpack(sbpm_pl, &pm->occ.cur, &pm->occ.max);
295 }
296 
297 static int mlxsw_sp_sb_pm_occ_query(struct mlxsw_sp *mlxsw_sp, u16 local_port,
298 				    u16 pool_index, struct list_head *bulk_list)
299 {
300 	const struct mlxsw_sp_sb_pool_des *des =
301 		&mlxsw_sp->sb_vals->pool_dess[pool_index];
302 	char sbpm_pl[MLXSW_REG_SBPM_LEN];
303 	struct mlxsw_sp_sb_pm *pm;
304 
305 	if (local_port == MLXSW_PORT_CPU_PORT &&
306 	    des->dir == MLXSW_REG_SBXX_DIR_INGRESS)
307 		return 0;
308 
309 	pm = mlxsw_sp_sb_pm_get(mlxsw_sp, local_port, pool_index);
310 	mlxsw_reg_sbpm_pack(sbpm_pl, local_port, des->pool, des->dir,
311 			    false, 0, 0);
312 	return mlxsw_reg_trans_query(mlxsw_sp->core, MLXSW_REG(sbpm), sbpm_pl,
313 				     bulk_list,
314 				     mlxsw_sp_sb_pm_occ_query_cb,
315 				     (unsigned long) pm);
316 }
317 
318 void mlxsw_sp_hdroom_prios_reset_buf_idx(struct mlxsw_sp_hdroom *hdroom)
319 {
320 	int prio;
321 
322 	for (prio = 0; prio < IEEE_8021QAZ_MAX_TCS; prio++) {
323 		switch (hdroom->mode) {
324 		case MLXSW_SP_HDROOM_MODE_DCB:
325 			hdroom->prios.prio[prio].buf_idx = hdroom->prios.prio[prio].ets_buf_idx;
326 			break;
327 		case MLXSW_SP_HDROOM_MODE_TC:
328 			hdroom->prios.prio[prio].buf_idx = hdroom->prios.prio[prio].set_buf_idx;
329 			break;
330 		}
331 	}
332 }
333 
334 void mlxsw_sp_hdroom_bufs_reset_lossiness(struct mlxsw_sp_hdroom *hdroom)
335 {
336 	int prio;
337 	int i;
338 
339 	for (i = 0; i < DCBX_MAX_BUFFERS; i++)
340 		hdroom->bufs.buf[i].lossy = true;
341 
342 	for (prio = 0; prio < IEEE_8021Q_MAX_PRIORITIES; prio++) {
343 		if (!hdroom->prios.prio[prio].lossy)
344 			hdroom->bufs.buf[hdroom->prios.prio[prio].buf_idx].lossy = false;
345 	}
346 }
347 
348 static u16 mlxsw_sp_hdroom_buf_threshold_get(const struct mlxsw_sp *mlxsw_sp, int mtu)
349 {
350 	return 2 * mlxsw_sp_bytes_cells(mlxsw_sp, mtu);
351 }
352 
353 static void mlxsw_sp_hdroom_buf_pack(char *pbmc_pl, int index, u16 size, u16 thres, bool lossy)
354 {
355 	if (lossy)
356 		mlxsw_reg_pbmc_lossy_buffer_pack(pbmc_pl, index, size);
357 	else
358 		mlxsw_reg_pbmc_lossless_buffer_pack(pbmc_pl, index, size,
359 						    thres);
360 }
361 
362 static u16 mlxsw_sp_hdroom_buf_delay_get(const struct mlxsw_sp *mlxsw_sp,
363 					 const struct mlxsw_sp_hdroom *hdroom)
364 {
365 	u16 delay_cells;
366 
367 	delay_cells = mlxsw_sp_bytes_cells(mlxsw_sp, hdroom->delay_bytes);
368 
369 	/* In the worst case scenario the delay will be made up of packets that
370 	 * are all of size CELL_SIZE + 1, which means each packet will require
371 	 * almost twice its true size when buffered in the switch. We therefore
372 	 * multiply this value by the "cell factor", which is close to 2.
373 	 *
374 	 * Another MTU is added in case the transmitting host already started
375 	 * transmitting a maximum length frame when the PFC packet was received.
376 	 */
377 	return 2 * delay_cells + mlxsw_sp_bytes_cells(mlxsw_sp, hdroom->mtu);
378 }
379 
380 static u32 mlxsw_sp_hdroom_int_buf_size_get(struct mlxsw_sp *mlxsw_sp, int mtu, u32 speed)
381 {
382 	u32 buffsize = mlxsw_sp->sb_ops->int_buf_size_get(mtu, speed);
383 
384 	return mlxsw_sp_bytes_cells(mlxsw_sp, buffsize) + 1;
385 }
386 
387 static bool mlxsw_sp_hdroom_buf_is_used(const struct mlxsw_sp_hdroom *hdroom, int buf)
388 {
389 	int prio;
390 
391 	for (prio = 0; prio < IEEE_8021QAZ_MAX_TCS; prio++) {
392 		if (hdroom->prios.prio[prio].buf_idx == buf)
393 			return true;
394 	}
395 	return false;
396 }
397 
398 void mlxsw_sp_hdroom_bufs_reset_sizes(struct mlxsw_sp_port *mlxsw_sp_port,
399 				      struct mlxsw_sp_hdroom *hdroom)
400 {
401 	struct mlxsw_sp *mlxsw_sp = mlxsw_sp_port->mlxsw_sp;
402 	u16 reserve_cells;
403 	int i;
404 
405 	/* Internal buffer. */
406 	reserve_cells = mlxsw_sp_hdroom_int_buf_size_get(mlxsw_sp, mlxsw_sp_port->max_mtu,
407 							 mlxsw_sp_port->max_speed);
408 	reserve_cells = mlxsw_sp_port_headroom_8x_adjust(mlxsw_sp_port, reserve_cells);
409 	hdroom->int_buf.reserve_cells = reserve_cells;
410 
411 	if (hdroom->int_buf.enable)
412 		hdroom->int_buf.size_cells = reserve_cells;
413 	else
414 		hdroom->int_buf.size_cells = 0;
415 
416 	/* PG buffers. */
417 	for (i = 0; i < DCBX_MAX_BUFFERS; i++) {
418 		struct mlxsw_sp_hdroom_buf *buf = &hdroom->bufs.buf[i];
419 		u16 thres_cells;
420 		u16 delay_cells;
421 
422 		if (!mlxsw_sp_hdroom_buf_is_used(hdroom, i)) {
423 			thres_cells = 0;
424 			delay_cells = 0;
425 		} else if (buf->lossy) {
426 			thres_cells = mlxsw_sp_hdroom_buf_threshold_get(mlxsw_sp, hdroom->mtu);
427 			delay_cells = 0;
428 		} else {
429 			thres_cells = mlxsw_sp_hdroom_buf_threshold_get(mlxsw_sp, hdroom->mtu);
430 			delay_cells = mlxsw_sp_hdroom_buf_delay_get(mlxsw_sp, hdroom);
431 		}
432 
433 		thres_cells = mlxsw_sp_port_headroom_8x_adjust(mlxsw_sp_port, thres_cells);
434 		delay_cells = mlxsw_sp_port_headroom_8x_adjust(mlxsw_sp_port, delay_cells);
435 
436 		buf->thres_cells = thres_cells;
437 		if (hdroom->mode == MLXSW_SP_HDROOM_MODE_DCB) {
438 			buf->size_cells = thres_cells + delay_cells;
439 		} else {
440 			/* Do not allow going below the minimum size, even if
441 			 * the user requested it.
442 			 */
443 			buf->size_cells = max(buf->set_size_cells, buf->thres_cells);
444 		}
445 	}
446 }
447 
448 #define MLXSW_SP_PB_UNUSED 8
449 
450 static int mlxsw_sp_hdroom_configure_buffers(struct mlxsw_sp_port *mlxsw_sp_port,
451 					     const struct mlxsw_sp_hdroom *hdroom, bool force)
452 {
453 	struct mlxsw_sp *mlxsw_sp = mlxsw_sp_port->mlxsw_sp;
454 	char pbmc_pl[MLXSW_REG_PBMC_LEN];
455 	bool dirty;
456 	int err;
457 	int i;
458 
459 	dirty = memcmp(&mlxsw_sp_port->hdroom->bufs, &hdroom->bufs, sizeof(hdroom->bufs));
460 	if (!dirty && !force)
461 		return 0;
462 
463 	mlxsw_reg_pbmc_pack(pbmc_pl, mlxsw_sp_port->local_port, 0xffff, 0xffff / 2);
464 	for (i = 0; i < MLXSW_SP_PB_COUNT; i++) {
465 		const struct mlxsw_sp_hdroom_buf *buf = &hdroom->bufs.buf[i];
466 
467 		if (i == MLXSW_SP_PB_UNUSED)
468 			continue;
469 
470 		mlxsw_sp_hdroom_buf_pack(pbmc_pl, i, buf->size_cells, buf->thres_cells, buf->lossy);
471 	}
472 
473 	mlxsw_reg_pbmc_lossy_buffer_pack(pbmc_pl, MLXSW_REG_PBMC_PORT_SHARED_BUF_IDX, 0);
474 	err = mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(pbmc), pbmc_pl);
475 	if (err)
476 		return err;
477 
478 	mlxsw_sp_port->hdroom->bufs = hdroom->bufs;
479 	return 0;
480 }
481 
482 static int mlxsw_sp_hdroom_configure_priomap(struct mlxsw_sp_port *mlxsw_sp_port,
483 					     const struct mlxsw_sp_hdroom *hdroom, bool force)
484 {
485 	char pptb_pl[MLXSW_REG_PPTB_LEN];
486 	bool dirty;
487 	int prio;
488 	int err;
489 
490 	dirty = memcmp(&mlxsw_sp_port->hdroom->prios, &hdroom->prios, sizeof(hdroom->prios));
491 	if (!dirty && !force)
492 		return 0;
493 
494 	mlxsw_reg_pptb_pack(pptb_pl, mlxsw_sp_port->local_port);
495 	for (prio = 0; prio < IEEE_8021QAZ_MAX_TCS; prio++)
496 		mlxsw_reg_pptb_prio_to_buff_pack(pptb_pl, prio, hdroom->prios.prio[prio].buf_idx);
497 
498 	err = mlxsw_reg_write(mlxsw_sp_port->mlxsw_sp->core, MLXSW_REG(pptb), pptb_pl);
499 	if (err)
500 		return err;
501 
502 	mlxsw_sp_port->hdroom->prios = hdroom->prios;
503 	return 0;
504 }
505 
506 static int mlxsw_sp_hdroom_configure_int_buf(struct mlxsw_sp_port *mlxsw_sp_port,
507 					     const struct mlxsw_sp_hdroom *hdroom, bool force)
508 {
509 	char sbib_pl[MLXSW_REG_SBIB_LEN];
510 	bool dirty;
511 	int err;
512 
513 	dirty = memcmp(&mlxsw_sp_port->hdroom->int_buf, &hdroom->int_buf, sizeof(hdroom->int_buf));
514 	if (!dirty && !force)
515 		return 0;
516 
517 	mlxsw_reg_sbib_pack(sbib_pl, mlxsw_sp_port->local_port, hdroom->int_buf.size_cells);
518 	err = mlxsw_reg_write(mlxsw_sp_port->mlxsw_sp->core, MLXSW_REG(sbib), sbib_pl);
519 	if (err)
520 		return err;
521 
522 	mlxsw_sp_port->hdroom->int_buf = hdroom->int_buf;
523 	return 0;
524 }
525 
526 static bool mlxsw_sp_hdroom_bufs_fit(struct mlxsw_sp *mlxsw_sp,
527 				     const struct mlxsw_sp_hdroom *hdroom)
528 {
529 	u32 taken_headroom_cells = 0;
530 	int i;
531 
532 	for (i = 0; i < MLXSW_SP_PB_COUNT; i++)
533 		taken_headroom_cells += hdroom->bufs.buf[i].size_cells;
534 
535 	taken_headroom_cells += hdroom->int_buf.reserve_cells;
536 	return taken_headroom_cells <= mlxsw_sp->sb->max_headroom_cells;
537 }
538 
539 static int __mlxsw_sp_hdroom_configure(struct mlxsw_sp_port *mlxsw_sp_port,
540 				       const struct mlxsw_sp_hdroom *hdroom, bool force)
541 {
542 	struct mlxsw_sp_hdroom orig_hdroom;
543 	struct mlxsw_sp_hdroom tmp_hdroom;
544 	int err;
545 	int i;
546 
547 	/* Port buffers need to be configured in three steps. First, all buffers
548 	 * with non-zero size are configured. Then, prio-to-buffer map is
549 	 * updated, allowing traffic to flow to the now non-zero buffers.
550 	 * Finally, zero-sized buffers are configured, because now no traffic
551 	 * should be directed to them anymore. This way, in a non-congested
552 	 * system, no packet drops are introduced by the reconfiguration.
553 	 */
554 
555 	orig_hdroom = *mlxsw_sp_port->hdroom;
556 	tmp_hdroom = orig_hdroom;
557 	for (i = 0; i < MLXSW_SP_PB_COUNT; i++) {
558 		if (hdroom->bufs.buf[i].size_cells)
559 			tmp_hdroom.bufs.buf[i] = hdroom->bufs.buf[i];
560 	}
561 
562 	if (!mlxsw_sp_hdroom_bufs_fit(mlxsw_sp_port->mlxsw_sp, &tmp_hdroom) ||
563 	    !mlxsw_sp_hdroom_bufs_fit(mlxsw_sp_port->mlxsw_sp, hdroom))
564 		return -ENOBUFS;
565 
566 	err = mlxsw_sp_hdroom_configure_buffers(mlxsw_sp_port, &tmp_hdroom, force);
567 	if (err)
568 		return err;
569 
570 	err = mlxsw_sp_hdroom_configure_priomap(mlxsw_sp_port, hdroom, force);
571 	if (err)
572 		goto err_configure_priomap;
573 
574 	err = mlxsw_sp_hdroom_configure_buffers(mlxsw_sp_port, hdroom, false);
575 	if (err)
576 		goto err_configure_buffers;
577 
578 	err = mlxsw_sp_hdroom_configure_int_buf(mlxsw_sp_port, hdroom, false);
579 	if (err)
580 		goto err_configure_int_buf;
581 
582 	*mlxsw_sp_port->hdroom = *hdroom;
583 	return 0;
584 
585 err_configure_int_buf:
586 	mlxsw_sp_hdroom_configure_buffers(mlxsw_sp_port, &tmp_hdroom, false);
587 err_configure_buffers:
588 	mlxsw_sp_hdroom_configure_priomap(mlxsw_sp_port, &tmp_hdroom, false);
589 err_configure_priomap:
590 	mlxsw_sp_hdroom_configure_buffers(mlxsw_sp_port, &orig_hdroom, false);
591 	return err;
592 }
593 
594 int mlxsw_sp_hdroom_configure(struct mlxsw_sp_port *mlxsw_sp_port,
595 			      const struct mlxsw_sp_hdroom *hdroom)
596 {
597 	return __mlxsw_sp_hdroom_configure(mlxsw_sp_port, hdroom, false);
598 }
599 
600 static int mlxsw_sp_port_headroom_init(struct mlxsw_sp_port *mlxsw_sp_port)
601 {
602 	struct mlxsw_sp *mlxsw_sp = mlxsw_sp_port->mlxsw_sp;
603 	struct mlxsw_sp_hdroom hdroom = {};
604 	u32 size9;
605 	int prio;
606 
607 	hdroom.mtu = mlxsw_sp_port->dev->mtu;
608 	hdroom.mode = MLXSW_SP_HDROOM_MODE_DCB;
609 	for (prio = 0; prio < IEEE_8021QAZ_MAX_TCS; prio++)
610 		hdroom.prios.prio[prio].lossy = true;
611 
612 	mlxsw_sp_hdroom_bufs_reset_lossiness(&hdroom);
613 	mlxsw_sp_hdroom_bufs_reset_sizes(mlxsw_sp_port, &hdroom);
614 
615 	/* Buffer 9 is used for control traffic. */
616 	size9 = mlxsw_sp_port_headroom_8x_adjust(mlxsw_sp_port, mlxsw_sp_port->max_mtu);
617 	hdroom.bufs.buf[9].size_cells = mlxsw_sp_bytes_cells(mlxsw_sp, size9);
618 
619 	return __mlxsw_sp_hdroom_configure(mlxsw_sp_port, &hdroom, true);
620 }
621 
622 static int mlxsw_sp_sb_port_init(struct mlxsw_sp *mlxsw_sp,
623 				 struct mlxsw_sp_sb_port *sb_port)
624 {
625 	struct mlxsw_sp_sb_pm *pms;
626 
627 	pms = kcalloc(mlxsw_sp->sb_vals->pool_count, sizeof(*pms),
628 		      GFP_KERNEL);
629 	if (!pms)
630 		return -ENOMEM;
631 	sb_port->pms = pms;
632 	return 0;
633 }
634 
635 static void mlxsw_sp_sb_port_fini(struct mlxsw_sp_sb_port *sb_port)
636 {
637 	kfree(sb_port->pms);
638 }
639 
640 static int mlxsw_sp_sb_ports_init(struct mlxsw_sp *mlxsw_sp)
641 {
642 	unsigned int max_ports = mlxsw_core_max_ports(mlxsw_sp->core);
643 	struct mlxsw_sp_sb_pr *prs;
644 	int i;
645 	int err;
646 
647 	mlxsw_sp->sb->ports = kcalloc(max_ports,
648 				      sizeof(struct mlxsw_sp_sb_port),
649 				      GFP_KERNEL);
650 	if (!mlxsw_sp->sb->ports)
651 		return -ENOMEM;
652 
653 	prs = kcalloc(mlxsw_sp->sb_vals->pool_count, sizeof(*prs),
654 		      GFP_KERNEL);
655 	if (!prs) {
656 		err = -ENOMEM;
657 		goto err_alloc_prs;
658 	}
659 	mlxsw_sp->sb->prs = prs;
660 
661 	for (i = 0; i < max_ports; i++) {
662 		err = mlxsw_sp_sb_port_init(mlxsw_sp, &mlxsw_sp->sb->ports[i]);
663 		if (err)
664 			goto err_sb_port_init;
665 	}
666 
667 	return 0;
668 
669 err_sb_port_init:
670 	for (i--; i >= 0; i--)
671 		mlxsw_sp_sb_port_fini(&mlxsw_sp->sb->ports[i]);
672 	kfree(mlxsw_sp->sb->prs);
673 err_alloc_prs:
674 	kfree(mlxsw_sp->sb->ports);
675 	return err;
676 }
677 
678 static void mlxsw_sp_sb_ports_fini(struct mlxsw_sp *mlxsw_sp)
679 {
680 	int max_ports = mlxsw_core_max_ports(mlxsw_sp->core);
681 	int i;
682 
683 	for (i = max_ports - 1; i >= 0; i--)
684 		mlxsw_sp_sb_port_fini(&mlxsw_sp->sb->ports[i]);
685 	kfree(mlxsw_sp->sb->prs);
686 	kfree(mlxsw_sp->sb->ports);
687 }
688 
689 #define MLXSW_SP_SB_PR(_mode, _size)	\
690 	{				\
691 		.mode = _mode,		\
692 		.size = _size,		\
693 	}
694 
695 #define MLXSW_SP_SB_PR_EXT(_mode, _size, _freeze_mode, _freeze_size)	\
696 	{								\
697 		.mode = _mode,						\
698 		.size = _size,						\
699 		.freeze_mode = _freeze_mode,				\
700 		.freeze_size = _freeze_size,				\
701 	}
702 
703 #define MLXSW_SP1_SB_PR_CPU_SIZE	(256 * 1000)
704 
705 /* Order according to mlxsw_sp1_sb_pool_dess */
706 static const struct mlxsw_sp_sb_pr mlxsw_sp1_sb_prs[] = {
707 	MLXSW_SP_SB_PR(MLXSW_REG_SBPR_MODE_DYNAMIC, MLXSW_SP_SB_REST),
708 	MLXSW_SP_SB_PR(MLXSW_REG_SBPR_MODE_DYNAMIC, 0),
709 	MLXSW_SP_SB_PR(MLXSW_REG_SBPR_MODE_DYNAMIC, 0),
710 	MLXSW_SP_SB_PR(MLXSW_REG_SBPR_MODE_DYNAMIC, 0),
711 	MLXSW_SP_SB_PR_EXT(MLXSW_REG_SBPR_MODE_DYNAMIC, MLXSW_SP_SB_REST,
712 			   true, false),
713 	MLXSW_SP_SB_PR(MLXSW_REG_SBPR_MODE_DYNAMIC, 0),
714 	MLXSW_SP_SB_PR(MLXSW_REG_SBPR_MODE_DYNAMIC, 0),
715 	MLXSW_SP_SB_PR(MLXSW_REG_SBPR_MODE_DYNAMIC, 0),
716 	MLXSW_SP_SB_PR_EXT(MLXSW_REG_SBPR_MODE_STATIC, MLXSW_SP_SB_INFI,
717 			   true, true),
718 	MLXSW_SP_SB_PR_EXT(MLXSW_REG_SBPR_MODE_DYNAMIC,
719 			   MLXSW_SP1_SB_PR_CPU_SIZE, true, false),
720 	MLXSW_SP_SB_PR_EXT(MLXSW_REG_SBPR_MODE_DYNAMIC,
721 			   MLXSW_SP1_SB_PR_CPU_SIZE, true, false),
722 };
723 
724 #define MLXSW_SP2_SB_PR_CPU_SIZE	(256 * 1000)
725 
726 /* Order according to mlxsw_sp2_sb_pool_dess */
727 static const struct mlxsw_sp_sb_pr mlxsw_sp2_sb_prs[] = {
728 	MLXSW_SP_SB_PR(MLXSW_REG_SBPR_MODE_DYNAMIC, MLXSW_SP_SB_REST),
729 	MLXSW_SP_SB_PR(MLXSW_REG_SBPR_MODE_STATIC, 0),
730 	MLXSW_SP_SB_PR(MLXSW_REG_SBPR_MODE_STATIC, 0),
731 	MLXSW_SP_SB_PR(MLXSW_REG_SBPR_MODE_STATIC, 0),
732 	MLXSW_SP_SB_PR_EXT(MLXSW_REG_SBPR_MODE_DYNAMIC, MLXSW_SP_SB_REST,
733 			   true, false),
734 	MLXSW_SP_SB_PR(MLXSW_REG_SBPR_MODE_STATIC, 0),
735 	MLXSW_SP_SB_PR(MLXSW_REG_SBPR_MODE_STATIC, 0),
736 	MLXSW_SP_SB_PR(MLXSW_REG_SBPR_MODE_STATIC, 0),
737 	MLXSW_SP_SB_PR_EXT(MLXSW_REG_SBPR_MODE_STATIC, MLXSW_SP_SB_INFI,
738 			   true, true),
739 	MLXSW_SP_SB_PR_EXT(MLXSW_REG_SBPR_MODE_DYNAMIC,
740 			   MLXSW_SP2_SB_PR_CPU_SIZE, true, false),
741 	MLXSW_SP_SB_PR_EXT(MLXSW_REG_SBPR_MODE_DYNAMIC,
742 			   MLXSW_SP2_SB_PR_CPU_SIZE, true, false),
743 };
744 
745 static int mlxsw_sp_sb_prs_init(struct mlxsw_sp *mlxsw_sp,
746 				const struct mlxsw_sp_sb_pr *prs,
747 				const struct mlxsw_sp_sb_pool_des *pool_dess,
748 				size_t prs_len)
749 {
750 	/* Round down, unlike mlxsw_sp_bytes_cells(). */
751 	u32 sb_cells = div_u64(mlxsw_sp->sb->sb_size, mlxsw_sp->sb->cell_size);
752 	u32 rest_cells[2] = {sb_cells, sb_cells};
753 	int i;
754 	int err;
755 
756 	/* Calculate how much space to give to the "REST" pools in either
757 	 * direction.
758 	 */
759 	for (i = 0; i < prs_len; i++) {
760 		enum mlxsw_reg_sbxx_dir dir = pool_dess[i].dir;
761 		u32 size = prs[i].size;
762 		u32 size_cells;
763 
764 		if (size == MLXSW_SP_SB_INFI || size == MLXSW_SP_SB_REST)
765 			continue;
766 
767 		size_cells = mlxsw_sp_bytes_cells(mlxsw_sp, size);
768 		if (WARN_ON_ONCE(size_cells > rest_cells[dir]))
769 			continue;
770 
771 		rest_cells[dir] -= size_cells;
772 	}
773 
774 	for (i = 0; i < prs_len; i++) {
775 		u32 size = prs[i].size;
776 		u32 size_cells;
777 
778 		if (size == MLXSW_SP_SB_INFI) {
779 			err = mlxsw_sp_sb_pr_write(mlxsw_sp, i, prs[i].mode,
780 						   0, true);
781 		} else if (size == MLXSW_SP_SB_REST) {
782 			size_cells = rest_cells[pool_dess[i].dir];
783 			err = mlxsw_sp_sb_pr_write(mlxsw_sp, i, prs[i].mode,
784 						   size_cells, false);
785 		} else {
786 			size_cells = mlxsw_sp_bytes_cells(mlxsw_sp, size);
787 			err = mlxsw_sp_sb_pr_write(mlxsw_sp, i, prs[i].mode,
788 						   size_cells, false);
789 		}
790 		if (err)
791 			return err;
792 	}
793 
794 	err = mlxsw_sp_sb_pr_desc_write(mlxsw_sp, MLXSW_REG_SBXX_DIR_INGRESS,
795 					MLXSW_REG_SBPR_MODE_DYNAMIC, 0, true);
796 	if (err)
797 		return err;
798 
799 	err = mlxsw_sp_sb_pr_desc_write(mlxsw_sp, MLXSW_REG_SBXX_DIR_EGRESS,
800 					MLXSW_REG_SBPR_MODE_DYNAMIC, 0, true);
801 	if (err)
802 		return err;
803 
804 	return 0;
805 }
806 
807 #define MLXSW_SP_SB_CM(_min_buff, _max_buff, _pool)	\
808 	{						\
809 		.min_buff = _min_buff,			\
810 		.max_buff = _max_buff,			\
811 		.pool_index = _pool,			\
812 	}
813 
814 #define MLXSW_SP_SB_CM_ING(_min_buff, _max_buff)	\
815 	{						\
816 		.min_buff = _min_buff,			\
817 		.max_buff = _max_buff,			\
818 		.pool_index = MLXSW_SP_SB_POOL_ING,	\
819 	}
820 
821 #define MLXSW_SP_SB_CM_EGR(_min_buff, _max_buff)	\
822 	{						\
823 		.min_buff = _min_buff,			\
824 		.max_buff = _max_buff,			\
825 		.pool_index = MLXSW_SP_SB_POOL_EGR,	\
826 	}
827 
828 #define MLXSW_SP_SB_CM_EGR_MC(_min_buff, _max_buff)	\
829 	{						\
830 		.min_buff = _min_buff,			\
831 		.max_buff = _max_buff,			\
832 		.pool_index = MLXSW_SP_SB_POOL_EGR_MC,	\
833 		.freeze_pool = true,			\
834 		.freeze_thresh = true,			\
835 	}
836 
837 static const struct mlxsw_sp_sb_cm mlxsw_sp1_sb_cms_ingress[] = {
838 	MLXSW_SP_SB_CM_ING(10000, 8),
839 	MLXSW_SP_SB_CM_ING(0, MLXSW_REG_SBXX_DYN_MAX_BUFF_MIN),
840 	MLXSW_SP_SB_CM_ING(0, MLXSW_REG_SBXX_DYN_MAX_BUFF_MIN),
841 	MLXSW_SP_SB_CM_ING(0, MLXSW_REG_SBXX_DYN_MAX_BUFF_MIN),
842 	MLXSW_SP_SB_CM_ING(0, MLXSW_REG_SBXX_DYN_MAX_BUFF_MIN),
843 	MLXSW_SP_SB_CM_ING(0, MLXSW_REG_SBXX_DYN_MAX_BUFF_MIN),
844 	MLXSW_SP_SB_CM_ING(0, MLXSW_REG_SBXX_DYN_MAX_BUFF_MIN),
845 	MLXSW_SP_SB_CM_ING(0, MLXSW_REG_SBXX_DYN_MAX_BUFF_MIN),
846 	MLXSW_SP_SB_CM_ING(0, 0), /* dummy, this PG does not exist */
847 	MLXSW_SP_SB_CM(10000, 8, MLXSW_SP_SB_POOL_ING_CPU),
848 };
849 
850 static const struct mlxsw_sp_sb_cm mlxsw_sp2_sb_cms_ingress[] = {
851 	MLXSW_SP_SB_CM_ING(0, 7),
852 	MLXSW_SP_SB_CM_ING(0, MLXSW_REG_SBXX_DYN_MAX_BUFF_MIN),
853 	MLXSW_SP_SB_CM_ING(0, MLXSW_REG_SBXX_DYN_MAX_BUFF_MIN),
854 	MLXSW_SP_SB_CM_ING(0, MLXSW_REG_SBXX_DYN_MAX_BUFF_MIN),
855 	MLXSW_SP_SB_CM_ING(0, MLXSW_REG_SBXX_DYN_MAX_BUFF_MIN),
856 	MLXSW_SP_SB_CM_ING(0, MLXSW_REG_SBXX_DYN_MAX_BUFF_MIN),
857 	MLXSW_SP_SB_CM_ING(0, MLXSW_REG_SBXX_DYN_MAX_BUFF_MIN),
858 	MLXSW_SP_SB_CM_ING(0, MLXSW_REG_SBXX_DYN_MAX_BUFF_MIN),
859 	MLXSW_SP_SB_CM_ING(0, 0), /* dummy, this PG does not exist */
860 	MLXSW_SP_SB_CM(10000, 8, MLXSW_SP_SB_POOL_ING_CPU),
861 };
862 
863 static const struct mlxsw_sp_sb_cm mlxsw_sp1_sb_cms_egress[] = {
864 	MLXSW_SP_SB_CM_EGR(1500, 9),
865 	MLXSW_SP_SB_CM_EGR(1500, 9),
866 	MLXSW_SP_SB_CM_EGR(1500, 9),
867 	MLXSW_SP_SB_CM_EGR(1500, 9),
868 	MLXSW_SP_SB_CM_EGR(1500, 9),
869 	MLXSW_SP_SB_CM_EGR(1500, 9),
870 	MLXSW_SP_SB_CM_EGR(1500, 9),
871 	MLXSW_SP_SB_CM_EGR(1500, 9),
872 	MLXSW_SP_SB_CM_EGR_MC(0, MLXSW_SP_SB_INFI),
873 	MLXSW_SP_SB_CM_EGR_MC(0, MLXSW_SP_SB_INFI),
874 	MLXSW_SP_SB_CM_EGR_MC(0, MLXSW_SP_SB_INFI),
875 	MLXSW_SP_SB_CM_EGR_MC(0, MLXSW_SP_SB_INFI),
876 	MLXSW_SP_SB_CM_EGR_MC(0, MLXSW_SP_SB_INFI),
877 	MLXSW_SP_SB_CM_EGR_MC(0, MLXSW_SP_SB_INFI),
878 	MLXSW_SP_SB_CM_EGR_MC(0, MLXSW_SP_SB_INFI),
879 	MLXSW_SP_SB_CM_EGR_MC(0, MLXSW_SP_SB_INFI),
880 	MLXSW_SP_SB_CM_EGR(1, 0xff),
881 };
882 
883 static const struct mlxsw_sp_sb_cm mlxsw_sp2_sb_cms_egress[] = {
884 	MLXSW_SP_SB_CM_EGR(0, 7),
885 	MLXSW_SP_SB_CM_EGR(0, 7),
886 	MLXSW_SP_SB_CM_EGR(0, 7),
887 	MLXSW_SP_SB_CM_EGR(0, 7),
888 	MLXSW_SP_SB_CM_EGR(0, 7),
889 	MLXSW_SP_SB_CM_EGR(0, 7),
890 	MLXSW_SP_SB_CM_EGR(0, 7),
891 	MLXSW_SP_SB_CM_EGR(0, 7),
892 	MLXSW_SP_SB_CM_EGR_MC(0, MLXSW_SP_SB_INFI),
893 	MLXSW_SP_SB_CM_EGR_MC(0, MLXSW_SP_SB_INFI),
894 	MLXSW_SP_SB_CM_EGR_MC(0, MLXSW_SP_SB_INFI),
895 	MLXSW_SP_SB_CM_EGR_MC(0, MLXSW_SP_SB_INFI),
896 	MLXSW_SP_SB_CM_EGR_MC(0, MLXSW_SP_SB_INFI),
897 	MLXSW_SP_SB_CM_EGR_MC(0, MLXSW_SP_SB_INFI),
898 	MLXSW_SP_SB_CM_EGR_MC(0, MLXSW_SP_SB_INFI),
899 	MLXSW_SP_SB_CM_EGR_MC(0, MLXSW_SP_SB_INFI),
900 	MLXSW_SP_SB_CM_EGR(1, 0xff),
901 };
902 
903 #define MLXSW_SP_CPU_PORT_SB_CM MLXSW_SP_SB_CM(0, 0, MLXSW_SP_SB_POOL_EGR_CPU)
904 
905 static const struct mlxsw_sp_sb_cm mlxsw_sp_cpu_port_sb_cms[] = {
906 	MLXSW_SP_SB_CM(1000, 8, MLXSW_SP_SB_POOL_EGR_CPU),
907 	MLXSW_SP_SB_CM(1000, 8, MLXSW_SP_SB_POOL_EGR_CPU),
908 	MLXSW_SP_SB_CM(1000, 8, MLXSW_SP_SB_POOL_EGR_CPU),
909 	MLXSW_SP_SB_CM(1000, 8, MLXSW_SP_SB_POOL_EGR_CPU),
910 	MLXSW_SP_SB_CM(1000, 8, MLXSW_SP_SB_POOL_EGR_CPU),
911 	MLXSW_SP_SB_CM(1000, 8, MLXSW_SP_SB_POOL_EGR_CPU),
912 	MLXSW_SP_CPU_PORT_SB_CM,
913 	MLXSW_SP_SB_CM(1000, 8, MLXSW_SP_SB_POOL_EGR_CPU),
914 	MLXSW_SP_CPU_PORT_SB_CM,
915 	MLXSW_SP_CPU_PORT_SB_CM,
916 	MLXSW_SP_CPU_PORT_SB_CM,
917 	MLXSW_SP_CPU_PORT_SB_CM,
918 	MLXSW_SP_CPU_PORT_SB_CM,
919 	MLXSW_SP_CPU_PORT_SB_CM,
920 	MLXSW_SP_CPU_PORT_SB_CM,
921 	MLXSW_SP_CPU_PORT_SB_CM,
922 	MLXSW_SP_CPU_PORT_SB_CM,
923 	MLXSW_SP_CPU_PORT_SB_CM,
924 	MLXSW_SP_CPU_PORT_SB_CM,
925 	MLXSW_SP_CPU_PORT_SB_CM,
926 	MLXSW_SP_CPU_PORT_SB_CM,
927 	MLXSW_SP_CPU_PORT_SB_CM,
928 	MLXSW_SP_CPU_PORT_SB_CM,
929 	MLXSW_SP_CPU_PORT_SB_CM,
930 	MLXSW_SP_CPU_PORT_SB_CM,
931 	MLXSW_SP_CPU_PORT_SB_CM,
932 	MLXSW_SP_CPU_PORT_SB_CM,
933 	MLXSW_SP_CPU_PORT_SB_CM,
934 	MLXSW_SP_CPU_PORT_SB_CM,
935 	MLXSW_SP_CPU_PORT_SB_CM,
936 	MLXSW_SP_CPU_PORT_SB_CM,
937 	MLXSW_SP_CPU_PORT_SB_CM,
938 };
939 
940 static bool
941 mlxsw_sp_sb_pool_is_static(struct mlxsw_sp *mlxsw_sp, u16 pool_index)
942 {
943 	struct mlxsw_sp_sb_pr *pr = mlxsw_sp_sb_pr_get(mlxsw_sp, pool_index);
944 
945 	return pr->mode == MLXSW_REG_SBPR_MODE_STATIC;
946 }
947 
948 static int __mlxsw_sp_sb_cms_init(struct mlxsw_sp *mlxsw_sp, u16 local_port,
949 				  enum mlxsw_reg_sbxx_dir dir,
950 				  const struct mlxsw_sp_sb_cm *cms,
951 				  size_t cms_len)
952 {
953 	const struct mlxsw_sp_sb_vals *sb_vals = mlxsw_sp->sb_vals;
954 	int i;
955 	int err;
956 
957 	for (i = 0; i < cms_len; i++) {
958 		const struct mlxsw_sp_sb_cm *cm;
959 		u32 min_buff;
960 		u32 max_buff;
961 
962 		if (i == 8 && dir == MLXSW_REG_SBXX_DIR_INGRESS)
963 			continue; /* PG number 8 does not exist, skip it */
964 		cm = &cms[i];
965 		if (WARN_ON(sb_vals->pool_dess[cm->pool_index].dir != dir))
966 			continue;
967 
968 		min_buff = mlxsw_sp_bytes_cells(mlxsw_sp, cm->min_buff);
969 		max_buff = cm->max_buff;
970 		if (max_buff == MLXSW_SP_SB_INFI) {
971 			err = mlxsw_sp_sb_cm_write(mlxsw_sp, local_port, i,
972 						   min_buff, 0,
973 						   true, cm->pool_index);
974 		} else {
975 			if (mlxsw_sp_sb_pool_is_static(mlxsw_sp,
976 						       cm->pool_index))
977 				max_buff = mlxsw_sp_bytes_cells(mlxsw_sp,
978 								max_buff);
979 			err = mlxsw_sp_sb_cm_write(mlxsw_sp, local_port, i,
980 						   min_buff, max_buff,
981 						   false, cm->pool_index);
982 		}
983 		if (err)
984 			return err;
985 	}
986 	return 0;
987 }
988 
989 static int mlxsw_sp_port_sb_cms_init(struct mlxsw_sp_port *mlxsw_sp_port)
990 {
991 	struct mlxsw_sp *mlxsw_sp = mlxsw_sp_port->mlxsw_sp;
992 	int err;
993 
994 	err = __mlxsw_sp_sb_cms_init(mlxsw_sp,
995 				     mlxsw_sp_port->local_port,
996 				     MLXSW_REG_SBXX_DIR_INGRESS,
997 				     mlxsw_sp->sb_vals->cms_ingress,
998 				     mlxsw_sp->sb_vals->cms_ingress_count);
999 	if (err)
1000 		return err;
1001 	return __mlxsw_sp_sb_cms_init(mlxsw_sp_port->mlxsw_sp,
1002 				      mlxsw_sp_port->local_port,
1003 				      MLXSW_REG_SBXX_DIR_EGRESS,
1004 				      mlxsw_sp->sb_vals->cms_egress,
1005 				      mlxsw_sp->sb_vals->cms_egress_count);
1006 }
1007 
1008 static int mlxsw_sp_cpu_port_sb_cms_init(struct mlxsw_sp *mlxsw_sp)
1009 {
1010 	return __mlxsw_sp_sb_cms_init(mlxsw_sp, 0, MLXSW_REG_SBXX_DIR_EGRESS,
1011 				      mlxsw_sp->sb_vals->cms_cpu,
1012 				      mlxsw_sp->sb_vals->cms_cpu_count);
1013 }
1014 
1015 #define MLXSW_SP_SB_PM(_min_buff, _max_buff)	\
1016 	{					\
1017 		.min_buff = _min_buff,		\
1018 		.max_buff = _max_buff,		\
1019 	}
1020 
1021 /* Order according to mlxsw_sp1_sb_pool_dess */
1022 static const struct mlxsw_sp_sb_pm mlxsw_sp1_sb_pms[] = {
1023 	MLXSW_SP_SB_PM(0, MLXSW_REG_SBXX_DYN_MAX_BUFF_MAX),
1024 	MLXSW_SP_SB_PM(0, MLXSW_REG_SBXX_DYN_MAX_BUFF_MIN),
1025 	MLXSW_SP_SB_PM(0, MLXSW_REG_SBXX_DYN_MAX_BUFF_MIN),
1026 	MLXSW_SP_SB_PM(0, MLXSW_REG_SBXX_DYN_MAX_BUFF_MIN),
1027 	MLXSW_SP_SB_PM(0, 7),
1028 	MLXSW_SP_SB_PM(0, MLXSW_REG_SBXX_DYN_MAX_BUFF_MIN),
1029 	MLXSW_SP_SB_PM(0, MLXSW_REG_SBXX_DYN_MAX_BUFF_MIN),
1030 	MLXSW_SP_SB_PM(0, MLXSW_REG_SBXX_DYN_MAX_BUFF_MIN),
1031 	MLXSW_SP_SB_PM(10000, 90000),
1032 	MLXSW_SP_SB_PM(0, 8),	/* 50% occupancy */
1033 	MLXSW_SP_SB_PM(0, MLXSW_REG_SBXX_DYN_MAX_BUFF_MIN),
1034 };
1035 
1036 /* Order according to mlxsw_sp2_sb_pool_dess */
1037 static const struct mlxsw_sp_sb_pm mlxsw_sp2_sb_pms[] = {
1038 	MLXSW_SP_SB_PM(0, 7),
1039 	MLXSW_SP_SB_PM(0, 0),
1040 	MLXSW_SP_SB_PM(0, 0),
1041 	MLXSW_SP_SB_PM(0, 0),
1042 	MLXSW_SP_SB_PM(0, 7),
1043 	MLXSW_SP_SB_PM(0, 0),
1044 	MLXSW_SP_SB_PM(0, 0),
1045 	MLXSW_SP_SB_PM(0, 0),
1046 	MLXSW_SP_SB_PM(10000, 90000),
1047 	MLXSW_SP_SB_PM(0, 8),	/* 50% occupancy */
1048 	MLXSW_SP_SB_PM(0, MLXSW_REG_SBXX_DYN_MAX_BUFF_MIN),
1049 };
1050 
1051 /* Order according to mlxsw_sp*_sb_pool_dess */
1052 static const struct mlxsw_sp_sb_pm mlxsw_sp_cpu_port_sb_pms[] = {
1053 	MLXSW_SP_SB_PM(0, 0),
1054 	MLXSW_SP_SB_PM(0, 0),
1055 	MLXSW_SP_SB_PM(0, 0),
1056 	MLXSW_SP_SB_PM(0, 0),
1057 	MLXSW_SP_SB_PM(0, 0),
1058 	MLXSW_SP_SB_PM(0, 0),
1059 	MLXSW_SP_SB_PM(0, 0),
1060 	MLXSW_SP_SB_PM(0, 0),
1061 	MLXSW_SP_SB_PM(0, 90000),
1062 	MLXSW_SP_SB_PM(0, 0),
1063 	MLXSW_SP_SB_PM(0, MLXSW_REG_SBXX_DYN_MAX_BUFF_MAX),
1064 };
1065 
1066 static int mlxsw_sp_sb_pms_init(struct mlxsw_sp *mlxsw_sp, u16 local_port,
1067 				const struct mlxsw_sp_sb_pm *pms,
1068 				bool skip_ingress)
1069 {
1070 	int i, err;
1071 
1072 	for (i = 0; i < mlxsw_sp->sb_vals->pool_count; i++) {
1073 		const struct mlxsw_sp_sb_pm *pm = &pms[i];
1074 		const struct mlxsw_sp_sb_pool_des *des;
1075 		u32 max_buff;
1076 		u32 min_buff;
1077 
1078 		des = &mlxsw_sp->sb_vals->pool_dess[i];
1079 		if (skip_ingress && des->dir == MLXSW_REG_SBXX_DIR_INGRESS)
1080 			continue;
1081 
1082 		min_buff = mlxsw_sp_bytes_cells(mlxsw_sp, pm->min_buff);
1083 		max_buff = pm->max_buff;
1084 		if (mlxsw_sp_sb_pool_is_static(mlxsw_sp, i))
1085 			max_buff = mlxsw_sp_bytes_cells(mlxsw_sp, max_buff);
1086 		err = mlxsw_sp_sb_pm_write(mlxsw_sp, local_port, i, min_buff,
1087 					   max_buff);
1088 		if (err)
1089 			return err;
1090 	}
1091 	return 0;
1092 }
1093 
1094 static int mlxsw_sp_port_sb_pms_init(struct mlxsw_sp_port *mlxsw_sp_port)
1095 {
1096 	struct mlxsw_sp *mlxsw_sp = mlxsw_sp_port->mlxsw_sp;
1097 
1098 	return mlxsw_sp_sb_pms_init(mlxsw_sp, mlxsw_sp_port->local_port,
1099 				    mlxsw_sp->sb_vals->pms, false);
1100 }
1101 
1102 static int mlxsw_sp_cpu_port_sb_pms_init(struct mlxsw_sp *mlxsw_sp)
1103 {
1104 	return mlxsw_sp_sb_pms_init(mlxsw_sp, 0, mlxsw_sp->sb_vals->pms_cpu,
1105 				    true);
1106 }
1107 
1108 #define MLXSW_SP_SB_MM(_min_buff, _max_buff)		\
1109 	{						\
1110 		.min_buff = _min_buff,			\
1111 		.max_buff = _max_buff,			\
1112 		.pool_index = MLXSW_SP_SB_POOL_EGR,	\
1113 	}
1114 
1115 static const struct mlxsw_sp_sb_mm mlxsw_sp_sb_mms[] = {
1116 	MLXSW_SP_SB_MM(0, 6),
1117 	MLXSW_SP_SB_MM(0, 6),
1118 	MLXSW_SP_SB_MM(0, 6),
1119 	MLXSW_SP_SB_MM(0, 6),
1120 	MLXSW_SP_SB_MM(0, 6),
1121 	MLXSW_SP_SB_MM(0, 6),
1122 	MLXSW_SP_SB_MM(0, 6),
1123 	MLXSW_SP_SB_MM(0, 6),
1124 	MLXSW_SP_SB_MM(0, 6),
1125 	MLXSW_SP_SB_MM(0, 6),
1126 	MLXSW_SP_SB_MM(0, 6),
1127 	MLXSW_SP_SB_MM(0, 6),
1128 	MLXSW_SP_SB_MM(0, 6),
1129 	MLXSW_SP_SB_MM(0, 6),
1130 	MLXSW_SP_SB_MM(0, 6),
1131 };
1132 
1133 static int mlxsw_sp_sb_mms_init(struct mlxsw_sp *mlxsw_sp)
1134 {
1135 	char sbmm_pl[MLXSW_REG_SBMM_LEN];
1136 	int i;
1137 	int err;
1138 
1139 	for (i = 0; i < mlxsw_sp->sb_vals->mms_count; i++) {
1140 		const struct mlxsw_sp_sb_pool_des *des;
1141 		const struct mlxsw_sp_sb_mm *mc;
1142 		u32 min_buff;
1143 
1144 		mc = &mlxsw_sp->sb_vals->mms[i];
1145 		des = &mlxsw_sp->sb_vals->pool_dess[mc->pool_index];
1146 		/* All pools used by sb_mm's are initialized using dynamic
1147 		 * thresholds, therefore 'max_buff' isn't specified in cells.
1148 		 */
1149 		min_buff = mlxsw_sp_bytes_cells(mlxsw_sp, mc->min_buff);
1150 		mlxsw_reg_sbmm_pack(sbmm_pl, i, min_buff, mc->max_buff,
1151 				    des->pool);
1152 		err = mlxsw_reg_write(mlxsw_sp->core, MLXSW_REG(sbmm), sbmm_pl);
1153 		if (err)
1154 			return err;
1155 	}
1156 	return 0;
1157 }
1158 
1159 static void mlxsw_sp_pool_count(struct mlxsw_sp *mlxsw_sp,
1160 				u16 *p_ingress_len, u16 *p_egress_len)
1161 {
1162 	int i;
1163 
1164 	for (i = 0; i < mlxsw_sp->sb_vals->pool_count; ++i) {
1165 		if (mlxsw_sp->sb_vals->pool_dess[i].dir ==
1166 		    MLXSW_REG_SBXX_DIR_INGRESS)
1167 			(*p_ingress_len)++;
1168 		else
1169 			(*p_egress_len)++;
1170 	}
1171 
1172 	WARN(*p_egress_len == 0, "No egress pools\n");
1173 }
1174 
1175 const struct mlxsw_sp_sb_vals mlxsw_sp1_sb_vals = {
1176 	.pool_count = ARRAY_SIZE(mlxsw_sp1_sb_pool_dess),
1177 	.pool_dess = mlxsw_sp1_sb_pool_dess,
1178 	.pms = mlxsw_sp1_sb_pms,
1179 	.pms_cpu = mlxsw_sp_cpu_port_sb_pms,
1180 	.prs = mlxsw_sp1_sb_prs,
1181 	.mms = mlxsw_sp_sb_mms,
1182 	.cms_ingress = mlxsw_sp1_sb_cms_ingress,
1183 	.cms_egress = mlxsw_sp1_sb_cms_egress,
1184 	.cms_cpu = mlxsw_sp_cpu_port_sb_cms,
1185 	.mms_count = ARRAY_SIZE(mlxsw_sp_sb_mms),
1186 	.cms_ingress_count = ARRAY_SIZE(mlxsw_sp1_sb_cms_ingress),
1187 	.cms_egress_count = ARRAY_SIZE(mlxsw_sp1_sb_cms_egress),
1188 	.cms_cpu_count = ARRAY_SIZE(mlxsw_sp_cpu_port_sb_cms),
1189 };
1190 
1191 const struct mlxsw_sp_sb_vals mlxsw_sp2_sb_vals = {
1192 	.pool_count = ARRAY_SIZE(mlxsw_sp2_sb_pool_dess),
1193 	.pool_dess = mlxsw_sp2_sb_pool_dess,
1194 	.pms = mlxsw_sp2_sb_pms,
1195 	.pms_cpu = mlxsw_sp_cpu_port_sb_pms,
1196 	.prs = mlxsw_sp2_sb_prs,
1197 	.mms = mlxsw_sp_sb_mms,
1198 	.cms_ingress = mlxsw_sp2_sb_cms_ingress,
1199 	.cms_egress = mlxsw_sp2_sb_cms_egress,
1200 	.cms_cpu = mlxsw_sp_cpu_port_sb_cms,
1201 	.mms_count = ARRAY_SIZE(mlxsw_sp_sb_mms),
1202 	.cms_ingress_count = ARRAY_SIZE(mlxsw_sp2_sb_cms_ingress),
1203 	.cms_egress_count = ARRAY_SIZE(mlxsw_sp2_sb_cms_egress),
1204 	.cms_cpu_count = ARRAY_SIZE(mlxsw_sp_cpu_port_sb_cms),
1205 };
1206 
1207 static u32 mlxsw_sp1_pb_int_buf_size_get(int mtu, u32 speed)
1208 {
1209 	return mtu * 5 / 2;
1210 }
1211 
1212 static u32 __mlxsw_sp_pb_int_buf_size_get(int mtu, u32 speed, u32 buffer_factor)
1213 {
1214 	return 3 * mtu + buffer_factor * speed / 1000;
1215 }
1216 
1217 #define MLXSW_SP2_SPAN_EG_MIRROR_BUFFER_FACTOR 38
1218 
1219 static u32 mlxsw_sp2_pb_int_buf_size_get(int mtu, u32 speed)
1220 {
1221 	int factor = MLXSW_SP2_SPAN_EG_MIRROR_BUFFER_FACTOR;
1222 
1223 	return __mlxsw_sp_pb_int_buf_size_get(mtu, speed, factor);
1224 }
1225 
1226 #define MLXSW_SP3_SPAN_EG_MIRROR_BUFFER_FACTOR 50
1227 
1228 static u32 mlxsw_sp3_pb_int_buf_size_get(int mtu, u32 speed)
1229 {
1230 	int factor = MLXSW_SP3_SPAN_EG_MIRROR_BUFFER_FACTOR;
1231 
1232 	return __mlxsw_sp_pb_int_buf_size_get(mtu, speed, factor);
1233 }
1234 
1235 const struct mlxsw_sp_sb_ops mlxsw_sp1_sb_ops = {
1236 	.int_buf_size_get = mlxsw_sp1_pb_int_buf_size_get,
1237 };
1238 
1239 const struct mlxsw_sp_sb_ops mlxsw_sp2_sb_ops = {
1240 	.int_buf_size_get = mlxsw_sp2_pb_int_buf_size_get,
1241 };
1242 
1243 const struct mlxsw_sp_sb_ops mlxsw_sp3_sb_ops = {
1244 	.int_buf_size_get = mlxsw_sp3_pb_int_buf_size_get,
1245 };
1246 
1247 int mlxsw_sp_buffers_init(struct mlxsw_sp *mlxsw_sp)
1248 {
1249 	u32 max_headroom_size;
1250 	u16 ing_pool_count = 0;
1251 	u16 eg_pool_count = 0;
1252 	int err;
1253 
1254 	if (!MLXSW_CORE_RES_VALID(mlxsw_sp->core, CELL_SIZE))
1255 		return -EIO;
1256 
1257 	if (!MLXSW_CORE_RES_VALID(mlxsw_sp->core, GUARANTEED_SHARED_BUFFER))
1258 		return -EIO;
1259 
1260 	if (!MLXSW_CORE_RES_VALID(mlxsw_sp->core, MAX_HEADROOM_SIZE))
1261 		return -EIO;
1262 
1263 	mlxsw_sp->sb = kzalloc(sizeof(*mlxsw_sp->sb), GFP_KERNEL);
1264 	if (!mlxsw_sp->sb)
1265 		return -ENOMEM;
1266 	mlxsw_sp->sb->cell_size = MLXSW_CORE_RES_GET(mlxsw_sp->core, CELL_SIZE);
1267 	mlxsw_sp->sb->sb_size = MLXSW_CORE_RES_GET(mlxsw_sp->core,
1268 						   GUARANTEED_SHARED_BUFFER);
1269 	max_headroom_size = MLXSW_CORE_RES_GET(mlxsw_sp->core,
1270 					       MAX_HEADROOM_SIZE);
1271 	/* Round down, because this limit must not be overstepped. */
1272 	mlxsw_sp->sb->max_headroom_cells = max_headroom_size /
1273 						mlxsw_sp->sb->cell_size;
1274 
1275 	err = mlxsw_sp_sb_ports_init(mlxsw_sp);
1276 	if (err)
1277 		goto err_sb_ports_init;
1278 	err = mlxsw_sp_sb_prs_init(mlxsw_sp, mlxsw_sp->sb_vals->prs,
1279 				   mlxsw_sp->sb_vals->pool_dess,
1280 				   mlxsw_sp->sb_vals->pool_count);
1281 	if (err)
1282 		goto err_sb_prs_init;
1283 	err = mlxsw_sp_cpu_port_sb_cms_init(mlxsw_sp);
1284 	if (err)
1285 		goto err_sb_cpu_port_sb_cms_init;
1286 	err = mlxsw_sp_cpu_port_sb_pms_init(mlxsw_sp);
1287 	if (err)
1288 		goto err_sb_cpu_port_pms_init;
1289 	err = mlxsw_sp_sb_mms_init(mlxsw_sp);
1290 	if (err)
1291 		goto err_sb_mms_init;
1292 	mlxsw_sp_pool_count(mlxsw_sp, &ing_pool_count, &eg_pool_count);
1293 	err = devl_sb_register(priv_to_devlink(mlxsw_sp->core), 0,
1294 			       mlxsw_sp->sb->sb_size,
1295 			       ing_pool_count,
1296 			       eg_pool_count,
1297 			       MLXSW_SP_SB_ING_TC_COUNT,
1298 			       MLXSW_SP_SB_EG_TC_COUNT);
1299 	if (err)
1300 		goto err_devlink_sb_register;
1301 
1302 	return 0;
1303 
1304 err_devlink_sb_register:
1305 err_sb_mms_init:
1306 err_sb_cpu_port_pms_init:
1307 err_sb_cpu_port_sb_cms_init:
1308 err_sb_prs_init:
1309 	mlxsw_sp_sb_ports_fini(mlxsw_sp);
1310 err_sb_ports_init:
1311 	kfree(mlxsw_sp->sb);
1312 	return err;
1313 }
1314 
1315 void mlxsw_sp_buffers_fini(struct mlxsw_sp *mlxsw_sp)
1316 {
1317 	devl_sb_unregister(priv_to_devlink(mlxsw_sp->core), 0);
1318 	mlxsw_sp_sb_ports_fini(mlxsw_sp);
1319 	kfree(mlxsw_sp->sb);
1320 }
1321 
1322 int mlxsw_sp_port_buffers_init(struct mlxsw_sp_port *mlxsw_sp_port)
1323 {
1324 	int err;
1325 
1326 	mlxsw_sp_port->hdroom = kzalloc(sizeof(*mlxsw_sp_port->hdroom), GFP_KERNEL);
1327 	if (!mlxsw_sp_port->hdroom)
1328 		return -ENOMEM;
1329 	mlxsw_sp_port->hdroom->mtu = mlxsw_sp_port->dev->mtu;
1330 
1331 	err = mlxsw_sp_port_headroom_init(mlxsw_sp_port);
1332 	if (err)
1333 		goto err_headroom_init;
1334 	err = mlxsw_sp_port_sb_cms_init(mlxsw_sp_port);
1335 	if (err)
1336 		goto err_port_sb_cms_init;
1337 	err = mlxsw_sp_port_sb_pms_init(mlxsw_sp_port);
1338 	if (err)
1339 		goto err_port_sb_pms_init;
1340 	return 0;
1341 
1342 err_port_sb_pms_init:
1343 err_port_sb_cms_init:
1344 err_headroom_init:
1345 	kfree(mlxsw_sp_port->hdroom);
1346 	return err;
1347 }
1348 
1349 void mlxsw_sp_port_buffers_fini(struct mlxsw_sp_port *mlxsw_sp_port)
1350 {
1351 	kfree(mlxsw_sp_port->hdroom);
1352 }
1353 
1354 int mlxsw_sp_sb_pool_get(struct mlxsw_core *mlxsw_core,
1355 			 unsigned int sb_index, u16 pool_index,
1356 			 struct devlink_sb_pool_info *pool_info)
1357 {
1358 	struct mlxsw_sp *mlxsw_sp = mlxsw_core_driver_priv(mlxsw_core);
1359 	enum mlxsw_reg_sbxx_dir dir;
1360 	struct mlxsw_sp_sb_pr *pr;
1361 
1362 	dir = mlxsw_sp->sb_vals->pool_dess[pool_index].dir;
1363 	pr = mlxsw_sp_sb_pr_get(mlxsw_sp, pool_index);
1364 	pool_info->pool_type = (enum devlink_sb_pool_type) dir;
1365 	pool_info->size = mlxsw_sp_cells_bytes(mlxsw_sp, pr->size);
1366 	pool_info->threshold_type = (enum devlink_sb_threshold_type) pr->mode;
1367 	pool_info->cell_size = mlxsw_sp->sb->cell_size;
1368 	return 0;
1369 }
1370 
1371 int mlxsw_sp_sb_pool_set(struct mlxsw_core *mlxsw_core,
1372 			 unsigned int sb_index, u16 pool_index, u32 size,
1373 			 enum devlink_sb_threshold_type threshold_type,
1374 			 struct netlink_ext_ack *extack)
1375 {
1376 	struct mlxsw_sp *mlxsw_sp = mlxsw_core_driver_priv(mlxsw_core);
1377 	u32 pool_size = mlxsw_sp_bytes_cells(mlxsw_sp, size);
1378 	const struct mlxsw_sp_sb_pr *pr;
1379 	enum mlxsw_reg_sbpr_mode mode;
1380 
1381 	mode = (enum mlxsw_reg_sbpr_mode) threshold_type;
1382 	pr = &mlxsw_sp->sb_vals->prs[pool_index];
1383 
1384 	if (size > MLXSW_CORE_RES_GET(mlxsw_sp->core,
1385 				      GUARANTEED_SHARED_BUFFER)) {
1386 		NL_SET_ERR_MSG_MOD(extack, "Exceeded shared buffer size");
1387 		return -EINVAL;
1388 	}
1389 
1390 	if (pr->freeze_mode && pr->mode != mode) {
1391 		NL_SET_ERR_MSG_MOD(extack, "Changing this pool's threshold type is forbidden");
1392 		return -EINVAL;
1393 	}
1394 
1395 	if (pr->freeze_size && pr->size != size) {
1396 		NL_SET_ERR_MSG_MOD(extack, "Changing this pool's size is forbidden");
1397 		return -EINVAL;
1398 	}
1399 
1400 	return mlxsw_sp_sb_pr_write(mlxsw_sp, pool_index, mode,
1401 				    pool_size, false);
1402 }
1403 
1404 #define MLXSW_SP_SB_THRESHOLD_TO_ALPHA_OFFSET (-2) /* 3->1, 16->14 */
1405 
1406 static u32 mlxsw_sp_sb_threshold_out(struct mlxsw_sp *mlxsw_sp, u16 pool_index,
1407 				     u32 max_buff)
1408 {
1409 	struct mlxsw_sp_sb_pr *pr = mlxsw_sp_sb_pr_get(mlxsw_sp, pool_index);
1410 
1411 	if (pr->mode == MLXSW_REG_SBPR_MODE_DYNAMIC)
1412 		return max_buff - MLXSW_SP_SB_THRESHOLD_TO_ALPHA_OFFSET;
1413 	return mlxsw_sp_cells_bytes(mlxsw_sp, max_buff);
1414 }
1415 
1416 static int mlxsw_sp_sb_threshold_in(struct mlxsw_sp *mlxsw_sp, u16 pool_index,
1417 				    u32 threshold, u32 *p_max_buff,
1418 				    struct netlink_ext_ack *extack)
1419 {
1420 	struct mlxsw_sp_sb_pr *pr = mlxsw_sp_sb_pr_get(mlxsw_sp, pool_index);
1421 
1422 	if (pr->mode == MLXSW_REG_SBPR_MODE_DYNAMIC) {
1423 		int val;
1424 
1425 		val = threshold + MLXSW_SP_SB_THRESHOLD_TO_ALPHA_OFFSET;
1426 		if (val < MLXSW_REG_SBXX_DYN_MAX_BUFF_MIN ||
1427 		    val > MLXSW_REG_SBXX_DYN_MAX_BUFF_MAX) {
1428 			NL_SET_ERR_MSG_MOD(extack, "Invalid dynamic threshold value");
1429 			return -EINVAL;
1430 		}
1431 		*p_max_buff = val;
1432 	} else {
1433 		*p_max_buff = mlxsw_sp_bytes_cells(mlxsw_sp, threshold);
1434 	}
1435 	return 0;
1436 }
1437 
1438 int mlxsw_sp_sb_port_pool_get(struct mlxsw_core_port *mlxsw_core_port,
1439 			      unsigned int sb_index, u16 pool_index,
1440 			      u32 *p_threshold)
1441 {
1442 	struct mlxsw_sp_port *mlxsw_sp_port =
1443 			mlxsw_core_port_driver_priv(mlxsw_core_port);
1444 	struct mlxsw_sp *mlxsw_sp = mlxsw_sp_port->mlxsw_sp;
1445 	u16 local_port = mlxsw_sp_port->local_port;
1446 	struct mlxsw_sp_sb_pm *pm = mlxsw_sp_sb_pm_get(mlxsw_sp, local_port,
1447 						       pool_index);
1448 
1449 	*p_threshold = mlxsw_sp_sb_threshold_out(mlxsw_sp, pool_index,
1450 						 pm->max_buff);
1451 	return 0;
1452 }
1453 
1454 int mlxsw_sp_sb_port_pool_set(struct mlxsw_core_port *mlxsw_core_port,
1455 			      unsigned int sb_index, u16 pool_index,
1456 			      u32 threshold, struct netlink_ext_ack *extack)
1457 {
1458 	struct mlxsw_sp_port *mlxsw_sp_port =
1459 			mlxsw_core_port_driver_priv(mlxsw_core_port);
1460 	struct mlxsw_sp *mlxsw_sp = mlxsw_sp_port->mlxsw_sp;
1461 	u16 local_port = mlxsw_sp_port->local_port;
1462 	u32 max_buff;
1463 	int err;
1464 
1465 	if (local_port == MLXSW_PORT_CPU_PORT) {
1466 		NL_SET_ERR_MSG_MOD(extack, "Changing CPU port's threshold is forbidden");
1467 		return -EINVAL;
1468 	}
1469 
1470 	err = mlxsw_sp_sb_threshold_in(mlxsw_sp, pool_index,
1471 				       threshold, &max_buff, extack);
1472 	if (err)
1473 		return err;
1474 
1475 	return mlxsw_sp_sb_pm_write(mlxsw_sp, local_port, pool_index,
1476 				    0, max_buff);
1477 }
1478 
1479 int mlxsw_sp_sb_tc_pool_bind_get(struct mlxsw_core_port *mlxsw_core_port,
1480 				 unsigned int sb_index, u16 tc_index,
1481 				 enum devlink_sb_pool_type pool_type,
1482 				 u16 *p_pool_index, u32 *p_threshold)
1483 {
1484 	struct mlxsw_sp_port *mlxsw_sp_port =
1485 			mlxsw_core_port_driver_priv(mlxsw_core_port);
1486 	struct mlxsw_sp *mlxsw_sp = mlxsw_sp_port->mlxsw_sp;
1487 	u16 local_port = mlxsw_sp_port->local_port;
1488 	u8 pg_buff = tc_index;
1489 	enum mlxsw_reg_sbxx_dir dir = (enum mlxsw_reg_sbxx_dir) pool_type;
1490 	struct mlxsw_sp_sb_cm *cm = mlxsw_sp_sb_cm_get(mlxsw_sp, local_port,
1491 						       pg_buff, dir);
1492 
1493 	*p_threshold = mlxsw_sp_sb_threshold_out(mlxsw_sp, cm->pool_index,
1494 						 cm->max_buff);
1495 	*p_pool_index = cm->pool_index;
1496 	return 0;
1497 }
1498 
1499 int mlxsw_sp_sb_tc_pool_bind_set(struct mlxsw_core_port *mlxsw_core_port,
1500 				 unsigned int sb_index, u16 tc_index,
1501 				 enum devlink_sb_pool_type pool_type,
1502 				 u16 pool_index, u32 threshold,
1503 				 struct netlink_ext_ack *extack)
1504 {
1505 	struct mlxsw_sp_port *mlxsw_sp_port =
1506 			mlxsw_core_port_driver_priv(mlxsw_core_port);
1507 	struct mlxsw_sp *mlxsw_sp = mlxsw_sp_port->mlxsw_sp;
1508 	u16 local_port = mlxsw_sp_port->local_port;
1509 	const struct mlxsw_sp_sb_cm *cm;
1510 	u8 pg_buff = tc_index;
1511 	enum mlxsw_reg_sbxx_dir dir = (enum mlxsw_reg_sbxx_dir) pool_type;
1512 	u32 max_buff;
1513 	int err;
1514 
1515 	if (local_port == MLXSW_PORT_CPU_PORT) {
1516 		NL_SET_ERR_MSG_MOD(extack, "Changing CPU port's binding is forbidden");
1517 		return -EINVAL;
1518 	}
1519 
1520 	if (dir != mlxsw_sp->sb_vals->pool_dess[pool_index].dir) {
1521 		NL_SET_ERR_MSG_MOD(extack, "Binding egress TC to ingress pool and vice versa is forbidden");
1522 		return -EINVAL;
1523 	}
1524 
1525 	if (dir == MLXSW_REG_SBXX_DIR_INGRESS)
1526 		cm = &mlxsw_sp->sb_vals->cms_ingress[tc_index];
1527 	else
1528 		cm = &mlxsw_sp->sb_vals->cms_egress[tc_index];
1529 
1530 	if (cm->freeze_pool && cm->pool_index != pool_index) {
1531 		NL_SET_ERR_MSG_MOD(extack, "Binding this TC to a different pool is forbidden");
1532 		return -EINVAL;
1533 	}
1534 
1535 	if (cm->freeze_thresh && cm->max_buff != threshold) {
1536 		NL_SET_ERR_MSG_MOD(extack, "Changing this TC's threshold is forbidden");
1537 		return -EINVAL;
1538 	}
1539 
1540 	err = mlxsw_sp_sb_threshold_in(mlxsw_sp, pool_index,
1541 				       threshold, &max_buff, extack);
1542 	if (err)
1543 		return err;
1544 
1545 	return mlxsw_sp_sb_cm_write(mlxsw_sp, local_port, pg_buff,
1546 				    0, max_buff, false, pool_index);
1547 }
1548 
1549 #define MASKED_COUNT_MAX \
1550 	(MLXSW_REG_SBSR_REC_MAX_COUNT / \
1551 	 (MLXSW_SP_SB_ING_TC_COUNT + MLXSW_SP_SB_EG_TC_COUNT))
1552 
1553 struct mlxsw_sp_sb_sr_occ_query_cb_ctx {
1554 	u8 masked_count;
1555 	u16 local_port_1;
1556 };
1557 
1558 static void mlxsw_sp_sb_sr_occ_query_cb(struct mlxsw_core *mlxsw_core,
1559 					char *sbsr_pl, size_t sbsr_pl_len,
1560 					unsigned long cb_priv)
1561 {
1562 	struct mlxsw_sp *mlxsw_sp = mlxsw_core_driver_priv(mlxsw_core);
1563 	struct mlxsw_sp_sb_sr_occ_query_cb_ctx cb_ctx;
1564 	u8 masked_count;
1565 	u16 local_port;
1566 	int rec_index = 0;
1567 	struct mlxsw_sp_sb_cm *cm;
1568 	int i;
1569 
1570 	memcpy(&cb_ctx, &cb_priv, sizeof(cb_ctx));
1571 
1572 	masked_count = 0;
1573 	for (local_port = cb_ctx.local_port_1;
1574 	     local_port < mlxsw_core_max_ports(mlxsw_core); local_port++) {
1575 		if (!mlxsw_sp->ports[local_port])
1576 			continue;
1577 		if (local_port == MLXSW_PORT_CPU_PORT) {
1578 			/* Ingress quotas are not supported for the CPU port */
1579 			masked_count++;
1580 			continue;
1581 		}
1582 		for (i = 0; i < MLXSW_SP_SB_ING_TC_COUNT; i++) {
1583 			cm = mlxsw_sp_sb_cm_get(mlxsw_sp, local_port, i,
1584 						MLXSW_REG_SBXX_DIR_INGRESS);
1585 			mlxsw_reg_sbsr_rec_unpack(sbsr_pl, rec_index++,
1586 						  &cm->occ.cur, &cm->occ.max);
1587 		}
1588 		if (++masked_count == cb_ctx.masked_count)
1589 			break;
1590 	}
1591 	masked_count = 0;
1592 	for (local_port = cb_ctx.local_port_1;
1593 	     local_port < mlxsw_core_max_ports(mlxsw_core); local_port++) {
1594 		if (!mlxsw_sp->ports[local_port])
1595 			continue;
1596 		for (i = 0; i < MLXSW_SP_SB_EG_TC_COUNT; i++) {
1597 			cm = mlxsw_sp_sb_cm_get(mlxsw_sp, local_port, i,
1598 						MLXSW_REG_SBXX_DIR_EGRESS);
1599 			mlxsw_reg_sbsr_rec_unpack(sbsr_pl, rec_index++,
1600 						  &cm->occ.cur, &cm->occ.max);
1601 		}
1602 		if (++masked_count == cb_ctx.masked_count)
1603 			break;
1604 	}
1605 }
1606 
1607 int mlxsw_sp_sb_occ_snapshot(struct mlxsw_core *mlxsw_core,
1608 			     unsigned int sb_index)
1609 {
1610 	struct mlxsw_sp *mlxsw_sp = mlxsw_core_driver_priv(mlxsw_core);
1611 	u16 local_port, local_port_1, last_local_port;
1612 	struct mlxsw_sp_sb_sr_occ_query_cb_ctx cb_ctx;
1613 	u8 masked_count, current_page = 0;
1614 	unsigned long cb_priv = 0;
1615 	LIST_HEAD(bulk_list);
1616 	char *sbsr_pl;
1617 	int i;
1618 	int err;
1619 	int err2;
1620 
1621 	sbsr_pl = kmalloc(MLXSW_REG_SBSR_LEN, GFP_KERNEL);
1622 	if (!sbsr_pl)
1623 		return -ENOMEM;
1624 
1625 	local_port = MLXSW_PORT_CPU_PORT;
1626 next_batch:
1627 	local_port_1 = local_port;
1628 	masked_count = 0;
1629 	mlxsw_reg_sbsr_pack(sbsr_pl, false);
1630 	mlxsw_reg_sbsr_port_page_set(sbsr_pl, current_page);
1631 	last_local_port = current_page * MLXSW_REG_SBSR_NUM_PORTS_IN_PAGE +
1632 			  MLXSW_REG_SBSR_NUM_PORTS_IN_PAGE - 1;
1633 
1634 	for (i = 0; i < MLXSW_SP_SB_ING_TC_COUNT; i++)
1635 		mlxsw_reg_sbsr_pg_buff_mask_set(sbsr_pl, i, 1);
1636 	for (i = 0; i < MLXSW_SP_SB_EG_TC_COUNT; i++)
1637 		mlxsw_reg_sbsr_tclass_mask_set(sbsr_pl, i, 1);
1638 	for (; local_port < mlxsw_core_max_ports(mlxsw_core); local_port++) {
1639 		if (!mlxsw_sp->ports[local_port])
1640 			continue;
1641 		if (local_port > last_local_port) {
1642 			current_page++;
1643 			goto do_query;
1644 		}
1645 		if (local_port != MLXSW_PORT_CPU_PORT) {
1646 			/* Ingress quotas are not supported for the CPU port */
1647 			mlxsw_reg_sbsr_ingress_port_mask_set(sbsr_pl,
1648 							     local_port, 1);
1649 		}
1650 		mlxsw_reg_sbsr_egress_port_mask_set(sbsr_pl, local_port, 1);
1651 		for (i = 0; i < mlxsw_sp->sb_vals->pool_count; i++) {
1652 			err = mlxsw_sp_sb_pm_occ_query(mlxsw_sp, local_port, i,
1653 						       &bulk_list);
1654 			if (err)
1655 				goto out;
1656 		}
1657 		if (++masked_count == MASKED_COUNT_MAX)
1658 			goto do_query;
1659 	}
1660 
1661 do_query:
1662 	cb_ctx.masked_count = masked_count;
1663 	cb_ctx.local_port_1 = local_port_1;
1664 	memcpy(&cb_priv, &cb_ctx, sizeof(cb_ctx));
1665 	err = mlxsw_reg_trans_query(mlxsw_core, MLXSW_REG(sbsr), sbsr_pl,
1666 				    &bulk_list, mlxsw_sp_sb_sr_occ_query_cb,
1667 				    cb_priv);
1668 	if (err)
1669 		goto out;
1670 	if (local_port < mlxsw_core_max_ports(mlxsw_core)) {
1671 		local_port++;
1672 		goto next_batch;
1673 	}
1674 
1675 out:
1676 	err2 = mlxsw_reg_trans_bulk_wait(&bulk_list);
1677 	if (!err)
1678 		err = err2;
1679 	kfree(sbsr_pl);
1680 	return err;
1681 }
1682 
1683 int mlxsw_sp_sb_occ_max_clear(struct mlxsw_core *mlxsw_core,
1684 			      unsigned int sb_index)
1685 {
1686 	struct mlxsw_sp *mlxsw_sp = mlxsw_core_driver_priv(mlxsw_core);
1687 	u16 local_port, last_local_port;
1688 	LIST_HEAD(bulk_list);
1689 	unsigned int masked_count;
1690 	u8 current_page = 0;
1691 	char *sbsr_pl;
1692 	int i;
1693 	int err;
1694 	int err2;
1695 
1696 	sbsr_pl = kmalloc(MLXSW_REG_SBSR_LEN, GFP_KERNEL);
1697 	if (!sbsr_pl)
1698 		return -ENOMEM;
1699 
1700 	local_port = MLXSW_PORT_CPU_PORT;
1701 next_batch:
1702 	masked_count = 0;
1703 	mlxsw_reg_sbsr_pack(sbsr_pl, true);
1704 	mlxsw_reg_sbsr_port_page_set(sbsr_pl, current_page);
1705 	last_local_port = current_page * MLXSW_REG_SBSR_NUM_PORTS_IN_PAGE +
1706 			  MLXSW_REG_SBSR_NUM_PORTS_IN_PAGE - 1;
1707 
1708 	for (i = 0; i < MLXSW_SP_SB_ING_TC_COUNT; i++)
1709 		mlxsw_reg_sbsr_pg_buff_mask_set(sbsr_pl, i, 1);
1710 	for (i = 0; i < MLXSW_SP_SB_EG_TC_COUNT; i++)
1711 		mlxsw_reg_sbsr_tclass_mask_set(sbsr_pl, i, 1);
1712 	for (; local_port < mlxsw_core_max_ports(mlxsw_core); local_port++) {
1713 		if (!mlxsw_sp->ports[local_port])
1714 			continue;
1715 		if (local_port > last_local_port) {
1716 			current_page++;
1717 			goto do_query;
1718 		}
1719 		if (local_port != MLXSW_PORT_CPU_PORT) {
1720 			/* Ingress quotas are not supported for the CPU port */
1721 			mlxsw_reg_sbsr_ingress_port_mask_set(sbsr_pl,
1722 							     local_port, 1);
1723 		}
1724 		mlxsw_reg_sbsr_egress_port_mask_set(sbsr_pl, local_port, 1);
1725 		for (i = 0; i < mlxsw_sp->sb_vals->pool_count; i++) {
1726 			err = mlxsw_sp_sb_pm_occ_clear(mlxsw_sp, local_port, i,
1727 						       &bulk_list);
1728 			if (err)
1729 				goto out;
1730 		}
1731 		if (++masked_count == MASKED_COUNT_MAX)
1732 			goto do_query;
1733 	}
1734 
1735 do_query:
1736 	err = mlxsw_reg_trans_query(mlxsw_core, MLXSW_REG(sbsr), sbsr_pl,
1737 				    &bulk_list, NULL, 0);
1738 	if (err)
1739 		goto out;
1740 	if (local_port < mlxsw_core_max_ports(mlxsw_core)) {
1741 		local_port++;
1742 		goto next_batch;
1743 	}
1744 
1745 out:
1746 	err2 = mlxsw_reg_trans_bulk_wait(&bulk_list);
1747 	if (!err)
1748 		err = err2;
1749 	kfree(sbsr_pl);
1750 	return err;
1751 }
1752 
1753 int mlxsw_sp_sb_occ_port_pool_get(struct mlxsw_core_port *mlxsw_core_port,
1754 				  unsigned int sb_index, u16 pool_index,
1755 				  u32 *p_cur, u32 *p_max)
1756 {
1757 	struct mlxsw_sp_port *mlxsw_sp_port =
1758 			mlxsw_core_port_driver_priv(mlxsw_core_port);
1759 	struct mlxsw_sp *mlxsw_sp = mlxsw_sp_port->mlxsw_sp;
1760 	u16 local_port = mlxsw_sp_port->local_port;
1761 	struct mlxsw_sp_sb_pm *pm = mlxsw_sp_sb_pm_get(mlxsw_sp, local_port,
1762 						       pool_index);
1763 
1764 	*p_cur = mlxsw_sp_cells_bytes(mlxsw_sp, pm->occ.cur);
1765 	*p_max = mlxsw_sp_cells_bytes(mlxsw_sp, pm->occ.max);
1766 	return 0;
1767 }
1768 
1769 int mlxsw_sp_sb_occ_tc_port_bind_get(struct mlxsw_core_port *mlxsw_core_port,
1770 				     unsigned int sb_index, u16 tc_index,
1771 				     enum devlink_sb_pool_type pool_type,
1772 				     u32 *p_cur, u32 *p_max)
1773 {
1774 	struct mlxsw_sp_port *mlxsw_sp_port =
1775 			mlxsw_core_port_driver_priv(mlxsw_core_port);
1776 	struct mlxsw_sp *mlxsw_sp = mlxsw_sp_port->mlxsw_sp;
1777 	u16 local_port = mlxsw_sp_port->local_port;
1778 	u8 pg_buff = tc_index;
1779 	enum mlxsw_reg_sbxx_dir dir = (enum mlxsw_reg_sbxx_dir) pool_type;
1780 	struct mlxsw_sp_sb_cm *cm = mlxsw_sp_sb_cm_get(mlxsw_sp, local_port,
1781 						       pg_buff, dir);
1782 
1783 	*p_cur = mlxsw_sp_cells_bytes(mlxsw_sp, cm->occ.cur);
1784 	*p_max = mlxsw_sp_cells_bytes(mlxsw_sp, cm->occ.max);
1785 	return 0;
1786 }
1787