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