drivers: net: usb: Import Google's Realtek RTL8152/RTL8153 changes
authordeadman96385 <seanhoyt963@gmail.com>
Thu, 22 Jul 2021 00:31:04 +0000 (19:31 -0500)
committerChristian Hoffmann <chrmhoffmann@gmail.com>
Sun, 12 Feb 2023 08:13:14 +0000 (09:13 +0100)
Change-Id: I310354ab560e53b1d93bb9414423f51eabfb6b52

drivers/net/usb/r8152.c

index 6e74965d26a0a34fd68597b137f91f6e24ec6ca2..d083bd6b42bd792e66611af723140b8e56478528 100644 (file)
@@ -29,7 +29,7 @@
 #include <linux/acpi.h>
 
 /* Information for net-next */
-#define NETNEXT_VERSION                "08"
+#define NETNEXT_VERSION                "09"
 
 /* Information for net */
 #define NET_VERSION            "9"
 #define PLA_FMC                        0xc0b4
 #define PLA_CFG_WOL            0xc0b6
 #define PLA_TEREDO_CFG         0xc0bc
+#define PLA_TEREDO_WAKE_BASE   0xc0c4
 #define PLA_MAR                        0xcd00
 #define PLA_BACKUP             0xd000
 #define PAL_BDC_CR             0xd1a0
 #define PLA_TEREDO_TIMER       0xd2cc
 #define PLA_REALWOW_TIMER      0xd2e8
+#define PLA_EFUSE_DATA         0xdd00
+#define PLA_EFUSE_CMD          0xdd02
 #define PLA_LEDSEL             0xdd90
 #define PLA_LED_FEATURE                0xdd92
 #define PLA_PHYAR              0xde00
 #define USB_CSR_DUMMY2         0xb466
 #define USB_DEV_STAT           0xb808
 #define USB_CONNECT_TIMER      0xcbf8
+#define USB_MSC_TIMER          0xcbfc
 #define USB_BURST_SIZE         0xcfc0
+#define USB_LPM_CONFIG         0xcfd8
 #define USB_USB_CTRL           0xd406
 #define USB_PHY_CTRL           0xd408
 #define USB_TX_AGG             0xd40a
 #define USB_USB_TIMER          0xd428
 #define USB_RX_EARLY_TIMEOUT   0xd42c
 #define USB_RX_EARLY_SIZE      0xd42e
-#define USB_PM_CTRL_STATUS     0xd432
+#define USB_PM_CTRL_STATUS     0xd432  /* RTL8153A */
+#define USB_RX_EXTRA_AGGR_TMR  0xd432  /* RTL8153B */
 #define USB_TX_DMA             0xd434
+#define USB_UPT_RXDMA_OWN      0xd437
 #define USB_TOLERANCE          0xd490
 #define USB_LPM_CTRL           0xd41a
 #define USB_BMU_RESET          0xd4b0
+#define USB_U1U2_TIMER         0xd4da
 #define USB_UPS_CTRL           0xd800
-#define USB_MISC_0             0xd81a
 #define USB_POWER_CUT          0xd80a
+#define USB_MISC_0             0xd81a
 #define USB_AFE_CTRL2          0xd824
+#define USB_UPS_CFG            0xd842
+#define USB_UPS_FLAGS          0xd848
 #define USB_WDT11_CTRL         0xe43c
 #define USB_BP_BA              0xfc26
 #define USB_BP_0               0xfc28
 #define USB_BP_6               0xfc34
 #define USB_BP_7               0xfc36
 #define USB_BP_EN              0xfc38
+#define USB_BP_8               0xfc38
+#define USB_BP_9               0xfc3a
+#define USB_BP_10              0xfc3c
+#define USB_BP_11              0xfc3e
+#define USB_BP_12              0xfc40
+#define USB_BP_13              0xfc42
+#define USB_BP_14              0xfc44
+#define USB_BP_15              0xfc46
+#define USB_BP2_EN             0xfc48
 
 /* OCP Registers */
 #define OCP_ALDPS_CONFIG       0x2010
 #define OCP_EEE_AR             0xa41a
 #define OCP_EEE_DATA           0xa41c
 #define OCP_PHY_STATUS         0xa420
+#define OCP_NCTL_CFG           0xa42c
 #define OCP_POWER_CFG          0xa430
 #define OCP_EEE_CFG            0xa432
 #define OCP_SRAM_ADDR          0xa436
 #define OCP_EEE_ADV            0xa5d0
 #define OCP_EEE_LPABLE         0xa5d2
 #define OCP_PHY_STATE          0xa708          /* nway state for 8153 */
+#define OCP_PHY_PATCH_STAT     0xb800
+#define OCP_PHY_PATCH_CMD      0xb820
+#define OCP_ADC_IOFFSET                0xbcfc
 #define OCP_ADC_CFG            0xbc06
+#define OCP_SYSCLK_CFG         0xc416
 
 /* SRAM Register */
+#define SRAM_GREEN_CFG         0x8011
 #define SRAM_LPF_CFG           0x8012
 #define SRAM_10M_AMP1          0x8080
 #define SRAM_10M_AMP2          0x8082
 /* PAL_BDC_CR */
 #define ALDPS_PROXY_MODE       0x0001
 
+/* PLA_EFUSE_CMD */
+#define EFUSE_READ_CMD         BIT(15)
+#define EFUSE_DATA_BIT16       BIT(7)
+
 /* PLA_CONFIG34 */
 #define LINK_ON_WAKE_EN                0x0010
 #define LINK_OFF_WAKE_EN       0x0008
 
 /* PLA_MAC_PWR_CTRL2 */
 #define EEE_SPDWN_RATIO                0x8007
+#define MAC_CLK_SPDWN_EN       BIT(15)
 
 /* PLA_MAC_PWR_CTRL3 */
 #define PKT_AVAIL_SPDWN_EN     0x0100
 #define STAT_SPEED_HIGH                0x0000
 #define STAT_SPEED_FULL                0x0002
 
+/* USB_LPM_CONFIG */
+#define LPM_U1U2_EN            BIT(0)
+
 /* USB_TX_AGG */
 #define TX_AGG_MAX_THRESHOLD   0x03
 
 #define RX_THR_SUPPER          0x0c350180
 #define RX_THR_HIGH            0x7a120180
 #define RX_THR_SLOW            0xffff0180
+#define RX_THR_B               0x00010001
 
 /* USB_TX_DMA */
 #define TEST_MODE_DISABLE      0x00000001
 #define BMU_RESET_EP_IN                0x01
 #define BMU_RESET_EP_OUT       0x02
 
+/* USB_UPT_RXDMA_OWN */
+#define OWN_UPDATE             BIT(0)
+#define OWN_CLEAR              BIT(1)
+
 /* USB_UPS_CTRL */
 #define POWER_CUT              0x0100
 
 /* USB_POWER_CUT */
 #define PWR_EN                 0x0001
 #define PHASE2_EN              0x0008
+#define UPS_EN                 BIT(4)
+#define USP_PREWAKE            BIT(5)
 
 /* USB_MISC_0 */
 #define PCUT_STATUS            0x0001
 #define SEN_VAL_NORMAL         0xa000
 #define SEL_RXIDLE             0x0100
 
+/* USB_UPS_CFG */
+#define SAW_CNT_1MS_MASK       0x0fff
+
+/* USB_UPS_FLAGS */
+#define UPS_FLAGS_R_TUNE               BIT(0)
+#define UPS_FLAGS_EN_10M_CKDIV         BIT(1)
+#define UPS_FLAGS_250M_CKDIV           BIT(2)
+#define UPS_FLAGS_EN_ALDPS             BIT(3)
+#define UPS_FLAGS_CTAP_SHORT_DIS       BIT(4)
+#define UPS_FLAGS_SPEED_MASK           (0xf << 16)
+#define ups_flags_speed(x)             ((x) << 16)
+#define UPS_FLAGS_EN_EEE               BIT(20)
+#define UPS_FLAGS_EN_500M_EEE          BIT(21)
+#define UPS_FLAGS_EN_EEE_CKDIV         BIT(22)
+#define UPS_FLAGS_EEE_PLLOFF_GIGA      BIT(24)
+#define UPS_FLAGS_EEE_CMOD_LV_EN       BIT(25)
+#define UPS_FLAGS_EN_GREEN             BIT(26)
+#define UPS_FLAGS_EN_FLOW_CTR          BIT(27)
+
+enum spd_duplex {
+       NWAY_10M_HALF = 1,
+       NWAY_10M_FULL,
+       NWAY_100M_HALF,
+       NWAY_100M_FULL,
+       NWAY_1000M_FULL,
+       FORCE_10M_HALF,
+       FORCE_10M_FULL,
+       FORCE_100M_HALF,
+       FORCE_100M_FULL,
+};
+
 /* OCP_ALDPS_CONFIG */
 #define ENPWRSAVE              0x8000
 #define ENPDNPS                        0x0200
 
 /* OCP_PHY_STATUS */
 #define PHY_STAT_MASK          0x0007
+#define PHY_STAT_EXT_INIT      2
 #define PHY_STAT_LAN_ON                3
 #define PHY_STAT_PWRDN         5
 
+/* OCP_NCTL_CFG */
+#define PGA_RETURN_EN          BIT(1)
+
 /* OCP_POWER_CFG */
 #define EEE_CLKDIV_EN          0x8000
 #define EN_ALDPS               0x0004
 #define EEE10_EN               0x0010
 
 /* OCP_DOWN_SPEED */
+#define EN_EEE_CMODE           BIT(14)
+#define EN_EEE_1000            BIT(13)
+#define EN_EEE_100             BIT(12)
+#define EN_10M_CLKDIV          BIT(11)
 #define EN_10M_BGOFF           0x0080
 
 /* OCP_PHY_STATE */
 #define TXDIS_STATE            0x01
 #define ABD_STATE              0x02
 
+/* OCP_PHY_PATCH_STAT */
+#define PATCH_READY            BIT(6)
+
+/* OCP_PHY_PATCH_CMD */
+#define PATCH_REQUEST          BIT(4)
+
 /* OCP_ADC_CFG */
 #define CKADSEL_L              0x0100
 #define ADC_EN                 0x0080
 #define EN_EMI_L               0x0040
 
+/* OCP_SYSCLK_CFG */
+#define clk_div_expo(x)                (min(x, 5) << 8)
+
+/* SRAM_GREEN_CFG */
+#define GREEN_ETH_EN           BIT(15)
+#define R_TUNE_EN              BIT(11)
+
 /* SRAM_LPF_CFG */
 #define LPF_AUTO_TUNE          0x8000
 
