1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27#ifdef CONFIG_I40E_DCB
28#include "i40e.h"
29#include <net/dcbnl.h>
30
31
32
33
34
35
36
37
38static void i40e_get_pfc_delay(struct i40e_hw *hw, u16 *delay)
39{
40 u32 val;
41
42 val = rd32(hw, I40E_PRTDCB_GENC);
43 *delay = (u16)((val & I40E_PRTDCB_GENC_PFCLDA_MASK) >>
44 I40E_PRTDCB_GENC_PFCLDA_SHIFT);
45}
46
47
48
49
50
51
52
53
54static int i40e_dcbnl_ieee_getets(struct net_device *dev,
55 struct ieee_ets *ets)
56{
57 struct i40e_pf *pf = i40e_netdev_to_pf(dev);
58 struct i40e_dcbx_config *dcbxcfg;
59 struct i40e_hw *hw = &pf->hw;
60
61 if (!(pf->dcbx_cap & DCB_CAP_DCBX_VER_IEEE))
62 return -EINVAL;
63
64 dcbxcfg = &hw->local_dcbx_config;
65 ets->willing = dcbxcfg->etscfg.willing;
66 ets->ets_cap = dcbxcfg->etscfg.maxtcs;
67 ets->cbs = dcbxcfg->etscfg.cbs;
68 memcpy(ets->tc_tx_bw, dcbxcfg->etscfg.tcbwtable,
69 sizeof(ets->tc_tx_bw));
70 memcpy(ets->tc_rx_bw, dcbxcfg->etscfg.tcbwtable,
71 sizeof(ets->tc_rx_bw));
72 memcpy(ets->tc_tsa, dcbxcfg->etscfg.tsatable,
73 sizeof(ets->tc_tsa));
74 memcpy(ets->prio_tc, dcbxcfg->etscfg.prioritytable,
75 sizeof(ets->prio_tc));
76 memcpy(ets->tc_reco_bw, dcbxcfg->etsrec.tcbwtable,
77 sizeof(ets->tc_reco_bw));
78 memcpy(ets->tc_reco_tsa, dcbxcfg->etsrec.tsatable,
79 sizeof(ets->tc_reco_tsa));
80 memcpy(ets->reco_prio_tc, dcbxcfg->etscfg.prioritytable,
81 sizeof(ets->reco_prio_tc));
82
83 return 0;
84}
85
86
87
88
89
90
91
92
93static int i40e_dcbnl_ieee_getpfc(struct net_device *dev,
94 struct ieee_pfc *pfc)
95{
96 struct i40e_pf *pf = i40e_netdev_to_pf(dev);
97 struct i40e_dcbx_config *dcbxcfg;
98 struct i40e_hw *hw = &pf->hw;
99 int i;
100
101 if (!(pf->dcbx_cap & DCB_CAP_DCBX_VER_IEEE))
102 return -EINVAL;
103
104 dcbxcfg = &hw->local_dcbx_config;
105 pfc->pfc_cap = dcbxcfg->pfc.pfccap;
106 pfc->pfc_en = dcbxcfg->pfc.pfcenable;
107 pfc->mbc = dcbxcfg->pfc.mbc;
108 i40e_get_pfc_delay(hw, &pfc->delay);
109
110
111 for (i = 0; i < I40E_MAX_TRAFFIC_CLASS; i++) {
112 pfc->requests[i] = pf->stats.priority_xoff_tx[i];
113 pfc->indications[i] = pf->stats.priority_xoff_rx[i];
114 }
115
116 return 0;
117}
118
119
120
121
122
123
124
125static u8 i40e_dcbnl_getdcbx(struct net_device *dev)
126{
127 struct i40e_pf *pf = i40e_netdev_to_pf(dev);
128
129 return pf->dcbx_cap;
130}
131
132
133
134
135
136
137
138static void i40e_dcbnl_get_perm_hw_addr(struct net_device *dev,
139 u8 *perm_addr)
140{
141 struct i40e_pf *pf = i40e_netdev_to_pf(dev);
142 int i, j;
143
144 memset(perm_addr, 0xff, MAX_ADDR_LEN);
145
146 for (i = 0; i < dev->addr_len; i++)
147 perm_addr[i] = pf->hw.mac.perm_addr[i];
148
149 for (j = 0; j < dev->addr_len; j++, i++)
150 perm_addr[i] = pf->hw.mac.san_addr[j];
151}
152
153static const struct dcbnl_rtnl_ops dcbnl_ops = {
154 .ieee_getets = i40e_dcbnl_ieee_getets,
155 .ieee_getpfc = i40e_dcbnl_ieee_getpfc,
156 .getdcbx = i40e_dcbnl_getdcbx,
157 .getpermhwaddr = i40e_dcbnl_get_perm_hw_addr,
158};
159
160
161
162
163
164
165
166
167void i40e_dcbnl_set_all(struct i40e_vsi *vsi)
168{
169 struct net_device *dev = vsi->netdev;
170 struct i40e_pf *pf = i40e_netdev_to_pf(dev);
171 struct i40e_dcbx_config *dcbxcfg;
172 struct i40e_hw *hw = &pf->hw;
173 struct dcb_app sapp;
174 u8 prio, tc_map;
175 int i;
176
177
178 if (!(pf->flags & I40E_FLAG_DCB_ENABLED))
179 return;
180
181
182 if ((pf->flags & I40E_FLAG_MFP_ENABLED) && !(pf->hw.func_caps.iscsi))
183 return;
184
185 dcbxcfg = &hw->local_dcbx_config;
186
187
188 for (i = 0; i < dcbxcfg->numapps; i++) {
189 prio = dcbxcfg->app[i].priority;
190 tc_map = BIT(dcbxcfg->etscfg.prioritytable[prio]);
191
192
193 if (tc_map & vsi->tc_config.enabled_tc) {
194 sapp.selector = dcbxcfg->app[i].selector;
195 sapp.protocol = dcbxcfg->app[i].protocolid;
196 sapp.priority = prio;
197 dcb_ieee_setapp(dev, &sapp);
198 }
199 }
200
201
202 dcbnl_ieee_notify(dev, RTM_SETDCB, DCB_CMD_IEEE_SET, 0, 0);
203}
204
205
206
207
208
209
210
211
212
213static int i40e_dcbnl_vsi_del_app(struct i40e_vsi *vsi,
214 struct i40e_dcb_app_priority_table *app)
215{
216 struct net_device *dev = vsi->netdev;
217 struct dcb_app sapp;
218
219 if (!dev)
220 return -EINVAL;
221
222 sapp.selector = app->selector;
223 sapp.protocol = app->protocolid;
224 sapp.priority = app->priority;
225 return dcb_ieee_delapp(dev, &sapp);
226}
227
228
229
230
231
232
233
234
235static void i40e_dcbnl_del_app(struct i40e_pf *pf,
236 struct i40e_dcb_app_priority_table *app)
237{
238 int v, err;
239
240 for (v = 0; v < pf->num_alloc_vsi; v++) {
241 if (pf->vsi[v] && pf->vsi[v]->netdev) {
242 err = i40e_dcbnl_vsi_del_app(pf->vsi[v], app);
243 dev_dbg(&pf->pdev->dev, "Deleting app for VSI seid=%d err=%d sel=%d proto=0x%x prio=%d\n",
244 pf->vsi[v]->seid, err, app->selector,
245 app->protocolid, app->priority);
246 }
247 }
248}
249
250
251
252
253
254
255
256
257static bool i40e_dcbnl_find_app(struct i40e_dcbx_config *cfg,
258 struct i40e_dcb_app_priority_table *app)
259{
260 int i;
261
262 for (i = 0; i < cfg->numapps; i++) {
263 if (app->selector == cfg->app[i].selector &&
264 app->protocolid == cfg->app[i].protocolid &&
265 app->priority == cfg->app[i].priority)
266 return true;
267 }
268
269 return false;
270}
271
272
273
274
275
276
277
278
279
280
281void i40e_dcbnl_flush_apps(struct i40e_pf *pf,
282 struct i40e_dcbx_config *old_cfg,
283 struct i40e_dcbx_config *new_cfg)
284{
285 struct i40e_dcb_app_priority_table app;
286 int i;
287
288
289 if ((pf->flags & I40E_FLAG_MFP_ENABLED) && !(pf->hw.func_caps.iscsi))
290 return;
291
292 for (i = 0; i < old_cfg->numapps; i++) {
293 app = old_cfg->app[i];
294
295 if (!i40e_dcbnl_find_app(new_cfg, &app))
296 i40e_dcbnl_del_app(pf, &app);
297 }
298}
299
300
301
302
303
304
305
306void i40e_dcbnl_setup(struct i40e_vsi *vsi)
307{
308 struct net_device *dev = vsi->netdev;
309 struct i40e_pf *pf = i40e_netdev_to_pf(dev);
310
311
312 if (!(pf->flags & I40E_FLAG_DCB_CAPABLE))
313 return;
314
315 dev->dcbnl_ops = &dcbnl_ops;
316
317
318 i40e_dcbnl_set_all(vsi);
319}
320#endif
321