1// SPDX-License-Identifier: GPL-2.0
  2/* Copyright(c) 2013 - 2018 Intel Corporation. */
  3
  4#ifdef CONFIG_I40E_DCB
  5#include "i40e.h"
  6#include <net/dcbnl.h>
  7
  8/**
  9 * i40e_get_pfc_delay - retrieve PFC Link Delay
 10 * @hw: pointer to hardware struct
 11 * @delay: holds the PFC Link delay value
 12 *
 13 * Returns PFC Link Delay from the PRTDCB_GENC.PFCLDA
 14 **/
 15static void i40e_get_pfc_delay(struct i40e_hw *hw, u16 *delay)
 16{
 17	u32 val;
 18
 19	val = rd32(hw, I40E_PRTDCB_GENC);
 20	*delay = (u16)((val & I40E_PRTDCB_GENC_PFCLDA_MASK) >>
 21		       I40E_PRTDCB_GENC_PFCLDA_SHIFT);
 22}
 23
 24/**
 25 * i40e_dcbnl_ieee_getets - retrieve local IEEE ETS configuration
 26 * @dev: the corresponding netdev
 27 * @ets: structure to hold the ETS information
 28 *
 29 * Returns local IEEE ETS configuration
 30 **/
 31static int i40e_dcbnl_ieee_getets(struct net_device *dev,
 32				  struct ieee_ets *ets)
 33{
 34	struct i40e_pf *pf = i40e_netdev_to_pf(dev);
 35	struct i40e_dcbx_config *dcbxcfg;
 36	struct i40e_hw *hw = &pf->hw;
 37
 38	if (!(pf->dcbx_cap & DCB_CAP_DCBX_VER_IEEE))
 39		return -EINVAL;
 40
 41	dcbxcfg = &hw->local_dcbx_config;
 42	ets->willing = dcbxcfg->etscfg.willing;
 43	ets->ets_cap = dcbxcfg->etscfg.maxtcs;
 44	ets->cbs = dcbxcfg->etscfg.cbs;
 45	memcpy(ets->tc_tx_bw, dcbxcfg->etscfg.tcbwtable,
 46		sizeof(ets->tc_tx_bw));
 47	memcpy(ets->tc_rx_bw, dcbxcfg->etscfg.tcbwtable,
 48		sizeof(ets->tc_rx_bw));
 49	memcpy(ets->tc_tsa, dcbxcfg->etscfg.tsatable,
 50		sizeof(ets->tc_tsa));
 51	memcpy(ets->prio_tc, dcbxcfg->etscfg.prioritytable,
 52		sizeof(ets->prio_tc));
 53	memcpy(ets->tc_reco_bw, dcbxcfg->etsrec.tcbwtable,
 54		sizeof(ets->tc_reco_bw));
 55	memcpy(ets->tc_reco_tsa, dcbxcfg->etsrec.tsatable,
 56		sizeof(ets->tc_reco_tsa));
 57	memcpy(ets->reco_prio_tc, dcbxcfg->etscfg.prioritytable,
 58		sizeof(ets->reco_prio_tc));
 59
 60	return 0;
 61}
 62
 63/**
 64 * i40e_dcbnl_ieee_getpfc - retrieve local IEEE PFC configuration
 65 * @dev: the corresponding netdev
 66 * @pfc: structure to hold the PFC information
 67 *
 68 * Returns local IEEE PFC configuration
 69 **/
 70static int i40e_dcbnl_ieee_getpfc(struct net_device *dev,
 71				  struct ieee_pfc *pfc)
 72{
 73	struct i40e_pf *pf = i40e_netdev_to_pf(dev);
 74	struct i40e_dcbx_config *dcbxcfg;
 75	struct i40e_hw *hw = &pf->hw;
 76	int i;
 77
 78	if (!(pf->dcbx_cap & DCB_CAP_DCBX_VER_IEEE))
 79		return -EINVAL;
 80
 81	dcbxcfg = &hw->local_dcbx_config;
 82	pfc->pfc_cap = dcbxcfg->pfc.pfccap;
 83	pfc->pfc_en = dcbxcfg->pfc.pfcenable;
 84	pfc->mbc = dcbxcfg->pfc.mbc;
 85	i40e_get_pfc_delay(hw, &pfc->delay);
 86
 87	/* Get Requests/Indicatiosn */
 88	for (i = 0; i < I40E_MAX_TRAFFIC_CLASS; i++) {
 89		pfc->requests[i] = pf->stats.priority_xoff_tx[i];
 90		pfc->indications[i] = pf->stats.priority_xoff_rx[i];
 91	}
 92
 93	return 0;
 94}
 95
 96/**
 97 * i40e_dcbnl_getdcbx - retrieve current DCBx capability
 98 * @dev: the corresponding netdev
 99 *
100 * Returns DCBx capability features
101 **/
102static u8 i40e_dcbnl_getdcbx(struct net_device *dev)
103{
104	struct i40e_pf *pf = i40e_netdev_to_pf(dev);
105
106	return pf->dcbx_cap;
107}
108
109/**
110 * i40e_dcbnl_get_perm_hw_addr - MAC address used by DCBx
111 * @dev: the corresponding netdev
112 * @perm_addr: buffer to store the MAC address
113 *
114 * Returns the SAN MAC address used for LLDP exchange
115 **/
116static void i40e_dcbnl_get_perm_hw_addr(struct net_device *dev,
117					u8 *perm_addr)
118{
119	struct i40e_pf *pf = i40e_netdev_to_pf(dev);
120	int i, j;
121
122	memset(perm_addr, 0xff, MAX_ADDR_LEN);
123
124	for (i = 0; i < dev->addr_len; i++)
125		perm_addr[i] = pf->hw.mac.perm_addr[i];
126
127	for (j = 0; j < dev->addr_len; j++, i++)
128		perm_addr[i] = pf->hw.mac.san_addr[j];
129}
130
131static const struct dcbnl_rtnl_ops dcbnl_ops = {
132	.ieee_getets	= i40e_dcbnl_ieee_getets,
133	.ieee_getpfc	= i40e_dcbnl_ieee_getpfc,
134	.getdcbx	= i40e_dcbnl_getdcbx,
135	.getpermhwaddr  = i40e_dcbnl_get_perm_hw_addr,
136};
137
138/**
139 * i40e_dcbnl_set_all - set all the apps and ieee data from DCBx config
140 * @vsi: the corresponding vsi
141 *
142 * Set up all the IEEE APPs in the DCBNL App Table and generate event for
143 * other settings
144 **/
145void i40e_dcbnl_set_all(struct i40e_vsi *vsi)
146{
147	struct net_device *dev = vsi->netdev;
148	struct i40e_pf *pf = i40e_netdev_to_pf(dev);
149	struct i40e_dcbx_config *dcbxcfg;
150	struct i40e_hw *hw = &pf->hw;
151	struct dcb_app sapp;
152	u8 prio, tc_map;
153	int i;
154
155	/* DCB not enabled */
156	if (!(pf->flags & I40E_FLAG_DCB_ENABLED))
157		return;
158
159	/* MFP mode but not an iSCSI PF so return */
160	if ((pf->flags & I40E_FLAG_MFP_ENABLED) && !(pf->hw.func_caps.iscsi))
161		return;
162
163	dcbxcfg = &hw->local_dcbx_config;
164
165	/* Set up all the App TLVs if DCBx is negotiated */
166	for (i = 0; i < dcbxcfg->numapps; i++) {
167		prio = dcbxcfg->app[i].priority;
168		tc_map = BIT(dcbxcfg->etscfg.prioritytable[prio]);
169
170		/* Add APP only if the TC is enabled for this VSI */
171		if (tc_map & vsi->tc_config.enabled_tc) {
172			sapp.selector = dcbxcfg->app[i].selector;
173			sapp.protocol = dcbxcfg->app[i].protocolid;
174			sapp.priority = prio;
175			dcb_ieee_setapp(dev, &sapp);
176		}
177	}
178
179	/* Notify user-space of the changes */
180	dcbnl_ieee_notify(dev, RTM_SETDCB, DCB_CMD_IEEE_SET, 0, 0);
181}
182
183/**
184 * i40e_dcbnl_vsi_del_app - Delete APP for given VSI
185 * @vsi: the corresponding vsi
186 * @app: APP to delete
187 *
188 * Delete given APP from the DCBNL APP table for given
189 * VSI
190 **/
191static int i40e_dcbnl_vsi_del_app(struct i40e_vsi *vsi,
192				  struct i40e_dcb_app_priority_table *app)
193{
194	struct net_device *dev = vsi->netdev;
195	struct dcb_app sapp;
196
197	if (!dev)
198		return -EINVAL;
199
200	sapp.selector = app->selector;
201	sapp.protocol = app->protocolid;
202	sapp.priority = app->priority;
203	return dcb_ieee_delapp(dev, &sapp);
204}
205
206/**
207 * i40e_dcbnl_del_app - Delete APP on all VSIs
208 * @pf: the corresponding PF
209 * @app: APP to delete
210 *
211 * Delete given APP from all the VSIs for given PF
212 **/
213static void i40e_dcbnl_del_app(struct i40e_pf *pf,
214			       struct i40e_dcb_app_priority_table *app)
215{
216	int v, err;
217
218	for (v = 0; v < pf->num_alloc_vsi; v++) {
219		if (pf->vsi[v] && pf->vsi[v]->netdev) {
220			err = i40e_dcbnl_vsi_del_app(pf->vsi[v], app);
221			dev_dbg(&pf->pdev->dev, "Deleting app for VSI seid=%d err=%d sel=%d proto=0x%x prio=%d\n",
222				pf->vsi[v]->seid, err, app->selector,
223				app->protocolid, app->priority);
224		}
225	}
226}
227
228/**
229 * i40e_dcbnl_find_app - Search APP in given DCB config
230 * @cfg: DCBX configuration data
231 * @app: APP to search for
232 *
233 * Find given APP in the DCB configuration
234 **/
235static bool i40e_dcbnl_find_app(struct i40e_dcbx_config *cfg,
236				struct i40e_dcb_app_priority_table *app)
237{
238	int i;
239
240	for (i = 0; i < cfg->numapps; i++) {
241		if (app->selector == cfg->app[i].selector &&
242		    app->protocolid == cfg->app[i].protocolid &&
243		    app->priority == cfg->app[i].priority)
244			return true;
245	}
246
247	return false;
248}
249
250/**
251 * i40e_dcbnl_flush_apps - Delete all removed APPs
252 * @pf: the corresponding PF
253 * @old_cfg: old DCBX configuration data
254 * @new_cfg: new DCBX configuration data
255 *
256 * Find and delete all APPs that are not present in the passed
257 * DCB configuration
258 **/
259void i40e_dcbnl_flush_apps(struct i40e_pf *pf,
260			   struct i40e_dcbx_config *old_cfg,
261			   struct i40e_dcbx_config *new_cfg)
262{
263	struct i40e_dcb_app_priority_table app;
264	int i;
265
266	/* MFP mode but not an iSCSI PF so return */
267	if ((pf->flags & I40E_FLAG_MFP_ENABLED) && !(pf->hw.func_caps.iscsi))
268		return;
269
270	for (i = 0; i < old_cfg->numapps; i++) {
271		app = old_cfg->app[i];
272		/* The APP is not available anymore delete it */
273		if (!i40e_dcbnl_find_app(new_cfg, &app))
274			i40e_dcbnl_del_app(pf, &app);
275	}
276}
277
278/**
279 * i40e_dcbnl_setup - DCBNL setup
280 * @vsi: the corresponding vsi
281 *
282 * Set up DCBNL ops and initial APP TLVs
283 **/
284void i40e_dcbnl_setup(struct i40e_vsi *vsi)
285{
286	struct net_device *dev = vsi->netdev;
287	struct i40e_pf *pf = i40e_netdev_to_pf(dev);
288
289	/* Not DCB capable */
290	if (!(pf->flags & I40E_FLAG_DCB_CAPABLE))
291		return;
292
293	dev->dcbnl_ops = &dcbnl_ops;
294
295	/* Set initial IEEE DCB settings */
296	i40e_dcbnl_set_all(vsi);
297}
298#endif /* CONFIG_I40E_DCB */