@@ -477,7 +569,6 @@ enum rtl_register_content {
 #define RTL8152_MAX_TX         4
 #define RTL8152_MAX_RX         10
 #define INTBUFSIZE             2
-#define CRC_SIZE               4
 #define TX_ALIGN               4
 #define RX_ALIGN               8
 
@@ -496,12 +587,13 @@ enum rtl_register_content {
 #define BYTE_EN_END_MASK       0xf0
 
 #define RTL8153_MAX_PACKET     9216 /* 9K */
-#define RTL8153_MAX_MTU                (RTL8153_MAX_PACKET - VLAN_ETH_HLEN - VLAN_HLEN)
-#define RTL8152_RMS            (VLAN_ETH_FRAME_LEN + VLAN_HLEN)
+#define RTL8153_MAX_MTU                (RTL8153_MAX_PACKET - VLAN_ETH_HLEN - \
+                                ETH_FCS_LEN)
+#define RTL8152_RMS            (VLAN_ETH_FRAME_LEN + ETH_FCS_LEN)
 #define RTL8153_RMS            RTL8153_MAX_PACKET
 #define RTL8152_TX_TIMEOUT     (5 * HZ)
 #define RTL8152_NAPI_WEIGHT    64
-#define rx_reserved_size(x)    ((x) + VLAN_ETH_HLEN + CRC_SIZE + \
+#define rx_reserved_size(x)    ((x) + VLAN_ETH_HLEN + ETH_FCS_LEN + \
                                 sizeof(struct rx_desc) + RX_ALIGN)
 
 /* rtl8152 flags */
@@ -513,14 +605,18 @@ enum rtl8152_flags {
        SELECTIVE_SUSPEND,
        PHY_RESET,
        SCHEDULE_NAPI,
+       GREEN_ETHERNET,
+       DELL_TB_RX_AGG_BUG,
 };
 
 /* Define these values to match your device */
 #define VENDOR_ID_REALTEK              0x0bda
+#define VENDOR_ID_MICROSOFT            0x045e
 #define VENDOR_ID_SAMSUNG              0x04e8
 #define VENDOR_ID_LENOVO               0x17ef
 #define VENDOR_ID_LINKSYS              0x13b1
 #define VENDOR_ID_NVIDIA               0x0955
+#define VENDOR_ID_TPLINK               0x2357
 
 #define MCU_TYPE_PLA                   0x0100
 #define MCU_TYPE_USB                   0x0000
@@ -658,6 +754,9 @@ enum rtl_version {
        RTL_VER_04,
        RTL_VER_05,
        RTL_VER_06,
+       RTL_VER_07,
+       RTL_VER_08,
+       RTL_VER_09,
        RTL_VER_MAX
 };
 
@@ -674,7 +773,7 @@ static const int multicast_filter_limit = 32;
 static unsigned int agg_buf_sz = 16384;
 
 #define RTL_LIMITED_TSO_SIZE   (agg_buf_sz - sizeof(struct tx_desc) - \
-                                VLAN_ETH_HLEN - VLAN_HLEN)
+                                VLAN_ETH_HLEN - ETH_FCS_LEN)
 
 static
 int get_registers(struct r8152 *tp, u16 value, u16 index, u16 size, void *data)
@@ -875,11 +974,13 @@ static u16 ocp_read_word(struct r8152 *tp, u16 type, u16 index)
 {
        u32 data;
        __le32 tmp;
+       u16 byen = BYTE_EN_WORD;
        u8 shift = index & 2;
 
        index &= ~3;
+       byen <<= shift;
 
-       generic_ocp_read(tp, index, sizeof(tmp), &tmp, type);
+       generic_ocp_read(tp, index, sizeof(tmp), &tmp, type | byen);
 
        data = __le32_to_cpu(tmp);
        data >>= (shift * 8);
@@ -991,6 +1092,12 @@ static void sram_write(struct r8152 *tp, u16 addr, u16 data)
        ocp_reg_write(tp, OCP_SRAM_DATA, data);
 }
 
+static u16 sram_read(struct r8152 *tp, u16 addr)
+{
+       ocp_reg_write(tp, OCP_SRAM_ADDR, addr);
+       return ocp_reg_read(tp, OCP_SRAM_DATA);
+}
+
 static int read_mii_word(struct net_device *netdev, int phy_id, int reg)
 {
        struct r8152 *tp = netdev_priv(netdev);
@@ -1154,6 +1261,7 @@ static void read_bulk_callback(struct urb *urb)
        int status = urb->status;
        struct rx_agg *agg;
        struct r8152 *tp;
+       unsigned long flags;
 
        agg = urb->context;
        if (!agg)
@@ -1183,9 +1291,9 @@ static void read_bulk_callback(struct urb *urb)
                if (urb->actual_length < ETH_ZLEN)
                        break;
 
-               spin_lock(&tp->rx_lock);
+               spin_lock_irqsave(&tp->rx_lock, flags);
                list_add_tail(&agg->list, &tp->rx_done);
-               spin_unlock(&tp->rx_lock);
+               spin_unlock_irqrestore(&tp->rx_lock, flags);
                napi_schedule(&tp->napi);
                return;
        case -ESHUTDOWN:
@@ -1213,6 +1321,7 @@ static void write_bulk_callback(struct urb *urb)
        struct net_device *netdev;
        struct tx_agg *agg;
        struct r8152 *tp;
+       unsigned long flags;
        int status = urb->status;
 
        agg = urb->context;
@@ -1234,9 +1343,9 @@ static void write_bulk_callback(struct urb *urb)
                stats->tx_bytes += agg->skb_len;
        }
 
-       spin_lock(&tp->tx_lock);
+       spin_lock_irqsave(&tp->tx_lock, flags);
        list_add_tail(&agg->list, &tp->tx_free);
-       spin_unlock(&tp->tx_lock);
+       spin_unlock_irqrestore(&tp->tx_lock, flags);
 
        usb_autopm_put_interface_async(tp->intf);
 
@@ -1276,6 +1385,7 @@ static void intr_callback(struct urb *urb)
        case -ECONNRESET:       /* unlink */
        case -ESHUTDOWN:
                netif_device_detach(tp->netdev);
+               /* fall through */
        case -ENOENT:
        case -EPROTO:
                netif_info(tp, intr, tp->netdev,
@@ -1701,6 +1811,9 @@ static int r8152_tx_agg_fill(struct r8152 *tp, struct tx_agg *agg)
                dev_kfree_skb_any(skb);
 
                remain = agg_buf_sz - (int)(tx_agg_align(tx_data) - agg->head);
+
+               if (test_bit(DELL_TB_RX_AGG_BUG, &tp->flags))
+                       break;
        }
 
        if (!skb_queue_empty(&skb_head)) {
@@ -1747,11 +1860,9 @@ static u8 r8152_rx_csum(struct r8152 *tp, struct rx_desc *rx_desc)
        if (opts2 & RD_IPV4_CS) {
                if (opts3 & IPF)
                        checksum = CHECKSUM_NONE;
-               else if ((opts2 & RD_UDP_CS) && (opts3 & UDPF))
-                       checksum = CHECKSUM_NONE;
-               else if ((opts2 & RD_TCP_CS) && (opts3 & TCPF))
-                       checksum = CHECKSUM_NONE;
-               else
+               else if ((opts2 & RD_UDP_CS) && !(opts3 & UDPF))
+                       checksum = CHECKSUM_UNNECESSARY;
+               else if ((opts2 & RD_TCP_CS) && !(opts3 & TCPF))
                        checksum = CHECKSUM_UNNECESSARY;
        } else if (opts2 & RD_IPV6_CS) {
                if ((opts2 & RD_UDP_CS) && !(opts3 & UDPF))
@@ -1769,6 +1880,7 @@ static int rx_bottom(struct r8152 *tp, int budget)
        unsigned long flags;
        struct list_head *cursor, *next, rx_queue;
        int ret = 0, work_done = 0;
+       struct napi_struct *napi = &tp->napi;
 
        if (!skb_queue_empty(&tp->rx_queue)) {
                while (work_done < budget) {
@@ -1781,7 +1893,7 @@ static int rx_bottom(struct r8152 *tp, int budget)
                                break;
 
                        pkt_len = skb->len;
-                       napi_gro_receive(&tp->napi, skb);
+                       napi_gro_receive(napi, skb);
                        work_done++;
                        stats->rx_packets++;
                        stats->rx_bytes += pkt_len;
@@ -1820,6 +1932,10 @@ static int rx_bottom(struct r8152 *tp, int budget)
                        unsigned int pkt_len;
                        struct sk_buff *skb;
 
+                       /* limite the skb numbers for rx_queue */
+                       if (unlikely(skb_queue_len(&tp->rx_queue) >= 1000))
+                               break;
+
                        pkt_len = le32_to_cpu(rx_desc->opts1) & RX_LEN_MASK;
                        if (pkt_len < ETH_ZLEN)
                                break;
@@ -1828,10 +1944,10 @@ static int rx_bottom(struct r8152 *tp, int budget)
                        if (urb->actual_length < len_used)
                                break;
 
-                       pkt_len -= CRC_SIZE;
+                       pkt_len -= ETH_FCS_LEN;
                        rx_data += sizeof(struct rx_desc);
 
-                       skb = napi_alloc_skb(&tp->napi, pkt_len);
+                       skb = napi_alloc_skb(napi, pkt_len);
                        if (!skb) {
                                stats->rx_dropped++;
                                goto find_next_rx;
@@ -1843,7 +1959,7 @@ static int rx_bottom(struct r8152 *tp, int budget)
                        skb->protocol = eth_type_trans(skb, netdev);
                        rtl_rx_vlan_tag(rx_desc, skb);
                        if (work_done < budget) {
-                               napi_gro_receive(&tp->napi, skb);
+                               napi_gro_receive(napi, skb);
                                work_done++;
                                stats->rx_packets++;
                                stats->rx_bytes += pkt_len;
@@ -1852,7 +1968,7 @@ static int rx_bottom(struct r8152 *tp, int budget)
                        }
 
 find_next_rx:
-                       rx_data = rx_agg_align(rx_data + pkt_len + CRC_SIZE);
+                       rx_data = rx_agg_align(rx_data + pkt_len + ETH_FCS_LEN);
                        rx_desc = (struct rx_desc *)rx_data;
                        len_used = (int)(rx_data - (u8 *)agg->head);
                        len_used += sizeof(struct rx_desc);
@@ -1941,6 +2057,8 @@ static int r8152_poll(struct napi_struct *napi, int budget)
        bottom_half(tp);
 
        if (work_done < budget) {
+               //if (!napi_complete_done(napi, work_done))
+                       //goto out;
                napi_complete(napi);
                if (!list_empty(&tp->rx_done))
                        napi_schedule(napi);
@@ -1949,6 +2067,7 @@ static int r8152_poll(struct napi_struct *napi, int budget)
                        napi_schedule(napi);
        }
 
+//out:
        return work_done;
 }
 
@@ -2140,7 +2259,7 @@ static void set_tx_qlen(struct r8152 *tp)
 {
        struct net_device *netdev = tp->netdev;
 
-       tp->tx_qlen = agg_buf_sz / (netdev->mtu + VLAN_ETH_HLEN + VLAN_HLEN +
+       tp->tx_qlen = agg_buf_sz / (netdev->mtu + VLAN_ETH_HLEN + ETH_FCS_LEN +
                                    sizeof(struct tx_desc));
 }
 
@@ -2251,18 +2370,64 @@ static int rtl8152_enable(struct r8152 *tp)
        return rtl_enable(tp);
 }
 
+static inline void r8153b_rx_agg_chg_indicate(struct r8152 *tp)
+{
+       ocp_write_byte(tp, MCU_TYPE_USB, USB_UPT_RXDMA_OWN,
+                      OWN_UPDATE | OWN_CLEAR);
+}
+
 static void r8153_set_rx_early_timeout(struct r8152 *tp)
 {
        u32 ocp_data = tp->coalesce / 8;
 
-       ocp_write_word(tp, MCU_TYPE_USB, USB_RX_EARLY_TIMEOUT, ocp_data);
+       switch (tp->version) {
+       case RTL_VER_03:
+       case RTL_VER_04:
+       case RTL_VER_05:
+       case RTL_VER_06:
+               ocp_write_word(tp, MCU_TYPE_USB, USB_RX_EARLY_TIMEOUT,
+                              ocp_data);
+               break;
+
+       case RTL_VER_08:
+       case RTL_VER_09:
+               /* The RTL8153B uses USB_RX_EXTRA_AGGR_TMR for rx timeout
+                * primarily. For USB_RX_EARLY_TIMEOUT, we fix it to 128ns.
+                */
+               ocp_write_word(tp, MCU_TYPE_USB, USB_RX_EARLY_TIMEOUT,
+                              128 / 8);
+               ocp_write_word(tp, MCU_TYPE_USB, USB_RX_EXTRA_AGGR_TMR,
+                              ocp_data);
+               r8153b_rx_agg_chg_indicate(tp);
+               break;
+
+       default:
+               break;
+       }
 }
 
 static void r8153_set_rx_early_size(struct r8152 *tp)
 {
-       u32 ocp_data = (agg_buf_sz - rx_reserved_size(tp->netdev->mtu)) / 4;
+       u32 ocp_data = agg_buf_sz - rx_reserved_size(tp->netdev->mtu);
 
-       ocp_write_word(tp, MCU_TYPE_USB, USB_RX_EARLY_SIZE, ocp_data);
+       switch (tp->version) {
+       case RTL_VER_03:
+       case RTL_VER_04:
+       case RTL_VER_05:
+       case RTL_VER_06:
+               ocp_write_word(tp, MCU_TYPE_USB, USB_RX_EARLY_SIZE,
+                              ocp_data / 4);
+               break;
+       case RTL_VER_08:
+       case RTL_VER_09:
+               ocp_write_word(tp, MCU_TYPE_USB, USB_RX_EARLY_SIZE,
+                              ocp_data / 8);
+               r8153b_rx_agg_chg_indicate(tp);
+               break;
+       default:
+               WARN_ON_ONCE(1);
+               break;
+       }
 }
 
 static int rtl8153_enable(struct r8152 *tp)
@@ -2270,7 +2435,6 @@ static int rtl8153_enable(struct r8152 *tp)
        if (test_bit(RTL8152_UNPLUG, &tp->flags))
                return -ENODEV;
 
-       usb_disable_lpm(tp->udev);
        set_tx_qlen(tp);
        rtl_set_eee_plus(tp);
        r8153_set_rx_early_timeout(tp);
@@ -2436,6 +2600,29 @@ static void __rtl_set_wol(struct r8152 *tp, u32 wolopts)
                device_set_wakeup_enable(&tp->udev->dev, false);
 }
 
+static void r8153_mac_clk_spd(struct r8152 *tp, bool enable)
+{
+       /* MAC clock speed down */
+       if (enable) {
+               ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL,
+                              ALDPS_SPDWN_RATIO);
+               ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL2,
+                              EEE_SPDWN_RATIO);
+               ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL3,
+                              PKT_AVAIL_SPDWN_EN | SUSPEND_SPDWN_EN |
+                              U1U2_SPDWN_EN | L1_SPDWN_EN);
+               ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL4,
+                              PWRSAVE_SPDWN_EN | RXDV_SPDWN_EN | TX10MIDLE_EN |
+                              TP100_SPDWN_EN | TP500_SPDWN_EN | EEE_SPDWN_EN |
+                              TP1000_SPDWN_EN);
+       } else {
+               ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL, 0);
+               ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL2, 0);
+               ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL3, 0);
+               ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL4, 0);
+       }
+}
+
 static void r8153_u1u2en(struct r8152 *tp, bool enable)
 {
        u8 u1u2[8];
@@ -2448,18 +2635,134 @@ static void r8153_u1u2en(struct r8152 *tp, bool enable)
        usb_ocp_write(tp, USB_TOLERANCE, BYTE_EN_SIX_BYTES, sizeof(u1u2), u1u2);
 }
 
