drivers/net/usb/lan78xx.c

   1 /*
   2  * Copyright (C) 2015 Microchip Technology
   3  *
   4  * This program is free software; you can redistribute it and/or
   5  * modify it under the terms of the GNU General Public License
   6  * as published by the Free Software Foundation; either version 2
   7  * of the License, or (at your option) any later version.
   8  *
   9  * This program is distributed in the hope that it will be useful,
  10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  12  * GNU General Public License for more details.
  13  *
  14  * You should have received a copy of the GNU General Public License
  15  * along with this program; if not, see <http://www.gnu.org/licenses/>.
  16  */
  17 #include <linux/version.h>
  18 #include <linux/module.h>
  19 #include <linux/netdevice.h>
  20 #include <linux/etherdevice.h>
  21 #include <linux/ethtool.h>
  22 #include <linux/usb.h>
  23 #include <linux/crc32.h>
  24 #include <linux/signal.h>
  25 #include <linux/slab.h>
  26 #include <linux/if_vlan.h>
  27 #include <linux/uaccess.h>
  28 #include <linux/list.h>
  29 #include <linux/ip.h>
  30 #include <linux/ipv6.h>
  31 #include <linux/mdio.h>
  32 #include <net/ip6_checksum.h>
  33 #include <linux/microchipphy.h>
  34 #include "lan78xx.h"
  35
  36 #define DRIVER_AUTHOR   "WOOJUNG HUH <woojung.huh@microchip.com>"
  37 #define DRIVER_DESC     "LAN78XX USB 3.0 Gigabit Ethernet Devices"
  38 #define DRIVER_NAME     "lan78xx"
  39 #define DRIVER_VERSION  "1.0.4"
  40
  41 #define TX_TIMEOUT_JIFFIES              (5 * HZ)
  42 #define THROTTLE_JIFFIES                (HZ / 8)
  43 #define UNLINK_TIMEOUT_MS               3
  44
  45 #define RX_MAX_QUEUE_MEMORY             (60 * 1518)
  46
  47 #define SS_USB_PKT_SIZE                 (1024)
  48 #define HS_USB_PKT_SIZE                 (512)
  49 #define FS_USB_PKT_SIZE                 (64)
  50
  51 #define MAX_RX_FIFO_SIZE                (12 * 1024)
  52 #define MAX_TX_FIFO_SIZE                (12 * 1024)
  53 #define DEFAULT_BURST_CAP_SIZE          (MAX_TX_FIFO_SIZE)
  54 #define DEFAULT_BULK_IN_DELAY           (0x0800)
  55 #define MAX_SINGLE_PACKET_SIZE          (9000)
  56 #define DEFAULT_TX_CSUM_ENABLE          (true)
  57 #define DEFAULT_RX_CSUM_ENABLE          (true)
  58 #define DEFAULT_TSO_CSUM_ENABLE         (true)
  59 #define DEFAULT_VLAN_FILTER_ENABLE      (true)
  60 #define TX_OVERHEAD                     (8)
  61 #define RXW_PADDING                     2
  62
  63 #define LAN78XX_USB_VENDOR_ID           (0x0424)
  64 #define LAN7800_USB_PRODUCT_ID          (0x7800)
  65 #define LAN7850_USB_PRODUCT_ID          (0x7850)
  66 #define LAN78XX_EEPROM_MAGIC            (0x78A5)
  67 #define LAN78XX_OTP_MAGIC               (0x78F3)
  68
  69 #define MII_READ                        1
  70 #define MII_WRITE                       0
  71
  72 #define EEPROM_INDICATOR                (0xA5)
  73 #define EEPROM_MAC_OFFSET               (0x01)
  74 #define MAX_EEPROM_SIZE                 512
  75 #define OTP_INDICATOR_1                 (0xF3)
  76 #define OTP_INDICATOR_2                 (0xF7)
  77
  78 #define WAKE_ALL                        (WAKE_PHY | WAKE_UCAST | \
  79                                          WAKE_MCAST | WAKE_BCAST | \
  80                                          WAKE_ARP | WAKE_MAGIC)
  81
  82 /* USB related defines */
  83 #define BULK_IN_PIPE                    1
  84 #define BULK_OUT_PIPE                   2
  85
  86 /* default autosuspend delay (mSec)*/
  87 #define DEFAULT_AUTOSUSPEND_DELAY       (10 * 1000)
  88
  89 /* statistic update interval (mSec) */
  90 #define STAT_UPDATE_TIMER               (1 * 1000)
  91
  92 static const char lan78xx_gstrings[][ETH_GSTRING_LEN] = {
  93         "RX FCS Errors",
  94         "RX Alignment Errors",
  95         "Rx Fragment Errors",
  96         "RX Jabber Errors",
  97         "RX Undersize Frame Errors",
  98         "RX Oversize Frame Errors",
  99         "RX Dropped Frames",
 100         "RX Unicast Byte Count",
 101         "RX Broadcast Byte Count",
 102         "RX Multicast Byte Count",
 103         "RX Unicast Frames",
 104         "RX Broadcast Frames",
 105         "RX Multicast Frames",
 106         "RX Pause Frames",
 107         "RX 64 Byte Frames",
 108         "RX 65 - 127 Byte Frames",
 109         "RX 128 - 255 Byte Frames",
 110         "RX 256 - 511 Bytes Frames",
 111         "RX 512 - 1023 Byte Frames",
 112         "RX 1024 - 1518 Byte Frames",
 113         "RX Greater 1518 Byte Frames",
 114         "EEE RX LPI Transitions",
 115         "EEE RX LPI Time",
 116         "TX FCS Errors",
 117         "TX Excess Deferral Errors",
 118         "TX Carrier Errors",
 119         "TX Bad Byte Count",
 120         "TX Single Collisions",
 121         "TX Multiple Collisions",
 122         "TX Excessive Collision",
 123         "TX Late Collisions",
 124         "TX Unicast Byte Count",
 125         "TX Broadcast Byte Count",
 126         "TX Multicast Byte Count",
 127         "TX Unicast Frames",
 128         "TX Broadcast Frames",
 129         "TX Multicast Frames",
 130         "TX Pause Frames",
 131         "TX 64 Byte Frames",
 132         "TX 65 - 127 Byte Frames",
 133         "TX 128 - 255 Byte Frames",
 134         "TX 256 - 511 Bytes Frames",
 135         "TX 512 - 1023 Byte Frames",
 136         "TX 1024 - 1518 Byte Frames",
 137         "TX Greater 1518 Byte Frames",
 138         "EEE TX LPI Transitions",
 139         "EEE TX LPI Time",
 140 };
 141
 142 struct lan78xx_statstage {
 143         u32 rx_fcs_errors;
 144         u32 rx_alignment_errors;
 145         u32 rx_fragment_errors;
 146         u32 rx_jabber_errors;
 147         u32 rx_undersize_frame_errors;
 148         u32 rx_oversize_frame_errors;
 149         u32 rx_dropped_frames;
 150         u32 rx_unicast_byte_count;
 151         u32 rx_broadcast_byte_count;
 152         u32 rx_multicast_byte_count;
 153         u32 rx_unicast_frames;
 154         u32 rx_broadcast_frames;
 155         u32 rx_multicast_frames;
 156         u32 rx_pause_frames;
 157         u32 rx_64_byte_frames;
 158         u32 rx_65_127_byte_frames;
 159         u32 rx_128_255_byte_frames;
 160         u32 rx_256_511_bytes_frames;
 161         u32 rx_512_1023_byte_frames;
 162         u32 rx_1024_1518_byte_frames;
 163         u32 rx_greater_1518_byte_frames;
 164         u32 eee_rx_lpi_transitions;
 165         u32 eee_rx_lpi_time;
 166         u32 tx_fcs_errors;
 167         u32 tx_excess_deferral_errors;
 168         u32 tx_carrier_errors;
 169         u32 tx_bad_byte_count;
 170         u32 tx_single_collisions;
 171         u32 tx_multiple_collisions;
 172         u32 tx_excessive_collision;
 173         u32 tx_late_collisions;
 174         u32 tx_unicast_byte_count;
 175         u32 tx_broadcast_byte_count;
 176         u32 tx_multicast_byte_count;
 177         u32 tx_unicast_frames;
 178         u32 tx_broadcast_frames;
 179         u32 tx_multicast_frames;
 180         u32 tx_pause_frames;
 181         u32 tx_64_byte_frames;
 182         u32 tx_65_127_byte_frames;
 183         u32 tx_128_255_byte_frames;
 184         u32 tx_256_511_bytes_frames;
 185         u32 tx_512_1023_byte_frames;
 186         u32 tx_1024_1518_byte_frames;
 187         u32 tx_greater_1518_byte_frames;
 188         u32 eee_tx_lpi_transitions;
 189         u32 eee_tx_lpi_time;
 190 };
 191
 192 struct lan78xx_statstage64 {
 193         u64 rx_fcs_errors;
 194         u64 rx_alignment_errors;
 195         u64 rx_fragment_errors;
 196         u64 rx_jabber_errors;
 197         u64 rx_undersize_frame_errors;
 198         u64 rx_oversize_frame_errors;
 199         u64 rx_dropped_frames;
 200         u64 rx_unicast_byte_count;
 201         u64 rx_broadcast_byte_count;
 202         u64 rx_multicast_byte_count;
 203         u64 rx_unicast_frames;
 204         u64 rx_broadcast_frames;
 205         u64 rx_multicast_frames;
 206         u64 rx_pause_frames;
 207         u64 rx_64_byte_frames;
 208         u64 rx_65_127_byte_frames;
 209         u64 rx_128_255_byte_frames;
 210         u64 rx_256_511_bytes_frames;
 211         u64 rx_512_1023_byte_frames;
 212         u64 rx_1024_1518_byte_frames;
 213         u64 rx_greater_1518_byte_frames;
 214         u64 eee_rx_lpi_transitions;
 215         u64 eee_rx_lpi_time;
 216         u64 tx_fcs_errors;
 217         u64 tx_excess_deferral_errors;
 218         u64 tx_carrier_errors;
 219         u64 tx_bad_byte_count;
 220         u64 tx_single_collisions;
 221         u64 tx_multiple_collisions;
 222         u64 tx_excessive_collision;
 223         u64 tx_late_collisions;
 224         u64 tx_unicast_byte_count;
 225         u64 tx_broadcast_byte_count;
 226         u64 tx_multicast_byte_count;
 227         u64 tx_unicast_frames;
 228         u64 tx_broadcast_frames;
 229         u64 tx_multicast_frames;
 230         u64 tx_pause_frames;
 231         u64 tx_64_byte_frames;
 232         u64 tx_65_127_byte_frames;
 233         u64 tx_128_255_byte_frames;
 234         u64 tx_256_511_bytes_frames;
 235         u64 tx_512_1023_byte_frames;
 236         u64 tx_1024_1518_byte_frames;
 237         u64 tx_greater_1518_byte_frames;
 238         u64 eee_tx_lpi_transitions;
 239         u64 eee_tx_lpi_time;
 240 };
 241
 242 struct lan78xx_net;
 243
 244 struct lan78xx_priv {
 245         struct lan78xx_net *dev;
 246         u32 rfe_ctl;
 247         u32 mchash_table[DP_SEL_VHF_HASH_LEN]; /* multicat hash table */
 248         u32 pfilter_table[NUM_OF_MAF][2]; /* perfect filter table */
 249         u32 vlan_table[DP_SEL_VHF_VLAN_LEN];
 250         struct mutex dataport_mutex; /* for dataport access */
 251         spinlock_t rfe_ctl_lock; /* for rfe register access */
 252         struct work_struct set_multicast;
 253         struct work_struct set_vlan;
 254         u32 wol;
 255 };
 256
 257 enum skb_state {
 258         illegal = 0,
 259         tx_start,
 260         tx_done,
 261         rx_start,
 262         rx_done,
 263         rx_cleanup,
 264         unlink_start
 265 };
 266
 267 struct skb_data {               /* skb->cb is one of these */
 268         struct urb *urb;
 269         struct lan78xx_net *dev;
 270         enum skb_state state;
 271         size_t length;
 272         int num_of_packet;
 273 };
 274
 275 struct usb_context {
 276         struct usb_ctrlrequest req;
 277         struct lan78xx_net *dev;
 278 };
 279
 280 #define EVENT_TX_HALT                   0
 281 #define EVENT_RX_HALT                   1
 282 #define EVENT_RX_MEMORY                 2
 283 #define EVENT_STS_SPLIT                 3
 284 #define EVENT_LINK_RESET                4
 285 #define EVENT_RX_PAUSED                 5
 286 #define EVENT_DEV_WAKING                6
 287 #define EVENT_DEV_ASLEEP                7
 288 #define EVENT_DEV_OPEN                  8
 289 #define EVENT_STAT_UPDATE               9
 290
 291 struct statstage {
 292         struct mutex                    access_lock;    /* for stats access */
 293         struct lan78xx_statstage        saved;
 294         struct lan78xx_statstage        rollover_count;
 295         struct lan78xx_statstage        rollover_max;
 296         struct lan78xx_statstage64      curr_stat;
 297 };
 298
 299 struct lan78xx_net {
 300         struct net_device       *net;
 301         struct usb_device       *udev;
 302         struct usb_interface    *intf;
 303         void                    *driver_priv;
 304
 305         int                     rx_qlen;
 306         int                     tx_qlen;
 307         struct sk_buff_head     rxq;
 308         struct sk_buff_head     txq;
 309         struct sk_buff_head     done;
 310         struct sk_buff_head     rxq_pause;
 311         struct sk_buff_head     txq_pend;
 312
 313         struct tasklet_struct   bh;
 314         struct delayed_work     wq;
 315
 316         struct usb_host_endpoint *ep_blkin;
 317         struct usb_host_endpoint *ep_blkout;
 318         struct usb_host_endpoint *ep_intr;
 319
 320         int                     msg_enable;
 321
 322         struct urb              *urb_intr;
 323         struct usb_anchor       deferred;
 324
 325         struct mutex            phy_mutex; /* for phy access */
 326         unsigned                pipe_in, pipe_out, pipe_intr;
 327
 328         u32                     hard_mtu;       /* count any extra framing */
 329         size_t                  rx_urb_size;    /* size for rx urbs */
 330
 331         unsigned long           flags;
 332
 333         wait_queue_head_t       *wait;
 334         unsigned char           suspend_count;
 335
 336         unsigned                maxpacket;
 337         struct timer_list       delay;
 338         struct timer_list       stat_monitor;
 339
 340         unsigned long           data[5];
 341
 342         int                     link_on;
 343         u8                      mdix_ctrl;
 344
 345         u32                     chipid;
 346         u32                     chiprev;
 347         struct mii_bus          *mdiobus;
 348
 349         int                     fc_autoneg;
 350         u8                      fc_request_control;
 351
 352         int                     delta;
 353         struct statstage        stats;
 354 };
 355
 356 /* use ethtool to change the level for any given device */
 357 static int msg_level = -1;
 358 module_param(msg_level, int, 0);
 359 MODULE_PARM_DESC(msg_level, "Override default message level");
 360
 361 static int lan78xx_read_reg(struct lan78xx_net *dev, u32 index, u32 *data)
 362 {
 363         u32 *buf = kmalloc(sizeof(u32), GFP_KERNEL);
 364         int ret;
 365
 366         if (!buf)
 367                 return -ENOMEM;
 368
 369         ret = usb_control_msg(dev->udev, usb_rcvctrlpipe(dev->udev, 0),
 370                               USB_VENDOR_REQUEST_READ_REGISTER,
 371                               USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
 372                               0, index, buf, 4, USB_CTRL_GET_TIMEOUT);
 373         if (likely(ret >= 0)) {
 374                 le32_to_cpus(buf);
 375                 *data = *buf;
 376         } else {
 377                 netdev_warn(dev->net,
 378                             "Failed to read register index 0x%08x. ret = %d",
 379                             index, ret);
 380         }
 381
 382         kfree(buf);
 383
 384         return ret;
 385 }
 386
 387 static int lan78xx_write_reg(struct lan78xx_net *dev, u32 index, u32 data)
 388 {
 389         u32 *buf = kmalloc(sizeof(u32), GFP_KERNEL);
 390         int ret;
 391
 392         if (!buf)
 393                 return -ENOMEM;
 394
 395         *buf = data;
 396         cpu_to_le32s(buf);
 397
 398         ret = usb_control_msg(dev->udev, usb_sndctrlpipe(dev->udev, 0),
 399                               USB_VENDOR_REQUEST_WRITE_REGISTER,
 400                               USB_DIR_OUT | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
 401                               0, index, buf, 4, USB_CTRL_SET_TIMEOUT);
 402         if (unlikely(ret < 0)) {
 403                 netdev_warn(dev->net,
 404                             "Failed to write register index 0x%08x. ret = %d",
 405                             index, ret);
 406         }
 407
 408         kfree(buf);
 409
 410         return ret;
 411 }
 412
 413 static int lan78xx_read_stats(struct lan78xx_net *dev,
 414                               struct lan78xx_statstage *data)
 415 {
 416         int ret = 0;
 417         int i;
 418         struct lan78xx_statstage *stats;
 419         u32 *src;
 420         u32 *dst;
 421
 422         stats = kmalloc(sizeof(*stats), GFP_KERNEL);
 423         if (!stats)
 424                 return -ENOMEM;
 425
 426         ret = usb_control_msg(dev->udev,
 427                               usb_rcvctrlpipe(dev->udev, 0),
 428                               USB_VENDOR_REQUEST_GET_STATS,
 429                               USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
 430                               0,
 431                               0,
 432                               (void *)stats,
 433                               sizeof(*stats),
 434                               USB_CTRL_SET_TIMEOUT);
 435         if (likely(ret >= 0)) {
 436                 src = (u32 *)stats;
 437                 dst = (u32 *)data;
 438                 for (i = 0; i < sizeof(*stats)/sizeof(u32); i++) {
 439                         le32_to_cpus(&src[i]);
 440                         dst[i] = src[i];
 441                 }
 442         } else {
 443                 netdev_warn(dev->net,
 444                             "Failed to read stat ret = 0x%x", ret);
 445         }
 446
 447         kfree(stats);
 448
 449         return ret;
 450 }
 451
 452 #define check_counter_rollover(struct1, dev_stats, member) {    \
 453         if (struct1->member < dev_stats.saved.member)           \
 454                 dev_stats.rollover_count.member++;              \
 455         }
 456
 457 static void lan78xx_check_stat_rollover(struct lan78xx_net *dev,
 458                                         struct lan78xx_statstage *stats)
 459 {
 460         check_counter_rollover(stats, dev->stats, rx_fcs_errors);
 461         check_counter_rollover(stats, dev->stats, rx_alignment_errors);
 462         check_counter_rollover(stats, dev->stats, rx_fragment_errors);
 463         check_counter_rollover(stats, dev->stats, rx_jabber_errors);
 464         check_counter_rollover(stats, dev->stats, rx_undersize_frame_errors);
 465         check_counter_rollover(stats, dev->stats, rx_oversize_frame_errors);
 466         check_counter_rollover(stats, dev->stats, rx_dropped_frames);
 467         check_counter_rollover(stats, dev->stats, rx_unicast_byte_count);
 468         check_counter_rollover(stats, dev->stats, rx_broadcast_byte_count);
 469         check_counter_rollover(stats, dev->stats, rx_multicast_byte_count);
 470         check_counter_rollover(stats, dev->stats, rx_unicast_frames);
 471         check_counter_rollover(stats, dev->stats, rx_broadcast_frames);
 472         check_counter_rollover(stats, dev->stats, rx_multicast_frames);
 473         check_counter_rollover(stats, dev->stats, rx_pause_frames);
 474         check_counter_rollover(stats, dev->stats, rx_64_byte_frames);
 475         check_counter_rollover(stats, dev->stats, rx_65_127_byte_frames);
 476         check_counter_rollover(stats, dev->stats, rx_128_255_byte_frames);
 477         check_counter_rollover(stats, dev->stats, rx_256_511_bytes_frames);
 478         check_counter_rollover(stats, dev->stats, rx_512_1023_byte_frames);
 479         check_counter_rollover(stats, dev->stats, rx_1024_1518_byte_frames);
 480         check_counter_rollover(stats, dev->stats, rx_greater_1518_byte_frames);
 481         check_counter_rollover(stats, dev->stats, eee_rx_lpi_transitions);
 482         check_counter_rollover(stats, dev->stats, eee_rx_lpi_time);
 483         check_counter_rollover(stats, dev->stats, tx_fcs_errors);
 484         check_counter_rollover(stats, dev->stats, tx_excess_deferral_errors);
 485         check_counter_rollover(stats, dev->stats, tx_carrier_errors);
 486         check_counter_rollover(stats, dev->stats, tx_bad_byte_count);
 487         check_counter_rollover(stats, dev->stats, tx_single_collisions);
 488         check_counter_rollover(stats, dev->stats, tx_multiple_collisions);
 489         check_counter_rollover(stats, dev->stats, tx_excessive_collision);
 490         check_counter_rollover(stats, dev->stats, tx_late_collisions);
 491         check_counter_rollover(stats, dev->stats, tx_unicast_byte_count);
 492         check_counter_rollover(stats, dev->stats, tx_broadcast_byte_count);
 493         check_counter_rollover(stats, dev->stats, tx_multicast_byte_count);
 494         check_counter_rollover(stats, dev->stats, tx_unicast_frames);
 495         check_counter_rollover(stats, dev->stats, tx_broadcast_frames);
 496         check_counter_rollover(stats, dev->stats, tx_multicast_frames);
 497         check_counter_rollover(stats, dev->stats, tx_pause_frames);
 498         check_counter_rollover(stats, dev->stats, tx_64_byte_frames);
 499         check_counter_rollover(stats, dev->stats, tx_65_127_byte_frames);
 500         check_counter_rollover(stats, dev->stats, tx_128_255_byte_frames);
 501         check_counter_rollover(stats, dev->stats, tx_256_511_bytes_frames);
 502         check_counter_rollover(stats, dev->stats, tx_512_1023_byte_frames);
 503         check_counter_rollover(stats, dev->stats, tx_1024_1518_byte_frames);
 504         check_counter_rollover(stats, dev->stats, tx_greater_1518_byte_frames);
 505         check_counter_rollover(stats, dev->stats, eee_tx_lpi_transitions);
 506         check_counter_rollover(stats, dev->stats, eee_tx_lpi_time);
 507
 508         memcpy(&dev->stats.saved, stats, sizeof(struct lan78xx_statstage));
 509 }
 510
 511 static void lan78xx_update_stats(struct lan78xx_net *dev)
 512 {
 513         u32 *p, *count, *max;
 514         u64 *data;
 515         int i;
 516         struct lan78xx_statstage lan78xx_stats;
 517
 518         if (usb_autopm_get_interface(dev->intf) < 0)
 519                 return;
 520
 521         p = (u32 *)&lan78xx_stats;
 522         count = (u32 *)&dev->stats.rollover_count;
 523         max = (u32 *)&dev->stats.rollover_max;
 524         data = (u64 *)&dev->stats.curr_stat;
 525
 526         mutex_lock(&dev->stats.access_lock);
 527
 528         if (lan78xx_read_stats(dev, &lan78xx_stats) > 0)
 529                 lan78xx_check_stat_rollover(dev, &lan78xx_stats);
 530
 531         for (i = 0; i < (sizeof(lan78xx_stats) / (sizeof(u32))); i++)
 532                 data[i] = (u64)p[i] + ((u64)count[i] * ((u64)max[i] + 1));
 533
 534         mutex_unlock(&dev->stats.access_lock);
 535
 536         usb_autopm_put_interface(dev->intf);
 537 }
 538
 539 /* Loop until the read is completed with timeout called with phy_mutex held */
 540 static int lan78xx_phy_wait_not_busy(struct lan78xx_net *dev)
 541 {
 542         unsigned long start_time = jiffies;
 543         u32 val;
 544         int ret;
 545
 546         do {
 547                 ret = lan78xx_read_reg(dev, MII_ACC, &val);
 548                 if (unlikely(ret < 0))
 549                         return -EIO;
 550
 551                 if (!(val & MII_ACC_MII_BUSY_))
 552                         return 0;
 553         } while (!time_after(jiffies, start_time + HZ));
 554
 555         return -EIO;
 556 }
 557
 558 static inline u32 mii_access(int id, int index, int read)
 559 {
 560         u32 ret;
 561
 562         ret = ((u32)id << MII_ACC_PHY_ADDR_SHIFT_) & MII_ACC_PHY_ADDR_MASK_;
 563         ret |= ((u32)index << MII_ACC_MIIRINDA_SHIFT_) & MII_ACC_MIIRINDA_MASK_;
 564         if (read)
 565                 ret |= MII_ACC_MII_READ_;
 566         else
 567                 ret |= MII_ACC_MII_WRITE_;
 568         ret |= MII_ACC_MII_BUSY_;
 569
 570         return ret;
 571 }
 572
 573 static int lan78xx_wait_eeprom(struct lan78xx_net *dev)
 574 {
 575         unsigned long start_time = jiffies;
 576         u32 val;
 577         int ret;
 578
 579         do {
 580                 ret = lan78xx_read_reg(dev, E2P_CMD, &val);
 581                 if (unlikely(ret < 0))
 582                         return -EIO;
 583
 584                 if (!(val & E2P_CMD_EPC_BUSY_) ||
 585                     (val & E2P_CMD_EPC_TIMEOUT_))
 586                         break;
 587                 usleep_range(40, 100);
 588         } while (!time_after(jiffies, start_time + HZ));
 589
 590         if (val & (E2P_CMD_EPC_TIMEOUT_ | E2P_CMD_EPC_BUSY_)) {
 591                 netdev_warn(dev->net, "EEPROM read operation timeout");
 592                 return -EIO;
 593         }
 594
 595         return 0;
 596 }
 597
 598 static int lan78xx_eeprom_confirm_not_busy(struct lan78xx_net *dev)
 599 {
 600         unsigned long start_time = jiffies;
 601         u32 val;
 602         int ret;
 603
 604         do {
 605                 ret = lan78xx_read_reg(dev, E2P_CMD, &val);
 606                 if (unlikely(ret < 0))
 607                         return -EIO;
 608
 609                 if (!(val & E2P_CMD_EPC_BUSY_))
 610                         return 0;
 611
 612                 usleep_range(40, 100);
 613         } while (!time_after(jiffies, start_time + HZ));
 614
 615         netdev_warn(dev->net, "EEPROM is busy");
 616         return -EIO;
 617 }
 618
 619 static int lan78xx_read_raw_eeprom(struct lan78xx_net *dev, u32 offset,
 620                                    u32 length, u8 *data)
 621 {
 622         u32 val;
 623         u32 saved;
 624         int i, ret;
 625         int retval;
 626
 627         /* depends on chip, some EEPROM pins are muxed with LED function.
 628          * disable & restore LED function to access EEPROM.
 629          */
 630         ret = lan78xx_read_reg(dev, HW_CFG, &val);
 631         saved = val;
 632         if (dev->chipid == ID_REV_CHIP_ID_7800_) {
 633                 val &= ~(HW_CFG_LED1_EN_ | HW_CFG_LED0_EN_);
 634                 ret = lan78xx_write_reg(dev, HW_CFG, val);
 635         }
 636
 637         retval = lan78xx_eeprom_confirm_not_busy(dev);
 638         if (retval)
 639                 return retval;
 640
 641         for (i = 0; i < length; i++) {
 642                 val = E2P_CMD_EPC_BUSY_ | E2P_CMD_EPC_CMD_READ_;
 643                 val |= (offset & E2P_CMD_EPC_ADDR_MASK_);
 644                 ret = lan78xx_write_reg(dev, E2P_CMD, val);
 645                 if (unlikely(ret < 0)) {
 646                         retval = -EIO;
 647                         goto exit;
 648                 }
 649
 650                 retval = lan78xx_wait_eeprom(dev);
 651                 if (retval < 0)
 652                         goto exit;
 653
 654                 ret = lan78xx_read_reg(dev, E2P_DATA, &val);
 655                 if (unlikely(ret < 0)) {
 656                         retval = -EIO;
 657                         goto exit;
 658                 }
 659
 660                 data[i] = val & 0xFF;
 661                 offset++;
 662         }
 663
 664         retval = 0;
 665 exit:
 666         if (dev->chipid == ID_REV_CHIP_ID_7800_)
 667                 ret = lan78xx_write_reg(dev, HW_CFG, saved);
 668
 669         return retval;
 670 }
 671
 672 static int lan78xx_read_eeprom(struct lan78xx_net *dev, u32 offset,
 673                                u32 length, u8 *data)
 674 {
 675         u8 sig;
 676         int ret;
 677
 678         ret = lan78xx_read_raw_eeprom(dev, 0, 1, &sig);
 679         if ((ret == 0) && (sig == EEPROM_INDICATOR))
 680                 ret = lan78xx_read_raw_eeprom(dev, offset, length, data);
 681         else
 682                 ret = -EINVAL;
 683
 684         return ret;
 685 }
 686
 687 static int lan78xx_write_raw_eeprom(struct lan78xx_net *dev, u32 offset,
 688                                     u32 length, u8 *data)
 689 {
 690         u32 val;
 691         u32 saved;
 692         int i, ret;
 693         int retval;
 694
 695         /* depends on chip, some EEPROM pins are muxed with LED function.
 696          * disable & restore LED function to access EEPROM.
 697          */
 698         ret = lan78xx_read_reg(dev, HW_CFG, &val);
 699         saved = val;
 700         if (dev->chipid == ID_REV_CHIP_ID_7800_) {
 701                 val &= ~(HW_CFG_LED1_EN_ | HW_CFG_LED0_EN_);
 702                 ret = lan78xx_write_reg(dev, HW_CFG, val);
 703         }
 704
 705         retval = lan78xx_eeprom_confirm_not_busy(dev);
 706         if (retval)
 707                 goto exit;
 708
 709         /* Issue write/erase enable command */
 710         val = E2P_CMD_EPC_BUSY_ | E2P_CMD_EPC_CMD_EWEN_;
 711         ret = lan78xx_write_reg(dev, E2P_CMD, val);
 712         if (unlikely(ret < 0)) {
 713                 retval = -EIO;
 714                 goto exit;
 715         }
 716
 717         retval = lan78xx_wait_eeprom(dev);
 718         if (retval < 0)
 719                 goto exit;
 720
 721         for (i = 0; i < length; i++) {
 722                 /* Fill data register */
 723                 val = data[i];
 724                 ret = lan78xx_write_reg(dev, E2P_DATA, val);
 725                 if (ret < 0) {
 726                         retval = -EIO;
 727                         goto exit;
 728                 }
 729
 730                 /* Send "write" command */
 731                 val = E2P_CMD_EPC_BUSY_ | E2P_CMD_EPC_CMD_WRITE_;
 732                 val |= (offset & E2P_CMD_EPC_ADDR_MASK_);
 733                 ret = lan78xx_write_reg(dev, E2P_CMD, val);
 734                 if (ret < 0) {
 735                         retval = -EIO;
 736                         goto exit;
 737                 }
 738
 739                 retval = lan78xx_wait_eeprom(dev);
 740                 if (retval < 0)
 741                         goto exit;
 742
 743                 offset++;
 744         }
 745
 746         retval = 0;
 747 exit:
 748         if (dev->chipid == ID_REV_CHIP_ID_7800_)
 749                 ret = lan78xx_write_reg(dev, HW_CFG, saved);
 750
 751         return retval;
 752 }
 753
 754 static int lan78xx_read_raw_otp(struct lan78xx_net *dev, u32 offset,
 755                                 u32 length, u8 *data)
 756 {
 757         int i;
 758         int ret;
 759         u32 buf;
 760         unsigned long timeout;
 761
 762         ret = lan78xx_read_reg(dev, OTP_PWR_DN, &buf);
 763
 764         if (buf & OTP_PWR_DN_PWRDN_N_) {
 765                 /* clear it and wait to be cleared */
 766                 ret = lan78xx_write_reg(dev, OTP_PWR_DN, 0);
 767
 768                 timeout = jiffies + HZ;
 769                 do {
 770                         usleep_range(1, 10);
 771                         ret = lan78xx_read_reg(dev, OTP_PWR_DN, &buf);
 772                         if (time_after(jiffies, timeout)) {
 773                                 netdev_warn(dev->net,
 774                                             "timeout on OTP_PWR_DN");
 775                                 return -EIO;
 776                         }
 777                 } while (buf & OTP_PWR_DN_PWRDN_N_);
 778         }
 779
 780         for (i = 0; i < length; i++) {
 781                 ret = lan78xx_write_reg(dev, OTP_ADDR1,
 782                                         ((offset + i) >> 8) & OTP_ADDR1_15_11);
 783                 ret = lan78xx_write_reg(dev, OTP_ADDR2,
 784                                         ((offset + i) & OTP_ADDR2_10_3));
 785
 786                 ret = lan78xx_write_reg(dev, OTP_FUNC_CMD, OTP_FUNC_CMD_READ_);
 787                 ret = lan78xx_write_reg(dev, OTP_CMD_GO, OTP_CMD_GO_GO_);
 788
 789                 timeout = jiffies + HZ;
 790                 do {
 791                         udelay(1);
 792                         ret = lan78xx_read_reg(dev, OTP_STATUS, &buf);
 793                         if (time_after(jiffies, timeout)) {
 794                                 netdev_warn(dev->net,
 795                                             "timeout on OTP_STATUS");
 796                                 return -EIO;
 797                         }
 798                 } while (buf & OTP_STATUS_BUSY_);
 799
 800                 ret = lan78xx_read_reg(dev, OTP_RD_DATA, &buf);
 801
 802                 data[i] = (u8)(buf & 0xFF);
 803         }
 804
 805         return 0;
 806 }
 807
 808 static int lan78xx_write_raw_otp(struct lan78xx_net *dev, u32 offset,
 809                                  u32 length, u8 *data)
 810 {
 811         int i;
 812         int ret;
 813         u32 buf;
 814         unsigned long timeout;
 815
 816         ret = lan78xx_read_reg(dev, OTP_PWR_DN, &buf);
 817
 818         if (buf & OTP_PWR_DN_PWRDN_N_) {
 819                 /* clear it and wait to be cleared */
 820                 ret = lan78xx_write_reg(dev, OTP_PWR_DN, 0);
 821
 822                 timeout = jiffies + HZ;
 823                 do {
 824                         udelay(1);
 825                         ret = lan78xx_read_reg(dev, OTP_PWR_DN, &buf);
 826                         if (time_after(jiffies, timeout)) {
 827                                 netdev_warn(dev->net,
 828                                             "timeout on OTP_PWR_DN completion");
 829                                 return -EIO;
 830                         }
 831                 } while (buf & OTP_PWR_DN_PWRDN_N_);
 832         }
 833
 834         /* set to BYTE program mode */
 835         ret = lan78xx_write_reg(dev, OTP_PRGM_MODE, OTP_PRGM_MODE_BYTE_);
 836
 837         for (i = 0; i < length; i++) {
 838                 ret = lan78xx_write_reg(dev, OTP_ADDR1,
 839                                         ((offset + i) >> 8) & OTP_ADDR1_15_11);
 840                 ret = lan78xx_write_reg(dev, OTP_ADDR2,
 841                                         ((offset + i) & OTP_ADDR2_10_3));
 842                 ret = lan78xx_write_reg(dev, OTP_PRGM_DATA, data[i]);
 843                 ret = lan78xx_write_reg(dev, OTP_TST_CMD, OTP_TST_CMD_PRGVRFY_);
 844                 ret = lan78xx_write_reg(dev, OTP_CMD_GO, OTP_CMD_GO_GO_);
 845
 846                 timeout = jiffies + HZ;
 847                 do {
 848                         udelay(1);
 849                         ret = lan78xx_read_reg(dev, OTP_STATUS, &buf);
 850                         if (time_after(jiffies, timeout)) {
 851                                 netdev_warn(dev->net,
 852                                             "Timeout on OTP_STATUS completion");
 853                                 return -EIO;
 854                         }
 855                 } while (buf & OTP_STATUS_BUSY_);
 856         }
 857
 858         return 0;
 859 }
 860
 861 static int lan78xx_read_otp(struct lan78xx_net *dev, u32 offset,
 862                             u32 length, u8 *data)
 863 {
 864         u8 sig;
 865         int ret;
 866
 867         ret = lan78xx_read_raw_otp(dev, 0, 1, &sig);
 868
 869         if (ret == 0) {
 870                 if (sig == OTP_INDICATOR_1)
 871                         offset = offset;
 872                 else if (sig == OTP_INDICATOR_2)
 873                         offset += 0x100;
 874                 else
 875                         ret = -EINVAL;
 876                 ret = lan78xx_read_raw_otp(dev, offset, length, data);
 877         }
 878
 879         return ret;
 880 }
 881
 882 static int lan78xx_dataport_wait_not_busy(struct lan78xx_net *dev)
 883 {
 884         int i, ret;
 885
 886         for (i = 0; i < 100; i++) {
 887                 u32 dp_sel;
 888
 889                 ret = lan78xx_read_reg(dev, DP_SEL, &dp_sel);
 890                 if (unlikely(ret < 0))
 891                         return -EIO;
 892
 893                 if (dp_sel & DP_SEL_DPRDY_)
 894                         return 0;
 895
 896                 usleep_range(40, 100);
 897         }
 898
 899         netdev_warn(dev->net, "lan78xx_dataport_wait_not_busy timed out");
 900
 901         return -EIO;
 902 }
 903
 904 static int lan78xx_dataport_write(struct lan78xx_net *dev, u32 ram_select,
 905                                   u32 addr, u32 length, u32 *buf)
 906 {
 907         struct lan78xx_priv *pdata = (struct lan78xx_priv *)(dev->data[0]);
 908         u32 dp_sel;
 909         int i, ret;
 910
 911         if (usb_autopm_get_interface(dev->intf) < 0)
 912                         return 0;
 913
 914         mutex_lock(&pdata->dataport_mutex);
 915
 916         ret = lan78xx_dataport_wait_not_busy(dev);
 917         if (ret < 0)
 918                 goto done;
 919
 920         ret = lan78xx_read_reg(dev, DP_SEL, &dp_sel);
 921
 922         dp_sel &= ~DP_SEL_RSEL_MASK_;
 923         dp_sel |= ram_select;
 924         ret = lan78xx_write_reg(dev, DP_SEL, dp_sel);
 925
 926         for (i = 0; i < length; i++) {
 927                 ret = lan78xx_write_reg(dev, DP_ADDR, addr + i);
 928
 929                 ret = lan78xx_write_reg(dev, DP_DATA, buf[i]);
 930
 931                 ret = lan78xx_write_reg(dev, DP_CMD, DP_CMD_WRITE_);
 932
 933                 ret = lan78xx_dataport_wait_not_busy(dev);
 934                 if (ret < 0)
 935                         goto done;
 936         }
 937
 938 done:
 939         mutex_unlock(&pdata->dataport_mutex);
 940         usb_autopm_put_interface(dev->intf);
 941
 942         return ret;
 943 }
 944
 945 static void lan78xx_set_addr_filter(struct lan78xx_priv *pdata,
 946                                     int index, u8 addr[ETH_ALEN])
 947 {
 948         u32     temp;
 949
 950         if ((pdata) && (index > 0) && (index < NUM_OF_MAF)) {
 951                 temp = addr[3];
 952                 temp = addr[2] | (temp << 8);
 953                 temp = addr[1] | (temp << 8);
 954                 temp = addr[0] | (temp << 8);
 955                 pdata->pfilter_table[index][1] = temp;
 956                 temp = addr[5];
 957                 temp = addr[4] | (temp << 8);
 958                 temp |= MAF_HI_VALID_ | MAF_HI_TYPE_DST_;
 959                 pdata->pfilter_table[index][0] = temp;
 960         }
 961 }
 962
 963 /* returns hash bit number for given MAC address */
 964 static inline u32 lan78xx_hash(char addr[ETH_ALEN])
 965 {
 966         return (ether_crc(ETH_ALEN, addr) >> 23) & 0x1ff;
 967 }
 968
 969 static void lan78xx_deferred_multicast_write(struct work_struct *param)
 970 {
 971         struct lan78xx_priv *pdata =
 972                         container_of(param, struct lan78xx_priv, set_multicast);
 973         struct lan78xx_net *dev = pdata->dev;
 974         int i;
 975         int ret;
 976
 977         netif_dbg(dev, drv, dev->net, "deferred multicast write 0x%08x\n",
 978                   pdata->rfe_ctl);
 979
 980         lan78xx_dataport_write(dev, DP_SEL_RSEL_VLAN_DA_, DP_SEL_VHF_VLAN_LEN,
 981                                DP_SEL_VHF_HASH_LEN, pdata->mchash_table);
 982
 983         for (i = 1; i < NUM_OF_MAF; i++) {
 984                 ret = lan78xx_write_reg(dev, MAF_HI(i), 0);
 985                 ret = lan78xx_write_reg(dev, MAF_LO(i),
 986                                         pdata->pfilter_table[i][1]);
 987                 ret = lan78xx_write_reg(dev, MAF_HI(i),
 988                                         pdata->pfilter_table[i][0]);
 989         }
 990
 991         ret = lan78xx_write_reg(dev, RFE_CTL, pdata->rfe_ctl);
 992 }
 993
 994 static void lan78xx_set_multicast(struct net_device *netdev)
 995 {
 996         struct lan78xx_net *dev = netdev_priv(netdev);
 997         struct lan78xx_priv *pdata = (struct lan78xx_priv *)(dev->data[0]);
 998         unsigned long flags;
 999         int i;
1000
1001         spin_lock_irqsave(&pdata->rfe_ctl_lock, flags);
1002
1003         pdata->rfe_ctl &= ~(RFE_CTL_UCAST_EN_ | RFE_CTL_MCAST_EN_ |
1004                             RFE_CTL_DA_PERFECT_ | RFE_CTL_MCAST_HASH_);
1005
1006         for (i = 0; i < DP_SEL_VHF_HASH_LEN; i++)
1007                         pdata->mchash_table[i] = 0;
1008         /* pfilter_table[0] has own HW address */
1009         for (i = 1; i < NUM_OF_MAF; i++) {
1010                         pdata->pfilter_table[i][0] =
1011                         pdata->pfilter_table[i][1] = 0;
1012         }
1013
1014         pdata->rfe_ctl |= RFE_CTL_BCAST_EN_;
1015
1016         if (dev->net->flags & IFF_PROMISC) {
1017                 netif_dbg(dev, drv, dev->net, "promiscuous mode enabled");
1018                 pdata->rfe_ctl |= RFE_CTL_MCAST_EN_ | RFE_CTL_UCAST_EN_;
1019         } else {
1020                 if (dev->net->flags & IFF_ALLMULTI) {
1021                         netif_dbg(dev, drv, dev->net,
1022                                   "receive all multicast enabled");
1023                         pdata->rfe_ctl |= RFE_CTL_MCAST_EN_;
1024                 }
1025         }
1026
1027         if (netdev_mc_count(dev->net)) {
1028                 struct netdev_hw_addr *ha;
1029                 int i;
1030
1031                 netif_dbg(dev, drv, dev->net, "receive multicast hash filter");
1032
1033                 pdata->rfe_ctl |= RFE_CTL_DA_PERFECT_;
1034
1035                 i = 1;
1036                 netdev_for_each_mc_addr(ha, netdev) {
1037                         /* set first 32 into Perfect Filter */
1038                         if (i < 33) {
1039                                 lan78xx_set_addr_filter(pdata, i, ha->addr);
1040                         } else {
1041                                 u32 bitnum = lan78xx_hash(ha->addr);
1042
1043                                 pdata->mchash_table[bitnum / 32] |=
1044                                                         (1 << (bitnum % 32));
1045                                 pdata->rfe_ctl |= RFE_CTL_MCAST_HASH_;
1046                         }
1047                         i++;
1048                 }
1049         }
1050
1051         spin_unlock_irqrestore(&pdata->rfe_ctl_lock, flags);
1052
1053         /* defer register writes to a sleepable context */
1054         schedule_work(&pdata->set_multicast);
1055 }
1056
1057 static int lan78xx_update_flowcontrol(struct lan78xx_net *dev, u8 duplex,
1058                                       u16 lcladv, u16 rmtadv)
1059 {
1060         u32 flow = 0, fct_flow = 0;
1061         int ret;
1062         u8 cap;
1063
1064         if (dev->fc_autoneg)
1065                 cap = mii_resolve_flowctrl_fdx(lcladv, rmtadv);
1066         else
1067                 cap = dev->fc_request_control;
1068
1069         if (cap & FLOW_CTRL_TX)
1070                 flow |= (FLOW_CR_TX_FCEN_ | 0xFFFF);
1071
1072         if (cap & FLOW_CTRL_RX)
1073                 flow |= FLOW_CR_RX_FCEN_;
1074
1075         if (dev->udev->speed == USB_SPEED_SUPER)
1076                 fct_flow = 0x817;
1077         else if (dev->udev->speed == USB_SPEED_HIGH)
1078                 fct_flow = 0x211;
1079
1080         netif_dbg(dev, link, dev->net, "rx pause %s, tx pause %s",
1081                   (cap & FLOW_CTRL_RX ? "enabled" : "disabled"),
1082                   (cap & FLOW_CTRL_TX ? "enabled" : "disabled"));
1083
1084         ret = lan78xx_write_reg(dev, FCT_FLOW, fct_flow);
1085
1086         /* threshold value should be set before enabling flow */
1087         ret = lan78xx_write_reg(dev, FLOW, flow);
1088
1089         return 0;
1090 }
1091
1092 static int lan78xx_link_reset(struct lan78xx_net *dev)
1093 {
1094         struct phy_device *phydev = dev->net->phydev;
1095         struct ethtool_cmd ecmd = { .cmd = ETHTOOL_GSET };
1096         int ladv, radv, ret;
1097         u32 buf;
1098
1099         /* clear PHY interrupt status */
1100         ret = phy_read(phydev, LAN88XX_INT_STS);
1101         if (unlikely(ret < 0))
1102                 return -EIO;
1103
1104         /* clear LAN78xx interrupt status */
1105         ret = lan78xx_write_reg(dev, INT_STS, INT_STS_PHY_INT_);
1106         if (unlikely(ret < 0))
1107                 return -EIO;
1108
1109         phy_read_status(phydev);
1110
1111         if (!phydev->link && dev->link_on) {
1112                 dev->link_on = false;
1113
1114                 /* reset MAC */
1115                 ret = lan78xx_read_reg(dev, MAC_CR, &buf);
1116                 if (unlikely(ret < 0))
1117                         return -EIO;
1118                 buf |= MAC_CR_RST_;
1119                 ret = lan78xx_write_reg(dev, MAC_CR, buf);
1120                 if (unlikely(ret < 0))
1121                         return -EIO;
1122
1123                 phy_mac_interrupt(phydev, 0);
1124
1125                 del_timer(&dev->stat_monitor);
1126         } else if (phydev->link && !dev->link_on) {
1127                 dev->link_on = true;
1128
1129                 phy_ethtool_gset(phydev, &ecmd);
1130
1131                 ret = phy_read(phydev, LAN88XX_INT_STS);
1132
1133                 if (dev->udev->speed == USB_SPEED_SUPER) {
1134                         if (ethtool_cmd_speed(&ecmd) == 1000) {
1135                                 /* disable U2 */
1136                                 ret = lan78xx_read_reg(dev, USB_CFG1, &buf);
1137                                 buf &= ~USB_CFG1_DEV_U2_INIT_EN_;
1138                                 ret = lan78xx_write_reg(dev, USB_CFG1, buf);
1139                                 /* enable U1 */
1140                                 ret = lan78xx_read_reg(dev, USB_CFG1, &buf);
1141                                 buf |= USB_CFG1_DEV_U1_INIT_EN_;
1142                                 ret = lan78xx_write_reg(dev, USB_CFG1, buf);
1143                         } else {
1144                                 /* enable U1 & U2 */
1145                                 ret = lan78xx_read_reg(dev, USB_CFG1, &buf);
1146                                 buf |= USB_CFG1_DEV_U2_INIT_EN_;
1147                                 buf |= USB_CFG1_DEV_U1_INIT_EN_;
1148                                 ret = lan78xx_write_reg(dev, USB_CFG1, buf);
1149                         }
1150                 }
1151
1152                 ladv = phy_read(phydev, MII_ADVERTISE);
1153                 if (ladv < 0)
1154                         return ladv;
1155
1156                 radv = phy_read(phydev, MII_LPA);
1157                 if (radv < 0)
1158                         return radv;
1159
1160                 netif_dbg(dev, link, dev->net,
1161                           "speed: %u duplex: %d anadv: 0x%04x anlpa: 0x%04x",
1162                           ethtool_cmd_speed(&ecmd), ecmd.duplex, ladv, radv);
1163
1164                 ret = lan78xx_update_flowcontrol(dev, ecmd.duplex, ladv, radv);
1165                 phy_mac_interrupt(phydev, 1);
1166
1167                 if (!timer_pending(&dev->stat_monitor)) {
1168                         dev->delta = 1;
1169                         mod_timer(&dev->stat_monitor,
1170                                   jiffies + STAT_UPDATE_TIMER);
1171                 }
1172         }
1173
1174         return ret;
1175 }
1176
1177 /* some work can't be done in tasklets, so we use keventd
1178  *
1179  * NOTE:  annoying asymmetry:  if it's active, schedule_work() fails,
1180  * but tasklet_schedule() doesn't.      hope the failure is rare.
1181  */
1182 static void lan78xx_defer_kevent(struct lan78xx_net *dev, int work)
1183 {
1184         set_bit(work, &dev->flags);
1185         if (!schedule_delayed_work(&dev->wq, 0))
1186                 netdev_err(dev->net, "kevent %d may have been dropped\n", work);
1187 }
1188
1189 static void lan78xx_status(struct lan78xx_net *dev, struct urb *urb)
1190 {
1191         u32 intdata;
1192
1193         if (urb->actual_length != 4) {
1194                 netdev_warn(dev->net,
1195                             "unexpected urb length %d", urb->actual_length);
1196                 return;
1197         }
1198
1199         memcpy(&intdata, urb->transfer_buffer, 4);
1200         le32_to_cpus(&intdata);
1201
1202         if (intdata & INT_ENP_PHY_INT) {
1203                 netif_dbg(dev, link, dev->net, "PHY INTR: 0x%08x\n", intdata);
1204                           lan78xx_defer_kevent(dev, EVENT_LINK_RESET);
1205         } else
1206                 netdev_warn(dev->net,
1207                             "unexpected interrupt: 0x%08x\n", intdata);
1208 }
1209
1210 static int lan78xx_ethtool_get_eeprom_len(struct net_device *netdev)
1211 {
1212         return MAX_EEPROM_SIZE;
1213 }
1214
1215 static int lan78xx_ethtool_get_eeprom(struct net_device *netdev,
1216                                       struct ethtool_eeprom *ee, u8 *data)
1217 {
1218         struct lan78xx_net *dev = netdev_priv(netdev);
1219
1220         ee->magic = LAN78XX_EEPROM_MAGIC;
1221
1222         return lan78xx_read_raw_eeprom(dev, ee->offset, ee->len, data);
1223 }
1224
1225 static int lan78xx_ethtool_set_eeprom(struct net_device *netdev,
1226                                       struct ethtool_eeprom *ee, u8 *data)
1227 {
1228         struct lan78xx_net *dev = netdev_priv(netdev);
1229
1230         /* Allow entire eeprom update only */
1231         if ((ee->magic == LAN78XX_EEPROM_MAGIC) &&
1232             (ee->offset == 0) &&
1233             (ee->len == 512) &&
1234             (data[0] == EEPROM_INDICATOR))
1235                 return lan78xx_write_raw_eeprom(dev, ee->offset, ee->len, data);
1236         else if ((ee->magic == LAN78XX_OTP_MAGIC) &&
1237                  (ee->offset == 0) &&
1238                  (ee->len == 512) &&
1239                  (data[0] == OTP_INDICATOR_1))
1240                 return lan78xx_write_raw_otp(dev, ee->offset, ee->len, data);
1241
1242         return -EINVAL;
1243 }
1244
1245 static void lan78xx_get_strings(struct net_device *netdev, u32 stringset,
1246                                 u8 *data)
1247 {
1248         if (stringset == ETH_SS_STATS)
1249                 memcpy(data, lan78xx_gstrings, sizeof(lan78xx_gstrings));
1250 }
1251
1252 static int lan78xx_get_sset_count(struct net_device *netdev, int sset)
1253 {
1254         if (sset == ETH_SS_STATS)
1255                 return ARRAY_SIZE(lan78xx_gstrings);
1256         else
1257                 return -EOPNOTSUPP;
1258 }
1259
1260 static void lan78xx_get_stats(struct net_device *netdev,
1261                               struct ethtool_stats *stats, u64 *data)
1262 {
1263         struct lan78xx_net *dev = netdev_priv(netdev);
1264
1265         lan78xx_update_stats(dev);
1266
1267         mutex_lock(&dev->stats.access_lock);
1268         memcpy(data, &dev->stats.curr_stat, sizeof(dev->stats.curr_stat));
1269         mutex_unlock(&dev->stats.access_lock);
1270 }
1271
1272 static void lan78xx_get_wol(struct net_device *netdev,
1273                             struct ethtool_wolinfo *wol)
1274 {
1275         struct lan78xx_net *dev = netdev_priv(netdev);
1276         int ret;
1277         u32 buf;
1278         struct lan78xx_priv *pdata = (struct lan78xx_priv *)(dev->data[0]);
1279
1280         if (usb_autopm_get_interface(dev->intf) < 0)
1281                         return;
1282
1283         ret = lan78xx_read_reg(dev, USB_CFG0, &buf);
1284         if (unlikely(ret < 0)) {
1285                 wol->supported = 0;
1286                 wol->wolopts = 0;
1287         } else {
1288                 if (buf & USB_CFG_RMT_WKP_) {
1289                         wol->supported = WAKE_ALL;
1290                         wol->wolopts = pdata->wol;
1291                 } else {
1292                         wol->supported = 0;
1293                         wol->wolopts = 0;
1294                 }
1295         }
1296
1297         usb_autopm_put_interface(dev->intf);
1298 }
1299
1300 static int lan78xx_set_wol(struct net_device *netdev,
1301                            struct ethtool_wolinfo *wol)
1302 {
1303         struct lan78xx_net *dev = netdev_priv(netdev);
1304         struct lan78xx_priv *pdata = (struct lan78xx_priv *)(dev->data[0]);
1305         int ret;
1306
1307         ret = usb_autopm_get_interface(dev->intf);
1308         if (ret < 0)
1309                 return ret;
1310
1311         pdata->wol = 0;
1312         if (wol->wolopts & WAKE_UCAST)
1313                 pdata->wol |= WAKE_UCAST;
1314         if (wol->wolopts & WAKE_MCAST)
1315                 pdata->wol |= WAKE_MCAST;
1316         if (wol->wolopts & WAKE_BCAST)
1317                 pdata->wol |= WAKE_BCAST;
1318         if (wol->wolopts & WAKE_MAGIC)
1319                 pdata->wol |= WAKE_MAGIC;
1320         if (wol->wolopts & WAKE_PHY)
1321                 pdata->wol |= WAKE_PHY;
1322         if (wol->wolopts & WAKE_ARP)
1323                 pdata->wol |= WAKE_ARP;
1324
1325         device_set_wakeup_enable(&dev->udev->dev, (bool)wol->wolopts);
1326
1327         phy_ethtool_set_wol(netdev->phydev, wol);
1328
1329         usb_autopm_put_interface(dev->intf);
1330
1331         return ret;
1332 }
1333
1334 static int lan78xx_get_eee(struct net_device *net, struct ethtool_eee *edata)
1335 {
1336         struct lan78xx_net *dev = netdev_priv(net);
1337         struct phy_device *phydev = net->phydev;
1338         int ret;
1339         u32 buf;
1340
1341         ret = usb_autopm_get_interface(dev->intf);
1342         if (ret < 0)
1343                 return ret;
1344
1345         ret = phy_ethtool_get_eee(phydev, edata);
1346         if (ret < 0)
1347                 goto exit;
1348
1349         ret = lan78xx_read_reg(dev, MAC_CR, &buf);
1350         if (buf & MAC_CR_EEE_EN_) {
1351                 edata->eee_enabled = true;
1352                 edata->eee_active = !!(edata->advertised &
1353                                        edata->lp_advertised);
1354                 edata->tx_lpi_enabled = true;
1355                 /* EEE_TX_LPI_REQ_DLY & tx_lpi_timer are same uSec unit */
1356                 ret = lan78xx_read_reg(dev, EEE_TX_LPI_REQ_DLY, &buf);
1357                 edata->tx_lpi_timer = buf;
1358         } else {
1359                 edata->eee_enabled = false;
1360                 edata->eee_active = false;
1361                 edata->tx_lpi_enabled = false;
1362                 edata->tx_lpi_timer = 0;
1363         }
1364
1365         ret = 0;
1366 exit:
1367         usb_autopm_put_interface(dev->intf);
1368
1369         return ret;
1370 }
1371
1372 static int lan78xx_set_eee(struct net_device *net, struct ethtool_eee *edata)
1373 {
1374         struct lan78xx_net *dev = netdev_priv(net);
1375         int ret;
1376         u32 buf;
1377
1378         ret = usb_autopm_get_interface(dev->intf);
1379         if (ret < 0)
1380                 return ret;
1381
1382         if (edata->eee_enabled) {
1383                 ret = lan78xx_read_reg(dev, MAC_CR, &buf);
1384                 buf |= MAC_CR_EEE_EN_;
1385                 ret = lan78xx_write_reg(dev, MAC_CR, buf);
1386
1387                 phy_ethtool_set_eee(net->phydev, edata);
1388
1389                 buf = (u32)edata->tx_lpi_timer;
1390                 ret = lan78xx_write_reg(dev, EEE_TX_LPI_REQ_DLY, buf);
1391         } else {
1392                 ret = lan78xx_read_reg(dev, MAC_CR, &buf);
1393                 buf &= ~MAC_CR_EEE_EN_;
1394                 ret = lan78xx_write_reg(dev, MAC_CR, buf);
1395         }
1396
1397         usb_autopm_put_interface(dev->intf);
1398
1399         return 0;
1400 }
1401
1402 static u32 lan78xx_get_link(struct net_device *net)
1403 {
1404         phy_read_status(net->phydev);
1405
1406         return net->phydev->link;
1407 }
1408
1409 static int lan78xx_nway_reset(struct net_device *net)
1410 {
1411         return phy_start_aneg(net->phydev);
1412 }
1413
1414 static void lan78xx_get_drvinfo(struct net_device *net,
1415                                 struct ethtool_drvinfo *info)
1416 {
1417         struct lan78xx_net *dev = netdev_priv(net);
1418
1419         strncpy(info->driver, DRIVER_NAME, sizeof(info->driver));
1420         strncpy(info->version, DRIVER_VERSION, sizeof(info->version));
1421         usb_make_path(dev->udev, info->bus_info, sizeof(info->bus_info));
1422 }
1423
1424 static u32 lan78xx_get_msglevel(struct net_device *net)
1425 {
1426         struct lan78xx_net *dev = netdev_priv(net);
1427
1428         return dev->msg_enable;
1429 }
1430
1431 static void lan78xx_set_msglevel(struct net_device *net, u32 level)
1432 {
1433         struct lan78xx_net *dev = netdev_priv(net);
1434
1435         dev->msg_enable = level;
1436 }
1437
1438 static int lan78xx_get_mdix_status(struct net_device *net)
1439 {
1440         struct phy_device *phydev = net->phydev;
1441         int buf;
1442
1443         phy_write(phydev, LAN88XX_EXT_PAGE_ACCESS, LAN88XX_EXT_PAGE_SPACE_1);
1444         buf = phy_read(phydev, LAN88XX_EXT_MODE_CTRL);
1445         phy_write(phydev, LAN88XX_EXT_PAGE_ACCESS, LAN88XX_EXT_PAGE_SPACE_0);
1446
1447         return buf;
1448 }
1449
1450 static void lan78xx_set_mdix_status(struct net_device *net, __u8 mdix_ctrl)
1451 {
1452         struct lan78xx_net *dev = netdev_priv(net);
1453         struct phy_device *phydev = net->phydev;
1454         int buf;
1455
1456         if (mdix_ctrl == ETH_TP_MDI) {
1457                 phy_write(phydev, LAN88XX_EXT_PAGE_ACCESS,
1458                           LAN88XX_EXT_PAGE_SPACE_1);
1459                 buf = phy_read(phydev, LAN88XX_EXT_MODE_CTRL);
1460                 buf &= ~LAN88XX_EXT_MODE_CTRL_MDIX_MASK_;
1461                 phy_write(phydev, LAN88XX_EXT_MODE_CTRL,
1462                           buf | LAN88XX_EXT_MODE_CTRL_MDI_);
1463                 phy_write(phydev, LAN88XX_EXT_PAGE_ACCESS,
1464                           LAN88XX_EXT_PAGE_SPACE_0);
1465         } else if (mdix_ctrl == ETH_TP_MDI_X) {
1466                 phy_write(phydev, LAN88XX_EXT_PAGE_ACCESS,
1467                           LAN88XX_EXT_PAGE_SPACE_1);
1468                 buf = phy_read(phydev, LAN88XX_EXT_MODE_CTRL);
1469                 buf &= ~LAN88XX_EXT_MODE_CTRL_MDIX_MASK_;
1470                 phy_write(phydev, LAN88XX_EXT_MODE_CTRL,
1471                           buf | LAN88XX_EXT_MODE_CTRL_MDI_X_);
1472                 phy_write(phydev, LAN88XX_EXT_PAGE_ACCESS,
1473                           LAN88XX_EXT_PAGE_SPACE_0);
1474         } else if (mdix_ctrl == ETH_TP_MDI_AUTO) {
1475                 phy_write(phydev, LAN88XX_EXT_PAGE_ACCESS,
1476                           LAN88XX_EXT_PAGE_SPACE_1);
1477                 buf = phy_read(phydev, LAN88XX_EXT_MODE_CTRL);
1478                 buf &= ~LAN88XX_EXT_MODE_CTRL_MDIX_MASK_;
1479                 phy_write(phydev, LAN88XX_EXT_MODE_CTRL,
1480                           buf | LAN88XX_EXT_MODE_CTRL_AUTO_MDIX_);
1481                 phy_write(phydev, LAN88XX_EXT_PAGE_ACCESS,
1482                           LAN88XX_EXT_PAGE_SPACE_0);
1483         }
1484         dev->mdix_ctrl = mdix_ctrl;
1485 }
1486
1487 static int lan78xx_get_settings(struct net_device *net, struct ethtool_cmd *cmd)
1488 {
1489         struct lan78xx_net *dev = netdev_priv(net);
1490         struct phy_device *phydev = net->phydev;
1491         int ret;
1492         int buf;
1493
1494         ret = usb_autopm_get_interface(dev->intf);
1495         if (ret < 0)
1496                 return ret;
1497
1498         ret = phy_ethtool_gset(phydev, cmd);
1499
1500         buf = lan78xx_get_mdix_status(net);
1501
1502         buf &= LAN88XX_EXT_MODE_CTRL_MDIX_MASK_;
1503         if (buf == LAN88XX_EXT_MODE_CTRL_AUTO_MDIX_) {
1504                 cmd->eth_tp_mdix = ETH_TP_MDI_AUTO;
1505                 cmd->eth_tp_mdix_ctrl = ETH_TP_MDI_AUTO;
1506         } else if (buf == LAN88XX_EXT_MODE_CTRL_MDI_) {
1507                 cmd->eth_tp_mdix = ETH_TP_MDI;
1508                 cmd->eth_tp_mdix_ctrl = ETH_TP_MDI;
1509         } else if (buf == LAN88XX_EXT_MODE_CTRL_MDI_X_) {
1510                 cmd->eth_tp_mdix = ETH_TP_MDI_X;
1511                 cmd->eth_tp_mdix_ctrl = ETH_TP_MDI_X;
1512         }
1513
1514         usb_autopm_put_interface(dev->intf);
1515
1516         return ret;
1517 }
1518
1519 static int lan78xx_set_settings(struct net_device *net, struct ethtool_cmd *cmd)
1520 {
1521         struct lan78xx_net *dev = netdev_priv(net);
1522         struct phy_device *phydev = net->phydev;
1523         int ret = 0;
1524         int temp;
1525
1526         ret = usb_autopm_get_interface(dev->intf);
1527         if (ret < 0)
1528                 return ret;
1529
1530         if (dev->mdix_ctrl != cmd->eth_tp_mdix_ctrl) {
1531                 lan78xx_set_mdix_status(net, cmd->eth_tp_mdix_ctrl);
1532         }
1533
1534         /* change speed & duplex */
1535         ret = phy_ethtool_sset(phydev, cmd);
1536
1537         if (!cmd->autoneg) {
1538                 /* force link down */
1539                 temp = phy_read(phydev, MII_BMCR);
1540                 phy_write(phydev, MII_BMCR, temp | BMCR_LOOPBACK);
1541                 mdelay(1);
1542                 phy_write(phydev, MII_BMCR, temp);
1543         }
1544
1545         usb_autopm_put_interface(dev->intf);
1546
1547         return ret;
1548 }
1549
1550 static void lan78xx_get_pause(struct net_device *net,
1551                               struct ethtool_pauseparam *pause)
1552 {
1553         struct lan78xx_net *dev = netdev_priv(net);
1554         struct phy_device *phydev = net->phydev;
1555         struct ethtool_cmd ecmd = { .cmd = ETHTOOL_GSET };
1556
1557         phy_ethtool_gset(phydev, &ecmd);
1558
1559         pause->autoneg = dev->fc_autoneg;
1560
1561         if (dev->fc_request_control & FLOW_CTRL_TX)
1562                 pause->tx_pause = 1;
1563
1564         if (dev->fc_request_control & FLOW_CTRL_RX)
1565                 pause->rx_pause = 1;
1566 }
1567
1568 static int lan78xx_set_pause(struct net_device *net,
1569                              struct ethtool_pauseparam *pause)
1570 {
1571         struct lan78xx_net *dev = netdev_priv(net);
1572         struct phy_device *phydev = net->phydev;
1573         struct ethtool_cmd ecmd = { .cmd = ETHTOOL_GSET };
1574         int ret;
1575
1576         phy_ethtool_gset(phydev, &ecmd);
1577
1578         if (pause->autoneg && !ecmd.autoneg) {
1579                 ret = -EINVAL;
1580                 goto exit;
1581         }
1582
1583         dev->fc_request_control = 0;
1584         if (pause->rx_pause)
1585                 dev->fc_request_control |= FLOW_CTRL_RX;
1586
1587         if (pause->tx_pause)
1588                 dev->fc_request_control |= FLOW_CTRL_TX;
1589
1590         if (ecmd.autoneg) {
1591                 u32 mii_adv;
1592
1593                 ecmd.advertising &= ~(ADVERTISED_Pause | ADVERTISED_Asym_Pause);
1594                 mii_adv = (u32)mii_advertise_flowctrl(dev->fc_request_control);
1595                 ecmd.advertising |= mii_adv_to_ethtool_adv_t(mii_adv);
1596                 phy_ethtool_sset(phydev, &ecmd);
1597         }
1598
1599         dev->fc_autoneg = pause->autoneg;
1600
1601         ret = 0;
1602 exit:
1603         return ret;
1604 }
1605
1606 static const struct ethtool_ops lan78xx_ethtool_ops = {
1607         .get_link       = lan78xx_get_link,
1608         .nway_reset     = lan78xx_nway_reset,
1609         .get_drvinfo    = lan78xx_get_drvinfo,
1610         .get_msglevel   = lan78xx_get_msglevel,
1611         .set_msglevel   = lan78xx_set_msglevel,
1612         .get_settings   = lan78xx_get_settings,
1613         .set_settings   = lan78xx_set_settings,
1614         .get_eeprom_len = lan78xx_ethtool_get_eeprom_len,
1615         .get_eeprom     = lan78xx_ethtool_get_eeprom,
1616         .set_eeprom     = lan78xx_ethtool_set_eeprom,
1617         .get_ethtool_stats = lan78xx_get_stats,
1618         .get_sset_count = lan78xx_get_sset_count,
1619         .get_strings    = lan78xx_get_strings,
1620         .get_wol        = lan78xx_get_wol,
1621         .set_wol        = lan78xx_set_wol,
1622         .get_eee        = lan78xx_get_eee,
1623         .set_eee        = lan78xx_set_eee,
1624         .get_pauseparam = lan78xx_get_pause,
1625         .set_pauseparam = lan78xx_set_pause,
1626 };
1627
1628 static int lan78xx_ioctl(struct net_device *netdev, struct ifreq *rq, int cmd)
1629 {
1630         if (!netif_running(netdev))
1631                 return -EINVAL;
1632
1633         return phy_mii_ioctl(netdev->phydev, rq, cmd);
1634 }
1635
1636 static void lan78xx_init_mac_address(struct lan78xx_net *dev)
1637 {
1638         u32 addr_lo, addr_hi;
1639         int ret;
1640         u8 addr[6];
1641
1642         ret = lan78xx_read_reg(dev, RX_ADDRL, &addr_lo);
1643         ret = lan78xx_read_reg(dev, RX_ADDRH, &addr_hi);
1644
1645         addr[0] = addr_lo & 0xFF;
1646         addr[1] = (addr_lo >> 8) & 0xFF;
1647         addr[2] = (addr_lo >> 16) & 0xFF;
1648         addr[3] = (addr_lo >> 24) & 0xFF;
1649         addr[4] = addr_hi & 0xFF;
1650         addr[5] = (addr_hi >> 8) & 0xFF;
1651
1652         if (!is_valid_ether_addr(addr)) {
1653                 /* reading mac address from EEPROM or OTP */
1654                 if ((lan78xx_read_eeprom(dev, EEPROM_MAC_OFFSET, ETH_ALEN,
1655                                          addr) == 0) ||
1656                     (lan78xx_read_otp(dev, EEPROM_MAC_OFFSET, ETH_ALEN,
1657                                       addr) == 0)) {
1658                         if (is_valid_ether_addr(addr)) {
1659                                 /* eeprom values are valid so use them */
1660                                 netif_dbg(dev, ifup, dev->net,
1661                                           "MAC address read from EEPROM");
1662                         } else {
1663                                 /* generate random MAC */
1664                                 random_ether_addr(addr);
1665                                 netif_dbg(dev, ifup, dev->net,
1666                                           "MAC address set to random addr");
1667                         }
1668
1669                         addr_lo = addr[0] | (addr[1] << 8) |
1670                                   (addr[2] << 16) | (addr[3] << 24);
1671                         addr_hi = addr[4] | (addr[5] << 8);
1672
1673                         ret = lan78xx_write_reg(dev, RX_ADDRL, addr_lo);
1674                         ret = lan78xx_write_reg(dev, RX_ADDRH, addr_hi);
1675                 } else {
1676                         /* generate random MAC */
1677                         random_ether_addr(addr);
1678                         netif_dbg(dev, ifup, dev->net,
1679                                   "MAC address set to random addr");
1680                 }
1681         }
1682
1683         ret = lan78xx_write_reg(dev, MAF_LO(0), addr_lo);
1684         ret = lan78xx_write_reg(dev, MAF_HI(0), addr_hi | MAF_HI_VALID_);
1685
1686         ether_addr_copy(dev->net->dev_addr, addr);
1687 }
1688
1689 /* MDIO read and write wrappers for phylib */
1690 static int lan78xx_mdiobus_read(struct mii_bus *bus, int phy_id, int idx)
1691 {
1692         struct lan78xx_net *dev = bus->priv;
1693         u32 val, addr;
1694         int ret;
1695
1696         ret = usb_autopm_get_interface(dev->intf);
1697         if (ret < 0)
1698                 return ret;
1699
1700         mutex_lock(&dev->phy_mutex);
1701
1702         /* confirm MII not busy */
1703         ret = lan78xx_phy_wait_not_busy(dev);
1704         if (ret < 0)
1705                 goto done;
1706
1707         /* set the address, index & direction (read from PHY) */
1708         addr = mii_access(phy_id, idx, MII_READ);
1709         ret = lan78xx_write_reg(dev, MII_ACC, addr);
1710
1711         ret = lan78xx_phy_wait_not_busy(dev);
1712         if (ret < 0)
1713                 goto done;
1714
1715         ret = lan78xx_read_reg(dev, MII_DATA, &val);
1716
1717         ret = (int)(val & 0xFFFF);
1718
1719 done:
1720         mutex_unlock(&dev->phy_mutex);
1721         usb_autopm_put_interface(dev->intf);
1722         return ret;
1723 }
1724
1725 static int lan78xx_mdiobus_write(struct mii_bus *bus, int phy_id, int idx,
1726                                  u16 regval)
1727 {
1728         struct lan78xx_net *dev = bus->priv;
1729         u32 val, addr;
1730         int ret;
1731
1732         ret = usb_autopm_get_interface(dev->intf);
1733         if (ret < 0)
1734                 return ret;
1735
1736         mutex_lock(&dev->phy_mutex);
1737
1738         /* confirm MII not busy */
1739         ret = lan78xx_phy_wait_not_busy(dev);
1740         if (ret < 0)
1741                 goto done;
1742
1743         val = (u32)regval;
1744         ret = lan78xx_write_reg(dev, MII_DATA, val);
1745
1746         /* set the address, index & direction (write to PHY) */
1747         addr = mii_access(phy_id, idx, MII_WRITE);
1748         ret = lan78xx_write_reg(dev, MII_ACC, addr);
1749
1750         ret = lan78xx_phy_wait_not_busy(dev);
1751         if (ret < 0)
1752                 goto done;
1753
1754 done:
1755         mutex_unlock(&dev->phy_mutex);
1756         usb_autopm_put_interface(dev->intf);
1757         return 0;
1758 }
1759
1760 static int lan78xx_mdio_init(struct lan78xx_net *dev)
1761 {
1762         int ret;
1763
1764         dev->mdiobus = mdiobus_alloc();
1765         if (!dev->mdiobus) {
1766                 netdev_err(dev->net, "can't allocate MDIO bus\n");
1767                 return -ENOMEM;
1768         }
1769
1770         dev->mdiobus->priv = (void *)dev;
1771         dev->mdiobus->read = lan78xx_mdiobus_read;
1772         dev->mdiobus->write = lan78xx_mdiobus_write;
1773         dev->mdiobus->name = "lan78xx-mdiobus";
1774
1775         snprintf(dev->mdiobus->id, MII_BUS_ID_SIZE, "usb-%03d:%03d",
1776                  dev->udev->bus->busnum, dev->udev->devnum);
1777
1778         switch (dev->chipid) {
1779         case ID_REV_CHIP_ID_7800_:
1780         case ID_REV_CHIP_ID_7850_:
1781                 /* set to internal PHY id */
1782                 dev->mdiobus->phy_mask = ~(1 << 1);
1783                 break;
1784         }
1785
1786         ret = mdiobus_register(dev->mdiobus);
1787         if (ret) {
1788                 netdev_err(dev->net, "can't register MDIO bus\n");
1789                 goto exit1;
1790         }
1791
1792         netdev_dbg(dev->net, "registered mdiobus bus %s\n", dev->mdiobus->id);
1793         return 0;
1794 exit1:
1795         mdiobus_free(dev->mdiobus);
1796         return ret;
1797 }
1798
1799 static void lan78xx_remove_mdio(struct lan78xx_net *dev)
1800 {
1801         mdiobus_unregister(dev->mdiobus);
1802         mdiobus_free(dev->mdiobus);
1803 }
1804
1805 static void lan78xx_link_status_change(struct net_device *net)
1806 {
1807         struct phy_device *phydev = net->phydev;
1808         int ret, temp;
1809
1810         /* At forced 100 F/H mode, chip may fail to set mode correctly
1811          * when cable is switched between long(~50+m) and short one.
1812          * As workaround, set to 10 before setting to 100
1813          * at forced 100 F/H mode.
1814          */
1815         if (!phydev->autoneg && (phydev->speed == 100)) {
1816                 /* disable phy interrupt */
1817                 temp = phy_read(phydev, LAN88XX_INT_MASK);
1818                 temp &= ~LAN88XX_INT_MASK_MDINTPIN_EN_;
1819                 ret = phy_write(phydev, LAN88XX_INT_MASK, temp);
1820
1821                 temp = phy_read(phydev, MII_BMCR);
1822                 temp &= ~(BMCR_SPEED100 | BMCR_SPEED1000);
1823                 phy_write(phydev, MII_BMCR, temp); /* set to 10 first */
1824                 temp |= BMCR_SPEED100;
1825                 phy_write(phydev, MII_BMCR, temp); /* set to 100 later */
1826
1827                 /* clear pending interrupt generated while workaround */
1828                 temp = phy_read(phydev, LAN88XX_INT_STS);
1829
1830                 /* enable phy interrupt back */
1831                 temp = phy_read(phydev, LAN88XX_INT_MASK);
1832                 temp |= LAN88XX_INT_MASK_MDINTPIN_EN_;
1833                 ret = phy_write(phydev, LAN88XX_INT_MASK, temp);
1834         }
1835 }
1836
1837 static int lan78xx_phy_init(struct lan78xx_net *dev)
1838 {
1839         int ret;
1840         u32 mii_adv;
1841         struct phy_device *phydev = dev->net->phydev;
1842
1843         phydev = phy_find_first(dev->mdiobus);
1844         if (!phydev) {
1845                 netdev_err(dev->net, "no PHY found\n");
1846                 return -EIO;
1847         }
1848
1849         /* Enable PHY interrupts.
1850          * We handle our own interrupt
1851          */
1852         ret = phy_read(phydev, LAN88XX_INT_STS);
1853         ret = phy_write(phydev, LAN88XX_INT_MASK,
1854                         LAN88XX_INT_MASK_MDINTPIN_EN_ |
1855                         LAN88XX_INT_MASK_LINK_CHANGE_);
1856
1857         phydev->irq = PHY_IGNORE_INTERRUPT;
1858
1859         ret = phy_connect_direct(dev->net, phydev,
1860                                  lan78xx_link_status_change,
1861                                  PHY_INTERFACE_MODE_GMII);
1862         if (ret) {
1863                 netdev_err(dev->net, "can't attach PHY to %s\n",
1864                            dev->mdiobus->id);
1865                 return -EIO;
1866         }
1867
1868         /* set to AUTOMDIX */
1869         lan78xx_set_mdix_status(dev->net, ETH_TP_MDI_AUTO);
1870
1871         /* MAC doesn't support 1000T Half */
1872         phydev->supported &= ~SUPPORTED_1000baseT_Half;
1873
1874         /* support both flow controls */
1875         dev->fc_request_control = (FLOW_CTRL_RX | FLOW_CTRL_TX);
1876         phydev->advertising &= ~(ADVERTISED_Pause | ADVERTISED_Asym_Pause);
1877         mii_adv = (u32)mii_advertise_flowctrl(dev->fc_request_control);
1878         phydev->advertising |= mii_adv_to_ethtool_adv_t(mii_adv);
1879
1880         genphy_config_aneg(phydev);
1881
1882         dev->fc_autoneg = phydev->autoneg;
1883
1884         phy_start(phydev);
1885
1886         netif_dbg(dev, ifup, dev->net, "phy initialised successfully");
1887
1888         return 0;
1889 }
1890
1891 static int lan78xx_set_rx_max_frame_length(struct lan78xx_net *dev, int size)
1892 {
1893         int ret = 0;
1894         u32 buf;
1895         bool rxenabled;
1896
1897         ret = lan78xx_read_reg(dev, MAC_RX, &buf);
1898
1899         rxenabled = ((buf & MAC_RX_RXEN_) != 0);
1900
1901         if (rxenabled) {
1902                 buf &= ~MAC_RX_RXEN_;
1903                 ret = lan78xx_write_reg(dev, MAC_RX, buf);
1904         }
1905
1906         /* add 4 to size for FCS */
1907         buf &= ~MAC_RX_MAX_SIZE_MASK_;
1908         buf |= (((size + 4) << MAC_RX_MAX_SIZE_SHIFT_) & MAC_RX_MAX_SIZE_MASK_);
1909
1910         ret = lan78xx_write_reg(dev, MAC_RX, buf);
1911
1912         if (rxenabled) {
1913                 buf |= MAC_RX_RXEN_;
1914                 ret = lan78xx_write_reg(dev, MAC_RX, buf);
1915         }
1916
1917         return 0;
1918 }
1919
1920 static int unlink_urbs(struct lan78xx_net *dev, struct sk_buff_head *q)
1921 {
1922         struct sk_buff *skb;
1923         unsigned long flags;
1924         int count = 0;
1925
1926         spin_lock_irqsave(&q->lock, flags);
1927         while (!skb_queue_empty(q)) {
1928                 struct skb_data *entry;
1929                 struct urb *urb;
1930                 int ret;
1931
1932                 skb_queue_walk(q, skb) {
1933                         entry = (struct skb_data *)skb->cb;
1934                         if (entry->state != unlink_start)
1935                                 goto found;
1936                 }
1937                 break;
1938 found:
1939                 entry->state = unlink_start;
1940                 urb = entry->urb;
1941
1942                 /* Get reference count of the URB to avoid it to be
1943                  * freed during usb_unlink_urb, which may trigger
1944                  * use-after-free problem inside usb_unlink_urb since
1945                  * usb_unlink_urb is always racing with .complete
1946                  * handler(include defer_bh).
1947                  */
1948                 usb_get_urb(urb);
1949                 spin_unlock_irqrestore(&q->lock, flags);
1950                 /* during some PM-driven resume scenarios,
1951                  * these (async) unlinks complete immediately
1952                  */
1953                 ret = usb_unlink_urb(urb);
1954                 if (ret != -EINPROGRESS && ret != 0)
1955                         netdev_dbg(dev->net, "unlink urb err, %d\n", ret);
1956                 else
1957                         count++;
1958                 usb_put_urb(urb);
1959                 spin_lock_irqsave(&q->lock, flags);
1960         }
1961         spin_unlock_irqrestore(&q->lock, flags);
1962         return count;
1963 }
1964
1965 static int lan78xx_change_mtu(struct net_device *netdev, int new_mtu)
1966 {
1967         struct lan78xx_net *dev = netdev_priv(netdev);
1968         int ll_mtu = new_mtu + netdev->hard_header_len;
1969         int old_hard_mtu = dev->hard_mtu;
1970         int old_rx_urb_size = dev->rx_urb_size;
1971         int ret;
1972
1973         if (new_mtu > MAX_SINGLE_PACKET_SIZE)
1974                 return -EINVAL;
1975
1976         if (new_mtu <= 0)
1977                 return -EINVAL;
1978         /* no second zero-length packet read wanted after mtu-sized packets */
1979         if ((ll_mtu % dev->maxpacket) == 0)
1980                 return -EDOM;
1981
1982         ret = lan78xx_set_rx_max_frame_length(dev, new_mtu + ETH_HLEN);
1983
1984         netdev->mtu = new_mtu;
1985
1986         dev->hard_mtu = netdev->mtu + netdev->hard_header_len;
1987         if (dev->rx_urb_size == old_hard_mtu) {
1988                 dev->rx_urb_size = dev->hard_mtu;
1989                 if (dev->rx_urb_size > old_rx_urb_size) {
1990                         if (netif_running(dev->net)) {
1991                                 unlink_urbs(dev, &dev->rxq);
1992                                 tasklet_schedule(&dev->bh);
1993                         }
1994                 }
1995         }
1996
1997         return 0;
1998 }
1999
2000 static int lan78xx_set_mac_addr(struct net_device *netdev, void *p)
2001 {
2002         struct lan78xx_net *dev = netdev_priv(netdev);
2003         struct sockaddr *addr = p;
2004         u32 addr_lo, addr_hi;
2005         int ret;
2006
2007         if (netif_running(netdev))
2008                 return -EBUSY;
2009
2010         if (!is_valid_ether_addr(addr->sa_data))
2011                 return -EADDRNOTAVAIL;
2012
2013         ether_addr_copy(netdev->dev_addr, addr->sa_data);
2014
2015         addr_lo = netdev->dev_addr[0] |
2016                   netdev->dev_addr[1] << 8 |
2017                   netdev->dev_addr[2] << 16 |
2018                   netdev->dev_addr[3] << 24;
2019         addr_hi = netdev->dev_addr[4] |
2020                   netdev->dev_addr[5] << 8;
2021
2022         ret = lan78xx_write_reg(dev, RX_ADDRL, addr_lo);
2023         ret = lan78xx_write_reg(dev, RX_ADDRH, addr_hi);
2024
2025         return 0;
2026 }
2027
2028 /* Enable or disable Rx checksum offload engine */
2029 static int lan78xx_set_features(struct net_device *netdev,
2030                                 netdev_features_t features)
2031 {
2032         struct lan78xx_net *dev = netdev_priv(netdev);
2033         struct lan78xx_priv *pdata = (struct lan78xx_priv *)(dev->data[0]);
2034         unsigned long flags;
2035         int ret;
2036
2037         spin_lock_irqsave(&pdata->rfe_ctl_lock, flags);
2038
2039         if (features & NETIF_F_RXCSUM) {
2040                 pdata->rfe_ctl |= RFE_CTL_TCPUDP_COE_ | RFE_CTL_IP_COE_;
2041                 pdata->rfe_ctl |= RFE_CTL_ICMP_COE_ | RFE_CTL_IGMP_COE_;
2042         } else {
2043                 pdata->rfe_ctl &= ~(RFE_CTL_TCPUDP_COE_ | RFE_CTL_IP_COE_);
2044                 pdata->rfe_ctl &= ~(RFE_CTL_ICMP_COE_ | RFE_CTL_IGMP_COE_);
2045         }
2046
2047         if (features & NETIF_F_HW_VLAN_CTAG_RX)
2048                 pdata->rfe_ctl |= RFE_CTL_VLAN_FILTER_;
2049         else
2050                 pdata->rfe_ctl &= ~RFE_CTL_VLAN_FILTER_;
2051
2052         spin_unlock_irqrestore(&pdata->rfe_ctl_lock, flags);
2053
2054         ret = lan78xx_write_reg(dev, RFE_CTL, pdata->rfe_ctl);
2055
2056         return 0;
2057 }
2058
2059 static void lan78xx_deferred_vlan_write(struct work_struct *param)
2060 {
2061         struct lan78xx_priv *pdata =
2062                         container_of(param, struct lan78xx_priv, set_vlan);
2063         struct lan78xx_net *dev = pdata->dev;
2064
2065         lan78xx_dataport_write(dev, DP_SEL_RSEL_VLAN_DA_, 0,
2066                                DP_SEL_VHF_VLAN_LEN, pdata->vlan_table);
2067 }
2068
2069 static int lan78xx_vlan_rx_add_vid(struct net_device *netdev,
2070                                    __be16 proto, u16 vid)
2071 {
2072         struct lan78xx_net *dev = netdev_priv(netdev);
2073         struct lan78xx_priv *pdata = (struct lan78xx_priv *)(dev->data[0]);
2074         u16 vid_bit_index;
2075         u16 vid_dword_index;
2076
2077         vid_dword_index = (vid >> 5) & 0x7F;
2078         vid_bit_index = vid & 0x1F;
2079
2080         pdata->vlan_table[vid_dword_index] |= (1 << vid_bit_index);
2081
2082         /* defer register writes to a sleepable context */
2083         schedule_work(&pdata->set_vlan);
2084
2085         return 0;
2086 }
2087
2088 static int lan78xx_vlan_rx_kill_vid(struct net_device *netdev,
2089                                     __be16 proto, u16 vid)
2090 {
2091         struct lan78xx_net *dev = netdev_priv(netdev);
2092         struct lan78xx_priv *pdata = (struct lan78xx_priv *)(dev->data[0]);
2093         u16 vid_bit_index;
2094         u16 vid_dword_index;
2095
2096         vid_dword_index = (vid >> 5) & 0x7F;
2097         vid_bit_index = vid & 0x1F;
2098
2099         pdata->vlan_table[vid_dword_index] &= ~(1 << vid_bit_index);
2100
2101         /* defer register writes to a sleepable context */
2102         schedule_work(&pdata->set_vlan);
2103
2104         return 0;
2105 }
2106
2107 static void lan78xx_init_ltm(struct lan78xx_net *dev)
2108 {
2109         int ret;
2110         u32 buf;
2111         u32 regs[6] = { 0 };
2112
2113         ret = lan78xx_read_reg(dev, USB_CFG1, &buf);
2114         if (buf & USB_CFG1_LTM_ENABLE_) {
2115                 u8 temp[2];
2116                 /* Get values from EEPROM first */
2117                 if (lan78xx_read_eeprom(dev, 0x3F, 2, temp) == 0) {
2118                         if (temp[0] == 24) {
2119                                 ret = lan78xx_read_raw_eeprom(dev,
2120                                                               temp[1] * 2,
2121                                                               24,
2122                                                               (u8 *)regs);
2123                                 if (ret < 0)
2124                                         return;
2125                         }
2126                 } else if (lan78xx_read_otp(dev, 0x3F, 2, temp) == 0) {
2127                         if (temp[0] == 24) {
2128                                 ret = lan78xx_read_raw_otp(dev,
2129                                                            temp[1] * 2,
2130                                                            24,
2131                                                            (u8 *)regs);
2132                                 if (ret < 0)
2133                                         return;
2134                         }
2135                 }
2136         }
2137
2138         lan78xx_write_reg(dev, LTM_BELT_IDLE0, regs[0]);
2139         lan78xx_write_reg(dev, LTM_BELT_IDLE1, regs[1]);
2140         lan78xx_write_reg(dev, LTM_BELT_ACT0, regs[2]);
2141         lan78xx_write_reg(dev, LTM_BELT_ACT1, regs[3]);
2142         lan78xx_write_reg(dev, LTM_INACTIVE0, regs[4]);
2143         lan78xx_write_reg(dev, LTM_INACTIVE1, regs[5]);
2144 }
2145
2146 static int lan78xx_reset(struct lan78xx_net *dev)
2147 {
2148         struct lan78xx_priv *pdata = (struct lan78xx_priv *)(dev->data[0]);
2149         u32 buf;
2150         int ret = 0;
2151         unsigned long timeout;
2152
2153         ret = lan78xx_read_reg(dev, HW_CFG, &buf);
2154         buf |= HW_CFG_LRST_;
2155         ret = lan78xx_write_reg(dev, HW_CFG, buf);
2156
2157         timeout = jiffies + HZ;
2158         do {
2159                 mdelay(1);
2160                 ret = lan78xx_read_reg(dev, HW_CFG, &buf);
2161                 if (time_after(jiffies, timeout)) {
2162                         netdev_warn(dev->net,
2163                                     "timeout on completion of LiteReset");
2164                         return -EIO;
2165                 }
2166         } while (buf & HW_CFG_LRST_);
2167
2168         lan78xx_init_mac_address(dev);
2169
2170         /* save DEVID for later usage */
2171         ret = lan78xx_read_reg(dev, ID_REV, &buf);
2172         dev->chipid = (buf & ID_REV_CHIP_ID_MASK_) >> 16;
2173         dev->chiprev = buf & ID_REV_CHIP_REV_MASK_;
2174
2175         /* Respond to the IN token with a NAK */
2176         ret = lan78xx_read_reg(dev, USB_CFG0, &buf);
2177         buf |= USB_CFG_BIR_;
2178         ret = lan78xx_write_reg(dev, USB_CFG0, buf);
2179
2180         /* Init LTM */
2181         lan78xx_init_ltm(dev);
2182
2183         dev->net->hard_header_len += TX_OVERHEAD;
2184         dev->hard_mtu = dev->net->mtu + dev->net->hard_header_len;
2185
2186         if (dev->udev->speed == USB_SPEED_SUPER) {
2187                 buf = DEFAULT_BURST_CAP_SIZE / SS_USB_PKT_SIZE;
2188                 dev->rx_urb_size = DEFAULT_BURST_CAP_SIZE;
2189                 dev->rx_qlen = 4;
2190                 dev->tx_qlen = 4;
2191         } else if (dev->udev->speed == USB_SPEED_HIGH) {
2192                 buf = DEFAULT_BURST_CAP_SIZE / HS_USB_PKT_SIZE;
2193                 dev->rx_urb_size = DEFAULT_BURST_CAP_SIZE;
2194                 dev->rx_qlen = RX_MAX_QUEUE_MEMORY / dev->rx_urb_size;
2195                 dev->tx_qlen = RX_MAX_QUEUE_MEMORY / dev->hard_mtu;
2196         } else {
2197                 buf = DEFAULT_BURST_CAP_SIZE / FS_USB_PKT_SIZE;
2198                 dev->rx_urb_size = DEFAULT_BURST_CAP_SIZE;
2199                 dev->rx_qlen = 4;
2200         }
2201
2202         ret = lan78xx_write_reg(dev, BURST_CAP, buf);
2203         ret = lan78xx_write_reg(dev, BULK_IN_DLY, DEFAULT_BULK_IN_DELAY);
2204
2205         ret = lan78xx_read_reg(dev, HW_CFG, &buf);
2206         buf |= HW_CFG_MEF_;
2207         ret = lan78xx_write_reg(dev, HW_CFG, buf);
2208
2209         ret = lan78xx_read_reg(dev, USB_CFG0, &buf);
2210         buf |= USB_CFG_BCE_;
2211         ret = lan78xx_write_reg(dev, USB_CFG0, buf);
2212
2213         /* set FIFO sizes */
2214         buf = (MAX_RX_FIFO_SIZE - 512) / 512;
2215         ret = lan78xx_write_reg(dev, FCT_RX_FIFO_END, buf);
2216
2217         buf = (MAX_TX_FIFO_SIZE - 512) / 512;
2218         ret = lan78xx_write_reg(dev, FCT_TX_FIFO_END, buf);
2219
2220         ret = lan78xx_write_reg(dev, INT_STS, INT_STS_CLEAR_ALL_);
2221         ret = lan78xx_write_reg(dev, FLOW, 0);
2222         ret = lan78xx_write_reg(dev, FCT_FLOW, 0);
2223
2224         /* Don't need rfe_ctl_lock during initialisation */
2225         ret = lan78xx_read_reg(dev, RFE_CTL, &pdata->rfe_ctl);
2226         pdata->rfe_ctl |= RFE_CTL_BCAST_EN_ | RFE_CTL_DA_PERFECT_;
2227         ret = lan78xx_write_reg(dev, RFE_CTL, pdata->rfe_ctl);
2228
2229         /* Enable or disable checksum offload engines */
2230         lan78xx_set_features(dev->net, dev->net->features);
2231
2232         lan78xx_set_multicast(dev->net);
2233
2234         /* reset PHY */
2235         ret = lan78xx_read_reg(dev, PMT_CTL, &buf);
2236         buf |= PMT_CTL_PHY_RST_;
2237         ret = lan78xx_write_reg(dev, PMT_CTL, buf);
2238
2239         timeout = jiffies + HZ;
2240         do {
2241                 mdelay(1);
2242                 ret = lan78xx_read_reg(dev, PMT_CTL, &buf);
2243                 if (time_after(jiffies, timeout)) {
2244                         netdev_warn(dev->net, "timeout waiting for PHY Reset");
2245                         return -EIO;
2246                 }
2247         } while ((buf & PMT_CTL_PHY_RST_) || !(buf & PMT_CTL_READY_));
2248
2249         ret = lan78xx_read_reg(dev, MAC_CR, &buf);
2250         buf |= MAC_CR_AUTO_DUPLEX_ | MAC_CR_AUTO_SPEED_;
2251         ret = lan78xx_write_reg(dev, MAC_CR, buf);
2252
2253         /* enable PHY interrupts */
2254         ret = lan78xx_read_reg(dev, INT_EP_CTL, &buf);
2255         buf |= INT_ENP_PHY_INT;
2256         ret = lan78xx_write_reg(dev, INT_EP_CTL, buf);
2257
2258         ret = lan78xx_read_reg(dev, MAC_TX, &buf);
2259         buf |= MAC_TX_TXEN_;
2260         ret = lan78xx_write_reg(dev, MAC_TX, buf);
2261
2262         ret = lan78xx_read_reg(dev, FCT_TX_CTL, &buf);
2263         buf |= FCT_TX_CTL_EN_;
2264         ret = lan78xx_write_reg(dev, FCT_TX_CTL, buf);
2265
2266         ret = lan78xx_set_rx_max_frame_length(dev, dev->net->mtu + ETH_HLEN);
2267
2268         ret = lan78xx_read_reg(dev, MAC_RX, &buf);
2269         buf |= MAC_RX_RXEN_;
2270         ret = lan78xx_write_reg(dev, MAC_RX, buf);
2271
2272         ret = lan78xx_read_reg(dev, FCT_RX_CTL, &buf);
2273         buf |= FCT_RX_CTL_EN_;
2274         ret = lan78xx_write_reg(dev, FCT_RX_CTL, buf);
2275
2276         return 0;
2277 }
2278
2279 static void lan78xx_init_stats(struct lan78xx_net *dev)
2280 {
2281         u32 *p;
2282         int i;
2283
2284         /* initialize for stats update
2285          * some counters are 20bits and some are 32bits
2286          */
2287         p = (u32 *)&dev->stats.rollover_max;
2288         for (i = 0; i < (sizeof(dev->stats.rollover_max) / (sizeof(u32))); i++)
2289                 p[i] = 0xFFFFF;
2290
2291         dev->stats.rollover_max.rx_unicast_byte_count = 0xFFFFFFFF;
2292         dev->stats.rollover_max.rx_broadcast_byte_count = 0xFFFFFFFF;
2293         dev->stats.rollover_max.rx_multicast_byte_count = 0xFFFFFFFF;
2294         dev->stats.rollover_max.eee_rx_lpi_transitions = 0xFFFFFFFF;
2295         dev->stats.rollover_max.eee_rx_lpi_time = 0xFFFFFFFF;
2296         dev->stats.rollover_max.tx_unicast_byte_count = 0xFFFFFFFF;
2297         dev->stats.rollover_max.tx_broadcast_byte_count = 0xFFFFFFFF;
2298         dev->stats.rollover_max.tx_multicast_byte_count = 0xFFFFFFFF;
2299         dev->stats.rollover_max.eee_tx_lpi_transitions = 0xFFFFFFFF;
2300         dev->stats.rollover_max.eee_tx_lpi_time = 0xFFFFFFFF;
2301
2302         lan78xx_defer_kevent(dev, EVENT_STAT_UPDATE);
2303 }
2304
2305 static int lan78xx_open(struct net_device *net)
2306 {
2307         struct lan78xx_net *dev = netdev_priv(net);
2308         int ret;
2309
2310         ret = usb_autopm_get_interface(dev->intf);
2311         if (ret < 0)
2312                 goto out;
2313
2314         ret = lan78xx_reset(dev);
2315         if (ret < 0)
2316                 goto done;
2317
2318         ret = lan78xx_phy_init(dev);
2319         if (ret < 0)
2320                 goto done;
2321
2322         /* for Link Check */
2323         if (dev->urb_intr) {
2324                 ret = usb_submit_urb(dev->urb_intr, GFP_KERNEL);
2325                 if (ret < 0) {
2326                         netif_err(dev, ifup, dev->net,
2327                                   "intr submit %d\n", ret);
2328                         goto done;
2329                 }
2330         }
2331
2332         lan78xx_init_stats(dev);
2333
2334         set_bit(EVENT_DEV_OPEN, &dev->flags);
2335
2336         netif_start_queue(net);
2337
2338         dev->link_on = false;
2339
2340         lan78xx_defer_kevent(dev, EVENT_LINK_RESET);
2341 done:
2342         usb_autopm_put_interface(dev->intf);
2343
2344 out:
2345         return ret;
2346 }
2347
2348 static void lan78xx_terminate_urbs(struct lan78xx_net *dev)
2349 {
2350         DECLARE_WAIT_QUEUE_HEAD_ONSTACK(unlink_wakeup);
2351         DECLARE_WAITQUEUE(wait, current);
2352         int temp;
2353
2354         /* ensure there are no more active urbs */
2355         add_wait_queue(&unlink_wakeup, &wait);
2356         set_current_state(TASK_UNINTERRUPTIBLE);
2357         dev->wait = &unlink_wakeup;
2358         temp = unlink_urbs(dev, &dev->txq) + unlink_urbs(dev, &dev->rxq);
2359
2360         /* maybe wait for deletions to finish. */
2361         while (!skb_queue_empty(&dev->rxq) &&
2362                !skb_queue_empty(&dev->txq) &&
2363                !skb_queue_empty(&dev->done)) {
2364                 schedule_timeout(msecs_to_jiffies(UNLINK_TIMEOUT_MS));
2365                 set_current_state(TASK_UNINTERRUPTIBLE);
2366                 netif_dbg(dev, ifdown, dev->net,
2367                           "waited for %d urb completions\n", temp);
2368         }
2369         set_current_state(TASK_RUNNING);
2370         dev->wait = NULL;
2371         remove_wait_queue(&unlink_wakeup, &wait);
2372 }
2373
2374 static int lan78xx_stop(struct net_device *net)
2375 {
2376         struct lan78xx_net              *dev = netdev_priv(net);
2377
2378         if (timer_pending(&dev->stat_monitor))
2379                 del_timer_sync(&dev->stat_monitor);
2380
2381         phy_stop(net->phydev);
2382         phy_disconnect(net->phydev);
2383         net->phydev = NULL;
2384
2385         clear_bit(EVENT_DEV_OPEN, &dev->flags);
2386         netif_stop_queue(net);
2387
2388         netif_info(dev, ifdown, dev->net,
2389                    "stop stats: rx/tx %lu/%lu, errs %lu/%lu\n",
2390                    net->stats.rx_packets, net->stats.tx_packets,
2391                    net->stats.rx_errors, net->stats.tx_errors);
2392
2393         lan78xx_terminate_urbs(dev);
2394
2395         usb_kill_urb(dev->urb_intr);
2396
2397         skb_queue_purge(&dev->rxq_pause);
2398
2399         /* deferred work (task, timer, softirq) must also stop.
2400          * can't flush_scheduled_work() until we drop rtnl (later),
2401          * else workers could deadlock; so make workers a NOP.
2402          */
2403         dev->flags = 0;
2404         cancel_delayed_work_sync(&dev->wq);
2405         tasklet_kill(&dev->bh);
2406
2407         usb_autopm_put_interface(dev->intf);
2408
2409         return 0;
2410 }
2411
2412 static int lan78xx_linearize(struct sk_buff *skb)
2413 {
2414         return skb_linearize(skb);
2415 }
2416
2417 static struct sk_buff *lan78xx_tx_prep(struct lan78xx_net *dev,
2418                                        struct sk_buff *skb, gfp_t flags)
2419 {
2420         u32 tx_cmd_a, tx_cmd_b;
2421
2422         if (skb_headroom(skb) < TX_OVERHEAD) {
2423                 struct sk_buff *skb2;
2424
2425                 skb2 = skb_copy_expand(skb, TX_OVERHEAD, 0, flags);
2426                 dev_kfree_skb_any(skb);
2427                 skb = skb2;
2428                 if (!skb)
2429                         return NULL;
2430         }
2431
2432         if (lan78xx_linearize(skb) < 0)
2433                 return NULL;
2434
2435         tx_cmd_a = (u32)(skb->len & TX_CMD_A_LEN_MASK_) | TX_CMD_A_FCS_;
2436
2437         if (skb->ip_summed == CHECKSUM_PARTIAL)
2438                 tx_cmd_a |= TX_CMD_A_IPE_ | TX_CMD_A_TPE_;
2439
2440         tx_cmd_b = 0;
2441         if (skb_is_gso(skb)) {
2442                 u16 mss = max(skb_shinfo(skb)->gso_size, TX_CMD_B_MSS_MIN_);
2443
2444                 tx_cmd_b = (mss << TX_CMD_B_MSS_SHIFT_) & TX_CMD_B_MSS_MASK_;
2445
2446                 tx_cmd_a |= TX_CMD_A_LSO_;
2447         }
2448
2449         if (skb_vlan_tag_present(skb)) {
2450                 tx_cmd_a |= TX_CMD_A_IVTG_;
2451                 tx_cmd_b |= skb_vlan_tag_get(skb) & TX_CMD_B_VTAG_MASK_;
2452         }
2453
2454         skb_push(skb, 4);
2455         cpu_to_le32s(&tx_cmd_b);
2456         memcpy(skb->data, &tx_cmd_b, 4);
2457
2458         skb_push(skb, 4);
2459         cpu_to_le32s(&tx_cmd_a);
2460         memcpy(skb->data, &tx_cmd_a, 4);
2461
2462         return skb;
2463 }
2464
2465 static enum skb_state defer_bh(struct lan78xx_net *dev, struct sk_buff *skb,
2466                                struct sk_buff_head *list, enum skb_state state)
2467 {
2468         unsigned long flags;
2469         enum skb_state old_state;
2470         struct skb_data *entry = (struct skb_data *)skb->cb;
2471
2472         spin_lock_irqsave(&list->lock, flags);
2473         old_state = entry->state;
2474         entry->state = state;
2475
2476         __skb_unlink(skb, list);
2477         spin_unlock(&list->lock);
2478         spin_lock(&dev->done.lock);
2479
2480         __skb_queue_tail(&dev->done, skb);
2481         if (skb_queue_len(&dev->done) == 1)
2482                 tasklet_schedule(&dev->bh);
2483         spin_unlock_irqrestore(&dev->done.lock, flags);
2484
2485         return old_state;
2486 }
2487
2488 static void tx_complete(struct urb *urb)
2489 {
2490         struct sk_buff *skb = (struct sk_buff *)urb->context;
2491         struct skb_data *entry = (struct skb_data *)skb->cb;
2492         struct lan78xx_net *dev = entry->dev;
2493
2494         if (urb->status == 0) {
2495                 dev->net->stats.tx_packets += entry->num_of_packet;
2496                 dev->net->stats.tx_bytes += entry->length;
2497         } else {
2498                 dev->net->stats.tx_errors++;
2499
2500                 switch (urb->status) {
2501                 case -EPIPE:
2502                         lan78xx_defer_kevent(dev, EVENT_TX_HALT);
2503                         break;
2504
2505                 /* software-driven interface shutdown */
2506                 case -ECONNRESET:
2507                 case -ESHUTDOWN:
2508                         break;
2509
2510                 case -EPROTO:
2511                 case -ETIME:
2512                 case -EILSEQ:
2513                         netif_stop_queue(dev->net);
2514                         break;
2515                 default:
2516                         netif_dbg(dev, tx_err, dev->net,
2517                                   "tx err %d\n", entry->urb->status);
2518                         break;
2519                 }
2520         }
2521
2522         usb_autopm_put_interface_async(dev->intf);
2523
2524         defer_bh(dev, skb, &dev->txq, tx_done);
2525 }
2526
2527 static void lan78xx_queue_skb(struct sk_buff_head *list,
2528                               struct sk_buff *newsk, enum skb_state state)
2529 {
2530         struct skb_data *entry = (struct skb_data *)newsk->cb;
2531
2532         __skb_queue_tail(list, newsk);
2533         entry->state = state;
2534 }
2535
2536 static netdev_tx_t
2537 lan78xx_start_xmit(struct sk_buff *skb, struct net_device *net)
2538 {
2539         struct lan78xx_net *dev = netdev_priv(net);
2540         struct sk_buff *skb2 = NULL;
2541
2542         if (skb) {
2543                 skb_tx_timestamp(skb);
2544                 skb2 = lan78xx_tx_prep(dev, skb, GFP_ATOMIC);
2545         }
2546
2547         if (skb2) {
2548                 skb_queue_tail(&dev->txq_pend, skb2);
2549
2550                 /* throttle TX patch at slower than SUPER SPEED USB */
2551                 if ((dev->udev->speed < USB_SPEED_SUPER) &&
2552                     (skb_queue_len(&dev->txq_pend) > 10))
2553                         netif_stop_queue(net);
2554         } else {
2555                 netif_dbg(dev, tx_err, dev->net,
2556                           "lan78xx_tx_prep return NULL\n");
2557                 dev->net->stats.tx_errors++;
2558                 dev->net->stats.tx_dropped++;
2559         }
2560
2561         tasklet_schedule(&dev->bh);
2562
2563         return NETDEV_TX_OK;
2564 }
2565
2566 static int
2567 lan78xx_get_endpoints(struct lan78xx_net *dev, struct usb_interface *intf)
2568 {
2569         int tmp;
2570         struct usb_host_interface *alt = NULL;
2571         struct usb_host_endpoint *in = NULL, *out = NULL;
2572         struct usb_host_endpoint *status = NULL;
2573
2574         for (tmp = 0; tmp < intf->num_altsetting; tmp++) {
2575                 unsigned ep;
2576
2577                 in = NULL;
2578                 out = NULL;
2579                 status = NULL;
2580                 alt = intf->altsetting + tmp;
2581
2582                 for (ep = 0; ep < alt->desc.bNumEndpoints; ep++) {
2583                         struct usb_host_endpoint *e;
2584                         int intr = 0;
2585
2586                         e = alt->endpoint + ep;
2587                         switch (e->desc.bmAttributes) {
2588                         case USB_ENDPOINT_XFER_INT:
2589                                 if (!usb_endpoint_dir_in(&e->desc))
2590                                         continue;
2591                                 intr = 1;
2592                                 /* FALLTHROUGH */
2593                         case USB_ENDPOINT_XFER_BULK:
2594                                 break;
2595                         default:
2596                                 continue;
2597                         }
2598                         if (usb_endpoint_dir_in(&e->desc)) {
2599                                 if (!intr && !in)
2600                                         in = e;
2601                                 else if (intr && !status)
2602                                         status = e;
2603                         } else {
2604                                 if (!out)
2605                                         out = e;
2606                         }
2607                 }
2608                 if (in && out)
2609                         break;
2610         }
2611         if (!alt || !in || !out)
2612                 return -EINVAL;
2613
2614         dev->pipe_in = usb_rcvbulkpipe(dev->udev,
2615                                        in->desc.bEndpointAddress &
2616                                        USB_ENDPOINT_NUMBER_MASK);
2617         dev->pipe_out = usb_sndbulkpipe(dev->udev,
2618                                         out->desc.bEndpointAddress &
2619                                         USB_ENDPOINT_NUMBER_MASK);
2620         dev->ep_intr = status;
2621
2622         return 0;
2623 }
2624
2625 static int lan78xx_bind(struct lan78xx_net *dev, struct usb_interface *intf)
2626 {
2627         struct lan78xx_priv *pdata = NULL;
2628         int ret;
2629         int i;
2630
2631         ret = lan78xx_get_endpoints(dev, intf);
2632
2633         dev->data[0] = (unsigned long)kzalloc(sizeof(*pdata), GFP_KERNEL);
2634
2635         pdata = (struct lan78xx_priv *)(dev->data[0]);
2636         if (!pdata) {
2637                 netdev_warn(dev->net, "Unable to allocate lan78xx_priv");
2638                 return -ENOMEM;
2639         }
2640
2641         pdata->dev = dev;
2642
2643         spin_lock_init(&pdata->rfe_ctl_lock);
2644         mutex_init(&pdata->dataport_mutex);
2645
2646         INIT_WORK(&pdata->set_multicast, lan78xx_deferred_multicast_write);
2647
2648         for (i = 0; i < DP_SEL_VHF_VLAN_LEN; i++)
2649                 pdata->vlan_table[i] = 0;
2650
2651         INIT_WORK(&pdata->set_vlan, lan78xx_deferred_vlan_write);
2652
2653         dev->net->features = 0;
2654
2655         if (DEFAULT_TX_CSUM_ENABLE)
2656                 dev->net->features |= NETIF_F_HW_CSUM;
2657
2658         if (DEFAULT_RX_CSUM_ENABLE)
2659                 dev->net->features |= NETIF_F_RXCSUM;
2660
2661         if (DEFAULT_TSO_CSUM_ENABLE)
2662                 dev->net->features |= NETIF_F_TSO | NETIF_F_TSO6 | NETIF_F_SG;
2663
2664         dev->net->hw_features = dev->net->features;
2665
2666         /* Init all registers */
2667         ret = lan78xx_reset(dev);
2668
2669         lan78xx_mdio_init(dev);
2670
2671         dev->net->flags |= IFF_MULTICAST;
2672
2673         pdata->wol = WAKE_MAGIC;
2674
2675         return 0;
2676 }
2677
2678 static void lan78xx_unbind(struct lan78xx_net *dev, struct usb_interface *intf)
2679 {
2680         struct lan78xx_priv *pdata = (struct lan78xx_priv *)(dev->data[0]);
2681
2682         lan78xx_remove_mdio(dev);
2683
2684         if (pdata) {
2685                 netif_dbg(dev, ifdown, dev->net, "free pdata");
2686                 kfree(pdata);
2687                 pdata = NULL;
2688                 dev->data[0] = 0;
2689         }
2690 }
2691
2692 static void lan78xx_rx_csum_offload(struct lan78xx_net *dev,
2693                                     struct sk_buff *skb,
2694                                     u32 rx_cmd_a, u32 rx_cmd_b)
2695 {
2696         if (!(dev->net->features & NETIF_F_RXCSUM) ||
2697             unlikely(rx_cmd_a & RX_CMD_A_ICSM_)) {
2698                 skb->ip_summed = CHECKSUM_NONE;
2699         } else {
2700                 skb->csum = ntohs((u16)(rx_cmd_b >> RX_CMD_B_CSUM_SHIFT_));
2701                 skb->ip_summed = CHECKSUM_COMPLETE;
2702         }
2703 }
2704
2705 static void lan78xx_skb_return(struct lan78xx_net *dev, struct sk_buff *skb)
2706 {
2707         int             status;
2708
2709         if (test_bit(EVENT_RX_PAUSED, &dev->flags)) {
2710                 skb_queue_tail(&dev->rxq_pause, skb);
2711                 return;
2712         }
2713
2714         dev->net->stats.rx_packets++;
2715         dev->net->stats.rx_bytes += skb->len;
2716
2717         skb->protocol = eth_type_trans(skb, dev->net);
2718
2719         netif_dbg(dev, rx_status, dev->net, "< rx, len %zu, type 0x%x\n",
2720                   skb->len + sizeof(struct ethhdr), skb->protocol);
2721         memset(skb->cb, 0, sizeof(struct skb_data));
2722
2723         if (skb_defer_rx_timestamp(skb))
2724                 return;
2725
2726         status = netif_rx(skb);
2727         if (status != NET_RX_SUCCESS)
2728                 netif_dbg(dev, rx_err, dev->net,
2729                           "netif_rx status %d\n", status);
2730 }
2731
2732 static int lan78xx_rx(struct lan78xx_net *dev, struct sk_buff *skb)
2733 {
2734         if (skb->len < dev->net->hard_header_len)
2735                 return 0;
2736
2737         while (skb->len > 0) {
2738                 u32 rx_cmd_a, rx_cmd_b, align_count, size;
2739                 u16 rx_cmd_c;
2740                 struct sk_buff *skb2;
2741                 unsigned char *packet;
2742
2743                 memcpy(&rx_cmd_a, skb->data, sizeof(rx_cmd_a));
2744                 le32_to_cpus(&rx_cmd_a);
2745                 skb_pull(skb, sizeof(rx_cmd_a));
2746
2747                 memcpy(&rx_cmd_b, skb->data, sizeof(rx_cmd_b));
2748                 le32_to_cpus(&rx_cmd_b);
2749                 skb_pull(skb, sizeof(rx_cmd_b));
2750
2751                 memcpy(&rx_cmd_c, skb->data, sizeof(rx_cmd_c));
2752                 le16_to_cpus(&rx_cmd_c);
2753                 skb_pull(skb, sizeof(rx_cmd_c));
2754
2755                 packet = skb->data;
2756
2757                 /* get the packet length */
2758                 size = (rx_cmd_a & RX_CMD_A_LEN_MASK_);
2759                 align_count = (4 - ((size + RXW_PADDING) % 4)) % 4;
2760
2761                 if (unlikely(rx_cmd_a & RX_CMD_A_RED_)) {
2762                         netif_dbg(dev, rx_err, dev->net,
2763                                   "Error rx_cmd_a=0x%08x", rx_cmd_a);
2764                 } else {
2765                         /* last frame in this batch */
2766                         if (skb->len == size) {
2767                                 lan78xx_rx_csum_offload(dev, skb,
2768                                                         rx_cmd_a, rx_cmd_b);
2769
2770                                 skb_trim(skb, skb->len - 4); /* remove fcs */
2771                                 skb->truesize = size + sizeof(struct sk_buff);
2772
2773                                 return 1;
2774                         }
2775
2776                         skb2 = skb_clone(skb, GFP_ATOMIC);
2777                         if (unlikely(!skb2)) {
2778                                 netdev_warn(dev->net, "Error allocating skb");
2779                                 return 0;
2780                         }
2781
2782                         skb2->len = size;
2783                         skb2->data = packet;
2784                         skb_set_tail_pointer(skb2, size);
2785
2786                         lan78xx_rx_csum_offload(dev, skb2, rx_cmd_a, rx_cmd_b);
2787
2788                         skb_trim(skb2, skb2->len - 4); /* remove fcs */
2789                         skb2->truesize = size + sizeof(struct sk_buff);
2790
2791                         lan78xx_skb_return(dev, skb2);
2792                 }
2793
2794                 skb_pull(skb, size);
2795
2796                 /* padding bytes before the next frame starts */
2797                 if (skb->len)
2798                         skb_pull(skb, align_count);
2799         }
2800
2801         return 1;
2802 }
2803
2804 static inline void rx_process(struct lan78xx_net *dev, struct sk_buff *skb)
2805 {
2806         if (!lan78xx_rx(dev, skb)) {
2807                 dev->net->stats.rx_errors++;
2808                 goto done;
2809         }
2810
2811         if (skb->len) {
2812                 lan78xx_skb_return(dev, skb);
2813                 return;
2814         }
2815
2816         netif_dbg(dev, rx_err, dev->net, "drop\n");
2817         dev->net->stats.rx_errors++;
2818 done:
2819         skb_queue_tail(&dev->done, skb);
2820 }
2821
2822 static void rx_complete(struct urb *urb);
2823
2824 static int rx_submit(struct lan78xx_net *dev, struct urb *urb, gfp_t flags)
2825 {
2826         struct sk_buff *skb;
2827         struct skb_data *entry;
2828         unsigned long lockflags;
2829         size_t size = dev->rx_urb_size;
2830         int ret = 0;
2831
2832         skb = netdev_alloc_skb_ip_align(dev->net, size);
2833         if (!skb) {
2834                 usb_free_urb(urb);
2835                 return -ENOMEM;
2836         }
2837
2838         entry = (struct skb_data *)skb->cb;
2839         entry->urb = urb;
2840         entry->dev = dev;
2841         entry->length = 0;
2842
2843         usb_fill_bulk_urb(urb, dev->udev, dev->pipe_in,
2844                           skb->data, size, rx_complete, skb);
2845
2846         spin_lock_irqsave(&dev->rxq.lock, lockflags);
2847
2848         if (netif_device_present(dev->net) &&
2849             netif_running(dev->net) &&
2850             !test_bit(EVENT_RX_HALT, &dev->flags) &&
2851             !test_bit(EVENT_DEV_ASLEEP, &dev->flags)) {
2852                 ret = usb_submit_urb(urb, GFP_ATOMIC);
2853                 switch (ret) {
2854                 case 0:
2855                         lan78xx_queue_skb(&dev->rxq, skb, rx_start);
2856                         break;
2857                 case -EPIPE:
2858                         lan78xx_defer_kevent(dev, EVENT_RX_HALT);
2859                         break;
2860                 case -ENODEV:
2861                         netif_dbg(dev, ifdown, dev->net, "device gone\n");
2862                         netif_device_detach(dev->net);
2863                         break;
2864                 case -EHOSTUNREACH:
2865                         ret = -ENOLINK;
2866                         break;
2867                 default:
2868                         netif_dbg(dev, rx_err, dev->net,
2869                                   "rx submit, %d\n", ret);
2870                         tasklet_schedule(&dev->bh);
2871                 }
2872         } else {
2873                 netif_dbg(dev, ifdown, dev->net, "rx: stopped\n");
2874                 ret = -ENOLINK;
2875         }
2876         spin_unlock_irqrestore(&dev->rxq.lock, lockflags);
2877         if (ret) {
2878                 dev_kfree_skb_any(skb);
2879                 usb_free_urb(urb);
2880         }
2881         return ret;
2882 }
2883
2884 static void rx_complete(struct urb *urb)
2885 {
2886         struct sk_buff  *skb = (struct sk_buff *)urb->context;
2887         struct skb_data *entry = (struct skb_data *)skb->cb;
2888         struct lan78xx_net *dev = entry->dev;
2889         int urb_status = urb->status;
2890         enum skb_state state;
2891
2892         skb_put(skb, urb->actual_length);
2893         state = rx_done;
2894         entry->urb = NULL;
2895
2896         switch (urb_status) {
2897         case 0:
2898                 if (skb->len < dev->net->hard_header_len) {
2899                         state = rx_cleanup;
2900                         dev->net->stats.rx_errors++;
2901                         dev->net->stats.rx_length_errors++;
2902                         netif_dbg(dev, rx_err, dev->net,
2903                                   "rx length %d\n", skb->len);
2904                 }
2905                 usb_mark_last_busy(dev->udev);
2906                 break;
2907         case -EPIPE:
2908                 dev->net->stats.rx_errors++;
2909                 lan78xx_defer_kevent(dev, EVENT_RX_HALT);
2910                 /* FALLTHROUGH */
2911         case -ECONNRESET:                               /* async unlink */
2912         case -ESHUTDOWN:                                /* hardware gone */
2913                 netif_dbg(dev, ifdown, dev->net,
2914                           "rx shutdown, code %d\n", urb_status);
2915                 state = rx_cleanup;
2916                 entry->urb = urb;
2917                 urb = NULL;
2918                 break;
2919         case -EPROTO:
2920         case -ETIME:
2921         case -EILSEQ:
2922                 dev->net->stats.rx_errors++;
2923                 state = rx_cleanup;
2924                 entry->urb = urb;
2925                 urb = NULL;
2926                 break;
2927
2928         /* data overrun ... flush fifo? */
2929         case -EOVERFLOW:
2930                 dev->net->stats.rx_over_errors++;
2931                 /* FALLTHROUGH */
2932
2933         default:
2934                 state = rx_cleanup;
2935                 dev->net->stats.rx_errors++;
2936                 netif_dbg(dev, rx_err, dev->net, "rx status %d\n", urb_status);
2937                 break;
2938         }
2939
2940         state = defer_bh(dev, skb, &dev->rxq, state);
2941
2942         if (urb) {
2943                 if (netif_running(dev->net) &&
2944                     !test_bit(EVENT_RX_HALT, &dev->flags) &&
2945                     state != unlink_start) {
2946                         rx_submit(dev, urb, GFP_ATOMIC);
2947                         return;
2948                 }
2949                 usb_free_urb(urb);
2950         }
2951         netif_dbg(dev, rx_err, dev->net, "no read resubmitted\n");
2952 }
2953
2954 static void lan78xx_tx_bh(struct lan78xx_net *dev)
2955 {
2956         int length;
2957         struct urb *urb = NULL;
2958         struct skb_data *entry;
2959         unsigned long flags;
2960         struct sk_buff_head *tqp = &dev->txq_pend;
2961         struct sk_buff *skb, *skb2;
2962         int ret;
2963         int count, pos;
2964         int skb_totallen, pkt_cnt;
2965
2966         skb_totallen = 0;
2967         pkt_cnt = 0;
2968         count = 0;
2969         length = 0;
2970         for (skb = tqp->next; pkt_cnt < tqp->qlen; skb = skb->next) {
2971                 if (skb_is_gso(skb)) {
2972                         if (pkt_cnt) {
2973                                 /* handle previous packets first */
2974                                 break;
2975                         }
2976                         count = 1;
2977                         length = skb->len - TX_OVERHEAD;
2978                         skb2 = skb_dequeue(tqp);
2979                         goto gso_skb;
2980                 }
2981
2982                 if ((skb_totallen + skb->len) > MAX_SINGLE_PACKET_SIZE)
2983                         break;
2984                 skb_totallen = skb->len + roundup(skb_totallen, sizeof(u32));
2985                 pkt_cnt++;
2986         }
2987
2988         /* copy to a single skb */
2989         skb = alloc_skb(skb_totallen, GFP_ATOMIC);
2990         if (!skb)
2991                 goto drop;
2992
2993         skb_put(skb, skb_totallen);
2994
2995         for (count = pos = 0; count < pkt_cnt; count++) {
2996                 skb2 = skb_dequeue(tqp);
2997                 if (skb2) {
2998                         length += (skb2->len - TX_OVERHEAD);
2999                         memcpy(skb->data + pos, skb2->data, skb2->len);
3000                         pos += roundup(skb2->len, sizeof(u32));
3001                         dev_kfree_skb(skb2);
3002                 }
3003         }
3004
3005 gso_skb:
3006         urb = usb_alloc_urb(0, GFP_ATOMIC);
3007         if (!urb)
3008                 goto drop;
3009
3010         entry = (struct skb_data *)skb->cb;
3011         entry->urb = urb;
3012         entry->dev = dev;
3013         entry->length = length;
3014         entry->num_of_packet = count;
3015
3016         spin_lock_irqsave(&dev->txq.lock, flags);
3017         ret = usb_autopm_get_interface_async(dev->intf);
3018         if (ret < 0) {
3019                 spin_unlock_irqrestore(&dev->txq.lock, flags);
3020                 goto drop;
3021         }
3022
3023         usb_fill_bulk_urb(urb, dev->udev, dev->pipe_out,
3024                           skb->data, skb->len, tx_complete, skb);
3025
3026         if (length % dev->maxpacket == 0) {
3027                 /* send USB_ZERO_PACKET */
3028                 urb->transfer_flags |= URB_ZERO_PACKET;
3029         }
3030
3031 #ifdef CONFIG_PM
3032         /* if this triggers the device is still a sleep */
3033         if (test_bit(EVENT_DEV_ASLEEP, &dev->flags)) {
3034                 /* transmission will be done in resume */
3035                 usb_anchor_urb(urb, &dev->deferred);
3036                 /* no use to process more packets */
3037                 netif_stop_queue(dev->net);
3038                 usb_put_urb(urb);
3039                 spin_unlock_irqrestore(&dev->txq.lock, flags);
3040                 netdev_dbg(dev->net, "Delaying transmission for resumption\n");
3041                 return;
3042         }
3043 #endif
3044
3045         ret = usb_submit_urb(urb, GFP_ATOMIC);
3046         switch (ret) {
3047         case 0:
3048                 netif_trans_update(dev->net);
3049                 lan78xx_queue_skb(&dev->txq, skb, tx_start);
3050                 if (skb_queue_len(&dev->txq) >= dev->tx_qlen)
3051                         netif_stop_queue(dev->net);
3052                 break;
3053         case -EPIPE:
3054                 netif_stop_queue(dev->net);
3055                 lan78xx_defer_kevent(dev, EVENT_TX_HALT);
3056                 usb_autopm_put_interface_async(dev->intf);
3057                 break;
3058         default:
3059                 usb_autopm_put_interface_async(dev->intf);
3060                 netif_dbg(dev, tx_err, dev->net,
3061                           "tx: submit urb err %d\n", ret);
3062                 break;
3063         }
3064
3065         spin_unlock_irqrestore(&dev->txq.lock, flags);
3066
3067         if (ret) {
3068                 netif_dbg(dev, tx_err, dev->net, "drop, code %d\n", ret);
3069 drop:
3070                 dev->net->stats.tx_dropped++;
3071                 if (skb)
3072                         dev_kfree_skb_any(skb);
3073                 usb_free_urb(urb);
3074         } else
3075                 netif_dbg(dev, tx_queued, dev->net,
3076                           "> tx, len %d, type 0x%x\n", length, skb->protocol);
3077 }
3078
3079 static void lan78xx_rx_bh(struct lan78xx_net *dev)
3080 {
3081         struct urb *urb;
3082         int i;
3083
3084         if (skb_queue_len(&dev->rxq) < dev->rx_qlen) {
3085                 for (i = 0; i < 10; i++) {
3086                         if (skb_queue_len(&dev->rxq) >= dev->rx_qlen)
3087                                 break;
3088                         urb = usb_alloc_urb(0, GFP_ATOMIC);
3089                         if (urb)
3090                                 if (rx_submit(dev, urb, GFP_ATOMIC) == -ENOLINK)
3091                                         return;
3092                 }
3093
3094                 if (skb_queue_len(&dev->rxq) < dev->rx_qlen)
3095                         tasklet_schedule(&dev->bh);
3096         }
3097         if (skb_queue_len(&dev->txq) < dev->tx_qlen)
3098                 netif_wake_queue(dev->net);
3099 }
3100
3101 static void lan78xx_bh(unsigned long param)
3102 {
3103         struct lan78xx_net *dev = (struct lan78xx_net *)param;
3104         struct sk_buff *skb;
3105         struct skb_data *entry;
3106
3107         while ((skb = skb_dequeue(&dev->done))) {
3108                 entry = (struct skb_data *)(skb->cb);
3109                 switch (entry->state) {
3110                 case rx_done:
3111                         entry->state = rx_cleanup;
3112                         rx_process(dev, skb);
3113                         continue;
3114                 case tx_done:
3115                         usb_free_urb(entry->urb);
3116                         dev_kfree_skb(skb);
3117                         continue;
3118                 case rx_cleanup:
3119                         usb_free_urb(entry->urb);
3120                         dev_kfree_skb(skb);
3121                         continue;
3122                 default:
3123                         netdev_dbg(dev->net, "skb state %d\n", entry->state);
3124                         return;
3125                 }
3126         }
3127
3128         if (netif_device_present(dev->net) && netif_running(dev->net)) {
3129                 /* reset update timer delta */
3130                 if (timer_pending(&dev->stat_monitor) && (dev->delta != 1)) {
3131                         dev->delta = 1;
3132                         mod_timer(&dev->stat_monitor,
3133                                   jiffies + STAT_UPDATE_TIMER);
3134                 }
3135
3136                 if (!skb_queue_empty(&dev->txq_pend))
3137                         lan78xx_tx_bh(dev);
3138
3139                 if (!timer_pending(&dev->delay) &&
3140                     !test_bit(EVENT_RX_HALT, &dev->flags))
3141                         lan78xx_rx_bh(dev);
3142         }
3143 }
3144
3145 static void lan78xx_delayedwork(struct work_struct *work)
3146 {
3147         int status;
3148         struct lan78xx_net *dev;
3149
3150         dev = container_of(work, struct lan78xx_net, wq.work);
3151
3152         if (test_bit(EVENT_TX_HALT, &dev->flags)) {
3153                 unlink_urbs(dev, &dev->txq);
3154                 status = usb_autopm_get_interface(dev->intf);
3155                 if (status < 0)
3156                         goto fail_pipe;
3157                 status = usb_clear_halt(dev->udev, dev->pipe_out);
3158                 usb_autopm_put_interface(dev->intf);
3159                 if (status < 0 &&
3160                     status != -EPIPE &&
3161                     status != -ESHUTDOWN) {
3162                         if (netif_msg_tx_err(dev))
3163 fail_pipe:
3164                                 netdev_err(dev->net,
3165                                            "can't clear tx halt, status %d\n",
3166                                            status);
3167                 } else {
3168                         clear_bit(EVENT_TX_HALT, &dev->flags);
3169                         if (status != -ESHUTDOWN)
3170                                 netif_wake_queue(dev->net);
3171                 }
3172         }
3173         if (test_bit(EVENT_RX_HALT, &dev->flags)) {
3174                 unlink_urbs(dev, &dev->rxq);
3175                 status = usb_autopm_get_interface(dev->intf);
3176                 if (status < 0)
3177                                 goto fail_halt;
3178                 status = usb_clear_halt(dev->udev, dev->pipe_in);
3179                 usb_autopm_put_interface(dev->intf);
3180                 if (status < 0 &&
3181                     status != -EPIPE &&
3182                     status != -ESHUTDOWN) {
3183                         if (netif_msg_rx_err(dev))
3184 fail_halt:
3185                                 netdev_err(dev->net,
3186                                            "can't clear rx halt, status %d\n",
3187                                            status);
3188                 } else {
3189                         clear_bit(EVENT_RX_HALT, &dev->flags);
3190                         tasklet_schedule(&dev->bh);
3191                 }
3192         }
3193
3194         if (test_bit(EVENT_LINK_RESET, &dev->flags)) {
3195                 int ret = 0;
3196
3197                 clear_bit(EVENT_LINK_RESET, &dev->flags);
3198                 status = usb_autopm_get_interface(dev->intf);
3199                 if (status < 0)
3200                         goto skip_reset;
3201                 if (lan78xx_link_reset(dev) < 0) {
3202                         usb_autopm_put_interface(dev->intf);
3203 skip_reset:
3204                         netdev_info(dev->net, "link reset failed (%d)\n",
3205                                     ret);
3206                 } else {
3207                         usb_autopm_put_interface(dev->intf);
3208                 }
3209         }
3210
3211         if (test_bit(EVENT_STAT_UPDATE, &dev->flags)) {
3212                 lan78xx_update_stats(dev);
3213
3214                 clear_bit(EVENT_STAT_UPDATE, &dev->flags);
3215
3216                 mod_timer(&dev->stat_monitor,
3217                           jiffies + (STAT_UPDATE_TIMER * dev->delta));
3218
3219                 dev->delta = min((dev->delta * 2), 50);
3220         }
3221 }
3222
3223 static void intr_complete(struct urb *urb)
3224 {
3225         struct lan78xx_net *dev = urb->context;
3226         int status = urb->status;
3227
3228         switch (status) {
3229         /* success */
3230         case 0:
3231                 lan78xx_status(dev, urb);
3232                 break;
3233
3234         /* software-driven interface shutdown */
3235         case -ENOENT:                   /* urb killed */
3236         case -ESHUTDOWN:                /* hardware gone */
3237                 netif_dbg(dev, ifdown, dev->net,
3238                           "intr shutdown, code %d\n", status);
3239                 return;
3240
3241         /* NOTE:  not throttling like RX/TX, since this endpoint
3242          * already polls infrequently
3243          */
3244         default:
3245                 netdev_dbg(dev->net, "intr status %d\n", status);
3246                 break;
3247         }
3248
3249         if (!netif_running(dev->net))
3250                 return;
3251
3252         memset(urb->transfer_buffer, 0, urb->transfer_buffer_length);
3253         status = usb_submit_urb(urb, GFP_ATOMIC);
3254         if (status != 0)
3255                 netif_err(dev, timer, dev->net,
3256                           "intr resubmit --> %d\n", status);
3257 }
3258
3259 static void lan78xx_disconnect(struct usb_interface *intf)
3260 {
3261         struct lan78xx_net              *dev;
3262         struct usb_device               *udev;
3263         struct net_device               *net;
3264
3265         dev = usb_get_intfdata(intf);
3266         usb_set_intfdata(intf, NULL);
3267         if (!dev)
3268                 return;
3269
3270         udev = interface_to_usbdev(intf);
3271
3272         net = dev->net;
3273         unregister_netdev(net);
3274
3275         cancel_delayed_work_sync(&dev->wq);
3276
3277         usb_scuttle_anchored_urbs(&dev->deferred);
3278
3279         lan78xx_unbind(dev, intf);
3280
3281         usb_kill_urb(dev->urb_intr);
3282         usb_free_urb(dev->urb_intr);
3283
3284         free_netdev(net);
3285         usb_put_dev(udev);
3286 }
3287
3288 static void lan78xx_tx_timeout(struct net_device *net)
3289 {
3290         struct lan78xx_net *dev = netdev_priv(net);
3291
3292         unlink_urbs(dev, &dev->txq);
3293         tasklet_schedule(&dev->bh);
3294 }
3295
3296 static const struct net_device_ops lan78xx_netdev_ops = {
3297         .ndo_open               = lan78xx_open,
3298         .ndo_stop               = lan78xx_stop,
3299         .ndo_start_xmit         = lan78xx_start_xmit,
3300         .ndo_tx_timeout         = lan78xx_tx_timeout,
3301         .ndo_change_mtu         = lan78xx_change_mtu,
3302         .ndo_set_mac_address    = lan78xx_set_mac_addr,
3303         .ndo_validate_addr      = eth_validate_addr,
3304         .ndo_do_ioctl           = lan78xx_ioctl,
3305         .ndo_set_rx_mode        = lan78xx_set_multicast,
3306         .ndo_set_features       = lan78xx_set_features,
3307         .ndo_vlan_rx_add_vid    = lan78xx_vlan_rx_add_vid,
3308         .ndo_vlan_rx_kill_vid   = lan78xx_vlan_rx_kill_vid,
3309 };
3310
3311 static void lan78xx_stat_monitor(unsigned long param)
3312 {
3313         struct lan78xx_net *dev;
3314
3315         dev = (struct lan78xx_net *)param;
3316
3317         lan78xx_defer_kevent(dev, EVENT_STAT_UPDATE);
3318 }
3319
3320 static int lan78xx_probe(struct usb_interface *intf,
3321                          const struct usb_device_id *id)
3322 {
3323         struct lan78xx_net *dev;
3324         struct net_device *netdev;
3325         struct usb_device *udev;
3326         int ret;
3327         unsigned maxp;
3328         unsigned period;
3329         u8 *buf = NULL;
3330
3331         udev = interface_to_usbdev(intf);
3332         udev = usb_get_dev(udev);
3333
3334         ret = -ENOMEM;
3335         netdev = alloc_etherdev(sizeof(struct lan78xx_net));
3336         if (!netdev) {
3337                         dev_err(&intf->dev, "Error: OOM\n");
3338                         goto out1;
3339         }
3340
3341         /* netdev_printk() needs this */
3342         SET_NETDEV_DEV(netdev, &intf->dev);
3343
3344         dev = netdev_priv(netdev);
3345         dev->udev = udev;
3346         dev->intf = intf;
3347         dev->net = netdev;
3348         dev->msg_enable = netif_msg_init(msg_level, NETIF_MSG_DRV
3349                                         | NETIF_MSG_PROBE | NETIF_MSG_LINK);
3350
3351         skb_queue_head_init(&dev->rxq);
3352         skb_queue_head_init(&dev->txq);
3353         skb_queue_head_init(&dev->done);
3354         skb_queue_head_init(&dev->rxq_pause);
3355         skb_queue_head_init(&dev->txq_pend);
3356         mutex_init(&dev->phy_mutex);
3357
3358         tasklet_init(&dev->bh, lan78xx_bh, (unsigned long)dev);
3359         INIT_DELAYED_WORK(&dev->wq, lan78xx_delayedwork);
3360         init_usb_anchor(&dev->deferred);
3361
3362         netdev->netdev_ops = &lan78xx_netdev_ops;
3363         netdev->watchdog_timeo = TX_TIMEOUT_JIFFIES;
3364         netdev->ethtool_ops = &lan78xx_ethtool_ops;
3365
3366         dev->stat_monitor.function = lan78xx_stat_monitor;
3367         dev->stat_monitor.data = (unsigned long)dev;
3368         dev->delta = 1;
3369         init_timer(&dev->stat_monitor);
3370
3371         mutex_init(&dev->stats.access_lock);
3372
3373         ret = lan78xx_bind(dev, intf);
3374         if (ret < 0)
3375                 goto out2;
3376         strcpy(netdev->name, "eth%d");
3377
3378         if (netdev->mtu > (dev->hard_mtu - netdev->hard_header_len))
3379                 netdev->mtu = dev->hard_mtu - netdev->hard_header_len;
3380
3381         dev->ep_blkin = (intf->cur_altsetting)->endpoint + 0;
3382         dev->ep_blkout = (intf->cur_altsetting)->endpoint + 1;
3383         dev->ep_intr = (intf->cur_altsetting)->endpoint + 2;
3384
3385         dev->pipe_in = usb_rcvbulkpipe(udev, BULK_IN_PIPE);
3386         dev->pipe_out = usb_sndbulkpipe(udev, BULK_OUT_PIPE);
3387
3388         dev->pipe_intr = usb_rcvintpipe(dev->udev,
3389                                         dev->ep_intr->desc.bEndpointAddress &
3390                                         USB_ENDPOINT_NUMBER_MASK);
3391         period = dev->ep_intr->desc.bInterval;
3392
3393         maxp = usb_maxpacket(dev->udev, dev->pipe_intr, 0);
3394         buf = kmalloc(maxp, GFP_KERNEL);
3395         if (buf) {
3396                 dev->urb_intr = usb_alloc_urb(0, GFP_KERNEL);
3397                 if (!dev->urb_intr) {
3398                         kfree(buf);
3399                         goto out3;
3400                 } else {
3401                         usb_fill_int_urb(dev->urb_intr, dev->udev,
3402                                          dev->pipe_intr, buf, maxp,
3403                                          intr_complete, dev, period);
3404                 }
3405         }
3406
3407         dev->maxpacket = usb_maxpacket(dev->udev, dev->pipe_out, 1);
3408
3409         /* driver requires remote-wakeup capability during autosuspend. */
3410         intf->needs_remote_wakeup = 1;
3411
3412         ret = register_netdev(netdev);
3413         if (ret != 0) {
3414                 netif_err(dev, probe, netdev, "couldn't register the device\n");
3415                 goto out2;
3416         }
3417
3418         usb_set_intfdata(intf, dev);
3419
3420         ret = device_set_wakeup_enable(&udev->dev, true);
3421
3422          /* Default delay of 2sec has more overhead than advantage.
3423           * Set to 10sec as default.
3424           */
3425         pm_runtime_set_autosuspend_delay(&udev->dev,
3426                                          DEFAULT_AUTOSUSPEND_DELAY);
3427
3428         return 0;
3429
3430 out3:
3431         lan78xx_unbind(dev, intf);
3432 out2:
3433         free_netdev(netdev);
3434 out1:
3435         usb_put_dev(udev);
3436
3437         return ret;
3438 }
3439
3440 static u16 lan78xx_wakeframe_crc16(const u8 *buf, int len)
3441 {
3442         const u16 crc16poly = 0x8005;
3443         int i;
3444         u16 bit, crc, msb;
3445         u8 data;
3446
3447         crc = 0xFFFF;
3448         for (i = 0; i < len; i++) {
3449                 data = *buf++;
3450                 for (bit = 0; bit < 8; bit++) {
3451                         msb = crc >> 15;
3452                         crc <<= 1;
3453
3454                         if (msb ^ (u16)(data & 1)) {
3455                                 crc ^= crc16poly;
3456                                 crc |= (u16)0x0001U;
3457                         }
3458                         data >>= 1;
3459                 }
3460         }
3461
3462         return crc;
3463 }
3464
3465 static int lan78xx_set_suspend(struct lan78xx_net *dev, u32 wol)
3466 {
3467         u32 buf;
3468         int ret;
3469         int mask_index;
3470         u16 crc;
3471         u32 temp_wucsr;
3472         u32 temp_pmt_ctl;
3473         const u8 ipv4_multicast[3] = { 0x01, 0x00, 0x5E };
3474         const u8 ipv6_multicast[3] = { 0x33, 0x33 };
3475         const u8 arp_type[2] = { 0x08, 0x06 };
3476
3477         ret = lan78xx_read_reg(dev, MAC_TX, &buf);
3478         buf &= ~MAC_TX_TXEN_;
3479         ret = lan78xx_write_reg(dev, MAC_TX, buf);
3480         ret = lan78xx_read_reg(dev, MAC_RX, &buf);
3481         buf &= ~MAC_RX_RXEN_;
3482         ret = lan78xx_write_reg(dev, MAC_RX, buf);
3483
3484         ret = lan78xx_write_reg(dev, WUCSR, 0);
3485         ret = lan78xx_write_reg(dev, WUCSR2, 0);
3486         ret = lan78xx_write_reg(dev, WK_SRC, 0xFFF1FF1FUL);
3487
3488         temp_wucsr = 0;
3489
3490         temp_pmt_ctl = 0;
3491         ret = lan78xx_read_reg(dev, PMT_CTL, &temp_pmt_ctl);
3492         temp_pmt_ctl &= ~PMT_CTL_RES_CLR_WKP_EN_;
3493         temp_pmt_ctl |= PMT_CTL_RES_CLR_WKP_STS_;
3494
3495         for (mask_index = 0; mask_index < NUM_OF_WUF_CFG; mask_index++)
3496                 ret = lan78xx_write_reg(dev, WUF_CFG(mask_index), 0);
3497
3498         mask_index = 0;
3499         if (wol & WAKE_PHY) {
3500                 temp_pmt_ctl |= PMT_CTL_PHY_WAKE_EN_;
3501
3502                 temp_pmt_ctl |= PMT_CTL_WOL_EN_;
3503                 temp_pmt_ctl &= ~PMT_CTL_SUS_MODE_MASK_;
3504                 temp_pmt_ctl |= PMT_CTL_SUS_MODE_0_;
3505         }
3506         if (wol & WAKE_MAGIC) {
3507                 temp_wucsr |= WUCSR_MPEN_;
3508
3509                 temp_pmt_ctl |= PMT_CTL_WOL_EN_;
3510                 temp_pmt_ctl &= ~PMT_CTL_SUS_MODE_MASK_;
3511                 temp_pmt_ctl |= PMT_CTL_SUS_MODE_3_;
3512         }
3513         if (wol & WAKE_BCAST) {
3514                 temp_wucsr |= WUCSR_BCST_EN_;
3515
3516                 temp_pmt_ctl |= PMT_CTL_WOL_EN_;
3517                 temp_pmt_ctl &= ~PMT_CTL_SUS_MODE_MASK_;
3518                 temp_pmt_ctl |= PMT_CTL_SUS_MODE_0_;
3519         }
3520         if (wol & WAKE_MCAST) {
3521                 temp_wucsr |= WUCSR_WAKE_EN_;
3522
3523                 /* set WUF_CFG & WUF_MASK for IPv4 Multicast */
3524                 crc = lan78xx_wakeframe_crc16(ipv4_multicast, 3);
3525                 ret = lan78xx_write_reg(dev, WUF_CFG(mask_index),
3526                                         WUF_CFGX_EN_ |
3527                                         WUF_CFGX_TYPE_MCAST_ |
3528                                         (0 << WUF_CFGX_OFFSET_SHIFT_) |
3529                                         (crc & WUF_CFGX_CRC16_MASK_));
3530
3531                 ret = lan78xx_write_reg(dev, WUF_MASK0(mask_index), 7);
3532                 ret = lan78xx_write_reg(dev, WUF_MASK1(mask_index), 0);
3533                 ret = lan78xx_write_reg(dev, WUF_MASK2(mask_index), 0);
3534                 ret = lan78xx_write_reg(dev, WUF_MASK3(mask_index), 0);
3535                 mask_index++;
3536
3537                 /* for IPv6 Multicast */
3538                 crc = lan78xx_wakeframe_crc16(ipv6_multicast, 2);
3539                 ret = lan78xx_write_reg(dev, WUF_CFG(mask_index),
3540                                         WUF_CFGX_EN_ |
3541                                         WUF_CFGX_TYPE_MCAST_ |
3542                                         (0 << WUF_CFGX_OFFSET_SHIFT_) |
3543                                         (crc & WUF_CFGX_CRC16_MASK_));
3544
3545                 ret = lan78xx_write_reg(dev, WUF_MASK0(mask_index), 3);
3546                 ret = lan78xx_write_reg(dev, WUF_MASK1(mask_index), 0);
3547                 ret = lan78xx_write_reg(dev, WUF_MASK2(mask_index), 0);
3548                 ret = lan78xx_write_reg(dev, WUF_MASK3(mask_index), 0);
3549                 mask_index++;
3550
3551                 temp_pmt_ctl |= PMT_CTL_WOL_EN_;
3552                 temp_pmt_ctl &= ~PMT_CTL_SUS_MODE_MASK_;
3553                 temp_pmt_ctl |= PMT_CTL_SUS_MODE_0_;
3554         }
3555         if (wol & WAKE_UCAST) {
3556                 temp_wucsr |= WUCSR_PFDA_EN_;
3557
3558                 temp_pmt_ctl |= PMT_CTL_WOL_EN_;
3559                 temp_pmt_ctl &= ~PMT_CTL_SUS_MODE_MASK_;
3560                 temp_pmt_ctl |= PMT_CTL_SUS_MODE_0_;
3561         }
3562         if (wol & WAKE_ARP) {
3563                 temp_wucsr |= WUCSR_WAKE_EN_;
3564
3565                 /* set WUF_CFG & WUF_MASK
3566                  * for packettype (offset 12,13) = ARP (0x0806)
3567                  */
3568                 crc = lan78xx_wakeframe_crc16(arp_type, 2);
3569                 ret = lan78xx_write_reg(dev, WUF_CFG(mask_index),
3570                                         WUF_CFGX_EN_ |
3571                                         WUF_CFGX_TYPE_ALL_ |
3572                                         (0 << WUF_CFGX_OFFSET_SHIFT_) |
3573                                         (crc & WUF_CFGX_CRC16_MASK_));
3574
3575                 ret = lan78xx_write_reg(dev, WUF_MASK0(mask_index), 0x3000);
3576                 ret = lan78xx_write_reg(dev, WUF_MASK1(mask_index), 0);
3577                 ret = lan78xx_write_reg(dev, WUF_MASK2(mask_index), 0);
3578                 ret = lan78xx_write_reg(dev, WUF_MASK3(mask_index), 0);
3579                 mask_index++;
3580
3581                 temp_pmt_ctl |= PMT_CTL_WOL_EN_;
3582                 temp_pmt_ctl &= ~PMT_CTL_SUS_MODE_MASK_;
3583                 temp_pmt_ctl |= PMT_CTL_SUS_MODE_0_;
3584         }
3585
3586         ret = lan78xx_write_reg(dev, WUCSR, temp_wucsr);
3587
3588         /* when multiple WOL bits are set */
3589         if (hweight_long((unsigned long)wol) > 1) {
3590                 temp_pmt_ctl |= PMT_CTL_WOL_EN_;
3591                 temp_pmt_ctl &= ~PMT_CTL_SUS_MODE_MASK_;
3592                 temp_pmt_ctl |= PMT_CTL_SUS_MODE_0_;
3593         }
3594         ret = lan78xx_write_reg(dev, PMT_CTL, temp_pmt_ctl);
3595
3596         /* clear WUPS */
3597         ret = lan78xx_read_reg(dev, PMT_CTL, &buf);
3598         buf |= PMT_CTL_WUPS_MASK_;
3599         ret = lan78xx_write_reg(dev, PMT_CTL, buf);
3600
3601         ret = lan78xx_read_reg(dev, MAC_RX, &buf);
3602         buf |= MAC_RX_RXEN_;
3603         ret = lan78xx_write_reg(dev, MAC_RX, buf);
3604
3605         return 0;
3606 }
3607
3608 static int lan78xx_suspend(struct usb_interface *intf, pm_message_t message)
3609 {
3610         struct lan78xx_net *dev = usb_get_intfdata(intf);
3611         struct lan78xx_priv *pdata = (struct lan78xx_priv *)(dev->data[0]);
3612         u32 buf;
3613         int ret;
3614         int event;
3615
3616         event = message.event;
3617
3618         if (!dev->suspend_count++) {
3619                 spin_lock_irq(&dev->txq.lock);
3620                 /* don't autosuspend while transmitting */
3621                 if ((skb_queue_len(&dev->txq) ||
3622                      skb_queue_len(&dev->txq_pend)) &&
3623                         PMSG_IS_AUTO(message)) {
3624                         spin_unlock_irq(&dev->txq.lock);
3625                         ret = -EBUSY;
3626                         goto out;
3627                 } else {
3628                         set_bit(EVENT_DEV_ASLEEP, &dev->flags);
3629                         spin_unlock_irq(&dev->txq.lock);
3630                 }
3631
3632                 /* stop TX & RX */
3633                 ret = lan78xx_read_reg(dev, MAC_TX, &buf);
3634                 buf &= ~MAC_TX_TXEN_;
3635                 ret = lan78xx_write_reg(dev, MAC_TX, buf);
3636                 ret = lan78xx_read_reg(dev, MAC_RX, &buf);
3637                 buf &= ~MAC_RX_RXEN_;
3638                 ret = lan78xx_write_reg(dev, MAC_RX, buf);
3639
3640                 /* empty out the rx and queues */
3641                 netif_device_detach(dev->net);
3642                 lan78xx_terminate_urbs(dev);
3643                 usb_kill_urb(dev->urb_intr);
3644
3645                 /* reattach */
3646                 netif_device_attach(dev->net);
3647         }
3648
3649         if (test_bit(EVENT_DEV_ASLEEP, &dev->flags)) {
3650                 del_timer(&dev->stat_monitor);
3651
3652                 if (PMSG_IS_AUTO(message)) {
3653                         /* auto suspend (selective suspend) */
3654                         ret = lan78xx_read_reg(dev, MAC_TX, &buf);
3655                         buf &= ~MAC_TX_TXEN_;
3656                         ret = lan78xx_write_reg(dev, MAC_TX, buf);
3657                         ret = lan78xx_read_reg(dev, MAC_RX, &buf);
3658                         buf &= ~MAC_RX_RXEN_;
3659                         ret = lan78xx_write_reg(dev, MAC_RX, buf);
3660
3661                         ret = lan78xx_write_reg(dev, WUCSR, 0);
3662                         ret = lan78xx_write_reg(dev, WUCSR2, 0);
3663                         ret = lan78xx_write_reg(dev, WK_SRC, 0xFFF1FF1FUL);
3664
3665                         /* set goodframe wakeup */
3666                         ret = lan78xx_read_reg(dev, WUCSR, &buf);
3667
3668                         buf |= WUCSR_RFE_WAKE_EN_;
3669                         buf |= WUCSR_STORE_WAKE_;
3670
3671                         ret = lan78xx_write_reg(dev, WUCSR, buf);
3672
3673                         ret = lan78xx_read_reg(dev, PMT_CTL, &buf);
3674
3675                         buf &= ~PMT_CTL_RES_CLR_WKP_EN_;
3676                         buf |= PMT_CTL_RES_CLR_WKP_STS_;
3677
3678                         buf |= PMT_CTL_PHY_WAKE_EN_;
3679                         buf |= PMT_CTL_WOL_EN_;
3680                         buf &= ~PMT_CTL_SUS_MODE_MASK_;
3681                         buf |= PMT_CTL_SUS_MODE_3_;
3682
3683                         ret = lan78xx_write_reg(dev, PMT_CTL, buf);
3684
3685                         ret = lan78xx_read_reg(dev, PMT_CTL, &buf);
3686
3687                         buf |= PMT_CTL_WUPS_MASK_;
3688
3689                         ret = lan78xx_write_reg(dev, PMT_CTL, buf);
3690
3691                         ret = lan78xx_read_reg(dev, MAC_RX, &buf);
3692                         buf |= MAC_RX_RXEN_;
3693                         ret = lan78xx_write_reg(dev, MAC_RX, buf);
3694                 } else {
3695                         lan78xx_set_suspend(dev, pdata->wol);
3696                 }
3697         }
3698
3699         ret = 0;
3700 out:
3701         return ret;
3702 }
3703
3704 static int lan78xx_resume(struct usb_interface *intf)
3705 {
3706         struct lan78xx_net *dev = usb_get_intfdata(intf);
3707         struct sk_buff *skb;
3708         struct urb *res;
3709         int ret;
3710         u32 buf;
3711
3712         if (!timer_pending(&dev->stat_monitor)) {
3713                 dev->delta = 1;
3714                 mod_timer(&dev->stat_monitor,
3715                           jiffies + STAT_UPDATE_TIMER);
3716         }
3717
3718         if (!--dev->suspend_count) {
3719                 /* resume interrupt URBs */
3720                 if (dev->urb_intr && test_bit(EVENT_DEV_OPEN, &dev->flags))
3721                                 usb_submit_urb(dev->urb_intr, GFP_NOIO);
3722
3723                 spin_lock_irq(&dev->txq.lock);
3724                 while ((res = usb_get_from_anchor(&dev->deferred))) {
3725                         skb = (struct sk_buff *)res->context;
3726                         ret = usb_submit_urb(res, GFP_ATOMIC);
3727                         if (ret < 0) {
3728                                 dev_kfree_skb_any(skb);
3729                                 usb_free_urb(res);
3730                                 usb_autopm_put_interface_async(dev->intf);
3731                         } else {
3732                                 netif_trans_update(dev->net);
3733                                 lan78xx_queue_skb(&dev->txq, skb, tx_start);
3734                         }
3735                 }
3736
3737                 clear_bit(EVENT_DEV_ASLEEP, &dev->flags);
3738                 spin_unlock_irq(&dev->txq.lock);
3739
3740                 if (test_bit(EVENT_DEV_OPEN, &dev->flags)) {
3741                         if (!(skb_queue_len(&dev->txq) >= dev->tx_qlen))
3742                                 netif_start_queue(dev->net);
3743                         tasklet_schedule(&dev->bh);
3744                 }
3745         }
3746
3747         ret = lan78xx_write_reg(dev, WUCSR2, 0);
3748         ret = lan78xx_write_reg(dev, WUCSR, 0);
3749         ret = lan78xx_write_reg(dev, WK_SRC, 0xFFF1FF1FUL);
3750
3751         ret = lan78xx_write_reg(dev, WUCSR2, WUCSR2_NS_RCD_ |
3752                                              WUCSR2_ARP_RCD_ |
3753                                              WUCSR2_IPV6_TCPSYN_RCD_ |
3754                                              WUCSR2_IPV4_TCPSYN_RCD_);
3755
3756         ret = lan78xx_write_reg(dev, WUCSR, WUCSR_EEE_TX_WAKE_ |
3757                                             WUCSR_EEE_RX_WAKE_ |
3758                                             WUCSR_PFDA_FR_ |
3759                                             WUCSR_RFE_WAKE_FR_ |
3760                                             WUCSR_WUFR_ |
3761                                             WUCSR_MPR_ |
3762                                             WUCSR_BCST_FR_);
3763
3764         ret = lan78xx_read_reg(dev, MAC_TX, &buf);
3765         buf |= MAC_TX_TXEN_;
3766         ret = lan78xx_write_reg(dev, MAC_TX, buf);
3767
3768         return 0;
3769 }
3770
3771 static int lan78xx_reset_resume(struct usb_interface *intf)
3772 {
3773         struct lan78xx_net *dev = usb_get_intfdata(intf);
3774
3775         lan78xx_reset(dev);
3776
3777         lan78xx_phy_init(dev);
3778
3779         return lan78xx_resume(intf);
3780 }
3781
3782 static const struct usb_device_id products[] = {
3783         {
3784         /* LAN7800 USB Gigabit Ethernet Device */
3785         USB_DEVICE(LAN78XX_USB_VENDOR_ID, LAN7800_USB_PRODUCT_ID),
3786         },
3787         {
3788         /* LAN7850 USB Gigabit Ethernet Device */
3789         USB_DEVICE(LAN78XX_USB_VENDOR_ID, LAN7850_USB_PRODUCT_ID),
3790         },
3791         {},
3792 };
3793 MODULE_DEVICE_TABLE(usb, products);
3794
3795 static struct usb_driver lan78xx_driver = {
3796         .name                   = DRIVER_NAME,
3797         .id_table               = products,
3798         .probe                  = lan78xx_probe,
3799         .disconnect             = lan78xx_disconnect,
3800         .suspend                = lan78xx_suspend,
3801         .resume                 = lan78xx_resume,
3802         .reset_resume           = lan78xx_reset_resume,
3803         .supports_autosuspend   = 1,
3804         .disable_hub_initiated_lpm = 1,
3805 };
3806
3807 module_usb_driver(lan78xx_driver);
3808
3809 MODULE_AUTHOR(DRIVER_AUTHOR);
3810 MODULE_DESCRIPTION(DRIVER_DESC);
3811 MODULE_LICENSE("GPL");