Branch data Line data Source code
1 : : // SPDX-License-Identifier: GPL-2.0-only
2 : : /*
3 : : * aQuantia Corporation Network Driver
4 : : * Copyright (C) 2014-2019 aQuantia Corporation. All rights reserved
5 : : */
6 : :
7 : : /* File aq_ethtool.c: Definition of ethertool related functions. */
8 : :
9 : : #include "aq_ethtool.h"
10 : : #include "aq_nic.h"
11 : : #include "aq_vec.h"
12 : : #include "aq_ptp.h"
13 : : #include "aq_filters.h"
14 : :
15 : : #include <linux/ptp_clock_kernel.h>
16 : :
17 : 0 : static void aq_ethtool_get_regs(struct net_device *ndev,
18 : : struct ethtool_regs *regs, void *p)
19 : : {
20 : 0 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
21 : 0 : u32 regs_count;
22 : :
23 : 0 : regs_count = aq_nic_get_regs_count(aq_nic);
24 : :
25 : 0 : memset(p, 0, regs_count * sizeof(u32));
26 : 0 : aq_nic_get_regs(aq_nic, regs, p);
27 : 0 : }
28 : :
29 : 33 : static int aq_ethtool_get_regs_len(struct net_device *ndev)
30 : : {
31 : 33 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
32 : 33 : u32 regs_count;
33 : :
34 : 33 : regs_count = aq_nic_get_regs_count(aq_nic);
35 : :
36 : 33 : return regs_count * sizeof(u32);
37 : : }
38 : :
39 : 0 : static u32 aq_ethtool_get_link(struct net_device *ndev)
40 : : {
41 : 0 : return ethtool_op_get_link(ndev);
42 : : }
43 : :
44 : 0 : static int aq_ethtool_get_link_ksettings(struct net_device *ndev,
45 : : struct ethtool_link_ksettings *cmd)
46 : : {
47 : 0 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
48 : :
49 : 0 : aq_nic_get_link_ksettings(aq_nic, cmd);
50 : 0 : cmd->base.speed = netif_carrier_ok(ndev) ?
51 [ # # ]: 0 : aq_nic_get_link_speed(aq_nic) : 0U;
52 : :
53 : 0 : return 0;
54 : : }
55 : :
56 : : static int
57 : 0 : aq_ethtool_set_link_ksettings(struct net_device *ndev,
58 : : const struct ethtool_link_ksettings *cmd)
59 : : {
60 : 0 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
61 : :
62 : 0 : return aq_nic_set_link_ksettings(aq_nic, cmd);
63 : : }
64 : :
65 : : static const char aq_ethtool_stat_names[][ETH_GSTRING_LEN] = {
66 : : "InPackets",
67 : : "InUCast",
68 : : "InMCast",
69 : : "InBCast",
70 : : "InErrors",
71 : : "OutPackets",
72 : : "OutUCast",
73 : : "OutMCast",
74 : : "OutBCast",
75 : : "InUCastOctets",
76 : : "OutUCastOctets",
77 : : "InMCastOctets",
78 : : "OutMCastOctets",
79 : : "InBCastOctets",
80 : : "OutBCastOctets",
81 : : "InOctets",
82 : : "OutOctets",
83 : : "InPacketsDma",
84 : : "OutPacketsDma",
85 : : "InOctetsDma",
86 : : "OutOctetsDma",
87 : : "InDroppedDma",
88 : : };
89 : :
90 : : static const char aq_ethtool_queue_stat_names[][ETH_GSTRING_LEN] = {
91 : : "Queue[%d] InPackets",
92 : : "Queue[%d] OutPackets",
93 : : "Queue[%d] Restarts",
94 : : "Queue[%d] InJumboPackets",
95 : : "Queue[%d] InLroPackets",
96 : : "Queue[%d] InErrors",
97 : : };
98 : :
99 : : static const char aq_ethtool_priv_flag_names[][ETH_GSTRING_LEN] = {
100 : : "DMASystemLoopback",
101 : : "PKTSystemLoopback",
102 : : "DMANetworkLoopback",
103 : : "PHYInternalLoopback",
104 : : "PHYExternalLoopback",
105 : : };
106 : :
107 : 0 : static void aq_ethtool_stats(struct net_device *ndev,
108 : : struct ethtool_stats *stats, u64 *data)
109 : : {
110 : 0 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
111 : 0 : struct aq_nic_cfg_s *cfg;
112 : :
113 : 0 : cfg = aq_nic_get_cfg(aq_nic);
114 : :
115 : 0 : memset(data, 0, (ARRAY_SIZE(aq_ethtool_stat_names) +
116 : : ARRAY_SIZE(aq_ethtool_queue_stat_names) *
117 : 0 : cfg->vecs) * sizeof(u64));
118 : 0 : aq_nic_get_stats(aq_nic, data);
119 : 0 : }
120 : :
121 : 33 : static void aq_ethtool_get_drvinfo(struct net_device *ndev,
122 : : struct ethtool_drvinfo *drvinfo)
123 : : {
124 : 33 : struct pci_dev *pdev = to_pci_dev(ndev->dev.parent);
125 : 33 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
126 : 33 : struct aq_nic_cfg_s *cfg;
127 : 33 : u32 firmware_version;
128 : 33 : u32 regs_count;
129 : :
130 : 33 : cfg = aq_nic_get_cfg(aq_nic);
131 : 33 : firmware_version = aq_nic_get_fw_version(aq_nic);
132 : 33 : regs_count = aq_nic_get_regs_count(aq_nic);
133 : :
134 : 33 : strlcat(drvinfo->driver, AQ_CFG_DRV_NAME, sizeof(drvinfo->driver));
135 : 33 : strlcat(drvinfo->version, AQ_CFG_DRV_VERSION, sizeof(drvinfo->version));
136 : :
137 : 33 : snprintf(drvinfo->fw_version, sizeof(drvinfo->fw_version),
138 : : "%u.%u.%u", firmware_version >> 24,
139 : 33 : (firmware_version >> 16) & 0xFFU, firmware_version & 0xFFFFU);
140 : :
141 [ + - ]: 66 : strlcpy(drvinfo->bus_info, pdev ? pci_name(pdev) : "",
142 : : sizeof(drvinfo->bus_info));
143 : 33 : drvinfo->n_stats = ARRAY_SIZE(aq_ethtool_stat_names) +
144 : 33 : cfg->vecs * ARRAY_SIZE(aq_ethtool_queue_stat_names);
145 : 33 : drvinfo->testinfo_len = 0;
146 : 33 : drvinfo->regdump_len = regs_count;
147 : 33 : drvinfo->eedump_len = 0;
148 : 33 : }
149 : :
150 : 0 : static void aq_ethtool_get_strings(struct net_device *ndev,
151 : : u32 stringset, u8 *data)
152 : : {
153 : 0 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
154 : 0 : struct aq_nic_cfg_s *cfg;
155 : 0 : u8 *p = data;
156 : 0 : int i, si;
157 : :
158 : 0 : cfg = aq_nic_get_cfg(aq_nic);
159 : :
160 [ # # # ]: 0 : switch (stringset) {
161 : 0 : case ETH_SS_STATS:
162 : 0 : memcpy(p, aq_ethtool_stat_names,
163 : : sizeof(aq_ethtool_stat_names));
164 : 0 : p = p + sizeof(aq_ethtool_stat_names);
165 [ # # ]: 0 : for (i = 0; i < cfg->vecs; i++) {
166 : 0 : for (si = 0;
167 [ # # ]: 0 : si < ARRAY_SIZE(aq_ethtool_queue_stat_names);
168 : 0 : si++) {
169 : 0 : snprintf(p, ETH_GSTRING_LEN,
170 : 0 : aq_ethtool_queue_stat_names[si], i);
171 : 0 : p += ETH_GSTRING_LEN;
172 : : }
173 : : }
174 : : break;
175 : 0 : case ETH_SS_PRIV_FLAGS:
176 : 0 : memcpy(p, aq_ethtool_priv_flag_names,
177 : : sizeof(aq_ethtool_priv_flag_names));
178 : 0 : break;
179 : : }
180 : 0 : }
181 : :
182 : 0 : static int aq_ethtool_set_phys_id(struct net_device *ndev,
183 : : enum ethtool_phys_id_state state)
184 : : {
185 [ # # ]: 0 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
186 : 0 : struct aq_hw_s *hw = aq_nic->aq_hw;
187 : 0 : int ret = 0;
188 : :
189 [ # # ]: 0 : if (!aq_nic->aq_fw_ops->led_control)
190 : : return -EOPNOTSUPP;
191 : :
192 : 0 : mutex_lock(&aq_nic->fwreq_mutex);
193 : :
194 [ # # # ]: 0 : switch (state) {
195 : 0 : case ETHTOOL_ID_ACTIVE:
196 : 0 : ret = aq_nic->aq_fw_ops->led_control(hw, AQ_HW_LED_BLINK |
197 : : AQ_HW_LED_BLINK << 2 | AQ_HW_LED_BLINK << 4);
198 : 0 : break;
199 : 0 : case ETHTOOL_ID_INACTIVE:
200 : 0 : ret = aq_nic->aq_fw_ops->led_control(hw, AQ_HW_LED_DEFAULT);
201 : 0 : break;
202 : : default:
203 : : break;
204 : : }
205 : :
206 : 0 : mutex_unlock(&aq_nic->fwreq_mutex);
207 : :
208 : 0 : return ret;
209 : : }
210 : :
211 : 99 : static int aq_ethtool_get_sset_count(struct net_device *ndev, int stringset)
212 : : {
213 : 99 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
214 : 99 : struct aq_nic_cfg_s *cfg;
215 : 99 : int ret = 0;
216 : :
217 : 99 : cfg = aq_nic_get_cfg(aq_nic);
218 : :
219 [ + + + ]: 99 : switch (stringset) {
220 : 33 : case ETH_SS_STATS:
221 : 33 : ret = ARRAY_SIZE(aq_ethtool_stat_names) +
222 : 33 : cfg->vecs * ARRAY_SIZE(aq_ethtool_queue_stat_names);
223 : 33 : break;
224 : : case ETH_SS_PRIV_FLAGS:
225 : : ret = ARRAY_SIZE(aq_ethtool_priv_flag_names);
226 : : break;
227 : 33 : default:
228 : 33 : ret = -EOPNOTSUPP;
229 : : }
230 : :
231 : 99 : return ret;
232 : : }
233 : :
234 : 0 : static u32 aq_ethtool_get_rss_indir_size(struct net_device *ndev)
235 : : {
236 : 0 : return AQ_CFG_RSS_INDIRECTION_TABLE_MAX;
237 : : }
238 : :
239 : 0 : static u32 aq_ethtool_get_rss_key_size(struct net_device *ndev)
240 : : {
241 : 0 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
242 : 0 : struct aq_nic_cfg_s *cfg;
243 : :
244 : 0 : cfg = aq_nic_get_cfg(aq_nic);
245 : :
246 : 0 : return sizeof(cfg->aq_rss.hash_secret_key);
247 : : }
248 : :
249 : 0 : static int aq_ethtool_get_rss(struct net_device *ndev, u32 *indir, u8 *key,
250 : : u8 *hfunc)
251 : : {
252 : 0 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
253 : 0 : struct aq_nic_cfg_s *cfg;
254 : 0 : unsigned int i = 0U;
255 : :
256 : 0 : cfg = aq_nic_get_cfg(aq_nic);
257 : :
258 [ # # ]: 0 : if (hfunc)
259 : 0 : *hfunc = ETH_RSS_HASH_TOP; /* Toeplitz */
260 [ # # ]: 0 : if (indir) {
261 [ # # ]: 0 : for (i = 0; i < AQ_CFG_RSS_INDIRECTION_TABLE_MAX; i++)
262 : 0 : indir[i] = cfg->aq_rss.indirection_table[i];
263 : : }
264 [ # # ]: 0 : if (key)
265 : 0 : memcpy(key, cfg->aq_rss.hash_secret_key,
266 : : sizeof(cfg->aq_rss.hash_secret_key));
267 : :
268 : 0 : return 0;
269 : : }
270 : :
271 : 0 : static int aq_ethtool_set_rss(struct net_device *netdev, const u32 *indir,
272 : : const u8 *key, const u8 hfunc)
273 : : {
274 : 0 : struct aq_nic_s *aq_nic = netdev_priv(netdev);
275 : 0 : struct aq_nic_cfg_s *cfg;
276 : 0 : unsigned int i = 0U;
277 : 0 : u32 rss_entries;
278 : 0 : int err = 0;
279 : :
280 : 0 : cfg = aq_nic_get_cfg(aq_nic);
281 : 0 : rss_entries = cfg->aq_rss.indirection_table_size;
282 : :
283 : : /* We do not allow change in unsupported parameters */
284 [ # # ]: 0 : if (hfunc != ETH_RSS_HASH_NO_CHANGE && hfunc != ETH_RSS_HASH_TOP)
285 : : return -EOPNOTSUPP;
286 : : /* Fill out the redirection table */
287 [ # # ]: 0 : if (indir)
288 [ # # ]: 0 : for (i = 0; i < rss_entries; i++)
289 : 0 : cfg->aq_rss.indirection_table[i] = indir[i];
290 : :
291 : : /* Fill out the rss hash key */
292 [ # # ]: 0 : if (key) {
293 : 0 : memcpy(cfg->aq_rss.hash_secret_key, key,
294 : : sizeof(cfg->aq_rss.hash_secret_key));
295 : 0 : err = aq_nic->aq_hw_ops->hw_rss_hash_set(aq_nic->aq_hw,
296 : : &cfg->aq_rss);
297 [ # # ]: 0 : if (err)
298 : : return err;
299 : : }
300 : :
301 : 0 : err = aq_nic->aq_hw_ops->hw_rss_set(aq_nic->aq_hw, &cfg->aq_rss);
302 : :
303 : 0 : return err;
304 : : }
305 : :
306 : 0 : static int aq_ethtool_get_rxnfc(struct net_device *ndev,
307 : : struct ethtool_rxnfc *cmd,
308 : : u32 *rule_locs)
309 : : {
310 : 0 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
311 : 0 : struct aq_nic_cfg_s *cfg;
312 : 0 : int err = 0;
313 : :
314 : 0 : cfg = aq_nic_get_cfg(aq_nic);
315 : :
316 [ # # # # : 0 : switch (cmd->cmd) {
# ]
317 : 0 : case ETHTOOL_GRXRINGS:
318 : 0 : cmd->data = cfg->vecs;
319 : 0 : break;
320 : 0 : case ETHTOOL_GRXCLSRLCNT:
321 : 0 : cmd->rule_cnt = aq_get_rxnfc_count_all_rules(aq_nic);
322 : 0 : break;
323 : 0 : case ETHTOOL_GRXCLSRULE:
324 : 0 : err = aq_get_rxnfc_rule(aq_nic, cmd);
325 : 0 : break;
326 : 0 : case ETHTOOL_GRXCLSRLALL:
327 : 0 : err = aq_get_rxnfc_all_rules(aq_nic, cmd, rule_locs);
328 : 0 : break;
329 : : default:
330 : : err = -EOPNOTSUPP;
331 : : break;
332 : : }
333 : :
334 : 0 : return err;
335 : : }
336 : :
337 : 0 : static int aq_ethtool_set_rxnfc(struct net_device *ndev,
338 : : struct ethtool_rxnfc *cmd)
339 : : {
340 [ # # # ]: 0 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
341 : 0 : int err = 0;
342 : :
343 [ # # # ]: 0 : switch (cmd->cmd) {
344 : 0 : case ETHTOOL_SRXCLSRLINS:
345 : 0 : err = aq_add_rxnfc_rule(aq_nic, cmd);
346 : 0 : break;
347 : 0 : case ETHTOOL_SRXCLSRLDEL:
348 : 0 : err = aq_del_rxnfc_rule(aq_nic, cmd);
349 : 0 : break;
350 : : default:
351 : : err = -EOPNOTSUPP;
352 : : break;
353 : : }
354 : :
355 : 0 : return err;
356 : : }
357 : :
358 : 0 : static int aq_ethtool_get_coalesce(struct net_device *ndev,
359 : : struct ethtool_coalesce *coal)
360 : : {
361 : 0 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
362 : 0 : struct aq_nic_cfg_s *cfg;
363 : :
364 : 0 : cfg = aq_nic_get_cfg(aq_nic);
365 : :
366 [ # # # # ]: 0 : if (cfg->itr == AQ_CFG_INTERRUPT_MODERATION_ON ||
367 : : cfg->itr == AQ_CFG_INTERRUPT_MODERATION_AUTO) {
368 : 0 : coal->rx_coalesce_usecs = cfg->rx_itr;
369 : 0 : coal->tx_coalesce_usecs = cfg->tx_itr;
370 : 0 : coal->rx_max_coalesced_frames = 0;
371 : 0 : coal->tx_max_coalesced_frames = 0;
372 : : } else {
373 : 0 : coal->rx_coalesce_usecs = 0;
374 : 0 : coal->tx_coalesce_usecs = 0;
375 : 0 : coal->rx_max_coalesced_frames = 1;
376 : 0 : coal->tx_max_coalesced_frames = 1;
377 : : }
378 : :
379 : 0 : return 0;
380 : : }
381 : :
382 : 0 : static int aq_ethtool_set_coalesce(struct net_device *ndev,
383 : : struct ethtool_coalesce *coal)
384 : : {
385 : 0 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
386 : 0 : struct aq_nic_cfg_s *cfg;
387 : :
388 : 0 : cfg = aq_nic_get_cfg(aq_nic);
389 : :
390 : : /* This is not yet supported
391 : : */
392 [ # # # # ]: 0 : if (coal->use_adaptive_rx_coalesce || coal->use_adaptive_tx_coalesce)
393 : : return -EOPNOTSUPP;
394 : :
395 : : /* Atlantic only supports timing based coalescing
396 : : */
397 [ # # ]: 0 : if (coal->rx_max_coalesced_frames > 1 ||
398 [ # # ]: 0 : coal->rx_coalesce_usecs_irq ||
399 [ # # ]: 0 : coal->rx_max_coalesced_frames_irq)
400 : : return -EOPNOTSUPP;
401 : :
402 [ # # ]: 0 : if (coal->tx_max_coalesced_frames > 1 ||
403 [ # # ]: 0 : coal->tx_coalesce_usecs_irq ||
404 [ # # ]: 0 : coal->tx_max_coalesced_frames_irq)
405 : : return -EOPNOTSUPP;
406 : :
407 : : /* We do not support frame counting. Check this
408 : : */
409 [ # # ]: 0 : if (!(coal->rx_max_coalesced_frames == !coal->rx_coalesce_usecs))
410 : : return -EOPNOTSUPP;
411 [ # # ]: 0 : if (!(coal->tx_max_coalesced_frames == !coal->tx_coalesce_usecs))
412 : : return -EOPNOTSUPP;
413 : :
414 [ # # # # ]: 0 : if (coal->rx_coalesce_usecs > AQ_CFG_INTERRUPT_MODERATION_USEC_MAX ||
415 : : coal->tx_coalesce_usecs > AQ_CFG_INTERRUPT_MODERATION_USEC_MAX)
416 : : return -EINVAL;
417 : :
418 : 0 : cfg->itr = AQ_CFG_INTERRUPT_MODERATION_ON;
419 : :
420 : 0 : cfg->rx_itr = coal->rx_coalesce_usecs;
421 : 0 : cfg->tx_itr = coal->tx_coalesce_usecs;
422 : :
423 : 0 : return aq_nic_update_interrupt_moderation_settings(aq_nic);
424 : : }
425 : :
426 : 0 : static void aq_ethtool_get_wol(struct net_device *ndev,
427 : : struct ethtool_wolinfo *wol)
428 : : {
429 : 0 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
430 : 0 : struct aq_nic_cfg_s *cfg;
431 : :
432 : 0 : cfg = aq_nic_get_cfg(aq_nic);
433 : :
434 : 0 : wol->supported = AQ_NIC_WOL_MODES;
435 : 0 : wol->wolopts = cfg->wol;
436 : 0 : }
437 : :
438 : 0 : static int aq_ethtool_set_wol(struct net_device *ndev,
439 : : struct ethtool_wolinfo *wol)
440 : : {
441 : 0 : struct pci_dev *pdev = to_pci_dev(ndev->dev.parent);
442 : 0 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
443 : 0 : struct aq_nic_cfg_s *cfg;
444 : 0 : int err = 0;
445 : :
446 : 0 : cfg = aq_nic_get_cfg(aq_nic);
447 : :
448 [ # # ]: 0 : if (wol->wolopts & ~AQ_NIC_WOL_MODES)
449 : : return -EOPNOTSUPP;
450 : :
451 : 0 : cfg->wol = wol->wolopts;
452 : :
453 : 0 : err = device_set_wakeup_enable(&pdev->dev, !!cfg->wol);
454 : :
455 : 0 : return err;
456 : : }
457 : :
458 : 0 : static int aq_ethtool_get_ts_info(struct net_device *ndev,
459 : : struct ethtool_ts_info *info)
460 : : {
461 : 0 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
462 : :
463 : 0 : ethtool_op_get_ts_info(ndev, info);
464 : :
465 [ # # ]: 0 : if (!aq_nic->aq_ptp)
466 : : return 0;
467 : :
468 : 0 : info->so_timestamping |=
469 : : SOF_TIMESTAMPING_TX_HARDWARE |
470 : : SOF_TIMESTAMPING_RX_HARDWARE |
471 : : SOF_TIMESTAMPING_RAW_HARDWARE;
472 : :
473 : 0 : info->tx_types = BIT(HWTSTAMP_TX_OFF) |
474 : : BIT(HWTSTAMP_TX_ON);
475 : :
476 : 0 : info->rx_filters = BIT(HWTSTAMP_FILTER_NONE);
477 : :
478 : 0 : info->rx_filters |= BIT(HWTSTAMP_FILTER_PTP_V2_L4_EVENT) |
479 : : BIT(HWTSTAMP_FILTER_PTP_V2_L2_EVENT) |
480 : : BIT(HWTSTAMP_FILTER_PTP_V2_EVENT);
481 : :
482 : 0 : info->phc_index = ptp_clock_index(aq_ptp_get_ptp_clock(aq_nic->aq_ptp));
483 : :
484 : 0 : return 0;
485 : : }
486 : :
487 : 0 : static enum hw_atl_fw2x_rate eee_mask_to_ethtool_mask(u32 speed)
488 : : {
489 : 0 : u32 rate = 0;
490 : :
491 : 0 : if (speed & AQ_NIC_RATE_EEE_10G)
492 : 0 : rate |= SUPPORTED_10000baseT_Full;
493 : :
494 [ # # # # ]: 0 : if (speed & AQ_NIC_RATE_EEE_2GS)
495 : 0 : rate |= SUPPORTED_2500baseX_Full;
496 : :
497 [ # # # # ]: 0 : if (speed & AQ_NIC_RATE_EEE_1G)
498 : 0 : rate |= SUPPORTED_1000baseT_Full;
499 : :
500 : 0 : return rate;
501 : : }
502 : :
503 : 0 : static int aq_ethtool_get_eee(struct net_device *ndev, struct ethtool_eee *eee)
504 : : {
505 [ # # ]: 0 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
506 : 0 : u32 rate, supported_rates;
507 : 0 : int err = 0;
508 : :
509 [ # # ]: 0 : if (!aq_nic->aq_fw_ops->get_eee_rate)
510 : : return -EOPNOTSUPP;
511 : :
512 : 0 : mutex_lock(&aq_nic->fwreq_mutex);
513 : 0 : err = aq_nic->aq_fw_ops->get_eee_rate(aq_nic->aq_hw, &rate,
514 : : &supported_rates);
515 : 0 : mutex_unlock(&aq_nic->fwreq_mutex);
516 [ # # ]: 0 : if (err < 0)
517 : : return err;
518 : :
519 [ # # ]: 0 : eee->supported = eee_mask_to_ethtool_mask(supported_rates);
520 : :
521 [ # # ]: 0 : if (aq_nic->aq_nic_cfg.eee_speeds)
522 : 0 : eee->advertised = eee->supported;
523 : :
524 [ # # ]: 0 : eee->lp_advertised = eee_mask_to_ethtool_mask(rate);
525 : :
526 : 0 : eee->eee_enabled = !!eee->advertised;
527 : :
528 : 0 : eee->tx_lpi_enabled = eee->eee_enabled;
529 [ # # ]: 0 : if (eee->advertised & eee->lp_advertised)
530 : 0 : eee->eee_active = true;
531 : :
532 : : return 0;
533 : : }
534 : :
535 : 0 : static int aq_ethtool_set_eee(struct net_device *ndev, struct ethtool_eee *eee)
536 : : {
537 : 0 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
538 : 0 : u32 rate, supported_rates;
539 : 0 : struct aq_nic_cfg_s *cfg;
540 : 0 : int err = 0;
541 : :
542 : 0 : cfg = aq_nic_get_cfg(aq_nic);
543 : :
544 [ # # # # ]: 0 : if (unlikely(!aq_nic->aq_fw_ops->get_eee_rate ||
545 : : !aq_nic->aq_fw_ops->set_eee_rate))
546 : : return -EOPNOTSUPP;
547 : :
548 : 0 : mutex_lock(&aq_nic->fwreq_mutex);
549 : 0 : err = aq_nic->aq_fw_ops->get_eee_rate(aq_nic->aq_hw, &rate,
550 : : &supported_rates);
551 : 0 : mutex_unlock(&aq_nic->fwreq_mutex);
552 [ # # ]: 0 : if (err < 0)
553 : : return err;
554 : :
555 [ # # ]: 0 : if (eee->eee_enabled) {
556 : 0 : rate = supported_rates;
557 : 0 : cfg->eee_speeds = rate;
558 : : } else {
559 : 0 : rate = 0;
560 : 0 : cfg->eee_speeds = 0;
561 : : }
562 : :
563 : 0 : mutex_lock(&aq_nic->fwreq_mutex);
564 : 0 : err = aq_nic->aq_fw_ops->set_eee_rate(aq_nic->aq_hw, rate);
565 : 0 : mutex_unlock(&aq_nic->fwreq_mutex);
566 : :
567 : 0 : return err;
568 : : }
569 : :
570 : 0 : static int aq_ethtool_nway_reset(struct net_device *ndev)
571 : : {
572 [ # # ]: 0 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
573 : 0 : int err = 0;
574 : :
575 [ # # ]: 0 : if (unlikely(!aq_nic->aq_fw_ops->renegotiate))
576 : : return -EOPNOTSUPP;
577 : :
578 [ # # ]: 0 : if (netif_running(ndev)) {
579 : 0 : mutex_lock(&aq_nic->fwreq_mutex);
580 : 0 : err = aq_nic->aq_fw_ops->renegotiate(aq_nic->aq_hw);
581 : 0 : mutex_unlock(&aq_nic->fwreq_mutex);
582 : : }
583 : :
584 : : return err;
585 : : }
586 : :
587 : 0 : static void aq_ethtool_get_pauseparam(struct net_device *ndev,
588 : : struct ethtool_pauseparam *pause)
589 : : {
590 : 0 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
591 : 0 : u32 fc = aq_nic->aq_nic_cfg.fc.req;
592 : :
593 : 0 : pause->autoneg = 0;
594 : :
595 : 0 : pause->rx_pause = !!(fc & AQ_NIC_FC_RX);
596 : 0 : pause->tx_pause = !!(fc & AQ_NIC_FC_TX);
597 : :
598 : 0 : }
599 : :
600 : 0 : static int aq_ethtool_set_pauseparam(struct net_device *ndev,
601 : : struct ethtool_pauseparam *pause)
602 : : {
603 [ # # ]: 0 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
604 : 0 : int err = 0;
605 : :
606 [ # # ]: 0 : if (!aq_nic->aq_fw_ops->set_flow_control)
607 : : return -EOPNOTSUPP;
608 : :
609 [ # # ]: 0 : if (pause->autoneg == AUTONEG_ENABLE)
610 : : return -EOPNOTSUPP;
611 : :
612 [ # # ]: 0 : if (pause->rx_pause)
613 : 0 : aq_nic->aq_hw->aq_nic_cfg->fc.req |= AQ_NIC_FC_RX;
614 : : else
615 : 0 : aq_nic->aq_hw->aq_nic_cfg->fc.req &= ~AQ_NIC_FC_RX;
616 : :
617 [ # # ]: 0 : if (pause->tx_pause)
618 : 0 : aq_nic->aq_hw->aq_nic_cfg->fc.req |= AQ_NIC_FC_TX;
619 : : else
620 : 0 : aq_nic->aq_hw->aq_nic_cfg->fc.req &= ~AQ_NIC_FC_TX;
621 : :
622 : 0 : mutex_lock(&aq_nic->fwreq_mutex);
623 : 0 : err = aq_nic->aq_fw_ops->set_flow_control(aq_nic->aq_hw);
624 : 0 : mutex_unlock(&aq_nic->fwreq_mutex);
625 : :
626 : 0 : return err;
627 : : }
628 : :
629 : 0 : static void aq_get_ringparam(struct net_device *ndev,
630 : : struct ethtool_ringparam *ring)
631 : : {
632 : 0 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
633 : 0 : struct aq_nic_cfg_s *cfg;
634 : :
635 : 0 : cfg = aq_nic_get_cfg(aq_nic);
636 : :
637 : 0 : ring->rx_pending = cfg->rxds;
638 : 0 : ring->tx_pending = cfg->txds;
639 : :
640 : 0 : ring->rx_max_pending = cfg->aq_hw_caps->rxds_max;
641 : 0 : ring->tx_max_pending = cfg->aq_hw_caps->txds_max;
642 : 0 : }
643 : :
644 : 0 : static int aq_set_ringparam(struct net_device *ndev,
645 : : struct ethtool_ringparam *ring)
646 : : {
647 : 0 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
648 : 0 : const struct aq_hw_caps_s *hw_caps;
649 : 0 : bool ndev_running = false;
650 : 0 : struct aq_nic_cfg_s *cfg;
651 : 0 : int err = 0;
652 : :
653 : 0 : cfg = aq_nic_get_cfg(aq_nic);
654 : 0 : hw_caps = cfg->aq_hw_caps;
655 : :
656 [ # # # # ]: 0 : if (ring->rx_mini_pending || ring->rx_jumbo_pending) {
657 : 0 : err = -EOPNOTSUPP;
658 : 0 : goto err_exit;
659 : : }
660 : :
661 [ # # ]: 0 : if (netif_running(ndev)) {
662 : 0 : ndev_running = true;
663 : 0 : dev_close(ndev);
664 : : }
665 : :
666 : 0 : aq_nic_free_vectors(aq_nic);
667 : :
668 : 0 : cfg->rxds = max(ring->rx_pending, hw_caps->rxds_min);
669 : 0 : cfg->rxds = min(cfg->rxds, hw_caps->rxds_max);
670 : 0 : cfg->rxds = ALIGN(cfg->rxds, AQ_HW_RXD_MULTIPLE);
671 : :
672 : 0 : cfg->txds = max(ring->tx_pending, hw_caps->txds_min);
673 : 0 : cfg->txds = min(cfg->txds, hw_caps->txds_max);
674 : 0 : cfg->txds = ALIGN(cfg->txds, AQ_HW_TXD_MULTIPLE);
675 : :
676 [ # # ]: 0 : for (aq_nic->aq_vecs = 0; aq_nic->aq_vecs < cfg->vecs;
677 : 0 : aq_nic->aq_vecs++) {
678 : 0 : aq_nic->aq_vec[aq_nic->aq_vecs] =
679 : 0 : aq_vec_alloc(aq_nic, aq_nic->aq_vecs, cfg);
680 [ # # ]: 0 : if (unlikely(!aq_nic->aq_vec[aq_nic->aq_vecs])) {
681 : 0 : err = -ENOMEM;
682 : 0 : goto err_exit;
683 : : }
684 : : }
685 [ # # ]: 0 : if (ndev_running)
686 : 0 : err = dev_open(ndev, NULL);
687 : :
688 : 0 : err_exit:
689 : 0 : return err;
690 : : }
691 : :
692 : 0 : static u32 aq_get_msg_level(struct net_device *ndev)
693 : : {
694 : 0 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
695 : :
696 : 0 : return aq_nic->msg_enable;
697 : : }
698 : :
699 : 0 : static void aq_set_msg_level(struct net_device *ndev, u32 data)
700 : : {
701 : 0 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
702 : :
703 : 0 : aq_nic->msg_enable = data;
704 : 0 : }
705 : :
706 : 0 : static u32 aq_ethtool_get_priv_flags(struct net_device *ndev)
707 : : {
708 : 0 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
709 : :
710 : 0 : return aq_nic->aq_nic_cfg.priv_flags;
711 : : }
712 : :
713 : 0 : static int aq_ethtool_set_priv_flags(struct net_device *ndev, u32 flags)
714 : : {
715 : 0 : struct aq_nic_s *aq_nic = netdev_priv(ndev);
716 : 0 : struct aq_nic_cfg_s *cfg;
717 : 0 : u32 priv_flags;
718 : :
719 : 0 : cfg = aq_nic_get_cfg(aq_nic);
720 : 0 : priv_flags = cfg->priv_flags;
721 : :
722 [ # # ]: 0 : if (flags & ~AQ_PRIV_FLAGS_MASK)
723 : : return -EOPNOTSUPP;
724 : :
725 [ # # # # ]: 0 : if (hweight32((flags | priv_flags) & AQ_HW_LOOPBACK_MASK) > 1) {
726 : 0 : netdev_info(ndev, "Can't enable more than one loopback simultaneously\n");
727 : 0 : return -EINVAL;
728 : : }
729 : :
730 : 0 : cfg->priv_flags = flags;
731 : :
732 [ # # ]: 0 : if ((priv_flags ^ flags) & BIT(AQ_HW_LOOPBACK_DMA_NET)) {
733 [ # # ]: 0 : if (netif_running(ndev)) {
734 : 0 : dev_close(ndev);
735 : :
736 : 0 : dev_open(ndev, NULL);
737 : : }
738 [ # # ]: 0 : } else if ((priv_flags ^ flags) & AQ_HW_LOOPBACK_MASK) {
739 : 0 : aq_nic_set_loopback(aq_nic);
740 : : }
741 : :
742 : : return 0;
743 : : }
744 : :
745 : : const struct ethtool_ops aq_ethtool_ops = {
746 : : .get_link = aq_ethtool_get_link,
747 : : .get_regs_len = aq_ethtool_get_regs_len,
748 : : .get_regs = aq_ethtool_get_regs,
749 : : .get_drvinfo = aq_ethtool_get_drvinfo,
750 : : .get_strings = aq_ethtool_get_strings,
751 : : .set_phys_id = aq_ethtool_set_phys_id,
752 : : .get_rxfh_indir_size = aq_ethtool_get_rss_indir_size,
753 : : .get_wol = aq_ethtool_get_wol,
754 : : .set_wol = aq_ethtool_set_wol,
755 : : .nway_reset = aq_ethtool_nway_reset,
756 : : .get_ringparam = aq_get_ringparam,
757 : : .set_ringparam = aq_set_ringparam,
758 : : .get_eee = aq_ethtool_get_eee,
759 : : .set_eee = aq_ethtool_set_eee,
760 : : .get_pauseparam = aq_ethtool_get_pauseparam,
761 : : .set_pauseparam = aq_ethtool_set_pauseparam,
762 : : .get_rxfh_key_size = aq_ethtool_get_rss_key_size,
763 : : .get_rxfh = aq_ethtool_get_rss,
764 : : .set_rxfh = aq_ethtool_set_rss,
765 : : .get_rxnfc = aq_ethtool_get_rxnfc,
766 : : .set_rxnfc = aq_ethtool_set_rxnfc,
767 : : .get_msglevel = aq_get_msg_level,
768 : : .set_msglevel = aq_set_msg_level,
769 : : .get_sset_count = aq_ethtool_get_sset_count,
770 : : .get_ethtool_stats = aq_ethtool_stats,
771 : : .get_priv_flags = aq_ethtool_get_priv_flags,
772 : : .set_priv_flags = aq_ethtool_set_priv_flags,
773 : : .get_link_ksettings = aq_ethtool_get_link_ksettings,
774 : : .set_link_ksettings = aq_ethtool_set_link_ksettings,
775 : : .get_coalesce = aq_ethtool_get_coalesce,
776 : : .set_coalesce = aq_ethtool_set_coalesce,
777 : : .get_ts_info = aq_ethtool_get_ts_info,
778 : : };
|
