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, write to the Free Software
  25  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  26  */
  27
  28 #include "asix.h"
  29 #include <linux/phy.h>
  30
  31 struct ax88172a_private {
  32         struct mii_bus *mdio;
  33         struct phy_device *phydev;
  34         char phy_name[20];
  35         u16 phy_addr;
  36         u16 oldmode;
  37         int use_embdphy;
  38         struct asix_rx_fixup_info rx_fixup_info;
  39 };
  40
  41 /* MDIO read and write wrappers for phylib */
  42 static int asix_mdio_bus_read(struct mii_bus *bus, int phy_id, int regnum)
  43 {
  44         return asix_mdio_read(((struct usbnet *)bus->priv)->net, phy_id,
  45                               regnum);
  46 }
  47
  48 static int asix_mdio_bus_write(struct mii_bus *bus, int phy_id, int regnum,
  49                                u16 val)
  50 {
  51         asix_mdio_write(((struct usbnet *)bus->priv)->net, phy_id, regnum, val);
  52         return 0;
  53 }
  54
  55 static int ax88172a_ioctl(struct net_device *net, struct ifreq *rq, int cmd)
  56 {
  57         if (!netif_running(net))
  58                 return -EINVAL;
  59
  60         if (!net->phydev)
  61                 return -ENODEV;
  62
  63         return phy_mii_ioctl(net->phydev, rq, cmd);
  64 }
  65
  66 /* set MAC link settings according to information from phylib */
  67 static void ax88172a_adjust_link(struct net_device *netdev)
  68 {
  69         struct phy_device *phydev = netdev->phydev;
  70         struct usbnet *dev = netdev_priv(netdev);
  71         struct ax88172a_private *priv = dev->driver_priv;
  72         u16 mode = 0;
  73
  74         if (phydev->link) {
  75                 mode = AX88772_MEDIUM_DEFAULT;
  76
  77                 if (phydev->duplex == DUPLEX_HALF)
  78                         mode &= ~AX_MEDIUM_FD;
  79
  80                 if (phydev->speed != SPEED_100)
  81                         mode &= ~AX_MEDIUM_PS;
  82         }
  83
  84         if (mode != priv->oldmode) {
  85                 asix_write_medium_mode(dev, mode);
  86                 priv->oldmode = mode;
  87                 netdev_dbg(netdev, "speed %u duplex %d, setting mode to 0x%04x\n",
  88                            phydev->speed, phydev->duplex, mode);
  89                 phy_print_status(phydev);
  90         }
  91 }
  92
  93 static void ax88172a_status(struct usbnet *dev, struct urb *urb)
  94 {
  95         /* link changes are detected by polling the phy */
  96 }
  97
  98 /* use phylib infrastructure */
  99 static int ax88172a_init_mdio(struct usbnet *dev)
 100 {
 101         struct ax88172a_private *priv = dev->driver_priv;
 102         int ret, i;
 103
 104         priv->mdio = mdiobus_alloc();
 105         if (!priv->mdio) {
 106                 netdev_err(dev->net, "Could not allocate MDIO bus\n");
 107                 return -ENOMEM;
 108         }
 109
 110         priv->mdio->priv = (void *)dev;
 111         priv->mdio->read = &asix_mdio_bus_read;
 112         priv->mdio->write = &asix_mdio_bus_write;
 113         priv->mdio->name = "Asix MDIO Bus";
 114         /* mii bus name is usb-<usb bus number>-<usb device number> */
 115         snprintf(priv->mdio->id, MII_BUS_ID_SIZE, "usb-%03d:%03d",
 116                  dev->udev->bus->busnum, dev->udev->devnum);
 117
 118         priv->mdio->irq = kzalloc(sizeof(int) * PHY_MAX_ADDR, GFP_KERNEL);
 119         if (!priv->mdio->irq) {
 120                 ret = -ENOMEM;
 121                 goto mfree;
 122         }
 123         for (i = 0; i < PHY_MAX_ADDR; i++)
 124                 priv->mdio->irq[i] = PHY_POLL;
 125
 126         ret = mdiobus_register(priv->mdio);
 127         if (ret) {
 128                 netdev_err(dev->net, "Could not register MDIO bus\n");
 129                 goto ifree;
 130         }
 131
 132         netdev_info(dev->net, "registered mdio bus %s\n", priv->mdio->id);
 133         return 0;
 134
 135 ifree:
 136         kfree(priv->mdio->irq);
 137 mfree:
 138         mdiobus_free(priv->mdio);
 139         return ret;
 140 }
 141
 142 static void ax88172a_remove_mdio(struct usbnet *dev)
 143 {
 144         struct ax88172a_private *priv = dev->driver_priv;
 145
 146         netdev_info(dev->net, "deregistering mdio bus %s\n", priv->mdio->id);
 147         mdiobus_unregister(priv->mdio);
 148         kfree(priv->mdio->irq);
 149         mdiobus_free(priv->mdio);
 150 }
 151
 152 static const struct net_device_ops ax88172a_netdev_ops = {
 153         .ndo_open               = usbnet_open,
 154         .ndo_stop               = usbnet_stop,
 155         .ndo_start_xmit         = usbnet_start_xmit,
 156         .ndo_tx_timeout         = usbnet_tx_timeout,
 157         .ndo_change_mtu         = usbnet_change_mtu,
 158         .ndo_set_mac_address    = asix_set_mac_address,
 159         .ndo_validate_addr      = eth_validate_addr,
 160         .ndo_do_ioctl           = ax88172a_ioctl,
 161         .ndo_set_rx_mode        = asix_set_multicast,
 162 };
 163
 164 static int ax88172a_get_settings(struct net_device *net,
 165                                  struct ethtool_cmd *cmd)
 166 {
 167         if (!net->phydev)
 168                 return -ENODEV;
 169
 170         return phy_ethtool_gset(net->phydev, cmd);
 171 }
 172
 173 static int ax88172a_set_settings(struct net_device *net,
 174                                  struct ethtool_cmd *cmd)
 175 {
 176         if (!net->phydev)
 177                 return -ENODEV;
 178
 179         return phy_ethtool_sset(net->phydev, cmd);
 180 }
 181
 182 static int ax88172a_nway_reset(struct net_device *net)
 183 {
 184         if (!net->phydev)
 185                 return -ENODEV;
 186
 187         return phy_start_aneg(net->phydev);
 188 }
 189
 190 static const struct ethtool_ops ax88172a_ethtool_ops = {
 191         .get_drvinfo            = asix_get_drvinfo,
 192         .get_link               = usbnet_get_link,
 193         .get_msglevel           = usbnet_get_msglevel,
 194         .set_msglevel           = usbnet_set_msglevel,
 195         .get_wol                = asix_get_wol,
 196         .set_wol                = asix_set_wol,
 197         .get_eeprom_len         = asix_get_eeprom_len,
 198         .get_eeprom             = asix_get_eeprom,
 199         .set_eeprom             = asix_set_eeprom,
 200         .get_settings           = ax88172a_get_settings,
 201         .set_settings           = ax88172a_set_settings,
 202         .nway_reset             = ax88172a_nway_reset,
 203 };
 204
 205 static int ax88172a_reset_phy(struct usbnet *dev, int embd_phy)
 206 {
 207         int ret;
 208
 209         ret = asix_sw_reset(dev, AX_SWRESET_IPPD);
 210         if (ret < 0)
 211                 goto err;
 212
 213         msleep(150);
 214         ret = asix_sw_reset(dev, AX_SWRESET_CLEAR);
 215         if (ret < 0)
 216                 goto err;
 217
 218         msleep(150);
 219
 220         ret = asix_sw_reset(dev, embd_phy ? AX_SWRESET_IPRL : AX_SWRESET_IPPD);
 221         if (ret < 0)
 222                 goto err;
 223
 224         return 0;
 225
 226 err:
 227         return ret;
 228 }
 229
 230
 231 static int ax88172a_bind(struct usbnet *dev, struct usb_interface *intf)
 232 {
 233         int ret;
 234         u8 buf[ETH_ALEN];
 235         struct ax88172a_private *priv;
 236
 237         usbnet_get_endpoints(dev, intf);
 238
 239         priv = kzalloc(sizeof(*priv), GFP_KERNEL);
 240         if (!priv)
 241                 return -ENOMEM;
 242
 243         dev->driver_priv = priv;
 244
 245         /* Get the MAC address */
 246         ret = asix_read_cmd(dev, AX_CMD_READ_NODE_ID, 0, 0, ETH_ALEN, buf);
 247         if (ret < 0) {
 248                 netdev_err(dev->net, "Failed to read MAC address: %d\n", ret);
 249                 goto free;
 250         }
 251         memcpy(dev->net->dev_addr, buf, ETH_ALEN);
 252
 253         dev->net->netdev_ops = &ax88172a_netdev_ops;
 254         dev->net->ethtool_ops = &ax88172a_ethtool_ops;
 255
 256         /* are we using the internal or the external phy? */
 257         ret = asix_read_cmd(dev, AX_CMD_SW_PHY_STATUS, 0, 0, 1, buf);
 258         if (ret < 0) {
 259                 netdev_err(dev->net, "Failed to read software interface selection register: %d\n",
 260                            ret);
 261                 goto free;
 262         }
 263
 264         netdev_dbg(dev->net, "AX_CMD_SW_PHY_STATUS = 0x%02x\n", buf[0]);
 265         switch (buf[0] & AX_PHY_SELECT_MASK) {
 266         case AX_PHY_SELECT_INTERNAL:
 267                 netdev_dbg(dev->net, "use internal phy\n");
 268                 priv->use_embdphy = 1;
 269                 break;
 270         case AX_PHY_SELECT_EXTERNAL:
 271                 netdev_dbg(dev->net, "use external phy\n");
 272                 priv->use_embdphy = 0;
 273                 break;
 274         default:
 275                 netdev_err(dev->net, "Interface mode not supported by driver\n");
 276                 ret = -ENOTSUPP;
 277                 goto free;
 278         }
 279
 280         priv->phy_addr = asix_read_phy_addr(dev, priv->use_embdphy);
 281         ax88172a_reset_phy(dev, priv->use_embdphy);
 282
 283         /* Asix framing packs multiple eth frames into a 2K usb bulk transfer */
 284         if (dev->driver_info->flags & FLAG_FRAMING_AX) {
 285                 /* hard_mtu  is still the default - the device does not support
 286                    jumbo eth frames */
 287                 dev->rx_urb_size = 2048;
 288         }
 289
 290         /* init MDIO bus */
 291         ret = ax88172a_init_mdio(dev);
 292         if (ret)
 293                 goto free;
 294
 295         return 0;
 296
 297 free:
 298         kfree(priv);
 299         return ret;
 300 }
 301
 302 static int ax88172a_stop(struct usbnet *dev)
 303 {
 304         struct ax88172a_private *priv = dev->driver_priv;
 305
 306         netdev_dbg(dev->net, "Stopping interface\n");
 307
 308         if (priv->phydev) {
 309                 netdev_info(dev->net, "Disconnecting from phy %s\n",
 310                             priv->phy_name);
 311                 phy_stop(priv->phydev);
 312                 phy_disconnect(priv->phydev);
 313         }
 314
 315         return 0;
 316 }
 317
 318 static void ax88172a_unbind(struct usbnet *dev, struct usb_interface *intf)
 319 {
 320         struct ax88172a_private *priv = dev->driver_priv;
 321
 322         ax88172a_remove_mdio(dev);
 323         kfree(priv);
 324 }
 325
 326 static int ax88172a_reset(struct usbnet *dev)
 327 {
 328         struct asix_data *data = (struct asix_data *)&dev->data;
 329         struct ax88172a_private *priv = dev->driver_priv;
 330         int ret;
 331         u16 rx_ctl;
 332
 333         ax88172a_reset_phy(dev, priv->use_embdphy);
 334
 335         msleep(150);
 336         rx_ctl = asix_read_rx_ctl(dev);
 337         netdev_dbg(dev->net, "RX_CTL is 0x%04x after software reset\n", rx_ctl);
 338         ret = asix_write_rx_ctl(dev, 0x0000);
 339         if (ret < 0)
 340                 goto out;
 341
 342         rx_ctl = asix_read_rx_ctl(dev);
 343         netdev_dbg(dev->net, "RX_CTL is 0x%04x setting to 0x0000\n", rx_ctl);
 344
 345         msleep(150);
 346
 347         ret = asix_write_cmd(dev, AX_CMD_WRITE_IPG0,
 348                              AX88772_IPG0_DEFAULT | AX88772_IPG1_DEFAULT,
 349                              AX88772_IPG2_DEFAULT, 0, NULL);
 350         if (ret < 0) {
 351                 netdev_err(dev->net, "Write IPG,IPG1,IPG2 failed: %d\n", ret);
 352                 goto out;
 353         }
 354
 355         /* Rewrite MAC address */
 356         memcpy(data->mac_addr, dev->net->dev_addr, ETH_ALEN);
 357         ret = asix_write_cmd(dev, AX_CMD_WRITE_NODE_ID, 0, 0, ETH_ALEN,
 358                              data->mac_addr);
 359         if (ret < 0)
 360                 goto out;
 361
 362         /* Set RX_CTL to default values with 2k buffer, and enable cactus */
 363         ret = asix_write_rx_ctl(dev, AX_DEFAULT_RX_CTL);
 364         if (ret < 0)
 365                 goto out;
 366
 367         rx_ctl = asix_read_rx_ctl(dev);
 368         netdev_dbg(dev->net, "RX_CTL is 0x%04x after all initializations\n",
 369                    rx_ctl);
 370
 371         rx_ctl = asix_read_medium_status(dev);
 372         netdev_dbg(dev->net, "Medium Status is 0x%04x after all initializations\n",
 373                    rx_ctl);
 374
 375         /* Connect to PHY */
 376         snprintf(priv->phy_name, 20, PHY_ID_FMT,
 377                  priv->mdio->id, priv->phy_addr);
 378
 379         priv->phydev = phy_connect(dev->net, priv->phy_name,
 380                                    &ax88172a_adjust_link,
 381                                    PHY_INTERFACE_MODE_MII);
 382         if (IS_ERR(priv->phydev)) {
 383                 netdev_err(dev->net, "Could not connect to PHY device %s\n",
 384                            priv->phy_name);
 385                 ret = PTR_ERR(priv->phydev);
 386                 goto out;
 387         }
 388
 389         netdev_info(dev->net, "Connected to phy %s\n", priv->phy_name);
 390
 391         /* During power-up, the AX88172A set the power down (BMCR_PDOWN)
 392          * bit of the PHY. Bring the PHY up again.
 393          */
 394         genphy_resume(priv->phydev);
 395         phy_start(priv->phydev);
 396
 397         return 0;
 398
 399 out:
 400         return ret;
 401
 402 }
 403
 404 static int ax88172a_rx_fixup(struct usbnet *dev, struct sk_buff *skb)
 405 {
 406         struct ax88172a_private *dp = dev->driver_priv;
 407         struct asix_rx_fixup_info *rx = &dp->rx_fixup_info;
 408
 409         return asix_rx_fixup_internal(dev, skb, rx);
 410 }
 411
 412 const struct driver_info ax88172a_info = {
 413         .description = "ASIX AX88172A USB 2.0 Ethernet",
 414         .bind = ax88172a_bind,
 415         .reset = ax88172a_reset,
 416         .stop = ax88172a_stop,
 417         .unbind = ax88172a_unbind,
 418         .status = ax88172a_status,
 419         .flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_LINK_INTR |
 420                  FLAG_MULTI_PACKET,
 421         .rx_fixup = ax88172a_rx_fixup,
 422         .tx_fixup = asix_tx_fixup,
 423 };