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 | **/ |
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, prio: 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 | **/ |
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, tc: 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, prio: i, tc: 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 | **/ |
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 | **/ |
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 | **/ |
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 | **/ |
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 | **/ |
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 | |