2 * aQuantia Corporation Network Driver
3 * Copyright (C) 2014-2017 aQuantia Corporation. All rights reserved
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms and conditions of the GNU General Public License,
7 * version 2, as published by the Free Software Foundation.
10 /* File aq_ethtool.c: Definition of ethertool related functions. */
12 #include "aq_ethtool.h"
15 static void aq_ethtool_get_regs(struct net_device
*ndev
,
16 struct ethtool_regs
*regs
, void *p
)
18 struct aq_nic_s
*aq_nic
= netdev_priv(ndev
);
19 u32 regs_count
= aq_nic_get_regs_count(aq_nic
);
21 memset(p
, 0, regs_count
* sizeof(u32
));
22 aq_nic_get_regs(aq_nic
, regs
, p
);
25 static int aq_ethtool_get_regs_len(struct net_device
*ndev
)
27 struct aq_nic_s
*aq_nic
= netdev_priv(ndev
);
28 u32 regs_count
= aq_nic_get_regs_count(aq_nic
);
30 return regs_count
* sizeof(u32
);
33 static u32
aq_ethtool_get_link(struct net_device
*ndev
)
35 return ethtool_op_get_link(ndev
);
38 static int aq_ethtool_get_link_ksettings(struct net_device
*ndev
,
39 struct ethtool_link_ksettings
*cmd
)
41 struct aq_nic_s
*aq_nic
= netdev_priv(ndev
);
43 aq_nic_get_link_ksettings(aq_nic
, cmd
);
44 cmd
->base
.speed
= netif_carrier_ok(ndev
) ?
45 aq_nic_get_link_speed(aq_nic
) : 0U;
51 aq_ethtool_set_link_ksettings(struct net_device
*ndev
,
52 const struct ethtool_link_ksettings
*cmd
)
54 struct aq_nic_s
*aq_nic
= netdev_priv(ndev
);
56 return aq_nic_set_link_ksettings(aq_nic
, cmd
);
59 /* there "5U" is number of queue[#] stats lines (InPackets+...+InErrors) */
60 static const unsigned int aq_ethtool_stat_queue_lines
= 5U;
61 static const unsigned int aq_ethtool_stat_queue_chars
=
63 static const char aq_ethtool_stat_names
[][ETH_GSTRING_LEN
] = {
87 "Queue[0] OutPackets",
88 "Queue[0] InJumboPackets",
89 "Queue[0] InLroPackets",
92 "Queue[1] OutPackets",
93 "Queue[1] InJumboPackets",
94 "Queue[1] InLroPackets",
97 "Queue[2] OutPackets",
98 "Queue[2] InJumboPackets",
99 "Queue[2] InLroPackets",
101 "Queue[3] InPackets",
102 "Queue[3] OutPackets",
103 "Queue[3] InJumboPackets",
104 "Queue[3] InLroPackets",
106 "Queue[4] InPackets",
107 "Queue[4] OutPackets",
108 "Queue[4] InJumboPackets",
109 "Queue[4] InLroPackets",
111 "Queue[5] InPackets",
112 "Queue[5] OutPackets",
113 "Queue[5] InJumboPackets",
114 "Queue[5] InLroPackets",
116 "Queue[6] InPackets",
117 "Queue[6] OutPackets",
118 "Queue[6] InJumboPackets",
119 "Queue[6] InLroPackets",
121 "Queue[7] InPackets",
122 "Queue[7] OutPackets",
123 "Queue[7] InJumboPackets",
124 "Queue[7] InLroPackets",
128 static void aq_ethtool_stats(struct net_device
*ndev
,
129 struct ethtool_stats
*stats
, u64
*data
)
131 struct aq_nic_s
*aq_nic
= netdev_priv(ndev
);
133 /* ASSERT: Need add lines to aq_ethtool_stat_names if AQ_CFG_VECS_MAX > 8 */
134 BUILD_BUG_ON(AQ_CFG_VECS_MAX
> 8);
135 memset(data
, 0, ARRAY_SIZE(aq_ethtool_stat_names
) * sizeof(u64
));
136 aq_nic_get_stats(aq_nic
, data
);
139 static void aq_ethtool_get_drvinfo(struct net_device
*ndev
,
140 struct ethtool_drvinfo
*drvinfo
)
142 struct aq_nic_s
*aq_nic
= netdev_priv(ndev
);
143 struct aq_nic_cfg_s
*cfg
= aq_nic_get_cfg(aq_nic
);
144 struct pci_dev
*pdev
= to_pci_dev(ndev
->dev
.parent
);
145 u32 firmware_version
= aq_nic_get_fw_version(aq_nic
);
146 u32 regs_count
= aq_nic_get_regs_count(aq_nic
);
148 strlcat(drvinfo
->driver
, AQ_CFG_DRV_NAME
, sizeof(drvinfo
->driver
));
149 strlcat(drvinfo
->version
, AQ_CFG_DRV_VERSION
, sizeof(drvinfo
->version
));
151 snprintf(drvinfo
->fw_version
, sizeof(drvinfo
->fw_version
),
152 "%u.%u.%u", firmware_version
>> 24,
153 (firmware_version
>> 16) & 0xFFU
, firmware_version
& 0xFFFFU
);
155 strlcpy(drvinfo
->bus_info
, pdev
? pci_name(pdev
) : "",
156 sizeof(drvinfo
->bus_info
));
157 drvinfo
->n_stats
= ARRAY_SIZE(aq_ethtool_stat_names
) -
158 (AQ_CFG_VECS_MAX
- cfg
->vecs
) * aq_ethtool_stat_queue_lines
;
159 drvinfo
->testinfo_len
= 0;
160 drvinfo
->regdump_len
= regs_count
;
161 drvinfo
->eedump_len
= 0;
164 static void aq_ethtool_get_strings(struct net_device
*ndev
,
165 u32 stringset
, u8
*data
)
167 struct aq_nic_s
*aq_nic
= netdev_priv(ndev
);
168 struct aq_nic_cfg_s
*cfg
= aq_nic_get_cfg(aq_nic
);
170 if (stringset
== ETH_SS_STATS
)
171 memcpy(data
, *aq_ethtool_stat_names
,
172 sizeof(aq_ethtool_stat_names
) -
173 (AQ_CFG_VECS_MAX
- cfg
->vecs
) *
174 aq_ethtool_stat_queue_chars
);
177 static int aq_ethtool_get_sset_count(struct net_device
*ndev
, int stringset
)
180 struct aq_nic_s
*aq_nic
= netdev_priv(ndev
);
181 struct aq_nic_cfg_s
*cfg
= aq_nic_get_cfg(aq_nic
);
185 ret
= ARRAY_SIZE(aq_ethtool_stat_names
) -
186 (AQ_CFG_VECS_MAX
- cfg
->vecs
) *
187 aq_ethtool_stat_queue_lines
;
195 static u32
aq_ethtool_get_rss_indir_size(struct net_device
*ndev
)
197 return AQ_CFG_RSS_INDIRECTION_TABLE_MAX
;
200 static u32
aq_ethtool_get_rss_key_size(struct net_device
*ndev
)
202 struct aq_nic_s
*aq_nic
= netdev_priv(ndev
);
203 struct aq_nic_cfg_s
*cfg
= aq_nic_get_cfg(aq_nic
);
205 return sizeof(cfg
->aq_rss
.hash_secret_key
);
208 static int aq_ethtool_get_rss(struct net_device
*ndev
, u32
*indir
, u8
*key
,
211 struct aq_nic_s
*aq_nic
= netdev_priv(ndev
);
212 struct aq_nic_cfg_s
*cfg
= aq_nic_get_cfg(aq_nic
);
216 *hfunc
= ETH_RSS_HASH_TOP
; /* Toeplitz */
218 for (i
= 0; i
< AQ_CFG_RSS_INDIRECTION_TABLE_MAX
; i
++)
219 indir
[i
] = cfg
->aq_rss
.indirection_table
[i
];
222 memcpy(key
, cfg
->aq_rss
.hash_secret_key
,
223 sizeof(cfg
->aq_rss
.hash_secret_key
));
227 static int aq_ethtool_get_rxnfc(struct net_device
*ndev
,
228 struct ethtool_rxnfc
*cmd
,
231 struct aq_nic_s
*aq_nic
= netdev_priv(ndev
);
232 struct aq_nic_cfg_s
*cfg
= aq_nic_get_cfg(aq_nic
);
236 case ETHTOOL_GRXRINGS
:
237 cmd
->data
= cfg
->vecs
;
248 const struct ethtool_ops aq_ethtool_ops
= {
249 .get_link
= aq_ethtool_get_link
,
250 .get_regs_len
= aq_ethtool_get_regs_len
,
251 .get_regs
= aq_ethtool_get_regs
,
252 .get_drvinfo
= aq_ethtool_get_drvinfo
,
253 .get_strings
= aq_ethtool_get_strings
,
254 .get_rxfh_indir_size
= aq_ethtool_get_rss_indir_size
,
255 .get_rxfh_key_size
= aq_ethtool_get_rss_key_size
,
256 .get_rxfh
= aq_ethtool_get_rss
,
257 .get_rxnfc
= aq_ethtool_get_rxnfc
,
258 .get_sset_count
= aq_ethtool_get_sset_count
,
259 .get_ethtool_stats
= aq_ethtool_stats
,
260 .get_link_ksettings
= aq_ethtool_get_link_ksettings
,
261 .set_link_ksettings
= aq_ethtool_set_link_ksettings
,