1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29#include "ehea.h"
30#include "ehea_phyp.h"
31
32static int ehea_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
33{
34 struct ehea_port *port = netdev_priv(dev);
35 int ret;
36
37 ret = ehea_sense_port_attr(port);
38
39 if (ret)
40 return ret;
41
42 if (netif_carrier_ok(dev)) {
43 switch (port->port_speed) {
44 case EHEA_SPEED_10M: cmd->speed = SPEED_10; break;
45 case EHEA_SPEED_100M: cmd->speed = SPEED_100; break;
46 case EHEA_SPEED_1G: cmd->speed = SPEED_1000; break;
47 case EHEA_SPEED_10G: cmd->speed = SPEED_10000; break;
48 }
49 cmd->duplex = port->full_duplex == 1 ?
50 DUPLEX_FULL : DUPLEX_HALF;
51 } else {
52 cmd->speed = -1;
53 cmd->duplex = -1;
54 }
55
56 cmd->supported = (SUPPORTED_10000baseT_Full | SUPPORTED_1000baseT_Full
57 | SUPPORTED_100baseT_Full | SUPPORTED_100baseT_Half
58 | SUPPORTED_10baseT_Full | SUPPORTED_10baseT_Half
59 | SUPPORTED_Autoneg | SUPPORTED_FIBRE);
60
61 cmd->advertising = (ADVERTISED_10000baseT_Full | ADVERTISED_Autoneg
62 | ADVERTISED_FIBRE);
63
64 cmd->port = PORT_FIBRE;
65 cmd->autoneg = port->autoneg == 1 ? AUTONEG_ENABLE : AUTONEG_DISABLE;
66
67 return 0;
68}
69
70static int ehea_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
71{
72 struct ehea_port *port = netdev_priv(dev);
73 int ret = 0;
74 u32 sp;
75
76 if (cmd->autoneg == AUTONEG_ENABLE) {
77 sp = EHEA_SPEED_AUTONEG;
78 goto doit;
79 }
80
81 switch (cmd->speed) {
82 case SPEED_10:
83 if (cmd->duplex == DUPLEX_FULL)
84 sp = H_SPEED_10M_F;
85 else
86 sp = H_SPEED_10M_H;
87 break;
88
89 case SPEED_100:
90 if (cmd->duplex == DUPLEX_FULL)
91 sp = H_SPEED_100M_F;
92 else
93 sp = H_SPEED_100M_H;
94 break;
95
96 case SPEED_1000:
97 if (cmd->duplex == DUPLEX_FULL)
98 sp = H_SPEED_1G_F;
99 else
100 ret = -EINVAL;
101 break;
102
103 case SPEED_10000:
104 if (cmd->duplex == DUPLEX_FULL)
105 sp = H_SPEED_10G_F;
106 else
107 ret = -EINVAL;
108 break;
109
110 default:
111 ret = -EINVAL;
112 break;
113 }
114
115 if (ret)
116 goto out;
117doit:
118 ret = ehea_set_portspeed(port, sp);
119
120 if (!ret)
121 ehea_info("%s: Port speed succesfully set: %dMbps "
122 "%s Duplex",
123 port->netdev->name, port->port_speed,
124 port->full_duplex == 1 ? "Full" : "Half");
125out:
126 return ret;
127}
128
129static int ehea_nway_reset(struct net_device *dev)
130{
131 struct ehea_port *port = netdev_priv(dev);
132 int ret;
133
134 ret = ehea_set_portspeed(port, EHEA_SPEED_AUTONEG);
135
136 if (!ret)
137 ehea_info("%s: Port speed succesfully set: %dMbps "
138 "%s Duplex",
139 port->netdev->name, port->port_speed,
140 port->full_duplex == 1 ? "Full" : "Half");
141 return ret;
142}
143
144static void ehea_get_drvinfo(struct net_device *dev,
145 struct ethtool_drvinfo *info)
146{
147 strlcpy(info->driver, DRV_NAME, sizeof(info->driver));
148 strlcpy(info->version, DRV_VERSION, sizeof(info->version));
149}
150
151static u32 ehea_get_msglevel(struct net_device *dev)
152{
153 struct ehea_port *port = netdev_priv(dev);
154 return port->msg_enable;
155}
156
157static void ehea_set_msglevel(struct net_device *dev, u32 value)
158{
159 struct ehea_port *port = netdev_priv(dev);
160 port->msg_enable = value;
161}
162
163static u32 ehea_get_rx_csum(struct net_device *dev)
164{
165 return 1;
166}
167
168static char ehea_ethtool_stats_keys[][ETH_GSTRING_LEN] = {
169 {"sig_comp_iv"},
170 {"swqe_refill_th"},
171 {"port resets"},
172 {"Receive errors"},
173 {"TCP cksum errors"},
174 {"IP cksum errors"},
175 {"Frame cksum errors"},
176 {"num SQ stopped"},
177 {"SQ stopped"},
178 {"PR0 free_swqes"},
179 {"PR1 free_swqes"},
180 {"PR2 free_swqes"},
181 {"PR3 free_swqes"},
182 {"PR4 free_swqes"},
183 {"PR5 free_swqes"},
184 {"PR6 free_swqes"},
185 {"PR7 free_swqes"},
186 {"LRO aggregated"},
187 {"LRO flushed"},
188 {"LRO no_desc"},
189};
190
191static void ehea_get_strings(struct net_device *dev, u32 stringset, u8 *data)
192{
193 if (stringset == ETH_SS_STATS) {
194 memcpy(data, &ehea_ethtool_stats_keys,
195 sizeof(ehea_ethtool_stats_keys));
196 }
197}
198
199static int ehea_get_sset_count(struct net_device *dev, int sset)
200{
201 switch (sset) {
202 case ETH_SS_STATS:
203 return ARRAY_SIZE(ehea_ethtool_stats_keys);
204 default:
205 return -EOPNOTSUPP;
206 }
207}
208
209static void ehea_get_ethtool_stats(struct net_device *dev,
210 struct ethtool_stats *stats, u64 *data)
211{
212 int i, k, tmp;
213 struct ehea_port *port = netdev_priv(dev);
214
215 for (i = 0; i < ehea_get_sset_count(dev, ETH_SS_STATS); i++)
216 data[i] = 0;
217 i = 0;
218
219 data[i++] = port->sig_comp_iv;
220 data[i++] = port->port_res[0].swqe_refill_th;
221 data[i++] = port->resets;
222
223 for (k = 0, tmp = 0; k < EHEA_MAX_PORT_RES; k++)
224 tmp += port->port_res[k].p_stats.poll_receive_errors;
225 data[i++] = tmp;
226
227 for (k = 0, tmp = 0; k < EHEA_MAX_PORT_RES; k++)
228 tmp += port->port_res[k].p_stats.err_tcp_cksum;
229 data[i++] = tmp;
230
231 for (k = 0, tmp = 0; k < EHEA_MAX_PORT_RES; k++)
232 tmp += port->port_res[k].p_stats.err_ip_cksum;
233 data[i++] = tmp;
234
235 for (k = 0, tmp = 0; k < EHEA_MAX_PORT_RES; k++)
236 tmp += port->port_res[k].p_stats.err_frame_crc;
237 data[i++] = tmp;
238
239 for (k = 0, tmp = 0; k < EHEA_MAX_PORT_RES; k++)
240 tmp += port->port_res[k].p_stats.queue_stopped;
241 data[i++] = tmp;
242
243 for (k = 0, tmp = 0; k < EHEA_MAX_PORT_RES; k++)
244 tmp |= port->port_res[k].queue_stopped;
245 data[i++] = tmp;
246
247 for (k = 0; k < 8; k++)
248 data[i++] = atomic_read(&port->port_res[k].swqe_avail);
249
250 for (k = 0, tmp = 0; k < EHEA_MAX_PORT_RES; k++)
251 tmp |= port->port_res[k].lro_mgr.stats.aggregated;
252 data[i++] = tmp;
253
254 for (k = 0, tmp = 0; k < EHEA_MAX_PORT_RES; k++)
255 tmp |= port->port_res[k].lro_mgr.stats.flushed;
256 data[i++] = tmp;
257
258 for (k = 0, tmp = 0; k < EHEA_MAX_PORT_RES; k++)
259 tmp |= port->port_res[k].lro_mgr.stats.no_desc;
260 data[i++] = tmp;
261
262}
263
264const struct ethtool_ops ehea_ethtool_ops = {
265 .get_settings = ehea_get_settings,
266 .get_drvinfo = ehea_get_drvinfo,
267 .get_msglevel = ehea_get_msglevel,
268 .set_msglevel = ehea_set_msglevel,
269 .get_link = ethtool_op_get_link,
270 .set_tso = ethtool_op_set_tso,
271 .get_strings = ehea_get_strings,
272 .get_sset_count = ehea_get_sset_count,
273 .get_ethtool_stats = ehea_get_ethtool_stats,
274 .get_rx_csum = ehea_get_rx_csum,
275 .set_settings = ehea_set_settings,
276 .nway_reset = ehea_nway_reset,
277};
278
279void ehea_set_ethtool_ops(struct net_device *netdev)
280{
281 SET_ETHTOOL_OPS(netdev, &ehea_ethtool_ops);
282}
283
