1*29aaf3d4SHoratiu Vultur // SPDX-License-Identifier: GPL-2.0+
2*29aaf3d4SHoratiu Vultur
3*29aaf3d4SHoratiu Vultur #include "lan966x_main.h"
4*29aaf3d4SHoratiu Vultur
5*29aaf3d4SHoratiu Vultur #define DWRR_COST_BIT_WIDTH BIT(5)
6*29aaf3d4SHoratiu Vultur
lan966x_ets_hw_cost(u32 w_min,u32 weight)7*29aaf3d4SHoratiu Vultur static u32 lan966x_ets_hw_cost(u32 w_min, u32 weight)
8*29aaf3d4SHoratiu Vultur {
9*29aaf3d4SHoratiu Vultur u32 res;
10*29aaf3d4SHoratiu Vultur
11*29aaf3d4SHoratiu Vultur /* Round half up: Multiply with 16 before division,
12*29aaf3d4SHoratiu Vultur * add 8 and divide result with 16 again
13*29aaf3d4SHoratiu Vultur */
14*29aaf3d4SHoratiu Vultur res = (((DWRR_COST_BIT_WIDTH << 4) * w_min / weight) + 8) >> 4;
15*29aaf3d4SHoratiu Vultur return max_t(u32, 1, res) - 1;
16*29aaf3d4SHoratiu Vultur }
17*29aaf3d4SHoratiu Vultur
lan966x_ets_add(struct lan966x_port * port,struct tc_ets_qopt_offload * qopt)18*29aaf3d4SHoratiu Vultur int lan966x_ets_add(struct lan966x_port *port,
19*29aaf3d4SHoratiu Vultur struct tc_ets_qopt_offload *qopt)
20*29aaf3d4SHoratiu Vultur {
21*29aaf3d4SHoratiu Vultur struct tc_ets_qopt_offload_replace_params *params;
22*29aaf3d4SHoratiu Vultur struct lan966x *lan966x = port->lan966x;
23*29aaf3d4SHoratiu Vultur u32 w_min = 100;
24*29aaf3d4SHoratiu Vultur u8 count = 0;
25*29aaf3d4SHoratiu Vultur u32 se_idx;
26*29aaf3d4SHoratiu Vultur u8 i;
27*29aaf3d4SHoratiu Vultur
28*29aaf3d4SHoratiu Vultur /* Check the input */
29*29aaf3d4SHoratiu Vultur if (qopt->parent != TC_H_ROOT)
30*29aaf3d4SHoratiu Vultur return -EINVAL;
31*29aaf3d4SHoratiu Vultur
32*29aaf3d4SHoratiu Vultur params = &qopt->replace_params;
33*29aaf3d4SHoratiu Vultur if (params->bands != NUM_PRIO_QUEUES)
34*29aaf3d4SHoratiu Vultur return -EINVAL;
35*29aaf3d4SHoratiu Vultur
36*29aaf3d4SHoratiu Vultur for (i = 0; i < params->bands; ++i) {
37*29aaf3d4SHoratiu Vultur /* In the switch the DWRR is always on the lowest consecutive
38*29aaf3d4SHoratiu Vultur * priorities. Due to this, the first priority must map to the
39*29aaf3d4SHoratiu Vultur * first DWRR band.
40*29aaf3d4SHoratiu Vultur */
41*29aaf3d4SHoratiu Vultur if (params->priomap[i] != (7 - i))
42*29aaf3d4SHoratiu Vultur return -EINVAL;
43*29aaf3d4SHoratiu Vultur
44*29aaf3d4SHoratiu Vultur if (params->quanta[i] && params->weights[i] == 0)
45*29aaf3d4SHoratiu Vultur return -EINVAL;
46*29aaf3d4SHoratiu Vultur }
47*29aaf3d4SHoratiu Vultur
48*29aaf3d4SHoratiu Vultur se_idx = SE_IDX_PORT + port->chip_port;
49*29aaf3d4SHoratiu Vultur
50*29aaf3d4SHoratiu Vultur /* Find minimum weight */
51*29aaf3d4SHoratiu Vultur for (i = 0; i < params->bands; ++i) {
52*29aaf3d4SHoratiu Vultur if (params->quanta[i] == 0)
53*29aaf3d4SHoratiu Vultur continue;
54*29aaf3d4SHoratiu Vultur
55*29aaf3d4SHoratiu Vultur w_min = min(w_min, params->weights[i]);
56*29aaf3d4SHoratiu Vultur }
57*29aaf3d4SHoratiu Vultur
58*29aaf3d4SHoratiu Vultur for (i = 0; i < params->bands; ++i) {
59*29aaf3d4SHoratiu Vultur if (params->quanta[i] == 0)
60*29aaf3d4SHoratiu Vultur continue;
61*29aaf3d4SHoratiu Vultur
62*29aaf3d4SHoratiu Vultur ++count;
63*29aaf3d4SHoratiu Vultur
64*29aaf3d4SHoratiu Vultur lan_wr(lan966x_ets_hw_cost(w_min, params->weights[i]),
65*29aaf3d4SHoratiu Vultur lan966x, QSYS_SE_DWRR_CFG(se_idx, 7 - i));
66*29aaf3d4SHoratiu Vultur }
67*29aaf3d4SHoratiu Vultur
68*29aaf3d4SHoratiu Vultur lan_rmw(QSYS_SE_CFG_SE_DWRR_CNT_SET(count) |
69*29aaf3d4SHoratiu Vultur QSYS_SE_CFG_SE_RR_ENA_SET(0),
70*29aaf3d4SHoratiu Vultur QSYS_SE_CFG_SE_DWRR_CNT |
71*29aaf3d4SHoratiu Vultur QSYS_SE_CFG_SE_RR_ENA,
72*29aaf3d4SHoratiu Vultur lan966x, QSYS_SE_CFG(se_idx));
73*29aaf3d4SHoratiu Vultur
74*29aaf3d4SHoratiu Vultur return 0;
75*29aaf3d4SHoratiu Vultur }
76*29aaf3d4SHoratiu Vultur
lan966x_ets_del(struct lan966x_port * port,struct tc_ets_qopt_offload * qopt)77*29aaf3d4SHoratiu Vultur int lan966x_ets_del(struct lan966x_port *port,
78*29aaf3d4SHoratiu Vultur struct tc_ets_qopt_offload *qopt)
79*29aaf3d4SHoratiu Vultur {
80*29aaf3d4SHoratiu Vultur struct lan966x *lan966x = port->lan966x;
81*29aaf3d4SHoratiu Vultur u32 se_idx;
82*29aaf3d4SHoratiu Vultur int i;
83*29aaf3d4SHoratiu Vultur
84*29aaf3d4SHoratiu Vultur se_idx = SE_IDX_PORT + port->chip_port;
85*29aaf3d4SHoratiu Vultur
86*29aaf3d4SHoratiu Vultur for (i = 0; i < NUM_PRIO_QUEUES; ++i)
87*29aaf3d4SHoratiu Vultur lan_wr(0, lan966x, QSYS_SE_DWRR_CFG(se_idx, i));
88*29aaf3d4SHoratiu Vultur
89*29aaf3d4SHoratiu Vultur lan_rmw(QSYS_SE_CFG_SE_DWRR_CNT_SET(0) |
90*29aaf3d4SHoratiu Vultur QSYS_SE_CFG_SE_RR_ENA_SET(0),
91*29aaf3d4SHoratiu Vultur QSYS_SE_CFG_SE_DWRR_CNT |
92*29aaf3d4SHoratiu Vultur QSYS_SE_CFG_SE_RR_ENA,
93*29aaf3d4SHoratiu Vultur lan966x, QSYS_SE_CFG(se_idx));
94*29aaf3d4SHoratiu Vultur
95*29aaf3d4SHoratiu Vultur return 0;
96*29aaf3d4SHoratiu Vultur }
97