drivers/net/usb/ax88179_178a.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /*
   3  * ASIX AX88179/178A USB 3.0/2.0 to Gigabit Ethernet Devices
   4  *
   5  * Copyright (C) 2011-2013 ASIX
   6  */
   7
   8 #include <linux/module.h>
   9 #include <linux/etherdevice.h>
  10 #include <linux/mii.h>
  11 #include <linux/usb.h>
  12 #include <linux/crc32.h>
  13 #include <linux/usb/usbnet.h>
  14 #include <uapi/linux/mdio.h>
  15 #include <linux/mdio.h>
  16
  17 #define AX88179_PHY_ID                          0x03
  18 #define AX_EEPROM_LEN                           0x100
  19 #define AX88179_EEPROM_MAGIC                    0x17900b95
  20 #define AX_MCAST_FLTSIZE                        8
  21 #define AX_MAX_MCAST                            64
  22 #define AX_INT_PPLS_LINK                        ((u32)BIT(16))
  23 #define AX_RXHDR_L4_TYPE_MASK                   0x1c
  24 #define AX_RXHDR_L4_TYPE_UDP                    4
  25 #define AX_RXHDR_L4_TYPE_TCP                    16
  26 #define AX_RXHDR_L3CSUM_ERR                     2
  27 #define AX_RXHDR_L4CSUM_ERR                     1
  28 #define AX_RXHDR_CRC_ERR                        ((u32)BIT(29))
  29 #define AX_RXHDR_DROP_ERR                       ((u32)BIT(31))
  30 #define AX_ACCESS_MAC                           0x01
  31 #define AX_ACCESS_PHY                           0x02
  32 #define AX_ACCESS_EEPROM                        0x04
  33 #define AX_ACCESS_EFUS                          0x05
  34 #define AX_RELOAD_EEPROM_EFUSE                  0x06
  35 #define AX_PAUSE_WATERLVL_HIGH                  0x54
  36 #define AX_PAUSE_WATERLVL_LOW                   0x55
  37
  38 #define PHYSICAL_LINK_STATUS                    0x02
  39         #define AX_USB_SS               0x04
  40         #define AX_USB_HS               0x02
  41
  42 #define GENERAL_STATUS                          0x03
  43 /* Check AX88179 version. UA1:Bit2 = 0,  UA2:Bit2 = 1 */
  44         #define AX_SECLD                0x04
  45
  46 #define AX_SROM_ADDR                            0x07
  47 #define AX_SROM_CMD                             0x0a
  48         #define EEP_RD                  0x04
  49         #define EEP_BUSY                0x10
  50
  51 #define AX_SROM_DATA_LOW                        0x08
  52 #define AX_SROM_DATA_HIGH                       0x09
  53
  54 #define AX_RX_CTL                               0x0b
  55         #define AX_RX_CTL_DROPCRCERR    0x0100
  56         #define AX_RX_CTL_IPE           0x0200
  57         #define AX_RX_CTL_START         0x0080
  58         #define AX_RX_CTL_AP            0x0020
  59         #define AX_RX_CTL_AM            0x0010
  60         #define AX_RX_CTL_AB            0x0008
  61         #define AX_RX_CTL_AMALL         0x0002
  62         #define AX_RX_CTL_PRO           0x0001
  63         #define AX_RX_CTL_STOP          0x0000
  64
  65 #define AX_NODE_ID                              0x10
  66 #define AX_MULFLTARY                            0x16
  67
  68 #define AX_MEDIUM_STATUS_MODE                   0x22
  69         #define AX_MEDIUM_GIGAMODE      0x01
  70         #define AX_MEDIUM_FULL_DUPLEX   0x02
  71         #define AX_MEDIUM_EN_125MHZ     0x08
  72         #define AX_MEDIUM_RXFLOW_CTRLEN 0x10
  73         #define AX_MEDIUM_TXFLOW_CTRLEN 0x20
  74         #define AX_MEDIUM_RECEIVE_EN    0x100
  75         #define AX_MEDIUM_PS            0x200
  76         #define AX_MEDIUM_JUMBO_EN      0x8040
  77
  78 #define AX_MONITOR_MOD                          0x24
  79         #define AX_MONITOR_MODE_RWLC    0x02
  80         #define AX_MONITOR_MODE_RWMP    0x04
  81         #define AX_MONITOR_MODE_PMEPOL  0x20
  82         #define AX_MONITOR_MODE_PMETYPE 0x40
  83
  84 #define AX_GPIO_CTRL                            0x25
  85         #define AX_GPIO_CTRL_GPIO3EN    0x80
  86         #define AX_GPIO_CTRL_GPIO2EN    0x40
  87         #define AX_GPIO_CTRL_GPIO1EN    0x20
  88
  89 #define AX_PHYPWR_RSTCTL                        0x26
  90         #define AX_PHYPWR_RSTCTL_BZ     0x0010
  91         #define AX_PHYPWR_RSTCTL_IPRL   0x0020
  92         #define AX_PHYPWR_RSTCTL_AT     0x1000
  93
  94 #define AX_RX_BULKIN_QCTRL                      0x2e
  95 #define AX_CLK_SELECT                           0x33
  96         #define AX_CLK_SELECT_BCS       0x01
  97         #define AX_CLK_SELECT_ACS       0x02
  98         #define AX_CLK_SELECT_ULR       0x08
  99
 100 #define AX_RXCOE_CTL                            0x34
 101         #define AX_RXCOE_IP             0x01
 102         #define AX_RXCOE_TCP            0x02
 103         #define AX_RXCOE_UDP            0x04
 104         #define AX_RXCOE_TCPV6          0x20
 105         #define AX_RXCOE_UDPV6          0x40
 106
 107 #define AX_TXCOE_CTL                            0x35
 108         #define AX_TXCOE_IP             0x01
 109         #define AX_TXCOE_TCP            0x02
 110         #define AX_TXCOE_UDP            0x04
 111         #define AX_TXCOE_TCPV6          0x20
 112         #define AX_TXCOE_UDPV6          0x40
 113
 114 #define AX_LEDCTRL                              0x73
 115
 116 #define GMII_PHY_PHYSR                          0x11
 117         #define GMII_PHY_PHYSR_SMASK    0xc000
 118         #define GMII_PHY_PHYSR_GIGA     0x8000
 119         #define GMII_PHY_PHYSR_100      0x4000
 120         #define GMII_PHY_PHYSR_FULL     0x2000
 121         #define GMII_PHY_PHYSR_LINK     0x400
 122
 123 #define GMII_LED_ACT                            0x1a
 124         #define GMII_LED_ACTIVE_MASK    0xff8f
 125         #define GMII_LED0_ACTIVE        BIT(4)
 126         #define GMII_LED1_ACTIVE        BIT(5)
 127         #define GMII_LED2_ACTIVE        BIT(6)
 128
 129 #define GMII_LED_LINK                           0x1c
 130         #define GMII_LED_LINK_MASK      0xf888
 131         #define GMII_LED0_LINK_10       BIT(0)
 132         #define GMII_LED0_LINK_100      BIT(1)
 133         #define GMII_LED0_LINK_1000     BIT(2)
 134         #define GMII_LED1_LINK_10       BIT(4)
 135         #define GMII_LED1_LINK_100      BIT(5)
 136         #define GMII_LED1_LINK_1000     BIT(6)
 137         #define GMII_LED2_LINK_10       BIT(8)
 138         #define GMII_LED2_LINK_100      BIT(9)
 139         #define GMII_LED2_LINK_1000     BIT(10)
 140         #define LED0_ACTIVE             BIT(0)
 141         #define LED0_LINK_10            BIT(1)
 142         #define LED0_LINK_100           BIT(2)
 143         #define LED0_LINK_1000          BIT(3)
 144         #define LED0_FD                 BIT(4)
 145         #define LED0_USB3_MASK          0x001f
 146         #define LED1_ACTIVE             BIT(5)
 147         #define LED1_LINK_10            BIT(6)
 148         #define LED1_LINK_100           BIT(7)
 149         #define LED1_LINK_1000          BIT(8)
 150         #define LED1_FD                 BIT(9)
 151         #define LED1_USB3_MASK          0x03e0
 152         #define LED2_ACTIVE             BIT(10)
 153         #define LED2_LINK_1000          BIT(13)
 154         #define LED2_LINK_100           BIT(12)
 155         #define LED2_LINK_10            BIT(11)
 156         #define LED2_FD                 BIT(14)
 157         #define LED_VALID               BIT(15)
 158         #define LED2_USB3_MASK          0x7c00
 159
 160 #define GMII_PHYPAGE                            0x1e
 161 #define GMII_PHY_PAGE_SELECT                    0x1f
 162         #define GMII_PHY_PGSEL_EXT      0x0007
 163         #define GMII_PHY_PGSEL_PAGE0    0x0000
 164         #define GMII_PHY_PGSEL_PAGE3    0x0003
 165         #define GMII_PHY_PGSEL_PAGE5    0x0005
 166
 167 struct ax88179_data {
 168         u8  eee_enabled;
 169         u8  eee_active;
 170         u16 rxctl;
 171         u16 reserved;
 172 };
 173
 174 struct ax88179_int_data {
 175         __le32 intdata1;
 176         __le32 intdata2;
 177 };
 178
 179 static const struct {
 180         unsigned char ctrl, timer_l, timer_h, size, ifg;
 181 } AX88179_BULKIN_SIZE[] =       {
 182         {7, 0x4f, 0,    0x12, 0xff},
 183         {7, 0x20, 3,    0x16, 0xff},
 184         {7, 0xae, 7,    0x18, 0xff},
 185         {7, 0xcc, 0x4c, 0x18, 8},
 186 };
 187
 188 static int __ax88179_read_cmd(struct usbnet *dev, u8 cmd, u16 value, u16 index,
 189                               u16 size, void *data, int in_pm)
 190 {
 191         int ret;
 192         int (*fn)(struct usbnet *, u8, u8, u16, u16, void *, u16);
 193
 194         BUG_ON(!dev);
 195
 196         if (!in_pm)
 197                 fn = usbnet_read_cmd;
 198         else
 199                 fn = usbnet_read_cmd_nopm;
 200
 201         ret = fn(dev, cmd, USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
 202                  value, index, data, size);
 203
 204         if (unlikely(ret < 0))
 205                 netdev_warn(dev->net, "Failed to read reg index 0x%04x: %d\n",
 206                             index, ret);
 207
 208         return ret;
 209 }
 210
 211 static int __ax88179_write_cmd(struct usbnet *dev, u8 cmd, u16 value, u16 index,
 212                                u16 size, const void *data, int in_pm)
 213 {
 214         int ret;
 215         int (*fn)(struct usbnet *, u8, u8, u16, u16, const void *, u16);
 216
 217         BUG_ON(!dev);
 218
 219         if (!in_pm)
 220                 fn = usbnet_write_cmd;
 221         else
 222                 fn = usbnet_write_cmd_nopm;
 223
 224         ret = fn(dev, cmd, USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
 225                  value, index, data, size);
 226
 227         if (unlikely(ret < 0))
 228                 netdev_warn(dev->net, "Failed to write reg index 0x%04x: %d\n",
 229                             index, ret);
 230
 231         return ret;
 232 }
 233
 234 static void ax88179_write_cmd_async(struct usbnet *dev, u8 cmd, u16 value,
 235                                     u16 index, u16 size, void *data)
 236 {
 237         u16 buf;
 238
 239         if (2 == size) {
 240                 buf = *((u16 *)data);
 241                 cpu_to_le16s(&buf);
 242                 usbnet_write_cmd_async(dev, cmd, USB_DIR_OUT | USB_TYPE_VENDOR |
 243                                        USB_RECIP_DEVICE, value, index, &buf,
 244                                        size);
 245         } else {
 246                 usbnet_write_cmd_async(dev, cmd, USB_DIR_OUT | USB_TYPE_VENDOR |
 247                                        USB_RECIP_DEVICE, value, index, data,
 248                                        size);
 249         }
 250 }
 251
 252 static int ax88179_read_cmd_nopm(struct usbnet *dev, u8 cmd, u16 value,
 253                                  u16 index, u16 size, void *data)
 254 {
 255         int ret;
 256
 257         if (2 == size) {
 258                 u16 buf;
 259                 ret = __ax88179_read_cmd(dev, cmd, value, index, size, &buf, 1);
 260                 le16_to_cpus(&buf);
 261                 *((u16 *)data) = buf;
 262         } else if (4 == size) {
 263                 u32 buf;
 264                 ret = __ax88179_read_cmd(dev, cmd, value, index, size, &buf, 1);
 265                 le32_to_cpus(&buf);
 266                 *((u32 *)data) = buf;
 267         } else {
 268                 ret = __ax88179_read_cmd(dev, cmd, value, index, size, data, 1);
 269         }
 270
 271         return ret;
 272 }
 273
 274 static int ax88179_write_cmd_nopm(struct usbnet *dev, u8 cmd, u16 value,
 275                                   u16 index, u16 size, const void *data)
 276 {
 277         int ret;
 278
 279         if (2 == size) {
 280                 u16 buf;
 281                 buf = *((u16 *)data);
 282                 cpu_to_le16s(&buf);
 283                 ret = __ax88179_write_cmd(dev, cmd, value, index,
 284                                           size, &buf, 1);
 285         } else {
 286                 ret = __ax88179_write_cmd(dev, cmd, value, index,
 287                                           size, data, 1);
 288         }
 289
 290         return ret;
 291 }
 292
 293 static int ax88179_read_cmd(struct usbnet *dev, u8 cmd, u16 value, u16 index,
 294                             u16 size, void *data)
 295 {
 296         int ret;
 297
 298         if (2 == size) {
 299                 u16 buf = 0;
 300                 ret = __ax88179_read_cmd(dev, cmd, value, index, size, &buf, 0);
 301                 le16_to_cpus(&buf);
 302                 *((u16 *)data) = buf;
 303         } else if (4 == size) {
 304                 u32 buf = 0;
 305                 ret = __ax88179_read_cmd(dev, cmd, value, index, size, &buf, 0);
 306                 le32_to_cpus(&buf);
 307                 *((u32 *)data) = buf;
 308         } else {
 309                 ret = __ax88179_read_cmd(dev, cmd, value, index, size, data, 0);
 310         }
 311
 312         return ret;
 313 }
 314
 315 static int ax88179_write_cmd(struct usbnet *dev, u8 cmd, u16 value, u16 index,
 316                              u16 size, const void *data)
 317 {
 318         int ret;
 319
 320         if (2 == size) {
 321                 u16 buf;
 322                 buf = *((u16 *)data);
 323                 cpu_to_le16s(&buf);
 324                 ret = __ax88179_write_cmd(dev, cmd, value, index,
 325                                           size, &buf, 0);
 326         } else {
 327                 ret = __ax88179_write_cmd(dev, cmd, value, index,
 328                                           size, data, 0);
 329         }
 330
 331         return ret;
 332 }
 333
 334 static void ax88179_status(struct usbnet *dev, struct urb *urb)
 335 {
 336         struct ax88179_int_data *event;
 337         u32 link;
 338
 339         if (urb->actual_length < 8)
 340                 return;
 341
 342         event = urb->transfer_buffer;
 343         le32_to_cpus((void *)&event->intdata1);
 344
 345         link = (((__force u32)event->intdata1) & AX_INT_PPLS_LINK) >> 16;
 346
 347         if (netif_carrier_ok(dev->net) != link) {
 348                 usbnet_link_change(dev, link, 1);
 349                 netdev_info(dev->net, "ax88179 - Link status is: %d\n", link);
 350         }
 351 }
 352
 353 static int ax88179_mdio_read(struct net_device *netdev, int phy_id, int loc)
 354 {
 355         struct usbnet *dev = netdev_priv(netdev);
 356         u16 res;
 357
 358         ax88179_read_cmd(dev, AX_ACCESS_PHY, phy_id, (__u16)loc, 2, &res);
 359         return res;
 360 }
 361
 362 static void ax88179_mdio_write(struct net_device *netdev, int phy_id, int loc,
 363                                int val)
 364 {
 365         struct usbnet *dev = netdev_priv(netdev);
 366         u16 res = (u16) val;
 367
 368         ax88179_write_cmd(dev, AX_ACCESS_PHY, phy_id, (__u16)loc, 2, &res);
 369 }
 370
 371 static inline int ax88179_phy_mmd_indirect(struct usbnet *dev, u16 prtad,
 372                                            u16 devad)
 373 {
 374         u16 tmp16;
 375         int ret;
 376
 377         tmp16 = devad;
 378         ret = ax88179_write_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
 379                                 MII_MMD_CTRL, 2, &tmp16);
 380
 381         tmp16 = prtad;
 382         ret = ax88179_write_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
 383                                 MII_MMD_DATA, 2, &tmp16);
 384
 385         tmp16 = devad | MII_MMD_CTRL_NOINCR;
 386         ret = ax88179_write_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
 387                                 MII_MMD_CTRL, 2, &tmp16);
 388
 389         return ret;
 390 }
 391
 392 static int
 393 ax88179_phy_read_mmd_indirect(struct usbnet *dev, u16 prtad, u16 devad)
 394 {
 395         int ret;
 396         u16 tmp16;
 397
 398         ax88179_phy_mmd_indirect(dev, prtad, devad);
 399
 400         ret = ax88179_read_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
 401                                MII_MMD_DATA, 2, &tmp16);
 402         if (ret < 0)
 403                 return ret;
 404
 405         return tmp16;
 406 }
 407
 408 static int
 409 ax88179_phy_write_mmd_indirect(struct usbnet *dev, u16 prtad, u16 devad,
 410                                u16 data)
 411 {
 412         int ret;
 413
 414         ax88179_phy_mmd_indirect(dev, prtad, devad);
 415
 416         ret = ax88179_write_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
 417                                 MII_MMD_DATA, 2, &data);
 418
 419         if (ret < 0)
 420                 return ret;
 421
 422         return 0;
 423 }
 424
 425 static int ax88179_suspend(struct usb_interface *intf, pm_message_t message)
 426 {
 427         struct usbnet *dev = usb_get_intfdata(intf);
 428         u16 tmp16;
 429         u8 tmp8;
 430
 431         usbnet_suspend(intf, message);
 432
 433         /* Disable RX path */
 434         ax88179_read_cmd_nopm(dev, AX_ACCESS_MAC, AX_MEDIUM_STATUS_MODE,
 435                               2, 2, &tmp16);
 436         tmp16 &= ~AX_MEDIUM_RECEIVE_EN;
 437         ax88179_write_cmd_nopm(dev, AX_ACCESS_MAC, AX_MEDIUM_STATUS_MODE,
 438                                2, 2, &tmp16);
 439
 440         /* Force bulk-in zero length */
 441         ax88179_read_cmd_nopm(dev, AX_ACCESS_MAC, AX_PHYPWR_RSTCTL,
 442                               2, 2, &tmp16);
 443
 444         tmp16 |= AX_PHYPWR_RSTCTL_BZ | AX_PHYPWR_RSTCTL_IPRL;
 445         ax88179_write_cmd_nopm(dev, AX_ACCESS_MAC, AX_PHYPWR_RSTCTL,
 446                                2, 2, &tmp16);
 447
 448         /* change clock */
 449         tmp8 = 0;
 450         ax88179_write_cmd_nopm(dev, AX_ACCESS_MAC, AX_CLK_SELECT, 1, 1, &tmp8);
 451
 452         /* Configure RX control register => stop operation */
 453         tmp16 = AX_RX_CTL_STOP;
 454         ax88179_write_cmd_nopm(dev, AX_ACCESS_MAC, AX_RX_CTL, 2, 2, &tmp16);
 455
 456         return 0;
 457 }
 458
 459 /* This function is used to enable the autodetach function. */
 460 /* This function is determined by offset 0x43 of EEPROM */
 461 static int ax88179_auto_detach(struct usbnet *dev, int in_pm)
 462 {
 463         u16 tmp16;
 464         u8 tmp8;
 465         int (*fnr)(struct usbnet *, u8, u16, u16, u16, void *);
 466         int (*fnw)(struct usbnet *, u8, u16, u16, u16, const void *);
 467
 468         if (!in_pm) {
 469                 fnr = ax88179_read_cmd;
 470                 fnw = ax88179_write_cmd;
 471         } else {
 472                 fnr = ax88179_read_cmd_nopm;
 473                 fnw = ax88179_write_cmd_nopm;
 474         }
 475
 476         if (fnr(dev, AX_ACCESS_EEPROM, 0x43, 1, 2, &tmp16) < 0)
 477                 return 0;
 478
 479         if ((tmp16 == 0xFFFF) || (!(tmp16 & 0x0100)))
 480                 return 0;
 481
 482         /* Enable Auto Detach bit */
 483         tmp8 = 0;
 484         fnr(dev, AX_ACCESS_MAC, AX_CLK_SELECT, 1, 1, &tmp8);
 485         tmp8 |= AX_CLK_SELECT_ULR;
 486         fnw(dev, AX_ACCESS_MAC, AX_CLK_SELECT, 1, 1, &tmp8);
 487
 488         fnr(dev, AX_ACCESS_MAC, AX_PHYPWR_RSTCTL, 2, 2, &tmp16);
 489         tmp16 |= AX_PHYPWR_RSTCTL_AT;
 490         fnw(dev, AX_ACCESS_MAC, AX_PHYPWR_RSTCTL, 2, 2, &tmp16);
 491
 492         return 0;
 493 }
 494
 495 static int ax88179_resume(struct usb_interface *intf)
 496 {
 497         struct usbnet *dev = usb_get_intfdata(intf);
 498         u16 tmp16;
 499         u8 tmp8;
 500
 501         usbnet_link_change(dev, 0, 0);
 502
 503         /* Power up ethernet PHY */
 504         tmp16 = 0;
 505         ax88179_write_cmd_nopm(dev, AX_ACCESS_MAC, AX_PHYPWR_RSTCTL,
 506                                2, 2, &tmp16);
 507         udelay(1000);
 508
 509         tmp16 = AX_PHYPWR_RSTCTL_IPRL;
 510         ax88179_write_cmd_nopm(dev, AX_ACCESS_MAC, AX_PHYPWR_RSTCTL,
 511                                2, 2, &tmp16);
 512         msleep(200);
 513
 514         /* Ethernet PHY Auto Detach*/
 515         ax88179_auto_detach(dev, 1);
 516
 517         /* Enable clock */
 518         ax88179_read_cmd_nopm(dev, AX_ACCESS_MAC,  AX_CLK_SELECT, 1, 1, &tmp8);
 519         tmp8 |= AX_CLK_SELECT_ACS | AX_CLK_SELECT_BCS;
 520         ax88179_write_cmd_nopm(dev, AX_ACCESS_MAC, AX_CLK_SELECT, 1, 1, &tmp8);
 521         msleep(100);
 522
 523         /* Configure RX control register => start operation */
 524         tmp16 = AX_RX_CTL_DROPCRCERR | AX_RX_CTL_IPE | AX_RX_CTL_START |
 525                 AX_RX_CTL_AP | AX_RX_CTL_AMALL | AX_RX_CTL_AB;
 526         ax88179_write_cmd_nopm(dev, AX_ACCESS_MAC, AX_RX_CTL, 2, 2, &tmp16);
 527
 528         return usbnet_resume(intf);
 529 }
 530
 531 static void
 532 ax88179_get_wol(struct net_device *net, struct ethtool_wolinfo *wolinfo)
 533 {
 534         struct usbnet *dev = netdev_priv(net);
 535         u8 opt;
 536
 537         if (ax88179_read_cmd(dev, AX_ACCESS_MAC, AX_MONITOR_MOD,
 538                              1, 1, &opt) < 0) {
 539                 wolinfo->supported = 0;
 540                 wolinfo->wolopts = 0;
 541                 return;
 542         }
 543
 544         wolinfo->supported = WAKE_PHY | WAKE_MAGIC;
 545         wolinfo->wolopts = 0;
 546         if (opt & AX_MONITOR_MODE_RWLC)
 547                 wolinfo->wolopts |= WAKE_PHY;
 548         if (opt & AX_MONITOR_MODE_RWMP)
 549                 wolinfo->wolopts |= WAKE_MAGIC;
 550 }
 551
 552 static int
 553 ax88179_set_wol(struct net_device *net, struct ethtool_wolinfo *wolinfo)
 554 {
 555         struct usbnet *dev = netdev_priv(net);
 556         u8 opt = 0;
 557
 558         if (wolinfo->wolopts & ~(WAKE_PHY | WAKE_MAGIC))
 559                 return -EINVAL;
 560
 561         if (wolinfo->wolopts & WAKE_PHY)
 562                 opt |= AX_MONITOR_MODE_RWLC;
 563         if (wolinfo->wolopts & WAKE_MAGIC)
 564                 opt |= AX_MONITOR_MODE_RWMP;
 565
 566         if (ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_MONITOR_MOD,
 567                               1, 1, &opt) < 0)
 568                 return -EINVAL;
 569
 570         return 0;
 571 }
 572
 573 static int ax88179_get_eeprom_len(struct net_device *net)
 574 {
 575         return AX_EEPROM_LEN;
 576 }
 577
 578 static int
 579 ax88179_get_eeprom(struct net_device *net, struct ethtool_eeprom *eeprom,
 580                    u8 *data)
 581 {
 582         struct usbnet *dev = netdev_priv(net);
 583         u16 *eeprom_buff;
 584         int first_word, last_word;
 585         int i, ret;
 586
 587         if (eeprom->len == 0)
 588                 return -EINVAL;
 589
 590         eeprom->magic = AX88179_EEPROM_MAGIC;
 591
 592         first_word = eeprom->offset >> 1;
 593         last_word = (eeprom->offset + eeprom->len - 1) >> 1;
 594         eeprom_buff = kmalloc_array(last_word - first_word + 1, sizeof(u16),
 595                                     GFP_KERNEL);
 596         if (!eeprom_buff)
 597                 return -ENOMEM;
 598
 599         /* ax88179/178A returns 2 bytes from eeprom on read */
 600         for (i = first_word; i <= last_word; i++) {
 601                 ret = __ax88179_read_cmd(dev, AX_ACCESS_EEPROM, i, 1, 2,
 602                                          &eeprom_buff[i - first_word],
 603                                          0);
 604                 if (ret < 0) {
 605                         kfree(eeprom_buff);
 606                         return -EIO;
 607                 }
 608         }
 609
 610         memcpy(data, (u8 *)eeprom_buff + (eeprom->offset & 1), eeprom->len);
 611         kfree(eeprom_buff);
 612         return 0;
 613 }
 614
 615 static int
 616 ax88179_set_eeprom(struct net_device *net, struct ethtool_eeprom *eeprom,
 617                    u8 *data)
 618 {
 619         struct usbnet *dev = netdev_priv(net);
 620         u16 *eeprom_buff;
 621         int first_word;
 622         int last_word;
 623         int ret;
 624         int i;
 625
 626         netdev_dbg(net, "write EEPROM len %d, offset %d, magic 0x%x\n",
 627                    eeprom->len, eeprom->offset, eeprom->magic);
 628
 629         if (eeprom->len == 0)
 630                 return -EINVAL;
 631
 632         if (eeprom->magic != AX88179_EEPROM_MAGIC)
 633                 return -EINVAL;
 634
 635         first_word = eeprom->offset >> 1;
 636         last_word = (eeprom->offset + eeprom->len - 1) >> 1;
 637
 638         eeprom_buff = kmalloc_array(last_word - first_word + 1, sizeof(u16),
 639                                     GFP_KERNEL);
 640         if (!eeprom_buff)
 641                 return -ENOMEM;
 642
 643         /* align data to 16 bit boundaries, read the missing data from
 644            the EEPROM */
 645         if (eeprom->offset & 1) {
 646                 ret = ax88179_read_cmd(dev, AX_ACCESS_EEPROM, first_word, 1, 2,
 647                                        &eeprom_buff[0]);
 648                 if (ret < 0) {
 649                         netdev_err(net, "Failed to read EEPROM at offset 0x%02x.\n", first_word);
 650                         goto free;
 651                 }
 652         }
 653
 654         if ((eeprom->offset + eeprom->len) & 1) {
 655                 ret = ax88179_read_cmd(dev, AX_ACCESS_EEPROM, last_word, 1, 2,
 656                                        &eeprom_buff[last_word - first_word]);
 657                 if (ret < 0) {
 658                         netdev_err(net, "Failed to read EEPROM at offset 0x%02x.\n", last_word);
 659                         goto free;
 660                 }
 661         }
 662
 663         memcpy((u8 *)eeprom_buff + (eeprom->offset & 1), data, eeprom->len);
 664
 665         for (i = first_word; i <= last_word; i++) {
 666                 netdev_dbg(net, "write to EEPROM at offset 0x%02x, data 0x%04x\n",
 667                            i, eeprom_buff[i - first_word]);
 668                 ret = ax88179_write_cmd(dev, AX_ACCESS_EEPROM, i, 1, 2,
 669                                         &eeprom_buff[i - first_word]);
 670                 if (ret < 0) {
 671                         netdev_err(net, "Failed to write EEPROM at offset 0x%02x.\n", i);
 672                         goto free;
 673                 }
 674                 msleep(20);
 675         }
 676
 677         /* reload EEPROM data */
 678         ret = ax88179_write_cmd(dev, AX_RELOAD_EEPROM_EFUSE, 0x0000, 0, 0, NULL);
 679         if (ret < 0) {
 680                 netdev_err(net, "Failed to reload EEPROM data\n");
 681                 goto free;
 682         }
 683
 684         ret = 0;
 685 free:
 686         kfree(eeprom_buff);
 687         return ret;
 688 }
 689
 690 static int ax88179_get_link_ksettings(struct net_device *net,
 691                                       struct ethtool_link_ksettings *cmd)
 692 {
 693         struct usbnet *dev = netdev_priv(net);
 694
 695         mii_ethtool_get_link_ksettings(&dev->mii, cmd);
 696
 697         return 0;
 698 }
 699
 700 static int ax88179_set_link_ksettings(struct net_device *net,
 701                                       const struct ethtool_link_ksettings *cmd)
 702 {
 703         struct usbnet *dev = netdev_priv(net);
 704         return mii_ethtool_set_link_ksettings(&dev->mii, cmd);
 705 }
 706
 707 static int
 708 ax88179_ethtool_get_eee(struct usbnet *dev, struct ethtool_eee *data)
 709 {
 710         int val;
 711
 712         /* Get Supported EEE */
 713         val = ax88179_phy_read_mmd_indirect(dev, MDIO_PCS_EEE_ABLE,
 714                                             MDIO_MMD_PCS);
 715         if (val < 0)
 716                 return val;
 717         data->supported = mmd_eee_cap_to_ethtool_sup_t(val);
 718
 719         /* Get advertisement EEE */
 720         val = ax88179_phy_read_mmd_indirect(dev, MDIO_AN_EEE_ADV,
 721                                             MDIO_MMD_AN);
 722         if (val < 0)
 723                 return val;
 724         data->advertised = mmd_eee_adv_to_ethtool_adv_t(val);
 725
 726         /* Get LP advertisement EEE */
 727         val = ax88179_phy_read_mmd_indirect(dev, MDIO_AN_EEE_LPABLE,
 728                                             MDIO_MMD_AN);
 729         if (val < 0)
 730                 return val;
 731         data->lp_advertised = mmd_eee_adv_to_ethtool_adv_t(val);
 732
 733         return 0;
 734 }
 735
 736 static int
 737 ax88179_ethtool_set_eee(struct usbnet *dev, struct ethtool_eee *data)
 738 {
 739         u16 tmp16 = ethtool_adv_to_mmd_eee_adv_t(data->advertised);
 740
 741         return ax88179_phy_write_mmd_indirect(dev, MDIO_AN_EEE_ADV,
 742                                               MDIO_MMD_AN, tmp16);
 743 }
 744
 745 static int ax88179_chk_eee(struct usbnet *dev)
 746 {
 747         struct ethtool_cmd ecmd = { .cmd = ETHTOOL_GSET };
 748         struct ax88179_data *priv = (struct ax88179_data *)dev->data;
 749
 750         mii_ethtool_gset(&dev->mii, &ecmd);
 751
 752         if (ecmd.duplex & DUPLEX_FULL) {
 753                 int eee_lp, eee_cap, eee_adv;
 754                 u32 lp, cap, adv, supported = 0;
 755
 756                 eee_cap = ax88179_phy_read_mmd_indirect(dev,
 757                                                         MDIO_PCS_EEE_ABLE,
 758                                                         MDIO_MMD_PCS);
 759                 if (eee_cap < 0) {
 760                         priv->eee_active = 0;
 761                         return false;
 762                 }
 763
 764                 cap = mmd_eee_cap_to_ethtool_sup_t(eee_cap);
 765                 if (!cap) {
 766                         priv->eee_active = 0;
 767                         return false;
 768                 }
 769
 770                 eee_lp = ax88179_phy_read_mmd_indirect(dev,
 771                                                        MDIO_AN_EEE_LPABLE,
 772                                                        MDIO_MMD_AN);
 773                 if (eee_lp < 0) {
 774                         priv->eee_active = 0;
 775                         return false;
 776                 }
 777
 778                 eee_adv = ax88179_phy_read_mmd_indirect(dev,
 779                                                         MDIO_AN_EEE_ADV,
 780                                                         MDIO_MMD_AN);
 781
 782                 if (eee_adv < 0) {
 783                         priv->eee_active = 0;
 784                         return false;
 785                 }
 786
 787                 adv = mmd_eee_adv_to_ethtool_adv_t(eee_adv);
 788                 lp = mmd_eee_adv_to_ethtool_adv_t(eee_lp);
 789                 supported = (ecmd.speed == SPEED_1000) ?
 790                              SUPPORTED_1000baseT_Full :
 791                              SUPPORTED_100baseT_Full;
 792
 793                 if (!(lp & adv & supported)) {
 794                         priv->eee_active = 0;
 795                         return false;
 796                 }
 797
 798                 priv->eee_active = 1;
 799                 return true;
 800         }
 801
 802         priv->eee_active = 0;
 803         return false;
 804 }
 805
 806 static void ax88179_disable_eee(struct usbnet *dev)
 807 {
 808         u16 tmp16;
 809
 810         tmp16 = GMII_PHY_PGSEL_PAGE3;
 811         ax88179_write_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
 812                           GMII_PHY_PAGE_SELECT, 2, &tmp16);
 813
 814         tmp16 = 0x3246;
 815         ax88179_write_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
 816                           MII_PHYADDR, 2, &tmp16);
 817
 818         tmp16 = GMII_PHY_PGSEL_PAGE0;
 819         ax88179_write_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
 820                           GMII_PHY_PAGE_SELECT, 2, &tmp16);
 821 }
 822
 823 static void ax88179_enable_eee(struct usbnet *dev)
 824 {
 825         u16 tmp16;
 826
 827         tmp16 = GMII_PHY_PGSEL_PAGE3;
 828         ax88179_write_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
 829                           GMII_PHY_PAGE_SELECT, 2, &tmp16);
 830
 831         tmp16 = 0x3247;
 832         ax88179_write_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
 833                           MII_PHYADDR, 2, &tmp16);
 834
 835         tmp16 = GMII_PHY_PGSEL_PAGE5;
 836         ax88179_write_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
 837                           GMII_PHY_PAGE_SELECT, 2, &tmp16);
 838
 839         tmp16 = 0x0680;
 840         ax88179_write_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
 841                           MII_BMSR, 2, &tmp16);
 842
 843         tmp16 = GMII_PHY_PGSEL_PAGE0;
 844         ax88179_write_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
 845                           GMII_PHY_PAGE_SELECT, 2, &tmp16);
 846 }
 847
 848 static int ax88179_get_eee(struct net_device *net, struct ethtool_eee *edata)
 849 {
 850         struct usbnet *dev = netdev_priv(net);
 851         struct ax88179_data *priv = (struct ax88179_data *)dev->data;
 852
 853         edata->eee_enabled = priv->eee_enabled;
 854         edata->eee_active = priv->eee_active;
 855
 856         return ax88179_ethtool_get_eee(dev, edata);
 857 }
 858
 859 static int ax88179_set_eee(struct net_device *net, struct ethtool_eee *edata)
 860 {
 861         struct usbnet *dev = netdev_priv(net);
 862         struct ax88179_data *priv = (struct ax88179_data *)dev->data;
 863         int ret;
 864
 865         priv->eee_enabled = edata->eee_enabled;
 866         if (!priv->eee_enabled) {
 867                 ax88179_disable_eee(dev);
 868         } else {
 869                 priv->eee_enabled = ax88179_chk_eee(dev);
 870                 if (!priv->eee_enabled)
 871                         return -EOPNOTSUPP;
 872
 873                 ax88179_enable_eee(dev);
 874         }
 875
 876         ret = ax88179_ethtool_set_eee(dev, edata);
 877         if (ret)
 878                 return ret;
 879
 880         mii_nway_restart(&dev->mii);
 881
 882         usbnet_link_change(dev, 0, 0);
 883
 884         return ret;
 885 }
 886
 887 static int ax88179_ioctl(struct net_device *net, struct ifreq *rq, int cmd)
 888 {
 889         struct usbnet *dev = netdev_priv(net);
 890         return generic_mii_ioctl(&dev->mii, if_mii(rq), cmd, NULL);
 891 }
 892
 893 static const struct ethtool_ops ax88179_ethtool_ops = {
 894         .get_link               = ethtool_op_get_link,
 895         .get_msglevel           = usbnet_get_msglevel,
 896         .set_msglevel           = usbnet_set_msglevel,
 897         .get_wol                = ax88179_get_wol,
 898         .set_wol                = ax88179_set_wol,
 899         .get_eeprom_len         = ax88179_get_eeprom_len,
 900         .get_eeprom             = ax88179_get_eeprom,
 901         .set_eeprom             = ax88179_set_eeprom,
 902         .get_eee                = ax88179_get_eee,
 903         .set_eee                = ax88179_set_eee,
 904         .nway_reset             = usbnet_nway_reset,
 905         .get_link_ksettings     = ax88179_get_link_ksettings,
 906         .set_link_ksettings     = ax88179_set_link_ksettings,
 907         .get_ts_info            = ethtool_op_get_ts_info,
 908 };
 909
 910 static void ax88179_set_multicast(struct net_device *net)
 911 {
 912         struct usbnet *dev = netdev_priv(net);
 913         struct ax88179_data *data = (struct ax88179_data *)dev->data;
 914         u8 *m_filter = ((u8 *)dev->data) + 12;
 915
 916         data->rxctl = (AX_RX_CTL_START | AX_RX_CTL_AB | AX_RX_CTL_IPE);
 917
 918         if (net->flags & IFF_PROMISC) {
 919                 data->rxctl |= AX_RX_CTL_PRO;
 920         } else if (net->flags & IFF_ALLMULTI ||
 921                    netdev_mc_count(net) > AX_MAX_MCAST) {
 922                 data->rxctl |= AX_RX_CTL_AMALL;
 923         } else if (netdev_mc_empty(net)) {
 924                 /* just broadcast and directed */
 925         } else {
 926                 /* We use the 20 byte dev->data for our 8 byte filter buffer
 927                  * to avoid allocating memory that is tricky to free later
 928                  */
 929                 u32 crc_bits;
 930                 struct netdev_hw_addr *ha;
 931
 932                 memset(m_filter, 0, AX_MCAST_FLTSIZE);
 933
 934                 netdev_for_each_mc_addr(ha, net) {
 935                         crc_bits = ether_crc(ETH_ALEN, ha->addr) >> 26;
 936                         *(m_filter + (crc_bits >> 3)) |= (1 << (crc_bits & 7));
 937                 }
 938
 939                 ax88179_write_cmd_async(dev, AX_ACCESS_MAC, AX_MULFLTARY,
 940                                         AX_MCAST_FLTSIZE, AX_MCAST_FLTSIZE,
 941                                         m_filter);
 942
 943                 data->rxctl |= AX_RX_CTL_AM;
 944         }
 945
 946         ax88179_write_cmd_async(dev, AX_ACCESS_MAC, AX_RX_CTL,
 947                                 2, 2, &data->rxctl);
 948 }
 949
 950 static int
 951 ax88179_set_features(struct net_device *net, netdev_features_t features)
 952 {
 953         u8 tmp;
 954         struct usbnet *dev = netdev_priv(net);
 955         netdev_features_t changed = net->features ^ features;
 956
 957         if (changed & NETIF_F_IP_CSUM) {
 958                 ax88179_read_cmd(dev, AX_ACCESS_MAC, AX_TXCOE_CTL, 1, 1, &tmp);
 959                 tmp ^= AX_TXCOE_TCP | AX_TXCOE_UDP;
 960                 ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_TXCOE_CTL, 1, 1, &tmp);
 961         }
 962
 963         if (changed & NETIF_F_IPV6_CSUM) {
 964                 ax88179_read_cmd(dev, AX_ACCESS_MAC, AX_TXCOE_CTL, 1, 1, &tmp);
 965                 tmp ^= AX_TXCOE_TCPV6 | AX_TXCOE_UDPV6;
 966                 ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_TXCOE_CTL, 1, 1, &tmp);
 967         }
 968
 969         if (changed & NETIF_F_RXCSUM) {
 970                 ax88179_read_cmd(dev, AX_ACCESS_MAC, AX_RXCOE_CTL, 1, 1, &tmp);
 971                 tmp ^= AX_RXCOE_IP | AX_RXCOE_TCP | AX_RXCOE_UDP |
 972                        AX_RXCOE_TCPV6 | AX_RXCOE_UDPV6;
 973                 ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_RXCOE_CTL, 1, 1, &tmp);
 974         }
 975
 976         return 0;
 977 }
 978
 979 static int ax88179_change_mtu(struct net_device *net, int new_mtu)
 980 {
 981         struct usbnet *dev = netdev_priv(net);
 982         u16 tmp16;
 983
 984         net->mtu = new_mtu;
 985         dev->hard_mtu = net->mtu + net->hard_header_len;
 986
 987         if (net->mtu > 1500) {
 988                 ax88179_read_cmd(dev, AX_ACCESS_MAC, AX_MEDIUM_STATUS_MODE,
 989                                  2, 2, &tmp16);
 990                 tmp16 |= AX_MEDIUM_JUMBO_EN;
 991                 ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_MEDIUM_STATUS_MODE,
 992                                   2, 2, &tmp16);
 993         } else {
 994                 ax88179_read_cmd(dev, AX_ACCESS_MAC, AX_MEDIUM_STATUS_MODE,
 995                                  2, 2, &tmp16);
 996                 tmp16 &= ~AX_MEDIUM_JUMBO_EN;
 997                 ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_MEDIUM_STATUS_MODE,
 998                                   2, 2, &tmp16);
 999         }
