1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright(c) 2013 - 2019 Intel Corporation. */
3 
4 #include "fm10k.h"
5 
6 /**
7  * fm10k_dcbnl_ieee_getets - get the ETS configuration for the device
8  * @dev: netdev interface for the device
9  * @ets: ETS structure to push configuration to
10  **/
fm10k_dcbnl_ieee_getets(struct net_device * dev,struct ieee_ets * ets)11 static int fm10k_dcbnl_ieee_getets(struct net_device *dev, struct ieee_ets *ets)
12 {
13 	int i;
14 
15 	/* we support 8 TCs in all modes */
16 	ets->ets_cap = IEEE_8021QAZ_MAX_TCS;
17 	ets->cbs = 0;
18 
19 	/* we only support strict priority and cannot do traffic shaping */
20 	memset(ets->tc_tx_bw, 0, sizeof(ets->tc_tx_bw));
21 	memset(ets->tc_rx_bw, 0, sizeof(ets->tc_rx_bw));
22 	memset(ets->tc_tsa, IEEE_8021QAZ_TSA_STRICT, sizeof(ets->tc_tsa));
23 
24 	/* populate the prio map based on the netdev */
25 	for (i = 0; i < IEEE_8021QAZ_MAX_TCS; i++)
26 		ets->prio_tc[i] = netdev_get_prio_tc_map(dev, i);
27 
28 	return 0;
29 }
30 
31 /**
32  * fm10k_dcbnl_ieee_setets - set the ETS configuration for the device
33  * @dev: netdev interface for the device
34  * @ets: ETS structure to pull configuration from
35  **/
fm10k_dcbnl_ieee_setets(struct net_device * dev,struct ieee_ets * ets)36 static int fm10k_dcbnl_ieee_setets(struct net_device *dev, struct ieee_ets *ets)
37 {
38 	u8 num_tc = 0;
39 	int i;
40 
41 	/* verify type and determine num_tcs needed */
42 	for (i = 0; i < IEEE_8021QAZ_MAX_TCS; i++) {
43 		if (ets->tc_tx_bw[i] || ets->tc_rx_bw[i])
44 			return -EINVAL;
45 		if (ets->tc_tsa[i] != IEEE_8021QAZ_TSA_STRICT)
46 			return -EINVAL;
47 		if (ets->prio_tc[i] > num_tc)
48 			num_tc = ets->prio_tc[i];
49 	}
50 
51 	/* if requested TC is greater than 0 then num_tcs is max + 1 */
52 	if (num_tc)
53 		num_tc++;
54 
55 	if (num_tc > IEEE_8021QAZ_MAX_TCS)
56 		return -EINVAL;
57 
58 	/* update TC hardware mapping if necessary */
59 	if (num_tc != netdev_get_num_tc(dev)) {
60 		int err = fm10k_setup_tc(dev, num_tc);
61 		if (err)
62 			return err;
63 	}
64 
65 	/* update priority mapping */
66 	for (i = 0; i < IEEE_8021QAZ_MAX_TCS; i++)
67 		netdev_set_prio_tc_map(dev, i, ets->prio_tc[i]);
68 
69 	return 0;
70 }
71 
72 /**
73  * fm10k_dcbnl_ieee_getpfc - get the PFC configuration for the device
74  * @dev: netdev interface for the device
75  * @pfc: PFC structure to push configuration to
76  **/
fm10k_dcbnl_ieee_getpfc(struct net_device * dev,struct ieee_pfc * pfc)77 static int fm10k_dcbnl_ieee_getpfc(struct net_device *dev, struct ieee_pfc *pfc)
78 {
79 	struct fm10k_intfc *interface = netdev_priv(dev);
80 
81 	/* record flow control max count and state of TCs */
82 	pfc->pfc_cap = IEEE_8021QAZ_MAX_TCS;
83 	pfc->pfc_en = interface->pfc_en;
84 
85 	return 0;
86 }
87 
88 /**
89  * fm10k_dcbnl_ieee_setpfc - set the PFC configuration for the device
90  * @dev: netdev interface for the device
91  * @pfc: PFC structure to pull configuration from
92  **/
fm10k_dcbnl_ieee_setpfc(struct net_device * dev,struct ieee_pfc * pfc)93 static int fm10k_dcbnl_ieee_setpfc(struct net_device *dev, struct ieee_pfc *pfc)
94 {
95 	struct fm10k_intfc *interface = netdev_priv(dev);
96 
97 	/* record PFC configuration to interface */
98 	interface->pfc_en = pfc->pfc_en;
99 
100 	/* if we are running update the drop_en state for all queues */
101 	if (netif_running(dev))
102 		fm10k_update_rx_drop_en(interface);
103 
104 	return 0;
105 }
106 
107 /**
108  * fm10k_dcbnl_getdcbx - get the DCBX configuration for the device
109  * @dev: netdev interface for the device
110  *
111  * Returns that we support only IEEE DCB for this interface
112  **/
fm10k_dcbnl_getdcbx(struct net_device __always_unused * dev)113 static u8 fm10k_dcbnl_getdcbx(struct net_device __always_unused *dev)
114 {
115 	return DCB_CAP_DCBX_HOST | DCB_CAP_DCBX_VER_IEEE;
116 }
117 
118 /**
119  * fm10k_dcbnl_setdcbx - get the DCBX configuration for the device
120  * @dev: netdev interface for the device
121  * @mode: new mode for this device
122  *
123  * Returns error on attempt to enable anything but IEEE DCB for this interface
124  **/
fm10k_dcbnl_setdcbx(struct net_device __always_unused * dev,u8 mode)125 static u8 fm10k_dcbnl_setdcbx(struct net_device __always_unused *dev, u8 mode)
126 {
127 	return (mode != (DCB_CAP_DCBX_HOST | DCB_CAP_DCBX_VER_IEEE)) ? 1 : 0;
128 }
129 
130 static const struct dcbnl_rtnl_ops fm10k_dcbnl_ops = {
131 	.ieee_getets	= fm10k_dcbnl_ieee_getets,
132 	.ieee_setets	= fm10k_dcbnl_ieee_setets,
133 	.ieee_getpfc	= fm10k_dcbnl_ieee_getpfc,
134 	.ieee_setpfc	= fm10k_dcbnl_ieee_setpfc,
135 
136 	.getdcbx	= fm10k_dcbnl_getdcbx,
137 	.setdcbx	= fm10k_dcbnl_setdcbx,
138 };
139 
140 /**
141  * fm10k_dcbnl_set_ops - Configures dcbnl ops pointer for netdev
142  * @dev: netdev interface for the device
143  *
144  * Enables PF for DCB by assigning DCBNL ops pointer.
145  **/
fm10k_dcbnl_set_ops(struct net_device * dev)146 void fm10k_dcbnl_set_ops(struct net_device *dev)
147 {
148 	struct fm10k_intfc *interface = netdev_priv(dev);
149 	struct fm10k_hw *hw = &interface->hw;
150 
151 	if (hw->mac.type == fm10k_mac_pf)
152 		dev->dcbnl_ops = &fm10k_dcbnl_ops;
153 }
154