+static void r8153b_u1u2en(struct r8152 *tp, bool enable)
+{
+       u32 ocp_data;
+
+       ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_LPM_CONFIG);
+       if (enable)
+               ocp_data |= LPM_U1U2_EN;
+       else
+               ocp_data &= ~LPM_U1U2_EN;
+
+       ocp_write_word(tp, MCU_TYPE_USB, USB_LPM_CONFIG, ocp_data);
+}
+
 static void r8153_u2p3en(struct r8152 *tp, bool enable)
 {
        u32 ocp_data;
 
        ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_U2P3_CTRL);
-       if (enable && tp->version != RTL_VER_03 && tp->version != RTL_VER_04)
+       if (enable)
                ocp_data |= U2P3_ENABLE;
        else
                ocp_data &= ~U2P3_ENABLE;
        ocp_write_word(tp, MCU_TYPE_USB, USB_U2P3_CTRL, ocp_data);
 }
 
+static void r8153b_ups_flags_w1w0(struct r8152 *tp, u32 set, u32 clear)
+{
+       u32 ocp_data;
+
+       ocp_data = ocp_read_dword(tp, MCU_TYPE_USB, USB_UPS_FLAGS);
+       ocp_data &= ~clear;
+       ocp_data |= set;
+       ocp_write_dword(tp, MCU_TYPE_USB, USB_UPS_FLAGS, ocp_data);
+}
+
+static void r8153b_green_en(struct r8152 *tp, bool enable)
+{
+       u16 data;
+
+       if (enable) {
+               sram_write(tp, 0x8045, 0);      /* 10M abiq&ldvbias */
+               sram_write(tp, 0x804d, 0x1222); /* 100M short abiq&ldvbias */
+               sram_write(tp, 0x805d, 0x0022); /* 1000M short abiq&ldvbias */
+       } else {
+               sram_write(tp, 0x8045, 0x2444); /* 10M abiq&ldvbias */
+               sram_write(tp, 0x804d, 0x2444); /* 100M short abiq&ldvbias */
+               sram_write(tp, 0x805d, 0x2444); /* 1000M short abiq&ldvbias */
+       }
+
+       data = sram_read(tp, SRAM_GREEN_CFG);
+       data |= GREEN_ETH_EN;
+       sram_write(tp, SRAM_GREEN_CFG, data);
+
+       r8153b_ups_flags_w1w0(tp, UPS_FLAGS_EN_GREEN, 0);
+}
+
+static u16 r8153_phy_status(struct r8152 *tp, u16 desired)
+{
+       u16 data;
+       int i;
+
+       for (i = 0; i < 500; i++) {
+               data = ocp_reg_read(tp, OCP_PHY_STATUS);
+               data &= PHY_STAT_MASK;
+               if (desired) {
+                       if (data == desired)
+                               break;
+               } else if (data == PHY_STAT_LAN_ON || data == PHY_STAT_PWRDN ||
+                          data == PHY_STAT_EXT_INIT) {
+                       break;
+               }
+
+               msleep(20);
+       }
+
+       return data;
+}
+
+static void r8153b_ups_en(struct r8152 *tp, bool enable)
+{
+       u32 ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_POWER_CUT);
+
+       if (enable) {
+               ocp_data |= UPS_EN | USP_PREWAKE | PHASE2_EN;
+               ocp_write_byte(tp, MCU_TYPE_USB, USB_POWER_CUT, ocp_data);
+
+               ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, 0xcfff);
+               ocp_data |= BIT(0);
+               ocp_write_byte(tp, MCU_TYPE_USB, 0xcfff, ocp_data);
+       } else {
+               u16 data;
+
+               ocp_data &= ~(UPS_EN | USP_PREWAKE);
+               ocp_write_byte(tp, MCU_TYPE_USB, USB_POWER_CUT, ocp_data);
+
+               ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, 0xcfff);
+               ocp_data &= ~BIT(0);
+               ocp_write_byte(tp, MCU_TYPE_USB, 0xcfff, ocp_data);
+
+               ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_MISC_0);
+               ocp_data &= ~PCUT_STATUS;
+               ocp_write_word(tp, MCU_TYPE_USB, USB_MISC_0, ocp_data);
+
+               data = r8153_phy_status(tp, 0);
+
+               switch (data) {
+               case PHY_STAT_PWRDN:
+               case PHY_STAT_EXT_INIT:
+                       r8153b_green_en(tp,
+                                       test_bit(GREEN_ETHERNET, &tp->flags));
+
+                       data = r8152_mdio_read(tp, MII_BMCR);
+                       data &= ~BMCR_PDOWN;
+                       data |= BMCR_RESET;
+                       r8152_mdio_write(tp, MII_BMCR, data);
+
+                       data = r8153_phy_status(tp, PHY_STAT_LAN_ON);
+                       /* fall through */
+
+               default:
+                       if (data != PHY_STAT_LAN_ON)
+                               netif_warn(tp, link, tp->netdev,
+                                          "PHY not ready");
+                       break;
+               }
+       }
+}
+
 static void r8153_power_cut_en(struct r8152 *tp, bool enable)
 {
        u32 ocp_data;
@@ -2476,6 +2779,38 @@ static void r8153_power_cut_en(struct r8152 *tp, bool enable)
        ocp_write_word(tp, MCU_TYPE_USB, USB_MISC_0, ocp_data);
 }
 
