1/*******************************************************************************
2 *
3 * Intel Ethernet Controller XL710 Family Linux Driver
4 * Copyright(c) 2013 - 2014 Intel Corporation.
5 *
6 * This program is free software; you can redistribute it and/or modify it
7 * under the terms and conditions of the GNU General Public License,
8 * version 2, as published by the Free Software Foundation.
9 *
10 * This program is distributed in the hope it will be useful, but WITHOUT
11 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
12 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
13 * more details.
14 *
15 * You should have received a copy of the GNU General Public License along
16 * with this program.  If not, see <http://www.gnu.org/licenses/>.
17 *
18 * The full GNU General Public License is included in this distribution in
19 * the file called "COPYING".
20 *
21 * Contact Information:
22 * e1000-devel Mailing List <e1000-devel@lists.sourceforge.net>
23 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
24 *
25 ******************************************************************************/
26
27#ifdef CONFIG_I40E_DCB
28#include "i40e.h"
29#include <net/dcbnl.h>
30
31/**
32 * i40e_get_pfc_delay - retrieve PFC Link Delay
33 * @hw: pointer to hardware struct
34 * @delay: holds the PFC Link delay value
35 *
36 * Returns PFC Link Delay from the PRTDCB_GENC.PFCLDA
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 * i40e_dcbnl_ieee_getets - retrieve local IEEE ETS configuration
49 * @netdev: the corresponding netdev
50 * @ets: structure to hold the ETS information
51 *
52 * Returns local IEEE ETS configuration
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 * i40e_dcbnl_ieee_getpfc - retrieve local IEEE PFC configuration
88 * @netdev: the corresponding netdev
89 * @ets: structure to hold the PFC information
90 *
91 * Returns local IEEE PFC configuration
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	/* Get Requests/Indicatiosn */
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 * i40e_dcbnl_getdcbx - retrieve current DCBx capability
121 * @netdev: the corresponding netdev
122 *
123 * Returns DCBx capability features
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 * i40e_dcbnl_get_perm_hw_addr - MAC address used by DCBx
134 * @netdev: the corresponding netdev
135 *
136 * Returns the SAN MAC address used for LLDP exchange
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 * i40e_dcbnl_set_all - set all the apps and ieee data from DCBx config
162 * @vsi: the corresponding vsi
163 *
164 * Set up all the IEEE APPs in the DCBNL App Table and generate event for
165 * other settings
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	/* DCB not enabled */
178	if (!(pf->flags & I40E_FLAG_DCB_ENABLED))
179		return;
180
181	/* MFP mode but not an iSCSI PF so return */
182	if ((pf->flags & I40E_FLAG_MFP_ENABLED) && !(pf->hw.func_caps.iscsi))
183		return;
184
185	dcbxcfg = &hw->local_dcbx_config;
186
187	/* Set up all the App TLVs if DCBx is negotiated */
188	for (i = 0; i < dcbxcfg->numapps; i++) {
189		prio = dcbxcfg->app[i].priority;
190		tc_map = (1 << dcbxcfg->etscfg.prioritytable[prio]);
191
192		/* Add APP only if the TC is enabled for this VSI */
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	/* Notify user-space of the changes */
202	dcbnl_ieee_notify(dev, RTM_SETDCB, DCB_CMD_IEEE_SET, 0, 0);
203}
204
205/**
206 * i40e_dcbnl_vsi_del_app - Delete APP for given VSI
207 * @vsi: the corresponding vsi
208 * @app: APP to delete
209 *
210 * Delete given APP from the DCBNL APP table for given
211 * VSI
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 * i40e_dcbnl_del_app - Delete APP on all VSIs
230 * @pf: the corresponding PF
231 * @app: APP to delete
232 *
233 * Delete given APP from all the VSIs for given PF
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	for (v = 0; v < pf->num_alloc_vsi; v++) {
240		if (pf->vsi[v] && pf->vsi[v]->netdev) {
241			err = i40e_dcbnl_vsi_del_app(pf->vsi[v], app);
242			if (err)
243				dev_info(&pf->pdev->dev, "%s: Failed deleting app for VSI seid=%d err=%d sel=%d proto=0x%x prio=%d\n",
244					 __func__, pf->vsi[v]->seid,
245					 err, app->selector,
246					 app->protocolid, app->priority);
247		}
248	}
249}
250
251/**
252 * i40e_dcbnl_find_app - Search APP in given DCB config
253 * @cfg: DCBX configuration data
254 * @app: APP to search for
255 *
256 * Find given APP in the DCB configuration
257 **/
258static bool i40e_dcbnl_find_app(struct i40e_dcbx_config *cfg,
259				struct i40e_dcb_app_priority_table *app)
260{
261	int i;
262
263	for (i = 0; i < cfg->numapps; i++) {
264		if (app->selector == cfg->app[i].selector &&
265		    app->protocolid == cfg->app[i].protocolid &&
266		    app->priority == cfg->app[i].priority)
267			return true;
268	}
269
270	return false;
271}
272
273/**
274 * i40e_dcbnl_flush_apps - Delete all removed APPs
275 * @pf: the corresponding PF
276 * @old_cfg: old DCBX configuration data
277 * @new_cfg: new DCBX configuration data
278 *
279 * Find and delete all APPs that are not present in the passed
280 * DCB configuration
281 **/
282void i40e_dcbnl_flush_apps(struct i40e_pf *pf,
283			   struct i40e_dcbx_config *old_cfg,
284			   struct i40e_dcbx_config *new_cfg)
285{
286	struct i40e_dcb_app_priority_table app;
287	int i;
288
289	/* MFP mode but not an iSCSI PF so return */
290	if ((pf->flags & I40E_FLAG_MFP_ENABLED) && !(pf->hw.func_caps.iscsi))
291		return;
292
293	for (i = 0; i < old_cfg->numapps; i++) {
294		app = old_cfg->app[i];
295		/* The APP is not available anymore delete it */
296		if (!i40e_dcbnl_find_app(new_cfg, &app))
297			i40e_dcbnl_del_app(pf, &app);
298	}
299}
300
301/**
302 * i40e_dcbnl_setup - DCBNL setup
303 * @vsi: the corresponding vsi
304 *
305 * Set up DCBNL ops and initial APP TLVs
306 **/
307void i40e_dcbnl_setup(struct i40e_vsi *vsi)
308{
309	struct net_device *dev = vsi->netdev;
310	struct i40e_pf *pf = i40e_netdev_to_pf(dev);
311
312	/* Not DCB capable */
313	if (!(pf->flags & I40E_FLAG_DCB_CAPABLE))
314		return;
315
316	dev->dcbnl_ops = &dcbnl_ops;
317
318	/* Set initial IEEE DCB settings */
319	i40e_dcbnl_set_all(vsi);
320}
321#endif /* CONFIG_I40E_DCB */
322