1
2
3
4
5
6
7
8
9
10
11
12#include "aq_ethtool.h"
13#include "aq_nic.h"
14
15static void aq_ethtool_get_regs(struct net_device *ndev,
16 struct ethtool_regs *regs, void *p)
17{
18 struct aq_nic_s *aq_nic = netdev_priv(ndev);
19 u32 regs_count = aq_nic_get_regs_count(aq_nic);
20
21 memset(p, 0, regs_count * sizeof(u32));
22 aq_nic_get_regs(aq_nic, regs, p);
23}
24
25static int aq_ethtool_get_regs_len(struct net_device *ndev)
26{
27 struct aq_nic_s *aq_nic = netdev_priv(ndev);
28 u32 regs_count = aq_nic_get_regs_count(aq_nic);
29
30 return regs_count * sizeof(u32);
31}
32
33static u32 aq_ethtool_get_link(struct net_device *ndev)
34{
35 return ethtool_op_get_link(ndev);
36}
37
38static int aq_ethtool_get_link_ksettings(struct net_device *ndev,
39 struct ethtool_link_ksettings *cmd)
40{
41 struct aq_nic_s *aq_nic = netdev_priv(ndev);
42
43 aq_nic_get_link_ksettings(aq_nic, cmd);
44 cmd->base.speed = netif_carrier_ok(ndev) ?
45 aq_nic_get_link_speed(aq_nic) : 0U;
46
47 return 0;
48}
49
50static int
51aq_ethtool_set_link_ksettings(struct net_device *ndev,
52 const struct ethtool_link_ksettings *cmd)
53{
54 struct aq_nic_s *aq_nic = netdev_priv(ndev);
55
56 return aq_nic_set_link_ksettings(aq_nic, cmd);
57}
58
59
60static const unsigned int aq_ethtool_stat_queue_lines = 5U;
61static const unsigned int aq_ethtool_stat_queue_chars =
62 5U * ETH_GSTRING_LEN;
63static const char aq_ethtool_stat_names[][ETH_GSTRING_LEN] = {
64 "InPackets",
65 "InUCast",
66 "InMCast",
67 "InBCast",
68 "InErrors",
69 "OutPackets",
70 "OutUCast",
71 "OutMCast",
72 "OutBCast",
73 "InUCastOctects",
74 "OutUCastOctects",
75 "InMCastOctects",
76 "OutMCastOctects",
77 "InBCastOctects",
78 "OutBCastOctects",
79 "InOctects",
80 "OutOctects",
81 "InPacketsDma",
82 "OutPacketsDma",
83 "InOctetsDma",
84 "OutOctetsDma",
85 "InDroppedDma",
86 "Queue[0] InPackets",
87 "Queue[0] OutPackets",
88 "Queue[0] InJumboPackets",
89 "Queue[0] InLroPackets",
90 "Queue[0] InErrors",
91 "Queue[1] InPackets",
92 "Queue[1] OutPackets",
93 "Queue[1] InJumboPackets",
94 "Queue[1] InLroPackets",
95 "Queue[1] InErrors",
96 "Queue[2] InPackets",
97 "Queue[2] OutPackets",
98 "Queue[2] InJumboPackets",
99 "Queue[2] InLroPackets",
100 "Queue[2] InErrors",
101 "Queue[3] InPackets",
102 "Queue[3] OutPackets",
103 "Queue[3] InJumboPackets",
104 "Queue[3] InLroPackets",
105 "Queue[3] InErrors",
106 "Queue[4] InPackets",
107 "Queue[4] OutPackets",
108 "Queue[4] InJumboPackets",
109 "Queue[4] InLroPackets",
110 "Queue[4] InErrors",
111 "Queue[5] InPackets",
112 "Queue[5] OutPackets",
113 "Queue[5] InJumboPackets",
114 "Queue[5] InLroPackets",
115 "Queue[5] InErrors",
116 "Queue[6] InPackets",
117 "Queue[6] OutPackets",
118 "Queue[6] InJumboPackets",
119 "Queue[6] InLroPackets",
120 "Queue[6] InErrors",
121 "Queue[7] InPackets",
122 "Queue[7] OutPackets",
123 "Queue[7] InJumboPackets",
124 "Queue[7] InLroPackets",
125 "Queue[7] InErrors",
126};
127
128static void aq_ethtool_stats(struct net_device *ndev,
129 struct ethtool_stats *stats, u64 *data)
130{
131 struct aq_nic_s *aq_nic = netdev_priv(ndev);
132
133
134 BUILD_BUG_ON(AQ_CFG_VECS_MAX > 8);
135 memset(data, 0, ARRAY_SIZE(aq_ethtool_stat_names) * sizeof(u64));
136 aq_nic_get_stats(aq_nic, data);
137}
138
139static void aq_ethtool_get_drvinfo(struct net_device *ndev,
140 struct ethtool_drvinfo *drvinfo)
141{
142 struct aq_nic_s *aq_nic = netdev_priv(ndev);
143 struct aq_nic_cfg_s *cfg = aq_nic_get_cfg(aq_nic);
144 struct pci_dev *pdev = to_pci_dev(ndev->dev.parent);
145 u32 firmware_version = aq_nic_get_fw_version(aq_nic);
146 u32 regs_count = aq_nic_get_regs_count(aq_nic);
147
148 strlcat(drvinfo->driver, AQ_CFG_DRV_NAME, sizeof(drvinfo->driver));
149 strlcat(drvinfo->version, AQ_CFG_DRV_VERSION, sizeof(drvinfo->version));
150
151 snprintf(drvinfo->fw_version, sizeof(drvinfo->fw_version),
152 "%u.%u.%u", firmware_version >> 24,
153 (firmware_version >> 16) & 0xFFU, firmware_version & 0xFFFFU);
154
155 strlcpy(drvinfo->bus_info, pdev ? pci_name(pdev) : "",
156 sizeof(drvinfo->bus_info));
157 drvinfo->n_stats = ARRAY_SIZE(aq_ethtool_stat_names) -
158 (AQ_CFG_VECS_MAX - cfg->vecs) * aq_ethtool_stat_queue_lines;
159 drvinfo->testinfo_len = 0;
160 drvinfo->regdump_len = regs_count;
161 drvinfo->eedump_len = 0;
162}
163
164static void aq_ethtool_get_strings(struct net_device *ndev,
165 u32 stringset, u8 *data)
166{
167 struct aq_nic_s *aq_nic = netdev_priv(ndev);
168 struct aq_nic_cfg_s *cfg = aq_nic_get_cfg(aq_nic);
169
170 if (stringset == ETH_SS_STATS)
171 memcpy(data, *aq_ethtool_stat_names,
172 sizeof(aq_ethtool_stat_names) -
173 (AQ_CFG_VECS_MAX - cfg->vecs) *
174 aq_ethtool_stat_queue_chars);
175}
176
177static int aq_ethtool_get_sset_count(struct net_device *ndev, int stringset)
178{
179 int ret = 0;
180 struct aq_nic_s *aq_nic = netdev_priv(ndev);
181 struct aq_nic_cfg_s *cfg = aq_nic_get_cfg(aq_nic);
182
183 switch (stringset) {
184 case ETH_SS_STATS:
185 ret = ARRAY_SIZE(aq_ethtool_stat_names) -
186 (AQ_CFG_VECS_MAX - cfg->vecs) *
187 aq_ethtool_stat_queue_lines;
188 break;
189 default:
190 ret = -EOPNOTSUPP;
191 }
192 return ret;
193}
194
195static u32 aq_ethtool_get_rss_indir_size(struct net_device *ndev)
196{
197 return AQ_CFG_RSS_INDIRECTION_TABLE_MAX;
198}
199
200static u32 aq_ethtool_get_rss_key_size(struct net_device *ndev)
201{
202 struct aq_nic_s *aq_nic = netdev_priv(ndev);
203 struct aq_nic_cfg_s *cfg = aq_nic_get_cfg(aq_nic);
204
205 return sizeof(cfg->aq_rss.hash_secret_key);
206}
207
208static int aq_ethtool_get_rss(struct net_device *ndev, u32 *indir, u8 *key,
209 u8 *hfunc)
210{
211 struct aq_nic_s *aq_nic = netdev_priv(ndev);
212 struct aq_nic_cfg_s *cfg = aq_nic_get_cfg(aq_nic);
213 unsigned int i = 0U;
214
215 if (hfunc)
216 *hfunc = ETH_RSS_HASH_TOP;
217 if (indir) {
218 for (i = 0; i < AQ_CFG_RSS_INDIRECTION_TABLE_MAX; i++)
219 indir[i] = cfg->aq_rss.indirection_table[i];
220 }
221 if (key)
222 memcpy(key, cfg->aq_rss.hash_secret_key,
223 sizeof(cfg->aq_rss.hash_secret_key));
224 return 0;
225}
226
227static int aq_ethtool_get_rxnfc(struct net_device *ndev,
228 struct ethtool_rxnfc *cmd,
229 u32 *rule_locs)
230{
231 struct aq_nic_s *aq_nic = netdev_priv(ndev);
232 struct aq_nic_cfg_s *cfg = aq_nic_get_cfg(aq_nic);
233 int err = 0;
234
235 switch (cmd->cmd) {
236 case ETHTOOL_GRXRINGS:
237 cmd->data = cfg->vecs;
238 break;
239
240 default:
241 err = -EOPNOTSUPP;
242 break;
243 }
244
245 return err;
246}
247
248const struct ethtool_ops aq_ethtool_ops = {
249 .get_link = aq_ethtool_get_link,
250 .get_regs_len = aq_ethtool_get_regs_len,
251 .get_regs = aq_ethtool_get_regs,
252 .get_drvinfo = aq_ethtool_get_drvinfo,
253 .get_strings = aq_ethtool_get_strings,
254 .get_rxfh_indir_size = aq_ethtool_get_rss_indir_size,
255 .get_rxfh_key_size = aq_ethtool_get_rss_key_size,
256 .get_rxfh = aq_ethtool_get_rss,
257 .get_rxnfc = aq_ethtool_get_rxnfc,
258 .get_sset_count = aq_ethtool_get_sset_count,
259 .get_ethtool_stats = aq_ethtool_stats,
260 .get_link_ksettings = aq_ethtool_get_link_ksettings,
261 .set_link_ksettings = aq_ethtool_set_link_ksettings,
262};
263