+static void r8153b_power_cut_en(struct r8152 *tp, bool enable)
+{
+       u32 ocp_data;
+
+       ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_POWER_CUT);
+       if (enable)
+               ocp_data |= PWR_EN | PHASE2_EN;
+       else
+               ocp_data &= ~PWR_EN;
+       ocp_write_word(tp, MCU_TYPE_USB, USB_POWER_CUT, ocp_data);
+
+       ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_MISC_0);
+       ocp_data &= ~PCUT_STATUS;
+       ocp_write_word(tp, MCU_TYPE_USB, USB_MISC_0, ocp_data);
+}
+
+static void r8153b_queue_wake(struct r8152 *tp, bool enable)
+{
+       u32 ocp_data;
+
+       ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, 0xd38a);
+       if (enable)
+               ocp_data |= BIT(0);
+       else
+               ocp_data &= ~BIT(0);
+       ocp_write_byte(tp, MCU_TYPE_PLA, 0xd38a, ocp_data);
+
+       ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, 0xd38c);
+       ocp_data &= ~BIT(0);
+       ocp_write_byte(tp, MCU_TYPE_PLA, 0xd38c, ocp_data);
+}
+
 static bool rtl_can_wakeup(struct r8152 *tp)
 {
        struct usb_device *udev = tp->udev;
@@ -2514,24 +2849,76 @@ static void rtl_runtime_suspend_enable(struct r8152 *tp, bool enable)
 
 static void rtl8153_runtime_enable(struct r8152 *tp, bool enable)
 {
-       rtl_runtime_suspend_enable(tp, enable);
-
        if (enable) {
                r8153_u1u2en(tp, false);
                r8153_u2p3en(tp, false);
+               r8153_mac_clk_spd(tp, true);
+               rtl_runtime_suspend_enable(tp, true);
        } else {
-               r8153_u2p3en(tp, true);
+               rtl_runtime_suspend_enable(tp, false);
+               r8153_mac_clk_spd(tp, false);
+
+               switch (tp->version) {
+               case RTL_VER_03:
+               case RTL_VER_04:
+                       break;
+               case RTL_VER_05:
+               case RTL_VER_06:
+               default:
+                       r8153_u2p3en(tp, true);
+                       break;
+               }
+
                r8153_u1u2en(tp, true);
        }
 }
 
+static void rtl8153b_runtime_enable(struct r8152 *tp, bool enable)
+{
+       if (enable) {
+               r8153b_queue_wake(tp, true);
+               r8153b_u1u2en(tp, false);
+               r8153_u2p3en(tp, false);
+               rtl_runtime_suspend_enable(tp, true);
+               r8153b_ups_en(tp, true);
+       } else {
+               r8153b_ups_en(tp, false);
+               r8153b_queue_wake(tp, false);
+               rtl_runtime_suspend_enable(tp, false);
+               r8153_u2p3en(tp, true);
+               r8153b_u1u2en(tp, true);
+       }
+}
+
 static void r8153_teredo_off(struct r8152 *tp)
 {
        u32 ocp_data;
 
-       ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_TEREDO_CFG);
-       ocp_data &= ~(TEREDO_SEL | TEREDO_RS_EVENT_MASK | OOB_TEREDO_EN);
-       ocp_write_word(tp, MCU_TYPE_PLA, PLA_TEREDO_CFG, ocp_data);
+       switch (tp->version) {
+       case RTL_VER_01:
+       case RTL_VER_02:
+       case RTL_VER_03:
+       case RTL_VER_04:
+       case RTL_VER_05:
+       case RTL_VER_06:
+       case RTL_VER_07:
+               ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_TEREDO_CFG);
+               ocp_data &= ~(TEREDO_SEL | TEREDO_RS_EVENT_MASK |
+                             OOB_TEREDO_EN);
+               ocp_write_word(tp, MCU_TYPE_PLA, PLA_TEREDO_CFG, ocp_data);
+               break;
+
+       case RTL_VER_08:
+       case RTL_VER_09:
+               /* The bit 0 ~ 7 are relative with teredo settings. They are
+                * W1C (write 1 to clear), so set all 1 to disable it.
+                */
+               ocp_write_byte(tp, MCU_TYPE_PLA, PLA_TEREDO_CFG, 0xff);
+               break;
+
+       default:
+               break;
+       }
 
        ocp_write_word(tp, MCU_TYPE_PLA, PLA_WDT6_CTRL, WDT6_SET_MODE);
        ocp_write_word(tp, MCU_TYPE_PLA, PLA_REALWOW_TIMER, 0);
@@ -2777,6 +3164,33 @@ static void r8152b_enter_oob(struct r8152 *tp)
        ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RCR, ocp_data);
 }
 
+static int r8153_patch_request(struct r8152 *tp, bool request)
+{
+       u16 data;
+       int i;
+
+       data = ocp_reg_read(tp, OCP_PHY_PATCH_CMD);
+       if (request)
+               data |= PATCH_REQUEST;
+       else
+               data &= ~PATCH_REQUEST;
+       ocp_reg_write(tp, OCP_PHY_PATCH_CMD, data);
+
+       for (i = 0; request && i < 5000; i++) {
+               usleep_range(1000, 2000);
+               if (ocp_reg_read(tp, OCP_PHY_PATCH_STAT) & PATCH_READY)
+                       break;
+       }
+
+       if (request && !(ocp_reg_read(tp, OCP_PHY_PATCH_STAT) & PATCH_READY)) {
+               netif_err(tp, drv, tp->netdev, "patch request fail\n");
+               r8153_patch_request(tp, false);
+               return -ETIME;
+       } else {
+               return 0;
+       }
+}
+
 static void r8153_aldps_en(struct r8152 *tp, bool enable)
 {
        u16 data;
@@ -2786,12 +3200,28 @@ static void r8153_aldps_en(struct r8152 *tp, bool enable)
                data |= EN_ALDPS;
                ocp_reg_write(tp, OCP_POWER_CFG, data);
        } else {
+               int i;
+
                data &= ~EN_ALDPS;
                ocp_reg_write(tp, OCP_POWER_CFG, data);
-               msleep(20);
+               for (i = 0; i < 20; i++) {
+                       usleep_range(1000, 2000);
+                       if (ocp_read_word(tp, MCU_TYPE_PLA, 0xe000) & 0x0100)
+                               break;
+               }
        }
 }
 
+static void r8153b_aldps_en(struct r8152 *tp, bool enable)
+{
+       r8153_aldps_en(tp, enable);
+
+       if (enable)
+               r8153b_ups_flags_w1w0(tp, UPS_FLAGS_EN_ALDPS, 0);
+       else
+               r8153b_ups_flags_w1w0(tp, 0, UPS_FLAGS_EN_ALDPS);
+}
+
 static void r8153_eee_en(struct r8152 *tp, bool enable)
 {
        u32 ocp_data;
@@ -2812,6 +3242,22 @@ static void r8153_eee_en(struct r8152 *tp, bool enable)
        ocp_reg_write(tp, OCP_EEE_CFG, config);
 }
 
+static void r8153b_eee_en(struct r8152 *tp, bool enable)
+{
+       r8153_eee_en(tp, enable);
+
+       if (enable)
+               r8153b_ups_flags_w1w0(tp, UPS_FLAGS_EN_EEE, 0);
+       else
+               r8153b_ups_flags_w1w0(tp, 0, UPS_FLAGS_EN_EEE);
+}
+
+static void r8153b_enable_fc(struct r8152 *tp)
+{
+       r8152b_enable_fc(tp);
+       r8153b_ups_flags_w1w0(tp, UPS_FLAGS_EN_FLOW_CTR, 0);
+}
+
 static void r8153_hw_phy_cfg(struct r8152 *tp)
 {
        u32 ocp_data;
@@ -2859,45 +3305,151 @@ static void r8153_hw_phy_cfg(struct r8152 *tp)
        r8153_aldps_en(tp, true);
        r8152b_enable_fc(tp);
 
+       switch (tp->version) {
+       case RTL_VER_03:
+       case RTL_VER_04:
+               break;
+       case RTL_VER_05:
+       case RTL_VER_06:
+       default:
+               r8153_u2p3en(tp, true);
+               break;
+       }
+
        set_bit(PHY_RESET, &tp->flags);
 }
 
-static void r8153_first_init(struct r8152 *tp)
+static u32 r8152_efuse_read(struct r8152 *tp, u8 addr)
 {
        u32 ocp_data;
-       int i;
 
-       rxdy_gated_en(tp, true);
-       r8153_teredo_off(tp);
+       ocp_write_word(tp, MCU_TYPE_PLA, PLA_EFUSE_CMD, EFUSE_READ_CMD | addr);
+       ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_EFUSE_CMD);
+       ocp_data = (ocp_data & EFUSE_DATA_BIT16) << 9;  /* data of bit16 */
+       ocp_data |= ocp_read_word(tp, MCU_TYPE_PLA, PLA_EFUSE_DATA);
 
-       ocp_data = ocp_read_dword(tp, MCU_TYPE_PLA, PLA_RCR);
-       ocp_data &= ~RCR_ACPT_ALL;
-       ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RCR, ocp_data);
+       return ocp_data;
+}
 
-       rtl8152_nic_reset(tp);
-       rtl_reset_bmu(tp);
+static void r8153b_hw_phy_cfg(struct r8152 *tp)
+{
+       u32 ocp_data, ups_flags = 0;
+       u16 data;
 
-       ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL);
-       ocp_data &= ~NOW_IS_OOB;
-       ocp_write_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL, ocp_data);
+       /* disable ALDPS before updating the PHY parameters */
+       r8153b_aldps_en(tp, false);
 
-       ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7);
-       ocp_data &= ~MCU_BORW_EN;
-       ocp_write_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7, ocp_data);
+       /* disable EEE before updating the PHY parameters */
+       r8153b_eee_en(tp, false);
+       ocp_reg_write(tp, OCP_EEE_ADV, 0);
 
-       for (i = 0; i < 1000; i++) {
-               ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL);
-               if (ocp_data & LINK_LIST_READY)
-                       break;
-               usleep_range(1000, 2000);
-       }
+       r8153b_green_en(tp, test_bit(GREEN_ETHERNET, &tp->flags));
 
-       ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7);
-       ocp_data |= RE_INIT_LL;
-       ocp_write_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7, ocp_data);
+       data = sram_read(tp, SRAM_GREEN_CFG);
+       data |= R_TUNE_EN;
+       sram_write(tp, SRAM_GREEN_CFG, data);
+       data = ocp_reg_read(tp, OCP_NCTL_CFG);
+       data |= PGA_RETURN_EN;
+       ocp_reg_write(tp, OCP_NCTL_CFG, data);
 
