]> bbs.cooldavid.org Git - net-next-2.6.git/blame - drivers/net/benet/be_ethtool.c
xps: Transmit Packet Steering
[net-next-2.6.git] / drivers / net / benet / be_ethtool.c
CommitLineData
6b7c5b94 1/*
294aedcf 2 * Copyright (C) 2005 - 2010 ServerEngines
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:
11 * linux-drivers@serverengines.com
12 *
13 * ServerEngines
14 * 209 N. Fair Oaks Ave
15 * Sunnyvale, CA 94085
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
3abcdeda 29enum {NETSTAT, PORTSTAT, MISCSTAT, DRVSTAT_TX, DRVSTAT_RX, ERXSTAT};
6b7c5b94
SP
30#define FIELDINFO(_struct, field) FIELD_SIZEOF(_struct, field), \
31 offsetof(_struct, field)
32#define NETSTAT_INFO(field) #field, NETSTAT,\
33 FIELDINFO(struct net_device_stats,\
34 field)
3abcdeda
SP
35#define DRVSTAT_TX_INFO(field) #field, DRVSTAT_TX,\
36 FIELDINFO(struct be_tx_stats, field)
37#define DRVSTAT_RX_INFO(field) #field, DRVSTAT_RX,\
38 FIELDINFO(struct be_rx_stats, field)
6b7c5b94
SP
39#define MISCSTAT_INFO(field) #field, MISCSTAT,\
40 FIELDINFO(struct be_rxf_stats, field)
41#define PORTSTAT_INFO(field) #field, PORTSTAT,\
42 FIELDINFO(struct be_port_rxf_stats, \
43 field)
44#define ERXSTAT_INFO(field) #field, ERXSTAT,\
45 FIELDINFO(struct be_erx_stats, field)
46
47static const struct be_ethtool_stat et_stats[] = {
48 {NETSTAT_INFO(rx_packets)},
49 {NETSTAT_INFO(tx_packets)},
50 {NETSTAT_INFO(rx_bytes)},
51 {NETSTAT_INFO(tx_bytes)},
52 {NETSTAT_INFO(rx_errors)},
53 {NETSTAT_INFO(tx_errors)},
54 {NETSTAT_INFO(rx_dropped)},
55 {NETSTAT_INFO(tx_dropped)},
3abcdeda
SP
56 {DRVSTAT_TX_INFO(be_tx_rate)},
57 {DRVSTAT_TX_INFO(be_tx_reqs)},
58 {DRVSTAT_TX_INFO(be_tx_wrbs)},
59 {DRVSTAT_TX_INFO(be_tx_stops)},
60 {DRVSTAT_TX_INFO(be_tx_events)},
61 {DRVSTAT_TX_INFO(be_tx_compl)},
6b7c5b94
SP
62 {PORTSTAT_INFO(rx_unicast_frames)},
63 {PORTSTAT_INFO(rx_multicast_frames)},
64 {PORTSTAT_INFO(rx_broadcast_frames)},
65 {PORTSTAT_INFO(rx_crc_errors)},
66 {PORTSTAT_INFO(rx_alignment_symbol_errors)},
67 {PORTSTAT_INFO(rx_pause_frames)},
68 {PORTSTAT_INFO(rx_control_frames)},
69 {PORTSTAT_INFO(rx_in_range_errors)},
70 {PORTSTAT_INFO(rx_out_range_errors)},
71 {PORTSTAT_INFO(rx_frame_too_long)},
72 {PORTSTAT_INFO(rx_address_match_errors)},
73 {PORTSTAT_INFO(rx_vlan_mismatch)},
74 {PORTSTAT_INFO(rx_dropped_too_small)},
75 {PORTSTAT_INFO(rx_dropped_too_short)},
76 {PORTSTAT_INFO(rx_dropped_header_too_small)},
77 {PORTSTAT_INFO(rx_dropped_tcp_length)},
78 {PORTSTAT_INFO(rx_dropped_runt)},
79 {PORTSTAT_INFO(rx_fifo_overflow)},
80 {PORTSTAT_INFO(rx_input_fifo_overflow)},
81 {PORTSTAT_INFO(rx_ip_checksum_errs)},
82 {PORTSTAT_INFO(rx_tcp_checksum_errs)},
83 {PORTSTAT_INFO(rx_udp_checksum_errs)},
84 {PORTSTAT_INFO(rx_non_rss_packets)},
85 {PORTSTAT_INFO(rx_ipv4_packets)},
86 {PORTSTAT_INFO(rx_ipv6_packets)},
def824c0
AK
87 {PORTSTAT_INFO(rx_switched_unicast_packets)},
88 {PORTSTAT_INFO(rx_switched_multicast_packets)},
89 {PORTSTAT_INFO(rx_switched_broadcast_packets)},
6b7c5b94
SP
90 {PORTSTAT_INFO(tx_unicastframes)},
91 {PORTSTAT_INFO(tx_multicastframes)},
92 {PORTSTAT_INFO(tx_broadcastframes)},
93 {PORTSTAT_INFO(tx_pauseframes)},
94 {PORTSTAT_INFO(tx_controlframes)},
95 {MISCSTAT_INFO(rx_drops_no_pbuf)},
96 {MISCSTAT_INFO(rx_drops_no_txpb)},
97 {MISCSTAT_INFO(rx_drops_no_erx_descr)},
98 {MISCSTAT_INFO(rx_drops_no_tpre_descr)},
99 {MISCSTAT_INFO(rx_drops_too_many_frags)},
100 {MISCSTAT_INFO(rx_drops_invalid_ring)},
101 {MISCSTAT_INFO(forwarded_packets)},
3abcdeda 102 {MISCSTAT_INFO(rx_drops_mtu)}
6b7c5b94
SP
103};
104#define ETHTOOL_STATS_NUM ARRAY_SIZE(et_stats)
105
3abcdeda
SP
106/* Stats related to multi RX queues */
107static const struct be_ethtool_stat et_rx_stats[] = {
108 {DRVSTAT_RX_INFO(rx_bytes)},
109 {DRVSTAT_RX_INFO(rx_pkts)},
110 {DRVSTAT_RX_INFO(rx_rate)},
111 {DRVSTAT_RX_INFO(rx_polls)},
112 {DRVSTAT_RX_INFO(rx_events)},
113 {DRVSTAT_RX_INFO(rx_compl)},
114 {DRVSTAT_RX_INFO(rx_mcast_pkts)},
115 {DRVSTAT_RX_INFO(rx_post_fail)},
116 {ERXSTAT_INFO(rx_drops_no_fragments)}
117};
118#define ETHTOOL_RXSTATS_NUM (ARRAY_SIZE(et_rx_stats))
119
ff33a6e2
S
120static const char et_self_tests[][ETH_GSTRING_LEN] = {
121 "MAC Loopback test",
122 "PHY Loopback test",
123 "External Loopback test",
124 "DDR DMA test"
4276e47e 125 "Link test"
ff33a6e2
S
126};
127
128#define ETHTOOL_TESTS_NUM ARRAY_SIZE(et_self_tests)
129#define BE_MAC_LOOPBACK 0x0
130#define BE_PHY_LOOPBACK 0x1
131#define BE_ONE_PORT_EXT_LOOPBACK 0x2
fced9999 132#define BE_NO_LOOPBACK 0xff
ff33a6e2 133
6b7c5b94
SP
134static void
135be_get_drvinfo(struct net_device *netdev, struct ethtool_drvinfo *drvinfo)
136{
137 struct be_adapter *adapter = netdev_priv(netdev);
138
139 strcpy(drvinfo->driver, DRV_NAME);
140 strcpy(drvinfo->version, DRV_VER);
141 strncpy(drvinfo->fw_version, adapter->fw_ver, FW_VER_LEN);
142 strcpy(drvinfo->bus_info, pci_name(adapter->pdev));
143 drvinfo->testinfo_len = 0;
144 drvinfo->regdump_len = 0;
145 drvinfo->eedump_len = 0;
146}
147
148static int
149be_get_coalesce(struct net_device *netdev, struct ethtool_coalesce *coalesce)
150{
151 struct be_adapter *adapter = netdev_priv(netdev);
3abcdeda 152 struct be_eq_obj *rx_eq = &adapter->rx_obj[0].rx_eq;
6b7c5b94
SP
153 struct be_eq_obj *tx_eq = &adapter->tx_eq;
154
6b7c5b94
SP
155 coalesce->rx_coalesce_usecs = rx_eq->cur_eqd;
156 coalesce->rx_coalesce_usecs_high = rx_eq->max_eqd;
157 coalesce->rx_coalesce_usecs_low = rx_eq->min_eqd;
158
159 coalesce->tx_coalesce_usecs = tx_eq->cur_eqd;
160 coalesce->tx_coalesce_usecs_high = tx_eq->max_eqd;
161 coalesce->tx_coalesce_usecs_low = tx_eq->min_eqd;
162
163 coalesce->use_adaptive_rx_coalesce = rx_eq->enable_aic;
164 coalesce->use_adaptive_tx_coalesce = tx_eq->enable_aic;
165
166 return 0;
167}
168
169/*
5be93b9a 170 * This routine is used to set interrup coalescing delay
6b7c5b94
SP
171 */
172static int
173be_set_coalesce(struct net_device *netdev, struct ethtool_coalesce *coalesce)
174{
175 struct be_adapter *adapter = netdev_priv(netdev);
3abcdeda
SP
176 struct be_rx_obj *rxo;
177 struct be_eq_obj *rx_eq;
6b7c5b94
SP
178 struct be_eq_obj *tx_eq = &adapter->tx_eq;
179 u32 tx_max, tx_min, tx_cur;
180 u32 rx_max, rx_min, rx_cur;
3abcdeda 181 int status = 0, i;
6b7c5b94
SP
182
183 if (coalesce->use_adaptive_tx_coalesce == 1)
184 return -EINVAL;
185
3abcdeda
SP
186 for_all_rx_queues(adapter, rxo, i) {
187 rx_eq = &rxo->rx_eq;
188
189 if (!rx_eq->enable_aic && coalesce->use_adaptive_rx_coalesce)
190 rx_eq->cur_eqd = 0;
191 rx_eq->enable_aic = coalesce->use_adaptive_rx_coalesce;
192
193 rx_max = coalesce->rx_coalesce_usecs_high;
194 rx_min = coalesce->rx_coalesce_usecs_low;
195 rx_cur = coalesce->rx_coalesce_usecs;
196
197 if (rx_eq->enable_aic) {
198 if (rx_max > BE_MAX_EQD)
199 rx_max = BE_MAX_EQD;
200 if (rx_min > rx_max)
201 rx_min = rx_max;
202 rx_eq->max_eqd = rx_max;
203 rx_eq->min_eqd = rx_min;
204 if (rx_eq->cur_eqd > rx_max)
205 rx_eq->cur_eqd = rx_max;
206 if (rx_eq->cur_eqd < rx_min)
207 rx_eq->cur_eqd = rx_min;
208 } else {
209 if (rx_cur > BE_MAX_EQD)
210 rx_cur = BE_MAX_EQD;
211 if (rx_eq->cur_eqd != rx_cur) {
212 status = be_cmd_modify_eqd(adapter, rx_eq->q.id,
213 rx_cur);
214 if (!status)
215 rx_eq->cur_eqd = rx_cur;
216 }
217 }
6b7c5b94 218 }
6b7c5b94
SP
219
220 tx_max = coalesce->tx_coalesce_usecs_high;
221 tx_min = coalesce->tx_coalesce_usecs_low;
222 tx_cur = coalesce->tx_coalesce_usecs;
223
224 if (tx_cur > BE_MAX_EQD)
225 tx_cur = BE_MAX_EQD;
226 if (tx_eq->cur_eqd != tx_cur) {
8788fdc2 227 status = be_cmd_modify_eqd(adapter, tx_eq->q.id, tx_cur);
6b7c5b94
SP
228 if (!status)
229 tx_eq->cur_eqd = tx_cur;
230 }
231
6b7c5b94
SP
232 return 0;
233}
234
235static u32 be_get_rx_csum(struct net_device *netdev)
236{
237 struct be_adapter *adapter = netdev_priv(netdev);
238
239 return adapter->rx_csum;
240}
241
242static int be_set_rx_csum(struct net_device *netdev, uint32_t data)
243{
244 struct be_adapter *adapter = netdev_priv(netdev);
245
246 if (data)
247 adapter->rx_csum = true;
248 else
249 adapter->rx_csum = false;
250
251 return 0;
252}
253
254static void
255be_get_ethtool_stats(struct net_device *netdev,
256 struct ethtool_stats *stats, uint64_t *data)
257{
258 struct be_adapter *adapter = netdev_priv(netdev);
3abcdeda 259 struct be_hw_stats *hw_stats = hw_stats_from_cmd(adapter->stats_cmd.va);
6b7c5b94 260 struct be_erx_stats *erx_stats = &hw_stats->erx;
3abcdeda 261 struct be_rx_obj *rxo;
6b7c5b94 262 void *p = NULL;
3abcdeda 263 int i, j;
6b7c5b94
SP
264
265 for (i = 0; i < ETHTOOL_STATS_NUM; i++) {
266 switch (et_stats[i].type) {
267 case NETSTAT:
3abcdeda 268 p = &netdev->stats;
6b7c5b94 269 break;
3abcdeda
SP
270 case DRVSTAT_TX:
271 p = &adapter->tx_stats;
6b7c5b94
SP
272 break;
273 case PORTSTAT:
3abcdeda 274 p = &hw_stats->rxf.port[adapter->port_num];
6b7c5b94
SP
275 break;
276 case MISCSTAT:
3abcdeda 277 p = &hw_stats->rxf;
6b7c5b94
SP
278 break;
279 }
280
281 p = (u8 *)p + et_stats[i].offset;
282 data[i] = (et_stats[i].size == sizeof(u64)) ?
283 *(u64 *)p: *(u32 *)p;
284 }
3abcdeda
SP
285
286 for_all_rx_queues(adapter, rxo, j) {
287 for (i = 0; i < ETHTOOL_RXSTATS_NUM; i++) {
288 switch (et_rx_stats[i].type) {
289 case DRVSTAT_RX:
290 p = (u8 *)&rxo->stats + et_rx_stats[i].offset;
291 break;
292 case ERXSTAT:
293 p = (u32 *)erx_stats + rxo->q.id;
294 break;
295 }
296 data[ETHTOOL_STATS_NUM + j * ETHTOOL_RXSTATS_NUM + i] =
297 (et_rx_stats[i].size == sizeof(u64)) ?
298 *(u64 *)p: *(u32 *)p;
299 }
300 }
6b7c5b94
SP
301}
302
303static void
304be_get_stat_strings(struct net_device *netdev, uint32_t stringset,
305 uint8_t *data)
306{
3abcdeda
SP
307 struct be_adapter *adapter = netdev_priv(netdev);
308 int i, j;
309
6b7c5b94
SP
310 switch (stringset) {
311 case ETH_SS_STATS:
312 for (i = 0; i < ETHTOOL_STATS_NUM; i++) {
313 memcpy(data, et_stats[i].desc, ETH_GSTRING_LEN);
314 data += ETH_GSTRING_LEN;
315 }
3abcdeda
SP
316 for (i = 0; i < adapter->num_rx_qs; i++) {
317 for (j = 0; j < ETHTOOL_RXSTATS_NUM; j++) {
318 sprintf(data, "rxq%d: %s", i,
319 et_rx_stats[j].desc);
320 data += ETH_GSTRING_LEN;
321 }
322 }
6b7c5b94 323 break;
ff33a6e2
S
324 case ETH_SS_TEST:
325 for (i = 0; i < ETHTOOL_TESTS_NUM; i++) {
326 memcpy(data, et_self_tests[i], ETH_GSTRING_LEN);
327 data += ETH_GSTRING_LEN;
328 }
329 break;
6b7c5b94
SP
330 }
331}
332
15f0a394 333static int be_get_sset_count(struct net_device *netdev, int stringset)
6b7c5b94 334{
3abcdeda
SP
335 struct be_adapter *adapter = netdev_priv(netdev);
336
15f0a394 337 switch (stringset) {
ff33a6e2
S
338 case ETH_SS_TEST:
339 return ETHTOOL_TESTS_NUM;
15f0a394 340 case ETH_SS_STATS:
3abcdeda
SP
341 return ETHTOOL_STATS_NUM +
342 adapter->num_rx_qs * ETHTOOL_RXSTATS_NUM;
15f0a394
BH
343 default:
344 return -EINVAL;
345 }
6b7c5b94
SP
346}
347
348static int be_get_settings(struct net_device *netdev, struct ethtool_cmd *ecmd)
349{
0388f251 350 struct be_adapter *adapter = netdev_priv(netdev);
ee3cb629
AK
351 struct be_dma_mem phy_cmd;
352 struct be_cmd_resp_get_phy_info *resp;
353 u8 mac_speed = 0;
0388f251
SB
354 u16 link_speed = 0;
355 bool link_up = false;
0dffc83e 356 int status;
ee3cb629 357 u16 intf_type;
0dffc83e 358
48e9989e 359 if ((adapter->link_speed < 0) || (!(netdev->flags & IFF_UP))) {
0dffc83e
AK
360 status = be_cmd_link_status_query(adapter, &link_up,
361 &mac_speed, &link_speed);
362
48e9989e 363 be_link_status_update(adapter, link_up);
0dffc83e
AK
364 /* link_speed is in units of 10 Mbps */
365 if (link_speed) {
366 ecmd->speed = link_speed*10;
367 } else {
368 switch (mac_speed) {
369 case PHY_LINK_SPEED_1GBPS:
370 ecmd->speed = SPEED_1000;
371 break;
372 case PHY_LINK_SPEED_10GBPS:
373 ecmd->speed = SPEED_10000;
374 break;
375 }
376 }
0388f251 377
ee3cb629
AK
378 phy_cmd.size = sizeof(struct be_cmd_req_get_phy_info);
379 phy_cmd.va = pci_alloc_consistent(adapter->pdev, phy_cmd.size,
380 &phy_cmd.dma);
381 if (!phy_cmd.va) {
382 dev_err(&adapter->pdev->dev, "Memory alloc failure\n");
383 return -ENOMEM;
384 }
385 status = be_cmd_get_phy_info(adapter, &phy_cmd);
16c02145 386 if (!status) {
ee3cb629
AK
387 resp = (struct be_cmd_resp_get_phy_info *) phy_cmd.va;
388 intf_type = le16_to_cpu(resp->interface_type);
389
390 switch (intf_type) {
391 case PHY_TYPE_XFP_10GB:
392 case PHY_TYPE_SFP_1GB:
393 case PHY_TYPE_SFP_PLUS_10GB:
16c02145 394 ecmd->port = PORT_FIBRE;
16c02145
SB
395 break;
396 default:
397 ecmd->port = PORT_TP;
16c02145
SB
398 break;
399 }
ee3cb629
AK
400
401 switch (intf_type) {
402 case PHY_TYPE_KR_10GB:
403 case PHY_TYPE_KX4_10GB:
404 ecmd->autoneg = AUTONEG_ENABLE;
16c02145 405 ecmd->transceiver = XCVR_INTERNAL;
ee3cb629
AK
406 break;
407 default:
408 ecmd->autoneg = AUTONEG_DISABLE;
409 ecmd->transceiver = XCVR_EXTERNAL;
410 break;
411 }
0388f251 412 }
0dffc83e
AK
413
414 /* Save for future use */
415 adapter->link_speed = ecmd->speed;
416 adapter->port_type = ecmd->port;
16c02145 417 adapter->transceiver = ecmd->transceiver;
ee3cb629
AK
418 adapter->autoneg = ecmd->autoneg;
419 pci_free_consistent(adapter->pdev, phy_cmd.size,
420 phy_cmd.va, phy_cmd.dma);
0dffc83e
AK
421 } else {
422 ecmd->speed = adapter->link_speed;
423 ecmd->port = adapter->port_type;
16c02145 424 ecmd->transceiver = adapter->transceiver;
ee3cb629 425 ecmd->autoneg = adapter->autoneg;
0388f251 426 }
0dffc83e 427
6b7c5b94 428 ecmd->duplex = DUPLEX_FULL;
0388f251 429 ecmd->phy_address = adapter->port_num;
16c02145
SB
430 switch (ecmd->port) {
431 case PORT_FIBRE:
432 ecmd->supported = (SUPPORTED_10000baseT_Full | SUPPORTED_FIBRE);
433 break;
434 case PORT_TP:
435 ecmd->supported = (SUPPORTED_10000baseT_Full | SUPPORTED_TP);
436 break;
437 case PORT_AUI:
438 ecmd->supported = (SUPPORTED_10000baseT_Full | SUPPORTED_AUI);
439 break;
440 }
0388f251 441
ee3cb629
AK
442 if (ecmd->autoneg) {
443 ecmd->supported |= SUPPORTED_1000baseT_Full;
444 ecmd->supported |= SUPPORTED_Autoneg;
445 ecmd->advertising |= (ADVERTISED_10000baseT_Full |
446 ADVERTISED_1000baseT_Full);
447 }
448
6b7c5b94
SP
449 return 0;
450}
451
452static void
453be_get_ringparam(struct net_device *netdev, struct ethtool_ringparam *ring)
454{
455 struct be_adapter *adapter = netdev_priv(netdev);
456
3abcdeda 457 ring->rx_max_pending = adapter->rx_obj[0].q.len;
6b7c5b94
SP
458 ring->tx_max_pending = adapter->tx_obj.q.len;
459
3abcdeda 460 ring->rx_pending = atomic_read(&adapter->rx_obj[0].q.used);
6b7c5b94
SP
461 ring->tx_pending = atomic_read(&adapter->tx_obj.q.used);
462}
463
464static void
465be_get_pauseparam(struct net_device *netdev, struct ethtool_pauseparam *ecmd)
466{
467 struct be_adapter *adapter = netdev_priv(netdev);
468
8788fdc2 469 be_cmd_get_flow_control(adapter, &ecmd->tx_pause, &ecmd->rx_pause);
03a980d1 470 ecmd->autoneg = 0;
6b7c5b94
SP
471}
472
473static int
474be_set_pauseparam(struct net_device *netdev, struct ethtool_pauseparam *ecmd)
475{
476 struct be_adapter *adapter = netdev_priv(netdev);
477 int status;
478
03a980d1 479 if (ecmd->autoneg != 0)
6b7c5b94 480 return -EINVAL;
9e90c961
AK
481 adapter->tx_fc = ecmd->tx_pause;
482 adapter->rx_fc = ecmd->rx_pause;
6b7c5b94 483
9e90c961
AK
484 status = be_cmd_set_flow_control(adapter,
485 adapter->tx_fc, adapter->rx_fc);
486 if (status)
6b7c5b94
SP
487 dev_warn(&adapter->pdev->dev, "Pause param set failed.\n");
488
489 return status;
490}
491
fad9ab2c
SB
492static int
493be_phys_id(struct net_device *netdev, u32 data)
494{
495 struct be_adapter *adapter = netdev_priv(netdev);
496 int status;
497 u32 cur;
498
fad9ab2c
SB
499 be_cmd_get_beacon_state(adapter, adapter->port_num, &cur);
500
501 if (cur == BEACON_STATE_ENABLED)
502 return 0;
503
504 if (data < 2)
505 data = 2;
506
507 status = be_cmd_set_beacon_state(adapter, adapter->port_num, 0, 0,
508 BEACON_STATE_ENABLED);
509 set_current_state(TASK_INTERRUPTIBLE);
510 schedule_timeout(data*HZ);
511
512 status = be_cmd_set_beacon_state(adapter, adapter->port_num, 0, 0,
513 BEACON_STATE_DISABLED);
514
515 return status;
516}
517
71d8d1b5
AK
518static void
519be_get_wol(struct net_device *netdev, struct ethtool_wolinfo *wol)
520{
521 struct be_adapter *adapter = netdev_priv(netdev);
522
523 wol->supported = WAKE_MAGIC;
524 if (adapter->wol)
525 wol->wolopts = WAKE_MAGIC;
526 else
527 wol->wolopts = 0;
528 memset(&wol->sopass, 0, sizeof(wol->sopass));
71d8d1b5
AK
529}
530
531static int
532be_set_wol(struct net_device *netdev, struct ethtool_wolinfo *wol)
533{
534 struct be_adapter *adapter = netdev_priv(netdev);
535
536 if (wol->wolopts & ~WAKE_MAGIC)
537 return -EINVAL;
538
539 if (wol->wolopts & WAKE_MAGIC)
540 adapter->wol = true;
541 else
542 adapter->wol = false;
543
544 return 0;
545}
546
ff33a6e2
S
547static int
548be_test_ddr_dma(struct be_adapter *adapter)
549{
550 int ret, i;
551 struct be_dma_mem ddrdma_cmd;
c0e4d4ba 552 u64 pattern[2] = {0x5a5a5a5a5a5a5a5aULL, 0xa5a5a5a5a5a5a5a5ULL};
ff33a6e2
S
553
554 ddrdma_cmd.size = sizeof(struct be_cmd_req_ddrdma_test);
555 ddrdma_cmd.va = pci_alloc_consistent(adapter->pdev, ddrdma_cmd.size,
556 &ddrdma_cmd.dma);
557 if (!ddrdma_cmd.va) {
2381a55c 558 dev_err(&adapter->pdev->dev, "Memory allocation failure\n");
ff33a6e2
S
559 return -ENOMEM;
560 }
561
562 for (i = 0; i < 2; i++) {
563 ret = be_cmd_ddr_dma_test(adapter, pattern[i],
564 4096, &ddrdma_cmd);
565 if (ret != 0)
566 goto err;
567 }
568
569err:
570 pci_free_consistent(adapter->pdev, ddrdma_cmd.size,
571 ddrdma_cmd.va, ddrdma_cmd.dma);
572 return ret;
573}
574
fced9999
SB
575static u64 be_loopback_test(struct be_adapter *adapter, u8 loopback_type,
576 u64 *status)
577{
578 be_cmd_set_loopback(adapter, adapter->port_num,
579 loopback_type, 1);
580 *status = be_cmd_loopback_test(adapter, adapter->port_num,
581 loopback_type, 1500,
582 2, 0xabc);
583 be_cmd_set_loopback(adapter, adapter->port_num,
584 BE_NO_LOOPBACK, 1);
585 return *status;
586}
587
ff33a6e2
S
588static void
589be_self_test(struct net_device *netdev, struct ethtool_test *test, u64 *data)
590{
591 struct be_adapter *adapter = netdev_priv(netdev);
4276e47e
SB
592 bool link_up;
593 u8 mac_speed = 0;
594 u16 qos_link_speed = 0;
ff33a6e2
S
595
596 memset(data, 0, sizeof(u64) * ETHTOOL_TESTS_NUM);
597
598 if (test->flags & ETH_TEST_FL_OFFLINE) {
fced9999
SB
599 if (be_loopback_test(adapter, BE_MAC_LOOPBACK,
600 &data[0]) != 0) {
ff33a6e2 601 test->flags |= ETH_TEST_FL_FAILED;
fced9999
SB
602 }
603 if (be_loopback_test(adapter, BE_PHY_LOOPBACK,
604 &data[1]) != 0) {
ff33a6e2 605 test->flags |= ETH_TEST_FL_FAILED;
fced9999
SB
606 }
607 if (be_loopback_test(adapter, BE_ONE_PORT_EXT_LOOPBACK,
608 &data[2]) != 0) {
ff33a6e2 609 test->flags |= ETH_TEST_FL_FAILED;
fced9999 610 }
8f47afe0 611 }
ff33a6e2 612
8f47afe0
SB
613 if (be_test_ddr_dma(adapter) != 0) {
614 data[3] = 1;
615 test->flags |= ETH_TEST_FL_FAILED;
ff33a6e2
S
616 }
617
4276e47e
SB
618 if (be_cmd_link_status_query(adapter, &link_up, &mac_speed,
619 &qos_link_speed) != 0) {
620 test->flags |= ETH_TEST_FL_FAILED;
621 data[4] = -1;
622 } else if (mac_speed) {
623 data[4] = 1;
624 }
ff33a6e2
S
625}
626
84517482
AK
627static int
628be_do_flash(struct net_device *netdev, struct ethtool_flash *efl)
629{
630 struct be_adapter *adapter = netdev_priv(netdev);
631 char file_name[ETHTOOL_FLASH_MAX_FILENAME];
632 u32 region;
633
634 file_name[ETHTOOL_FLASH_MAX_FILENAME - 1] = 0;
635 strcpy(file_name, efl->data);
636 region = efl->region;
637
638 return be_load_fw(adapter, file_name);
639}
640
368c0ca2
SB
641static int
642be_get_eeprom_len(struct net_device *netdev)
643{
644 return BE_READ_SEEPROM_LEN;
645}
646
647static int
648be_read_eeprom(struct net_device *netdev, struct ethtool_eeprom *eeprom,
649 uint8_t *data)
650{
651 struct be_adapter *adapter = netdev_priv(netdev);
652 struct be_dma_mem eeprom_cmd;
653 struct be_cmd_resp_seeprom_read *resp;
654 int status;
655
656 if (!eeprom->len)
657 return -EINVAL;
658
659 eeprom->magic = BE_VENDOR_ID | (adapter->pdev->device<<16);
660
661 memset(&eeprom_cmd, 0, sizeof(struct be_dma_mem));
662 eeprom_cmd.size = sizeof(struct be_cmd_req_seeprom_read);
663 eeprom_cmd.va = pci_alloc_consistent(adapter->pdev, eeprom_cmd.size,
664 &eeprom_cmd.dma);
665
666 if (!eeprom_cmd.va) {
667 dev_err(&adapter->pdev->dev,
668 "Memory allocation failure. Could not read eeprom\n");
669 return -ENOMEM;
670 }
671
672 status = be_cmd_get_seeprom_data(adapter, &eeprom_cmd);
673
674 if (!status) {
675 resp = (struct be_cmd_resp_seeprom_read *) eeprom_cmd.va;
c0ad9845 676 memcpy(data, resp->seeprom_data + eeprom->offset, eeprom->len);
368c0ca2
SB
677 }
678 pci_free_consistent(adapter->pdev, eeprom_cmd.size, eeprom_cmd.va,
679 eeprom_cmd.dma);
680
681 return status;
682}
683
0fc0b732 684const struct ethtool_ops be_ethtool_ops = {
6b7c5b94
SP
685 .get_settings = be_get_settings,
686 .get_drvinfo = be_get_drvinfo,
71d8d1b5
AK
687 .get_wol = be_get_wol,
688 .set_wol = be_set_wol,
6b7c5b94 689 .get_link = ethtool_op_get_link,
368c0ca2
SB
690 .get_eeprom_len = be_get_eeprom_len,
691 .get_eeprom = be_read_eeprom,
6b7c5b94
SP
692 .get_coalesce = be_get_coalesce,
693 .set_coalesce = be_set_coalesce,
694 .get_ringparam = be_get_ringparam,
695 .get_pauseparam = be_get_pauseparam,
696 .set_pauseparam = be_set_pauseparam,
697 .get_rx_csum = be_get_rx_csum,
698 .set_rx_csum = be_set_rx_csum,
699 .get_tx_csum = ethtool_op_get_tx_csum,
583e3f34 700 .set_tx_csum = ethtool_op_set_tx_hw_csum,
6b7c5b94
SP
701 .get_sg = ethtool_op_get_sg,
702 .set_sg = ethtool_op_set_sg,
703 .get_tso = ethtool_op_get_tso,
704 .set_tso = ethtool_op_set_tso,
705 .get_strings = be_get_stat_strings,
fad9ab2c 706 .phys_id = be_phys_id,
15f0a394 707 .get_sset_count = be_get_sset_count,
6b7c5b94 708 .get_ethtool_stats = be_get_ethtool_stats,
84517482 709 .flash_device = be_do_flash,
ff33a6e2 710 .self_test = be_self_test,
6b7c5b94 711};