1
2
3
4#include "fm10k.h"
5
6
7
8
9
10
11static int fm10k_dcbnl_ieee_getets(struct net_device *dev, struct ieee_ets *ets)
12{
13 int i;
14
15
16 ets->ets_cap = IEEE_8021QAZ_MAX_TCS;
17 ets->cbs = 0;
18
19
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
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
33
34
35
36static int fm10k_dcbnl_ieee_setets(struct net_device *dev, struct ieee_ets *ets)
37{
38 u8 num_tc = 0;
39 int i;
40
41
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
52 if (num_tc)
53 num_tc++;
54
55 if (num_tc > IEEE_8021QAZ_MAX_TCS)
56 return -EINVAL;
57
58
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
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
74
75
76
77static int fm10k_dcbnl_ieee_getpfc(struct net_device *dev, struct ieee_pfc *pfc)
78{
79 struct fm10k_intfc *interface = netdev_priv(dev);
80
81
82 pfc->pfc_cap = IEEE_8021QAZ_MAX_TCS;
83 pfc->pfc_en = interface->pfc_en;
84
85 return 0;
86}
87
88
89
90
91
92
93static int fm10k_dcbnl_ieee_setpfc(struct net_device *dev, struct ieee_pfc *pfc)
94{
95 struct fm10k_intfc *interface = netdev_priv(dev);
96
97
98 interface->pfc_en = pfc->pfc_en;
99
100
101 if (netif_running(dev))
102 fm10k_update_rx_drop_en(interface);
103
104 return 0;
105}
106
107
108
109
110
111
112
113static 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
120
121
122
123
124
125static 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
130static 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
142
143
144
145
146void 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