-       for (i = 0; i < 1000; i++) {
-               ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL);
+       /* ADC Bias Calibration:
+        * read efuse offset 0x7d to get a 17-bit data. Remove the dummy/fake
+        * bit (bit3) to rebuild the real 16-bit data. Write the data to the
+        * ADC ioffset.
+        */
+       ocp_data = r8152_efuse_read(tp, 0x7d);
+       data = (u16)(((ocp_data & 0x1fff0) >> 1) | (ocp_data & 0x7));
+       if (data != 0xffff)
+               ocp_reg_write(tp, OCP_ADC_IOFFSET, data);
+
+       /* ups mode tx-link-pulse timing adjustment:
+        * rg_saw_cnt = OCP reg 0xC426 Bit[13:0]
+        * swr_cnt_1ms_ini = 16000000 / rg_saw_cnt
+        */
+       ocp_data = ocp_reg_read(tp, 0xc426);
+       ocp_data &= 0x3fff;
+       if (ocp_data) {
+               u32 swr_cnt_1ms_ini;
+
+               swr_cnt_1ms_ini = (16000000 / ocp_data) & SAW_CNT_1MS_MASK;
+               ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_UPS_CFG);
+               ocp_data = (ocp_data & ~SAW_CNT_1MS_MASK) | swr_cnt_1ms_ini;
+               ocp_write_word(tp, MCU_TYPE_USB, USB_UPS_CFG, ocp_data);
+       }
+
+       ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_PHY_PWR);
+       ocp_data |= PFM_PWM_SWITCH;
+       ocp_write_word(tp, MCU_TYPE_PLA, PLA_PHY_PWR, ocp_data);
+
+       /* Advnace EEE */
+       if (!r8153_patch_request(tp, true)) {
+               data = ocp_reg_read(tp, OCP_POWER_CFG);
+               data |= EEE_CLKDIV_EN;
+               ocp_reg_write(tp, OCP_POWER_CFG, data);
+
+               data = ocp_reg_read(tp, OCP_DOWN_SPEED);
+               data |= EN_EEE_CMODE | EN_EEE_1000 | EN_10M_CLKDIV;
+               ocp_reg_write(tp, OCP_DOWN_SPEED, data);
+
+               ocp_reg_write(tp, OCP_SYSCLK_CFG, 0);
+               ocp_reg_write(tp, OCP_SYSCLK_CFG, clk_div_expo(5));
+
+               ups_flags |= UPS_FLAGS_EN_10M_CKDIV | UPS_FLAGS_250M_CKDIV |
+                            UPS_FLAGS_EN_EEE_CKDIV | UPS_FLAGS_EEE_CMOD_LV_EN |
+                            UPS_FLAGS_EEE_PLLOFF_GIGA;
+
+               r8153_patch_request(tp, false);
+       }
+
+       r8153b_ups_flags_w1w0(tp, ups_flags, 0);
+
+       r8153b_eee_en(tp, true);
+       ocp_reg_write(tp, OCP_EEE_ADV, MDIO_EEE_1000T | MDIO_EEE_100TX);
+
+       r8153b_aldps_en(tp, true);
+       r8153b_enable_fc(tp);
+       r8153_u2p3en(tp, true);
+
+       set_bit(PHY_RESET, &tp->flags);
+}
+
+static void r8153_first_init(struct r8152 *tp)
+{
+       u32 ocp_data;
+       int i;
+
+       r8153_mac_clk_spd(tp, false);
+       rxdy_gated_en(tp, true);
+       r8153_teredo_off(tp);
+
+       ocp_data = ocp_read_dword(tp, MCU_TYPE_PLA, PLA_RCR);
+       ocp_data &= ~RCR_ACPT_ALL;
+       ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RCR, ocp_data);
+
+       rtl8152_nic_reset(tp);
+       rtl_reset_bmu(tp);
+
+       ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL);
+       ocp_data &= ~NOW_IS_OOB;
+       ocp_write_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL, ocp_data);
+
+       ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7);
+       ocp_data &= ~MCU_BORW_EN;
+       ocp_write_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7, ocp_data);
+
+       for (i = 0; i < 1000; i++) {
+               ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL);
+               if (ocp_data & LINK_LIST_READY)
+                       break;
+               usleep_range(1000, 2000);
+       }
+
+       ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7);
+       ocp_data |= RE_INIT_LL;
+       ocp_write_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7, ocp_data);
+
+       for (i = 0; i < 1000; i++) {
+               ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL);
                if (ocp_data & LINK_LIST_READY)
                        break;
                usleep_range(1000, 2000);
@@ -2905,7 +3457,8 @@ static void r8153_first_init(struct r8152 *tp)
 
        rtl_rx_vlan_en(tp, tp->netdev->features & NETIF_F_HW_VLAN_CTAG_RX);
 
-       ocp_write_word(tp, MCU_TYPE_PLA, PLA_RMS, RTL8153_RMS);
+       ocp_data = tp->netdev->mtu + VLAN_ETH_HLEN + ETH_FCS_LEN;
+       ocp_write_word(tp, MCU_TYPE_PLA, PLA_RMS, ocp_data);
        ocp_write_byte(tp, MCU_TYPE_PLA, PLA_MTPS, MTPS_JUMBO);
 
        ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_TCR0);
@@ -2920,11 +3473,6 @@ static void r8153_first_init(struct r8152 *tp)
        ocp_write_word(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL2, RXFIFO_THR3_NORMAL);
        /* TX share fifo free credit full threshold */
        ocp_write_dword(tp, MCU_TYPE_PLA, PLA_TXFIFO_CTRL, TXFIFO_THR_NORMAL2);
-
-       /* rx aggregation */
-       ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_USB_CTRL);
-       ocp_data &= ~(RX_AGG_DISABLE | RX_ZERO_EN);
-       ocp_write_word(tp, MCU_TYPE_USB, USB_USB_CTRL, ocp_data);
 }
 
 static void r8153_enter_oob(struct r8152 *tp)
@@ -2932,6 +3480,8 @@ static void r8153_enter_oob(struct r8152 *tp)
        u32 ocp_data;
        int i;
 
+       r8153_mac_clk_spd(tp, true);
+
        ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL);
        ocp_data &= ~NOW_IS_OOB;
        ocp_write_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL, ocp_data);
@@ -2957,11 +3507,31 @@ static void r8153_enter_oob(struct r8152 *tp)
                usleep_range(1000, 2000);
        }
 
-       ocp_write_word(tp, MCU_TYPE_PLA, PLA_RMS, RTL8153_RMS);
+       ocp_data = tp->netdev->mtu + VLAN_ETH_HLEN + ETH_FCS_LEN;
+       ocp_write_word(tp, MCU_TYPE_PLA, PLA_RMS, ocp_data);
+
+       switch (tp->version) {
+       case RTL_VER_03:
+       case RTL_VER_04:
+       case RTL_VER_05:
+       case RTL_VER_06:
+               ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_TEREDO_CFG);
+               ocp_data &= ~TEREDO_WAKE_MASK;
+               ocp_write_word(tp, MCU_TYPE_PLA, PLA_TEREDO_CFG, ocp_data);
+               break;
+
+       case RTL_VER_08:
+       case RTL_VER_09:
+               /* Clear teredo wake event. bit[15:8] is the teredo wakeup
+                * type. Set it to zero. bits[7:0] are the W1C bits about
+                * the events. Set them to all 1 to clear them.
+                */
+               ocp_write_word(tp, MCU_TYPE_PLA, PLA_TEREDO_WAKE_BASE, 0x00ff);
+               break;
 
-       ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_TEREDO_CFG);
-       ocp_data &= ~TEREDO_WAKE_MASK;
-       ocp_write_word(tp, MCU_TYPE_PLA, PLA_TEREDO_CFG, ocp_data);
+       default:
+               break;
+       }
 
        rtl_rx_vlan_en(tp, true);
 
@@ -2986,12 +3556,20 @@ static void rtl8153_disable(struct r8152 *tp)
        rtl_disable(tp);
        rtl_reset_bmu(tp);
        r8153_aldps_en(tp, true);
