1 /****************************************************************************
2 * Driver for Solarflare Solarstorm network controllers and boards
3 * Copyright 2005-2006 Fen Systems Ltd.
4 * Copyright 2006-2010 Solarflare Communications Inc.
6 * This program is free software; you can redistribute it and/or modify it
7 * under the terms of the GNU General Public License version 2 as published
8 * by the Free Software Foundation, incorporated herein by reference.
11 #include <linux/netdevice.h>
12 #include <linux/ethtool.h>
13 #include <linux/rtnetlink.h>
15 #include "net_driver.h"
16 #include "workarounds.h"
22 struct efx_ethtool_stat
{
25 EFX_ETHTOOL_STAT_SOURCE_mac_stats
,
26 EFX_ETHTOOL_STAT_SOURCE_nic
,
27 EFX_ETHTOOL_STAT_SOURCE_channel
,
28 EFX_ETHTOOL_STAT_SOURCE_tx_queue
31 u64(*get_stat
) (void *field
); /* Reader function */
34 /* Initialiser for a struct #efx_ethtool_stat with type-checking */
35 #define EFX_ETHTOOL_STAT(stat_name, source_name, field, field_type, \
36 get_stat_function) { \
38 .source = EFX_ETHTOOL_STAT_SOURCE_##source_name, \
39 .offset = ((((field_type *) 0) == \
40 &((struct efx_##source_name *)0)->field) ? \
41 offsetof(struct efx_##source_name, field) : \
42 offsetof(struct efx_##source_name, field)), \
43 .get_stat = get_stat_function, \
46 static u64
efx_get_uint_stat(void *field
)
48 return *(unsigned int *)field
;
51 static u64
efx_get_u64_stat(void *field
)
53 return *(u64
*) field
;
56 static u64
efx_get_atomic_stat(void *field
)
58 return atomic_read((atomic_t
*) field
);
61 #define EFX_ETHTOOL_U64_MAC_STAT(field) \
62 EFX_ETHTOOL_STAT(field, mac_stats, field, \
63 u64, efx_get_u64_stat)
65 #define EFX_ETHTOOL_UINT_NIC_STAT(name) \
66 EFX_ETHTOOL_STAT(name, nic, n_##name, \
67 unsigned int, efx_get_uint_stat)
69 #define EFX_ETHTOOL_ATOMIC_NIC_ERROR_STAT(field) \
70 EFX_ETHTOOL_STAT(field, nic, field, \
71 atomic_t, efx_get_atomic_stat)
73 #define EFX_ETHTOOL_UINT_CHANNEL_STAT(field) \
74 EFX_ETHTOOL_STAT(field, channel, n_##field, \
75 unsigned int, efx_get_uint_stat)
77 #define EFX_ETHTOOL_UINT_TXQ_STAT(field) \
78 EFX_ETHTOOL_STAT(tx_##field, tx_queue, field, \
79 unsigned int, efx_get_uint_stat)
81 static const struct efx_ethtool_stat efx_ethtool_stats
[] = {
82 EFX_ETHTOOL_U64_MAC_STAT(tx_bytes
),
83 EFX_ETHTOOL_U64_MAC_STAT(tx_good_bytes
),
84 EFX_ETHTOOL_U64_MAC_STAT(tx_bad_bytes
),
85 EFX_ETHTOOL_U64_MAC_STAT(tx_packets
),
86 EFX_ETHTOOL_U64_MAC_STAT(tx_bad
),
87 EFX_ETHTOOL_U64_MAC_STAT(tx_pause
),
88 EFX_ETHTOOL_U64_MAC_STAT(tx_control
),
89 EFX_ETHTOOL_U64_MAC_STAT(tx_unicast
),
90 EFX_ETHTOOL_U64_MAC_STAT(tx_multicast
),
91 EFX_ETHTOOL_U64_MAC_STAT(tx_broadcast
),
92 EFX_ETHTOOL_U64_MAC_STAT(tx_lt64
),
93 EFX_ETHTOOL_U64_MAC_STAT(tx_64
),
94 EFX_ETHTOOL_U64_MAC_STAT(tx_65_to_127
),
95 EFX_ETHTOOL_U64_MAC_STAT(tx_128_to_255
),
96 EFX_ETHTOOL_U64_MAC_STAT(tx_256_to_511
),
97 EFX_ETHTOOL_U64_MAC_STAT(tx_512_to_1023
),
98 EFX_ETHTOOL_U64_MAC_STAT(tx_1024_to_15xx
),
99 EFX_ETHTOOL_U64_MAC_STAT(tx_15xx_to_jumbo
),
100 EFX_ETHTOOL_U64_MAC_STAT(tx_gtjumbo
),
101 EFX_ETHTOOL_U64_MAC_STAT(tx_collision
),
102 EFX_ETHTOOL_U64_MAC_STAT(tx_single_collision
),
103 EFX_ETHTOOL_U64_MAC_STAT(tx_multiple_collision
),
104 EFX_ETHTOOL_U64_MAC_STAT(tx_excessive_collision
),
105 EFX_ETHTOOL_U64_MAC_STAT(tx_deferred
),
106 EFX_ETHTOOL_U64_MAC_STAT(tx_late_collision
),
107 EFX_ETHTOOL_U64_MAC_STAT(tx_excessive_deferred
),
108 EFX_ETHTOOL_U64_MAC_STAT(tx_non_tcpudp
),
109 EFX_ETHTOOL_U64_MAC_STAT(tx_mac_src_error
),
110 EFX_ETHTOOL_U64_MAC_STAT(tx_ip_src_error
),
111 EFX_ETHTOOL_UINT_TXQ_STAT(tso_bursts
),
112 EFX_ETHTOOL_UINT_TXQ_STAT(tso_long_headers
),
113 EFX_ETHTOOL_UINT_TXQ_STAT(tso_packets
),
114 EFX_ETHTOOL_UINT_TXQ_STAT(pushes
),
115 EFX_ETHTOOL_U64_MAC_STAT(rx_bytes
),
116 EFX_ETHTOOL_U64_MAC_STAT(rx_good_bytes
),
117 EFX_ETHTOOL_U64_MAC_STAT(rx_bad_bytes
),
118 EFX_ETHTOOL_U64_MAC_STAT(rx_packets
),
119 EFX_ETHTOOL_U64_MAC_STAT(rx_good
),
120 EFX_ETHTOOL_U64_MAC_STAT(rx_bad
),
121 EFX_ETHTOOL_U64_MAC_STAT(rx_pause
),
122 EFX_ETHTOOL_U64_MAC_STAT(rx_control
),
123 EFX_ETHTOOL_U64_MAC_STAT(rx_unicast
),
124 EFX_ETHTOOL_U64_MAC_STAT(rx_multicast
),
125 EFX_ETHTOOL_U64_MAC_STAT(rx_broadcast
),
126 EFX_ETHTOOL_U64_MAC_STAT(rx_lt64
),
127 EFX_ETHTOOL_U64_MAC_STAT(rx_64
),
128 EFX_ETHTOOL_U64_MAC_STAT(rx_65_to_127
),
129 EFX_ETHTOOL_U64_MAC_STAT(rx_128_to_255
),
130 EFX_ETHTOOL_U64_MAC_STAT(rx_256_to_511
),
131 EFX_ETHTOOL_U64_MAC_STAT(rx_512_to_1023
),
132 EFX_ETHTOOL_U64_MAC_STAT(rx_1024_to_15xx
),
133 EFX_ETHTOOL_U64_MAC_STAT(rx_15xx_to_jumbo
),
134 EFX_ETHTOOL_U64_MAC_STAT(rx_gtjumbo
),
135 EFX_ETHTOOL_U64_MAC_STAT(rx_bad_lt64
),
136 EFX_ETHTOOL_U64_MAC_STAT(rx_bad_64_to_15xx
),
137 EFX_ETHTOOL_U64_MAC_STAT(rx_bad_15xx_to_jumbo
),
138 EFX_ETHTOOL_U64_MAC_STAT(rx_bad_gtjumbo
),
139 EFX_ETHTOOL_U64_MAC_STAT(rx_overflow
),
140 EFX_ETHTOOL_U64_MAC_STAT(rx_missed
),
141 EFX_ETHTOOL_U64_MAC_STAT(rx_false_carrier
),
142 EFX_ETHTOOL_U64_MAC_STAT(rx_symbol_error
),
143 EFX_ETHTOOL_U64_MAC_STAT(rx_align_error
),
144 EFX_ETHTOOL_U64_MAC_STAT(rx_length_error
),
145 EFX_ETHTOOL_U64_MAC_STAT(rx_internal_error
),
146 EFX_ETHTOOL_UINT_NIC_STAT(rx_nodesc_drop_cnt
),
147 EFX_ETHTOOL_ATOMIC_NIC_ERROR_STAT(rx_reset
),
148 EFX_ETHTOOL_UINT_CHANNEL_STAT(rx_tobe_disc
),
149 EFX_ETHTOOL_UINT_CHANNEL_STAT(rx_ip_hdr_chksum_err
),
150 EFX_ETHTOOL_UINT_CHANNEL_STAT(rx_tcp_udp_chksum_err
),
151 EFX_ETHTOOL_UINT_CHANNEL_STAT(rx_mcast_mismatch
),
152 EFX_ETHTOOL_UINT_CHANNEL_STAT(rx_frm_trunc
),
153 EFX_ETHTOOL_UINT_CHANNEL_STAT(rx_nodesc_trunc
),
156 /* Number of ethtool statistics */
157 #define EFX_ETHTOOL_NUM_STATS ARRAY_SIZE(efx_ethtool_stats)
159 #define EFX_ETHTOOL_EEPROM_MAGIC 0xEFAB
161 /**************************************************************************
165 **************************************************************************
168 /* Identify device by flashing LEDs */
169 static int efx_ethtool_phys_id(struct net_device
*net_dev
,
170 enum ethtool_phys_id_state state
)
172 struct efx_nic
*efx
= netdev_priv(net_dev
);
173 enum efx_led_mode mode
= EFX_LED_DEFAULT
;
182 case ETHTOOL_ID_INACTIVE
:
183 mode
= EFX_LED_DEFAULT
;
185 case ETHTOOL_ID_ACTIVE
:
186 return 1; /* cycle on/off once per second */
189 efx
->type
->set_id_led(efx
, mode
);
193 /* This must be called with rtnl_lock held. */
194 static int efx_ethtool_get_settings(struct net_device
*net_dev
,
195 struct ethtool_cmd
*ecmd
)
197 struct efx_nic
*efx
= netdev_priv(net_dev
);
198 struct efx_link_state
*link_state
= &efx
->link_state
;
200 mutex_lock(&efx
->mac_lock
);
201 efx
->phy_op
->get_settings(efx
, ecmd
);
202 mutex_unlock(&efx
->mac_lock
);
204 /* Both MACs support pause frames (bidirectional and respond-only) */
205 ecmd
->supported
|= SUPPORTED_Pause
| SUPPORTED_Asym_Pause
;
207 if (LOOPBACK_INTERNAL(efx
)) {
208 ethtool_cmd_speed_set(ecmd
, link_state
->speed
);
209 ecmd
->duplex
= link_state
->fd
? DUPLEX_FULL
: DUPLEX_HALF
;
215 /* This must be called with rtnl_lock held. */
216 static int efx_ethtool_set_settings(struct net_device
*net_dev
,
217 struct ethtool_cmd
*ecmd
)
219 struct efx_nic
*efx
= netdev_priv(net_dev
);
222 /* GMAC does not support 1000Mbps HD */
223 if ((ethtool_cmd_speed(ecmd
) == SPEED_1000
) &&
224 (ecmd
->duplex
!= DUPLEX_FULL
)) {
225 netif_dbg(efx
, drv
, efx
->net_dev
,
226 "rejecting unsupported 1000Mbps HD setting\n");
230 mutex_lock(&efx
->mac_lock
);
231 rc
= efx
->phy_op
->set_settings(efx
, ecmd
);
232 mutex_unlock(&efx
->mac_lock
);
236 static void efx_ethtool_get_drvinfo(struct net_device
*net_dev
,
237 struct ethtool_drvinfo
*info
)
239 struct efx_nic
*efx
= netdev_priv(net_dev
);
241 strlcpy(info
->driver
, KBUILD_MODNAME
, sizeof(info
->driver
));
242 strlcpy(info
->version
, EFX_DRIVER_VERSION
, sizeof(info
->version
));
243 if (efx_nic_rev(efx
) >= EFX_REV_SIENA_A0
)
244 efx_mcdi_print_fwver(efx
, info
->fw_version
,
245 sizeof(info
->fw_version
));
246 strlcpy(info
->bus_info
, pci_name(efx
->pci_dev
), sizeof(info
->bus_info
));
249 static int efx_ethtool_get_regs_len(struct net_device
*net_dev
)
251 return efx_nic_get_regs_len(netdev_priv(net_dev
));
254 static void efx_ethtool_get_regs(struct net_device
*net_dev
,
255 struct ethtool_regs
*regs
, void *buf
)
257 struct efx_nic
*efx
= netdev_priv(net_dev
);
259 regs
->version
= efx
->type
->revision
;
260 efx_nic_get_regs(efx
, buf
);
263 static u32
efx_ethtool_get_msglevel(struct net_device
*net_dev
)
265 struct efx_nic
*efx
= netdev_priv(net_dev
);
266 return efx
->msg_enable
;
269 static void efx_ethtool_set_msglevel(struct net_device
*net_dev
, u32 msg_enable
)
271 struct efx_nic
*efx
= netdev_priv(net_dev
);
272 efx
->msg_enable
= msg_enable
;
276 * efx_fill_test - fill in an individual self-test entry
277 * @test_index: Index of the test
278 * @strings: Ethtool strings, or %NULL
279 * @data: Ethtool test results, or %NULL
280 * @test: Pointer to test result (used only if data != %NULL)
281 * @unit_format: Unit name format (e.g. "chan\%d")
282 * @unit_id: Unit id (e.g. 0 for "chan0")
283 * @test_format: Test name format (e.g. "loopback.\%s.tx.sent")
284 * @test_id: Test id (e.g. "PHYXS" for "loopback.PHYXS.tx_sent")
286 * Fill in an individual self-test entry.
288 static void efx_fill_test(unsigned int test_index
, u8
*strings
, u64
*data
,
289 int *test
, const char *unit_format
, int unit_id
,
290 const char *test_format
, const char *test_id
)
292 char unit_str
[ETH_GSTRING_LEN
], test_str
[ETH_GSTRING_LEN
];
294 /* Fill data value, if applicable */
296 data
[test_index
] = *test
;
298 /* Fill string, if applicable */
300 if (strchr(unit_format
, '%'))
301 snprintf(unit_str
, sizeof(unit_str
),
302 unit_format
, unit_id
);
304 strcpy(unit_str
, unit_format
);
305 snprintf(test_str
, sizeof(test_str
), test_format
, test_id
);
306 snprintf(strings
+ test_index
* ETH_GSTRING_LEN
,
308 "%-6s %-24s", unit_str
, test_str
);
312 #define EFX_CHANNEL_NAME(_channel) "chan%d", _channel->channel
313 #define EFX_TX_QUEUE_NAME(_tx_queue) "txq%d", _tx_queue->queue
314 #define EFX_RX_QUEUE_NAME(_rx_queue) "rxq%d", _rx_queue->queue
315 #define EFX_LOOPBACK_NAME(_mode, _counter) \
316 "loopback.%s." _counter, STRING_TABLE_LOOKUP(_mode, efx_loopback_mode)
319 * efx_fill_loopback_test - fill in a block of loopback self-test entries
321 * @lb_tests: Efx loopback self-test results structure
322 * @mode: Loopback test mode
323 * @test_index: Starting index of the test
324 * @strings: Ethtool strings, or %NULL
325 * @data: Ethtool test results, or %NULL
327 static int efx_fill_loopback_test(struct efx_nic
*efx
,
328 struct efx_loopback_self_tests
*lb_tests
,
329 enum efx_loopback_mode mode
,
330 unsigned int test_index
,
331 u8
*strings
, u64
*data
)
333 struct efx_channel
*channel
=
334 efx_get_channel(efx
, efx
->tx_channel_offset
);
335 struct efx_tx_queue
*tx_queue
;
337 efx_for_each_channel_tx_queue(tx_queue
, channel
) {
338 efx_fill_test(test_index
++, strings
, data
,
339 &lb_tests
->tx_sent
[tx_queue
->queue
],
340 EFX_TX_QUEUE_NAME(tx_queue
),
341 EFX_LOOPBACK_NAME(mode
, "tx_sent"));
342 efx_fill_test(test_index
++, strings
, data
,
343 &lb_tests
->tx_done
[tx_queue
->queue
],
344 EFX_TX_QUEUE_NAME(tx_queue
),
345 EFX_LOOPBACK_NAME(mode
, "tx_done"));
347 efx_fill_test(test_index
++, strings
, data
,
350 EFX_LOOPBACK_NAME(mode
, "rx_good"));
351 efx_fill_test(test_index
++, strings
, data
,
354 EFX_LOOPBACK_NAME(mode
, "rx_bad"));
360 * efx_ethtool_fill_self_tests - get self-test details
362 * @tests: Efx self-test results structure, or %NULL
363 * @strings: Ethtool strings, or %NULL
364 * @data: Ethtool test results, or %NULL
366 static int efx_ethtool_fill_self_tests(struct efx_nic
*efx
,
367 struct efx_self_tests
*tests
,
368 u8
*strings
, u64
*data
)
370 struct efx_channel
*channel
;
371 unsigned int n
= 0, i
;
372 enum efx_loopback_mode mode
;
374 efx_fill_test(n
++, strings
, data
, &tests
->phy_alive
,
375 "phy", 0, "alive", NULL
);
376 efx_fill_test(n
++, strings
, data
, &tests
->nvram
,
377 "core", 0, "nvram", NULL
);
378 efx_fill_test(n
++, strings
, data
, &tests
->interrupt
,
379 "core", 0, "interrupt", NULL
);
382 efx_for_each_channel(channel
, efx
) {
383 efx_fill_test(n
++, strings
, data
,
384 &tests
->eventq_dma
[channel
->channel
],
385 EFX_CHANNEL_NAME(channel
),
387 efx_fill_test(n
++, strings
, data
,
388 &tests
->eventq_int
[channel
->channel
],
389 EFX_CHANNEL_NAME(channel
),
393 efx_fill_test(n
++, strings
, data
, &tests
->registers
,
394 "core", 0, "registers", NULL
);
396 if (efx
->phy_op
->run_tests
!= NULL
) {
397 EFX_BUG_ON_PARANOID(efx
->phy_op
->test_name
== NULL
);
399 for (i
= 0; true; ++i
) {
402 EFX_BUG_ON_PARANOID(i
>= EFX_MAX_PHY_TESTS
);
403 name
= efx
->phy_op
->test_name(efx
, i
);
407 efx_fill_test(n
++, strings
, data
, &tests
->phy_ext
[i
],
408 "phy", 0, name
, NULL
);
413 for (mode
= LOOPBACK_NONE
; mode
<= LOOPBACK_TEST_MAX
; mode
++) {
414 if (!(efx
->loopback_modes
& (1 << mode
)))
416 n
= efx_fill_loopback_test(efx
,
417 &tests
->loopback
[mode
], mode
, n
,
424 static int efx_ethtool_get_sset_count(struct net_device
*net_dev
,
427 switch (string_set
) {
429 return EFX_ETHTOOL_NUM_STATS
;
431 return efx_ethtool_fill_self_tests(netdev_priv(net_dev
),
438 static void efx_ethtool_get_strings(struct net_device
*net_dev
,
439 u32 string_set
, u8
*strings
)
441 struct efx_nic
*efx
= netdev_priv(net_dev
);
444 switch (string_set
) {
446 for (i
= 0; i
< EFX_ETHTOOL_NUM_STATS
; i
++)
447 strlcpy(strings
+ i
* ETH_GSTRING_LEN
,
448 efx_ethtool_stats
[i
].name
, ETH_GSTRING_LEN
);
451 efx_ethtool_fill_self_tests(efx
, NULL
, strings
, NULL
);
454 /* No other string sets */
459 static void efx_ethtool_get_stats(struct net_device
*net_dev
,
460 struct ethtool_stats
*stats
,
463 struct efx_nic
*efx
= netdev_priv(net_dev
);
464 struct efx_mac_stats
*mac_stats
= &efx
->mac_stats
;
465 const struct efx_ethtool_stat
*stat
;
466 struct efx_channel
*channel
;
467 struct efx_tx_queue
*tx_queue
;
470 EFX_BUG_ON_PARANOID(stats
->n_stats
!= EFX_ETHTOOL_NUM_STATS
);
472 spin_lock_bh(&efx
->stats_lock
);
474 /* Update MAC and NIC statistics */
475 efx
->type
->update_stats(efx
);
477 /* Fill detailed statistics buffer */
478 for (i
= 0; i
< EFX_ETHTOOL_NUM_STATS
; i
++) {
479 stat
= &efx_ethtool_stats
[i
];
480 switch (stat
->source
) {
481 case EFX_ETHTOOL_STAT_SOURCE_mac_stats
:
482 data
[i
] = stat
->get_stat((void *)mac_stats
+
485 case EFX_ETHTOOL_STAT_SOURCE_nic
:
486 data
[i
] = stat
->get_stat((void *)efx
+ stat
->offset
);
488 case EFX_ETHTOOL_STAT_SOURCE_channel
:
490 efx_for_each_channel(channel
, efx
)
491 data
[i
] += stat
->get_stat((void *)channel
+
494 case EFX_ETHTOOL_STAT_SOURCE_tx_queue
:
496 efx_for_each_channel(channel
, efx
) {
497 efx_for_each_channel_tx_queue(tx_queue
, channel
)
499 stat
->get_stat((void *)tx_queue
506 spin_unlock_bh(&efx
->stats_lock
);
509 static void efx_ethtool_self_test(struct net_device
*net_dev
,
510 struct ethtool_test
*test
, u64
*data
)
512 struct efx_nic
*efx
= netdev_priv(net_dev
);
513 struct efx_self_tests
*efx_tests
;
517 efx_tests
= kzalloc(sizeof(*efx_tests
), GFP_KERNEL
);
521 if (efx
->state
!= STATE_READY
) {
526 netif_info(efx
, drv
, efx
->net_dev
, "starting %sline testing\n",
527 (test
->flags
& ETH_TEST_FL_OFFLINE
) ? "off" : "on");
529 /* We need rx buffers and interrupts. */
530 already_up
= (efx
->net_dev
->flags
& IFF_UP
);
532 rc
= dev_open(efx
->net_dev
);
534 netif_err(efx
, drv
, efx
->net_dev
,
535 "failed opening device.\n");
540 rc
= efx_selftest(efx
, efx_tests
, test
->flags
);
543 dev_close(efx
->net_dev
);
545 netif_info(efx
, drv
, efx
->net_dev
, "%s %sline self-tests\n",
546 rc
== 0 ? "passed" : "failed",
547 (test
->flags
& ETH_TEST_FL_OFFLINE
) ? "off" : "on");
550 /* Fill ethtool results structures */
551 efx_ethtool_fill_self_tests(efx
, efx_tests
, NULL
, data
);
555 test
->flags
|= ETH_TEST_FL_FAILED
;
558 /* Restart autonegotiation */
559 static int efx_ethtool_nway_reset(struct net_device
*net_dev
)
561 struct efx_nic
*efx
= netdev_priv(net_dev
);
563 return mdio45_nway_restart(&efx
->mdio
);
567 * Each channel has a single IRQ and moderation timer, started by any
568 * completion (or other event). Unless the module parameter
569 * separate_tx_channels is set, IRQs and moderation are therefore
570 * shared between RX and TX completions. In this case, when RX IRQ
571 * moderation is explicitly changed then TX IRQ moderation is
572 * automatically changed too, but otherwise we fail if the two values
573 * are requested to be different.
575 * The hardware does not support a limit on the number of completions
576 * before an IRQ, so we do not use the max_frames fields. We should
577 * report and require that max_frames == (usecs != 0), but this would
578 * invalidate existing user documentation.
580 * The hardware does not have distinct settings for interrupt
581 * moderation while the previous IRQ is being handled, so we should
582 * not use the 'irq' fields. However, an earlier developer
583 * misunderstood the meaning of the 'irq' fields and the driver did
584 * not support the standard fields. To avoid invalidating existing
585 * user documentation, we report and accept changes through either the
586 * standard or 'irq' fields. If both are changed at the same time, we
587 * prefer the standard field.
589 * We implement adaptive IRQ moderation, but use a different algorithm
590 * from that assumed in the definition of struct ethtool_coalesce.
591 * Therefore we do not use any of the adaptive moderation parameters
595 static int efx_ethtool_get_coalesce(struct net_device
*net_dev
,
596 struct ethtool_coalesce
*coalesce
)
598 struct efx_nic
*efx
= netdev_priv(net_dev
);
599 unsigned int tx_usecs
, rx_usecs
;
602 efx_get_irq_moderation(efx
, &tx_usecs
, &rx_usecs
, &rx_adaptive
);
604 coalesce
->tx_coalesce_usecs
= tx_usecs
;
605 coalesce
->tx_coalesce_usecs_irq
= tx_usecs
;
606 coalesce
->rx_coalesce_usecs
= rx_usecs
;
607 coalesce
->rx_coalesce_usecs_irq
= rx_usecs
;
608 coalesce
->use_adaptive_rx_coalesce
= rx_adaptive
;
613 static int efx_ethtool_set_coalesce(struct net_device
*net_dev
,
614 struct ethtool_coalesce
*coalesce
)
616 struct efx_nic
*efx
= netdev_priv(net_dev
);
617 struct efx_channel
*channel
;
618 unsigned int tx_usecs
, rx_usecs
;
619 bool adaptive
, rx_may_override_tx
;
622 if (coalesce
->use_adaptive_tx_coalesce
)
625 efx_get_irq_moderation(efx
, &tx_usecs
, &rx_usecs
, &adaptive
);
627 if (coalesce
->rx_coalesce_usecs
!= rx_usecs
)
628 rx_usecs
= coalesce
->rx_coalesce_usecs
;
630 rx_usecs
= coalesce
->rx_coalesce_usecs_irq
;
632 adaptive
= coalesce
->use_adaptive_rx_coalesce
;
634 /* If channels are shared, TX IRQ moderation can be quietly
635 * overridden unless it is changed from its old value.
637 rx_may_override_tx
= (coalesce
->tx_coalesce_usecs
== tx_usecs
&&
638 coalesce
->tx_coalesce_usecs_irq
== tx_usecs
);
639 if (coalesce
->tx_coalesce_usecs
!= tx_usecs
)
640 tx_usecs
= coalesce
->tx_coalesce_usecs
;
642 tx_usecs
= coalesce
->tx_coalesce_usecs_irq
;
644 rc
= efx_init_irq_moderation(efx
, tx_usecs
, rx_usecs
, adaptive
,
649 efx_for_each_channel(channel
, efx
)
650 efx
->type
->push_irq_moderation(channel
);
655 static void efx_ethtool_get_ringparam(struct net_device
*net_dev
,
656 struct ethtool_ringparam
*ring
)
658 struct efx_nic
*efx
= netdev_priv(net_dev
);
660 ring
->rx_max_pending
= EFX_MAX_DMAQ_SIZE
;
661 ring
->tx_max_pending
= EFX_MAX_DMAQ_SIZE
;
662 ring
->rx_pending
= efx
->rxq_entries
;
663 ring
->tx_pending
= efx
->txq_entries
;
666 static int efx_ethtool_set_ringparam(struct net_device
*net_dev
,
667 struct ethtool_ringparam
*ring
)
669 struct efx_nic
*efx
= netdev_priv(net_dev
);
672 if (ring
->rx_mini_pending
|| ring
->rx_jumbo_pending
||
673 ring
->rx_pending
> EFX_MAX_DMAQ_SIZE
||
674 ring
->tx_pending
> EFX_MAX_DMAQ_SIZE
)
677 if (ring
->rx_pending
< EFX_RXQ_MIN_ENT
) {
678 netif_err(efx
, drv
, efx
->net_dev
,
679 "RX queues cannot be smaller than %u\n",
684 txq_entries
= max(ring
->tx_pending
, EFX_TXQ_MIN_ENT(efx
));
685 if (txq_entries
!= ring
->tx_pending
)
686 netif_warn(efx
, drv
, efx
->net_dev
,
687 "increasing TX queue size to minimum of %u\n",
690 return efx_realloc_channels(efx
, ring
->rx_pending
, txq_entries
);
693 static int efx_ethtool_set_pauseparam(struct net_device
*net_dev
,
694 struct ethtool_pauseparam
*pause
)
696 struct efx_nic
*efx
= netdev_priv(net_dev
);
697 u8 wanted_fc
, old_fc
;
701 mutex_lock(&efx
->mac_lock
);
703 wanted_fc
= ((pause
->rx_pause
? EFX_FC_RX
: 0) |
704 (pause
->tx_pause
? EFX_FC_TX
: 0) |
705 (pause
->autoneg
? EFX_FC_AUTO
: 0));
707 if ((wanted_fc
& EFX_FC_TX
) && !(wanted_fc
& EFX_FC_RX
)) {
708 netif_dbg(efx
, drv
, efx
->net_dev
,
709 "Flow control unsupported: tx ON rx OFF\n");
714 if ((wanted_fc
& EFX_FC_AUTO
) && !efx
->link_advertising
) {
715 netif_dbg(efx
, drv
, efx
->net_dev
,
716 "Autonegotiation is disabled\n");
721 /* Hook for Falcon bug 11482 workaround */
722 if (efx
->type
->prepare_enable_fc_tx
&&
723 (wanted_fc
& EFX_FC_TX
) && !(efx
->wanted_fc
& EFX_FC_TX
))
724 efx
->type
->prepare_enable_fc_tx(efx
);
726 old_adv
= efx
->link_advertising
;
727 old_fc
= efx
->wanted_fc
;
728 efx_link_set_wanted_fc(efx
, wanted_fc
);
729 if (efx
->link_advertising
!= old_adv
||
730 (efx
->wanted_fc
^ old_fc
) & EFX_FC_AUTO
) {
731 rc
= efx
->phy_op
->reconfigure(efx
);
733 netif_err(efx
, drv
, efx
->net_dev
,
734 "Unable to advertise requested flow "
735 "control setting\n");
740 /* Reconfigure the MAC. The PHY *may* generate a link state change event
741 * if the user just changed the advertised capabilities, but there's no
742 * harm doing this twice */
743 efx
->type
->reconfigure_mac(efx
);
746 mutex_unlock(&efx
->mac_lock
);
751 static void efx_ethtool_get_pauseparam(struct net_device
*net_dev
,
752 struct ethtool_pauseparam
*pause
)
754 struct efx_nic
*efx
= netdev_priv(net_dev
);
756 pause
->rx_pause
= !!(efx
->wanted_fc
& EFX_FC_RX
);
757 pause
->tx_pause
= !!(efx
->wanted_fc
& EFX_FC_TX
);
758 pause
->autoneg
= !!(efx
->wanted_fc
& EFX_FC_AUTO
);
762 static void efx_ethtool_get_wol(struct net_device
*net_dev
,
763 struct ethtool_wolinfo
*wol
)
765 struct efx_nic
*efx
= netdev_priv(net_dev
);
766 return efx
->type
->get_wol(efx
, wol
);
770 static int efx_ethtool_set_wol(struct net_device
*net_dev
,
771 struct ethtool_wolinfo
*wol
)
773 struct efx_nic
*efx
= netdev_priv(net_dev
);
774 return efx
->type
->set_wol(efx
, wol
->wolopts
);
777 static int efx_ethtool_reset(struct net_device
*net_dev
, u32
*flags
)
779 struct efx_nic
*efx
= netdev_priv(net_dev
);
782 rc
= efx
->type
->map_reset_flags(flags
);
786 return efx_reset(efx
, rc
);
789 /* MAC address mask including only I/G bit */
790 static const u8 mac_addr_ig_mask
[ETH_ALEN
] = { 0x01, 0, 0, 0, 0, 0 };
792 #define IP4_ADDR_FULL_MASK ((__force __be32)~0)
793 #define PORT_FULL_MASK ((__force __be16)~0)
794 #define ETHER_TYPE_FULL_MASK ((__force __be16)~0)
796 static int efx_ethtool_get_class_rule(struct efx_nic
*efx
,
797 struct ethtool_rx_flow_spec
*rule
)
799 struct ethtool_tcpip4_spec
*ip_entry
= &rule
->h_u
.tcp_ip4_spec
;
800 struct ethtool_tcpip4_spec
*ip_mask
= &rule
->m_u
.tcp_ip4_spec
;
801 struct ethhdr
*mac_entry
= &rule
->h_u
.ether_spec
;
802 struct ethhdr
*mac_mask
= &rule
->m_u
.ether_spec
;
803 struct efx_filter_spec spec
;
806 rc
= efx_filter_get_filter_safe(efx
, EFX_FILTER_PRI_MANUAL
,
807 rule
->location
, &spec
);
811 if (spec
.dmaq_id
== EFX_FILTER_RX_DMAQ_ID_DROP
)
812 rule
->ring_cookie
= RX_CLS_FLOW_DISC
;
814 rule
->ring_cookie
= spec
.dmaq_id
;
816 if ((spec
.match_flags
& EFX_FILTER_MATCH_ETHER_TYPE
) &&
817 spec
.ether_type
== htons(ETH_P_IP
) &&
818 (spec
.match_flags
& EFX_FILTER_MATCH_IP_PROTO
) &&
819 (spec
.ip_proto
== IPPROTO_TCP
|| spec
.ip_proto
== IPPROTO_UDP
) &&
821 ~(EFX_FILTER_MATCH_ETHER_TYPE
| EFX_FILTER_MATCH_OUTER_VID
|
822 EFX_FILTER_MATCH_LOC_HOST
| EFX_FILTER_MATCH_REM_HOST
|
823 EFX_FILTER_MATCH_IP_PROTO
|
824 EFX_FILTER_MATCH_LOC_PORT
| EFX_FILTER_MATCH_REM_PORT
))) {
825 rule
->flow_type
= ((spec
.ip_proto
== IPPROTO_TCP
) ?
826 TCP_V4_FLOW
: UDP_V4_FLOW
);
827 if (spec
.match_flags
& EFX_FILTER_MATCH_LOC_HOST
) {
828 ip_entry
->ip4dst
= spec
.loc_host
[0];
829 ip_mask
->ip4dst
= IP4_ADDR_FULL_MASK
;
831 if (spec
.match_flags
& EFX_FILTER_MATCH_REM_HOST
) {
832 ip_entry
->ip4src
= spec
.rem_host
[0];
833 ip_mask
->ip4src
= IP4_ADDR_FULL_MASK
;
835 if (spec
.match_flags
& EFX_FILTER_MATCH_LOC_PORT
) {
836 ip_entry
->pdst
= spec
.loc_port
;
837 ip_mask
->pdst
= PORT_FULL_MASK
;
839 if (spec
.match_flags
& EFX_FILTER_MATCH_REM_PORT
) {
840 ip_entry
->psrc
= spec
.rem_port
;
841 ip_mask
->psrc
= PORT_FULL_MASK
;
843 } else if (!(spec
.match_flags
&
844 ~(EFX_FILTER_MATCH_LOC_MAC
| EFX_FILTER_MATCH_LOC_MAC_IG
|
845 EFX_FILTER_MATCH_REM_MAC
| EFX_FILTER_MATCH_ETHER_TYPE
|
846 EFX_FILTER_MATCH_OUTER_VID
))) {
847 rule
->flow_type
= ETHER_FLOW
;
848 if (spec
.match_flags
&
849 (EFX_FILTER_MATCH_LOC_MAC
| EFX_FILTER_MATCH_LOC_MAC_IG
)) {
850 memcpy(mac_entry
->h_dest
, spec
.loc_mac
, ETH_ALEN
);
851 if (spec
.match_flags
& EFX_FILTER_MATCH_LOC_MAC
)
852 memset(mac_mask
->h_dest
, ~0, ETH_ALEN
);
854 memcpy(mac_mask
->h_dest
, mac_addr_ig_mask
,
857 if (spec
.match_flags
& EFX_FILTER_MATCH_REM_MAC
) {
858 memcpy(mac_entry
->h_source
, spec
.rem_mac
, ETH_ALEN
);
859 memset(mac_mask
->h_source
, ~0, ETH_ALEN
);
861 if (spec
.match_flags
& EFX_FILTER_MATCH_ETHER_TYPE
) {
862 mac_entry
->h_proto
= spec
.ether_type
;
863 mac_mask
->h_proto
= ETHER_TYPE_FULL_MASK
;
866 /* The above should handle all filters that we insert */
871 if (spec
.match_flags
& EFX_FILTER_MATCH_OUTER_VID
) {
872 rule
->flow_type
|= FLOW_EXT
;
873 rule
->h_ext
.vlan_tci
= spec
.outer_vid
;
874 rule
->m_ext
.vlan_tci
= htons(0xfff);
881 efx_ethtool_get_rxnfc(struct net_device
*net_dev
,
882 struct ethtool_rxnfc
*info
, u32
*rule_locs
)
884 struct efx_nic
*efx
= netdev_priv(net_dev
);
887 case ETHTOOL_GRXRINGS
:
888 info
->data
= efx
->n_rx_channels
;
891 case ETHTOOL_GRXFH
: {
892 unsigned min_revision
= 0;
895 switch (info
->flow_type
) {
897 info
->data
|= RXH_L4_B_0_1
| RXH_L4_B_2_3
;
903 info
->data
|= RXH_IP_SRC
| RXH_IP_DST
;
904 min_revision
= EFX_REV_FALCON_B0
;
907 info
->data
|= RXH_L4_B_0_1
| RXH_L4_B_2_3
;
913 info
->data
|= RXH_IP_SRC
| RXH_IP_DST
;
914 min_revision
= EFX_REV_SIENA_A0
;
919 if (efx_nic_rev(efx
) < min_revision
)
924 case ETHTOOL_GRXCLSRLCNT
:
925 info
->data
= efx_filter_get_rx_id_limit(efx
);
928 info
->data
|= RX_CLS_LOC_SPECIAL
;
930 efx_filter_count_rx_used(efx
, EFX_FILTER_PRI_MANUAL
);
933 case ETHTOOL_GRXCLSRULE
:
934 if (efx_filter_get_rx_id_limit(efx
) == 0)
936 return efx_ethtool_get_class_rule(efx
, &info
->fs
);
938 case ETHTOOL_GRXCLSRLALL
: {
940 info
->data
= efx_filter_get_rx_id_limit(efx
);
943 rc
= efx_filter_get_rx_ids(efx
, EFX_FILTER_PRI_MANUAL
,
944 rule_locs
, info
->rule_cnt
);
956 static int efx_ethtool_set_class_rule(struct efx_nic
*efx
,
957 struct ethtool_rx_flow_spec
*rule
)
959 struct ethtool_tcpip4_spec
*ip_entry
= &rule
->h_u
.tcp_ip4_spec
;
960 struct ethtool_tcpip4_spec
*ip_mask
= &rule
->m_u
.tcp_ip4_spec
;
961 struct ethhdr
*mac_entry
= &rule
->h_u
.ether_spec
;
962 struct ethhdr
*mac_mask
= &rule
->m_u
.ether_spec
;
963 struct efx_filter_spec spec
;
966 /* Check that user wants us to choose the location */
967 if (rule
->location
!= RX_CLS_LOC_ANY
)
970 /* Range-check ring_cookie */
971 if (rule
->ring_cookie
>= efx
->n_rx_channels
&&
972 rule
->ring_cookie
!= RX_CLS_FLOW_DISC
)
975 /* Check for unsupported extensions */
976 if ((rule
->flow_type
& FLOW_EXT
) &&
977 (rule
->m_ext
.vlan_etype
|| rule
->m_ext
.data
[0] ||
978 rule
->m_ext
.data
[1]))
981 efx_filter_init_rx(&spec
, EFX_FILTER_PRI_MANUAL
,
982 efx
->rx_scatter
? EFX_FILTER_FLAG_RX_SCATTER
: 0,
983 (rule
->ring_cookie
== RX_CLS_FLOW_DISC
) ?
984 EFX_FILTER_RX_DMAQ_ID_DROP
: rule
->ring_cookie
);
986 switch (rule
->flow_type
& ~FLOW_EXT
) {
989 spec
.match_flags
= (EFX_FILTER_MATCH_ETHER_TYPE
|
990 EFX_FILTER_MATCH_IP_PROTO
);
991 spec
.ether_type
= htons(ETH_P_IP
);
992 spec
.ip_proto
= ((rule
->flow_type
& ~FLOW_EXT
) == TCP_V4_FLOW
?
993 IPPROTO_TCP
: IPPROTO_UDP
);
994 if (ip_mask
->ip4dst
) {
995 if (ip_mask
->ip4dst
!= IP4_ADDR_FULL_MASK
)
997 spec
.match_flags
|= EFX_FILTER_MATCH_LOC_HOST
;
998 spec
.loc_host
[0] = ip_entry
->ip4dst
;
1000 if (ip_mask
->ip4src
) {
1001 if (ip_mask
->ip4src
!= IP4_ADDR_FULL_MASK
)
1003 spec
.match_flags
|= EFX_FILTER_MATCH_REM_HOST
;
1004 spec
.rem_host
[0] = ip_entry
->ip4src
;
1006 if (ip_mask
->pdst
) {
1007 if (ip_mask
->pdst
!= PORT_FULL_MASK
)
1009 spec
.match_flags
|= EFX_FILTER_MATCH_LOC_PORT
;
1010 spec
.loc_port
= ip_entry
->pdst
;
1012 if (ip_mask
->psrc
) {
1013 if (ip_mask
->psrc
!= PORT_FULL_MASK
)
1015 spec
.match_flags
|= EFX_FILTER_MATCH_REM_PORT
;
1016 spec
.rem_port
= ip_entry
->psrc
;
1023 if (!is_zero_ether_addr(mac_mask
->h_dest
)) {
1024 if (ether_addr_equal(mac_mask
->h_dest
,
1026 spec
.match_flags
|= EFX_FILTER_MATCH_LOC_MAC_IG
;
1027 else if (is_broadcast_ether_addr(mac_mask
->h_dest
))
1028 spec
.match_flags
|= EFX_FILTER_MATCH_LOC_MAC
;
1031 memcpy(spec
.loc_mac
, mac_entry
->h_dest
, ETH_ALEN
);
1033 if (!is_zero_ether_addr(mac_mask
->h_source
)) {
1034 if (!is_broadcast_ether_addr(mac_mask
->h_source
))
1036 spec
.match_flags
|= EFX_FILTER_MATCH_REM_MAC
;
1037 memcpy(spec
.rem_mac
, mac_entry
->h_source
, ETH_ALEN
);
1039 if (mac_mask
->h_proto
) {
1040 if (mac_mask
->h_proto
!= ETHER_TYPE_FULL_MASK
)
1042 spec
.match_flags
|= EFX_FILTER_MATCH_ETHER_TYPE
;
1043 spec
.ether_type
= mac_entry
->h_proto
;
1051 if ((rule
->flow_type
& FLOW_EXT
) && rule
->m_ext
.vlan_tci
) {
1052 if (rule
->m_ext
.vlan_tci
!= htons(0xfff))
1054 spec
.match_flags
|= EFX_FILTER_MATCH_OUTER_VID
;
1055 spec
.outer_vid
= rule
->h_ext
.vlan_tci
;
1058 rc
= efx_filter_insert_filter(efx
, &spec
, true);
1062 rule
->location
= rc
;
1066 static int efx_ethtool_set_rxnfc(struct net_device
*net_dev
,
1067 struct ethtool_rxnfc
*info
)
1069 struct efx_nic
*efx
= netdev_priv(net_dev
);
1071 if (efx_filter_get_rx_id_limit(efx
) == 0)
1074 switch (info
->cmd
) {
1075 case ETHTOOL_SRXCLSRLINS
:
1076 return efx_ethtool_set_class_rule(efx
, &info
->fs
);
1078 case ETHTOOL_SRXCLSRLDEL
:
1079 return efx_filter_remove_id_safe(efx
, EFX_FILTER_PRI_MANUAL
,
1087 static u32
efx_ethtool_get_rxfh_indir_size(struct net_device
*net_dev
)
1089 struct efx_nic
*efx
= netdev_priv(net_dev
);
1091 return ((efx_nic_rev(efx
) < EFX_REV_FALCON_B0
||
1092 efx
->n_rx_channels
== 1) ?
1093 0 : ARRAY_SIZE(efx
->rx_indir_table
));
1096 static int efx_ethtool_get_rxfh_indir(struct net_device
*net_dev
, u32
*indir
)
1098 struct efx_nic
*efx
= netdev_priv(net_dev
);
1100 memcpy(indir
, efx
->rx_indir_table
, sizeof(efx
->rx_indir_table
));
1104 static int efx_ethtool_set_rxfh_indir(struct net_device
*net_dev
,
1107 struct efx_nic
*efx
= netdev_priv(net_dev
);
1109 memcpy(efx
->rx_indir_table
, indir
, sizeof(efx
->rx_indir_table
));
1110 efx_nic_push_rx_indir_table(efx
);
1114 int efx_ethtool_get_ts_info(struct net_device
*net_dev
,
1115 struct ethtool_ts_info
*ts_info
)
1117 struct efx_nic
*efx
= netdev_priv(net_dev
);
1119 /* Software capabilities */
1120 ts_info
->so_timestamping
= (SOF_TIMESTAMPING_RX_SOFTWARE
|
1121 SOF_TIMESTAMPING_SOFTWARE
);
1122 ts_info
->phc_index
= -1;
1124 efx_ptp_get_ts_info(efx
, ts_info
);
1128 static int efx_ethtool_get_module_eeprom(struct net_device
*net_dev
,
1129 struct ethtool_eeprom
*ee
,
1132 struct efx_nic
*efx
= netdev_priv(net_dev
);
1135 if (!efx
->phy_op
|| !efx
->phy_op
->get_module_eeprom
)
1138 mutex_lock(&efx
->mac_lock
);
1139 ret
= efx
->phy_op
->get_module_eeprom(efx
, ee
, data
);
1140 mutex_unlock(&efx
->mac_lock
);
1145 static int efx_ethtool_get_module_info(struct net_device
*net_dev
,
1146 struct ethtool_modinfo
*modinfo
)
1148 struct efx_nic
*efx
= netdev_priv(net_dev
);
1151 if (!efx
->phy_op
|| !efx
->phy_op
->get_module_info
)
1154 mutex_lock(&efx
->mac_lock
);
1155 ret
= efx
->phy_op
->get_module_info(efx
, modinfo
);
1156 mutex_unlock(&efx
->mac_lock
);
1161 const struct ethtool_ops efx_ethtool_ops
= {
1162 .get_settings
= efx_ethtool_get_settings
,
1163 .set_settings
= efx_ethtool_set_settings
,
1164 .get_drvinfo
= efx_ethtool_get_drvinfo
,
1165 .get_regs_len
= efx_ethtool_get_regs_len
,
1166 .get_regs
= efx_ethtool_get_regs
,
1167 .get_msglevel
= efx_ethtool_get_msglevel
,
1168 .set_msglevel
= efx_ethtool_set_msglevel
,
1169 .nway_reset
= efx_ethtool_nway_reset
,
1170 .get_link
= ethtool_op_get_link
,
1171 .get_coalesce
= efx_ethtool_get_coalesce
,
1172 .set_coalesce
= efx_ethtool_set_coalesce
,
1173 .get_ringparam
= efx_ethtool_get_ringparam
,
1174 .set_ringparam
= efx_ethtool_set_ringparam
,
1175 .get_pauseparam
= efx_ethtool_get_pauseparam
,
1176 .set_pauseparam
= efx_ethtool_set_pauseparam
,
1177 .get_sset_count
= efx_ethtool_get_sset_count
,
1178 .self_test
= efx_ethtool_self_test
,
1179 .get_strings
= efx_ethtool_get_strings
,
1180 .set_phys_id
= efx_ethtool_phys_id
,
1181 .get_ethtool_stats
= efx_ethtool_get_stats
,
1182 .get_wol
= efx_ethtool_get_wol
,
1183 .set_wol
= efx_ethtool_set_wol
,
1184 .reset
= efx_ethtool_reset
,
1185 .get_rxnfc
= efx_ethtool_get_rxnfc
,
1186 .set_rxnfc
= efx_ethtool_set_rxnfc
,
1187 .get_rxfh_indir_size
= efx_ethtool_get_rxfh_indir_size
,
1188 .get_rxfh_indir
= efx_ethtool_get_rxfh_indir
,
1189 .set_rxfh_indir
= efx_ethtool_set_rxfh_indir
,
1190 .get_ts_info
= efx_ethtool_get_ts_info
,
1191 .get_module_info
= efx_ethtool_get_module_info
,
1192 .get_module_eeprom
= efx_ethtool_get_module_eeprom
,