1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21#include "fm10k.h"
22
23
24
25
26
27
28static int fm10k_dcbnl_ieee_getets(struct net_device *dev, struct ieee_ets *ets)
29{
30 int i;
31
32
33 ets->ets_cap = IEEE_8021QAZ_MAX_TCS;
34 ets->cbs = 0;
35
36
37 memset(ets->tc_tx_bw, 0, sizeof(ets->tc_tx_bw));
38 memset(ets->tc_rx_bw, 0, sizeof(ets->tc_rx_bw));
39 memset(ets->tc_tsa, IEEE_8021QAZ_TSA_STRICT, sizeof(ets->tc_tsa));
40
41
42 for (i = 0; i < IEEE_8021QAZ_MAX_TCS; i++)
43 ets->prio_tc[i] = netdev_get_prio_tc_map(dev, i);
44
45 return 0;
46}
47
48
49
50
51
52
53static int fm10k_dcbnl_ieee_setets(struct net_device *dev, struct ieee_ets *ets)
54{
55 u8 num_tc = 0;
56 int i, err;
57
58
59 for (i = 0; i < IEEE_8021QAZ_MAX_TCS; i++) {
60 if (ets->tc_tx_bw[i] || ets->tc_rx_bw[i])
61 return -EINVAL;
62 if (ets->tc_tsa[i] != IEEE_8021QAZ_TSA_STRICT)
63 return -EINVAL;
64 if (ets->prio_tc[i] > num_tc)
65 num_tc = ets->prio_tc[i];
66 }
67
68
69 if (num_tc)
70 num_tc++;
71
72 if (num_tc > IEEE_8021QAZ_MAX_TCS)
73 return -EINVAL;
74
75
76 if (num_tc != netdev_get_num_tc(dev)) {
77 err = fm10k_setup_tc(dev, num_tc);
78 if (err)
79 return err;
80 }
81
82
83 for (i = 0; i < IEEE_8021QAZ_MAX_TCS; i++)
84 netdev_set_prio_tc_map(dev, i, ets->prio_tc[i]);
85
86 return 0;
87}
88
89
90
91
92
93
94static int fm10k_dcbnl_ieee_getpfc(struct net_device *dev, struct ieee_pfc *pfc)
95{
96 struct fm10k_intfc *interface = netdev_priv(dev);
97
98
99 pfc->pfc_cap = IEEE_8021QAZ_MAX_TCS;
100 pfc->pfc_en = interface->pfc_en;
101
102 return 0;
103}
104
105
106
107
108
109
110static int fm10k_dcbnl_ieee_setpfc(struct net_device *dev, struct ieee_pfc *pfc)
111{
112 struct fm10k_intfc *interface = netdev_priv(dev);
113
114
115 interface->pfc_en = pfc->pfc_en;
116
117
118 if (netif_running(dev))
119 fm10k_update_rx_drop_en(interface);
120
121 return 0;
122}
123
124
125
126
127
128
129
130static u8 fm10k_dcbnl_getdcbx(struct net_device __always_unused *dev)
131{
132 return DCB_CAP_DCBX_HOST | DCB_CAP_DCBX_VER_IEEE;
133}
134
135
136
137
138
139
140
141
142static u8 fm10k_dcbnl_setdcbx(struct net_device __always_unused *dev, u8 mode)
143{
144 return (mode != (DCB_CAP_DCBX_HOST | DCB_CAP_DCBX_VER_IEEE)) ? 1 : 0;
145}
146
147static const struct dcbnl_rtnl_ops fm10k_dcbnl_ops = {
148 .ieee_getets = fm10k_dcbnl_ieee_getets,
149 .ieee_setets = fm10k_dcbnl_ieee_setets,
150 .ieee_getpfc = fm10k_dcbnl_ieee_getpfc,
151 .ieee_setpfc = fm10k_dcbnl_ieee_setpfc,
152
153 .getdcbx = fm10k_dcbnl_getdcbx,
154 .setdcbx = fm10k_dcbnl_setdcbx,
155};
156
157
158
159
160
161
162
163void fm10k_dcbnl_set_ops(struct net_device *dev)
164{
165 struct fm10k_intfc *interface = netdev_priv(dev);
166 struct fm10k_hw *hw = &interface->hw;
167
168 if (hw->mac.type == fm10k_mac_pf)
169 dev->dcbnl_ops = &fm10k_dcbnl_ops;
170}
171