-       usb_enable_lpm(tp->udev);
+}
+
+static void rtl8153b_disable(struct r8152 *tp)
+{
+       r8153b_aldps_en(tp, false);
+       rtl_disable(tp);
+       rtl_reset_bmu(tp);
+       r8153b_aldps_en(tp, true);
 }
 
 static int rtl8152_set_speed(struct r8152 *tp, u8 autoneg, u16 speed, u8 duplex)
 {
        u16 bmcr, anar, gbcr;
+       enum spd_duplex speed_duplex;
        int ret = 0;
 
        anar = r8152_mdio_read(tp, MII_ADVERTISE);
@@ -3008,32 +3586,43 @@ static int rtl8152_set_speed(struct r8152 *tp, u8 autoneg, u16 speed, u8 duplex)
                if (speed == SPEED_10) {
                        bmcr = 0;
                        anar |= ADVERTISE_10HALF | ADVERTISE_10FULL;
+                       speed_duplex = FORCE_10M_HALF;
                } else if (speed == SPEED_100) {
                        bmcr = BMCR_SPEED100;
                        anar |= ADVERTISE_100HALF | ADVERTISE_100FULL;
+                       speed_duplex = FORCE_100M_HALF;
                } else if (speed == SPEED_1000 && tp->mii.supports_gmii) {
                        bmcr = BMCR_SPEED1000;
                        gbcr |= ADVERTISE_1000FULL | ADVERTISE_1000HALF;
+                       speed_duplex = NWAY_1000M_FULL;
                } else {
                        ret = -EINVAL;
                        goto out;
                }
 
-               if (duplex == DUPLEX_FULL)
+               if (duplex == DUPLEX_FULL) {
                        bmcr |= BMCR_FULLDPLX;
+                       if (speed != SPEED_1000)
+                               speed_duplex++;
+               }
        } else {
                if (speed == SPEED_10) {
-                       if (duplex == DUPLEX_FULL)
+                       if (duplex == DUPLEX_FULL) {
                                anar |= ADVERTISE_10HALF | ADVERTISE_10FULL;
-                       else
+                               speed_duplex = NWAY_10M_FULL;
+                       } else {
                                anar |= ADVERTISE_10HALF;
+                               speed_duplex = NWAY_10M_HALF;
+                       }
                } else if (speed == SPEED_100) {
                        if (duplex == DUPLEX_FULL) {
                                anar |= ADVERTISE_10HALF | ADVERTISE_10FULL;
                                anar |= ADVERTISE_100HALF | ADVERTISE_100FULL;
+                               speed_duplex = NWAY_100M_FULL;
                        } else {
                                anar |= ADVERTISE_10HALF;
                                anar |= ADVERTISE_100HALF;
+                               speed_duplex = NWAY_100M_HALF;
                        }
                } else if (speed == SPEED_1000 && tp->mii.supports_gmii) {
                        if (duplex == DUPLEX_FULL) {
@@ -3045,6 +3634,7 @@ static int rtl8152_set_speed(struct r8152 *tp, u8 autoneg, u16 speed, u8 duplex)
                                anar |= ADVERTISE_100HALF;
                                gbcr |= ADVERTISE_1000HALF;
                        }
+                       speed_duplex = NWAY_1000M_FULL;
                } else {
                        ret = -EINVAL;
                        goto out;
@@ -3062,6 +3652,17 @@ static int rtl8152_set_speed(struct r8152 *tp, u8 autoneg, u16 speed, u8 duplex)
        r8152_mdio_write(tp, MII_ADVERTISE, anar);
        r8152_mdio_write(tp, MII_BMCR, bmcr);
 
+       switch (tp->version) {
+       case RTL_VER_08:
+       case RTL_VER_09:
+               r8153b_ups_flags_w1w0(tp, ups_flags_speed(speed_duplex),
+                                     UPS_FLAGS_SPEED_MASK);
+               break;
+
+       default:
+               break;
+       }
+
        if (bmcr & BMCR_RESET) {
                int i;
 
@@ -3105,12 +3706,23 @@ static void rtl8153_up(struct r8152 *tp)
                return;
 
        r8153_u1u2en(tp, false);
+       r8153_u2p3en(tp, false);
        r8153_aldps_en(tp, false);
        r8153_first_init(tp);
        r8153_aldps_en(tp, true);
-       r8153_u2p3en(tp, true);
+
+       switch (tp->version) {
+       case RTL_VER_03:
+       case RTL_VER_04:
+               break;
+       case RTL_VER_05:
+       case RTL_VER_06:
+       default:
+               r8153_u2p3en(tp, true);
+               break;
+       }
+
        r8153_u1u2en(tp, true);
-       usb_enable_lpm(tp->udev);
 }
 
 static void rtl8153_down(struct r8152 *tp)
@@ -3128,6 +3740,38 @@ static void rtl8153_down(struct r8152 *tp)
        r8153_aldps_en(tp, true);
 }
 
+static void rtl8153b_up(struct r8152 *tp)
+{
+       if (test_bit(RTL8152_UNPLUG, &tp->flags))
+               return;
+
+       r8153b_u1u2en(tp, false);
+       r8153_u2p3en(tp, false);
+       r8153b_aldps_en(tp, false);
+
+       r8153_first_init(tp);
+       ocp_write_dword(tp, MCU_TYPE_USB, USB_RX_BUF_TH, RX_THR_B);
+
+       r8153b_aldps_en(tp, true);
+       r8153_u2p3en(tp, true);
+       r8153b_u1u2en(tp, true);
+}
+
+static void rtl8153b_down(struct r8152 *tp)
+{
+       if (test_bit(RTL8152_UNPLUG, &tp->flags)) {
+               rtl_drop_queued_tx(tp);
+               return;
+       }
+
+       r8153b_u1u2en(tp, false);
+       r8153_u2p3en(tp, false);
+       r8153b_power_cut_en(tp, false);
+       r8153b_aldps_en(tp, false);
+       r8153_enter_oob(tp);
+       r8153b_aldps_en(tp, true);
+}
+
 static bool rtl8152_in_nway(struct r8152 *tp)
 {
        u16 nway_state;
@@ -3157,6 +3801,7 @@ static bool rtl8153_in_nway(struct r8152 *tp)
 static void set_carrier(struct r8152 *tp)
 {
        struct net_device *netdev = tp->netdev;
+       struct napi_struct *napi = &tp->napi;
        u8 speed;
 
        speed = rtl8152_get_speed(tp);
@@ -3164,11 +3809,12 @@ static void set_carrier(struct r8152 *tp)
        if (speed & LINK_STATUS) {
                if (!netif_carrier_ok(netdev)) {
                        tp->rtl_ops.enable(tp);
-                       set_bit(RTL8152_SET_RX_MODE, &tp->flags);
                        netif_stop_queue(netdev);
-                       napi_disable(&tp->napi);
+                       napi_disable(napi);
                        netif_carrier_on(netdev);
                        rtl_start_rx(tp);
+                       clear_bit(RTL8152_SET_RX_MODE, &tp->flags);
+                       _rtl8152_set_rx_mode(netdev);
                        napi_enable(&tp->napi);
                        netif_wake_queue(netdev);
                        netif_info(tp, link, netdev, "carrier on\n");
@@ -3179,9 +3825,9 @@ static void set_carrier(struct r8152 *tp)
        } else {
                if (netif_carrier_ok(netdev)) {
                        netif_carrier_off(netdev);
-                       napi_disable(&tp->napi);
+                       napi_disable(napi);
                        tp->rtl_ops.disable(tp);
-                       napi_enable(&tp->napi);
+                       napi_enable(napi);
                        netif_info(tp, link, netdev, "carrier off\n");
                }
        }
@@ -3429,12 +4075,7 @@ static void r8153_init(struct r8152 *tp)
                        break;
        }
 
-       for (i = 0; i < 500; i++) {
-               ocp_data = ocp_reg_read(tp, OCP_PHY_STATUS) & PHY_STAT_MASK;
-               if (ocp_data == PHY_STAT_LAN_ON || ocp_data == PHY_STAT_PWRDN)
-                       break;
-               msleep(20);
-       }
+       data = r8153_phy_status(tp, 0);
 
        if (tp->version == RTL_VER_03 || tp->version == RTL_VER_04 ||
            tp->version == RTL_VER_05)
@@ -3446,17 +4087,8 @@ static void r8153_init(struct r8152 *tp)
                r8152_mdio_write(tp, MII_BMCR, data);
        }
 
-       for (i = 0; i < 500; i++) {
-               ocp_data = ocp_reg_read(tp, OCP_PHY_STATUS) & PHY_STAT_MASK;
-               if (ocp_data == PHY_STAT_LAN_ON)
-                       break;
-
-               msleep(20);
-               if (test_bit(RTL8152_UNPLUG, &tp->flags))
-                       break;
-       }
+       data = r8153_phy_status(tp, PHY_STAT_LAN_ON);
 
-       usb_disable_lpm(tp->udev);
        r8153_u2p3en(tp, false);
 
        if (tp->version == RTL_VER_04) {
@@ -3516,15 +4148,91 @@ static void r8153_init(struct r8152 *tp)
 
        r8153_power_cut_en(tp, false);
        r8153_u1u2en(tp, true);
+       r8153_mac_clk_spd(tp, false);
+       usb_enable_lpm(tp->udev);
+
+       /* rx aggregation */
+       ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_USB_CTRL);
+       ocp_data &= ~(RX_AGG_DISABLE | RX_ZERO_EN);
+       if (test_bit(DELL_TB_RX_AGG_BUG, &tp->flags))
+               ocp_data |= RX_AGG_DISABLE;
+
+       ocp_write_word(tp, MCU_TYPE_USB, USB_USB_CTRL, ocp_data);
+
+       rtl_tally_reset(tp);
+
+       switch (tp->udev->speed) {
+       case USB_SPEED_SUPER:
+       case USB_SPEED_SUPER_PLUS:
+               tp->coalesce = COALESCE_SUPER;
+               break;
+       case USB_SPEED_HIGH:
+               tp->coalesce = COALESCE_HIGH;
+               break;
+       default:
+               tp->coalesce = COALESCE_SLOW;
+               break;
+       }
+}
+
+static void r8153b_init(struct r8152 *tp)
+{
+       u32 ocp_data;
+       u16 data;
+       int i;
+
+       if (test_bit(RTL8152_UNPLUG, &tp->flags))
+               return;
+
+       r8153b_u1u2en(tp, false);
+
+       for (i = 0; i < 500; i++) {
+               if (ocp_read_word(tp, MCU_TYPE_PLA, PLA_BOOT_CTRL) &
+                   AUTOLOAD_DONE)
+                       break;
+               msleep(20);
+       }
+
+       data = r8153_phy_status(tp, 0);
+
+       data = r8152_mdio_read(tp, MII_BMCR);
+       if (data & BMCR_PDOWN) {
+               data &= ~BMCR_PDOWN;
+               r8152_mdio_write(tp, MII_BMCR, data);
+       }
+
+       data = r8153_phy_status(tp, PHY_STAT_LAN_ON);
+
+       r8153_u2p3en(tp, false);
+
+       /* MSC timer = 0xfff * 8ms = 32760 ms */
+       ocp_write_word(tp, MCU_TYPE_USB, USB_MSC_TIMER, 0x0fff);
+
+       /* U1/U2/L1 idle timer. 500 us */
+       ocp_write_word(tp, MCU_TYPE_USB, USB_U1U2_TIMER, 500);
+
+       r8153b_power_cut_en(tp, false);
+       r8153b_ups_en(tp, false);
+       r8153b_queue_wake(tp, false);
+       rtl_runtime_suspend_enable(tp, false);
+       r8153b_u1u2en(tp, true);
+       usb_enable_lpm(tp->udev);
 
        /* MAC clock speed down */
-       ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL, 0);
-       ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL2, 0);
-       ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL3, 0);
-       ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL4, 0);
+       ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL2);
+       ocp_data |= MAC_CLK_SPDWN_EN;
+       ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL2, ocp_data);
+
+       set_bit(GREEN_ETHERNET, &tp->flags);
+
+       /* rx aggregation */
+       ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_USB_CTRL);
+       ocp_data &= ~(RX_AGG_DISABLE | RX_ZERO_EN);
+       ocp_write_word(tp, MCU_TYPE_USB, USB_USB_CTRL, ocp_data);
 
        rtl_tally_reset(tp);
-       r8153_u2p3en(tp, true);
+
+       tp->coalesce = 15000;   /* 15 us */
 }
 
 static int rtl8152_pre_reset(struct usb_interface *intf)
@@ -3570,7 +4278,7 @@ static int rtl8152_post_reset(struct usb_interface *intf)
                mutex_lock(&tp->control);
                tp->rtl_ops.enable(tp);
                rtl_start_rx(tp);
-               rtl8152_set_rx_mode(netdev);
+               _rtl8152_set_rx_mode(netdev);
                mutex_unlock(&tp->control);
        }
 
@@ -3607,7 +4315,62 @@ static bool delay_autosuspend(struct r8152 *tp)
                return false;
 }
 
