1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18#include <linux/firmware.h>
19#include <linux/mdio.h>
20
21#include "cxgb4.h"
22#include "t4_regs.h"
23#include "t4fw_api.h"
24
25#define EEPROM_MAGIC 0x38E2F10C
26
27static u32 get_msglevel(struct net_device *dev)
28{
29 return netdev2adap(dev)->msg_enable;
30}
31
32static void set_msglevel(struct net_device *dev, u32 val)
33{
34 netdev2adap(dev)->msg_enable = val;
35}
36
37static const char stats_strings[][ETH_GSTRING_LEN] = {
38 "tx_octets_ok ",
39 "tx_frames_ok ",
40 "tx_broadcast_frames ",
41 "tx_multicast_frames ",
42 "tx_unicast_frames ",
43 "tx_error_frames ",
44
45 "tx_frames_64 ",
46 "tx_frames_65_to_127 ",
47 "tx_frames_128_to_255 ",
48 "tx_frames_256_to_511 ",
49 "tx_frames_512_to_1023 ",
50 "tx_frames_1024_to_1518 ",
51 "tx_frames_1519_to_max ",
52
53 "tx_frames_dropped ",
54 "tx_pause_frames ",
55 "tx_ppp0_frames ",
56 "tx_ppp1_frames ",
57 "tx_ppp2_frames ",
58 "tx_ppp3_frames ",
59 "tx_ppp4_frames ",
60 "tx_ppp5_frames ",
61 "tx_ppp6_frames ",
62 "tx_ppp7_frames ",
63
64 "rx_octets_ok ",
65 "rx_frames_ok ",
66 "rx_broadcast_frames ",
67 "rx_multicast_frames ",
68 "rx_unicast_frames ",
69
70 "rx_frames_too_long ",
71 "rx_jabber_errors ",
72 "rx_fcs_errors ",
73 "rx_length_errors ",
74 "rx_symbol_errors ",
75 "rx_runt_frames ",
76
77 "rx_frames_64 ",
78 "rx_frames_65_to_127 ",
79 "rx_frames_128_to_255 ",
80 "rx_frames_256_to_511 ",
81 "rx_frames_512_to_1023 ",
82 "rx_frames_1024_to_1518 ",
83 "rx_frames_1519_to_max ",
84
85 "rx_pause_frames ",
86 "rx_ppp0_frames ",
87 "rx_ppp1_frames ",
88 "rx_ppp2_frames ",
89 "rx_ppp3_frames ",
90 "rx_ppp4_frames ",
91 "rx_ppp5_frames ",
92 "rx_ppp6_frames ",
93 "rx_ppp7_frames ",
94
95 "rx_bg0_frames_dropped ",
96 "rx_bg1_frames_dropped ",
97 "rx_bg2_frames_dropped ",
98 "rx_bg3_frames_dropped ",
99 "rx_bg0_frames_trunc ",
100 "rx_bg1_frames_trunc ",
101 "rx_bg2_frames_trunc ",
102 "rx_bg3_frames_trunc ",
103
104 "tso ",
105 "tx_csum_offload ",
106 "rx_csum_good ",
107 "vlan_extractions ",
108 "vlan_insertions ",
109 "gro_packets ",
110 "gro_merged ",
111};
112
113static char adapter_stats_strings[][ETH_GSTRING_LEN] = {
114 "db_drop ",
115 "db_full ",
116 "db_empty ",
117 "tcp_ipv4_out_rsts ",
118 "tcp_ipv4_in_segs ",
119 "tcp_ipv4_out_segs ",
120 "tcp_ipv4_retrans_segs ",
121 "tcp_ipv6_out_rsts ",
122 "tcp_ipv6_in_segs ",
123 "tcp_ipv6_out_segs ",
124 "tcp_ipv6_retrans_segs ",
125 "usm_ddp_frames ",
126 "usm_ddp_octets ",
127 "usm_ddp_drops ",
128 "rdma_no_rqe_mod_defer ",
129 "rdma_no_rqe_pkt_defer ",
130 "tp_err_ofld_no_neigh ",
131 "tp_err_ofld_cong_defer ",
132 "write_coal_success ",
133 "write_coal_fail ",
134};
135
136static char channel_stats_strings[][ETH_GSTRING_LEN] = {
137 "--------Channel--------- ",
138 "tp_cpl_requests ",
139 "tp_cpl_responses ",
140 "tp_mac_in_errs ",
141 "tp_hdr_in_errs ",
142 "tp_tcp_in_errs ",
143 "tp_tcp6_in_errs ",
144 "tp_tnl_cong_drops ",
145 "tp_tnl_tx_drops ",
146 "tp_ofld_vlan_drops ",
147 "tp_ofld_chan_drops ",
148 "fcoe_octets_ddp ",
149 "fcoe_frames_ddp ",
150 "fcoe_frames_drop ",
151};
152
153static char loopback_stats_strings[][ETH_GSTRING_LEN] = {
154 "-------Loopback----------- ",
155 "octets_ok ",
156 "frames_ok ",
157 "bcast_frames ",
158 "mcast_frames ",
159 "ucast_frames ",
160 "error_frames ",
161 "frames_64 ",
162 "frames_65_to_127 ",
163 "frames_128_to_255 ",
164 "frames_256_to_511 ",
165 "frames_512_to_1023 ",
166 "frames_1024_to_1518 ",
167 "frames_1519_to_max ",
168 "frames_dropped ",
169 "bg0_frames_dropped ",
170 "bg1_frames_dropped ",
171 "bg2_frames_dropped ",
172 "bg3_frames_dropped ",
173 "bg0_frames_trunc ",
174 "bg1_frames_trunc ",
175 "bg2_frames_trunc ",
176 "bg3_frames_trunc ",
177};
178
179static int get_sset_count(struct net_device *dev, int sset)
180{
181 switch (sset) {
182 case ETH_SS_STATS:
183 return ARRAY_SIZE(stats_strings) +
184 ARRAY_SIZE(adapter_stats_strings) +
185 ARRAY_SIZE(channel_stats_strings) +
186 ARRAY_SIZE(loopback_stats_strings);
187 default:
188 return -EOPNOTSUPP;
189 }
190}
191
192static int get_regs_len(struct net_device *dev)
193{
194 struct adapter *adap = netdev2adap(dev);
195
196 return t4_get_regs_len(adap);
197}
198
199static int get_eeprom_len(struct net_device *dev)
200{
201 return EEPROMSIZE;
202}
203
204static void get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
205{
206 struct adapter *adapter = netdev2adap(dev);
207 u32 exprom_vers;
208
209 strlcpy(info->driver, cxgb4_driver_name, sizeof(info->driver));
210 strlcpy(info->version, cxgb4_driver_version,
211 sizeof(info->version));
212 strlcpy(info->bus_info, pci_name(adapter->pdev),
213 sizeof(info->bus_info));
214 info->regdump_len = get_regs_len(dev);
215
216 if (!adapter->params.fw_vers)
217 strcpy(info->fw_version, "N/A");
218 else
219 snprintf(info->fw_version, sizeof(info->fw_version),
220 "%u.%u.%u.%u, TP %u.%u.%u.%u",
221 FW_HDR_FW_VER_MAJOR_G(adapter->params.fw_vers),
222 FW_HDR_FW_VER_MINOR_G(adapter->params.fw_vers),
223 FW_HDR_FW_VER_MICRO_G(adapter->params.fw_vers),
224 FW_HDR_FW_VER_BUILD_G(adapter->params.fw_vers),
225 FW_HDR_FW_VER_MAJOR_G(adapter->params.tp_vers),
226 FW_HDR_FW_VER_MINOR_G(adapter->params.tp_vers),
227 FW_HDR_FW_VER_MICRO_G(adapter->params.tp_vers),
228 FW_HDR_FW_VER_BUILD_G(adapter->params.tp_vers));
229
230 if (!t4_get_exprom_version(adapter, &exprom_vers))
231 snprintf(info->erom_version, sizeof(info->erom_version),
232 "%u.%u.%u.%u",
233 FW_HDR_FW_VER_MAJOR_G(exprom_vers),
234 FW_HDR_FW_VER_MINOR_G(exprom_vers),
235 FW_HDR_FW_VER_MICRO_G(exprom_vers),
236 FW_HDR_FW_VER_BUILD_G(exprom_vers));
237}
238
239static void get_strings(struct net_device *dev, u32 stringset, u8 *data)
240{
241 if (stringset == ETH_SS_STATS) {
242 memcpy(data, stats_strings, sizeof(stats_strings));
243 data += sizeof(stats_strings);
244 memcpy(data, adapter_stats_strings,
245 sizeof(adapter_stats_strings));
246 data += sizeof(adapter_stats_strings);
247 memcpy(data, channel_stats_strings,
248 sizeof(channel_stats_strings));
249 data += sizeof(channel_stats_strings);
250 memcpy(data, loopback_stats_strings,
251 sizeof(loopback_stats_strings));
252 }
253}
254
255
256
257
258struct queue_port_stats {
259 u64 tso;
260 u64 tx_csum;
261 u64 rx_csum;
262 u64 vlan_ex;
263 u64 vlan_ins;
264 u64 gro_pkts;
265 u64 gro_merged;
266};
267
268struct adapter_stats {
269 u64 db_drop;
270 u64 db_full;
271 u64 db_empty;
272 u64 tcp_v4_out_rsts;
273 u64 tcp_v4_in_segs;
274 u64 tcp_v4_out_segs;
275 u64 tcp_v4_retrans_segs;
276 u64 tcp_v6_out_rsts;
277 u64 tcp_v6_in_segs;
278 u64 tcp_v6_out_segs;
279 u64 tcp_v6_retrans_segs;
280 u64 frames;
281 u64 octets;
282 u64 drops;
283 u64 rqe_dfr_mod;
284 u64 rqe_dfr_pkt;
285 u64 ofld_no_neigh;
286 u64 ofld_cong_defer;
287 u64 wc_success;
288 u64 wc_fail;
289};
290
291struct channel_stats {
292 u64 cpl_req;
293 u64 cpl_rsp;
294 u64 mac_in_errs;
295 u64 hdr_in_errs;
296 u64 tcp_in_errs;
297 u64 tcp6_in_errs;
298 u64 tnl_cong_drops;
299 u64 tnl_tx_drops;
300 u64 ofld_vlan_drops;
301 u64 ofld_chan_drops;
302 u64 octets_ddp;
303 u64 frames_ddp;
304 u64 frames_drop;
305};
306
307static void collect_sge_port_stats(const struct adapter *adap,
308 const struct port_info *p,
309 struct queue_port_stats *s)
310{
311 int i;
312 const struct sge_eth_txq *tx = &adap->sge.ethtxq[p->first_qset];
313 const struct sge_eth_rxq *rx = &adap->sge.ethrxq[p->first_qset];
314
315 memset(s, 0, sizeof(*s));
316 for (i = 0; i < p->nqsets; i++, rx++, tx++) {
317 s->tso += tx->tso;
318 s->tx_csum += tx->tx_cso;
319 s->rx_csum += rx->stats.rx_cso;
320 s->vlan_ex += rx->stats.vlan_ex;
321 s->vlan_ins += tx->vlan_ins;
322 s->gro_pkts += rx->stats.lro_pkts;
323 s->gro_merged += rx->stats.lro_merged;
324 }
325}
326
327static void collect_adapter_stats(struct adapter *adap, struct adapter_stats *s)
328{
329 struct tp_tcp_stats v4, v6;
330 struct tp_rdma_stats rdma_stats;
331 struct tp_err_stats err_stats;
332 struct tp_usm_stats usm_stats;
333 u64 val1, val2;
334
335 memset(s, 0, sizeof(*s));
336
337 spin_lock(&adap->stats_lock);
338 t4_tp_get_tcp_stats(adap, &v4, &v6);
339 t4_tp_get_rdma_stats(adap, &rdma_stats);
340 t4_get_usm_stats(adap, &usm_stats);
341 t4_tp_get_err_stats(adap, &err_stats);
342 spin_unlock(&adap->stats_lock);
343
344 s->db_drop = adap->db_stats.db_drop;
345 s->db_full = adap->db_stats.db_full;
346 s->db_empty = adap->db_stats.db_empty;
347
348 s->tcp_v4_out_rsts = v4.tcp_out_rsts;
349 s->tcp_v4_in_segs = v4.tcp_in_segs;
350 s->tcp_v4_out_segs = v4.tcp_out_segs;
351 s->tcp_v4_retrans_segs = v4.tcp_retrans_segs;
352 s->tcp_v6_out_rsts = v6.tcp_out_rsts;
353 s->tcp_v6_in_segs = v6.tcp_in_segs;
354 s->tcp_v6_out_segs = v6.tcp_out_segs;
355 s->tcp_v6_retrans_segs = v6.tcp_retrans_segs;
356
357 if (is_offload(adap)) {
358 s->frames = usm_stats.frames;
359 s->octets = usm_stats.octets;
360 s->drops = usm_stats.drops;
361 s->rqe_dfr_mod = rdma_stats.rqe_dfr_mod;
362 s->rqe_dfr_pkt = rdma_stats.rqe_dfr_pkt;
363 }
364
365 s->ofld_no_neigh = err_stats.ofld_no_neigh;
366 s->ofld_cong_defer = err_stats.ofld_cong_defer;
367
368 if (!is_t4(adap->params.chip)) {
369 int v;
370
371 v = t4_read_reg(adap, SGE_STAT_CFG_A);
372 if (STATSOURCE_T5_G(v) == 7) {
373 val2 = t4_read_reg(adap, SGE_STAT_MATCH_A);
374 val1 = t4_read_reg(adap, SGE_STAT_TOTAL_A);
375 s->wc_success = val1 - val2;
376 s->wc_fail = val2;
377 }
378 }
379}
380
381static void collect_channel_stats(struct adapter *adap, struct channel_stats *s,
382 u8 i)
383{
384 struct tp_cpl_stats cpl_stats;
385 struct tp_err_stats err_stats;
386 struct tp_fcoe_stats fcoe_stats;
387
388 memset(s, 0, sizeof(*s));
389
390 spin_lock(&adap->stats_lock);
391 t4_tp_get_cpl_stats(adap, &cpl_stats);
392 t4_tp_get_err_stats(adap, &err_stats);
393 t4_get_fcoe_stats(adap, i, &fcoe_stats);
394 spin_unlock(&adap->stats_lock);
395
396 s->cpl_req = cpl_stats.req[i];
397 s->cpl_rsp = cpl_stats.rsp[i];
398 s->mac_in_errs = err_stats.mac_in_errs[i];
399 s->hdr_in_errs = err_stats.hdr_in_errs[i];
400 s->tcp_in_errs = err_stats.tcp_in_errs[i];
401 s->tcp6_in_errs = err_stats.tcp6_in_errs[i];
402 s->tnl_cong_drops = err_stats.tnl_cong_drops[i];
403 s->tnl_tx_drops = err_stats.tnl_tx_drops[i];
404 s->ofld_vlan_drops = err_stats.ofld_vlan_drops[i];
405 s->ofld_chan_drops = err_stats.ofld_chan_drops[i];
406 s->octets_ddp = fcoe_stats.octets_ddp;
407 s->frames_ddp = fcoe_stats.frames_ddp;
408 s->frames_drop = fcoe_stats.frames_drop;
409}
410
411static void get_stats(struct net_device *dev, struct ethtool_stats *stats,
412 u64 *data)
413{
414 struct port_info *pi = netdev_priv(dev);
415 struct adapter *adapter = pi->adapter;
416 struct lb_port_stats s;
417 int i;
418 u64 *p0;
419
420 t4_get_port_stats_offset(adapter, pi->tx_chan,
421 (struct port_stats *)data,
422 &pi->stats_base);
423
424 data += sizeof(struct port_stats) / sizeof(u64);
425 collect_sge_port_stats(adapter, pi, (struct queue_port_stats *)data);
426 data += sizeof(struct queue_port_stats) / sizeof(u64);
427 collect_adapter_stats(adapter, (struct adapter_stats *)data);
428 data += sizeof(struct adapter_stats) / sizeof(u64);
429
430 *data++ = (u64)pi->port_id;
431 collect_channel_stats(adapter, (struct channel_stats *)data,
432 pi->port_id);
433 data += sizeof(struct channel_stats) / sizeof(u64);
434
435 *data++ = (u64)pi->port_id;
436 memset(&s, 0, sizeof(s));
437 t4_get_lb_stats(adapter, pi->port_id, &s);
438
439 p0 = &s.octets;
440 for (i = 0; i < ARRAY_SIZE(loopback_stats_strings) - 1; i++)
441 *data++ = (unsigned long long)*p0++;
442}
443
444static void get_regs(struct net_device *dev, struct ethtool_regs *regs,
445 void *buf)
446{
447 struct adapter *adap = netdev2adap(dev);
448 size_t buf_size;
449
450 buf_size = t4_get_regs_len(adap);
451 regs->version = mk_adap_vers(adap);
452 t4_get_regs(adap, buf, buf_size);
453}
454
455static int restart_autoneg(struct net_device *dev)
456{
457 struct port_info *p = netdev_priv(dev);
458
459 if (!netif_running(dev))
460 return -EAGAIN;
461 if (p->link_cfg.autoneg != AUTONEG_ENABLE)
462 return -EINVAL;
463 t4_restart_aneg(p->adapter, p->adapter->pf, p->tx_chan);
464 return 0;
465}
466
467static int identify_port(struct net_device *dev,
468 enum ethtool_phys_id_state state)
469{
470 unsigned int val;
471 struct adapter *adap = netdev2adap(dev);
472
473 if (state == ETHTOOL_ID_ACTIVE)
474 val = 0xffff;
475 else if (state == ETHTOOL_ID_INACTIVE)
476 val = 0;
477 else
478 return -EINVAL;
479
480 return t4_identify_port(adap, adap->pf, netdev2pinfo(dev)->viid, val);
481}
482
483static unsigned int from_fw_linkcaps(enum fw_port_type type, unsigned int caps)
484{
485 unsigned int v = 0;
486
487 if (type == FW_PORT_TYPE_BT_SGMII || type == FW_PORT_TYPE_BT_XFI ||
488 type == FW_PORT_TYPE_BT_XAUI) {
489 v |= SUPPORTED_TP;
490 if (caps & FW_PORT_CAP_SPEED_100M)
491 v |= SUPPORTED_100baseT_Full;
492 if (caps & FW_PORT_CAP_SPEED_1G)
493 v |= SUPPORTED_1000baseT_Full;
494 if (caps & FW_PORT_CAP_SPEED_10G)
495 v |= SUPPORTED_10000baseT_Full;
496 } else if (type == FW_PORT_TYPE_KX4 || type == FW_PORT_TYPE_KX) {
497 v |= SUPPORTED_Backplane;
498 if (caps & FW_PORT_CAP_SPEED_1G)
499 v |= SUPPORTED_1000baseKX_Full;
500 if (caps & FW_PORT_CAP_SPEED_10G)
501 v |= SUPPORTED_10000baseKX4_Full;
502 } else if (type == FW_PORT_TYPE_KR) {
503 v |= SUPPORTED_Backplane | SUPPORTED_10000baseKR_Full;
504 } else if (type == FW_PORT_TYPE_BP_AP) {
505 v |= SUPPORTED_Backplane | SUPPORTED_10000baseR_FEC |
506 SUPPORTED_10000baseKR_Full | SUPPORTED_1000baseKX_Full;
507 } else if (type == FW_PORT_TYPE_BP4_AP) {
508 v |= SUPPORTED_Backplane | SUPPORTED_10000baseR_FEC |
509 SUPPORTED_10000baseKR_Full | SUPPORTED_1000baseKX_Full |
510 SUPPORTED_10000baseKX4_Full;
511 } else if (type == FW_PORT_TYPE_FIBER_XFI ||
512 type == FW_PORT_TYPE_FIBER_XAUI ||
513 type == FW_PORT_TYPE_SFP ||
514 type == FW_PORT_TYPE_QSFP_10G ||
515 type == FW_PORT_TYPE_QSA) {
516 v |= SUPPORTED_FIBRE;
517 if (caps & FW_PORT_CAP_SPEED_1G)
518 v |= SUPPORTED_1000baseT_Full;
519 if (caps & FW_PORT_CAP_SPEED_10G)
520 v |= SUPPORTED_10000baseT_Full;
521 } else if (type == FW_PORT_TYPE_BP40_BA ||
522 type == FW_PORT_TYPE_QSFP) {
523 v |= SUPPORTED_40000baseSR4_Full;
524 v |= SUPPORTED_FIBRE;
525 }
526
527 if (caps & FW_PORT_CAP_ANEG)
528 v |= SUPPORTED_Autoneg;
529 return v;
530}
531
532static unsigned int to_fw_linkcaps(unsigned int caps)
533{
534 unsigned int v = 0;
535
536 if (caps & ADVERTISED_100baseT_Full)
537 v |= FW_PORT_CAP_SPEED_100M;
538 if (caps & ADVERTISED_1000baseT_Full)
539 v |= FW_PORT_CAP_SPEED_1G;
540 if (caps & ADVERTISED_10000baseT_Full)
541 v |= FW_PORT_CAP_SPEED_10G;
542 if (caps & ADVERTISED_40000baseSR4_Full)
543 v |= FW_PORT_CAP_SPEED_40G;
544 return v;
545}
546
547static int get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
548{
549 const struct port_info *p = netdev_priv(dev);
550
551 if (p->port_type == FW_PORT_TYPE_BT_SGMII ||
552 p->port_type == FW_PORT_TYPE_BT_XFI ||
553 p->port_type == FW_PORT_TYPE_BT_XAUI) {
554 cmd->port = PORT_TP;
555 } else if (p->port_type == FW_PORT_TYPE_FIBER_XFI ||
556 p->port_type == FW_PORT_TYPE_FIBER_XAUI) {
557 cmd->port = PORT_FIBRE;
558 } else if (p->port_type == FW_PORT_TYPE_SFP ||
559 p->port_type == FW_PORT_TYPE_QSFP_10G ||
560 p->port_type == FW_PORT_TYPE_QSA ||
561 p->port_type == FW_PORT_TYPE_QSFP) {
562 if (p->mod_type == FW_PORT_MOD_TYPE_LR ||
563 p->mod_type == FW_PORT_MOD_TYPE_SR ||
564 p->mod_type == FW_PORT_MOD_TYPE_ER ||
565 p->mod_type == FW_PORT_MOD_TYPE_LRM)
566 cmd->port = PORT_FIBRE;
567 else if (p->mod_type == FW_PORT_MOD_TYPE_TWINAX_PASSIVE ||
568 p->mod_type == FW_PORT_MOD_TYPE_TWINAX_ACTIVE)
569 cmd->port = PORT_DA;
570 else
571 cmd->port = PORT_OTHER;
572 } else {
573 cmd->port = PORT_OTHER;
574 }
575
576 if (p->mdio_addr >= 0) {
577 cmd->phy_address = p->mdio_addr;
578 cmd->transceiver = XCVR_EXTERNAL;
579 cmd->mdio_support = p->port_type == FW_PORT_TYPE_BT_SGMII ?
580 MDIO_SUPPORTS_C22 : MDIO_SUPPORTS_C45;
581 } else {
582 cmd->phy_address = 0;
583 cmd->transceiver = XCVR_INTERNAL;
584 cmd->mdio_support = 0;
585 }
586
587 cmd->supported = from_fw_linkcaps(p->port_type, p->link_cfg.supported);
588 cmd->advertising = from_fw_linkcaps(p->port_type,
589 p->link_cfg.advertising);
590 ethtool_cmd_speed_set(cmd,
591 netif_carrier_ok(dev) ? p->link_cfg.speed : 0);
592 cmd->duplex = DUPLEX_FULL;
593 cmd->autoneg = p->link_cfg.autoneg;
594 cmd->maxtxpkt = 0;
595 cmd->maxrxpkt = 0;
596 return 0;
597}
598
599static unsigned int speed_to_caps(int speed)
600{
601 if (speed == 100)
602 return FW_PORT_CAP_SPEED_100M;
603 if (speed == 1000)
604 return FW_PORT_CAP_SPEED_1G;
605 if (speed == 10000)
606 return FW_PORT_CAP_SPEED_10G;
607 if (speed == 40000)
608 return FW_PORT_CAP_SPEED_40G;
609 return 0;
610}
611
612static int set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
613{
614 unsigned int cap;
615 struct port_info *p = netdev_priv(dev);
616 struct link_config *lc = &p->link_cfg;
617 u32 speed = ethtool_cmd_speed(cmd);
618 struct link_config old_lc;
619 int ret;
620
621 if (cmd->duplex != DUPLEX_FULL)
622 return -EINVAL;
623
624 if (!(lc->supported & FW_PORT_CAP_ANEG)) {
625
626
627
628 if (cmd->autoneg == AUTONEG_DISABLE &&
629 (lc->supported & speed_to_caps(speed)))
630 return 0;
631 return -EINVAL;
632 }
633
634 old_lc = *lc;
635 if (cmd->autoneg == AUTONEG_DISABLE) {
636 cap = speed_to_caps(speed);
637
638 if (!(lc->supported & cap))
639 return -EINVAL;
640 lc->requested_speed = cap;
641 lc->advertising = 0;
642 } else {
643 cap = to_fw_linkcaps(cmd->advertising);
644 if (!(lc->supported & cap))
645 return -EINVAL;
646 lc->requested_speed = 0;
647 lc->advertising = cap | FW_PORT_CAP_ANEG;
648 }
649 lc->autoneg = cmd->autoneg;
650
651
652
653
654 ret = t4_link_l1cfg(p->adapter, p->adapter->mbox, p->tx_chan, lc);
655 if (ret)
656 *lc = old_lc;
657
658 return ret;
659}
660
661static void get_pauseparam(struct net_device *dev,
662 struct ethtool_pauseparam *epause)
663{
664 struct port_info *p = netdev_priv(dev);
665
666 epause->autoneg = (p->link_cfg.requested_fc & PAUSE_AUTONEG) != 0;
667 epause->rx_pause = (p->link_cfg.fc & PAUSE_RX) != 0;
668 epause->tx_pause = (p->link_cfg.fc & PAUSE_TX) != 0;
669}
670
671static int set_pauseparam(struct net_device *dev,
672 struct ethtool_pauseparam *epause)
673{
674 struct port_info *p = netdev_priv(dev);
675 struct link_config *lc = &p->link_cfg;
676
677 if (epause->autoneg == AUTONEG_DISABLE)
678 lc->requested_fc = 0;
679 else if (lc->supported & FW_PORT_CAP_ANEG)
680 lc->requested_fc = PAUSE_AUTONEG;
681 else
682 return -EINVAL;
683
684 if (epause->rx_pause)
685 lc->requested_fc |= PAUSE_RX;
686 if (epause->tx_pause)
687 lc->requested_fc |= PAUSE_TX;
688 if (netif_running(dev))
689 return t4_link_l1cfg(p->adapter, p->adapter->mbox, p->tx_chan,
690 lc);
691 return 0;
692}
693
694static void get_sge_param(struct net_device *dev, struct ethtool_ringparam *e)
695{
696 const struct port_info *pi = netdev_priv(dev);
697 const struct sge *s = &pi->adapter->sge;
698
699 e->rx_max_pending = MAX_RX_BUFFERS;
700 e->rx_mini_max_pending = MAX_RSPQ_ENTRIES;
701 e->rx_jumbo_max_pending = 0;
702 e->tx_max_pending = MAX_TXQ_ENTRIES;
703
704 e->rx_pending = s->ethrxq[pi->first_qset].fl.size - 8;
705 e->rx_mini_pending = s->ethrxq[pi->first_qset].rspq.size;
706 e->rx_jumbo_pending = 0;
707 e->tx_pending = s->ethtxq[pi->first_qset].q.size;
708}
709
710static int set_sge_param(struct net_device *dev, struct ethtool_ringparam *e)
711{
712 int i;
713 const struct port_info *pi = netdev_priv(dev);
714 struct adapter *adapter = pi->adapter;
715 struct sge *s = &adapter->sge;
716
717 if (e->rx_pending > MAX_RX_BUFFERS || e->rx_jumbo_pending ||
718 e->tx_pending > MAX_TXQ_ENTRIES ||
719 e->rx_mini_pending > MAX_RSPQ_ENTRIES ||
720 e->rx_mini_pending < MIN_RSPQ_ENTRIES ||
721 e->rx_pending < MIN_FL_ENTRIES || e->tx_pending < MIN_TXQ_ENTRIES)
722 return -EINVAL;
723
724 if (adapter->flags & FULL_INIT_DONE)
725 return -EBUSY;
726
727 for (i = 0; i < pi->nqsets; ++i) {
728 s->ethtxq[pi->first_qset + i].q.size = e->tx_pending;
729 s->ethrxq[pi->first_qset + i].fl.size = e->rx_pending + 8;
730 s->ethrxq[pi->first_qset + i].rspq.size = e->rx_mini_pending;
731 }
732 return 0;
733}
734
735
736
737
738
739
740
741
742
743static int set_rx_intr_params(struct net_device *dev,
744 unsigned int us, unsigned int cnt)
745{
746 int i, err;
747 struct port_info *pi = netdev_priv(dev);
748 struct adapter *adap = pi->adapter;
749 struct sge_eth_rxq *q = &adap->sge.ethrxq[pi->first_qset];
750
751 for (i = 0; i < pi->nqsets; i++, q++) {
752 err = cxgb4_set_rspq_intr_params(&q->rspq, us, cnt);
753 if (err)
754 return err;
755 }
756 return 0;
757}
758
759static int set_adaptive_rx_setting(struct net_device *dev, int adaptive_rx)
760{
761 int i;
762 struct port_info *pi = netdev_priv(dev);
763 struct adapter *adap = pi->adapter;
764 struct sge_eth_rxq *q = &adap->sge.ethrxq[pi->first_qset];
765
766 for (i = 0; i < pi->nqsets; i++, q++)
767 q->rspq.adaptive_rx = adaptive_rx;
768
769 return 0;
770}
771
772static int get_adaptive_rx_setting(struct net_device *dev)
773{
774 struct port_info *pi = netdev_priv(dev);
775 struct adapter *adap = pi->adapter;
776 struct sge_eth_rxq *q = &adap->sge.ethrxq[pi->first_qset];
777
778 return q->rspq.adaptive_rx;
779}
780
781static int set_coalesce(struct net_device *dev, struct ethtool_coalesce *c)
782{
783 set_adaptive_rx_setting(dev, c->use_adaptive_rx_coalesce);
784 return set_rx_intr_params(dev, c->rx_coalesce_usecs,
785 c->rx_max_coalesced_frames);
786}
787
788static int get_coalesce(struct net_device *dev, struct ethtool_coalesce *c)
789{
790 const struct port_info *pi = netdev_priv(dev);
791 const struct adapter *adap = pi->adapter;
792 const struct sge_rspq *rq = &adap->sge.ethrxq[pi->first_qset].rspq;
793
794 c->rx_coalesce_usecs = qtimer_val(adap, rq);
795 c->rx_max_coalesced_frames = (rq->intr_params & QINTR_CNT_EN_F) ?
796 adap->sge.counter_val[rq->pktcnt_idx] : 0;
797 c->use_adaptive_rx_coalesce = get_adaptive_rx_setting(dev);
798 return 0;
799}
800
801
802
803
804
805
806
807
808
809
810
811
812
813
814
815
816
817
818static int eeprom_ptov(unsigned int phys_addr, unsigned int fn, unsigned int sz)
819{
820 fn *= sz;
821 if (phys_addr < 1024)
822 return phys_addr + (31 << 10);
823 if (phys_addr < 1024 + fn)
824 return 31744 - fn + phys_addr - 1024;
825 if (phys_addr < EEPROMSIZE)
826 return phys_addr - 1024 - fn;
827 return -EINVAL;
828}
829
830
831
832static int eeprom_rd_phys(struct adapter *adap, unsigned int phys_addr, u32 *v)
833{
834 int vaddr = eeprom_ptov(phys_addr, adap->pf, EEPROMPFSIZE);
835
836 if (vaddr >= 0)
837 vaddr = pci_read_vpd(adap->pdev, vaddr, sizeof(u32), v);
838 return vaddr < 0 ? vaddr : 0;
839}
840
841static int eeprom_wr_phys(struct adapter *adap, unsigned int phys_addr, u32 v)
842{
843 int vaddr = eeprom_ptov(phys_addr, adap->pf, EEPROMPFSIZE);
844
845 if (vaddr >= 0)
846 vaddr = pci_write_vpd(adap->pdev, vaddr, sizeof(u32), &v);
847 return vaddr < 0 ? vaddr : 0;
848}
849
850#define EEPROM_MAGIC 0x38E2F10C
851
852static int get_eeprom(struct net_device *dev, struct ethtool_eeprom *e,
853 u8 *data)
854{
855 int i, err = 0;
856 struct adapter *adapter = netdev2adap(dev);
857 u8 *buf = t4_alloc_mem(EEPROMSIZE);
858
859 if (!buf)
860 return -ENOMEM;
861
862 e->magic = EEPROM_MAGIC;
863 for (i = e->offset & ~3; !err && i < e->offset + e->len; i += 4)
864 err = eeprom_rd_phys(adapter, i, (u32 *)&buf[i]);
865
866 if (!err)
867 memcpy(data, buf + e->offset, e->len);
868 t4_free_mem(buf);
869 return err;
870}
871
872static int set_eeprom(struct net_device *dev, struct ethtool_eeprom *eeprom,
873 u8 *data)
874{
875 u8 *buf;
876 int err = 0;
877 u32 aligned_offset, aligned_len, *p;
878 struct adapter *adapter = netdev2adap(dev);
879
880 if (eeprom->magic != EEPROM_MAGIC)
881 return -EINVAL;
882
883 aligned_offset = eeprom->offset & ~3;
884 aligned_len = (eeprom->len + (eeprom->offset & 3) + 3) & ~3;
885
886 if (adapter->pf > 0) {
887 u32 start = 1024 + adapter->pf * EEPROMPFSIZE;
888
889 if (aligned_offset < start ||
890 aligned_offset + aligned_len > start + EEPROMPFSIZE)
891 return -EPERM;
892 }
893
894 if (aligned_offset != eeprom->offset || aligned_len != eeprom->len) {
895
896
897 buf = t4_alloc_mem(aligned_len);
898 if (!buf)
899 return -ENOMEM;
900 err = eeprom_rd_phys(adapter, aligned_offset, (u32 *)buf);
901 if (!err && aligned_len > 4)
902 err = eeprom_rd_phys(adapter,
903 aligned_offset + aligned_len - 4,
904 (u32 *)&buf[aligned_len - 4]);
905 if (err)
906 goto out;
907 memcpy(buf + (eeprom->offset & 3), data, eeprom->len);
908 } else {
909 buf = data;
910 }
911
912 err = t4_seeprom_wp(adapter, false);
913 if (err)
914 goto out;
915
916 for (p = (u32 *)buf; !err && aligned_len; aligned_len -= 4, p++) {
917 err = eeprom_wr_phys(adapter, aligned_offset, *p);
918 aligned_offset += 4;
919 }
920
921 if (!err)
922 err = t4_seeprom_wp(adapter, true);
923out:
924 if (buf != data)
925 t4_free_mem(buf);
926 return err;
927}
928
929static int set_flash(struct net_device *netdev, struct ethtool_flash *ef)
930{
931 int ret;
932 const struct firmware *fw;
933 struct adapter *adap = netdev2adap(netdev);
934 unsigned int mbox = PCIE_FW_MASTER_M + 1;
935 u32 pcie_fw;
936 unsigned int master;
937 u8 master_vld = 0;
938
939 pcie_fw = t4_read_reg(adap, PCIE_FW_A);
940 master = PCIE_FW_MASTER_G(pcie_fw);
941 if (pcie_fw & PCIE_FW_MASTER_VLD_F)
942 master_vld = 1;
943
944 if (master_vld && (master != adap->pf)) {
945 dev_warn(adap->pdev_dev,
946 "cxgb4 driver needs to be loaded as MASTER to support FW flash\n");
947 return -EOPNOTSUPP;
948 }
949
950 ef->data[sizeof(ef->data) - 1] = '\0';
951 ret = request_firmware(&fw, ef->data, adap->pdev_dev);
952 if (ret < 0)
953 return ret;
954
955
956
957
958
959
960 if (adap->flags & FULL_INIT_DONE)
961 mbox = adap->mbox;
962
963 ret = t4_fw_upgrade(adap, mbox, fw->data, fw->size, 1);
964 release_firmware(fw);
965 if (!ret)
966 dev_info(adap->pdev_dev,
967 "loaded firmware %s, reload cxgb4 driver\n", ef->data);
968 return ret;
969}
970
971static int get_ts_info(struct net_device *dev, struct ethtool_ts_info *ts_info)
972{
973 ts_info->so_timestamping = SOF_TIMESTAMPING_TX_SOFTWARE |
974 SOF_TIMESTAMPING_RX_SOFTWARE |
975 SOF_TIMESTAMPING_SOFTWARE;
976
977 ts_info->so_timestamping |= SOF_TIMESTAMPING_RX_HARDWARE |
978 SOF_TIMESTAMPING_RAW_HARDWARE;
979
980 ts_info->phc_index = -1;
981
982 return 0;
983}
984
985static u32 get_rss_table_size(struct net_device *dev)
986{
987 const struct port_info *pi = netdev_priv(dev);
988
989 return pi->rss_size;
990}
991
992static int get_rss_table(struct net_device *dev, u32 *p, u8 *key, u8 *hfunc)
993{
994 const struct port_info *pi = netdev_priv(dev);
995 unsigned int n = pi->rss_size;
996
997 if (hfunc)
998 *hfunc = ETH_RSS_HASH_TOP;
999 if (!p)
1000 return 0;
1001 while (n--)
1002 p[n] = pi->rss[n];
1003 return 0;
1004}
1005
1006static int set_rss_table(struct net_device *dev, const u32 *p, const u8 *key,
1007 const u8 hfunc)
1008{
1009 unsigned int i;
1010 struct port_info *pi = netdev_priv(dev);
1011
1012
1013
1014
1015 if (key ||
1016 (hfunc != ETH_RSS_HASH_NO_CHANGE && hfunc != ETH_RSS_HASH_TOP))
1017 return -EOPNOTSUPP;
1018 if (!p)
1019 return 0;
1020
1021
1022 if (pi->adapter->flags & FULL_INIT_DONE) {
1023 for (i = 0; i < pi->rss_size; i++)
1024 pi->rss[i] = p[i];
1025
1026 return cxgb4_write_rss(pi, pi->rss);
1027 }
1028
1029 return -EPERM;
1030}
1031
1032static int get_rxnfc(struct net_device *dev, struct ethtool_rxnfc *info,
1033 u32 *rules)
1034{
1035 const struct port_info *pi = netdev_priv(dev);
1036
1037 switch (info->cmd) {
1038 case ETHTOOL_GRXFH: {
1039 unsigned int v = pi->rss_mode;
1040
1041 info->data = 0;
1042 switch (info->flow_type) {
1043 case TCP_V4_FLOW:
1044 if (v & FW_RSS_VI_CONFIG_CMD_IP4FOURTUPEN_F)
1045 info->data = RXH_IP_SRC | RXH_IP_DST |
1046 RXH_L4_B_0_1 | RXH_L4_B_2_3;
1047 else if (v & FW_RSS_VI_CONFIG_CMD_IP4TWOTUPEN_F)
1048 info->data = RXH_IP_SRC | RXH_IP_DST;
1049 break;
1050 case UDP_V4_FLOW:
1051 if ((v & FW_RSS_VI_CONFIG_CMD_IP4FOURTUPEN_F) &&
1052 (v & FW_RSS_VI_CONFIG_CMD_UDPEN_F))
1053 info->data = RXH_IP_SRC | RXH_IP_DST |
1054 RXH_L4_B_0_1 | RXH_L4_B_2_3;
1055 else if (v & FW_RSS_VI_CONFIG_CMD_IP4TWOTUPEN_F)
1056 info->data = RXH_IP_SRC | RXH_IP_DST;
1057 break;
1058 case SCTP_V4_FLOW:
1059 case AH_ESP_V4_FLOW:
1060 case IPV4_FLOW:
1061 if (v & FW_RSS_VI_CONFIG_CMD_IP4TWOTUPEN_F)
1062 info->data = RXH_IP_SRC | RXH_IP_DST;
1063 break;
1064 case TCP_V6_FLOW:
1065 if (v & FW_RSS_VI_CONFIG_CMD_IP6FOURTUPEN_F)
1066 info->data = RXH_IP_SRC | RXH_IP_DST |
1067 RXH_L4_B_0_1 | RXH_L4_B_2_3;
1068 else if (v & FW_RSS_VI_CONFIG_CMD_IP6TWOTUPEN_F)
1069 info->data = RXH_IP_SRC | RXH_IP_DST;
1070 break;
1071 case UDP_V6_FLOW:
1072 if ((v & FW_RSS_VI_CONFIG_CMD_IP6FOURTUPEN_F) &&
1073 (v & FW_RSS_VI_CONFIG_CMD_UDPEN_F))
1074 info->data = RXH_IP_SRC | RXH_IP_DST |
1075 RXH_L4_B_0_1 | RXH_L4_B_2_3;
1076 else if (v & FW_RSS_VI_CONFIG_CMD_IP6TWOTUPEN_F)
1077 info->data = RXH_IP_SRC | RXH_IP_DST;
1078 break;
1079 case SCTP_V6_FLOW:
1080 case AH_ESP_V6_FLOW:
1081 case IPV6_FLOW:
1082 if (v & FW_RSS_VI_CONFIG_CMD_IP6TWOTUPEN_F)
1083 info->data = RXH_IP_SRC | RXH_IP_DST;
1084 break;
1085 }
1086 return 0;
1087 }
1088 case ETHTOOL_GRXRINGS:
1089 info->data = pi->nqsets;
1090 return 0;
1091 }
1092 return -EOPNOTSUPP;
1093}
1094
1095static const struct ethtool_ops cxgb_ethtool_ops = {
1096 .get_settings = get_settings,
1097 .set_settings = set_settings,
1098 .get_drvinfo = get_drvinfo,
1099 .get_msglevel = get_msglevel,
1100 .set_msglevel = set_msglevel,
1101 .get_ringparam = get_sge_param,
1102 .set_ringparam = set_sge_param,
1103 .get_coalesce = get_coalesce,
1104 .set_coalesce = set_coalesce,
1105 .get_eeprom_len = get_eeprom_len,
1106 .get_eeprom = get_eeprom,
1107 .set_eeprom = set_eeprom,
1108 .get_pauseparam = get_pauseparam,
1109 .set_pauseparam = set_pauseparam,
1110 .get_link = ethtool_op_get_link,
1111 .get_strings = get_strings,
1112 .set_phys_id = identify_port,
1113 .nway_reset = restart_autoneg,
1114 .get_sset_count = get_sset_count,
1115 .get_ethtool_stats = get_stats,
1116 .get_regs_len = get_regs_len,
1117 .get_regs = get_regs,
1118 .get_rxnfc = get_rxnfc,
1119 .get_rxfh_indir_size = get_rss_table_size,
1120 .get_rxfh = get_rss_table,
1121 .set_rxfh = set_rss_table,
1122 .flash_device = set_flash,
1123 .get_ts_info = get_ts_info
1124};
1125
1126void cxgb4_set_ethtool_ops(struct net_device *netdev)
1127{
1128 netdev->ethtool_ops = &cxgb_ethtool_ops;
1129}
1130
