net: usbnet: support 64bit stats
[sfrench/cifs-2.6.git] / drivers / net / usb / ax88172a.c
1 /*
2  * ASIX AX88172A based USB 2.0 Ethernet Devices
3  * Copyright (C) 2012 OMICRON electronics GmbH
4  *
5  * Supports external PHYs via phylib. Based on the driver for the
6  * AX88772. Original copyrights follow:
7  *
8  * Copyright (C) 2003-2006 David Hollis <dhollis@davehollis.com>
9  * Copyright (C) 2005 Phil Chang <pchang23@sbcglobal.net>
10  * Copyright (C) 2006 James Painter <jamie.painter@iname.com>
11  * Copyright (c) 2002-2003 TiVo Inc.
12  *
13  * This program is free software; you can redistribute it and/or modify
14  * it under the terms of the GNU General Public License as published by
15  * the Free Software Foundation; either version 2 of the License, or
16  * (at your option) any later version.
17  *
18  * This program is distributed in the hope that it will be useful,
19  * but WITHOUT ANY WARRANTY; without even the implied warranty of
20  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
21  * GNU General Public License for more details.
22  *
23  * You should have received a copy of the GNU General Public License
24  * along with this program; if not, see <http://www.gnu.org/licenses/>.
25  */
26
27 #include "asix.h"
28 #include <linux/phy.h>
29
30 struct ax88172a_private {
31         struct mii_bus *mdio;
32         struct phy_device *phydev;
33         char phy_name[20];
34         u16 phy_addr;
35         u16 oldmode;
36         int use_embdphy;
37         struct asix_rx_fixup_info rx_fixup_info;
38 };
39
40 /* MDIO read and write wrappers for phylib */
41 static int asix_mdio_bus_read(struct mii_bus *bus, int phy_id, int regnum)
42 {
43         return asix_mdio_read(((struct usbnet *)bus->priv)->net, phy_id,
44                               regnum);
45 }
46
47 static int asix_mdio_bus_write(struct mii_bus *bus, int phy_id, int regnum,
48                                u16 val)
49 {
50         asix_mdio_write(((struct usbnet *)bus->priv)->net, phy_id, regnum, val);
51         return 0;
52 }
53
54 static int ax88172a_ioctl(struct net_device *net, struct ifreq *rq, int cmd)
55 {
56         if (!netif_running(net))
57                 return -EINVAL;
58
59         if (!net->phydev)
60                 return -ENODEV;
61
62         return phy_mii_ioctl(net->phydev, rq, cmd);
63 }
64
65 /* set MAC link settings according to information from phylib */
66 static void ax88172a_adjust_link(struct net_device *netdev)
67 {
68         struct phy_device *phydev = netdev->phydev;
69         struct usbnet *dev = netdev_priv(netdev);
70         struct ax88172a_private *priv = dev->driver_priv;
71         u16 mode = 0;
72
73         if (phydev->link) {
74                 mode = AX88772_MEDIUM_DEFAULT;
75
76                 if (phydev->duplex == DUPLEX_HALF)
77                         mode &= ~AX_MEDIUM_FD;
78
79                 if (phydev->speed != SPEED_100)
80                         mode &= ~AX_MEDIUM_PS;
81         }
82
83         if (mode != priv->oldmode) {
84                 asix_write_medium_mode(dev, mode, 0);
85                 priv->oldmode = mode;
86                 netdev_dbg(netdev, "speed %u duplex %d, setting mode to 0x%04x\n",
87                            phydev->speed, phydev->duplex, mode);
88                 phy_print_status(phydev);
89         }
90 }
91
92 static void ax88172a_status(struct usbnet *dev, struct urb *urb)
93 {
94         /* link changes are detected by polling the phy */
95 }
96
97 /* use phylib infrastructure */
98 static int ax88172a_init_mdio(struct usbnet *dev)
99 {
100         struct ax88172a_private *priv = dev->driver_priv;
101         int ret;
102
103         priv->mdio = mdiobus_alloc();
104         if (!priv->mdio) {
105                 netdev_err(dev->net, "Could not allocate MDIO bus\n");
106                 return -ENOMEM;
107         }
108
109         priv->mdio->priv = (void *)dev;
110         priv->mdio->read = &asix_mdio_bus_read;
111         priv->mdio->write = &asix_mdio_bus_write;
112         priv->mdio->name = "Asix MDIO Bus";
113         /* mii bus name is usb-<usb bus number>-<usb device number> */
114         snprintf(priv->mdio->id, MII_BUS_ID_SIZE, "usb-%03d:%03d",
115                  dev->udev->bus->busnum, dev->udev->devnum);
116
117         ret = mdiobus_register(priv->mdio);
118         if (ret) {
119                 netdev_err(dev->net, "Could not register MDIO bus\n");
120                 goto mfree;
121         }
122
123         netdev_info(dev->net, "registered mdio bus %s\n", priv->mdio->id);
124         return 0;
125
126 mfree:
127         mdiobus_free(priv->mdio);
128         return ret;
129 }
130
131 static void ax88172a_remove_mdio(struct usbnet *dev)
132 {
133         struct ax88172a_private *priv = dev->driver_priv;
134
135         netdev_info(dev->net, "deregistering mdio bus %s\n", priv->mdio->id);
136         mdiobus_unregister(priv->mdio);
137         mdiobus_free(priv->mdio);
138 }
139
140 static const struct net_device_ops ax88172a_netdev_ops = {
141         .ndo_open               = usbnet_open,
142         .ndo_stop               = usbnet_stop,
143         .ndo_start_xmit         = usbnet_start_xmit,
144         .ndo_tx_timeout         = usbnet_tx_timeout,
145         .ndo_change_mtu         = usbnet_change_mtu,
146         .ndo_get_stats64        = usbnet_get_stats64,
147         .ndo_set_mac_address    = asix_set_mac_address,
148         .ndo_validate_addr      = eth_validate_addr,
149         .ndo_do_ioctl           = ax88172a_ioctl,
150         .ndo_set_rx_mode        = asix_set_multicast,
151 };
152
153 static const struct ethtool_ops ax88172a_ethtool_ops = {
154         .get_drvinfo            = asix_get_drvinfo,
155         .get_link               = usbnet_get_link,
156         .get_msglevel           = usbnet_get_msglevel,
157         .set_msglevel           = usbnet_set_msglevel,
158         .get_wol                = asix_get_wol,
159         .set_wol                = asix_set_wol,
160         .get_eeprom_len         = asix_get_eeprom_len,
161         .get_eeprom             = asix_get_eeprom,
162         .set_eeprom             = asix_set_eeprom,
163         .nway_reset             = phy_ethtool_nway_reset,
164         .get_link_ksettings     = phy_ethtool_get_link_ksettings,
165         .set_link_ksettings     = phy_ethtool_set_link_ksettings,
166 };
167
168 static int ax88172a_reset_phy(struct usbnet *dev, int embd_phy)
169 {
170         int ret;
171
172         ret = asix_sw_reset(dev, AX_SWRESET_IPPD, 0);
173         if (ret < 0)
174                 goto err;
175
176         msleep(150);
177         ret = asix_sw_reset(dev, AX_SWRESET_CLEAR, 0);
178         if (ret < 0)
179                 goto err;
180
181         msleep(150);
182
183         ret = asix_sw_reset(dev, embd_phy ? AX_SWRESET_IPRL : AX_SWRESET_IPPD,
184                             0);
185         if (ret < 0)
186                 goto err;
187
188         return 0;
189
190 err:
191         return ret;
192 }
193
194
195 static int ax88172a_bind(struct usbnet *dev, struct usb_interface *intf)
196 {
197         int ret;
198         u8 buf[ETH_ALEN];
199         struct ax88172a_private *priv;
200
201         usbnet_get_endpoints(dev, intf);
202
203         priv = kzalloc(sizeof(*priv), GFP_KERNEL);
204         if (!priv)
205                 return -ENOMEM;
206
207         dev->driver_priv = priv;
208
209         /* Get the MAC address */
210         ret = asix_read_cmd(dev, AX_CMD_READ_NODE_ID, 0, 0, ETH_ALEN, buf, 0);
211         if (ret < 0) {
212                 netdev_err(dev->net, "Failed to read MAC address: %d\n", ret);
213                 goto free;
214         }
215         memcpy(dev->net->dev_addr, buf, ETH_ALEN);
216
217         dev->net->netdev_ops = &ax88172a_netdev_ops;
218         dev->net->ethtool_ops = &ax88172a_ethtool_ops;
219
220         /* are we using the internal or the external phy? */
221         ret = asix_read_cmd(dev, AX_CMD_SW_PHY_STATUS, 0, 0, 1, buf, 0);
222         if (ret < 0) {
223                 netdev_err(dev->net, "Failed to read software interface selection register: %d\n",
224                            ret);
225                 goto free;
226         }
227
228         netdev_dbg(dev->net, "AX_CMD_SW_PHY_STATUS = 0x%02x\n", buf[0]);
229         switch (buf[0] & AX_PHY_SELECT_MASK) {
230         case AX_PHY_SELECT_INTERNAL:
231                 netdev_dbg(dev->net, "use internal phy\n");
232                 priv->use_embdphy = 1;
233                 break;
234         case AX_PHY_SELECT_EXTERNAL:
235                 netdev_dbg(dev->net, "use external phy\n");
236                 priv->use_embdphy = 0;
237                 break;
238         default:
239                 netdev_err(dev->net, "Interface mode not supported by driver\n");
240                 ret = -ENOTSUPP;
241                 goto free;
242         }
243
244         priv->phy_addr = asix_read_phy_addr(dev, priv->use_embdphy);
245         ax88172a_reset_phy(dev, priv->use_embdphy);
246
247         /* Asix framing packs multiple eth frames into a 2K usb bulk transfer */
248         if (dev->driver_info->flags & FLAG_FRAMING_AX) {
249                 /* hard_mtu  is still the default - the device does not support
250                    jumbo eth frames */
251                 dev->rx_urb_size = 2048;
252         }
253
254         /* init MDIO bus */
255         ret = ax88172a_init_mdio(dev);
256         if (ret)
257                 goto free;
258
259         return 0;
260
261 free:
262         kfree(priv);
263         return ret;
264 }
265
266 static int ax88172a_stop(struct usbnet *dev)
267 {
268         struct ax88172a_private *priv = dev->driver_priv;
269
270         netdev_dbg(dev->net, "Stopping interface\n");
271
272         if (priv->phydev) {
273                 netdev_info(dev->net, "Disconnecting from phy %s\n",
274                             priv->phy_name);
275                 phy_stop(priv->phydev);
276                 phy_disconnect(priv->phydev);
277         }
278
279         return 0;
280 }
281
282 static void ax88172a_unbind(struct usbnet *dev, struct usb_interface *intf)
283 {
284         struct ax88172a_private *priv = dev->driver_priv;
285
286         ax88172a_remove_mdio(dev);
287         kfree(priv);
288 }
289
290 static int ax88172a_reset(struct usbnet *dev)
291 {
292         struct asix_data *data = (struct asix_data *)&dev->data;
293         struct ax88172a_private *priv = dev->driver_priv;
294         int ret;
295         u16 rx_ctl;
296
297         ax88172a_reset_phy(dev, priv->use_embdphy);
298
299         msleep(150);
300         rx_ctl = asix_read_rx_ctl(dev, 0);
301         netdev_dbg(dev->net, "RX_CTL is 0x%04x after software reset\n", rx_ctl);
302         ret = asix_write_rx_ctl(dev, 0x0000, 0);
303         if (ret < 0)
304                 goto out;
305
306         rx_ctl = asix_read_rx_ctl(dev, 0);
307         netdev_dbg(dev->net, "RX_CTL is 0x%04x setting to 0x0000\n", rx_ctl);
308
309         msleep(150);
310
311         ret = asix_write_cmd(dev, AX_CMD_WRITE_IPG0,
312                              AX88772_IPG0_DEFAULT | AX88772_IPG1_DEFAULT,
313                              AX88772_IPG2_DEFAULT, 0, NULL, 0);
314         if (ret < 0) {
315                 netdev_err(dev->net, "Write IPG,IPG1,IPG2 failed: %d\n", ret);
316                 goto out;
317         }
318
319         /* Rewrite MAC address */
320         memcpy(data->mac_addr, dev->net->dev_addr, ETH_ALEN);
321         ret = asix_write_cmd(dev, AX_CMD_WRITE_NODE_ID, 0, 0, ETH_ALEN,
322                              data->mac_addr, 0);
323         if (ret < 0)
324                 goto out;
325
326         /* Set RX_CTL to default values with 2k buffer, and enable cactus */
327         ret = asix_write_rx_ctl(dev, AX_DEFAULT_RX_CTL, 0);
328         if (ret < 0)
329                 goto out;
330
331         rx_ctl = asix_read_rx_ctl(dev, 0);
332         netdev_dbg(dev->net, "RX_CTL is 0x%04x after all initializations\n",
333                    rx_ctl);
334
335         rx_ctl = asix_read_medium_status(dev, 0);
336         netdev_dbg(dev->net, "Medium Status is 0x%04x after all initializations\n",
337                    rx_ctl);
338
339         /* Connect to PHY */
340         snprintf(priv->phy_name, 20, PHY_ID_FMT,
341                  priv->mdio->id, priv->phy_addr);
342
343         priv->phydev = phy_connect(dev->net, priv->phy_name,
344                                    &ax88172a_adjust_link,
345                                    PHY_INTERFACE_MODE_MII);
346         if (IS_ERR(priv->phydev)) {
347                 netdev_err(dev->net, "Could not connect to PHY device %s\n",
348                            priv->phy_name);
349                 ret = PTR_ERR(priv->phydev);
350                 goto out;
351         }
352
353         netdev_info(dev->net, "Connected to phy %s\n", priv->phy_name);
354
355         /* During power-up, the AX88172A set the power down (BMCR_PDOWN)
356          * bit of the PHY. Bring the PHY up again.
357          */
358         genphy_resume(priv->phydev);
359         phy_start(priv->phydev);
360
361         return 0;
362
363 out:
364         return ret;
365
366 }
367
368 static int ax88172a_rx_fixup(struct usbnet *dev, struct sk_buff *skb)
369 {
370         struct ax88172a_private *dp = dev->driver_priv;
371         struct asix_rx_fixup_info *rx = &dp->rx_fixup_info;
372
373         return asix_rx_fixup_internal(dev, skb, rx);
374 }
375
376 const struct driver_info ax88172a_info = {
377         .description = "ASIX AX88172A USB 2.0 Ethernet",
378         .bind = ax88172a_bind,
379         .reset = ax88172a_reset,
380         .stop = ax88172a_stop,
381         .unbind = ax88172a_unbind,
382         .status = ax88172a_status,
383         .flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_LINK_INTR |
384                  FLAG_MULTI_PACKET,
385         .rx_fixup = ax88172a_rx_fixup,
386         .tx_fixup = asix_tx_fixup,
387 };