-static int rtl8152_rumtime_suspend(struct r8152 *tp)
+static int rtl8152_runtime_resume(struct r8152 *tp)
+{
+       struct net_device *netdev = tp->netdev;
+
+       if (netif_running(netdev) && netdev->flags & IFF_UP) {
+               struct napi_struct *napi = &tp->napi;
+
+               tp->rtl_ops.autosuspend_en(tp, false);
+               napi_disable(napi);
+               set_bit(WORK_ENABLE, &tp->flags);
+
+               if (netif_carrier_ok(netdev)) {
+                       if (rtl8152_get_speed(tp) & LINK_STATUS) {
+                               rtl_start_rx(tp);
+                       } else {
+                               netif_carrier_off(netdev);
+                               tp->rtl_ops.disable(tp);
+                               netif_info(tp, link, netdev, "linking down\n");
+                       }
+               }
+
+               napi_enable(napi);
+               clear_bit(SELECTIVE_SUSPEND, &tp->flags);
+               smp_mb__after_atomic();
+
+               if (!list_empty(&tp->rx_done))
+                       napi_schedule(&tp->napi);
+
+               usb_submit_urb(tp->intr_urb, GFP_NOIO);
+       } else {
+               if (netdev->flags & IFF_UP)
+                       tp->rtl_ops.autosuspend_en(tp, false);
+
+               clear_bit(SELECTIVE_SUSPEND, &tp->flags);
+       }
+
+       return 0;
+}
+
+static int rtl8152_system_resume(struct r8152 *tp)
+{
+       struct net_device *netdev = tp->netdev;
+
+       netif_device_attach(netdev);
+
+       if (netif_running(netdev) && netdev->flags & IFF_UP) {
+               tp->rtl_ops.up(tp);
+               netif_carrier_off(netdev);
+               set_bit(WORK_ENABLE, &tp->flags);
+               usb_submit_urb(tp->intr_urb, GFP_NOIO);
+       }
+
+       return 0;
+}
+
+static int rtl8152_runtime_suspend(struct r8152 *tp)
 {
        struct net_device *netdev = tp->netdev;
        int ret = 0;
@@ -3618,13 +4381,6 @@ static int rtl8152_rumtime_suspend(struct r8152 *tp)
        if (netif_running(netdev) && test_bit(WORK_ENABLE, &tp->flags)) {
                u32 rcr = 0;
 
-               if (delay_autosuspend(tp)) {
-                       clear_bit(SELECTIVE_SUSPEND, &tp->flags);
-                       smp_mb__after_atomic();
-                       ret = -EBUSY;
-                       goto out1;
-               }
-
                if (netif_carrier_ok(netdev)) {
                        u32 ocp_data;
 
@@ -3650,11 +4406,18 @@ static int rtl8152_rumtime_suspend(struct r8152 *tp)
                tp->rtl_ops.autosuspend_en(tp, true);
 
                if (netif_carrier_ok(netdev)) {
-                       napi_disable(&tp->napi);
+                       struct napi_struct *napi = &tp->napi;
+
+                       napi_disable(napi);
                        rtl_stop_rx(tp);
                        rxdy_gated_en(tp, false);
                        ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RCR, rcr);
-                       napi_enable(&tp->napi);
+                       napi_enable(napi);
+               }
+
+               if (delay_autosuspend(tp)) {
+                       rtl8152_runtime_resume(tp);
+                       ret = -EBUSY;
                }
        }
 
@@ -3665,20 +4428,21 @@ out1:
 static int rtl8152_system_suspend(struct r8152 *tp)
 {
        struct net_device *netdev = tp->netdev;
-       int ret = 0;
 
        netif_device_detach(netdev);
 
        if (netif_running(netdev) && test_bit(WORK_ENABLE, &tp->flags)) {
+               struct napi_struct *napi = &tp->napi;
+
                clear_bit(WORK_ENABLE, &tp->flags);
                usb_kill_urb(tp->intr_urb);
-               napi_disable(&tp->napi);
+               napi_disable(napi);
                cancel_delayed_work_sync(&tp->schedule);
                tp->rtl_ops.down(tp);
-               napi_enable(&tp->napi);
+               napi_enable(napi);
        }
 
-       return ret;
+       return 0;
 }
 
 static int rtl8152_suspend(struct usb_interface *intf, pm_message_t message)
@@ -3689,7 +4453,7 @@ static int rtl8152_suspend(struct usb_interface *intf, pm_message_t message)
        mutex_lock(&tp->control);
 
        if (PMSG_IS_AUTO(message))
-               ret = rtl8152_rumtime_suspend(tp);
+               ret = rtl8152_runtime_suspend(tp);
        else
                ret = rtl8152_system_suspend(tp);
 
@@ -3701,52 +4465,18 @@ static int rtl8152_suspend(struct usb_interface *intf, pm_message_t message)
 static int rtl8152_resume(struct usb_interface *intf)
 {
        struct r8152 *tp = usb_get_intfdata(intf);
+       int ret;
 
        mutex_lock(&tp->control);
 
-       if (!test_bit(SELECTIVE_SUSPEND, &tp->flags)) {
-               tp->rtl_ops.init(tp);
-               queue_delayed_work(system_long_wq, &tp->hw_phy_work, 0);
-               netif_device_attach(tp->netdev);
-       }
-
-       if (netif_running(tp->netdev) && tp->netdev->flags & IFF_UP) {
-               if (test_bit(SELECTIVE_SUSPEND, &tp->flags)) {
-                       tp->rtl_ops.autosuspend_en(tp, false);
-                       napi_disable(&tp->napi);
-                       set_bit(WORK_ENABLE, &tp->flags);
-
-                       if (netif_carrier_ok(tp->netdev)) {
-                               if (rtl8152_get_speed(tp) & LINK_STATUS) {
-                                       rtl_start_rx(tp);
-                               } else {
-                                       netif_carrier_off(tp->netdev);
-                                       tp->rtl_ops.disable(tp);
-                                       netif_info(tp, link, tp->netdev,
-                                                  "linking down\n");
-                               }
-                       }
-
-                       napi_enable(&tp->napi);
-                       clear_bit(SELECTIVE_SUSPEND, &tp->flags);
-                       smp_mb__after_atomic();
-                       if (!list_empty(&tp->rx_done))
-                               napi_schedule(&tp->napi);
-               } else {
-                       tp->rtl_ops.up(tp);
-                       netif_carrier_off(tp->netdev);
-                       set_bit(WORK_ENABLE, &tp->flags);
-               }
-               usb_submit_urb(tp->intr_urb, GFP_KERNEL);
-       } else if (test_bit(SELECTIVE_SUSPEND, &tp->flags)) {
-               if (tp->netdev->flags & IFF_UP)
-                       tp->rtl_ops.autosuspend_en(tp, false);
-               clear_bit(SELECTIVE_SUSPEND, &tp->flags);
-       }
+       if (test_bit(SELECTIVE_SUSPEND, &tp->flags))
+               ret = rtl8152_runtime_resume(tp);
+       else
+               ret = rtl8152_system_resume(tp);
 
        mutex_unlock(&tp->control);
 
-       return 0;
+       return ret;
 }
 
 static int rtl8152_reset_resume(struct usb_interface *intf)
@@ -3754,6 +4484,9 @@ static int rtl8152_reset_resume(struct usb_interface *intf)
        struct r8152 *tp = usb_get_intfdata(intf);
 
        clear_bit(SELECTIVE_SUSPEND, &tp->flags);
+       tp->rtl_ops.init(tp);
+       queue_delayed_work(system_long_wq, &tp->hw_phy_work, 0);
+       set_ethernet_addr(tp);
        return rtl8152_resume(intf);
 }
 
@@ -3830,7 +4563,8 @@ static void rtl8152_get_drvinfo(struct net_device *netdev,
 }
 
 static
-int rtl8152_get_settings(struct net_device *netdev, struct ethtool_cmd *cmd)
+int rtl8152_get_link_ksettings(struct net_device *netdev,
+                              struct ethtool_link_ksettings *cmd)
 {
        struct r8152 *tp = netdev_priv(netdev);
        int ret;
@@ -3844,7 +4578,7 @@ int rtl8152_get_settings(struct net_device *netdev, struct ethtool_cmd *cmd)
 
        mutex_lock(&tp->control);
 
-       ret = mii_ethtool_gset(&tp->mii, cmd);
+       //mii_ethtool_get_link_ksettings(&tp->mii, cmd);
 
        mutex_unlock(&tp->control);
 
@@ -3854,7 +4588,8 @@ out:
        return ret;
 }
 
-static int rtl8152_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
+static int rtl8152_set_link_ksettings(struct net_device *dev,
+                                     const struct ethtool_link_ksettings *cmd)
 {
        struct r8152 *tp = netdev_priv(dev);
        int ret;
@@ -3865,11 +4600,12 @@ static int rtl8152_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
 
        mutex_lock(&tp->control);
 
-       ret = rtl8152_set_speed(tp, cmd->autoneg, cmd->speed, cmd->duplex);
+       ret = rtl8152_set_speed(tp, cmd->base.autoneg, cmd->base.speed,
+                               cmd->base.duplex);
        if (!ret) {
-               tp->autoneg = cmd->autoneg;
-               tp->speed = cmd->speed;
-               tp->duplex = cmd->duplex;
+               tp->autoneg = cmd->base.autoneg;
+               tp->speed = cmd->base.speed;
+               tp->duplex = cmd->base.duplex;
        }
 
        mutex_unlock(&tp->control);
@@ -4023,6 +4759,20 @@ static int r8153_set_eee(struct r8152 *tp, struct ethtool_eee *eee)
        return 0;
 }
 
