sctp: fasthandoff with ASCONF at server-node
[linux-2.6-block.git] / drivers / net / ethernet / emulex / benet / be_ethtool.c
CommitLineData
6b7c5b94 1/*
d2145cde 2 * Copyright (C) 2005 - 2011 Emulex
6b7c5b94
SP
3 * All rights reserved.
4 *
5 * This program is free software; you can redistribute it and/or
6 * modify it under the terms of the GNU General Public License version 2
7 * as published by the Free Software Foundation. The full GNU General
8 * Public License is included in this distribution in the file called COPYING.
9 *
10 * Contact Information:
d2145cde 11 * linux-drivers@emulex.com
6b7c5b94 12 *
d2145cde
AK
13 * Emulex
14 * 3333 Susan Street
15 * Costa Mesa, CA 92626
6b7c5b94
SP
16 */
17
18#include "be.h"
8788fdc2 19#include "be_cmds.h"
6b7c5b94
SP
20#include <linux/ethtool.h>
21
22struct be_ethtool_stat {
23 char desc[ETH_GSTRING_LEN];
24 int type;
25 int size;
26 int offset;
27};
28
ac124ff9 29enum {DRVSTAT_TX, DRVSTAT_RX, DRVSTAT};
6b7c5b94
SP
30#define FIELDINFO(_struct, field) FIELD_SIZEOF(_struct, field), \
31 offsetof(_struct, field)
3abcdeda
SP
32#define DRVSTAT_TX_INFO(field) #field, DRVSTAT_TX,\
33 FIELDINFO(struct be_tx_stats, field)
34#define DRVSTAT_RX_INFO(field) #field, DRVSTAT_RX,\
35 FIELDINFO(struct be_rx_stats, field)
609ff3bb 36#define DRVSTAT_INFO(field) #field, DRVSTAT,\
ac124ff9 37 FIELDINFO(struct be_drv_stats, field)
6b7c5b94
SP
38
39static const struct be_ethtool_stat et_stats[] = {
ac124ff9 40 {DRVSTAT_INFO(tx_events)},
89a88ab8
AK
41 {DRVSTAT_INFO(rx_crc_errors)},
42 {DRVSTAT_INFO(rx_alignment_symbol_errors)},
43 {DRVSTAT_INFO(rx_pause_frames)},
44 {DRVSTAT_INFO(rx_control_frames)},
45 {DRVSTAT_INFO(rx_in_range_errors)},
46 {DRVSTAT_INFO(rx_out_range_errors)},
47 {DRVSTAT_INFO(rx_frame_too_long)},
48 {DRVSTAT_INFO(rx_address_match_errors)},
49 {DRVSTAT_INFO(rx_dropped_too_small)},
50 {DRVSTAT_INFO(rx_dropped_too_short)},
51 {DRVSTAT_INFO(rx_dropped_header_too_small)},
52 {DRVSTAT_INFO(rx_dropped_tcp_length)},
53 {DRVSTAT_INFO(rx_dropped_runt)},
54 {DRVSTAT_INFO(rxpp_fifo_overflow_drop)},
55 {DRVSTAT_INFO(rx_input_fifo_overflow_drop)},
56 {DRVSTAT_INFO(rx_ip_checksum_errs)},
57 {DRVSTAT_INFO(rx_tcp_checksum_errs)},
58 {DRVSTAT_INFO(rx_udp_checksum_errs)},
89a88ab8
AK
59 {DRVSTAT_INFO(tx_pauseframes)},
60 {DRVSTAT_INFO(tx_controlframes)},
61 {DRVSTAT_INFO(rx_priority_pause_frames)},
62 {DRVSTAT_INFO(pmem_fifo_overflow_drop)},
63 {DRVSTAT_INFO(jabber_events)},
64 {DRVSTAT_INFO(rx_drops_no_pbuf)},
65 {DRVSTAT_INFO(rx_drops_no_txpb)},
66 {DRVSTAT_INFO(rx_drops_no_erx_descr)},
67 {DRVSTAT_INFO(rx_drops_no_tpre_descr)},
68 {DRVSTAT_INFO(rx_drops_too_many_frags)},
69 {DRVSTAT_INFO(rx_drops_invalid_ring)},
70 {DRVSTAT_INFO(forwarded_packets)},
71 {DRVSTAT_INFO(rx_drops_mtu)},
72 {DRVSTAT_INFO(eth_red_drops)},
609ff3bb 73 {DRVSTAT_INFO(be_on_die_temperature)}
6b7c5b94
SP
74};
75#define ETHTOOL_STATS_NUM ARRAY_SIZE(et_stats)
76
ab1594e9
SP
77/* Stats related to multi RX queues: get_stats routine assumes bytes, pkts
78 * are first and second members respectively.
79 */
3abcdeda 80static const struct be_ethtool_stat et_rx_stats[] = {
ab1594e9
SP
81 {DRVSTAT_RX_INFO(rx_bytes)},/* If moving this member see above note */
82 {DRVSTAT_RX_INFO(rx_pkts)}, /* If moving this member see above note */
3abcdeda
SP
83 {DRVSTAT_RX_INFO(rx_polls)},
84 {DRVSTAT_RX_INFO(rx_events)},
85 {DRVSTAT_RX_INFO(rx_compl)},
86 {DRVSTAT_RX_INFO(rx_mcast_pkts)},
87 {DRVSTAT_RX_INFO(rx_post_fail)},
ac124ff9
SP
88 {DRVSTAT_RX_INFO(rx_drops_no_skbs)},
89 {DRVSTAT_RX_INFO(rx_drops_no_frags)}
3abcdeda
SP
90};
91#define ETHTOOL_RXSTATS_NUM (ARRAY_SIZE(et_rx_stats))
92
ab1594e9
SP
93/* Stats related to multi TX queues: get_stats routine assumes compl is the
94 * first member
95 */
3c8def97 96static const struct be_ethtool_stat et_tx_stats[] = {
ab1594e9 97 {DRVSTAT_TX_INFO(tx_compl)}, /* If moving this member see above note */
ac124ff9
SP
98 {DRVSTAT_TX_INFO(tx_bytes)},
99 {DRVSTAT_TX_INFO(tx_pkts)},
100 {DRVSTAT_TX_INFO(tx_reqs)},
101 {DRVSTAT_TX_INFO(tx_wrbs)},
102 {DRVSTAT_TX_INFO(tx_compl)},
103 {DRVSTAT_TX_INFO(tx_stops)}
3c8def97
SP
104};
105#define ETHTOOL_TXSTATS_NUM (ARRAY_SIZE(et_tx_stats))
106
ff33a6e2
S
107static const char et_self_tests[][ETH_GSTRING_LEN] = {
108 "MAC Loopback test",
109 "PHY Loopback test",
110 "External Loopback test",
4ee77214 111 "DDR DMA test",
4276e47e 112 "Link test"
ff33a6e2
S
113};
114
115#define ETHTOOL_TESTS_NUM ARRAY_SIZE(et_self_tests)
116#define BE_MAC_LOOPBACK 0x0
117#define BE_PHY_LOOPBACK 0x1
118#define BE_ONE_PORT_EXT_LOOPBACK 0x2
fced9999 119#define BE_NO_LOOPBACK 0xff
ff33a6e2 120
04b71175
SP
121static void be_get_drvinfo(struct net_device *netdev,
122 struct ethtool_drvinfo *drvinfo)
6b7c5b94
SP
123{
124 struct be_adapter *adapter = netdev_priv(netdev);
04b71175
SP
125 char fw_on_flash[FW_VER_LEN];
126
127 memset(fw_on_flash, 0 , sizeof(fw_on_flash));
128 be_cmd_get_fw_ver(adapter, adapter->fw_ver, fw_on_flash);
6b7c5b94
SP
129
130 strcpy(drvinfo->driver, DRV_NAME);
131 strcpy(drvinfo->version, DRV_VER);
132 strncpy(drvinfo->fw_version, adapter->fw_ver, FW_VER_LEN);
04b71175
SP
133 if (memcmp(adapter->fw_ver, fw_on_flash, FW_VER_LEN) != 0) {
134 strcat(drvinfo->fw_version, " [");
135 strcat(drvinfo->fw_version, fw_on_flash);
136 strcat(drvinfo->fw_version, "]");
137 }
138
6b7c5b94
SP
139 strcpy(drvinfo->bus_info, pci_name(adapter->pdev));
140 drvinfo->testinfo_len = 0;
141 drvinfo->regdump_len = 0;
142 drvinfo->eedump_len = 0;
143}
144
311fddc7
SK
145static int
146be_get_reg_len(struct net_device *netdev)
147{
148 struct be_adapter *adapter = netdev_priv(netdev);
149 u32 log_size = 0;
150
16a871ef
AK
151 if (be_physfn(adapter))
152 be_cmd_get_reg_len(adapter, &log_size);
153
311fddc7
SK
154 return log_size;
155}
156
157static void
158be_get_regs(struct net_device *netdev, struct ethtool_regs *regs, void *buf)
159{
160 struct be_adapter *adapter = netdev_priv(netdev);
161
16a871ef
AK
162 if (be_physfn(adapter)) {
163 memset(buf, 0, regs->len);
164 be_cmd_get_regs(adapter, regs->len, buf);
165 }
311fddc7
SK
166}
167
6b7c5b94
SP
168static int
169be_get_coalesce(struct net_device *netdev, struct ethtool_coalesce *coalesce)
170{
171 struct be_adapter *adapter = netdev_priv(netdev);
3abcdeda 172 struct be_eq_obj *rx_eq = &adapter->rx_obj[0].rx_eq;
6b7c5b94
SP
173 struct be_eq_obj *tx_eq = &adapter->tx_eq;
174
6b7c5b94
SP
175 coalesce->rx_coalesce_usecs = rx_eq->cur_eqd;
176 coalesce->rx_coalesce_usecs_high = rx_eq->max_eqd;
177 coalesce->rx_coalesce_usecs_low = rx_eq->min_eqd;
178
179 coalesce->tx_coalesce_usecs = tx_eq->cur_eqd;
180 coalesce->tx_coalesce_usecs_high = tx_eq->max_eqd;
181 coalesce->tx_coalesce_usecs_low = tx_eq->min_eqd;
182
183 coalesce->use_adaptive_rx_coalesce = rx_eq->enable_aic;
184 coalesce->use_adaptive_tx_coalesce = tx_eq->enable_aic;
185
186 return 0;
187}
188
189/*
5be93b9a 190 * This routine is used to set interrup coalescing delay
6b7c5b94
SP
191 */
192static int
193be_set_coalesce(struct net_device *netdev, struct ethtool_coalesce *coalesce)
194{
195 struct be_adapter *adapter = netdev_priv(netdev);
3abcdeda
SP
196 struct be_rx_obj *rxo;
197 struct be_eq_obj *rx_eq;
6b7c5b94 198 struct be_eq_obj *tx_eq = &adapter->tx_eq;
6b7c5b94 199 u32 rx_max, rx_min, rx_cur;
3abcdeda 200 int status = 0, i;
03746b0a 201 u32 tx_cur;
6b7c5b94
SP
202
203 if (coalesce->use_adaptive_tx_coalesce == 1)
204 return -EINVAL;
205
3abcdeda
SP
206 for_all_rx_queues(adapter, rxo, i) {
207 rx_eq = &rxo->rx_eq;
208
209 if (!rx_eq->enable_aic && coalesce->use_adaptive_rx_coalesce)
210 rx_eq->cur_eqd = 0;
211 rx_eq->enable_aic = coalesce->use_adaptive_rx_coalesce;
212
213 rx_max = coalesce->rx_coalesce_usecs_high;
214 rx_min = coalesce->rx_coalesce_usecs_low;
215 rx_cur = coalesce->rx_coalesce_usecs;
216
217 if (rx_eq->enable_aic) {
218 if (rx_max > BE_MAX_EQD)
219 rx_max = BE_MAX_EQD;
220 if (rx_min > rx_max)
221 rx_min = rx_max;
222 rx_eq->max_eqd = rx_max;
223 rx_eq->min_eqd = rx_min;
224 if (rx_eq->cur_eqd > rx_max)
225 rx_eq->cur_eqd = rx_max;
226 if (rx_eq->cur_eqd < rx_min)
227 rx_eq->cur_eqd = rx_min;
228 } else {
229 if (rx_cur > BE_MAX_EQD)
230 rx_cur = BE_MAX_EQD;
231 if (rx_eq->cur_eqd != rx_cur) {
232 status = be_cmd_modify_eqd(adapter, rx_eq->q.id,
233 rx_cur);
234 if (!status)
235 rx_eq->cur_eqd = rx_cur;
236 }
237 }
6b7c5b94 238 }
6b7c5b94 239
6b7c5b94
SP
240 tx_cur = coalesce->tx_coalesce_usecs;
241
242 if (tx_cur > BE_MAX_EQD)
243 tx_cur = BE_MAX_EQD;
244 if (tx_eq->cur_eqd != tx_cur) {
8788fdc2 245 status = be_cmd_modify_eqd(adapter, tx_eq->q.id, tx_cur);
6b7c5b94
SP
246 if (!status)
247 tx_eq->cur_eqd = tx_cur;
248 }
249
6b7c5b94
SP
250 return 0;
251}
252
6b7c5b94
SP
253static void
254be_get_ethtool_stats(struct net_device *netdev,
255 struct ethtool_stats *stats, uint64_t *data)
256{
257 struct be_adapter *adapter = netdev_priv(netdev);
3abcdeda 258 struct be_rx_obj *rxo;
3c8def97 259 struct be_tx_obj *txo;
ac124ff9 260 void *p;
ab1594e9 261 unsigned int i, j, base = 0, start;
6b7c5b94
SP
262
263 for (i = 0; i < ETHTOOL_STATS_NUM; i++) {
ac124ff9 264 p = (u8 *)&adapter->drv_stats + et_stats[i].offset;
ab1594e9 265 data[i] = *(u32 *)p;
6b7c5b94 266 }
ab1594e9 267 base += ETHTOOL_STATS_NUM;
3abcdeda
SP
268
269 for_all_rx_queues(adapter, rxo, j) {
ab1594e9
SP
270 struct be_rx_stats *stats = rx_stats(rxo);
271
272 do {
273 start = u64_stats_fetch_begin_bh(&stats->sync);
274 data[base] = stats->rx_bytes;
275 data[base + 1] = stats->rx_pkts;
276 } while (u64_stats_fetch_retry_bh(&stats->sync, start));
277
278 for (i = 2; i < ETHTOOL_RXSTATS_NUM; i++) {
279 p = (u8 *)stats + et_rx_stats[i].offset;
280 data[base + i] = *(u32 *)p;
3abcdeda 281 }
ab1594e9 282 base += ETHTOOL_RXSTATS_NUM;
3abcdeda 283 }
3c8def97 284
3c8def97 285 for_all_tx_queues(adapter, txo, j) {
ab1594e9
SP
286 struct be_tx_stats *stats = tx_stats(txo);
287
288 do {
289 start = u64_stats_fetch_begin_bh(&stats->sync_compl);
290 data[base] = stats->tx_compl;
291 } while (u64_stats_fetch_retry_bh(&stats->sync_compl, start));
292
293 do {
294 start = u64_stats_fetch_begin_bh(&stats->sync);
295 for (i = 1; i < ETHTOOL_TXSTATS_NUM; i++) {
296 p = (u8 *)stats + et_tx_stats[i].offset;
297 data[base + i] =
298 (et_tx_stats[i].size == sizeof(u64)) ?
299 *(u64 *)p : *(u32 *)p;
300 }
301 } while (u64_stats_fetch_retry_bh(&stats->sync, start));
302 base += ETHTOOL_TXSTATS_NUM;
3c8def97 303 }
6b7c5b94
SP
304}
305
306static void
307be_get_stat_strings(struct net_device *netdev, uint32_t stringset,
308 uint8_t *data)
309{
3abcdeda
SP
310 struct be_adapter *adapter = netdev_priv(netdev);
311 int i, j;
312
6b7c5b94
SP
313 switch (stringset) {
314 case ETH_SS_STATS:
315 for (i = 0; i < ETHTOOL_STATS_NUM; i++) {
316 memcpy(data, et_stats[i].desc, ETH_GSTRING_LEN);
317 data += ETH_GSTRING_LEN;
318 }
3abcdeda
SP
319 for (i = 0; i < adapter->num_rx_qs; i++) {
320 for (j = 0; j < ETHTOOL_RXSTATS_NUM; j++) {
321 sprintf(data, "rxq%d: %s", i,
322 et_rx_stats[j].desc);
323 data += ETH_GSTRING_LEN;
324 }
325 }
3c8def97
SP
326 for (i = 0; i < adapter->num_tx_qs; i++) {
327 for (j = 0; j < ETHTOOL_TXSTATS_NUM; j++) {
328 sprintf(data, "txq%d: %s", i,
329 et_tx_stats[j].desc);
330 data += ETH_GSTRING_LEN;
331 }
332 }
6b7c5b94 333 break;
ff33a6e2
S
334 case ETH_SS_TEST:
335 for (i = 0; i < ETHTOOL_TESTS_NUM; i++) {
336 memcpy(data, et_self_tests[i], ETH_GSTRING_LEN);
337 data += ETH_GSTRING_LEN;
338 }
339 break;
6b7c5b94
SP
340 }
341}
342
15f0a394 343static int be_get_sset_count(struct net_device *netdev, int stringset)
6b7c5b94 344{
3abcdeda
SP
345 struct be_adapter *adapter = netdev_priv(netdev);
346
15f0a394 347 switch (stringset) {
ff33a6e2
S
348 case ETH_SS_TEST:
349 return ETHTOOL_TESTS_NUM;
15f0a394 350 case ETH_SS_STATS:
3abcdeda 351 return ETHTOOL_STATS_NUM +
3c8def97
SP
352 adapter->num_rx_qs * ETHTOOL_RXSTATS_NUM +
353 adapter->num_tx_qs * ETHTOOL_TXSTATS_NUM;
15f0a394
BH
354 default:
355 return -EINVAL;
356 }
6b7c5b94
SP
357}
358
359static int be_get_settings(struct net_device *netdev, struct ethtool_cmd *ecmd)
360{
0388f251 361 struct be_adapter *adapter = netdev_priv(netdev);
306f1348 362 struct be_phy_info phy_info;
ee3cb629 363 u8 mac_speed = 0;
0388f251 364 u16 link_speed = 0;
0dffc83e
AK
365 int status;
366
48e9989e 367 if ((adapter->link_speed < 0) || (!(netdev->flags & IFF_UP))) {
ea172a01
SP
368 status = be_cmd_link_status_query(adapter, &mac_speed,
369 &link_speed, 0);
0dffc83e
AK
370
371 /* link_speed is in units of 10 Mbps */
372 if (link_speed) {
70739497 373 ethtool_cmd_speed_set(ecmd, link_speed*10);
0dffc83e
AK
374 } else {
375 switch (mac_speed) {
4fa9ed07 376 case PHY_LINK_SPEED_10MBPS:
70739497 377 ethtool_cmd_speed_set(ecmd, SPEED_10);
4fa9ed07
AK
378 break;
379 case PHY_LINK_SPEED_100MBPS:
70739497 380 ethtool_cmd_speed_set(ecmd, SPEED_100);
4fa9ed07 381 break;
0dffc83e 382 case PHY_LINK_SPEED_1GBPS:
70739497 383 ethtool_cmd_speed_set(ecmd, SPEED_1000);
0dffc83e
AK
384 break;
385 case PHY_LINK_SPEED_10GBPS:
70739497 386 ethtool_cmd_speed_set(ecmd, SPEED_10000);
0dffc83e 387 break;
4fa9ed07 388 case PHY_LINK_SPEED_ZERO:
70739497 389 ethtool_cmd_speed_set(ecmd, 0);
4fa9ed07 390 break;
0dffc83e
AK
391 }
392 }
0388f251 393
306f1348 394 status = be_cmd_get_phy_info(adapter, &phy_info);
16c02145 395 if (!status) {
306f1348 396 switch (phy_info.interface_type) {
ee3cb629
AK
397 case PHY_TYPE_XFP_10GB:
398 case PHY_TYPE_SFP_1GB:
399 case PHY_TYPE_SFP_PLUS_10GB:
16c02145 400 ecmd->port = PORT_FIBRE;
16c02145
SB
401 break;
402 default:
403 ecmd->port = PORT_TP;
16c02145
SB
404 break;
405 }
ee3cb629 406
306f1348 407 switch (phy_info.interface_type) {
ee3cb629
AK
408 case PHY_TYPE_KR_10GB:
409 case PHY_TYPE_KX4_10GB:
410 ecmd->autoneg = AUTONEG_ENABLE;
16c02145 411 ecmd->transceiver = XCVR_INTERNAL;
ee3cb629
AK
412 break;
413 default:
414 ecmd->autoneg = AUTONEG_DISABLE;
415 ecmd->transceiver = XCVR_EXTERNAL;
416 break;
417 }
0388f251 418 }
0dffc83e
AK
419
420 /* Save for future use */
70739497 421 adapter->link_speed = ethtool_cmd_speed(ecmd);
0dffc83e 422 adapter->port_type = ecmd->port;
16c02145 423 adapter->transceiver = ecmd->transceiver;
ee3cb629 424 adapter->autoneg = ecmd->autoneg;
0dffc83e 425 } else {
70739497 426 ethtool_cmd_speed_set(ecmd, adapter->link_speed);
0dffc83e 427 ecmd->port = adapter->port_type;
16c02145 428 ecmd->transceiver = adapter->transceiver;
ee3cb629 429 ecmd->autoneg = adapter->autoneg;
0388f251 430 }
0dffc83e 431
6b7c5b94 432 ecmd->duplex = DUPLEX_FULL;
0388f251 433 ecmd->phy_address = adapter->port_num;
16c02145
SB
434 switch (ecmd->port) {
435 case PORT_FIBRE:
436 ecmd->supported = (SUPPORTED_10000baseT_Full | SUPPORTED_FIBRE);
437 break;
438 case PORT_TP:
439 ecmd->supported = (SUPPORTED_10000baseT_Full | SUPPORTED_TP);
440 break;
441 case PORT_AUI:
442 ecmd->supported = (SUPPORTED_10000baseT_Full | SUPPORTED_AUI);
443 break;
444 }
0388f251 445
ee3cb629
AK
446 if (ecmd->autoneg) {
447 ecmd->supported |= SUPPORTED_1000baseT_Full;
448 ecmd->supported |= SUPPORTED_Autoneg;
449 ecmd->advertising |= (ADVERTISED_10000baseT_Full |
450 ADVERTISED_1000baseT_Full);
451 }
452
6b7c5b94
SP
453 return 0;
454}
455
456static void
457be_get_ringparam(struct net_device *netdev, struct ethtool_ringparam *ring)
458{
459 struct be_adapter *adapter = netdev_priv(netdev);
460
3abcdeda 461 ring->rx_max_pending = adapter->rx_obj[0].q.len;
3c8def97 462 ring->tx_max_pending = adapter->tx_obj[0].q.len;
6b7c5b94 463
3abcdeda 464 ring->rx_pending = atomic_read(&adapter->rx_obj[0].q.used);
3c8def97 465 ring->tx_pending = atomic_read(&adapter->tx_obj[0].q.used);
6b7c5b94
SP
466}
467
468static void
469be_get_pauseparam(struct net_device *netdev, struct ethtool_pauseparam *ecmd)
470{
471 struct be_adapter *adapter = netdev_priv(netdev);
472
8788fdc2 473 be_cmd_get_flow_control(adapter, &ecmd->tx_pause, &ecmd->rx_pause);
03a980d1 474 ecmd->autoneg = 0;
6b7c5b94
SP
475}
476
477static int
478be_set_pauseparam(struct net_device *netdev, struct ethtool_pauseparam *ecmd)
479{
480 struct be_adapter *adapter = netdev_priv(netdev);
481 int status;
482
03a980d1 483 if (ecmd->autoneg != 0)
6b7c5b94 484 return -EINVAL;
9e90c961
AK
485 adapter->tx_fc = ecmd->tx_pause;
486 adapter->rx_fc = ecmd->rx_pause;
6b7c5b94 487
9e90c961
AK
488 status = be_cmd_set_flow_control(adapter,
489 adapter->tx_fc, adapter->rx_fc);
490 if (status)
6b7c5b94
SP
491 dev_warn(&adapter->pdev->dev, "Pause param set failed.\n");
492
493 return status;
494}
495
fad9ab2c 496static int
1a642469 497be_set_phys_id(struct net_device *netdev,
498 enum ethtool_phys_id_state state)
fad9ab2c
SB
499{
500 struct be_adapter *adapter = netdev_priv(netdev);
fad9ab2c 501
1a642469 502 switch (state) {
503 case ETHTOOL_ID_ACTIVE:
504 be_cmd_get_beacon_state(adapter, adapter->hba_port_num,
505 &adapter->beacon_state);
fce55922 506 return 1; /* cycle on/off once per second */
fad9ab2c 507
1a642469 508 case ETHTOOL_ID_ON:
509 be_cmd_set_beacon_state(adapter, adapter->hba_port_num, 0, 0,
510 BEACON_STATE_ENABLED);
511 break;
fad9ab2c 512
1a642469 513 case ETHTOOL_ID_OFF:
514 be_cmd_set_beacon_state(adapter, adapter->hba_port_num, 0, 0,
515 BEACON_STATE_DISABLED);
516 break;
fad9ab2c 517
1a642469 518 case ETHTOOL_ID_INACTIVE:
519 be_cmd_set_beacon_state(adapter, adapter->hba_port_num, 0, 0,
520 adapter->beacon_state);
521 }
fad9ab2c 522
1a642469 523 return 0;
fad9ab2c
SB
524}
525
dcf96f1f
AK
526static bool
527be_is_wol_supported(struct be_adapter *adapter)
528{
529 if (!be_physfn(adapter))
530 return false;
531 else
532 return true;
533}
534
71d8d1b5
AK
535static void
536be_get_wol(struct net_device *netdev, struct ethtool_wolinfo *wol)
537{
538 struct be_adapter *adapter = netdev_priv(netdev);
539
dcf96f1f
AK
540 if (be_is_wol_supported(adapter))
541 wol->supported = WAKE_MAGIC;
542
71d8d1b5
AK
543 if (adapter->wol)
544 wol->wolopts = WAKE_MAGIC;
545 else
546 wol->wolopts = 0;
547 memset(&wol->sopass, 0, sizeof(wol->sopass));
71d8d1b5
AK
548}
549
550static int
551be_set_wol(struct net_device *netdev, struct ethtool_wolinfo *wol)
552{
553 struct be_adapter *adapter = netdev_priv(netdev);
554
555 if (wol->wolopts & ~WAKE_MAGIC)
556 return -EINVAL;
557
dcf96f1f 558 if ((wol->wolopts & WAKE_MAGIC) && be_is_wol_supported(adapter))
71d8d1b5
AK
559 adapter->wol = true;
560 else
561 adapter->wol = false;
562
563 return 0;
564}
565
ff33a6e2
S
566static int
567be_test_ddr_dma(struct be_adapter *adapter)
568{
569 int ret, i;
570 struct be_dma_mem ddrdma_cmd;
215faf9c
JP
571 static const u64 pattern[2] = {
572 0x5a5a5a5a5a5a5a5aULL, 0xa5a5a5a5a5a5a5a5ULL
573 };
ff33a6e2
S
574
575 ddrdma_cmd.size = sizeof(struct be_cmd_req_ddrdma_test);
2b7bcebf
IV
576 ddrdma_cmd.va = dma_alloc_coherent(&adapter->pdev->dev, ddrdma_cmd.size,
577 &ddrdma_cmd.dma, GFP_KERNEL);
ff33a6e2 578 if (!ddrdma_cmd.va) {
2381a55c 579 dev_err(&adapter->pdev->dev, "Memory allocation failure\n");
ff33a6e2
S
580 return -ENOMEM;
581 }
582
583 for (i = 0; i < 2; i++) {
584 ret = be_cmd_ddr_dma_test(adapter, pattern[i],
585 4096, &ddrdma_cmd);
586 if (ret != 0)
587 goto err;
588 }
589
590err:
2b7bcebf
IV
591 dma_free_coherent(&adapter->pdev->dev, ddrdma_cmd.size, ddrdma_cmd.va,
592 ddrdma_cmd.dma);
ff33a6e2
S
593 return ret;
594}
595
fced9999
SB
596static u64 be_loopback_test(struct be_adapter *adapter, u8 loopback_type,
597 u64 *status)
598{
9e1453c5 599 be_cmd_set_loopback(adapter, adapter->hba_port_num,
fced9999 600 loopback_type, 1);
9e1453c5 601 *status = be_cmd_loopback_test(adapter, adapter->hba_port_num,
fced9999
SB
602 loopback_type, 1500,
603 2, 0xabc);
9e1453c5 604 be_cmd_set_loopback(adapter, adapter->hba_port_num,
fced9999
SB
605 BE_NO_LOOPBACK, 1);
606 return *status;
607}
608
ff33a6e2
S
609static void
610be_self_test(struct net_device *netdev, struct ethtool_test *test, u64 *data)
611{
612 struct be_adapter *adapter = netdev_priv(netdev);
4276e47e
SB
613 u8 mac_speed = 0;
614 u16 qos_link_speed = 0;
ff33a6e2
S
615
616 memset(data, 0, sizeof(u64) * ETHTOOL_TESTS_NUM);
617
618 if (test->flags & ETH_TEST_FL_OFFLINE) {
fced9999
SB
619 if (be_loopback_test(adapter, BE_MAC_LOOPBACK,
620 &data[0]) != 0) {
ff33a6e2 621 test->flags |= ETH_TEST_FL_FAILED;
fced9999
SB
622 }
623 if (be_loopback_test(adapter, BE_PHY_LOOPBACK,
624 &data[1]) != 0) {
ff33a6e2 625 test->flags |= ETH_TEST_FL_FAILED;
fced9999
SB
626 }
627 if (be_loopback_test(adapter, BE_ONE_PORT_EXT_LOOPBACK,
628 &data[2]) != 0) {
ff33a6e2 629 test->flags |= ETH_TEST_FL_FAILED;
fced9999 630 }
8f47afe0 631 }
ff33a6e2 632
8f47afe0
SB
633 if (be_test_ddr_dma(adapter) != 0) {
634 data[3] = 1;
635 test->flags |= ETH_TEST_FL_FAILED;
ff33a6e2
S
636 }
637
ea172a01 638 if (be_cmd_link_status_query(adapter, &mac_speed,
187e8756 639 &qos_link_speed, 0) != 0) {
4276e47e
SB
640 test->flags |= ETH_TEST_FL_FAILED;
641 data[4] = -1;
4ee77214
AK
642 } else if (!mac_speed) {
643 test->flags |= ETH_TEST_FL_FAILED;
4276e47e
SB
644 data[4] = 1;
645 }
ff33a6e2
S
646}
647
84517482
AK
648static int
649be_do_flash(struct net_device *netdev, struct ethtool_flash *efl)
650{
651 struct be_adapter *adapter = netdev_priv(netdev);
652 char file_name[ETHTOOL_FLASH_MAX_FILENAME];
84517482
AK
653
654 file_name[ETHTOOL_FLASH_MAX_FILENAME - 1] = 0;
655 strcpy(file_name, efl->data);
84517482
AK
656
657 return be_load_fw(adapter, file_name);
658}
659
368c0ca2
SB
660static int
661be_get_eeprom_len(struct net_device *netdev)
662{
663 return BE_READ_SEEPROM_LEN;
664}
665
666static int
667be_read_eeprom(struct net_device *netdev, struct ethtool_eeprom *eeprom,
668 uint8_t *data)
669{
670 struct be_adapter *adapter = netdev_priv(netdev);
671 struct be_dma_mem eeprom_cmd;
672 struct be_cmd_resp_seeprom_read *resp;
673 int status;
674
675 if (!eeprom->len)
676 return -EINVAL;
677
678 eeprom->magic = BE_VENDOR_ID | (adapter->pdev->device<<16);
679
680 memset(&eeprom_cmd, 0, sizeof(struct be_dma_mem));
681 eeprom_cmd.size = sizeof(struct be_cmd_req_seeprom_read);
2b7bcebf
IV
682 eeprom_cmd.va = dma_alloc_coherent(&adapter->pdev->dev, eeprom_cmd.size,
683 &eeprom_cmd.dma, GFP_KERNEL);
368c0ca2
SB
684
685 if (!eeprom_cmd.va) {
686 dev_err(&adapter->pdev->dev,
687 "Memory allocation failure. Could not read eeprom\n");
688 return -ENOMEM;
689 }
690
691 status = be_cmd_get_seeprom_data(adapter, &eeprom_cmd);
692
693 if (!status) {
43d620c8 694 resp = eeprom_cmd.va;
c0ad9845 695 memcpy(data, resp->seeprom_data + eeprom->offset, eeprom->len);
368c0ca2 696 }
2b7bcebf
IV
697 dma_free_coherent(&adapter->pdev->dev, eeprom_cmd.size, eeprom_cmd.va,
698 eeprom_cmd.dma);
368c0ca2
SB
699
700 return status;
701}
702
0fc0b732 703const struct ethtool_ops be_ethtool_ops = {
6b7c5b94
SP
704 .get_settings = be_get_settings,
705 .get_drvinfo = be_get_drvinfo,
71d8d1b5
AK
706 .get_wol = be_get_wol,
707 .set_wol = be_set_wol,
6b7c5b94 708 .get_link = ethtool_op_get_link,
368c0ca2
SB
709 .get_eeprom_len = be_get_eeprom_len,
710 .get_eeprom = be_read_eeprom,
6b7c5b94
SP
711 .get_coalesce = be_get_coalesce,
712 .set_coalesce = be_set_coalesce,
713 .get_ringparam = be_get_ringparam,
714 .get_pauseparam = be_get_pauseparam,
715 .set_pauseparam = be_set_pauseparam,
6b7c5b94 716 .get_strings = be_get_stat_strings,
1a642469 717 .set_phys_id = be_set_phys_id,
15f0a394 718 .get_sset_count = be_get_sset_count,
6b7c5b94 719 .get_ethtool_stats = be_get_ethtool_stats,
311fddc7
SK
720 .get_regs_len = be_get_reg_len,
721 .get_regs = be_get_regs,
84517482 722 .flash_device = be_do_flash,
ff33a6e2 723 .self_test = be_self_test,
6b7c5b94 724};