1 /*
2 * linux/drivers/net/ehea/ehea_ethtool.c
3 *
4 * eHEA ethernet device driver for IBM eServer System p
5 *
6 * (C) Copyright IBM Corp. 2006
7 *
8 * Authors:
9 * Christoph Raisch <raisch@de.ibm.com>
10 * Jan-Bernd Themann <themann@de.ibm.com>
11 * Thomas Klein <tklein@de.ibm.com>
12 *
13 *
14 * This program is free software; you can redistribute it and/or modify
15 * it under the terms of the GNU General Public License as published by
16 * the Free Software Foundation; either version 2, or (at your option)
17 * any later version.
18 *
19 * This program is distributed in the hope that it will be useful,
20 * but WITHOUT ANY WARRANTY; without even the implied warranty of
21 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
22 * GNU General Public License for more details.
23 *
24 * You should have received a copy of the GNU General Public License
25 * along with this program; if not, write to the Free Software
26 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
27 */
28
29 #include "ehea.h"
30 #include "ehea_phyp.h"
31
ehea_get_settings(struct net_device * dev,struct ethtool_cmd * cmd)32 static 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
ehea_set_settings(struct net_device * dev,struct ethtool_cmd * cmd)70 static 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;
117 doit:
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");
125 out:
126 return ret;
127 }
128
ehea_nway_reset(struct net_device * dev)129 static 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
ehea_get_drvinfo(struct net_device * dev,struct ethtool_drvinfo * info)144 static 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
ehea_get_msglevel(struct net_device * dev)151 static u32 ehea_get_msglevel(struct net_device *dev)
152 {
153 struct ehea_port *port = netdev_priv(dev);
154 return port->msg_enable;
155 }
156
ehea_set_msglevel(struct net_device * dev,u32 value)157 static 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
ehea_get_rx_csum(struct net_device * dev)163 static u32 ehea_get_rx_csum(struct net_device *dev)
164 {
165 return 1;
166 }
167
168 static 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
ehea_get_strings(struct net_device * dev,u32 stringset,u8 * data)191 static 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
ehea_get_sset_count(struct net_device * dev,int sset)199 static 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
ehea_get_ethtool_stats(struct net_device * dev,struct ethtool_stats * stats,u64 * data)209 static 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
264 const 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, /* Restart autonegotiation */
277 };
278
ehea_set_ethtool_ops(struct net_device * netdev)279 void ehea_set_ethtool_ops(struct net_device *netdev)
280 {
281 SET_ETHTOOL_OPS(netdev, &ehea_ethtool_ops);
282 }
283