+static int r8153b_set_eee(struct r8152 *tp, struct ethtool_eee *eee)
+{
+       u16 val = ethtool_adv_to_mmd_eee_adv_t(eee->advertised);
+
+       r8153b_eee_en(tp, eee->eee_enabled);
+
+       if (!eee->eee_enabled)
+               val = 0;
+
+       ocp_reg_write(tp, OCP_EEE_ADV, val);
+
+       return 0;
+}
+
 static int
 rtl_ethtool_get_eee(struct net_device *net, struct ethtool_eee *edata)
 {
@@ -4098,6 +4848,7 @@ static int rtl8152_get_coalesce(struct net_device *netdev,
        switch (tp->version) {
        case RTL_VER_01:
        case RTL_VER_02:
+       case RTL_VER_07:
                return -EOPNOTSUPP;
        default:
                break;
@@ -4117,6 +4868,7 @@ static int rtl8152_set_coalesce(struct net_device *netdev,
        switch (tp->version) {
        case RTL_VER_01:
        case RTL_VER_02:
+       case RTL_VER_07:
                return -EOPNOTSUPP;
        default:
                break;
@@ -4147,8 +4899,6 @@ static int rtl8152_set_coalesce(struct net_device *netdev,
 
 static const struct ethtool_ops ops = {
        .get_drvinfo = rtl8152_get_drvinfo,
-       .get_settings = rtl8152_get_settings,
-       .set_settings = rtl8152_set_settings,
        .get_link = ethtool_op_get_link,
        .nway_reset = rtl8152_nway_reset,
        .get_msglevel = rtl8152_get_msglevel,
@@ -4162,6 +4912,8 @@ static const struct ethtool_ops ops = {
        .set_coalesce = rtl8152_set_coalesce,
        .get_eee = rtl_ethtool_get_eee,
        .set_eee = rtl_ethtool_set_eee,
+       .get_link_ksettings = rtl8152_get_link_ksettings,
+       .set_link_ksettings = rtl8152_set_link_ksettings,
 };
 
 static int rtl8152_ioctl(struct net_device *netdev, struct ifreq *rq, int cmd)
@@ -4216,14 +4968,13 @@ static int rtl8152_change_mtu(struct net_device *dev, int new_mtu)
        switch (tp->version) {
        case RTL_VER_01:
        case RTL_VER_02:
-               return eth_change_mtu(dev, new_mtu);
+       case RTL_VER_07:
+               dev->mtu = new_mtu;
+               return 0;
        default:
                break;
        }
 
-       if (new_mtu < 68 || new_mtu > RTL8153_MAX_MTU)
-               return -EINVAL;
-
        ret = usb_autopm_get_interface(tp->intf);
        if (ret < 0)
                return ret;
@@ -4232,8 +4983,14 @@ static int rtl8152_change_mtu(struct net_device *dev, int new_mtu)
 
        dev->mtu = new_mtu;
 
-       if (netif_running(dev) && netif_carrier_ok(dev))
-               r8153_set_rx_early_size(tp);
+       if (netif_running(dev)) {
+               u32 rms = new_mtu + VLAN_ETH_HLEN + ETH_FCS_LEN;
+
+               ocp_write_word(tp, MCU_TYPE_PLA, PLA_RMS, rms);
+
+               if (netif_carrier_ok(dev))
+                       r8153_set_rx_early_size(tp);
+       }
 
        mutex_unlock(&tp->control);
 
@@ -4256,44 +5013,6 @@ static const struct net_device_ops rtl8152_netdev_ops = {
        .ndo_features_check     = rtl8152_features_check,
 };
 
-static void r8152b_get_version(struct r8152 *tp)
-{
-       u32     ocp_data;
-       u16     version;
-
-       ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_TCR1);
-       version = (u16)(ocp_data & VERSION_MASK);
-
-       switch (version) {
-       case 0x4c00:
-               tp->version = RTL_VER_01;
-               break;
-       case 0x4c10:
-               tp->version = RTL_VER_02;
-               break;
-       case 0x5c00:
-               tp->version = RTL_VER_03;
-               tp->mii.supports_gmii = 1;
-               break;
-       case 0x5c10:
-               tp->version = RTL_VER_04;
-               tp->mii.supports_gmii = 1;
-               break;
-       case 0x5c20:
-               tp->version = RTL_VER_05;
-               tp->mii.supports_gmii = 1;
-               break;
-       case 0x5c30:
-               tp->version = RTL_VER_06;
-               tp->mii.supports_gmii = 1;
-               break;
-       default:
-               netif_info(tp, probe, tp->netdev,
-                          "Unknown version 0x%04x\n", version);
-               break;
-       }
-}
-
 static void rtl8152_unload(struct r8152 *tp)
 {
        if (test_bit(RTL8152_UNPLUG, &tp->flags))
@@ -4311,6 +5030,14 @@ static void rtl8153_unload(struct r8152 *tp)
        r8153_power_cut_en(tp, false);
 }
 
+static void rtl8153b_unload(struct r8152 *tp)
+{
+       if (test_bit(RTL8152_UNPLUG, &tp->flags))
+               return;
+
+       r8153b_power_cut_en(tp, false);
+}
+
 static int rtl_ops_init(struct r8152 *tp)
 {
        struct rtl_ops *ops = &tp->rtl_ops;
@@ -4319,6 +5046,7 @@ static int rtl_ops_init(struct r8152 *tp)
        switch (tp->version) {
        case RTL_VER_01:
        case RTL_VER_02:
+       case RTL_VER_07:
                ops->init               = r8152b_init;
                ops->enable             = rtl8152_enable;
                ops->disable            = rtl8152_disable;
@@ -4349,6 +5077,21 @@ static int rtl_ops_init(struct r8152 *tp)
                ops->autosuspend_en     = rtl8153_runtime_enable;
                break;
 
+       case RTL_VER_08:
+       case RTL_VER_09:
+               ops->init               = r8153b_init;
+               ops->enable             = rtl8153_enable;
+               ops->disable            = rtl8153b_disable;
+               ops->up                 = rtl8153b_up;
+               ops->down               = rtl8153b_down;
+               ops->unload             = rtl8153b_unload;
+               ops->eee_get            = r8153_get_eee;
+               ops->eee_set            = r8153b_set_eee;
+               ops->in_nway            = rtl8153_in_nway;
+               ops->hw_phy_cfg         = r8153b_hw_phy_cfg;
+               ops->autosuspend_en     = rtl8153b_runtime_enable;
+               break;
+
        default:
                ret = -ENODEV;
                netif_err(tp, probe, tp->netdev, "Unknown Device\n");
@@ -4358,14 +5101,77 @@ static int rtl_ops_init(struct r8152 *tp)
        return ret;
 }
 
+static u8 rtl_get_version(struct usb_interface *intf)
+{
+       struct usb_device *udev = interface_to_usbdev(intf);
+       u32 ocp_data = 0;
+       __le32 *tmp;
+       u8 version;
+       int ret;
+
+       tmp = kmalloc(sizeof(*tmp), GFP_KERNEL);
+       if (!tmp)
+               return 0;
+
+       ret = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0),
+                             RTL8152_REQ_GET_REGS, RTL8152_REQT_READ,
+                             PLA_TCR0, MCU_TYPE_PLA, tmp, sizeof(*tmp), 500);
+       if (ret > 0)
+               ocp_data = (__le32_to_cpu(*tmp) >> 16) & VERSION_MASK;
+
+       kfree(tmp);
+
+       switch (ocp_data) {
+       case 0x4c00:
+               version = RTL_VER_01;
+               break;
+       case 0x4c10:
+               version = RTL_VER_02;
+               break;
+       case 0x5c00:
+               version = RTL_VER_03;
+               break;
+       case 0x5c10:
+               version = RTL_VER_04;
+               break;
+       case 0x5c20:
+               version = RTL_VER_05;
+               break;
+       case 0x5c30:
+               version = RTL_VER_06;
+               break;
+       case 0x4800:
+               version = RTL_VER_07;
+               break;
+       case 0x6000:
+               version = RTL_VER_08;
+               break;
+       case 0x6010:
+               version = RTL_VER_09;
+               break;
+       default:
+               version = RTL_VER_UNKNOWN;
+               dev_info(&intf->dev, "Unknown version 0x%04x\n", ocp_data);
+               break;
+       }
+
+       dev_dbg(&intf->dev, "Detected version 0x%04x\n", version);
+
+       return version;
+}
+
 static int rtl8152_probe(struct usb_interface *intf,
                         const struct usb_device_id *id)
 {
        struct usb_device *udev = interface_to_usbdev(intf);
+       u8 version = rtl_get_version(intf);
        struct r8152 *tp;
        struct net_device *netdev;
        int ret;
 
+       if (version == RTL_VER_UNKNOWN)
+               return -ENODEV;
+
        if (udev->actconfig->desc.bConfigurationValue != 1) {
                usb_driver_set_configuration(udev, 1);
                return -ENODEV;
@@ -4388,8 +5194,19 @@ static int rtl8152_probe(struct usb_interface *intf,
        tp->udev = udev;
        tp->netdev = netdev;
        tp->intf = intf;
+       tp->version = version;
+
+       switch (version) {
+       case RTL_VER_01:
+       case RTL_VER_02:
+       case RTL_VER_07:
+               tp->mii.supports_gmii = 0;
+               break;
+       default:
+               tp->mii.supports_gmii = 1;
+               break;
+       }
 
-       r8152b_get_version(tp);
        ret = rtl_ops_init(tp);
        if (ret)
                goto out;
@@ -4418,9 +5235,27 @@ static int rtl8152_probe(struct usb_interface *intf,
                netdev->hw_features &= ~NETIF_F_RXCSUM;
        }
 
+       if (le16_to_cpu(udev->descriptor.bcdDevice) == 0x3011 && udev->serial &&
+           (!strcmp(udev->serial, "000001000000") || !strcmp(udev->serial, "000002000000"))) {
+               dev_info(&udev->dev, "Dell TB16 Dock, disable RX aggregation");
+               set_bit(DELL_TB_RX_AGG_BUG, &tp->flags);
+       }
+
        netdev->ethtool_ops = &ops;
        netif_set_gso_max_size(netdev, RTL_LIMITED_TSO_SIZE);
 
+       /* MTU range: 68 - 1500 or 9194 */
+       //netdev->min_mtu = ETH_MIN_MTU;
+       //switch (tp->version) {
+       //case RTL_VER_01:
+       //case RTL_VER_02:
+       //      netdev->max_mtu = ETH_DATA_LEN;
+       //      break;
+       //default:
+       //      netdev->max_mtu = RTL8153_MAX_MTU;
+       //      break;
+       //}
+
        tp->mii.dev = netdev;
        tp->mii.mdio_read = read_mii_word;
        tp->mii.mdio_write = write_mii_word;
@@ -4428,19 +5263,6 @@ static int rtl8152_probe(struct usb_interface *intf,
        tp->mii.reg_num_mask = 0x1f;
        tp->mii.phy_id = R8152_PHY_ID;
 
-       switch (udev->speed) {
-       case USB_SPEED_SUPER:
-       case USB_SPEED_SUPER_PLUS:
-               tp->coalesce = COALESCE_SUPER;
-               break;
-       case USB_SPEED_HIGH:
-               tp->coalesce = COALESCE_HIGH;
-               break;
-       default:
-               tp->coalesce = COALESCE_SLOW;
-               break;
-       }
-
        tp->autoneg = AUTONEG_ENABLE;
        tp->speed = tp->mii.supports_gmii ? SPEED_1000 : SPEED_100;
        tp->duplex = DUPLEX_FULL;
@@ -4518,14 +5340,23 @@ static void rtl8152_disconnect(struct usb_interface *intf)
        .bInterfaceProtocol = USB_CDC_PROTO_NONE
 
 /* table of devices that work with this driver */
-static struct usb_device_id rtl8152_table[] = {
+static const struct usb_device_id rtl8152_table[] = {
+       {REALTEK_USB_DEVICE(VENDOR_ID_REALTEK, 0x8050)},
        {REALTEK_USB_DEVICE(VENDOR_ID_REALTEK, 0x8152)},
        {REALTEK_USB_DEVICE(VENDOR_ID_REALTEK, 0x8153)},
+       {REALTEK_USB_DEVICE(VENDOR_ID_MICROSOFT, 0x07ab)},
+       {REALTEK_USB_DEVICE(VENDOR_ID_MICROSOFT, 0x07c6)},
        {REALTEK_USB_DEVICE(VENDOR_ID_SAMSUNG, 0xa101)},
-       {REALTEK_USB_DEVICE(VENDOR_ID_LENOVO,  0x7205)},
        {REALTEK_USB_DEVICE(VENDOR_ID_LENOVO,  0x304f)},
+       {REALTEK_USB_DEVICE(VENDOR_ID_LENOVO,  0x3062)},
+       {REALTEK_USB_DEVICE(VENDOR_ID_LENOVO,  0x3069)},
+       {REALTEK_USB_DEVICE(VENDOR_ID_LENOVO,  0x7205)},
+       {REALTEK_USB_DEVICE(VENDOR_ID_LENOVO,  0x720c)},
+       {REALTEK_USB_DEVICE(VENDOR_ID_LENOVO,  0x7214)},
+       {REALTEK_USB_DEVICE(VENDOR_ID_LENOVO,  0xa387)},
        {REALTEK_USB_DEVICE(VENDOR_ID_LINKSYS, 0x0041)},
        {REALTEK_USB_DEVICE(VENDOR_ID_NVIDIA,  0x09ff)},
+       {REALTEK_USB_DEVICE(VENDOR_ID_TPLINK,  0x0601)},
        {}
 };