Commit | Line | Data |
---|---|---|
564c274c AV |
1 | /* |
2 | * Copyright (c) 2011 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 | */ | |
33 | ||
34 | #include <linux/dcbnl.h> | |
43c880df | 35 | #include <linux/math64.h> |
564c274c AV |
36 | |
37 | #include "mlx4_en.h" | |
38 | ||
39 | static int mlx4_en_dcbnl_ieee_getets(struct net_device *dev, | |
40 | struct ieee_ets *ets) | |
41 | { | |
42 | struct mlx4_en_priv *priv = netdev_priv(dev); | |
43 | struct ieee_ets *my_ets = &priv->ets; | |
44 | ||
45 | /* No IEEE PFC settings available */ | |
46 | if (!my_ets) | |
47 | return -EINVAL; | |
48 | ||
49 | ets->ets_cap = IEEE_8021QAZ_MAX_TCS; | |
50 | ets->cbs = my_ets->cbs; | |
51 | memcpy(ets->tc_tx_bw, my_ets->tc_tx_bw, sizeof(ets->tc_tx_bw)); | |
52 | memcpy(ets->tc_tsa, my_ets->tc_tsa, sizeof(ets->tc_tsa)); | |
53 | memcpy(ets->prio_tc, my_ets->prio_tc, sizeof(ets->prio_tc)); | |
54 | ||
55 | return 0; | |
56 | } | |
57 | ||
58 | static int mlx4_en_ets_validate(struct mlx4_en_priv *priv, struct ieee_ets *ets) | |
59 | { | |
60 | int i; | |
61 | int total_ets_bw = 0; | |
62 | int has_ets_tc = 0; | |
63 | ||
64 | for (i = 0; i < IEEE_8021QAZ_MAX_TCS; i++) { | |
fd8daa45 | 65 | if (ets->prio_tc[i] >= MLX4_EN_NUM_UP) { |
564c274c AV |
66 | en_err(priv, "Bad priority in UP <=> TC mapping. TC: %d, UP: %d\n", |
67 | i, ets->prio_tc[i]); | |
68 | return -EINVAL; | |
69 | } | |
70 | ||
71 | switch (ets->tc_tsa[i]) { | |
72 | case IEEE_8021QAZ_TSA_STRICT: | |
73 | break; | |
74 | case IEEE_8021QAZ_TSA_ETS: | |
75 | has_ets_tc = 1; | |
76 | total_ets_bw += ets->tc_tx_bw[i]; | |
77 | break; | |
78 | default: | |
79 | en_err(priv, "TC[%d]: Not supported TSA: %d\n", | |
80 | i, ets->tc_tsa[i]); | |
81 | return -ENOTSUPP; | |
82 | } | |
83 | } | |
84 | ||
85 | if (has_ets_tc && total_ets_bw != MLX4_EN_BW_MAX) { | |
86 | en_err(priv, "Bad ETS BW sum: %d. Should be exactly 100%%\n", | |
87 | total_ets_bw); | |
88 | return -EINVAL; | |
89 | } | |
90 | ||
91 | return 0; | |
92 | } | |
93 | ||
94 | static int mlx4_en_config_port_scheduler(struct mlx4_en_priv *priv, | |
95 | struct ieee_ets *ets, u16 *ratelimit) | |
96 | { | |
97 | struct mlx4_en_dev *mdev = priv->mdev; | |
98 | int num_strict = 0; | |
99 | int i; | |
100 | __u8 tc_tx_bw[IEEE_8021QAZ_MAX_TCS] = { 0 }; | |
101 | __u8 pg[IEEE_8021QAZ_MAX_TCS] = { 0 }; | |
102 | ||
103 | ets = ets ?: &priv->ets; | |
109d2446 | 104 | ratelimit = ratelimit ?: priv->maxrate; |
564c274c AV |
105 | |
106 | /* higher TC means higher priority => lower pg */ | |
107 | for (i = IEEE_8021QAZ_MAX_TCS - 1; i >= 0; i--) { | |
108 | switch (ets->tc_tsa[i]) { | |
109 | case IEEE_8021QAZ_TSA_STRICT: | |
110 | pg[i] = num_strict++; | |
111 | tc_tx_bw[i] = MLX4_EN_BW_MAX; | |
112 | break; | |
113 | case IEEE_8021QAZ_TSA_ETS: | |
114 | pg[i] = MLX4_EN_TC_ETS; | |
115 | tc_tx_bw[i] = ets->tc_tx_bw[i] ?: MLX4_EN_BW_MIN; | |
116 | break; | |
117 | } | |
118 | } | |
119 | ||
120 | return mlx4_SET_PORT_SCHEDULER(mdev->dev, priv->port, tc_tx_bw, pg, | |
121 | ratelimit); | |
122 | } | |
123 | ||
124 | static int | |
125 | mlx4_en_dcbnl_ieee_setets(struct net_device *dev, struct ieee_ets *ets) | |
126 | { | |
127 | struct mlx4_en_priv *priv = netdev_priv(dev); | |
128 | struct mlx4_en_dev *mdev = priv->mdev; | |
129 | int err; | |
130 | ||
131 | err = mlx4_en_ets_validate(priv, ets); | |
132 | if (err) | |
133 | return err; | |
134 | ||
135 | err = mlx4_SET_PORT_PRIO2TC(mdev->dev, priv->port, ets->prio_tc); | |
136 | if (err) | |
137 | return err; | |
138 | ||
139 | err = mlx4_en_config_port_scheduler(priv, ets, NULL); | |
140 | if (err) | |
141 | return err; | |
142 | ||
143 | memcpy(&priv->ets, ets, sizeof(priv->ets)); | |
144 | ||
145 | return 0; | |
146 | } | |
147 | ||
148 | static int mlx4_en_dcbnl_ieee_getpfc(struct net_device *dev, | |
149 | struct ieee_pfc *pfc) | |
150 | { | |
151 | struct mlx4_en_priv *priv = netdev_priv(dev); | |
152 | ||
153 | pfc->pfc_cap = IEEE_8021QAZ_MAX_TCS; | |
154 | pfc->pfc_en = priv->prof->tx_ppp; | |
155 | ||
156 | return 0; | |
157 | } | |
158 | ||
159 | static int mlx4_en_dcbnl_ieee_setpfc(struct net_device *dev, | |
160 | struct ieee_pfc *pfc) | |
161 | { | |
162 | struct mlx4_en_priv *priv = netdev_priv(dev); | |
5c044e63 | 163 | struct mlx4_en_port_profile *prof = priv->prof; |
564c274c AV |
164 | struct mlx4_en_dev *mdev = priv->mdev; |
165 | int err; | |
166 | ||
167 | en_dbg(DRV, priv, "cap: 0x%x en: 0x%x mbc: 0x%x delay: %d\n", | |
168 | pfc->pfc_cap, | |
169 | pfc->pfc_en, | |
170 | pfc->mbc, | |
171 | pfc->delay); | |
172 | ||
0e316f1b EE |
173 | prof->rx_pause = !pfc->pfc_en; |
174 | prof->tx_pause = !pfc->pfc_en; | |
5c044e63 AV |
175 | prof->rx_ppp = pfc->pfc_en; |
176 | prof->tx_ppp = pfc->pfc_en; | |
564c274c AV |
177 | |
178 | err = mlx4_SET_PORT_general(mdev->dev, priv->port, | |
179 | priv->rx_skb_size + ETH_FCS_LEN, | |
5c044e63 AV |
180 | prof->tx_pause, |
181 | prof->tx_ppp, | |
182 | prof->rx_pause, | |
183 | prof->rx_ppp); | |
564c274c AV |
184 | if (err) |
185 | en_err(priv, "Failed setting pause params\n"); | |
186 | ||
187 | return err; | |
188 | } | |
189 | ||
190 | static u8 mlx4_en_dcbnl_getdcbx(struct net_device *dev) | |
191 | { | |
c4637cdf | 192 | return DCB_CAP_DCBX_HOST | DCB_CAP_DCBX_VER_IEEE; |
564c274c AV |
193 | } |
194 | ||
195 | static u8 mlx4_en_dcbnl_setdcbx(struct net_device *dev, u8 mode) | |
196 | { | |
197 | if ((mode & DCB_CAP_DCBX_LLD_MANAGED) || | |
198 | (mode & DCB_CAP_DCBX_VER_CEE) || | |
199 | !(mode & DCB_CAP_DCBX_VER_IEEE) || | |
200 | !(mode & DCB_CAP_DCBX_HOST)) | |
201 | return 1; | |
202 | ||
203 | return 0; | |
204 | } | |
205 | ||
109d2446 AV |
206 | #define MLX4_RATELIMIT_UNITS_IN_KB 100000 /* rate-limit HW unit in Kbps */ |
207 | static int mlx4_en_dcbnl_ieee_getmaxrate(struct net_device *dev, | |
208 | struct ieee_maxrate *maxrate) | |
209 | { | |
210 | struct mlx4_en_priv *priv = netdev_priv(dev); | |
211 | int i; | |
212 | ||
109d2446 AV |
213 | for (i = 0; i < IEEE_8021QAZ_MAX_TCS; i++) |
214 | maxrate->tc_maxrate[i] = | |
215 | priv->maxrate[i] * MLX4_RATELIMIT_UNITS_IN_KB; | |
216 | ||
217 | return 0; | |
218 | } | |
219 | ||
220 | static int mlx4_en_dcbnl_ieee_setmaxrate(struct net_device *dev, | |
221 | struct ieee_maxrate *maxrate) | |
222 | { | |
223 | struct mlx4_en_priv *priv = netdev_priv(dev); | |
224 | u16 tmp[IEEE_8021QAZ_MAX_TCS]; | |
225 | int i, err; | |
226 | ||
227 | for (i = 0; i < IEEE_8021QAZ_MAX_TCS; i++) { | |
228 | /* Convert from Kbps into HW units, rounding result up. | |
229 | * Setting to 0, means unlimited BW. | |
230 | */ | |
43c880df PG |
231 | tmp[i] = div_u64(maxrate->tc_maxrate[i] + |
232 | MLX4_RATELIMIT_UNITS_IN_KB - 1, | |
233 | MLX4_RATELIMIT_UNITS_IN_KB); | |
109d2446 AV |
234 | } |
235 | ||
236 | err = mlx4_en_config_port_scheduler(priv, NULL, tmp); | |
237 | if (err) | |
238 | return err; | |
239 | ||
29bb8f4a | 240 | memcpy(priv->maxrate, tmp, sizeof(priv->maxrate)); |
109d2446 AV |
241 | |
242 | return 0; | |
243 | } | |
244 | ||
564c274c AV |
245 | const struct dcbnl_rtnl_ops mlx4_en_dcbnl_ops = { |
246 | .ieee_getets = mlx4_en_dcbnl_ieee_getets, | |
247 | .ieee_setets = mlx4_en_dcbnl_ieee_setets, | |
109d2446 AV |
248 | .ieee_getmaxrate = mlx4_en_dcbnl_ieee_getmaxrate, |
249 | .ieee_setmaxrate = mlx4_en_dcbnl_ieee_setmaxrate, | |
564c274c AV |
250 | .ieee_getpfc = mlx4_en_dcbnl_ieee_getpfc, |
251 | .ieee_setpfc = mlx4_en_dcbnl_ieee_setpfc, | |
252 | ||
253 | .getdcbx = mlx4_en_dcbnl_getdcbx, | |
254 | .setdcbx = mlx4_en_dcbnl_setdcbx, | |
255 | }; | |
540b3a39 OG |
256 | |
257 | const struct dcbnl_rtnl_ops mlx4_en_dcbnl_pfc_ops = { | |
258 | .ieee_getpfc = mlx4_en_dcbnl_ieee_getpfc, | |
259 | .ieee_setpfc = mlx4_en_dcbnl_ieee_setpfc, | |
260 | ||
261 | .getdcbx = mlx4_en_dcbnl_getdcbx, | |
262 | .setdcbx = mlx4_en_dcbnl_setdcbx, | |
263 | }; |