1000
1001         /* max qlen depend on hard_mtu and rx_urb_size */
1002         usbnet_update_max_qlen(dev);
1003
1004         return 0;
1005 }
1006
1007 static int ax88179_set_mac_addr(struct net_device *net, void *p)
1008 {
1009         struct usbnet *dev = netdev_priv(net);
1010         struct sockaddr *addr = p;
1011         int ret;
1012
1013         if (netif_running(net))
1014                 return -EBUSY;
1015         if (!is_valid_ether_addr(addr->sa_data))
1016                 return -EADDRNOTAVAIL;
1017
1018         eth_hw_addr_set(net, addr->sa_data);
1019
1020         /* Set the MAC address */
1021         ret = ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_NODE_ID, ETH_ALEN,
1022                                  ETH_ALEN, net->dev_addr);
1023         if (ret < 0)
1024                 return ret;
1025
1026         return 0;
1027 }
1028
1029 static const struct net_device_ops ax88179_netdev_ops = {
1030         .ndo_open               = usbnet_open,
1031         .ndo_stop               = usbnet_stop,
1032         .ndo_start_xmit         = usbnet_start_xmit,
1033         .ndo_tx_timeout         = usbnet_tx_timeout,
1034         .ndo_get_stats64        = dev_get_tstats64,
1035         .ndo_change_mtu         = ax88179_change_mtu,
1036         .ndo_set_mac_address    = ax88179_set_mac_addr,
1037         .ndo_validate_addr      = eth_validate_addr,
1038         .ndo_eth_ioctl          = ax88179_ioctl,
1039         .ndo_set_rx_mode        = ax88179_set_multicast,
1040         .ndo_set_features       = ax88179_set_features,
1041 };
1042
1043 static int ax88179_check_eeprom(struct usbnet *dev)
1044 {
1045         u8 i, buf, eeprom[20];
1046         u16 csum, delay = HZ / 10;
1047         unsigned long jtimeout;
1048
1049         /* Read EEPROM content */
1050         for (i = 0; i < 6; i++) {
1051                 buf = i;
1052                 if (ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_SROM_ADDR,
1053                                       1, 1, &buf) < 0)
1054                         return -EINVAL;
1055
1056                 buf = EEP_RD;
1057                 if (ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_SROM_CMD,
1058                                       1, 1, &buf) < 0)
1059                         return -EINVAL;
1060
1061                 jtimeout = jiffies + delay;
1062                 do {
1063                         ax88179_read_cmd(dev, AX_ACCESS_MAC, AX_SROM_CMD,
1064                                          1, 1, &buf);
1065
1066                         if (time_after(jiffies, jtimeout))
1067                                 return -EINVAL;
1068
1069                 } while (buf & EEP_BUSY);
1070
1071                 __ax88179_read_cmd(dev, AX_ACCESS_MAC, AX_SROM_DATA_LOW,
1072                                    2, 2, &eeprom[i * 2], 0);
1073
1074                 if ((i == 0) && (eeprom[0] == 0xFF))
1075                         return -EINVAL;
1076         }
1077
1078         csum = eeprom[6] + eeprom[7] + eeprom[8] + eeprom[9];
1079         csum = (csum >> 8) + (csum & 0xff);
1080         if ((csum + eeprom[10]) != 0xff)
1081                 return -EINVAL;
1082
1083         return 0;
1084 }
1085
1086 static int ax88179_check_efuse(struct usbnet *dev, u16 *ledmode)
1087 {
1088         u8      i;
1089         u8      efuse[64];
1090         u16     csum = 0;
1091
1092         if (ax88179_read_cmd(dev, AX_ACCESS_EFUS, 0, 64, 64, efuse) < 0)
1093                 return -EINVAL;
1094
1095         if (*efuse == 0xFF)
1096                 return -EINVAL;
1097
1098         for (i = 0; i < 64; i++)
1099                 csum = csum + efuse[i];
1100
1101         while (csum > 255)
1102                 csum = (csum & 0x00FF) + ((csum >> 8) & 0x00FF);
1103
1104         if (csum != 0xFF)
1105                 return -EINVAL;
1106
1107         *ledmode = (efuse[51] << 8) | efuse[52];
1108
1109         return 0;
1110 }
1111
1112 static int ax88179_convert_old_led(struct usbnet *dev, u16 *ledvalue)
1113 {
1114         u16 led;
1115
1116         /* Loaded the old eFuse LED Mode */
1117         if (ax88179_read_cmd(dev, AX_ACCESS_EEPROM, 0x3C, 1, 2, &led) < 0)
1118                 return -EINVAL;
1119
1120         led >>= 8;
1121         switch (led) {
1122         case 0xFF:
1123                 led = LED0_ACTIVE | LED1_LINK_10 | LED1_LINK_100 |
1124                       LED1_LINK_1000 | LED2_ACTIVE | LED2_LINK_10 |
1125                       LED2_LINK_100 | LED2_LINK_1000 | LED_VALID;
1126                 break;
1127         case 0xFE:
1128                 led = LED0_ACTIVE | LED1_LINK_1000 | LED2_LINK_100 | LED_VALID;
1129                 break;
1130         case 0xFD:
1131                 led = LED0_ACTIVE | LED1_LINK_1000 | LED2_LINK_100 |
1132                       LED2_LINK_10 | LED_VALID;
1133                 break;
1134         case 0xFC:
1135                 led = LED0_ACTIVE | LED1_ACTIVE | LED1_LINK_1000 | LED2_ACTIVE |
1136                       LED2_LINK_100 | LED2_LINK_10 | LED_VALID;
1137                 break;
1138         default:
1139                 led = LED0_ACTIVE | LED1_LINK_10 | LED1_LINK_100 |
1140                       LED1_LINK_1000 | LED2_ACTIVE | LED2_LINK_10 |
1141                       LED2_LINK_100 | LED2_LINK_1000 | LED_VALID;
1142                 break;
1143         }
1144
1145         *ledvalue = led;
1146
1147         return 0;
1148 }
1149
1150 static int ax88179_led_setting(struct usbnet *dev)
1151 {
1152         u8 ledfd, value = 0;
1153         u16 tmp, ledact, ledlink, ledvalue = 0, delay = HZ / 10;
1154         unsigned long jtimeout;
1155
1156         /* Check AX88179 version. UA1 or UA2*/
1157         ax88179_read_cmd(dev, AX_ACCESS_MAC, GENERAL_STATUS, 1, 1, &value);
1158
1159         if (!(value & AX_SECLD)) {      /* UA1 */
1160                 value = AX_GPIO_CTRL_GPIO3EN | AX_GPIO_CTRL_GPIO2EN |
1161                         AX_GPIO_CTRL_GPIO1EN;
1162                 if (ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_GPIO_CTRL,
1163                                       1, 1, &value) < 0)
1164                         return -EINVAL;
1165         }
1166
1167         /* Check EEPROM */
1168         if (!ax88179_check_eeprom(dev)) {
1169                 value = 0x42;
1170                 if (ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_SROM_ADDR,
1171                                       1, 1, &value) < 0)
1172                         return -EINVAL;
1173
1174                 value = EEP_RD;
1175                 if (ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_SROM_CMD,
1176                                       1, 1, &value) < 0)
1177                         return -EINVAL;
1178
1179                 jtimeout = jiffies + delay;
1180                 do {
1181                         ax88179_read_cmd(dev, AX_ACCESS_MAC, AX_SROM_CMD,
1182                                          1, 1, &value);
1183
1184                         if (time_after(jiffies, jtimeout))
1185                                 return -EINVAL;
1186
1187                 } while (value & EEP_BUSY);
1188
1189                 ax88179_read_cmd(dev, AX_ACCESS_MAC, AX_SROM_DATA_HIGH,
1190                                  1, 1, &value);
1191                 ledvalue = (value << 8);
1192
1193                 ax88179_read_cmd(dev, AX_ACCESS_MAC, AX_SROM_DATA_LOW,
1194                                  1, 1, &value);
1195                 ledvalue |= value;
1196
1197                 /* load internal ROM for defaule setting */
1198                 if ((ledvalue == 0xFFFF) || ((ledvalue & LED_VALID) == 0))
1199                         ax88179_convert_old_led(dev, &ledvalue);
1200
1201         } else if (!ax88179_check_efuse(dev, &ledvalue)) {
1202                 if ((ledvalue == 0xFFFF) || ((ledvalue & LED_VALID) == 0))
1203                         ax88179_convert_old_led(dev, &ledvalue);
1204         } else {
1205                 ax88179_convert_old_led(dev, &ledvalue);
1206         }
1207
1208         tmp = GMII_PHY_PGSEL_EXT;
1209         ax88179_write_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
1210                           GMII_PHY_PAGE_SELECT, 2, &tmp);
1211
1212         tmp = 0x2c;
1213         ax88179_write_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
1214                           GMII_PHYPAGE, 2, &tmp);
1215
1216         ax88179_read_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
1217                          GMII_LED_ACT, 2, &ledact);
1218
1219         ax88179_read_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
1220                          GMII_LED_LINK, 2, &ledlink);
1221
1222         ledact &= GMII_LED_ACTIVE_MASK;
1223         ledlink &= GMII_LED_LINK_MASK;
1224
1225         if (ledvalue & LED0_ACTIVE)
1226                 ledact |= GMII_LED0_ACTIVE;
1227
1228         if (ledvalue & LED1_ACTIVE)
1229                 ledact |= GMII_LED1_ACTIVE;
1230
1231         if (ledvalue & LED2_ACTIVE)
1232                 ledact |= GMII_LED2_ACTIVE;
1233
1234         if (ledvalue & LED0_LINK_10)
1235                 ledlink |= GMII_LED0_LINK_10;
1236
1237         if (ledvalue & LED1_LINK_10)
1238                 ledlink |= GMII_LED1_LINK_10;
1239
1240         if (ledvalue & LED2_LINK_10)
1241                 ledlink |= GMII_LED2_LINK_10;
1242
1243         if (ledvalue & LED0_LINK_100)
1244                 ledlink |= GMII_LED0_LINK_100;
1245
1246         if (ledvalue & LED1_LINK_100)
1247                 ledlink |= GMII_LED1_LINK_100;
1248
1249         if (ledvalue & LED2_LINK_100)
1250                 ledlink |= GMII_LED2_LINK_100;
1251
1252         if (ledvalue & LED0_LINK_1000)
1253                 ledlink |= GMII_LED0_LINK_1000;
1254
1255         if (ledvalue & LED1_LINK_1000)
1256                 ledlink |= GMII_LED1_LINK_1000;
1257
1258         if (ledvalue & LED2_LINK_1000)
1259                 ledlink |= GMII_LED2_LINK_1000;
1260
1261         tmp = ledact;
1262         ax88179_write_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
1263                           GMII_LED_ACT, 2, &tmp);
1264
1265         tmp = ledlink;
1266         ax88179_write_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
1267                           GMII_LED_LINK, 2, &tmp);
1268
1269         tmp = GMII_PHY_PGSEL_PAGE0;
1270         ax88179_write_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
1271                           GMII_PHY_PAGE_SELECT, 2, &tmp);
1272
1273         /* LED full duplex setting */
1274         ledfd = 0;
1275         if (ledvalue & LED0_FD)
1276                 ledfd |= 0x01;
1277         else if ((ledvalue & LED0_USB3_MASK) == 0)
1278                 ledfd |= 0x02;
1279
1280         if (ledvalue & LED1_FD)
1281                 ledfd |= 0x04;
1282         else if ((ledvalue & LED1_USB3_MASK) == 0)
1283                 ledfd |= 0x08;
1284
1285         if (ledvalue & LED2_FD)
1286                 ledfd |= 0x10;
1287         else if ((ledvalue & LED2_USB3_MASK) == 0)
1288                 ledfd |= 0x20;
1289
1290         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_LEDCTRL, 1, 1, &ledfd);
1291
1292         return 0;
1293 }
1294
1295 static void ax88179_get_mac_addr(struct usbnet *dev)
1296 {
1297         u8 mac[ETH_ALEN];
1298
1299         memset(mac, 0, sizeof(mac));
1300
1301         /* Maybe the boot loader passed the MAC address via device tree */
1302         if (!eth_platform_get_mac_address(&dev->udev->dev, mac)) {
1303                 netif_dbg(dev, ifup, dev->net,
1304                           "MAC address read from device tree");
1305         } else {
1306                 ax88179_read_cmd(dev, AX_ACCESS_MAC, AX_NODE_ID, ETH_ALEN,
1307                                  ETH_ALEN, mac);
1308                 netif_dbg(dev, ifup, dev->net,
1309                           "MAC address read from ASIX chip");
1310         }
1311
1312         if (is_valid_ether_addr(mac)) {
1313                 eth_hw_addr_set(dev->net, mac);
1314         } else {
1315                 netdev_info(dev->net, "invalid MAC address, using random\n");
1316                 eth_hw_addr_random(dev->net);
1317         }
1318
1319         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_NODE_ID, ETH_ALEN, ETH_ALEN,
1320                           dev->net->dev_addr);
1321 }
1322
1323 static int ax88179_bind(struct usbnet *dev, struct usb_interface *intf)
1324 {
1325         u8 buf[5];
1326         u16 *tmp16;
1327         u8 *tmp;
1328         struct ax88179_data *ax179_data = (struct ax88179_data *)dev->data;
1329         struct ethtool_eee eee_data;
1330
1331         usbnet_get_endpoints(dev, intf);
1332
1333         tmp16 = (u16 *)buf;
1334         tmp = (u8 *)buf;
1335
1336         memset(ax179_data, 0, sizeof(*ax179_data));
1337
1338         /* Power up ethernet PHY */
1339         *tmp16 = 0;
1340         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_PHYPWR_RSTCTL, 2, 2, tmp16);
1341         *tmp16 = AX_PHYPWR_RSTCTL_IPRL;
1342         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_PHYPWR_RSTCTL, 2, 2, tmp16);
1343         msleep(200);
1344
1345         *tmp = AX_CLK_SELECT_ACS | AX_CLK_SELECT_BCS;
1346         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_CLK_SELECT, 1, 1, tmp);
1347         msleep(100);
1348
1349         /* Read MAC address from DTB or asix chip */
1350         ax88179_get_mac_addr(dev);
1351         memcpy(dev->net->perm_addr, dev->net->dev_addr, ETH_ALEN);
1352
1353         /* RX bulk configuration */
1354         memcpy(tmp, &AX88179_BULKIN_SIZE[0], 5);
1355         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_RX_BULKIN_QCTRL, 5, 5, tmp);
1356
1357         dev->rx_urb_size = 1024 * 20;
1358
1359         *tmp = 0x34;
1360         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_PAUSE_WATERLVL_LOW, 1, 1, tmp);
1361
1362         *tmp = 0x52;
1363         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_PAUSE_WATERLVL_HIGH,
1364                           1, 1, tmp);
1365
1366         dev->net->netdev_ops = &ax88179_netdev_ops;
1367         dev->net->ethtool_ops = &ax88179_ethtool_ops;
1368         dev->net->needed_headroom = 8;
1369         dev->net->max_mtu = 4088;
1370
1371         /* Initialize MII structure */
1372         dev->mii.dev = dev->net;
1373         dev->mii.mdio_read = ax88179_mdio_read;
1374         dev->mii.mdio_write = ax88179_mdio_write;
1375         dev->mii.phy_id_mask = 0xff;
1376         dev->mii.reg_num_mask = 0xff;
1377         dev->mii.phy_id = 0x03;
1378         dev->mii.supports_gmii = 1;
1379
1380         dev->net->features |= NETIF_F_SG | NETIF_F_IP_CSUM |
1381                               NETIF_F_IPV6_CSUM | NETIF_F_RXCSUM | NETIF_F_TSO;
1382
1383         dev->net->hw_features |= dev->net->features;
1384
1385         netif_set_tso_max_size(dev->net, 16384);
1386
1387         /* Enable checksum offload */
1388         *tmp = AX_RXCOE_IP | AX_RXCOE_TCP | AX_RXCOE_UDP |
1389                AX_RXCOE_TCPV6 | AX_RXCOE_UDPV6;
1390         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_RXCOE_CTL, 1, 1, tmp);
1391
1392         *tmp = AX_TXCOE_IP | AX_TXCOE_TCP | AX_TXCOE_UDP |
1393                AX_TXCOE_TCPV6 | AX_TXCOE_UDPV6;
1394         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_TXCOE_CTL, 1, 1, tmp);
1395
1396         /* Configure RX control register => start operation */
1397         *tmp16 = AX_RX_CTL_DROPCRCERR | AX_RX_CTL_IPE | AX_RX_CTL_START |
1398                  AX_RX_CTL_AP | AX_RX_CTL_AMALL | AX_RX_CTL_AB;
1399         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_RX_CTL, 2, 2, tmp16);
1400
1401         *tmp = AX_MONITOR_MODE_PMETYPE | AX_MONITOR_MODE_PMEPOL |
1402                AX_MONITOR_MODE_RWMP;
1403         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_MONITOR_MOD, 1, 1, tmp);
1404
1405         /* Configure default medium type => giga */
1406         *tmp16 = AX_MEDIUM_RECEIVE_EN | AX_MEDIUM_TXFLOW_CTRLEN |
1407                  AX_MEDIUM_RXFLOW_CTRLEN | AX_MEDIUM_FULL_DUPLEX |
1408                  AX_MEDIUM_GIGAMODE;
1409         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_MEDIUM_STATUS_MODE,
1410                           2, 2, tmp16);
1411
1412         ax88179_led_setting(dev);
1413
1414         ax179_data->eee_enabled = 0;
1415         ax179_data->eee_active = 0;
1416
1417         ax88179_disable_eee(dev);
1418
1419         ax88179_ethtool_get_eee(dev, &eee_data);
1420         eee_data.advertised = 0;
1421         ax88179_ethtool_set_eee(dev, &eee_data);
1422
1423         /* Restart autoneg */
1424         mii_nway_restart(&dev->mii);
1425
1426         usbnet_link_change(dev, 0, 0);
1427
1428         return 0;
1429 }
1430
1431 static void ax88179_unbind(struct usbnet *dev, struct usb_interface *intf)
1432 {
1433         u16 tmp16;
1434
1435         /* Configure RX control register => stop operation */
1436         tmp16 = AX_RX_CTL_STOP;
1437         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_RX_CTL, 2, 2, &tmp16);
1438
1439         tmp16 = 0;
1440         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_CLK_SELECT, 1, 1, &tmp16);
1441
1442         /* Power down ethernet PHY */
1443         tmp16 = 0;
1444         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_PHYPWR_RSTCTL, 2, 2, &tmp16);
1445 }
1446
1447 static void
1448 ax88179_rx_checksum(struct sk_buff *skb, u32 *pkt_hdr)
1449 {
1450         skb->ip_summed = CHECKSUM_NONE;
1451
1452         /* checksum error bit is set */
1453         if ((*pkt_hdr & AX_RXHDR_L3CSUM_ERR) ||
1454             (*pkt_hdr & AX_RXHDR_L4CSUM_ERR))
1455                 return;
1456
1457         /* It must be a TCP or UDP packet with a valid checksum */
1458         if (((*pkt_hdr & AX_RXHDR_L4_TYPE_MASK) == AX_RXHDR_L4_TYPE_TCP) ||
1459             ((*pkt_hdr & AX_RXHDR_L4_TYPE_MASK) == AX_RXHDR_L4_TYPE_UDP))
1460                 skb->ip_summed = CHECKSUM_UNNECESSARY;
1461 }
1462
1463 static int ax88179_rx_fixup(struct usbnet *dev, struct sk_buff *skb)
1464 {
1465         struct sk_buff *ax_skb;
1466         int pkt_cnt;
1467         u32 rx_hdr;
1468         u16 hdr_off;
1469         u32 *pkt_hdr;
1470
1471         /* At the end of the SKB, there's a header telling us how many packets
1472          * are bundled into this buffer and where we can find an array of
1473          * per-packet metadata (which contains elements encoded into u16).
1474          */
1475
1476         /* SKB contents for current firmware:
1477          *   <packet 1> <padding>
1478          *   ...
1479          *   <packet N> <padding>
1480          *   <per-packet metadata entry 1> <dummy header>
1481          *   ...
1482          *   <per-packet metadata entry N> <dummy header>
1483          *   <padding2> <rx_hdr>
1484          *
1485          * where:
1486          *   <packet N> contains pkt_len bytes:
1487          *              2 bytes of IP alignment pseudo header
1488          *              packet received
1489          *   <per-packet metadata entry N> contains 4 bytes:
1490          *              pkt_len and fields AX_RXHDR_*
1491          *   <padding>  0-7 bytes to terminate at
1492          *              8 bytes boundary (64-bit).
1493          *   <padding2> 4 bytes to make rx_hdr terminate at
1494          *              8 bytes boundary (64-bit)
1495          *   <dummy-header> contains 4 bytes:
1496          *              pkt_len=0 and AX_RXHDR_DROP_ERR
1497          *   <rx-hdr>   contains 4 bytes:
1498          *              pkt_cnt and hdr_off (offset of
1499          *                <per-packet metadata entry 1>)
1500          *
1501          * pkt_cnt is number of entrys in the per-packet metadata.
1502          * In current firmware there is 2 entrys per packet.
1503          * The first points to the packet and the
1504          *  second is a dummy header.
1505          * This was done probably to align fields in 64-bit and
1506          *  maintain compatibility with old firmware.
1507          * This code assumes that <dummy header> and <padding2> are
1508          *  optional.
1509          */
1510
1511         if (skb->len < 4)
1512                 return 0;
1513         skb_trim(skb, skb->len - 4);
1514         rx_hdr = get_unaligned_le32(skb_tail_pointer(skb));
1515         pkt_cnt = (u16)rx_hdr;
1516         hdr_off = (u16)(rx_hdr >> 16);
1517
1518         if (pkt_cnt == 0)
1519                 return 0;
1520
1521         /* Make sure that the bounds of the metadata array are inside the SKB
1522          * (and in front of the counter at the end).
1523          */
1524         if (pkt_cnt * 4 + hdr_off > skb->len)
1525                 return 0;
1526         pkt_hdr = (u32 *)(skb->data + hdr_off);
1527
1528         /* Packets must not overlap the metadata array */
1529         skb_trim(skb, hdr_off);
1530
1531         for (; pkt_cnt > 0; pkt_cnt--, pkt_hdr++) {
1532                 u16 pkt_len_plus_padd;
1533                 u16 pkt_len;
1534
1535                 le32_to_cpus(pkt_hdr);
1536                 pkt_len = (*pkt_hdr >> 16) & 0x1fff;
1537                 pkt_len_plus_padd = (pkt_len + 7) & 0xfff8;
1538
1539                 /* Skip dummy header used for alignment
1540                  */
1541                 if (pkt_len == 0)
1542                         continue;
1543
1544                 if (pkt_len_plus_padd > skb->len)
1545                         return 0;
1546
1547                 /* Check CRC or runt packet */
1548                 if ((*pkt_hdr & (AX_RXHDR_CRC_ERR | AX_RXHDR_DROP_ERR)) ||
1549                     pkt_len < 2 + ETH_HLEN) {
1550                         dev->net->stats.rx_errors++;
1551                         skb_pull(skb, pkt_len_plus_padd);
1552                         continue;
1553                 }
1554
1555                 /* last packet */
1556                 if (pkt_len_plus_padd == skb->len) {
1557                         skb_trim(skb, pkt_len);
1558
1559                         /* Skip IP alignment pseudo header */
1560                         skb_pull(skb, 2);
1561
1562                         skb->truesize = SKB_TRUESIZE(pkt_len_plus_padd);
1563                         ax88179_rx_checksum(skb, pkt_hdr);
1564                         return 1;
1565                 }
1566
1567                 ax_skb = skb_clone(skb, GFP_ATOMIC);
1568                 if (!ax_skb)
1569                         return 0;
1570                 skb_trim(ax_skb, pkt_len);
1571
1572                 /* Skip IP alignment pseudo header */
1573                 skb_pull(ax_skb, 2);
1574
1575                 skb->truesize = pkt_len_plus_padd +
1576                                 SKB_DATA_ALIGN(sizeof(struct sk_buff));
1577                 ax88179_rx_checksum(ax_skb, pkt_hdr);
1578                 usbnet_skb_return(dev, ax_skb);
1579
1580                 skb_pull(skb, pkt_len_plus_padd);
1581         }
1582
1583         return 0;
1584 }
1585
1586 static struct sk_buff *
1587 ax88179_tx_fixup(struct usbnet *dev, struct sk_buff *skb, gfp_t flags)
1588 {
1589         u32 tx_hdr1, tx_hdr2;
1590         int frame_size = dev->maxpacket;
1591         int headroom;
1592         void *ptr;
1593
1594         tx_hdr1 = skb->len;
1595         tx_hdr2 = skb_shinfo(skb)->gso_size; /* Set TSO mss */
1596         if (((skb->len + 8) % frame_size) == 0)
1597                 tx_hdr2 |= 0x80008000;  /* Enable padding */
1598
1599         headroom = skb_headroom(skb) - 8;
1600
1601         if ((dev->net->features & NETIF_F_SG) && skb_linearize(skb))
1602                 return NULL;
1603
1604         if ((skb_header_cloned(skb) || headroom < 0) &&
1605             pskb_expand_head(skb, headroom < 0 ? 8 : 0, 0, GFP_ATOMIC)) {
1606                 dev_kfree_skb_any(skb);
1607                 return NULL;
1608         }
1609
1610         ptr = skb_push(skb, 8);
1611         put_unaligned_le32(tx_hdr1, ptr);
1612         put_unaligned_le32(tx_hdr2, ptr + 4);
1613
1614         usbnet_set_skb_tx_stats(skb, (skb_shinfo(skb)->gso_segs ?: 1), 0);
1615
1616         return skb;
1617 }
1618
1619 static int ax88179_link_reset(struct usbnet *dev)
1620 {
1621         struct ax88179_data *ax179_data = (struct ax88179_data *)dev->data;
1622         u8 tmp[5], link_sts;
1623         u16 mode, tmp16, delay = HZ / 10;
1624         u32 tmp32 = 0x40000000;
1625         unsigned long jtimeout;
1626
1627         jtimeout = jiffies + delay;
1628         while (tmp32 & 0x40000000) {
1629                 mode = 0;
1630                 ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_RX_CTL, 2, 2, &mode);
1631                 ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_RX_CTL, 2, 2,
1632                                   &ax179_data->rxctl);
1633
1634                 /*link up, check the usb device control TX FIFO full or empty*/
1635                 ax88179_read_cmd(dev, 0x81, 0x8c, 0, 4, &tmp32);
1636
1637                 if (time_after(jiffies, jtimeout))
1638                         return 0;
1639         }
1640
1641         mode = AX_MEDIUM_RECEIVE_EN | AX_MEDIUM_TXFLOW_CTRLEN |
1642                AX_MEDIUM_RXFLOW_CTRLEN;
1643
1644         ax88179_read_cmd(dev, AX_ACCESS_MAC, PHYSICAL_LINK_STATUS,
1645                          1, 1, &link_sts);
1646
1647         ax88179_read_cmd(dev, AX_ACCESS_PHY, AX88179_PHY_ID,
1648                          GMII_PHY_PHYSR, 2, &tmp16);
1649
1650         if (!(tmp16 & GMII_PHY_PHYSR_LINK)) {
1651                 return 0;
1652         } else if (GMII_PHY_PHYSR_GIGA == (tmp16 & GMII_PHY_PHYSR_SMASK)) {
1653                 mode |= AX_MEDIUM_GIGAMODE | AX_MEDIUM_EN_125MHZ;
1654                 if (dev->net->mtu > 1500)
1655                         mode |= AX_MEDIUM_JUMBO_EN;
1656
1657                 if (link_sts & AX_USB_SS)
1658                         memcpy(tmp, &AX88179_BULKIN_SIZE[0], 5);
1659                 else if (link_sts & AX_USB_HS)
1660                         memcpy(tmp, &AX88179_BULKIN_SIZE[1], 5);
1661                 else
1662                         memcpy(tmp, &AX88179_BULKIN_SIZE[3], 5);
1663         } else if (GMII_PHY_PHYSR_100 == (tmp16 & GMII_PHY_PHYSR_SMASK)) {
1664                 mode |= AX_MEDIUM_PS;
1665
1666                 if (link_sts & (AX_USB_SS | AX_USB_HS))
1667                         memcpy(tmp, &AX88179_BULKIN_SIZE[2], 5);
1668                 else
1669                         memcpy(tmp, &AX88179_BULKIN_SIZE[3], 5);
1670         } else {
1671                 memcpy(tmp, &AX88179_BULKIN_SIZE[3], 5);
1672         }
1673
1674         /* RX bulk configuration */
1675         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_RX_BULKIN_QCTRL, 5, 5, tmp);
1676
1677         dev->rx_urb_size = (1024 * (tmp[3] + 2));
1678
1679         if (tmp16 & GMII_PHY_PHYSR_FULL)
1680                 mode |= AX_MEDIUM_FULL_DUPLEX;
1681         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_MEDIUM_STATUS_MODE,
1682                           2, 2, &mode);
1683
1684         ax179_data->eee_enabled = ax88179_chk_eee(dev);
1685
1686         netif_carrier_on(dev->net);
1687
1688         return 0;
1689 }
1690
1691 static int ax88179_reset(struct usbnet *dev)
1692 {
1693         u8 buf[5];
1694         u16 *tmp16;
1695         u8 *tmp;
1696         struct ax88179_data *ax179_data = (struct ax88179_data *)dev->data;
1697         struct ethtool_eee eee_data;
1698
1699         tmp16 = (u16 *)buf;
1700         tmp = (u8 *)buf;
1701
1702         /* Power up ethernet PHY */
1703         *tmp16 = 0;
1704         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_PHYPWR_RSTCTL, 2, 2, tmp16);
1705
1706         *tmp16 = AX_PHYPWR_RSTCTL_IPRL;
1707         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_PHYPWR_RSTCTL, 2, 2, tmp16);
1708         msleep(200);
1709
1710         *tmp = AX_CLK_SELECT_ACS | AX_CLK_SELECT_BCS;
1711         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_CLK_SELECT, 1, 1, tmp);
1712         msleep(100);
1713
1714         /* Ethernet PHY Auto Detach*/
1715         ax88179_auto_detach(dev, 0);
1716
1717         /* Read MAC address from DTB or asix chip */
1718         ax88179_get_mac_addr(dev);
1719
1720         /* RX bulk configuration */
1721         memcpy(tmp, &AX88179_BULKIN_SIZE[0], 5);
1722         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_RX_BULKIN_QCTRL, 5, 5, tmp);
1723
1724         dev->rx_urb_size = 1024 * 20;
1725
1726         *tmp = 0x34;
1727         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_PAUSE_WATERLVL_LOW, 1, 1, tmp);
1728
1729         *tmp = 0x52;
1730         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_PAUSE_WATERLVL_HIGH,
1731                           1, 1, tmp);
1732
1733         dev->net->features |= NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM |
1734                               NETIF_F_RXCSUM;
1735
1736         dev->net->hw_features |= NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM |
1737                                  NETIF_F_RXCSUM;
1738
1739         /* Enable checksum offload */
1740         *tmp = AX_RXCOE_IP | AX_RXCOE_TCP | AX_RXCOE_UDP |
1741                AX_RXCOE_TCPV6 | AX_RXCOE_UDPV6;
1742         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_RXCOE_CTL, 1, 1, tmp);
1743
1744         *tmp = AX_TXCOE_IP | AX_TXCOE_TCP | AX_TXCOE_UDP |
1745                AX_TXCOE_TCPV6 | AX_TXCOE_UDPV6;
1746         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_TXCOE_CTL, 1, 1, tmp);
1747
1748         /* Configure RX control register => start operation */
1749         *tmp16 = AX_RX_CTL_DROPCRCERR | AX_RX_CTL_IPE | AX_RX_CTL_START |
1750                  AX_RX_CTL_AP | AX_RX_CTL_AMALL | AX_RX_CTL_AB;
1751         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_RX_CTL, 2, 2, tmp16);
1752
1753         *tmp = AX_MONITOR_MODE_PMETYPE | AX_MONITOR_MODE_PMEPOL |
1754                AX_MONITOR_MODE_RWMP;
1755         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_MONITOR_MOD, 1, 1, tmp);
1756
1757         /* Configure default medium type => giga */
1758         *tmp16 = AX_MEDIUM_RECEIVE_EN | AX_MEDIUM_TXFLOW_CTRLEN |
1759                  AX_MEDIUM_RXFLOW_CTRLEN | AX_MEDIUM_FULL_DUPLEX |
1760                  AX_MEDIUM_GIGAMODE;
1761         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_MEDIUM_STATUS_MODE,
1762                           2, 2, tmp16);
1763
1764         ax88179_led_setting(dev);
1765
1766         ax179_data->eee_enabled = 0;
1767         ax179_data->eee_active = 0;
1768
1769         ax88179_disable_eee(dev);
1770
1771         ax88179_ethtool_get_eee(dev, &eee_data);
1772         eee_data.advertised = 0;
1773         ax88179_ethtool_set_eee(dev, &eee_data);
1774
1775         /* Restart autoneg */
1776         mii_nway_restart(&dev->mii);
1777
1778         usbnet_link_change(dev, 0, 0);
1779
1780         return 0;
1781 }
1782
1783 static int ax88179_stop(struct usbnet *dev)
1784 {
1785         u16 tmp16;
1786
1787         ax88179_read_cmd(dev, AX_ACCESS_MAC, AX_MEDIUM_STATUS_MODE,
1788                          2, 2, &tmp16);
1789         tmp16 &= ~AX_MEDIUM_RECEIVE_EN;
1790         ax88179_write_cmd(dev, AX_ACCESS_MAC, AX_MEDIUM_STATUS_MODE,
1791                           2, 2, &tmp16);
1792
1793         return 0;
1794 }
1795
1796 static const struct driver_info ax88179_info = {
1797         .description = "ASIX AX88179 USB 3.0 Gigabit Ethernet",
1798         .bind = ax88179_bind,
1799         .unbind = ax88179_unbind,
1800         .status = ax88179_status,
1801         .link_reset = ax88179_link_reset,
1802         .reset = ax88179_reset,
1803         .stop = ax88179_stop,
1804         .flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_SEND_ZLP,
1805         .rx_fixup = ax88179_rx_fixup,
1806         .tx_fixup = ax88179_tx_fixup,
1807 };
1808
1809 static const struct driver_info ax88178a_info = {
1810         .description = "ASIX AX88178A USB 2.0 Gigabit Ethernet",
1811         .bind = ax88179_bind,
1812         .unbind = ax88179_unbind,
1813         .status = ax88179_status,
1814         .link_reset = ax88179_link_reset,
1815         .reset = ax88179_reset,
1816         .stop = ax88179_stop,
1817         .flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_SEND_ZLP,
1818         .rx_fixup = ax88179_rx_fixup,
1819         .tx_fixup = ax88179_tx_fixup,
1820 };
1821
1822 static const struct driver_info cypress_GX3_info = {
1823         .description = "Cypress GX3 SuperSpeed to Gigabit Ethernet Controller",
1824         .bind = ax88179_bind,
1825         .unbind = ax88179_unbind,
1826         .status = ax88179_status,
1827         .link_reset = ax88179_link_reset,
1828         .reset = ax88179_reset,
1829         .stop = ax88179_stop,
1830         .flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_SEND_ZLP,
1831         .rx_fixup = ax88179_rx_fixup,
1832         .tx_fixup = ax88179_tx_fixup,
1833 };
1834
1835 static const struct driver_info dlink_dub1312_info = {
1836         .description = "D-Link DUB-1312 USB 3.0 to Gigabit Ethernet Adapter",
1837         .bind = ax88179_bind,
1838         .unbind = ax88179_unbind,
1839         .status = ax88179_status,
1840         .link_reset = ax88179_link_reset,
1841         .reset = ax88179_reset,
1842         .stop = ax88179_stop,
1843         .flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_SEND_ZLP,
1844         .rx_fixup = ax88179_rx_fixup,
1845         .tx_fixup = ax88179_tx_fixup,
1846 };
1847
1848 static const struct driver_info sitecom_info = {
1849         .description = "Sitecom USB 3.0 to Gigabit Adapter",
1850         .bind = ax88179_bind,
1851         .unbind = ax88179_unbind,
1852         .status = ax88179_status,
1853         .link_reset = ax88179_link_reset,
1854         .reset = ax88179_reset,
1855         .stop = ax88179_stop,
1856         .flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_SEND_ZLP,
1857         .rx_fixup = ax88179_rx_fixup,
1858         .tx_fixup = ax88179_tx_fixup,
1859 };
1860
1861 static const struct driver_info samsung_info = {
1862         .description = "Samsung USB Ethernet Adapter",
1863         .bind = ax88179_bind,
1864         .unbind = ax88179_unbind,
1865         .status = ax88179_status,
1866         .link_reset = ax88179_link_reset,
1867         .reset = ax88179_reset,
1868         .stop = ax88179_stop,
1869         .flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_SEND_ZLP,
1870         .rx_fixup = ax88179_rx_fixup,
1871         .tx_fixup = ax88179_tx_fixup,
1872 };
1873
1874 static const struct driver_info lenovo_info = {
1875         .description = "Lenovo OneLinkDock Gigabit LAN",
1876         .bind = ax88179_bind,
1877         .unbind = ax88179_unbind,
1878         .status = ax88179_status,
1879         .link_reset = ax88179_link_reset,
1880         .reset = ax88179_reset,
1881         .stop = ax88179_stop,
1882         .flags = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_SEND_ZLP,
1883         .rx_fixup = ax88179_rx_fixup,
1884         .tx_fixup = ax88179_tx_fixup,
1885 };
1886
1887 static const struct driver_info belkin_info = {
1888         .description = "Belkin USB Ethernet Adapter",
1889         .bind   = ax88179_bind,
1890         .unbind = ax88179_unbind,
1891         .status = ax88179_status,
1892         .link_reset = ax88179_link_reset,
1893         .reset  = ax88179_reset,
1894         .stop   = ax88179_stop,
1895         .flags  = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_SEND_ZLP,
1896         .rx_fixup = ax88179_rx_fixup,
1897         .tx_fixup = ax88179_tx_fixup,
1898 };
1899
1900 static const struct driver_info toshiba_info = {
1901         .description = "Toshiba USB Ethernet Adapter",
1902         .bind   = ax88179_bind,
1903         .unbind = ax88179_unbind,
1904         .status = ax88179_status,
1905         .link_reset = ax88179_link_reset,
1906         .reset  = ax88179_reset,
1907         .stop = ax88179_stop,
1908         .flags  = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_SEND_ZLP,
1909         .rx_fixup = ax88179_rx_fixup,
1910         .tx_fixup = ax88179_tx_fixup,
1911 };
1912
1913 static const struct driver_info mct_info = {
1914         .description = "MCT USB 3.0 Gigabit Ethernet Adapter",
1915         .bind   = ax88179_bind,
1916         .unbind = ax88179_unbind,
1917         .status = ax88179_status,
1918         .link_reset = ax88179_link_reset,
1919         .reset  = ax88179_reset,
1920         .stop   = ax88179_stop,
1921         .flags  = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_SEND_ZLP,
1922         .rx_fixup = ax88179_rx_fixup,
1923         .tx_fixup = ax88179_tx_fixup,
1924 };
1925
1926 static const struct driver_info at_umc2000_info = {
1927         .description = "AT-UMC2000 USB 3.0/USB 3.1 Gen 1 to Gigabit Ethernet Adapter",
1928         .bind   = ax88179_bind,
1929         .unbind = ax88179_unbind,
1930         .status = ax88179_status,
1931         .link_reset = ax88179_link_reset,
1932         .reset  = ax88179_reset,
1933         .stop   = ax88179_stop,
1934         .flags  = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_SEND_ZLP,
1935         .rx_fixup = ax88179_rx_fixup,
1936         .tx_fixup = ax88179_tx_fixup,
1937 };
1938
1939 static const struct driver_info at_umc200_info = {
1940         .description = "AT-UMC200 USB 3.0/USB 3.1 Gen 1 to Fast Ethernet Adapter",
1941         .bind   = ax88179_bind,
1942         .unbind = ax88179_unbind,
1943         .status = ax88179_status,
1944         .link_reset = ax88179_link_reset,
1945         .reset  = ax88179_reset,
1946         .stop   = ax88179_stop,
1947         .flags  = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_SEND_ZLP,
1948         .rx_fixup = ax88179_rx_fixup,
1949         .tx_fixup = ax88179_tx_fixup,
1950 };
1951
1952 static const struct driver_info at_umc2000sp_info = {
1953         .description = "AT-UMC2000/SP USB 3.0/USB 3.1 Gen 1 to Gigabit Ethernet Adapter",
1954         .bind   = ax88179_bind,
1955         .unbind = ax88179_unbind,
1956         .status = ax88179_status,
1957         .link_reset = ax88179_link_reset,
1958         .reset  = ax88179_reset,
1959         .stop   = ax88179_stop,
1960         .flags  = FLAG_ETHER | FLAG_FRAMING_AX | FLAG_SEND_ZLP,
1961         .rx_fixup = ax88179_rx_fixup,
1962         .tx_fixup = ax88179_tx_fixup,
1963 };
1964
1965 static const struct usb_device_id products[] = {
1966 {
1967         /* ASIX AX88179 10/100/1000 */
1968         USB_DEVICE(0x0b95, 0x1790),
1969         .driver_info = (unsigned long)&ax88179_info,
1970 }, {
1971         /* ASIX AX88178A 10/100/1000 */
1972         USB_DEVICE(0x0b95, 0x178a),
1973         .driver_info = (unsigned long)&ax88178a_info,
1974 }, {
1975         /* Cypress GX3 SuperSpeed to Gigabit Ethernet Bridge Controller */
1976         USB_DEVICE(0x04b4, 0x3610),
1977         .driver_info = (unsigned long)&cypress_GX3_info,
1978 }, {
1979         /* D-Link DUB-1312 USB 3.0 to Gigabit Ethernet Adapter */
1980         USB_DEVICE(0x2001, 0x4a00),
1981         .driver_info = (unsigned long)&dlink_dub1312_info,
1982 }, {
1983         /* Sitecom USB 3.0 to Gigabit Adapter */
1984         USB_DEVICE(0x0df6, 0x0072),
1985         .driver_info = (unsigned long)&sitecom_info,
1986 }, {
1987         /* Samsung USB Ethernet Adapter */
1988         USB_DEVICE(0x04e8, 0xa100),
1989         .driver_info = (unsigned long)&samsung_info,
1990 }, {
1991         /* Lenovo OneLinkDock Gigabit LAN */
1992         USB_DEVICE(0x17ef, 0x304b),
1993         .driver_info = (unsigned long)&lenovo_info,
1994 }, {
1995         /* Belkin B2B128 USB 3.0 Hub + Gigabit Ethernet Adapter */
1996         USB_DEVICE(0x050d, 0x0128),
1997         .driver_info = (unsigned long)&belkin_info,
1998 }, {
1999         /* Toshiba USB 3.0 GBit Ethernet Adapter */
2000         USB_DEVICE(0x0930, 0x0a13),
2001         .driver_info = (unsigned long)&toshiba_info,
2002 }, {
2003         /* Magic Control Technology U3-A9003 USB 3.0 Gigabit Ethernet Adapter */
2004         USB_DEVICE(0x0711, 0x0179),
2005         .driver_info = (unsigned long)&mct_info,
2006 }, {
2007         /* Allied Telesis AT-UMC2000 USB 3.0/USB 3.1 Gen 1 to Gigabit Ethernet Adapter */
2008         USB_DEVICE(0x07c9, 0x000e),
2009         .driver_info = (unsigned long)&at_umc2000_info,
2010 }, {
2011         /* Allied Telesis AT-UMC200 USB 3.0/USB 3.1 Gen 1 to Fast Ethernet Adapter */
2012         USB_DEVICE(0x07c9, 0x000f),
2013         .driver_info = (unsigned long)&at_umc200_info,
2014 }, {
2015         /* Allied Telesis AT-UMC2000/SP USB 3.0/USB 3.1 Gen 1 to Gigabit Ethernet Adapter */
2016         USB_DEVICE(0x07c9, 0x0010),
2017         .driver_info = (unsigned long)&at_umc2000sp_info,
2018 },
2019         { },
2020 };
2021 MODULE_DEVICE_TABLE(usb, products);
2022
2023 static struct usb_driver ax88179_178a_driver = {
2024         .name =         "ax88179_178a",
2025         .id_table =     products,
2026         .probe =        usbnet_probe,
2027         .suspend =      ax88179_suspend,
2028         .resume =       ax88179_resume,
2029         .reset_resume = ax88179_resume,
2030         .disconnect =   usbnet_disconnect,
2031         .supports_autosuspend = 1,
2032         .disable_hub_initiated_lpm = 1,
2033 };
2034
2035 module_usb_driver(ax88179_178a_driver);
2036
2037 MODULE_DESCRIPTION("ASIX AX88179/178A based USB 3.0/2.0 Gigabit Ethernet Devices");
2038 MODULE_LICENSE("GPL");