1/*
2 * Copyright (c) 2018, Mellanox Technologies. All rights reserved.
3 *
4 * This software is available to you under a choice of one of two
5 * licenses. You may choose to be licensed under the terms of the GNU
6 * General Public License (GPL) Version 2, available from the file
7 * COPYING in the main directory of this source tree, or the
8 * OpenIB.org BSD license below:
9 *
10 * Redistribution and use in source and binary forms, with or
11 * without modification, are permitted provided that the following
12 * conditions are met:
13 *
14 * - Redistributions of source code must retain the above
15 * copyright notice, this list of conditions and the following
16 * disclaimer.
17 *
18 * - Redistributions in binary form must reproduce the above
19 * copyright notice, this list of conditions and the following
20 * disclaimer in the documentation and/or other materials
21 * provided with the distribution.
22 *
23 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
24 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
25 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
26 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
27 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
28 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
29 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
30 * SOFTWARE.
31 */
32#include "port_buffer.h"
33
34int mlx5e_port_query_buffer(struct mlx5e_priv *priv,
35 struct mlx5e_port_buffer *port_buffer)
36{
37 u16 port_buff_cell_sz = priv->dcbx.port_buff_cell_sz;
38 struct mlx5_core_dev *mdev = priv->mdev;
39 int sz = MLX5_ST_SZ_BYTES(pbmc_reg);
40 u32 total_used = 0;
41 void *buffer;
42 void *out;
43 int err;
44 int i;
45
46 out = kzalloc(size: sz, GFP_KERNEL);
47 if (!out)
48 return -ENOMEM;
49
50 err = mlx5e_port_query_pbmc(mdev, out);
51 if (err)
52 goto out;
53
54 for (i = 0; i < MLX5E_MAX_NETWORK_BUFFER; i++) {
55 buffer = MLX5_ADDR_OF(pbmc_reg, out, buffer[i]);
56 port_buffer->buffer[i].lossy =
57 MLX5_GET(bufferx_reg, buffer, lossy);
58 port_buffer->buffer[i].epsb =
59 MLX5_GET(bufferx_reg, buffer, epsb);
60 port_buffer->buffer[i].size =
61 MLX5_GET(bufferx_reg, buffer, size) * port_buff_cell_sz;
62 port_buffer->buffer[i].xon =
63 MLX5_GET(bufferx_reg, buffer, xon_threshold) * port_buff_cell_sz;
64 port_buffer->buffer[i].xoff =
65 MLX5_GET(bufferx_reg, buffer, xoff_threshold) * port_buff_cell_sz;
66 total_used += port_buffer->buffer[i].size;
67
68 netdev_dbg(priv->netdev, "buffer %d: size=%d, xon=%d, xoff=%d, epsb=%d, lossy=%d\n",
69 i,
70 port_buffer->buffer[i].size,
71 port_buffer->buffer[i].xon,
72 port_buffer->buffer[i].xoff,
73 port_buffer->buffer[i].epsb,
74 port_buffer->buffer[i].lossy);
75 }
76
77 port_buffer->internal_buffers_size = 0;
78 for (i = MLX5E_MAX_NETWORK_BUFFER; i < MLX5E_TOTAL_BUFFERS; i++) {
79 buffer = MLX5_ADDR_OF(pbmc_reg, out, buffer[i]);
80 port_buffer->internal_buffers_size +=
81 MLX5_GET(bufferx_reg, buffer, size) * port_buff_cell_sz;
82 }
83
84 port_buffer->port_buffer_size =
85 MLX5_GET(pbmc_reg, out, port_buffer_size) * port_buff_cell_sz;
86 port_buffer->headroom_size = total_used;
87 port_buffer->spare_buffer_size = port_buffer->port_buffer_size -
88 port_buffer->internal_buffers_size -
89 port_buffer->headroom_size;
90
91 netdev_dbg(priv->netdev,
92 "total buffer size=%u, headroom buffer size=%u, internal buffers size=%u, spare buffer size=%u\n",
93 port_buffer->port_buffer_size, port_buffer->headroom_size,
94 port_buffer->internal_buffers_size,
95 port_buffer->spare_buffer_size);
96out:
97 kfree(objp: out);
98 return err;
99}
100
101struct mlx5e_buffer_pool {
102 u32 infi_size;
103 u32 size;
104 u32 buff_occupancy;
105};
106
107static int mlx5e_port_query_pool(struct mlx5_core_dev *mdev,
108 struct mlx5e_buffer_pool *buffer_pool,
109 u32 desc, u8 dir, u8 pool_idx)
110{
111 u32 out[MLX5_ST_SZ_DW(sbpr_reg)] = {};
112 int err;
113
114 err = mlx5e_port_query_sbpr(mdev, desc, dir, pool_idx, out,
115 size_out: sizeof(out));
116 if (err)
117 return err;
118
119 buffer_pool->size = MLX5_GET(sbpr_reg, out, size);
120 buffer_pool->infi_size = MLX5_GET(sbpr_reg, out, infi_size);
121 buffer_pool->buff_occupancy = MLX5_GET(sbpr_reg, out, buff_occupancy);
122
123 return err;
124}
125
126enum {
127 MLX5_INGRESS_DIR = 0,
128 MLX5_EGRESS_DIR = 1,
129};
130
131enum {
132 MLX5_LOSSY_POOL = 0,
133 MLX5_LOSSLESS_POOL = 1,
134};
135
136/* No limit on usage of shared buffer pool (max_buff=0) */
137#define MLX5_SB_POOL_NO_THRESHOLD 0
138/* Shared buffer pool usage threshold when calculated
139 * dynamically in alpha units. alpha=13 is equivalent to
140 * HW_alpha of [(1/128) * 2 ^ (alpha-1)] = 32, where HW_alpha
141 * equates to the following portion of the shared buffer pool:
142 * [32 / (1 + n * 32)] While *n* is the number of buffers
143 * that are using the shared buffer pool.
144 */
145#define MLX5_SB_POOL_THRESHOLD 13
146
147/* Shared buffer class management parameters */
148struct mlx5_sbcm_params {
149 u8 pool_idx;
150 u8 max_buff;
151 u8 infi_size;
152};
153
154static const struct mlx5_sbcm_params sbcm_default = {
155 .pool_idx = MLX5_LOSSY_POOL,
156 .max_buff = MLX5_SB_POOL_NO_THRESHOLD,
157 .infi_size = 0,
158};
159
160static const struct mlx5_sbcm_params sbcm_lossy = {
161 .pool_idx = MLX5_LOSSY_POOL,
162 .max_buff = MLX5_SB_POOL_NO_THRESHOLD,
163 .infi_size = 1,
164};
165
166static const struct mlx5_sbcm_params sbcm_lossless = {
167 .pool_idx = MLX5_LOSSLESS_POOL,
168 .max_buff = MLX5_SB_POOL_THRESHOLD,
169 .infi_size = 0,
170};
171
172static const struct mlx5_sbcm_params sbcm_lossless_no_threshold = {
173 .pool_idx = MLX5_LOSSLESS_POOL,
174 .max_buff = MLX5_SB_POOL_NO_THRESHOLD,
175 .infi_size = 1,
176};
177
178/**
179 * select_sbcm_params() - selects the shared buffer pool configuration
180 *
181 * @buffer: <input> port buffer to retrieve params of
182 * @lossless_buff_count: <input> number of lossless buffers in total
183 *
184 * The selection is based on the following rules:
185 * 1. If buffer size is 0, no shared buffer pool is used.
186 * 2. If buffer is lossy, use lossy shared buffer pool.
187 * 3. If there are more than 1 lossless buffers, use lossless shared buffer pool
188 * with threshold.
189 * 4. If there is only 1 lossless buffer, use lossless shared buffer pool
190 * without threshold.
191 *
192 * @return const struct mlx5_sbcm_params* selected values
193 */
194static const struct mlx5_sbcm_params *
195select_sbcm_params(struct mlx5e_bufferx_reg *buffer, u8 lossless_buff_count)
196{
197 if (buffer->size == 0)
198 return &sbcm_default;
199
200 if (buffer->lossy)
201 return &sbcm_lossy;
202
203 if (lossless_buff_count > 1)
204 return &sbcm_lossless;
205
206 return &sbcm_lossless_no_threshold;
207}
208
209static int port_update_pool_cfg(struct mlx5_core_dev *mdev,
210 struct mlx5e_port_buffer *port_buffer)
211{
212 const struct mlx5_sbcm_params *p;
213 u8 lossless_buff_count = 0;
214 int err;
215 int i;
216
217 if (!MLX5_CAP_GEN(mdev, sbcam_reg))
218 return 0;
219
220 for (i = 0; i < MLX5E_MAX_NETWORK_BUFFER; i++)
221 lossless_buff_count += ((port_buffer->buffer[i].size) &&
222 (!(port_buffer->buffer[i].lossy)));
223
224 for (i = 0; i < MLX5E_MAX_NETWORK_BUFFER; i++) {
225 p = select_sbcm_params(buffer: &port_buffer->buffer[i], lossless_buff_count);
226 err = mlx5e_port_set_sbcm(mdev, desc: 0, pg_buff_idx: i,
227 dir: MLX5_INGRESS_DIR,
228 infi_size: p->infi_size,
229 max_buff: p->max_buff,
230 pool_idx: p->pool_idx);
231 if (err)
232 return err;
233 }
234
235 return 0;
236}
237
238static int port_update_shared_buffer(struct mlx5_core_dev *mdev,
239 u32 current_headroom_size,
240 u32 new_headroom_size)
241{
242 struct mlx5e_buffer_pool lossless_ipool;
243 struct mlx5e_buffer_pool lossy_epool;
244 u32 lossless_ipool_size;
245 u32 shared_buffer_size;
246 u32 total_buffer_size;
247 u32 lossy_epool_size;
248 int err;
249
250 if (!MLX5_CAP_GEN(mdev, sbcam_reg))
251 return 0;
252
253 err = mlx5e_port_query_pool(mdev, buffer_pool: &lossy_epool, desc: 0, dir: MLX5_EGRESS_DIR,
254 pool_idx: MLX5_LOSSY_POOL);
255 if (err)
256 return err;
257
258 err = mlx5e_port_query_pool(mdev, buffer_pool: &lossless_ipool, desc: 0, dir: MLX5_INGRESS_DIR,
259 pool_idx: MLX5_LOSSLESS_POOL);
260 if (err)
261 return err;
262
263 total_buffer_size = current_headroom_size + lossy_epool.size +
264 lossless_ipool.size;
265 shared_buffer_size = total_buffer_size - new_headroom_size;
266
267 if (shared_buffer_size < 4) {
268 pr_err("Requested port buffer is too large, not enough space left for shared buffer\n");
269 return -EINVAL;
270 }
271
272 /* Total shared buffer size is split in a ratio of 3:1 between
273 * lossy and lossless pools respectively.
274 */
275 lossy_epool_size = (shared_buffer_size / 4) * 3;
276 lossless_ipool_size = shared_buffer_size / 4;
277
278 mlx5e_port_set_sbpr(mdev, desc: 0, dir: MLX5_EGRESS_DIR, pool_idx: MLX5_LOSSY_POOL, infi_size: 0,
279 size: lossy_epool_size);
280 mlx5e_port_set_sbpr(mdev, desc: 0, dir: MLX5_INGRESS_DIR, pool_idx: MLX5_LOSSLESS_POOL, infi_size: 0,
281 size: lossless_ipool_size);
282 return 0;
283}
284
285static int port_set_buffer(struct mlx5e_priv *priv,
286 struct mlx5e_port_buffer *port_buffer)
287{
288 u16 port_buff_cell_sz = priv->dcbx.port_buff_cell_sz;
289 struct mlx5_core_dev *mdev = priv->mdev;
290 int sz = MLX5_ST_SZ_BYTES(pbmc_reg);
291 u32 new_headroom_size = 0;
292 u32 current_headroom_size;
293 void *in;
294 int err;
295 int i;
296
297 current_headroom_size = port_buffer->headroom_size;
298
299 in = kzalloc(size: sz, GFP_KERNEL);
300 if (!in)
301 return -ENOMEM;
302
303 err = mlx5e_port_query_pbmc(mdev, out: in);
304 if (err)
305 goto out;
306
307 for (i = 0; i < MLX5E_MAX_NETWORK_BUFFER; i++) {
308 void *buffer = MLX5_ADDR_OF(pbmc_reg, in, buffer[i]);
309 u64 size = port_buffer->buffer[i].size;
310 u64 xoff = port_buffer->buffer[i].xoff;
311 u64 xon = port_buffer->buffer[i].xon;
312
313 new_headroom_size += size;
314 do_div(size, port_buff_cell_sz);
315 do_div(xoff, port_buff_cell_sz);
316 do_div(xon, port_buff_cell_sz);
317 MLX5_SET(bufferx_reg, buffer, size, size);
318 MLX5_SET(bufferx_reg, buffer, lossy, port_buffer->buffer[i].lossy);
319 MLX5_SET(bufferx_reg, buffer, xoff_threshold, xoff);
320 MLX5_SET(bufferx_reg, buffer, xon_threshold, xon);
321 }
322
323 new_headroom_size /= port_buff_cell_sz;
324 current_headroom_size /= port_buff_cell_sz;
325 err = port_update_shared_buffer(mdev: priv->mdev, current_headroom_size,
326 new_headroom_size);
327 if (err)
328 goto out;
329
330 err = port_update_pool_cfg(mdev: priv->mdev, port_buffer);
331 if (err)
332 goto out;
333
334 err = mlx5e_port_set_pbmc(mdev, in);
335out:
336 kfree(objp: in);
337 return err;
338}
339
340/* xoff = ((301+2.16 * len [m]) * speed [Gbps] + 2.72 MTU [B])
341 * minimum speed value is 40Gbps
342 */
343static u32 calculate_xoff(struct mlx5e_priv *priv, unsigned int mtu)
344{
345 u32 speed;
346 u32 xoff;
347 int err;
348
349 err = mlx5e_port_linkspeed(mdev: priv->mdev, speed: &speed);
350 if (err)
351 speed = SPEED_40000;
352 speed = max_t(u32, speed, SPEED_40000);
353
354 xoff = (301 + 216 * priv->dcbx.cable_len / 100) * speed / 1000 + 272 * mtu / 100;
355
356 netdev_dbg(priv->netdev, "%s: xoff=%d\n", __func__, xoff);
357 return xoff;
358}
359
360static int update_xoff_threshold(struct mlx5e_port_buffer *port_buffer,
361 u32 xoff, unsigned int max_mtu, u16 port_buff_cell_sz)
362{
363 int i;
364
365 for (i = 0; i < MLX5E_MAX_NETWORK_BUFFER; i++) {
366 if (port_buffer->buffer[i].lossy) {
367 port_buffer->buffer[i].xoff = 0;
368 port_buffer->buffer[i].xon = 0;
369 continue;
370 }
371
372 if (port_buffer->buffer[i].size <
373 (xoff + max_mtu + port_buff_cell_sz)) {
374 pr_err("buffer_size[%d]=%d is not enough for lossless buffer\n",
375 i, port_buffer->buffer[i].size);
376 return -ENOMEM;
377 }
378
379 port_buffer->buffer[i].xoff = port_buffer->buffer[i].size - xoff;
380 port_buffer->buffer[i].xon =
381 port_buffer->buffer[i].xoff - max_mtu;
382 }
383
384 return 0;
385}
386
387/**
388 * update_buffer_lossy - Update buffer configuration based on pfc
389 * @mdev: port function core device
390 * @max_mtu: netdev's max_mtu
391 * @pfc_en: <input> current pfc configuration
392 * @buffer: <input> current prio to buffer mapping
393 * @xoff: <input> xoff value
394 * @port_buff_cell_sz: <input> port buffer cell_size
395 * @port_buffer: <output> port receive buffer configuration
396 * @change: <output>
397 *
398 * Update buffer configuration based on pfc configuration and
399 * priority to buffer mapping.
400 * Buffer's lossy bit is changed to:
401 * lossless if there is at least one PFC enabled priority
402 * mapped to this buffer lossy if all priorities mapped to
403 * this buffer are PFC disabled
404 *
405 * @return: 0 if no error,
406 * sets change to true if buffer configuration was modified.
407 */
408static int update_buffer_lossy(struct mlx5_core_dev *mdev,
409 unsigned int max_mtu,
410 u8 pfc_en, u8 *buffer, u32 xoff, u16 port_buff_cell_sz,
411 struct mlx5e_port_buffer *port_buffer,
412 bool *change)
413{
414 bool changed = false;
415 u8 lossy_count;
416 u8 prio_count;
417 u8 lossy;
418 int prio;
419 int err;
420 int i;
421
422 for (i = 0; i < MLX5E_MAX_NETWORK_BUFFER; i++) {
423 prio_count = 0;
424 lossy_count = 0;
425
426 for (prio = 0; prio < MLX5E_MAX_PRIORITY; prio++) {
427 if (buffer[prio] != i)
428 continue;
429
430 prio_count++;
431 lossy_count += !(pfc_en & (1 << prio));
432 }
433
434 if (lossy_count == prio_count)
435 lossy = 1;
436 else /* lossy_count < prio_count */
437 lossy = 0;
438
439 if (lossy != port_buffer->buffer[i].lossy) {
440 port_buffer->buffer[i].lossy = lossy;
441 changed = true;
442 }
443 }
444
445 if (changed) {
446 err = update_xoff_threshold(port_buffer, xoff, max_mtu, port_buff_cell_sz);
447 if (err)
448 return err;
449
450 err = port_update_pool_cfg(mdev, port_buffer);
451 if (err)
452 return err;
453
454 *change = true;
455 }
456
457 return 0;
458}
459
460static int fill_pfc_en(struct mlx5_core_dev *mdev, u8 *pfc_en)
461{
462 u32 g_rx_pause, g_tx_pause;
463 int err;
464
465 err = mlx5_query_port_pause(dev: mdev, rx_pause: &g_rx_pause, tx_pause: &g_tx_pause);
466 if (err)
467 return err;
468
469 /* If global pause enabled, set all active buffers to lossless.
470 * Otherwise, check PFC setting.
471 */
472 if (g_rx_pause || g_tx_pause)
473 *pfc_en = 0xff;
474 else
475 err = mlx5_query_port_pfc(dev: mdev, pfc_en_tx: pfc_en, NULL);
476
477 return err;
478}
479
480#define MINIMUM_MAX_MTU 9216
481int mlx5e_port_manual_buffer_config(struct mlx5e_priv *priv,
482 u32 change, unsigned int mtu,
483 struct ieee_pfc *pfc,
484 u32 *buffer_size,
485 u8 *prio2buffer)
486{
487 u16 port_buff_cell_sz = priv->dcbx.port_buff_cell_sz;
488 struct net_device *netdev = priv->netdev;
489 struct mlx5e_port_buffer port_buffer;
490 u32 xoff = calculate_xoff(priv, mtu);
491 bool update_prio2buffer = false;
492 u8 buffer[MLX5E_MAX_PRIORITY];
493 bool update_buffer = false;
494 unsigned int max_mtu;
495 u32 total_used = 0;
496 u8 curr_pfc_en;
497 int err;
498 int i;
499
500 netdev_dbg(netdev, "%s: change=%x\n", __func__, change);
501 max_mtu = max_t(unsigned int, priv->netdev->max_mtu, MINIMUM_MAX_MTU);
502
503 err = mlx5e_port_query_buffer(priv, port_buffer: &port_buffer);
504 if (err)
505 return err;
506
507 if (change & MLX5E_PORT_BUFFER_CABLE_LEN) {
508 update_buffer = true;
509 err = update_xoff_threshold(port_buffer: &port_buffer, xoff, max_mtu, port_buff_cell_sz);
510 if (err)
511 return err;
512 }
513
514 if (change & MLX5E_PORT_BUFFER_PFC) {
515 netdev_dbg(netdev, "%s: requested PFC per priority bitmask: 0x%x\n",
516 __func__, pfc->pfc_en);
517 err = mlx5e_port_query_priority2buffer(mdev: priv->mdev, buffer);
518 if (err)
519 return err;
520
521 err = update_buffer_lossy(mdev: priv->mdev, max_mtu, pfc_en: pfc->pfc_en, buffer, xoff,
522 port_buff_cell_sz, port_buffer: &port_buffer,
523 change: &update_buffer);
524 if (err)
525 return err;
526 }
527
528 if (change & MLX5E_PORT_BUFFER_PRIO2BUFFER) {
529 update_prio2buffer = true;
530 for (i = 0; i < MLX5E_MAX_NETWORK_BUFFER; i++)
531 netdev_dbg(priv->netdev, "%s: requested to map prio[%d] to buffer %d\n",
532 __func__, i, prio2buffer[i]);
533
534 err = fill_pfc_en(mdev: priv->mdev, pfc_en: &curr_pfc_en);
535 if (err)
536 return err;
537
538 err = update_buffer_lossy(mdev: priv->mdev, max_mtu, pfc_en: curr_pfc_en, buffer: prio2buffer, xoff,
539 port_buff_cell_sz, port_buffer: &port_buffer, change: &update_buffer);
540 if (err)
541 return err;
542 }
543
544 if (change & MLX5E_PORT_BUFFER_SIZE) {
545 for (i = 0; i < MLX5E_MAX_NETWORK_BUFFER; i++) {
546 netdev_dbg(priv->netdev, "%s: buffer[%d]=%d\n", __func__, i, buffer_size[i]);
547 if (!port_buffer.buffer[i].lossy && !buffer_size[i]) {
548 netdev_dbg(priv->netdev, "%s: lossless buffer[%d] size cannot be zero\n",
549 __func__, i);
550 return -EINVAL;
551 }
552
553 port_buffer.buffer[i].size = buffer_size[i];
554 total_used += buffer_size[i];
555 }
556
557 netdev_dbg(priv->netdev, "%s: total buffer requested=%d\n", __func__, total_used);
558
559 if (total_used > port_buffer.headroom_size &&
560 (total_used - port_buffer.headroom_size) >
561 port_buffer.spare_buffer_size)
562 return -EINVAL;
563
564 update_buffer = true;
565 err = update_xoff_threshold(port_buffer: &port_buffer, xoff, max_mtu, port_buff_cell_sz);
566 if (err)
567 return err;
568 }
569
570 /* Need to update buffer configuration if xoff value is changed */
571 if (!update_buffer && xoff != priv->dcbx.xoff) {
572 update_buffer = true;
573 err = update_xoff_threshold(port_buffer: &port_buffer, xoff, max_mtu, port_buff_cell_sz);
574 if (err)
575 return err;
576 }
577 priv->dcbx.xoff = xoff;
578
579 /* Apply the settings */
580 if (update_buffer) {
581 err = port_set_buffer(priv, port_buffer: &port_buffer);
582 if (err)
583 return err;
584 }
585
586 if (update_prio2buffer)
587 err = mlx5e_port_set_priority2buffer(mdev: priv->mdev, buffer: prio2buffer);
588
589 return err;
590}
591

source code of linux/drivers/net/ethernet/mellanox/mlx5/core/en/port_buffer.c