Lines Matching refs:tp
888 void (*init)(struct r8152 *tp);
889 int (*enable)(struct r8152 *tp);
890 void (*disable)(struct r8152 *tp);
891 void (*up)(struct r8152 *tp);
892 void (*down)(struct r8152 *tp);
893 void (*unload)(struct r8152 *tp);
894 int (*eee_get)(struct r8152 *tp, struct ethtool_eee *eee);
895 int (*eee_set)(struct r8152 *tp, struct ethtool_eee *eee);
896 bool (*in_nway)(struct r8152 *tp);
897 void (*hw_phy_cfg)(struct r8152 *tp);
898 void (*autosuspend_en)(struct r8152 *tp, bool enable);
899 void (*change_mtu)(struct r8152 *tp);
927 int (*pre_fw)(struct r8152 *tp);
928 int (*post_fw)(struct r8152 *tp);
1214 static void rtl_set_inaccessible(struct r8152 *tp) in rtl_set_inaccessible() argument
1216 set_bit(RTL8152_INACCESSIBLE, &tp->flags); in rtl_set_inaccessible()
1220 static void rtl_set_accessible(struct r8152 *tp) in rtl_set_accessible() argument
1222 clear_bit(RTL8152_INACCESSIBLE, &tp->flags); in rtl_set_accessible()
1227 int r8152_control_msg(struct r8152 *tp, unsigned int pipe, __u8 request, in r8152_control_msg() argument
1231 struct usb_device *udev = tp->udev; in r8152_control_msg()
1234 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in r8152_control_msg()
1249 tp->reg_access_reset_count = 0; in r8152_control_msg()
1263 rtl_set_inaccessible(tp); in r8152_control_msg()
1270 if (!test_bit(PROBED_WITH_NO_ERRORS, &tp->flags)) { in r8152_control_msg()
1271 set_bit(PROBE_SHOULD_RETRY, &tp->flags); in r8152_control_msg()
1283 if (test_bit(IN_PRE_RESET, &tp->flags)) in r8152_control_msg()
1286 if (tp->reg_access_reset_count < REGISTER_ACCESS_MAX_RESETS) { in r8152_control_msg()
1287 usb_queue_reset_device(tp->intf); in r8152_control_msg()
1288 tp->reg_access_reset_count++; in r8152_control_msg()
1289 } else if (tp->reg_access_reset_count == REGISTER_ACCESS_MAX_RESETS) { in r8152_control_msg()
1299 int get_registers(struct r8152 *tp, u16 value, u16 index, u16 size, void *data) in get_registers() argument
1308 ret = r8152_control_msg(tp, tp->pipe_ctrl_in, in get_registers()
1323 int set_registers(struct r8152 *tp, u16 value, u16 index, u16 size, void *data) in set_registers() argument
1332 ret = r8152_control_msg(tp, tp->pipe_ctrl_out, in set_registers()
1341 static void rtl_set_unplug(struct r8152 *tp) in rtl_set_unplug() argument
1343 if (tp->udev->state == USB_STATE_NOTATTACHED) in rtl_set_unplug()
1344 rtl_set_inaccessible(tp); in rtl_set_unplug()
1347 static int generic_ocp_read(struct r8152 *tp, u16 index, u16 size, in generic_ocp_read() argument
1353 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in generic_ocp_read()
1365 ret = get_registers(tp, index, type, limit, data); in generic_ocp_read()
1373 ret = get_registers(tp, index, type, size, data); in generic_ocp_read()
1385 rtl_set_unplug(tp); in generic_ocp_read()
1390 static int generic_ocp_write(struct r8152 *tp, u16 index, u16 byteen, in generic_ocp_write() argument
1397 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in generic_ocp_write()
1414 ret = set_registers(tp, index, type | byen, 4, data); in generic_ocp_write()
1432 ret = set_registers(tp, index, in generic_ocp_write()
1442 ret = set_registers(tp, index, in generic_ocp_write()
1457 ret = set_registers(tp, index, type | byen, 4, data); in generic_ocp_write()
1462 rtl_set_unplug(tp); in generic_ocp_write()
1468 int pla_ocp_read(struct r8152 *tp, u16 index, u16 size, void *data) in pla_ocp_read() argument
1470 return generic_ocp_read(tp, index, size, data, MCU_TYPE_PLA); in pla_ocp_read()
1474 int pla_ocp_write(struct r8152 *tp, u16 index, u16 byteen, u16 size, void *data) in pla_ocp_write() argument
1476 return generic_ocp_write(tp, index, byteen, size, data, MCU_TYPE_PLA); in pla_ocp_write()
1480 int usb_ocp_write(struct r8152 *tp, u16 index, u16 byteen, u16 size, void *data) in usb_ocp_write() argument
1482 return generic_ocp_write(tp, index, byteen, size, data, MCU_TYPE_USB); in usb_ocp_write()
1485 static u32 ocp_read_dword(struct r8152 *tp, u16 type, u16 index) in ocp_read_dword() argument
1489 generic_ocp_read(tp, index, sizeof(data), &data, type); in ocp_read_dword()
1494 static void ocp_write_dword(struct r8152 *tp, u16 type, u16 index, u32 data) in ocp_write_dword() argument
1498 generic_ocp_write(tp, index, BYTE_EN_DWORD, sizeof(tmp), &tmp, type); in ocp_write_dword()
1501 static u16 ocp_read_word(struct r8152 *tp, u16 type, u16 index) in ocp_read_word() argument
1511 generic_ocp_read(tp, index, sizeof(tmp), &tmp, type | byen); in ocp_read_word()
1520 static void ocp_write_word(struct r8152 *tp, u16 type, u16 index, u32 data) in ocp_write_word() argument
1538 generic_ocp_write(tp, index, byen, sizeof(tmp), &tmp, type); in ocp_write_word()
1541 static u8 ocp_read_byte(struct r8152 *tp, u16 type, u16 index) in ocp_read_byte() argument
1549 generic_ocp_read(tp, index, sizeof(tmp), &tmp, type); in ocp_read_byte()
1558 static void ocp_write_byte(struct r8152 *tp, u16 type, u16 index, u32 data) in ocp_write_byte() argument
1576 generic_ocp_write(tp, index, byen, sizeof(tmp), &tmp, type); in ocp_write_byte()
1579 static u16 ocp_reg_read(struct r8152 *tp, u16 addr) in ocp_reg_read() argument
1584 if (ocp_base != tp->ocp_base) { in ocp_reg_read()
1585 ocp_write_word(tp, MCU_TYPE_PLA, PLA_OCP_GPHY_BASE, ocp_base); in ocp_reg_read()
1586 tp->ocp_base = ocp_base; in ocp_reg_read()
1590 return ocp_read_word(tp, MCU_TYPE_PLA, ocp_index); in ocp_reg_read()
1593 static void ocp_reg_write(struct r8152 *tp, u16 addr, u16 data) in ocp_reg_write() argument
1598 if (ocp_base != tp->ocp_base) { in ocp_reg_write()
1599 ocp_write_word(tp, MCU_TYPE_PLA, PLA_OCP_GPHY_BASE, ocp_base); in ocp_reg_write()
1600 tp->ocp_base = ocp_base; in ocp_reg_write()
1604 ocp_write_word(tp, MCU_TYPE_PLA, ocp_index, data); in ocp_reg_write()
1607 static inline void r8152_mdio_write(struct r8152 *tp, u32 reg_addr, u32 value) in r8152_mdio_write() argument
1609 ocp_reg_write(tp, OCP_BASE_MII + reg_addr * 2, value); in r8152_mdio_write()
1612 static inline int r8152_mdio_read(struct r8152 *tp, u32 reg_addr) in r8152_mdio_read() argument
1614 return ocp_reg_read(tp, OCP_BASE_MII + reg_addr * 2); in r8152_mdio_read()
1617 static void sram_write(struct r8152 *tp, u16 addr, u16 data) in sram_write() argument
1619 ocp_reg_write(tp, OCP_SRAM_ADDR, addr); in sram_write()
1620 ocp_reg_write(tp, OCP_SRAM_DATA, data); in sram_write()
1623 static u16 sram_read(struct r8152 *tp, u16 addr) in sram_read() argument
1625 ocp_reg_write(tp, OCP_SRAM_ADDR, addr); in sram_read()
1626 return ocp_reg_read(tp, OCP_SRAM_DATA); in sram_read()
1631 struct r8152 *tp = netdev_priv(netdev); in read_mii_word() local
1634 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in read_mii_word()
1640 ret = r8152_mdio_read(tp, reg); in read_mii_word()
1648 struct r8152 *tp = netdev_priv(netdev); in write_mii_word() local
1650 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in write_mii_word()
1656 r8152_mdio_write(tp, reg, val); in write_mii_word()
1660 r8152_submit_rx(struct r8152 *tp, struct rx_agg *agg, gfp_t mem_flags);
1663 rtl8152_set_speed(struct r8152 *tp, u8 autoneg, u32 speed, u8 duplex,
1669 struct r8152 *tp = netdev_priv(netdev); in __rtl8152_set_mac_address() local
1677 ret = usb_autopm_get_interface(tp->intf); in __rtl8152_set_mac_address()
1682 mutex_lock(&tp->control); in __rtl8152_set_mac_address()
1686 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CRWECR, CRWECR_CONFIG); in __rtl8152_set_mac_address()
1687 pla_ocp_write(tp, PLA_IDR, BYTE_EN_SIX_BYTES, 8, addr->sa_data); in __rtl8152_set_mac_address()
1688 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CRWECR, CRWECR_NORAML); in __rtl8152_set_mac_address()
1690 mutex_unlock(&tp->control); in __rtl8152_set_mac_address()
1693 usb_autopm_put_interface(tp->intf); in __rtl8152_set_mac_address()
1707 static int vendor_mac_passthru_addr_read(struct r8152 *tp, struct sockaddr *sa) in vendor_mac_passthru_addr_read() argument
1719 if (tp->lenovo_macpassthru) { in vendor_mac_passthru_addr_read()
1725 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_MISC_0); in vendor_mac_passthru_addr_read()
1728 ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, EFUSE); in vendor_mac_passthru_addr_read()
1730 netif_dbg(tp, probe, tp->netdev, in vendor_mac_passthru_addr_read()
1736 ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_MISC_1); in vendor_mac_passthru_addr_read()
1738 netif_dbg(tp, probe, tp->netdev, in vendor_mac_passthru_addr_read()
1755 netif_warn(tp, probe, tp->netdev, in vendor_mac_passthru_addr_read()
1763 netif_warn(tp, probe, tp->netdev, in vendor_mac_passthru_addr_read()
1769 netif_warn(tp, probe, tp->netdev, in vendor_mac_passthru_addr_read()
1776 netif_info(tp, probe, tp->netdev, in vendor_mac_passthru_addr_read()
1784 static int determine_ethernet_addr(struct r8152 *tp, struct sockaddr *sa) in determine_ethernet_addr() argument
1786 struct net_device *dev = tp->netdev; in determine_ethernet_addr()
1791 ret = eth_platform_get_mac_address(&tp->udev->dev, sa->sa_data); in determine_ethernet_addr()
1793 if (tp->version == RTL_VER_01) { in determine_ethernet_addr()
1794 ret = pla_ocp_read(tp, PLA_IDR, 8, sa->sa_data); in determine_ethernet_addr()
1799 ret = vendor_mac_passthru_addr_read(tp, sa); in determine_ethernet_addr()
1801 ret = pla_ocp_read(tp, PLA_BACKUP, 8, in determine_ethernet_addr()
1807 netif_err(tp, probe, dev, "Get ether addr fail\n"); in determine_ethernet_addr()
1809 netif_err(tp, probe, dev, "Invalid ether addr %pM\n", in determine_ethernet_addr()
1813 netif_info(tp, probe, dev, "Random ether addr %pM\n", in determine_ethernet_addr()
1821 static int set_ethernet_addr(struct r8152 *tp, bool in_resume) in set_ethernet_addr() argument
1823 struct net_device *dev = tp->netdev; in set_ethernet_addr()
1827 ret = determine_ethernet_addr(tp, &sa); in set_ethernet_addr()
1831 if (tp->version == RTL_VER_01) in set_ethernet_addr()
1844 struct r8152 *tp; in read_bulk_callback() local
1851 tp = agg->context; in read_bulk_callback()
1852 if (!tp) in read_bulk_callback()
1855 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in read_bulk_callback()
1858 if (!test_bit(WORK_ENABLE, &tp->flags)) in read_bulk_callback()
1861 netdev = tp->netdev; in read_bulk_callback()
1868 usb_mark_last_busy(tp->udev); in read_bulk_callback()
1875 spin_lock_irqsave(&tp->rx_lock, flags); in read_bulk_callback()
1876 list_add_tail(&agg->list, &tp->rx_done); in read_bulk_callback()
1877 spin_unlock_irqrestore(&tp->rx_lock, flags); in read_bulk_callback()
1878 napi_schedule(&tp->napi); in read_bulk_callback()
1881 rtl_set_unplug(tp); in read_bulk_callback()
1882 netif_device_detach(tp->netdev); in read_bulk_callback()
1886 spin_lock_irqsave(&tp->rx_lock, flags); in read_bulk_callback()
1887 list_add_tail(&agg->list, &tp->rx_done); in read_bulk_callback()
1888 spin_unlock_irqrestore(&tp->rx_lock, flags); in read_bulk_callback()
1889 set_bit(RX_EPROTO, &tp->flags); in read_bulk_callback()
1890 schedule_delayed_work(&tp->schedule, 1); in read_bulk_callback()
1904 r8152_submit_rx(tp, agg, GFP_ATOMIC); in read_bulk_callback()
1912 struct r8152 *tp; in write_bulk_callback() local
1920 tp = agg->context; in write_bulk_callback()
1921 if (!tp) in write_bulk_callback()
1924 netdev = tp->netdev; in write_bulk_callback()
1935 spin_lock_irqsave(&tp->tx_lock, flags); in write_bulk_callback()
1936 list_add_tail(&agg->list, &tp->tx_free); in write_bulk_callback()
1937 spin_unlock_irqrestore(&tp->tx_lock, flags); in write_bulk_callback()
1939 usb_autopm_put_interface_async(tp->intf); in write_bulk_callback()
1944 if (!test_bit(WORK_ENABLE, &tp->flags)) in write_bulk_callback()
1947 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in write_bulk_callback()
1950 if (!skb_queue_empty(&tp->tx_queue)) in write_bulk_callback()
1951 tasklet_schedule(&tp->tx_tl); in write_bulk_callback()
1956 struct r8152 *tp; in intr_callback() local
1961 tp = urb->context; in intr_callback()
1962 if (!tp) in intr_callback()
1965 if (!test_bit(WORK_ENABLE, &tp->flags)) in intr_callback()
1968 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in intr_callback()
1976 netif_device_detach(tp->netdev); in intr_callback()
1980 netif_info(tp, intr, tp->netdev, in intr_callback()
1985 netif_info(tp, intr, tp->netdev, in intr_callback()
1990 netif_info(tp, intr, tp->netdev, "intr status %d\n", status); in intr_callback()
1996 if (!netif_carrier_ok(tp->netdev)) { in intr_callback()
1997 set_bit(RTL8152_LINK_CHG, &tp->flags); in intr_callback()
1998 schedule_delayed_work(&tp->schedule, 0); in intr_callback()
2001 if (netif_carrier_ok(tp->netdev)) { in intr_callback()
2002 netif_stop_queue(tp->netdev); in intr_callback()
2003 set_bit(RTL8152_LINK_CHG, &tp->flags); in intr_callback()
2004 schedule_delayed_work(&tp->schedule, 0); in intr_callback()
2011 rtl_set_unplug(tp); in intr_callback()
2012 netif_device_detach(tp->netdev); in intr_callback()
2014 netif_err(tp, intr, tp->netdev, in intr_callback()
2029 static void free_rx_agg(struct r8152 *tp, struct rx_agg *agg) in free_rx_agg() argument
2037 atomic_dec(&tp->rx_count); in free_rx_agg()
2040 static struct rx_agg *alloc_rx_agg(struct r8152 *tp, gfp_t mflags) in alloc_rx_agg() argument
2042 struct net_device *netdev = tp->netdev; in alloc_rx_agg()
2044 unsigned int order = get_order(tp->rx_buf_sz); in alloc_rx_agg()
2062 rx_agg->context = tp; in alloc_rx_agg()
2066 spin_lock_irqsave(&tp->rx_lock, flags); in alloc_rx_agg()
2067 list_add_tail(&rx_agg->info_list, &tp->rx_info); in alloc_rx_agg()
2068 spin_unlock_irqrestore(&tp->rx_lock, flags); in alloc_rx_agg()
2070 atomic_inc(&tp->rx_count); in alloc_rx_agg()
2081 static void free_all_mem(struct r8152 *tp) in free_all_mem() argument
2087 spin_lock_irqsave(&tp->rx_lock, flags); in free_all_mem()
2089 list_for_each_entry_safe(agg, agg_next, &tp->rx_info, info_list) in free_all_mem()
2090 free_rx_agg(tp, agg); in free_all_mem()
2092 spin_unlock_irqrestore(&tp->rx_lock, flags); in free_all_mem()
2094 WARN_ON(atomic_read(&tp->rx_count)); in free_all_mem()
2097 usb_free_urb(tp->tx_info[i].urb); in free_all_mem()
2098 tp->tx_info[i].urb = NULL; in free_all_mem()
2100 kfree(tp->tx_info[i].buffer); in free_all_mem()
2101 tp->tx_info[i].buffer = NULL; in free_all_mem()
2102 tp->tx_info[i].head = NULL; in free_all_mem()
2105 usb_free_urb(tp->intr_urb); in free_all_mem()
2106 tp->intr_urb = NULL; in free_all_mem()
2108 kfree(tp->intr_buff); in free_all_mem()
2109 tp->intr_buff = NULL; in free_all_mem()
2112 static int alloc_all_mem(struct r8152 *tp) in alloc_all_mem() argument
2114 struct net_device *netdev = tp->netdev; in alloc_all_mem()
2115 struct usb_interface *intf = tp->intf; in alloc_all_mem()
2122 spin_lock_init(&tp->rx_lock); in alloc_all_mem()
2123 spin_lock_init(&tp->tx_lock); in alloc_all_mem()
2124 INIT_LIST_HEAD(&tp->rx_info); in alloc_all_mem()
2125 INIT_LIST_HEAD(&tp->tx_free); in alloc_all_mem()
2126 INIT_LIST_HEAD(&tp->rx_done); in alloc_all_mem()
2127 skb_queue_head_init(&tp->tx_queue); in alloc_all_mem()
2128 skb_queue_head_init(&tp->rx_queue); in alloc_all_mem()
2129 atomic_set(&tp->rx_count, 0); in alloc_all_mem()
2132 if (!alloc_rx_agg(tp, GFP_KERNEL)) in alloc_all_mem()
2158 INIT_LIST_HEAD(&tp->tx_info[i].list); in alloc_all_mem()
2159 tp->tx_info[i].context = tp; in alloc_all_mem()
2160 tp->tx_info[i].urb = urb; in alloc_all_mem()
2161 tp->tx_info[i].buffer = buf; in alloc_all_mem()
2162 tp->tx_info[i].head = tx_agg_align(buf); in alloc_all_mem()
2164 list_add_tail(&tp->tx_info[i].list, &tp->tx_free); in alloc_all_mem()
2167 tp->intr_urb = usb_alloc_urb(0, GFP_KERNEL); in alloc_all_mem()
2168 if (!tp->intr_urb) in alloc_all_mem()
2171 tp->intr_buff = kmalloc(INTBUFSIZE, GFP_KERNEL); in alloc_all_mem()
2172 if (!tp->intr_buff) in alloc_all_mem()
2175 tp->intr_interval = (int)ep_intr->desc.bInterval; in alloc_all_mem()
2176 usb_fill_int_urb(tp->intr_urb, tp->udev, tp->pipe_intr, in alloc_all_mem()
2177 tp->intr_buff, INTBUFSIZE, intr_callback, in alloc_all_mem()
2178 tp, tp->intr_interval); in alloc_all_mem()
2183 free_all_mem(tp); in alloc_all_mem()
2187 static struct tx_agg *r8152_get_tx_agg(struct r8152 *tp) in r8152_get_tx_agg() argument
2192 if (list_empty(&tp->tx_free)) in r8152_get_tx_agg()
2195 spin_lock_irqsave(&tp->tx_lock, flags); in r8152_get_tx_agg()
2196 if (!list_empty(&tp->tx_free)) { in r8152_get_tx_agg()
2199 cursor = tp->tx_free.next; in r8152_get_tx_agg()
2203 spin_unlock_irqrestore(&tp->tx_lock, flags); in r8152_get_tx_agg()
2212 static void r8152_csum_workaround(struct r8152 *tp, struct sk_buff *skb, in r8152_csum_workaround() argument
2216 netdev_features_t features = tp->netdev->features; in r8152_csum_workaround()
2243 stats = &tp->netdev->stats; in r8152_csum_workaround()
2268 static int r8152_tx_csum(struct r8152 *tp, struct tx_desc *desc, in r8152_tx_csum() argument
2283 netif_warn(tp, tx_err, tp->netdev, in r8152_tx_csum()
2316 netif_warn(tp, tx_err, tp->netdev, in r8152_tx_csum()
2356 static int r8152_tx_agg_fill(struct r8152 *tp, struct tx_agg *agg) in r8152_tx_agg_fill() argument
2358 struct sk_buff_head skb_head, *tx_queue = &tp->tx_queue; in r8152_tx_agg_fill()
2391 if (r8152_tx_csum(tp, tx_desc, skb, skb->len)) { in r8152_tx_agg_fill()
2392 r8152_csum_workaround(tp, skb, &skb_head); in r8152_tx_agg_fill()
2402 struct net_device_stats *stats = &tp->netdev->stats; in r8152_tx_agg_fill()
2418 if (tp->dell_tb_rx_agg_bug) in r8152_tx_agg_fill()
2428 netif_tx_lock(tp->netdev); in r8152_tx_agg_fill()
2430 if (netif_queue_stopped(tp->netdev) && in r8152_tx_agg_fill()
2431 skb_queue_len(&tp->tx_queue) < tp->tx_qlen) in r8152_tx_agg_fill()
2432 netif_wake_queue(tp->netdev); in r8152_tx_agg_fill()
2434 netif_tx_unlock(tp->netdev); in r8152_tx_agg_fill()
2436 ret = usb_autopm_get_interface_async(tp->intf); in r8152_tx_agg_fill()
2440 usb_fill_bulk_urb(agg->urb, tp->udev, tp->pipe_out, in r8152_tx_agg_fill()
2446 usb_autopm_put_interface_async(tp->intf); in r8152_tx_agg_fill()
2452 static u8 r8152_rx_csum(struct r8152 *tp, struct rx_desc *rx_desc) in r8152_rx_csum() argument
2457 if (!(tp->netdev->features & NETIF_F_RXCSUM)) in r8152_rx_csum()
2481 static inline bool rx_count_exceed(struct r8152 *tp) in rx_count_exceed() argument
2483 return atomic_read(&tp->rx_count) > RTL8152_MAX_RX; in rx_count_exceed()
2491 static struct rx_agg *rtl_get_free_rx(struct r8152 *tp, gfp_t mflags) in rtl_get_free_rx() argument
2496 spin_lock_irqsave(&tp->rx_lock, flags); in rtl_get_free_rx()
2498 list_for_each_entry_safe(agg, agg_next, &tp->rx_used, list) { in rtl_get_free_rx()
2505 if (rx_count_exceed(tp)) { in rtl_get_free_rx()
2507 free_rx_agg(tp, agg); in rtl_get_free_rx()
2513 spin_unlock_irqrestore(&tp->rx_lock, flags); in rtl_get_free_rx()
2515 if (!agg_free && atomic_read(&tp->rx_count) < tp->rx_pending) in rtl_get_free_rx()
2516 agg_free = alloc_rx_agg(tp, mflags); in rtl_get_free_rx()
2521 static int rx_bottom(struct r8152 *tp, int budget) in rx_bottom() argument
2526 struct napi_struct *napi = &tp->napi; in rx_bottom()
2528 if (!skb_queue_empty(&tp->rx_queue)) { in rx_bottom()
2530 struct sk_buff *skb = __skb_dequeue(&tp->rx_queue); in rx_bottom()
2531 struct net_device *netdev = tp->netdev; in rx_bottom()
2546 if (list_empty(&tp->rx_done)) in rx_bottom()
2549 clear_bit(RX_EPROTO, &tp->flags); in rx_bottom()
2551 spin_lock_irqsave(&tp->rx_lock, flags); in rx_bottom()
2552 list_splice_init(&tp->rx_done, &rx_queue); in rx_bottom()
2553 spin_unlock_irqrestore(&tp->rx_lock, flags); in rx_bottom()
2569 agg_free = rtl_get_free_rx(tp, GFP_ATOMIC); in rx_bottom()
2576 struct net_device *netdev = tp->netdev; in rx_bottom()
2582 if (unlikely(skb_queue_len(&tp->rx_queue) >= 1000)) in rx_bottom()
2596 if (!agg_free || tp->rx_copybreak > pkt_len) in rx_bottom()
2599 rx_frag_head_sz = tp->rx_copybreak; in rx_bottom()
2607 skb->ip_summed = r8152_rx_csum(tp, rx_desc); in rx_bottom()
2628 __skb_queue_tail(&tp->rx_queue, skb); in rx_bottom()
2641 spin_lock_irqsave(&tp->rx_lock, flags); in rx_bottom()
2643 list_add(&agg_free->list, &tp->rx_used); in rx_bottom()
2645 list_add_tail(&agg->list, &tp->rx_used); in rx_bottom()
2649 spin_unlock_irqrestore(&tp->rx_lock, flags); in rx_bottom()
2654 ret = r8152_submit_rx(tp, agg, GFP_ATOMIC); in rx_bottom()
2662 spin_lock_irqsave(&tp->rx_lock, flags); in rx_bottom()
2663 list_splice_tail(&rx_queue, &tp->rx_done); in rx_bottom()
2664 spin_unlock_irqrestore(&tp->rx_lock, flags); in rx_bottom()
2671 static void tx_bottom(struct r8152 *tp) in tx_bottom() argument
2676 struct net_device *netdev = tp->netdev; in tx_bottom()
2679 if (skb_queue_empty(&tp->tx_queue)) in tx_bottom()
2682 agg = r8152_get_tx_agg(tp); in tx_bottom()
2686 res = r8152_tx_agg_fill(tp, agg); in tx_bottom()
2691 rtl_set_unplug(tp); in tx_bottom()
2697 netif_warn(tp, tx_err, netdev, in tx_bottom()
2701 spin_lock_irqsave(&tp->tx_lock, flags); in tx_bottom()
2702 list_add_tail(&agg->list, &tp->tx_free); in tx_bottom()
2703 spin_unlock_irqrestore(&tp->tx_lock, flags); in tx_bottom()
2710 struct r8152 *tp = from_tasklet(tp, t, tx_tl); in bottom_half() local
2712 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in bottom_half()
2715 if (!test_bit(WORK_ENABLE, &tp->flags)) in bottom_half()
2720 if (!netif_carrier_ok(tp->netdev)) in bottom_half()
2723 clear_bit(SCHEDULE_TASKLET, &tp->flags); in bottom_half()
2725 tx_bottom(tp); in bottom_half()
2730 struct r8152 *tp = container_of(napi, struct r8152, napi); in r8152_poll() local
2736 work_done = rx_bottom(tp, budget); in r8152_poll()
2741 if (!list_empty(&tp->rx_done)) in r8152_poll()
2750 int r8152_submit_rx(struct r8152 *tp, struct rx_agg *agg, gfp_t mem_flags) in r8152_submit_rx() argument
2755 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags) || in r8152_submit_rx()
2756 !test_bit(WORK_ENABLE, &tp->flags) || !netif_carrier_ok(tp->netdev)) in r8152_submit_rx()
2759 usb_fill_bulk_urb(agg->urb, tp->udev, tp->pipe_in, in r8152_submit_rx()
2760 agg->buffer, tp->rx_buf_sz, in r8152_submit_rx()
2765 rtl_set_unplug(tp); in r8152_submit_rx()
2766 netif_device_detach(tp->netdev); in r8152_submit_rx()
2772 spin_lock_irqsave(&tp->rx_lock, flags); in r8152_submit_rx()
2773 list_add_tail(&agg->list, &tp->rx_done); in r8152_submit_rx()
2774 spin_unlock_irqrestore(&tp->rx_lock, flags); in r8152_submit_rx()
2776 netif_err(tp, rx_err, tp->netdev, in r8152_submit_rx()
2779 napi_schedule(&tp->napi); in r8152_submit_rx()
2785 static void rtl_drop_queued_tx(struct r8152 *tp) in rtl_drop_queued_tx() argument
2787 struct net_device_stats *stats = &tp->netdev->stats; in rtl_drop_queued_tx()
2788 struct sk_buff_head skb_head, *tx_queue = &tp->tx_queue; in rtl_drop_queued_tx()
2807 struct r8152 *tp = netdev_priv(netdev); in rtl8152_tx_timeout() local
2809 netif_warn(tp, tx_err, netdev, "Tx timeout\n"); in rtl8152_tx_timeout()
2811 usb_queue_reset_device(tp->intf); in rtl8152_tx_timeout()
2816 struct r8152 *tp = netdev_priv(netdev); in rtl8152_set_rx_mode() local
2819 set_bit(RTL8152_SET_RX_MODE, &tp->flags); in rtl8152_set_rx_mode()
2820 schedule_delayed_work(&tp->schedule, 0); in rtl8152_set_rx_mode()
2826 struct r8152 *tp = netdev_priv(netdev); in _rtl8152_set_rx_mode() local
2832 ocp_data = ocp_read_dword(tp, MCU_TYPE_PLA, PLA_RCR); in _rtl8152_set_rx_mode()
2838 netif_notice(tp, link, netdev, "Promiscuous mode enabled\n"); in _rtl8152_set_rx_mode()
2868 pla_ocp_write(tp, PLA_MAR, BYTE_EN_DWORD, sizeof(tmp), tmp); in _rtl8152_set_rx_mode()
2869 ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RCR, ocp_data); in _rtl8152_set_rx_mode()
2892 struct r8152 *tp = netdev_priv(netdev); in rtl8152_start_xmit() local
2896 skb_queue_tail(&tp->tx_queue, skb); in rtl8152_start_xmit()
2898 if (!list_empty(&tp->tx_free)) { in rtl8152_start_xmit()
2899 if (test_bit(SELECTIVE_SUSPEND, &tp->flags)) { in rtl8152_start_xmit()
2900 set_bit(SCHEDULE_TASKLET, &tp->flags); in rtl8152_start_xmit()
2901 schedule_delayed_work(&tp->schedule, 0); in rtl8152_start_xmit()
2903 usb_mark_last_busy(tp->udev); in rtl8152_start_xmit()
2904 tasklet_schedule(&tp->tx_tl); in rtl8152_start_xmit()
2906 } else if (skb_queue_len(&tp->tx_queue) > tp->tx_qlen) { in rtl8152_start_xmit()
2913 static void r8152b_reset_packet_filter(struct r8152 *tp) in r8152b_reset_packet_filter() argument
2917 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_FMC); in r8152b_reset_packet_filter()
2919 ocp_write_word(tp, MCU_TYPE_PLA, PLA_FMC, ocp_data); in r8152b_reset_packet_filter()
2921 ocp_write_word(tp, MCU_TYPE_PLA, PLA_FMC, ocp_data); in r8152b_reset_packet_filter()
2924 static void rtl8152_nic_reset(struct r8152 *tp) in rtl8152_nic_reset() argument
2929 switch (tp->version) { in rtl8152_nic_reset()
2933 ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_CR); in rtl8152_nic_reset()
2935 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CR, ocp_data); in rtl8152_nic_reset()
2937 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_BMU_RESET); in rtl8152_nic_reset()
2939 ocp_write_word(tp, MCU_TYPE_USB, USB_BMU_RESET, ocp_data); in rtl8152_nic_reset()
2941 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_USB_CTRL); in rtl8152_nic_reset()
2943 ocp_write_word(tp, MCU_TYPE_USB, USB_USB_CTRL, ocp_data); in rtl8152_nic_reset()
2945 ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_CR); in rtl8152_nic_reset()
2947 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CR, ocp_data); in rtl8152_nic_reset()
2949 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_BMU_RESET); in rtl8152_nic_reset()
2951 ocp_write_word(tp, MCU_TYPE_USB, USB_BMU_RESET, ocp_data); in rtl8152_nic_reset()
2953 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_USB_CTRL); in rtl8152_nic_reset()
2955 ocp_write_word(tp, MCU_TYPE_USB, USB_USB_CTRL, ocp_data); in rtl8152_nic_reset()
2959 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CR, CR_RST); in rtl8152_nic_reset()
2962 if (!(ocp_read_byte(tp, MCU_TYPE_PLA, PLA_CR) & CR_RST)) in rtl8152_nic_reset()
2970 static void set_tx_qlen(struct r8152 *tp) in set_tx_qlen() argument
2972 tp->tx_qlen = agg_buf_sz / (mtu_to_size(tp->netdev->mtu) + sizeof(struct tx_desc)); in set_tx_qlen()
2975 static inline u16 rtl8152_get_speed(struct r8152 *tp) in rtl8152_get_speed() argument
2977 return ocp_read_word(tp, MCU_TYPE_PLA, PLA_PHYSTATUS); in rtl8152_get_speed()
2980 static void rtl_eee_plus_en(struct r8152 *tp, bool enable) in rtl_eee_plus_en() argument
2984 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_EEEP_CR); in rtl_eee_plus_en()
2989 ocp_write_word(tp, MCU_TYPE_PLA, PLA_EEEP_CR, ocp_data); in rtl_eee_plus_en()
2992 static void rtl_set_eee_plus(struct r8152 *tp) in rtl_set_eee_plus() argument
2994 if (rtl8152_get_speed(tp) & _10bps) in rtl_set_eee_plus()
2995 rtl_eee_plus_en(tp, true); in rtl_set_eee_plus()
2997 rtl_eee_plus_en(tp, false); in rtl_set_eee_plus()
3000 static void rxdy_gated_en(struct r8152 *tp, bool enable) in rxdy_gated_en() argument
3004 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_MISC_1); in rxdy_gated_en()
3009 ocp_write_word(tp, MCU_TYPE_PLA, PLA_MISC_1, ocp_data); in rxdy_gated_en()
3012 static int rtl_start_rx(struct r8152 *tp) in rtl_start_rx() argument
3021 spin_lock_irqsave(&tp->rx_lock, flags); in rtl_start_rx()
3023 INIT_LIST_HEAD(&tp->rx_done); in rtl_start_rx()
3024 INIT_LIST_HEAD(&tp->rx_used); in rtl_start_rx()
3026 list_splice_init(&tp->rx_info, &tmp_list); in rtl_start_rx()
3028 spin_unlock_irqrestore(&tp->rx_lock, flags); in rtl_start_rx()
3035 spin_lock_irqsave(&tp->rx_lock, flags); in rtl_start_rx()
3036 list_add_tail(&agg->list, &tp->rx_used); in rtl_start_rx()
3037 spin_unlock_irqrestore(&tp->rx_lock, flags); in rtl_start_rx()
3039 spin_lock_irqsave(&tp->rx_lock, flags); in rtl_start_rx()
3040 list_add_tail(&agg->list, &tp->rx_done); in rtl_start_rx()
3041 spin_unlock_irqrestore(&tp->rx_lock, flags); in rtl_start_rx()
3043 ret = r8152_submit_rx(tp, agg, GFP_KERNEL); in rtl_start_rx()
3047 spin_lock_irqsave(&tp->rx_lock, flags); in rtl_start_rx()
3048 WARN_ON(!list_empty(&tp->rx_info)); in rtl_start_rx()
3049 list_splice(&tmp_list, &tp->rx_info); in rtl_start_rx()
3050 spin_unlock_irqrestore(&tp->rx_lock, flags); in rtl_start_rx()
3055 static int rtl_stop_rx(struct r8152 *tp) in rtl_stop_rx() argument
3069 spin_lock_irqsave(&tp->rx_lock, flags); in rtl_stop_rx()
3070 list_splice_init(&tp->rx_info, &tmp_list); in rtl_stop_rx()
3071 spin_unlock_irqrestore(&tp->rx_lock, flags); in rtl_stop_rx()
3078 free_rx_agg(tp, agg); in rtl_stop_rx()
3084 spin_lock_irqsave(&tp->rx_lock, flags); in rtl_stop_rx()
3085 WARN_ON(!list_empty(&tp->rx_info)); in rtl_stop_rx()
3086 list_splice(&tmp_list, &tp->rx_info); in rtl_stop_rx()
3087 spin_unlock_irqrestore(&tp->rx_lock, flags); in rtl_stop_rx()
3089 while (!skb_queue_empty(&tp->rx_queue)) in rtl_stop_rx()
3090 dev_kfree_skb(__skb_dequeue(&tp->rx_queue)); in rtl_stop_rx()
3095 static void rtl_set_ifg(struct r8152 *tp, u16 speed) in rtl_set_ifg() argument
3099 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_TCR1); in rtl_set_ifg()
3103 ocp_write_word(tp, MCU_TYPE_PLA, PLA_TCR1, ocp_data); in rtl_set_ifg()
3105 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL4); in rtl_set_ifg()
3107 ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL4, ocp_data); in rtl_set_ifg()
3110 ocp_write_word(tp, MCU_TYPE_PLA, PLA_TCR1, ocp_data); in rtl_set_ifg()
3112 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL4); in rtl_set_ifg()
3114 ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL4, ocp_data); in rtl_set_ifg()
3118 static inline void r8153b_rx_agg_chg_indicate(struct r8152 *tp) in r8153b_rx_agg_chg_indicate() argument
3120 ocp_write_byte(tp, MCU_TYPE_USB, USB_UPT_RXDMA_OWN, in r8153b_rx_agg_chg_indicate()
3124 static int rtl_enable(struct r8152 *tp) in rtl_enable() argument
3128 r8152b_reset_packet_filter(tp); in rtl_enable()
3130 ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_CR); in rtl_enable()
3132 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CR, ocp_data); in rtl_enable()
3134 switch (tp->version) { in rtl_enable()
3144 r8153b_rx_agg_chg_indicate(tp); in rtl_enable()
3148 rxdy_gated_en(tp, false); in rtl_enable()
3153 static int rtl8152_enable(struct r8152 *tp) in rtl8152_enable() argument
3155 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in rtl8152_enable()
3158 set_tx_qlen(tp); in rtl8152_enable()
3159 rtl_set_eee_plus(tp); in rtl8152_enable()
3161 return rtl_enable(tp); in rtl8152_enable()
3164 static void r8153_set_rx_early_timeout(struct r8152 *tp) in r8153_set_rx_early_timeout() argument
3166 u32 ocp_data = tp->coalesce / 8; in r8153_set_rx_early_timeout()
3168 switch (tp->version) { in r8153_set_rx_early_timeout()
3173 ocp_write_word(tp, MCU_TYPE_USB, USB_RX_EARLY_TIMEOUT, in r8153_set_rx_early_timeout()
3183 ocp_write_word(tp, MCU_TYPE_USB, USB_RX_EARLY_TIMEOUT, in r8153_set_rx_early_timeout()
3185 ocp_write_word(tp, MCU_TYPE_USB, USB_RX_EXTRA_AGGR_TMR, in r8153_set_rx_early_timeout()
3194 ocp_write_word(tp, MCU_TYPE_USB, USB_RX_EARLY_TIMEOUT, in r8153_set_rx_early_timeout()
3196 ocp_write_word(tp, MCU_TYPE_USB, USB_RX_EXTRA_AGGR_TMR, in r8153_set_rx_early_timeout()
3205 static void r8153_set_rx_early_size(struct r8152 *tp) in r8153_set_rx_early_size() argument
3207 u32 ocp_data = tp->rx_buf_sz - rx_reserved_size(tp->netdev->mtu); in r8153_set_rx_early_size()
3209 switch (tp->version) { in r8153_set_rx_early_size()
3214 ocp_write_word(tp, MCU_TYPE_USB, USB_RX_EARLY_SIZE, in r8153_set_rx_early_size()
3220 ocp_write_word(tp, MCU_TYPE_USB, USB_RX_EARLY_SIZE, in r8153_set_rx_early_size()
3229 ocp_write_word(tp, MCU_TYPE_USB, USB_RX_EARLY_SIZE, in r8153_set_rx_early_size()
3238 static int rtl8153_enable(struct r8152 *tp) in rtl8153_enable() argument
3242 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in rtl8153_enable()
3245 set_tx_qlen(tp); in rtl8153_enable()
3246 rtl_set_eee_plus(tp); in rtl8153_enable()
3247 r8153_set_rx_early_timeout(tp); in rtl8153_enable()
3248 r8153_set_rx_early_size(tp); in rtl8153_enable()
3250 rtl_set_ifg(tp, rtl8152_get_speed(tp)); in rtl8153_enable()
3252 switch (tp->version) { in rtl8153_enable()
3255 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_FW_TASK); in rtl8153_enable()
3257 ocp_write_word(tp, MCU_TYPE_USB, USB_FW_TASK, ocp_data); in rtl8153_enable()
3260 ocp_write_word(tp, MCU_TYPE_USB, USB_FW_TASK, ocp_data); in rtl8153_enable()
3266 return rtl_enable(tp); in rtl8153_enable()
3269 static void rtl_disable(struct r8152 *tp) in rtl_disable() argument
3274 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) { in rtl_disable()
3275 rtl_drop_queued_tx(tp); in rtl_disable()
3279 ocp_data = ocp_read_dword(tp, MCU_TYPE_PLA, PLA_RCR); in rtl_disable()
3281 ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RCR, ocp_data); in rtl_disable()
3283 rtl_drop_queued_tx(tp); in rtl_disable()
3286 usb_kill_urb(tp->tx_info[i].urb); in rtl_disable()
3288 rxdy_gated_en(tp, true); in rtl_disable()
3291 ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL); in rtl_disable()
3298 if (ocp_read_word(tp, MCU_TYPE_PLA, PLA_TCR0) & TCR0_TX_EMPTY) in rtl_disable()
3303 rtl_stop_rx(tp); in rtl_disable()
3305 rtl8152_nic_reset(tp); in rtl_disable()
3308 static void r8152_power_cut_en(struct r8152 *tp, bool enable) in r8152_power_cut_en() argument
3312 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_UPS_CTRL); in r8152_power_cut_en()
3317 ocp_write_word(tp, MCU_TYPE_USB, USB_UPS_CTRL, ocp_data); in r8152_power_cut_en()
3319 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_PM_CTRL_STATUS); in r8152_power_cut_en()
3321 ocp_write_word(tp, MCU_TYPE_USB, USB_PM_CTRL_STATUS, ocp_data); in r8152_power_cut_en()
3324 static void rtl_rx_vlan_en(struct r8152 *tp, bool enable) in rtl_rx_vlan_en() argument
3328 switch (tp->version) { in rtl_rx_vlan_en()
3339 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_CPCR); in rtl_rx_vlan_en()
3344 ocp_write_word(tp, MCU_TYPE_PLA, PLA_CPCR, ocp_data); in rtl_rx_vlan_en()
3354 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_RCR1); in rtl_rx_vlan_en()
3359 ocp_write_word(tp, MCU_TYPE_PLA, PLA_RCR1, ocp_data); in rtl_rx_vlan_en()
3368 struct r8152 *tp = netdev_priv(dev); in rtl8152_set_features() local
3371 ret = usb_autopm_get_interface(tp->intf); in rtl8152_set_features()
3375 mutex_lock(&tp->control); in rtl8152_set_features()
3379 rtl_rx_vlan_en(tp, true); in rtl8152_set_features()
3381 rtl_rx_vlan_en(tp, false); in rtl8152_set_features()
3384 mutex_unlock(&tp->control); in rtl8152_set_features()
3386 usb_autopm_put_interface(tp->intf); in rtl8152_set_features()
3394 static u32 __rtl_get_wol(struct r8152 *tp) in __rtl_get_wol() argument
3399 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_CONFIG34); in __rtl_get_wol()
3403 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_CONFIG5); in __rtl_get_wol()
3411 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_CFG_WOL); in __rtl_get_wol()
3418 static void __rtl_set_wol(struct r8152 *tp, u32 wolopts) in __rtl_set_wol() argument
3422 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CRWECR, CRWECR_CONFIG); in __rtl_set_wol()
3424 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_CONFIG34); in __rtl_set_wol()
3428 ocp_write_word(tp, MCU_TYPE_PLA, PLA_CONFIG34, ocp_data); in __rtl_set_wol()
3430 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_CONFIG5); in __rtl_set_wol()
3438 ocp_write_word(tp, MCU_TYPE_PLA, PLA_CONFIG5, ocp_data); in __rtl_set_wol()
3440 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CRWECR, CRWECR_NORAML); in __rtl_set_wol()
3442 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_CFG_WOL); in __rtl_set_wol()
3446 ocp_write_word(tp, MCU_TYPE_PLA, PLA_CFG_WOL, ocp_data); in __rtl_set_wol()
3449 device_set_wakeup_enable(&tp->udev->dev, true); in __rtl_set_wol()
3451 device_set_wakeup_enable(&tp->udev->dev, false); in __rtl_set_wol()
3454 static void r8153_mac_clk_speed_down(struct r8152 *tp, bool enable) in r8153_mac_clk_speed_down() argument
3456 u32 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL2); in r8153_mac_clk_speed_down()
3464 ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL2, ocp_data); in r8153_mac_clk_speed_down()
3467 static void r8156_mac_clk_spd(struct r8152 *tp, bool enable) in r8156_mac_clk_spd() argument
3474 ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL, in r8156_mac_clk_spd()
3477 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL2); in r8156_mac_clk_spd()
3480 ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL2, ocp_data); in r8156_mac_clk_spd()
3482 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL2); in r8156_mac_clk_spd()
3484 ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL2, ocp_data); in r8156_mac_clk_spd()
3488 static void r8153_u1u2en(struct r8152 *tp, bool enable) in r8153_u1u2en() argument
3497 usb_ocp_write(tp, USB_TOLERANCE, BYTE_EN_SIX_BYTES, sizeof(u1u2), u1u2); in r8153_u1u2en()
3500 static void r8153b_u1u2en(struct r8152 *tp, bool enable) in r8153b_u1u2en() argument
3504 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_LPM_CONFIG); in r8153b_u1u2en()
3510 ocp_write_word(tp, MCU_TYPE_USB, USB_LPM_CONFIG, ocp_data); in r8153b_u1u2en()
3513 static void r8153_u2p3en(struct r8152 *tp, bool enable) in r8153_u2p3en() argument
3517 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_U2P3_CTRL); in r8153_u2p3en()
3522 ocp_write_word(tp, MCU_TYPE_USB, USB_U2P3_CTRL, ocp_data); in r8153_u2p3en()
3525 static void r8153b_ups_flags(struct r8152 *tp) in r8153b_ups_flags() argument
3529 if (tp->ups_info.green) in r8153b_ups_flags()
3532 if (tp->ups_info.aldps) in r8153b_ups_flags()
3535 if (tp->ups_info.eee) in r8153b_ups_flags()
3538 if (tp->ups_info.flow_control) in r8153b_ups_flags()
3541 if (tp->ups_info.eee_ckdiv) in r8153b_ups_flags()
3544 if (tp->ups_info.eee_cmod_lv) in r8153b_ups_flags()
3547 if (tp->ups_info.r_tune) in r8153b_ups_flags()
3550 if (tp->ups_info._10m_ckdiv) in r8153b_ups_flags()
3553 if (tp->ups_info.eee_plloff_100) in r8153b_ups_flags()
3556 if (tp->ups_info.eee_plloff_giga) in r8153b_ups_flags()
3559 if (tp->ups_info._250m_ckdiv) in r8153b_ups_flags()
3562 if (tp->ups_info.ctap_short_off) in r8153b_ups_flags()
3565 switch (tp->ups_info.speed_duplex) { in r8153b_ups_flags()
3597 ocp_write_dword(tp, MCU_TYPE_USB, USB_UPS_FLAGS, ups_flags); in r8153b_ups_flags()
3600 static void r8156_ups_flags(struct r8152 *tp) in r8156_ups_flags() argument
3604 if (tp->ups_info.green) in r8156_ups_flags()
3607 if (tp->ups_info.aldps) in r8156_ups_flags()
3610 if (tp->ups_info.eee) in r8156_ups_flags()
3613 if (tp->ups_info.flow_control) in r8156_ups_flags()
3616 if (tp->ups_info.eee_ckdiv) in r8156_ups_flags()
3619 if (tp->ups_info._10m_ckdiv) in r8156_ups_flags()
3622 if (tp->ups_info.eee_plloff_100) in r8156_ups_flags()
3625 if (tp->ups_info.eee_plloff_giga) in r8156_ups_flags()
3628 if (tp->ups_info._250m_ckdiv) in r8156_ups_flags()
3631 switch (tp->ups_info.speed_duplex) { in r8156_ups_flags()
3666 switch (tp->ups_info.lite_mode) { in r8156_ups_flags()
3679 ocp_write_dword(tp, MCU_TYPE_USB, USB_UPS_FLAGS, ups_flags); in r8156_ups_flags()
3682 static void rtl_green_en(struct r8152 *tp, bool enable) in rtl_green_en() argument
3686 data = sram_read(tp, SRAM_GREEN_CFG); in rtl_green_en()
3691 sram_write(tp, SRAM_GREEN_CFG, data); in rtl_green_en()
3693 tp->ups_info.green = enable; in rtl_green_en()
3696 static void r8153b_green_en(struct r8152 *tp, bool enable) in r8153b_green_en() argument
3699 sram_write(tp, 0x8045, 0); /* 10M abiq&ldvbias */ in r8153b_green_en()
3700 sram_write(tp, 0x804d, 0x1222); /* 100M short abiq&ldvbias */ in r8153b_green_en()
3701 sram_write(tp, 0x805d, 0x0022); /* 1000M short abiq&ldvbias */ in r8153b_green_en()
3703 sram_write(tp, 0x8045, 0x2444); /* 10M abiq&ldvbias */ in r8153b_green_en()
3704 sram_write(tp, 0x804d, 0x2444); /* 100M short abiq&ldvbias */ in r8153b_green_en()
3705 sram_write(tp, 0x805d, 0x2444); /* 1000M short abiq&ldvbias */ in r8153b_green_en()
3708 rtl_green_en(tp, true); in r8153b_green_en()
3711 static u16 r8153_phy_status(struct r8152 *tp, u16 desired) in r8153_phy_status() argument
3717 data = ocp_reg_read(tp, OCP_PHY_STATUS); in r8153_phy_status()
3728 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in r8153_phy_status()
3735 static void r8153b_ups_en(struct r8152 *tp, bool enable) in r8153b_ups_en() argument
3737 u32 ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_POWER_CUT); in r8153b_ups_en()
3740 r8153b_ups_flags(tp); in r8153b_ups_en()
3743 ocp_write_byte(tp, MCU_TYPE_USB, USB_POWER_CUT, ocp_data); in r8153b_ups_en()
3745 ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_MISC_2); in r8153b_ups_en()
3747 ocp_write_byte(tp, MCU_TYPE_USB, USB_MISC_2, ocp_data); in r8153b_ups_en()
3750 ocp_write_byte(tp, MCU_TYPE_USB, USB_POWER_CUT, ocp_data); in r8153b_ups_en()
3752 ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_MISC_2); in r8153b_ups_en()
3754 ocp_write_byte(tp, MCU_TYPE_USB, USB_MISC_2, ocp_data); in r8153b_ups_en()
3756 if (ocp_read_word(tp, MCU_TYPE_USB, USB_MISC_0) & PCUT_STATUS) { in r8153b_ups_en()
3760 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in r8153b_ups_en()
3762 if (ocp_read_word(tp, MCU_TYPE_PLA, PLA_BOOT_CTRL) & in r8153b_ups_en()
3768 tp->rtl_ops.hw_phy_cfg(tp); in r8153b_ups_en()
3770 rtl8152_set_speed(tp, tp->autoneg, tp->speed, in r8153b_ups_en()
3771 tp->duplex, tp->advertising); in r8153b_ups_en()
3776 static void r8153c_ups_en(struct r8152 *tp, bool enable) in r8153c_ups_en() argument
3778 u32 ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_POWER_CUT); in r8153c_ups_en()
3781 r8153b_ups_flags(tp); in r8153c_ups_en()
3784 ocp_write_byte(tp, MCU_TYPE_USB, USB_POWER_CUT, ocp_data); in r8153c_ups_en()
3786 ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_MISC_2); in r8153c_ups_en()
3789 ocp_write_byte(tp, MCU_TYPE_USB, USB_MISC_2, ocp_data); in r8153c_ups_en()
3792 ocp_write_byte(tp, MCU_TYPE_USB, USB_POWER_CUT, ocp_data); in r8153c_ups_en()
3794 ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_MISC_2); in r8153c_ups_en()
3796 ocp_write_byte(tp, MCU_TYPE_USB, USB_MISC_2, ocp_data); in r8153c_ups_en()
3798 if (ocp_read_word(tp, MCU_TYPE_USB, USB_MISC_0) & PCUT_STATUS) { in r8153c_ups_en()
3802 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in r8153c_ups_en()
3804 if (ocp_read_word(tp, MCU_TYPE_PLA, PLA_BOOT_CTRL) & in r8153c_ups_en()
3810 tp->rtl_ops.hw_phy_cfg(tp); in r8153c_ups_en()
3812 rtl8152_set_speed(tp, tp->autoneg, tp->speed, in r8153c_ups_en()
3813 tp->duplex, tp->advertising); in r8153c_ups_en()
3816 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CRWECR, CRWECR_CONFIG); in r8153c_ups_en()
3818 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_CONFIG34); in r8153c_ups_en()
3820 ocp_write_word(tp, MCU_TYPE_PLA, PLA_CONFIG34, ocp_data); in r8153c_ups_en()
3822 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CRWECR, CRWECR_NORAML); in r8153c_ups_en()
3826 static void r8156_ups_en(struct r8152 *tp, bool enable) in r8156_ups_en() argument
3828 u32 ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_POWER_CUT); in r8156_ups_en()
3831 r8156_ups_flags(tp); in r8156_ups_en()
3834 ocp_write_byte(tp, MCU_TYPE_USB, USB_POWER_CUT, ocp_data); in r8156_ups_en()
3836 ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_MISC_2); in r8156_ups_en()
3838 ocp_write_byte(tp, MCU_TYPE_USB, USB_MISC_2, ocp_data); in r8156_ups_en()
3840 switch (tp->version) { in r8156_ups_en()
3843 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_UPHY_XTAL); in r8156_ups_en()
3845 ocp_write_byte(tp, MCU_TYPE_USB, USB_UPHY_XTAL, ocp_data); in r8156_ups_en()
3852 ocp_write_byte(tp, MCU_TYPE_USB, USB_POWER_CUT, ocp_data); in r8156_ups_en()
3854 ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_MISC_2); in r8156_ups_en()
3856 ocp_write_byte(tp, MCU_TYPE_USB, USB_MISC_2, ocp_data); in r8156_ups_en()
3858 if (ocp_read_word(tp, MCU_TYPE_USB, USB_MISC_0) & PCUT_STATUS) { in r8156_ups_en()
3859 tp->rtl_ops.hw_phy_cfg(tp); in r8156_ups_en()
3861 rtl8152_set_speed(tp, tp->autoneg, tp->speed, in r8156_ups_en()
3862 tp->duplex, tp->advertising); in r8156_ups_en()
3867 static void r8153_power_cut_en(struct r8152 *tp, bool enable) in r8153_power_cut_en() argument
3871 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_POWER_CUT); in r8153_power_cut_en()
3876 ocp_write_word(tp, MCU_TYPE_USB, USB_POWER_CUT, ocp_data); in r8153_power_cut_en()
3878 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_MISC_0); in r8153_power_cut_en()
3880 ocp_write_word(tp, MCU_TYPE_USB, USB_MISC_0, ocp_data); in r8153_power_cut_en()
3883 static void r8153b_power_cut_en(struct r8152 *tp, bool enable) in r8153b_power_cut_en() argument
3887 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_POWER_CUT); in r8153b_power_cut_en()
3892 ocp_write_word(tp, MCU_TYPE_USB, USB_POWER_CUT, ocp_data); in r8153b_power_cut_en()
3894 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_MISC_0); in r8153b_power_cut_en()
3896 ocp_write_word(tp, MCU_TYPE_USB, USB_MISC_0, ocp_data); in r8153b_power_cut_en()
3899 static void r8153_queue_wake(struct r8152 *tp, bool enable) in r8153_queue_wake() argument
3903 ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_INDICATE_FALG); in r8153_queue_wake()
3908 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_INDICATE_FALG, ocp_data); in r8153_queue_wake()
3910 ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_SUSPEND_FLAG); in r8153_queue_wake()
3912 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_SUSPEND_FLAG, ocp_data); in r8153_queue_wake()
3914 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_EXTRA_STATUS); in r8153_queue_wake()
3916 ocp_write_word(tp, MCU_TYPE_PLA, PLA_EXTRA_STATUS, ocp_data); in r8153_queue_wake()
3919 static bool rtl_can_wakeup(struct r8152 *tp) in rtl_can_wakeup() argument
3921 struct usb_device *udev = tp->udev; in rtl_can_wakeup()
3926 static void rtl_runtime_suspend_enable(struct r8152 *tp, bool enable) in rtl_runtime_suspend_enable() argument
3931 __rtl_set_wol(tp, WAKE_ANY); in rtl_runtime_suspend_enable()
3933 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CRWECR, CRWECR_CONFIG); in rtl_runtime_suspend_enable()
3935 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_CONFIG34); in rtl_runtime_suspend_enable()
3937 ocp_write_word(tp, MCU_TYPE_PLA, PLA_CONFIG34, ocp_data); in rtl_runtime_suspend_enable()
3939 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CRWECR, CRWECR_NORAML); in rtl_runtime_suspend_enable()
3943 __rtl_set_wol(tp, tp->saved_wolopts); in rtl_runtime_suspend_enable()
3945 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CRWECR, CRWECR_CONFIG); in rtl_runtime_suspend_enable()
3947 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_CONFIG34); in rtl_runtime_suspend_enable()
3949 ocp_write_word(tp, MCU_TYPE_PLA, PLA_CONFIG34, ocp_data); in rtl_runtime_suspend_enable()
3951 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CRWECR, CRWECR_NORAML); in rtl_runtime_suspend_enable()
3955 static void rtl8153_runtime_enable(struct r8152 *tp, bool enable) in rtl8153_runtime_enable() argument
3958 r8153_u1u2en(tp, false); in rtl8153_runtime_enable()
3959 r8153_u2p3en(tp, false); in rtl8153_runtime_enable()
3960 rtl_runtime_suspend_enable(tp, true); in rtl8153_runtime_enable()
3962 rtl_runtime_suspend_enable(tp, false); in rtl8153_runtime_enable()
3964 switch (tp->version) { in rtl8153_runtime_enable()
3971 r8153_u2p3en(tp, true); in rtl8153_runtime_enable()
3975 r8153_u1u2en(tp, true); in rtl8153_runtime_enable()
3979 static void rtl8153b_runtime_enable(struct r8152 *tp, bool enable) in rtl8153b_runtime_enable() argument
3982 r8153_queue_wake(tp, true); in rtl8153b_runtime_enable()
3983 r8153b_u1u2en(tp, false); in rtl8153b_runtime_enable()
3984 r8153_u2p3en(tp, false); in rtl8153b_runtime_enable()
3985 rtl_runtime_suspend_enable(tp, true); in rtl8153b_runtime_enable()
3986 r8153b_ups_en(tp, true); in rtl8153b_runtime_enable()
3988 r8153b_ups_en(tp, false); in rtl8153b_runtime_enable()
3989 r8153_queue_wake(tp, false); in rtl8153b_runtime_enable()
3990 rtl_runtime_suspend_enable(tp, false); in rtl8153b_runtime_enable()
3991 if (tp->udev->speed >= USB_SPEED_SUPER) in rtl8153b_runtime_enable()
3992 r8153b_u1u2en(tp, true); in rtl8153b_runtime_enable()
3996 static void rtl8153c_runtime_enable(struct r8152 *tp, bool enable) in rtl8153c_runtime_enable() argument
3999 r8153_queue_wake(tp, true); in rtl8153c_runtime_enable()
4000 r8153b_u1u2en(tp, false); in rtl8153c_runtime_enable()
4001 r8153_u2p3en(tp, false); in rtl8153c_runtime_enable()
4002 rtl_runtime_suspend_enable(tp, true); in rtl8153c_runtime_enable()
4003 r8153c_ups_en(tp, true); in rtl8153c_runtime_enable()
4005 r8153c_ups_en(tp, false); in rtl8153c_runtime_enable()
4006 r8153_queue_wake(tp, false); in rtl8153c_runtime_enable()
4007 rtl_runtime_suspend_enable(tp, false); in rtl8153c_runtime_enable()
4008 r8153b_u1u2en(tp, true); in rtl8153c_runtime_enable()
4012 static void rtl8156_runtime_enable(struct r8152 *tp, bool enable) in rtl8156_runtime_enable() argument
4015 r8153_queue_wake(tp, true); in rtl8156_runtime_enable()
4016 r8153b_u1u2en(tp, false); in rtl8156_runtime_enable()
4017 r8153_u2p3en(tp, false); in rtl8156_runtime_enable()
4018 rtl_runtime_suspend_enable(tp, true); in rtl8156_runtime_enable()
4020 r8153_queue_wake(tp, false); in rtl8156_runtime_enable()
4021 rtl_runtime_suspend_enable(tp, false); in rtl8156_runtime_enable()
4022 r8153_u2p3en(tp, true); in rtl8156_runtime_enable()
4023 if (tp->udev->speed >= USB_SPEED_SUPER) in rtl8156_runtime_enable()
4024 r8153b_u1u2en(tp, true); in rtl8156_runtime_enable()
4028 static void r8153_teredo_off(struct r8152 *tp) in r8153_teredo_off() argument
4032 switch (tp->version) { in r8153_teredo_off()
4040 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_TEREDO_CFG); in r8153_teredo_off()
4043 ocp_write_word(tp, MCU_TYPE_PLA, PLA_TEREDO_CFG, ocp_data); in r8153_teredo_off()
4059 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_TEREDO_CFG, 0xff); in r8153_teredo_off()
4063 ocp_write_word(tp, MCU_TYPE_PLA, PLA_WDT6_CTRL, WDT6_SET_MODE); in r8153_teredo_off()
4064 ocp_write_word(tp, MCU_TYPE_PLA, PLA_REALWOW_TIMER, 0); in r8153_teredo_off()
4065 ocp_write_dword(tp, MCU_TYPE_PLA, PLA_TEREDO_TIMER, 0); in r8153_teredo_off()
4068 static void rtl_reset_bmu(struct r8152 *tp) in rtl_reset_bmu() argument
4072 ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_BMU_RESET); in rtl_reset_bmu()
4074 ocp_write_byte(tp, MCU_TYPE_USB, USB_BMU_RESET, ocp_data); in rtl_reset_bmu()
4076 ocp_write_byte(tp, MCU_TYPE_USB, USB_BMU_RESET, ocp_data); in rtl_reset_bmu()
4080 static void rtl_clear_bp(struct r8152 *tp, u16 type) in rtl_clear_bp() argument
4085 switch (tp->version) { in rtl_clear_bp()
4094 ocp_write_word(tp, MCU_TYPE_USB, USB_BP2_EN, 0); in rtl_clear_bp()
4103 ocp_write_byte(tp, type, PLA_BP_EN, 0); in rtl_clear_bp()
4112 ocp_write_word(tp, type, USB_BP2_EN, 0); in rtl_clear_bp()
4117 generic_ocp_write(tp, PLA_BP_0, BYTE_EN_DWORD, bp_num << 1, bp, type); in rtl_clear_bp()
4121 ocp_write_word(tp, type, PLA_BP_BA, 0); in rtl_clear_bp()
4124 static inline void rtl_reset_ocp_base(struct r8152 *tp) in rtl_reset_ocp_base() argument
4126 tp->ocp_base = -1; in rtl_reset_ocp_base()
4129 static int rtl_phy_patch_request(struct r8152 *tp, bool request, bool wait) in rtl_phy_patch_request() argument
4134 data = ocp_reg_read(tp, OCP_PHY_PATCH_CMD); in rtl_phy_patch_request()
4142 ocp_reg_write(tp, OCP_PHY_PATCH_CMD, data); in rtl_phy_patch_request()
4147 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in rtl_phy_patch_request()
4151 ocp_data = ocp_reg_read(tp, OCP_PHY_PATCH_STAT); in rtl_phy_patch_request()
4157 !(ocp_reg_read(tp, OCP_PHY_PATCH_STAT) & PATCH_READY)) { in rtl_phy_patch_request()
4158 dev_err(&tp->intf->dev, "PHY patch request fail\n"); in rtl_phy_patch_request()
4159 rtl_phy_patch_request(tp, false, false); in rtl_phy_patch_request()
4166 static void rtl_patch_key_set(struct r8152 *tp, u16 key_addr, u16 patch_key) in rtl_patch_key_set() argument
4169 sram_write(tp, key_addr, patch_key); in rtl_patch_key_set()
4170 sram_write(tp, SRAM_PHY_LOCK, PHY_PATCH_LOCK); in rtl_patch_key_set()
4174 sram_write(tp, 0x0000, 0x0000); in rtl_patch_key_set()
4176 data = ocp_reg_read(tp, OCP_PHY_LOCK); in rtl_patch_key_set()
4178 ocp_reg_write(tp, OCP_PHY_LOCK, data); in rtl_patch_key_set()
4180 sram_write(tp, key_addr, 0x0000); in rtl_patch_key_set()
4187 rtl_pre_ram_code(struct r8152 *tp, u16 key_addr, u16 patch_key, bool wait) in rtl_pre_ram_code() argument
4189 if (rtl_phy_patch_request(tp, true, wait)) in rtl_pre_ram_code()
4192 rtl_patch_key_set(tp, key_addr, patch_key); in rtl_pre_ram_code()
4197 static int rtl_post_ram_code(struct r8152 *tp, u16 key_addr, bool wait) in rtl_post_ram_code() argument
4199 rtl_patch_key_set(tp, key_addr, 0); in rtl_post_ram_code()
4201 rtl_phy_patch_request(tp, false, wait); in rtl_post_ram_code()
4206 static bool rtl8152_is_fw_phy_speed_up_ok(struct r8152 *tp, struct fw_phy_speed_up *phy) in rtl8152_is_fw_phy_speed_up_ok() argument
4212 switch (tp->version) { in rtl8152_is_fw_phy_speed_up_ok()
4236 dev_err(&tp->intf->dev, "invalid fw_offset\n"); in rtl8152_is_fw_phy_speed_up_ok()
4242 dev_err(&tp->intf->dev, "invalid block length\n"); in rtl8152_is_fw_phy_speed_up_ok()
4247 dev_err(&tp->intf->dev, "invalid register to load firmware\n"); in rtl8152_is_fw_phy_speed_up_ok()
4256 static bool rtl8152_is_fw_phy_ver_ok(struct r8152 *tp, struct fw_phy_ver *ver) in rtl8152_is_fw_phy_ver_ok() argument
4260 switch (tp->version) { in rtl8152_is_fw_phy_ver_ok()
4272 dev_err(&tp->intf->dev, "invalid block length\n"); in rtl8152_is_fw_phy_ver_ok()
4277 dev_err(&tp->intf->dev, "invalid phy ver addr\n"); in rtl8152_is_fw_phy_ver_ok()
4286 static bool rtl8152_is_fw_phy_fixup_ok(struct r8152 *tp, struct fw_phy_fixup *fix) in rtl8152_is_fw_phy_fixup_ok() argument
4290 switch (tp->version) { in rtl8152_is_fw_phy_fixup_ok()
4302 dev_err(&tp->intf->dev, "invalid block length\n"); in rtl8152_is_fw_phy_fixup_ok()
4308 dev_err(&tp->intf->dev, "invalid phy fixup\n"); in rtl8152_is_fw_phy_fixup_ok()
4317 static bool rtl8152_is_fw_phy_union_ok(struct r8152 *tp, struct fw_phy_union *phy) in rtl8152_is_fw_phy_union_ok() argument
4323 switch (tp->version) { in rtl8152_is_fw_phy_union_ok()
4337 dev_err(&tp->intf->dev, "invalid fw_offset\n"); in rtl8152_is_fw_phy_union_ok()
4343 dev_err(&tp->intf->dev, "invalid block length\n"); in rtl8152_is_fw_phy_union_ok()
4348 dev_err(&tp->intf->dev, "invalid pre_num %d\n", phy->pre_num); in rtl8152_is_fw_phy_union_ok()
4353 dev_err(&tp->intf->dev, "invalid bp_num %d\n", phy->bp_num); in rtl8152_is_fw_phy_union_ok()
4362 static bool rtl8152_is_fw_phy_nc_ok(struct r8152 *tp, struct fw_phy_nc *phy) in rtl8152_is_fw_phy_nc_ok() argument
4368 switch (tp->version) { in rtl8152_is_fw_phy_nc_ok()
4384 dev_err(&tp->intf->dev, "fw_offset too small\n"); in rtl8152_is_fw_phy_nc_ok()
4390 dev_err(&tp->intf->dev, "invalid fw_offset\n"); in rtl8152_is_fw_phy_nc_ok()
4396 dev_err(&tp->intf->dev, "invalid block length\n"); in rtl8152_is_fw_phy_nc_ok()
4401 dev_err(&tp->intf->dev, "invalid register to load firmware\n"); in rtl8152_is_fw_phy_nc_ok()
4406 dev_err(&tp->intf->dev, "invalid base address register\n"); in rtl8152_is_fw_phy_nc_ok()
4411 dev_err(&tp->intf->dev, in rtl8152_is_fw_phy_nc_ok()
4417 dev_err(&tp->intf->dev, in rtl8152_is_fw_phy_nc_ok()
4423 dev_err(&tp->intf->dev, in rtl8152_is_fw_phy_nc_ok()
4429 dev_err(&tp->intf->dev, "invalid break point number\n"); in rtl8152_is_fw_phy_nc_ok()
4438 static bool rtl8152_is_fw_mac_ok(struct r8152 *tp, struct fw_mac *mac) in rtl8152_is_fw_mac_ok() argument
4447 switch (tp->version) { in rtl8152_is_fw_mac_ok()
4484 switch (tp->version) { in rtl8152_is_fw_mac_ok()
4520 dev_err(&tp->intf->dev, "fw_offset too small\n"); in rtl8152_is_fw_mac_ok()
4526 dev_err(&tp->intf->dev, "invalid fw_offset\n"); in rtl8152_is_fw_mac_ok()
4532 dev_err(&tp->intf->dev, "invalid block length\n"); in rtl8152_is_fw_mac_ok()
4537 dev_err(&tp->intf->dev, "invalid register to load firmware\n"); in rtl8152_is_fw_mac_ok()
4542 dev_err(&tp->intf->dev, "invalid base address register\n"); in rtl8152_is_fw_mac_ok()
4547 dev_err(&tp->intf->dev, "invalid enabled mask register\n"); in rtl8152_is_fw_mac_ok()
4552 dev_err(&tp->intf->dev, in rtl8152_is_fw_mac_ok()
4558 dev_err(&tp->intf->dev, "invalid break point number\n"); in rtl8152_is_fw_mac_ok()
4564 dev_err(&tp->intf->dev, "unused bp%u is not zero\n", i); in rtl8152_is_fw_mac_ok()
4578 static long rtl8152_fw_verify_checksum(struct r8152 *tp, in rtl8152_fw_verify_checksum() argument
4595 dev_err(&tp->intf->dev, "digestsize incorrect (%u)\n", in rtl8152_fw_verify_checksum()
4615 dev_err(&tp->intf->dev, "checksum fail\n"); in rtl8152_fw_verify_checksum()
4625 static long rtl8152_check_firmware(struct r8152 *tp, struct rtl_fw *rtl_fw) in rtl8152_check_firmware() argument
4634 dev_err(&tp->intf->dev, "file too small\n"); in rtl8152_check_firmware()
4638 ret = rtl8152_fw_verify_checksum(tp, fw_hdr, fw->size); in rtl8152_check_firmware()
4659 dev_err(&tp->intf->dev, in rtl8152_check_firmware()
4664 if (!rtl8152_is_fw_mac_ok(tp, (struct fw_mac *)block)) { in rtl8152_check_firmware()
4665 dev_err(&tp->intf->dev, in rtl8152_check_firmware()
4673 dev_err(&tp->intf->dev, in rtl8152_check_firmware()
4678 if (!rtl8152_is_fw_mac_ok(tp, (struct fw_mac *)block)) { in rtl8152_check_firmware()
4679 dev_err(&tp->intf->dev, in rtl8152_check_firmware()
4693 dev_err(&tp->intf->dev, in rtl8152_check_firmware()
4699 dev_err(&tp->intf->dev, in rtl8152_check_firmware()
4708 dev_err(&tp->intf->dev, in rtl8152_check_firmware()
4714 dev_err(&tp->intf->dev, in rtl8152_check_firmware()
4723 dev_err(&tp->intf->dev, in rtl8152_check_firmware()
4729 dev_err(&tp->intf->dev, in rtl8152_check_firmware()
4734 if (!rtl8152_is_fw_phy_nc_ok(tp, (struct fw_phy_nc *)block)) { in rtl8152_check_firmware()
4735 dev_err(&tp->intf->dev, in rtl8152_check_firmware()
4748 dev_err(&tp->intf->dev, "PHY_UNION_NC out of order\n"); in rtl8152_check_firmware()
4753 dev_err(&tp->intf->dev, "multiple PHY_UNION_NC encountered\n"); in rtl8152_check_firmware()
4757 if (!rtl8152_is_fw_phy_union_ok(tp, (struct fw_phy_union *)block)) { in rtl8152_check_firmware()
4758 dev_err(&tp->intf->dev, "check PHY_UNION_NC failed\n"); in rtl8152_check_firmware()
4769 dev_err(&tp->intf->dev, "PHY_UNION_NC1 out of order\n"); in rtl8152_check_firmware()
4774 dev_err(&tp->intf->dev, "multiple PHY NC1 encountered\n"); in rtl8152_check_firmware()
4778 if (!rtl8152_is_fw_phy_union_ok(tp, (struct fw_phy_union *)block)) { in rtl8152_check_firmware()
4779 dev_err(&tp->intf->dev, "check PHY_UNION_NC1 failed\n"); in rtl8152_check_firmware()
4789 dev_err(&tp->intf->dev, "PHY_UNION_NC2 out of order\n"); in rtl8152_check_firmware()
4794 dev_err(&tp->intf->dev, "multiple PHY NC2 encountered\n"); in rtl8152_check_firmware()
4798 if (!rtl8152_is_fw_phy_union_ok(tp, (struct fw_phy_union *)block)) { in rtl8152_check_firmware()
4799 dev_err(&tp->intf->dev, "check PHY_UNION_NC2 failed\n"); in rtl8152_check_firmware()
4808 dev_err(&tp->intf->dev, "PHY_UNION_UC2 out of order\n"); in rtl8152_check_firmware()
4813 dev_err(&tp->intf->dev, "multiple PHY UC2 encountered\n"); in rtl8152_check_firmware()
4817 if (!rtl8152_is_fw_phy_union_ok(tp, (struct fw_phy_union *)block)) { in rtl8152_check_firmware()
4818 dev_err(&tp->intf->dev, "check PHY_UNION_UC2 failed\n"); in rtl8152_check_firmware()
4826 dev_err(&tp->intf->dev, "PHY_UNION_UC out of order\n"); in rtl8152_check_firmware()
4831 dev_err(&tp->intf->dev, "multiple PHY UC encountered\n"); in rtl8152_check_firmware()
4835 if (!rtl8152_is_fw_phy_union_ok(tp, (struct fw_phy_union *)block)) { in rtl8152_check_firmware()
4836 dev_err(&tp->intf->dev, "check PHY_UNION_UC failed\n"); in rtl8152_check_firmware()
4842 if (!rtl8152_is_fw_phy_union_ok(tp, (struct fw_phy_union *)block)) { in rtl8152_check_firmware()
4843 dev_err(&tp->intf->dev, "check RTL_FW_PHY_UNION_MISC failed\n"); in rtl8152_check_firmware()
4848 if (!rtl8152_is_fw_phy_fixup_ok(tp, (struct fw_phy_fixup *)block)) { in rtl8152_check_firmware()
4849 dev_err(&tp->intf->dev, "check PHY fixup failed\n"); in rtl8152_check_firmware()
4855 dev_err(&tp->intf->dev, "multiple PHY firmware encountered"); in rtl8152_check_firmware()
4859 if (!rtl8152_is_fw_phy_speed_up_ok(tp, (struct fw_phy_speed_up *)block)) { in rtl8152_check_firmware()
4860 dev_err(&tp->intf->dev, "check PHY speed up failed\n"); in rtl8152_check_firmware()
4873 dev_err(&tp->intf->dev, "Invalid order to set PHY version\n"); in rtl8152_check_firmware()
4878 dev_err(&tp->intf->dev, "multiple PHY version encountered"); in rtl8152_check_firmware()
4882 if (!rtl8152_is_fw_phy_ver_ok(tp, (struct fw_phy_ver *)block)) { in rtl8152_check_firmware()
4883 dev_err(&tp->intf->dev, "check PHY version failed\n"); in rtl8152_check_firmware()
4889 dev_warn(&tp->intf->dev, "Unknown type %u is found\n", in rtl8152_check_firmware()
4900 dev_err(&tp->intf->dev, "without PHY_STOP\n"); in rtl8152_check_firmware()
4909 static void rtl_ram_code_speed_up(struct r8152 *tp, struct fw_phy_speed_up *phy, bool wait) in rtl_ram_code_speed_up() argument
4914 rtl_reset_ocp_base(tp); in rtl_ram_code_speed_up()
4916 if (sram_read(tp, SRAM_GPHY_FW_VER) >= __le16_to_cpu(phy->version)) { in rtl_ram_code_speed_up()
4917 dev_dbg(&tp->intf->dev, "PHY firmware has been the newest\n"); in rtl_ram_code_speed_up()
4925 if (rtl_phy_patch_request(tp, true, wait)) in rtl_ram_code_speed_up()
4937 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_GPHY_CTRL); in rtl_ram_code_speed_up()
4939 ocp_write_word(tp, MCU_TYPE_USB, USB_GPHY_CTRL, ocp_data); in rtl_ram_code_speed_up()
4941 generic_ocp_write(tp, __le16_to_cpu(phy->fw_reg), 0xff, size, data, MCU_TYPE_USB); in rtl_ram_code_speed_up()
4946 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_POL_GPIO_CTRL); in rtl_ram_code_speed_up()
4948 ocp_write_word(tp, MCU_TYPE_PLA, PLA_POL_GPIO_CTRL, ocp_data); in rtl_ram_code_speed_up()
4951 if (!(ocp_read_word(tp, MCU_TYPE_PLA, PLA_POL_GPIO_CTRL) & POL_GPHY_PATCH)) in rtl_ram_code_speed_up()
4956 dev_err(&tp->intf->dev, "ram code speedup mode timeout\n"); in rtl_ram_code_speed_up()
4961 rtl_reset_ocp_base(tp); in rtl_ram_code_speed_up()
4963 rtl_phy_patch_request(tp, false, wait); in rtl_ram_code_speed_up()
4965 if (sram_read(tp, SRAM_GPHY_FW_VER) == __le16_to_cpu(phy->version)) in rtl_ram_code_speed_up()
4966 dev_dbg(&tp->intf->dev, "successfully applied %s\n", phy->info); in rtl_ram_code_speed_up()
4968 dev_err(&tp->intf->dev, "ram code speedup mode fail\n"); in rtl_ram_code_speed_up()
4971 static int rtl8152_fw_phy_ver(struct r8152 *tp, struct fw_phy_ver *phy_ver) in rtl8152_fw_phy_ver() argument
4978 rtl_reset_ocp_base(tp); in rtl8152_fw_phy_ver()
4980 if (sram_read(tp, ver_addr) >= ver) { in rtl8152_fw_phy_ver()
4981 dev_dbg(&tp->intf->dev, "PHY firmware has been the newest\n"); in rtl8152_fw_phy_ver()
4985 sram_write(tp, ver_addr, ver); in rtl8152_fw_phy_ver()
4987 dev_dbg(&tp->intf->dev, "PHY firmware version %x\n", ver); in rtl8152_fw_phy_ver()
4992 static void rtl8152_fw_phy_fixup(struct r8152 *tp, struct fw_phy_fixup *fix) in rtl8152_fw_phy_fixup() argument
4996 rtl_reset_ocp_base(tp); in rtl8152_fw_phy_fixup()
4999 data = ocp_reg_read(tp, addr); in rtl8152_fw_phy_fixup()
5018 ocp_reg_write(tp, addr, data); in rtl8152_fw_phy_fixup()
5020 dev_dbg(&tp->intf->dev, "applied ocp %x %x\n", addr, data); in rtl8152_fw_phy_fixup()
5023 static void rtl8152_fw_phy_union_apply(struct r8152 *tp, struct fw_phy_union *phy) in rtl8152_fw_phy_union_apply() argument
5029 rtl_reset_ocp_base(tp); in rtl8152_fw_phy_union_apply()
5033 sram_write(tp, __le16_to_cpu(phy->pre_set[i].addr), in rtl8152_fw_phy_union_apply()
5041 ocp_reg_write(tp, OCP_SRAM_ADDR, __le16_to_cpu(phy->fw_reg)); in rtl8152_fw_phy_union_apply()
5043 ocp_reg_write(tp, OCP_SRAM_DATA, __le16_to_cpu(data[i])); in rtl8152_fw_phy_union_apply()
5047 sram_write(tp, __le16_to_cpu(phy->bp[i].addr), __le16_to_cpu(phy->bp[i].data)); in rtl8152_fw_phy_union_apply()
5050 sram_write(tp, __le16_to_cpu(phy->bp_en.addr), __le16_to_cpu(phy->bp_en.data)); in rtl8152_fw_phy_union_apply()
5052 dev_dbg(&tp->intf->dev, "successfully applied %s\n", phy->info); in rtl8152_fw_phy_union_apply()
5055 static void rtl8152_fw_phy_nc_apply(struct r8152 *tp, struct fw_phy_nc *phy) in rtl8152_fw_phy_nc_apply() argument
5061 rtl_reset_ocp_base(tp); in rtl8152_fw_phy_nc_apply()
5064 sram_write(tp, mode_reg, __le16_to_cpu(phy->mode_pre)); in rtl8152_fw_phy_nc_apply()
5065 sram_write(tp, __le16_to_cpu(phy->ba_reg), in rtl8152_fw_phy_nc_apply()
5073 ocp_reg_write(tp, OCP_SRAM_ADDR, __le16_to_cpu(phy->fw_reg)); in rtl8152_fw_phy_nc_apply()
5075 ocp_reg_write(tp, OCP_SRAM_DATA, __le16_to_cpu(data[i])); in rtl8152_fw_phy_nc_apply()
5077 sram_write(tp, __le16_to_cpu(phy->patch_en_addr), in rtl8152_fw_phy_nc_apply()
5083 sram_write(tp, bp_index, __le16_to_cpu(phy->bp[i])); in rtl8152_fw_phy_nc_apply()
5087 sram_write(tp, mode_reg, __le16_to_cpu(phy->mode_post)); in rtl8152_fw_phy_nc_apply()
5089 dev_dbg(&tp->intf->dev, "successfully applied %s\n", phy->info); in rtl8152_fw_phy_nc_apply()
5092 static void rtl8152_fw_mac_apply(struct r8152 *tp, struct fw_mac *mac) in rtl8152_fw_mac_apply() argument
5110 if (fw_ver_reg && ocp_read_byte(tp, MCU_TYPE_USB, fw_ver_reg) >= mac->fw_ver_data) { in rtl8152_fw_mac_apply()
5111 dev_dbg(&tp->intf->dev, "%s firmware has been the newest\n", type ? "PLA" : "USB"); in rtl8152_fw_mac_apply()
5115 rtl_clear_bp(tp, type); in rtl8152_fw_mac_apply()
5120 if (tp->version == RTL_VER_04 && type == MCU_TYPE_PLA && in rtl8152_fw_mac_apply()
5121 !(ocp_read_word(tp, MCU_TYPE_PLA, PLA_MACDBG_POST) & DEBUG_OE)) { in rtl8152_fw_mac_apply()
5122 ocp_write_word(tp, MCU_TYPE_PLA, PLA_MACDBG_PRE, DEBUG_LTSSM); in rtl8152_fw_mac_apply()
5123 ocp_write_word(tp, MCU_TYPE_PLA, PLA_MACDBG_POST, DEBUG_LTSSM); in rtl8152_fw_mac_apply()
5132 generic_ocp_write(tp, __le16_to_cpu(mac->fw_reg), 0xff, length, data, in rtl8152_fw_mac_apply()
5135 ocp_write_word(tp, type, __le16_to_cpu(mac->bp_ba_addr), in rtl8152_fw_mac_apply()
5138 generic_ocp_write(tp, __le16_to_cpu(mac->bp_start), BYTE_EN_DWORD, in rtl8152_fw_mac_apply()
5143 ocp_write_word(tp, type, bp_en_addr, in rtl8152_fw_mac_apply()
5147 ocp_write_byte(tp, MCU_TYPE_USB, fw_ver_reg, in rtl8152_fw_mac_apply()
5150 dev_dbg(&tp->intf->dev, "successfully applied %s\n", mac->info); in rtl8152_fw_mac_apply()
5153 static void rtl8152_apply_firmware(struct r8152 *tp, bool power_cut) in rtl8152_apply_firmware() argument
5155 struct rtl_fw *rtl_fw = &tp->rtl_fw; in rtl8152_apply_firmware()
5169 rtl_fw->pre_fw(tp); in rtl8152_apply_firmware()
5179 rtl8152_fw_mac_apply(tp, (struct fw_mac *)block); in rtl8152_apply_firmware()
5186 rtl_pre_ram_code(tp, key_addr, __le16_to_cpu(key->key_data), !power_cut); in rtl8152_apply_firmware()
5192 rtl_post_ram_code(tp, key_addr, !power_cut); in rtl8152_apply_firmware()
5195 rtl8152_fw_phy_nc_apply(tp, (struct fw_phy_nc *)block); in rtl8152_apply_firmware()
5198 patch_phy = rtl8152_fw_phy_ver(tp, (struct fw_phy_ver *)block); in rtl8152_apply_firmware()
5207 rtl8152_fw_phy_union_apply(tp, (struct fw_phy_union *)block); in rtl8152_apply_firmware()
5211 rtl8152_fw_phy_fixup(tp, (struct fw_phy_fixup *)block); in rtl8152_apply_firmware()
5214 rtl_ram_code_speed_up(tp, (struct fw_phy_speed_up *)block, !power_cut); in rtl8152_apply_firmware()
5225 rtl_fw->post_fw(tp); in rtl8152_apply_firmware()
5227 rtl_reset_ocp_base(tp); in rtl8152_apply_firmware()
5229 dev_info(&tp->intf->dev, "load %s successfully\n", rtl_fw->version); in rtl8152_apply_firmware()
5232 static void rtl8152_release_firmware(struct r8152 *tp) in rtl8152_release_firmware() argument
5234 struct rtl_fw *rtl_fw = &tp->rtl_fw; in rtl8152_release_firmware()
5242 static int rtl8152_request_firmware(struct r8152 *tp) in rtl8152_request_firmware() argument
5244 struct rtl_fw *rtl_fw = &tp->rtl_fw; in rtl8152_request_firmware()
5248 dev_info(&tp->intf->dev, "skip request firmware\n"); in rtl8152_request_firmware()
5253 rc = request_firmware(&rtl_fw->fw, rtl_fw->fw_name, &tp->intf->dev); in rtl8152_request_firmware()
5257 rc = rtl8152_check_firmware(tp, rtl_fw); in rtl8152_request_firmware()
5265 dev_warn(&tp->intf->dev, in rtl8152_request_firmware()
5273 static void r8152_aldps_en(struct r8152 *tp, bool enable) in r8152_aldps_en() argument
5276 ocp_reg_write(tp, OCP_ALDPS_CONFIG, ENPWRSAVE | ENPDNPS | in r8152_aldps_en()
5279 ocp_reg_write(tp, OCP_ALDPS_CONFIG, ENPDNPS | LINKENA | in r8152_aldps_en()
5285 static inline void r8152_mmd_indirect(struct r8152 *tp, u16 dev, u16 reg) in r8152_mmd_indirect() argument
5287 ocp_reg_write(tp, OCP_EEE_AR, FUN_ADDR | dev); in r8152_mmd_indirect()
5288 ocp_reg_write(tp, OCP_EEE_DATA, reg); in r8152_mmd_indirect()
5289 ocp_reg_write(tp, OCP_EEE_AR, FUN_DATA | dev); in r8152_mmd_indirect()
5292 static u16 r8152_mmd_read(struct r8152 *tp, u16 dev, u16 reg) in r8152_mmd_read() argument
5296 r8152_mmd_indirect(tp, dev, reg); in r8152_mmd_read()
5297 data = ocp_reg_read(tp, OCP_EEE_DATA); in r8152_mmd_read()
5298 ocp_reg_write(tp, OCP_EEE_AR, 0x0000); in r8152_mmd_read()
5303 static void r8152_mmd_write(struct r8152 *tp, u16 dev, u16 reg, u16 data) in r8152_mmd_write() argument
5305 r8152_mmd_indirect(tp, dev, reg); in r8152_mmd_write()
5306 ocp_reg_write(tp, OCP_EEE_DATA, data); in r8152_mmd_write()
5307 ocp_reg_write(tp, OCP_EEE_AR, 0x0000); in r8152_mmd_write()
5310 static void r8152_eee_en(struct r8152 *tp, bool enable) in r8152_eee_en() argument
5315 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_EEE_CR); in r8152_eee_en()
5316 config1 = ocp_reg_read(tp, OCP_EEE_CONFIG1) & ~sd_rise_time_mask; in r8152_eee_en()
5317 config2 = ocp_reg_read(tp, OCP_EEE_CONFIG2); in r8152_eee_en()
5318 config3 = ocp_reg_read(tp, OCP_EEE_CONFIG3) & ~fast_snr_mask; in r8152_eee_en()
5335 ocp_write_word(tp, MCU_TYPE_PLA, PLA_EEE_CR, ocp_data); in r8152_eee_en()
5336 ocp_reg_write(tp, OCP_EEE_CONFIG1, config1); in r8152_eee_en()
5337 ocp_reg_write(tp, OCP_EEE_CONFIG2, config2); in r8152_eee_en()
5338 ocp_reg_write(tp, OCP_EEE_CONFIG3, config3); in r8152_eee_en()
5341 static void r8153_eee_en(struct r8152 *tp, bool enable) in r8153_eee_en() argument
5346 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_EEE_CR); in r8153_eee_en()
5347 config = ocp_reg_read(tp, OCP_EEE_CFG); in r8153_eee_en()
5357 ocp_write_word(tp, MCU_TYPE_PLA, PLA_EEE_CR, ocp_data); in r8153_eee_en()
5358 ocp_reg_write(tp, OCP_EEE_CFG, config); in r8153_eee_en()
5360 tp->ups_info.eee = enable; in r8153_eee_en()
5363 static void r8156_eee_en(struct r8152 *tp, bool enable) in r8156_eee_en() argument
5367 r8153_eee_en(tp, enable); in r8156_eee_en()
5369 config = ocp_reg_read(tp, OCP_EEE_ADV2); in r8156_eee_en()
5376 ocp_reg_write(tp, OCP_EEE_ADV2, config); in r8156_eee_en()
5379 static void rtl_eee_enable(struct r8152 *tp, bool enable) in rtl_eee_enable() argument
5381 switch (tp->version) { in rtl_eee_enable()
5386 r8152_eee_en(tp, true); in rtl_eee_enable()
5387 r8152_mmd_write(tp, MDIO_MMD_AN, MDIO_AN_EEE_ADV, in rtl_eee_enable()
5388 tp->eee_adv); in rtl_eee_enable()
5390 r8152_eee_en(tp, false); in rtl_eee_enable()
5391 r8152_mmd_write(tp, MDIO_MMD_AN, MDIO_AN_EEE_ADV, 0); in rtl_eee_enable()
5402 r8153_eee_en(tp, true); in rtl_eee_enable()
5403 ocp_reg_write(tp, OCP_EEE_ADV, tp->eee_adv); in rtl_eee_enable()
5405 r8153_eee_en(tp, false); in rtl_eee_enable()
5406 ocp_reg_write(tp, OCP_EEE_ADV, 0); in rtl_eee_enable()
5415 r8156_eee_en(tp, true); in rtl_eee_enable()
5416 ocp_reg_write(tp, OCP_EEE_ADV, tp->eee_adv); in rtl_eee_enable()
5418 r8156_eee_en(tp, false); in rtl_eee_enable()
5419 ocp_reg_write(tp, OCP_EEE_ADV, 0); in rtl_eee_enable()
5427 static void r8152b_enable_fc(struct r8152 *tp) in r8152b_enable_fc() argument
5431 anar = r8152_mdio_read(tp, MII_ADVERTISE); in r8152b_enable_fc()
5433 r8152_mdio_write(tp, MII_ADVERTISE, anar); in r8152b_enable_fc()
5435 tp->ups_info.flow_control = true; in r8152b_enable_fc()
5438 static void rtl8152_disable(struct r8152 *tp) in rtl8152_disable() argument
5440 r8152_aldps_en(tp, false); in rtl8152_disable()
5441 rtl_disable(tp); in rtl8152_disable()
5442 r8152_aldps_en(tp, true); in rtl8152_disable()
5445 static void r8152b_hw_phy_cfg(struct r8152 *tp) in r8152b_hw_phy_cfg() argument
5447 rtl8152_apply_firmware(tp, false); in r8152b_hw_phy_cfg()
5448 rtl_eee_enable(tp, tp->eee_en); in r8152b_hw_phy_cfg()
5449 r8152_aldps_en(tp, true); in r8152b_hw_phy_cfg()
5450 r8152b_enable_fc(tp); in r8152b_hw_phy_cfg()
5452 set_bit(PHY_RESET, &tp->flags); in r8152b_hw_phy_cfg()
5455 static void wait_oob_link_list_ready(struct r8152 *tp) in wait_oob_link_list_ready() argument
5461 ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL); in wait_oob_link_list_ready()
5468 static void r8156b_wait_loading_flash(struct r8152 *tp) in r8156b_wait_loading_flash() argument
5470 if ((ocp_read_word(tp, MCU_TYPE_PLA, PLA_GPHY_CTRL) & GPHY_FLASH) && in r8156b_wait_loading_flash()
5471 !(ocp_read_word(tp, MCU_TYPE_USB, USB_GPHY_CTRL) & BYPASS_FLASH)) { in r8156b_wait_loading_flash()
5475 if (ocp_read_word(tp, MCU_TYPE_USB, USB_GPHY_CTRL) & GPHY_PATCH_DONE) in r8156b_wait_loading_flash()
5482 static void r8152b_exit_oob(struct r8152 *tp) in r8152b_exit_oob() argument
5486 ocp_data = ocp_read_dword(tp, MCU_TYPE_PLA, PLA_RCR); in r8152b_exit_oob()
5488 ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RCR, ocp_data); in r8152b_exit_oob()
5490 rxdy_gated_en(tp, true); in r8152b_exit_oob()
5491 r8153_teredo_off(tp); in r8152b_exit_oob()
5492 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CRWECR, CRWECR_NORAML); in r8152b_exit_oob()
5493 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CR, 0x00); in r8152b_exit_oob()
5495 ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL); in r8152b_exit_oob()
5497 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL, ocp_data); in r8152b_exit_oob()
5499 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7); in r8152b_exit_oob()
5501 ocp_write_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7, ocp_data); in r8152b_exit_oob()
5503 wait_oob_link_list_ready(tp); in r8152b_exit_oob()
5505 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7); in r8152b_exit_oob()
5507 ocp_write_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7, ocp_data); in r8152b_exit_oob()
5509 wait_oob_link_list_ready(tp); in r8152b_exit_oob()
5511 rtl8152_nic_reset(tp); in r8152b_exit_oob()
5514 ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL0, RXFIFO_THR1_NORMAL); in r8152b_exit_oob()
5516 if (tp->udev->speed == USB_SPEED_FULL || in r8152b_exit_oob()
5517 tp->udev->speed == USB_SPEED_LOW) { in r8152b_exit_oob()
5519 ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL1, in r8152b_exit_oob()
5521 ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL2, in r8152b_exit_oob()
5525 ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL1, in r8152b_exit_oob()
5527 ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL2, in r8152b_exit_oob()
5532 ocp_write_dword(tp, MCU_TYPE_PLA, PLA_TXFIFO_CTRL, TXFIFO_THR_NORMAL2); in r8152b_exit_oob()
5534 ocp_write_byte(tp, MCU_TYPE_USB, USB_TX_AGG, TX_AGG_MAX_THRESHOLD); in r8152b_exit_oob()
5535 ocp_write_dword(tp, MCU_TYPE_USB, USB_RX_BUF_TH, RX_THR_HIGH); in r8152b_exit_oob()
5536 ocp_write_dword(tp, MCU_TYPE_USB, USB_TX_DMA, in r8152b_exit_oob()
5539 rtl_rx_vlan_en(tp, tp->netdev->features & NETIF_F_HW_VLAN_CTAG_RX); in r8152b_exit_oob()
5541 ocp_write_word(tp, MCU_TYPE_PLA, PLA_RMS, RTL8152_RMS); in r8152b_exit_oob()
5543 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_TCR0); in r8152b_exit_oob()
5545 ocp_write_word(tp, MCU_TYPE_PLA, PLA_TCR0, ocp_data); in r8152b_exit_oob()
5548 static void r8152b_enter_oob(struct r8152 *tp) in r8152b_enter_oob() argument
5552 ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL); in r8152b_enter_oob()
5554 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL, ocp_data); in r8152b_enter_oob()
5556 ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL0, RXFIFO_THR1_OOB); in r8152b_enter_oob()
5557 ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL1, RXFIFO_THR2_OOB); in r8152b_enter_oob()
5558 ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL2, RXFIFO_THR3_OOB); in r8152b_enter_oob()
5560 rtl_disable(tp); in r8152b_enter_oob()
5562 wait_oob_link_list_ready(tp); in r8152b_enter_oob()
5564 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7); in r8152b_enter_oob()
5566 ocp_write_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7, ocp_data); in r8152b_enter_oob()
5568 wait_oob_link_list_ready(tp); in r8152b_enter_oob()
5570 ocp_write_word(tp, MCU_TYPE_PLA, PLA_RMS, RTL8152_RMS); in r8152b_enter_oob()
5572 rtl_rx_vlan_en(tp, true); in r8152b_enter_oob()
5574 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_BDC_CR); in r8152b_enter_oob()
5576 ocp_write_word(tp, MCU_TYPE_PLA, PLA_BDC_CR, ocp_data); in r8152b_enter_oob()
5578 ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL); in r8152b_enter_oob()
5580 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL, ocp_data); in r8152b_enter_oob()
5582 rxdy_gated_en(tp, false); in r8152b_enter_oob()
5584 ocp_data = ocp_read_dword(tp, MCU_TYPE_PLA, PLA_RCR); in r8152b_enter_oob()
5586 ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RCR, ocp_data); in r8152b_enter_oob()
5589 static int r8153_pre_firmware_1(struct r8152 *tp) in r8153_pre_firmware_1() argument
5595 u32 ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_WDT1_CTRL); in r8153_pre_firmware_1()
5605 static int r8153_post_firmware_1(struct r8152 *tp) in r8153_post_firmware_1() argument
5608 if (ocp_read_byte(tp, MCU_TYPE_USB, USB_CSTMR) & FORCE_SUPER) in r8153_post_firmware_1()
5609 ocp_write_word(tp, MCU_TYPE_USB, USB_BP_4, BP4_SUPER_ONLY); in r8153_post_firmware_1()
5612 ocp_write_word(tp, MCU_TYPE_PLA, PLA_UPHY_TIMER, 36000 / 16); in r8153_post_firmware_1()
5617 static int r8153_pre_firmware_2(struct r8152 *tp) in r8153_pre_firmware_2() argument
5621 r8153_pre_firmware_1(tp); in r8153_pre_firmware_2()
5623 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_FW_FIX_EN0); in r8153_pre_firmware_2()
5625 ocp_write_word(tp, MCU_TYPE_USB, USB_FW_FIX_EN0, ocp_data); in r8153_pre_firmware_2()
5630 static int r8153_post_firmware_2(struct r8152 *tp) in r8153_post_firmware_2() argument
5635 if (ocp_read_byte(tp, MCU_TYPE_USB, USB_CSTMR) & FORCE_SUPER) { in r8153_post_firmware_2()
5636 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_BP_EN); in r8153_post_firmware_2()
5638 ocp_write_word(tp, MCU_TYPE_PLA, PLA_BP_EN, ocp_data); in r8153_post_firmware_2()
5642 ocp_write_word(tp, MCU_TYPE_PLA, PLA_UPHY_TIMER, 36000 / 16); in r8153_post_firmware_2()
5645 ocp_write_word(tp, MCU_TYPE_PLA, PLA_EXTRA_STATUS, U3P3_CHECK_EN | 4); in r8153_post_firmware_2()
5647 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_FW_FIX_EN0); in r8153_post_firmware_2()
5649 ocp_write_word(tp, MCU_TYPE_USB, USB_FW_FIX_EN0, ocp_data); in r8153_post_firmware_2()
5651 ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_USB2PHY); in r8153_post_firmware_2()
5653 ocp_write_byte(tp, MCU_TYPE_USB, USB_USB2PHY, ocp_data); in r8153_post_firmware_2()
5658 static int r8153_post_firmware_3(struct r8152 *tp) in r8153_post_firmware_3() argument
5662 ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_USB2PHY); in r8153_post_firmware_3()
5664 ocp_write_byte(tp, MCU_TYPE_USB, USB_USB2PHY, ocp_data); in r8153_post_firmware_3()
5666 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_FW_FIX_EN1); in r8153_post_firmware_3()
5668 ocp_write_word(tp, MCU_TYPE_USB, USB_FW_FIX_EN1, ocp_data); in r8153_post_firmware_3()
5673 static int r8153b_pre_firmware_1(struct r8152 *tp) in r8153b_pre_firmware_1() argument
5676 ocp_write_word(tp, MCU_TYPE_USB, USB_FC_TIMER, in r8153b_pre_firmware_1()
5682 static int r8153b_post_firmware_1(struct r8152 *tp) in r8153b_post_firmware_1() argument
5687 ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_MISC_1); in r8153b_post_firmware_1()
5689 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_BP_EN); in r8153b_post_firmware_1()
5691 ocp_write_word(tp, MCU_TYPE_PLA, PLA_BP_EN, ocp_data); in r8153b_post_firmware_1()
5694 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_FW_CTRL); in r8153b_post_firmware_1()
5696 ocp_write_word(tp, MCU_TYPE_USB, USB_FW_CTRL, ocp_data); in r8153b_post_firmware_1()
5698 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_FW_TASK); in r8153b_post_firmware_1()
5700 ocp_write_word(tp, MCU_TYPE_USB, USB_FW_TASK, ocp_data); in r8153b_post_firmware_1()
5702 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_FW_FIX_EN1); in r8153b_post_firmware_1()
5704 ocp_write_word(tp, MCU_TYPE_USB, USB_FW_FIX_EN1, ocp_data); in r8153b_post_firmware_1()
5709 static int r8153c_post_firmware_1(struct r8152 *tp) in r8153c_post_firmware_1() argument
5713 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_FW_CTRL); in r8153c_post_firmware_1()
5715 ocp_write_word(tp, MCU_TYPE_USB, USB_FW_CTRL, ocp_data); in r8153c_post_firmware_1()
5717 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_FW_TASK); in r8153c_post_firmware_1()
5719 ocp_write_word(tp, MCU_TYPE_USB, USB_FW_TASK, ocp_data); in r8153c_post_firmware_1()
5724 static int r8156a_post_firmware_1(struct r8152 *tp) in r8156a_post_firmware_1() argument
5728 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_FW_FIX_EN1); in r8156a_post_firmware_1()
5730 ocp_write_word(tp, MCU_TYPE_USB, USB_FW_FIX_EN1, ocp_data); in r8156a_post_firmware_1()
5733 ocp_write_dword(tp, MCU_TYPE_USB, USB_UPHY3_MDCMDIO, 0x4026840e); in r8156a_post_firmware_1()
5734 ocp_write_dword(tp, MCU_TYPE_USB, USB_UPHY3_MDCMDIO, 0x4001acc9); in r8156a_post_firmware_1()
5739 static void r8153_aldps_en(struct r8152 *tp, bool enable) in r8153_aldps_en() argument
5743 data = ocp_reg_read(tp, OCP_POWER_CFG); in r8153_aldps_en()
5746 ocp_reg_write(tp, OCP_POWER_CFG, data); in r8153_aldps_en()
5751 ocp_reg_write(tp, OCP_POWER_CFG, data); in r8153_aldps_en()
5754 if (ocp_read_word(tp, MCU_TYPE_PLA, 0xe000) & 0x0100) in r8153_aldps_en()
5759 tp->ups_info.aldps = enable; in r8153_aldps_en()
5762 static void r8153_hw_phy_cfg(struct r8152 *tp) in r8153_hw_phy_cfg() argument
5768 r8153_aldps_en(tp, false); in r8153_hw_phy_cfg()
5771 rtl_eee_enable(tp, false); in r8153_hw_phy_cfg()
5773 rtl8152_apply_firmware(tp, false); in r8153_hw_phy_cfg()
5775 if (tp->version == RTL_VER_03) { in r8153_hw_phy_cfg()
5776 data = ocp_reg_read(tp, OCP_EEE_CFG); in r8153_hw_phy_cfg()
5778 ocp_reg_write(tp, OCP_EEE_CFG, data); in r8153_hw_phy_cfg()
5781 data = ocp_reg_read(tp, OCP_POWER_CFG); in r8153_hw_phy_cfg()
5783 ocp_reg_write(tp, OCP_POWER_CFG, data); in r8153_hw_phy_cfg()
5785 data = ocp_reg_read(tp, OCP_DOWN_SPEED); in r8153_hw_phy_cfg()
5787 ocp_reg_write(tp, OCP_DOWN_SPEED, data); in r8153_hw_phy_cfg()
5788 data = ocp_reg_read(tp, OCP_POWER_CFG); in r8153_hw_phy_cfg()
5790 ocp_reg_write(tp, OCP_POWER_CFG, data); in r8153_hw_phy_cfg()
5791 sram_write(tp, SRAM_IMPEDANCE, 0x0b13); in r8153_hw_phy_cfg()
5793 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_PHY_PWR); in r8153_hw_phy_cfg()
5795 ocp_write_word(tp, MCU_TYPE_PLA, PLA_PHY_PWR, ocp_data); in r8153_hw_phy_cfg()
5798 sram_write(tp, SRAM_LPF_CFG, 0xf70f); in r8153_hw_phy_cfg()
5801 sram_write(tp, SRAM_10M_AMP1, 0x00af); in r8153_hw_phy_cfg()
5802 sram_write(tp, SRAM_10M_AMP2, 0x0208); in r8153_hw_phy_cfg()
5804 if (tp->eee_en) in r8153_hw_phy_cfg()
5805 rtl_eee_enable(tp, true); in r8153_hw_phy_cfg()
5807 r8153_aldps_en(tp, true); in r8153_hw_phy_cfg()
5808 r8152b_enable_fc(tp); in r8153_hw_phy_cfg()
5810 switch (tp->version) { in r8153_hw_phy_cfg()
5817 r8153_u2p3en(tp, true); in r8153_hw_phy_cfg()
5821 set_bit(PHY_RESET, &tp->flags); in r8153_hw_phy_cfg()
5824 static u32 r8152_efuse_read(struct r8152 *tp, u8 addr) in r8152_efuse_read() argument
5828 ocp_write_word(tp, MCU_TYPE_PLA, PLA_EFUSE_CMD, EFUSE_READ_CMD | addr); in r8152_efuse_read()
5829 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_EFUSE_CMD); in r8152_efuse_read()
5831 ocp_data |= ocp_read_word(tp, MCU_TYPE_PLA, PLA_EFUSE_DATA); in r8152_efuse_read()
5836 static void r8153b_hw_phy_cfg(struct r8152 *tp) in r8153b_hw_phy_cfg() argument
5841 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_MISC_0); in r8153b_hw_phy_cfg()
5844 ocp_write_word(tp, MCU_TYPE_USB, USB_MISC_0, ocp_data); in r8153b_hw_phy_cfg()
5848 r8153_aldps_en(tp, false); in r8153b_hw_phy_cfg()
5851 rtl_eee_enable(tp, false); in r8153b_hw_phy_cfg()
5854 ocp_write_word(tp, MCU_TYPE_USB, USB_U1U2_TIMER, 500); in r8153b_hw_phy_cfg()
5856 data = r8153_phy_status(tp, 0); in r8153b_hw_phy_cfg()
5861 rtl8152_apply_firmware(tp, true); in r8153b_hw_phy_cfg()
5863 data = r8152_mdio_read(tp, MII_BMCR); in r8153b_hw_phy_cfg()
5865 r8152_mdio_write(tp, MII_BMCR, data); in r8153b_hw_phy_cfg()
5869 rtl8152_apply_firmware(tp, false); in r8153b_hw_phy_cfg()
5873 r8153b_green_en(tp, test_bit(GREEN_ETHERNET, &tp->flags)); in r8153b_hw_phy_cfg()
5875 data = sram_read(tp, SRAM_GREEN_CFG); in r8153b_hw_phy_cfg()
5877 sram_write(tp, SRAM_GREEN_CFG, data); in r8153b_hw_phy_cfg()
5878 data = ocp_reg_read(tp, OCP_NCTL_CFG); in r8153b_hw_phy_cfg()
5880 ocp_reg_write(tp, OCP_NCTL_CFG, data); in r8153b_hw_phy_cfg()
5887 ocp_data = r8152_efuse_read(tp, 0x7d); in r8153b_hw_phy_cfg()
5890 ocp_reg_write(tp, OCP_ADC_IOFFSET, data); in r8153b_hw_phy_cfg()
5896 ocp_data = ocp_reg_read(tp, 0xc426); in r8153b_hw_phy_cfg()
5902 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_UPS_CFG); in r8153b_hw_phy_cfg()
5904 ocp_write_word(tp, MCU_TYPE_USB, USB_UPS_CFG, ocp_data); in r8153b_hw_phy_cfg()
5907 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_PHY_PWR); in r8153b_hw_phy_cfg()
5909 ocp_write_word(tp, MCU_TYPE_PLA, PLA_PHY_PWR, ocp_data); in r8153b_hw_phy_cfg()
5912 if (!rtl_phy_patch_request(tp, true, true)) { in r8153b_hw_phy_cfg()
5913 data = ocp_reg_read(tp, OCP_POWER_CFG); in r8153b_hw_phy_cfg()
5915 ocp_reg_write(tp, OCP_POWER_CFG, data); in r8153b_hw_phy_cfg()
5916 tp->ups_info.eee_ckdiv = true; in r8153b_hw_phy_cfg()
5918 data = ocp_reg_read(tp, OCP_DOWN_SPEED); in r8153b_hw_phy_cfg()
5920 ocp_reg_write(tp, OCP_DOWN_SPEED, data); in r8153b_hw_phy_cfg()
5921 tp->ups_info.eee_cmod_lv = true; in r8153b_hw_phy_cfg()
5922 tp->ups_info._10m_ckdiv = true; in r8153b_hw_phy_cfg()
5923 tp->ups_info.eee_plloff_giga = true; in r8153b_hw_phy_cfg()
5925 ocp_reg_write(tp, OCP_SYSCLK_CFG, 0); in r8153b_hw_phy_cfg()
5926 ocp_reg_write(tp, OCP_SYSCLK_CFG, clk_div_expo(5)); in r8153b_hw_phy_cfg()
5927 tp->ups_info._250m_ckdiv = true; in r8153b_hw_phy_cfg()
5929 rtl_phy_patch_request(tp, false, true); in r8153b_hw_phy_cfg()
5932 if (tp->eee_en) in r8153b_hw_phy_cfg()
5933 rtl_eee_enable(tp, true); in r8153b_hw_phy_cfg()
5935 r8153_aldps_en(tp, true); in r8153b_hw_phy_cfg()
5936 r8152b_enable_fc(tp); in r8153b_hw_phy_cfg()
5938 set_bit(PHY_RESET, &tp->flags); in r8153b_hw_phy_cfg()
5941 static void r8153c_hw_phy_cfg(struct r8152 *tp) in r8153c_hw_phy_cfg() argument
5943 r8153b_hw_phy_cfg(tp); in r8153c_hw_phy_cfg()
5945 tp->ups_info.r_tune = true; in r8153c_hw_phy_cfg()
5948 static void rtl8153_change_mtu(struct r8152 *tp) in rtl8153_change_mtu() argument
5950 ocp_write_word(tp, MCU_TYPE_PLA, PLA_RMS, mtu_to_size(tp->netdev->mtu)); in rtl8153_change_mtu()
5951 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_MTPS, MTPS_JUMBO); in rtl8153_change_mtu()
5954 static void r8153_first_init(struct r8152 *tp) in r8153_first_init() argument
5958 rxdy_gated_en(tp, true); in r8153_first_init()
5959 r8153_teredo_off(tp); in r8153_first_init()
5961 ocp_data = ocp_read_dword(tp, MCU_TYPE_PLA, PLA_RCR); in r8153_first_init()
5963 ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RCR, ocp_data); in r8153_first_init()
5965 rtl8152_nic_reset(tp); in r8153_first_init()
5966 rtl_reset_bmu(tp); in r8153_first_init()
5968 ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL); in r8153_first_init()
5970 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL, ocp_data); in r8153_first_init()
5972 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7); in r8153_first_init()
5974 ocp_write_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7, ocp_data); in r8153_first_init()
5976 wait_oob_link_list_ready(tp); in r8153_first_init()
5978 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7); in r8153_first_init()
5980 ocp_write_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7, ocp_data); in r8153_first_init()
5982 wait_oob_link_list_ready(tp); in r8153_first_init()
5984 rtl_rx_vlan_en(tp, tp->netdev->features & NETIF_F_HW_VLAN_CTAG_RX); in r8153_first_init()
5986 rtl8153_change_mtu(tp); in r8153_first_init()
5988 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_TCR0); in r8153_first_init()
5990 ocp_write_word(tp, MCU_TYPE_PLA, PLA_TCR0, ocp_data); in r8153_first_init()
5992 rtl8152_nic_reset(tp); in r8153_first_init()
5995 ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL0, RXFIFO_THR1_NORMAL); in r8153_first_init()
5996 ocp_write_word(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL1, RXFIFO_THR2_NORMAL); in r8153_first_init()
5997 ocp_write_word(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL2, RXFIFO_THR3_NORMAL); in r8153_first_init()
5999 ocp_write_dword(tp, MCU_TYPE_PLA, PLA_TXFIFO_CTRL, TXFIFO_THR_NORMAL2); in r8153_first_init()
6002 static void r8153_enter_oob(struct r8152 *tp) in r8153_enter_oob() argument
6006 ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL); in r8153_enter_oob()
6008 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL, ocp_data); in r8153_enter_oob()
6011 ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL0, RXFIFO_THR1_OOB); in r8153_enter_oob()
6012 ocp_write_word(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL1, RXFIFO_THR2_OOB); in r8153_enter_oob()
6013 ocp_write_word(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL2, RXFIFO_THR3_OOB); in r8153_enter_oob()
6015 rtl_disable(tp); in r8153_enter_oob()
6016 rtl_reset_bmu(tp); in r8153_enter_oob()
6018 wait_oob_link_list_ready(tp); in r8153_enter_oob()
6020 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7); in r8153_enter_oob()
6022 ocp_write_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7, ocp_data); in r8153_enter_oob()
6024 wait_oob_link_list_ready(tp); in r8153_enter_oob()
6026 ocp_write_word(tp, MCU_TYPE_PLA, PLA_RMS, 1522); in r8153_enter_oob()
6027 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_MTPS, MTPS_DEFAULT); in r8153_enter_oob()
6029 switch (tp->version) { in r8153_enter_oob()
6034 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_TEREDO_CFG); in r8153_enter_oob()
6036 ocp_write_word(tp, MCU_TYPE_PLA, PLA_TEREDO_CFG, ocp_data); in r8153_enter_oob()
6046 ocp_write_word(tp, MCU_TYPE_PLA, PLA_TEREDO_WAKE_BASE, 0x00ff); in r8153_enter_oob()
6053 rtl_rx_vlan_en(tp, true); in r8153_enter_oob()
6055 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_BDC_CR); in r8153_enter_oob()
6057 ocp_write_word(tp, MCU_TYPE_PLA, PLA_BDC_CR, ocp_data); in r8153_enter_oob()
6059 ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL); in r8153_enter_oob()
6061 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL, ocp_data); in r8153_enter_oob()
6063 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7); in r8153_enter_oob()
6065 ocp_write_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7, ocp_data); in r8153_enter_oob()
6067 rxdy_gated_en(tp, false); in r8153_enter_oob()
6069 ocp_data = ocp_read_dword(tp, MCU_TYPE_PLA, PLA_RCR); in r8153_enter_oob()
6071 ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RCR, ocp_data); in r8153_enter_oob()
6074 static void rtl8153_disable(struct r8152 *tp) in rtl8153_disable() argument
6076 r8153_aldps_en(tp, false); in rtl8153_disable()
6077 rtl_disable(tp); in rtl8153_disable()
6078 rtl_reset_bmu(tp); in rtl8153_disable()
6079 r8153_aldps_en(tp, true); in rtl8153_disable()
6082 static u32 fc_pause_on_auto(struct r8152 *tp) in fc_pause_on_auto() argument
6084 return (ALIGN(mtu_to_size(tp->netdev->mtu), 1024) + 6 * 1024); in fc_pause_on_auto()
6087 static u32 fc_pause_off_auto(struct r8152 *tp) in fc_pause_off_auto() argument
6089 return (ALIGN(mtu_to_size(tp->netdev->mtu), 1024) + 14 * 1024); in fc_pause_off_auto()
6092 static void r8156_fc_parameter(struct r8152 *tp) in r8156_fc_parameter() argument
6094 u32 pause_on = tp->fc_pause_on ? tp->fc_pause_on : fc_pause_on_auto(tp); in r8156_fc_parameter()
6095 u32 pause_off = tp->fc_pause_off ? tp->fc_pause_off : fc_pause_off_auto(tp); in r8156_fc_parameter()
6097 ocp_write_word(tp, MCU_TYPE_PLA, PLA_RX_FIFO_FULL, pause_on / 16); in r8156_fc_parameter()
6098 ocp_write_word(tp, MCU_TYPE_PLA, PLA_RX_FIFO_EMPTY, pause_off / 16); in r8156_fc_parameter()
6101 static int rtl8156_enable(struct r8152 *tp) in rtl8156_enable() argument
6106 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in rtl8156_enable()
6109 r8156_fc_parameter(tp); in rtl8156_enable()
6110 set_tx_qlen(tp); in rtl8156_enable()
6111 rtl_set_eee_plus(tp); in rtl8156_enable()
6112 r8153_set_rx_early_timeout(tp); in rtl8156_enable()
6113 r8153_set_rx_early_size(tp); in rtl8156_enable()
6115 speed = rtl8152_get_speed(tp); in rtl8156_enable()
6116 rtl_set_ifg(tp, speed); in rtl8156_enable()
6118 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL4); in rtl8156_enable()
6123 ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL4, ocp_data); in rtl8156_enable()
6126 ocp_write_word(tp, MCU_TYPE_PLA, PLA_EEE_TXTWSYS, 0x11); in rtl8156_enable()
6128 ocp_write_word(tp, MCU_TYPE_PLA, PLA_EEE_TXTWSYS, 0x3d); in rtl8156_enable()
6130 if (tp->udev->speed == USB_SPEED_HIGH) { in rtl8156_enable()
6132 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_L1_CTRL); in rtl8156_enable()
6138 ocp_write_word(tp, MCU_TYPE_USB, USB_L1_CTRL, ocp_data); in rtl8156_enable()
6141 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_FW_TASK); in rtl8156_enable()
6143 ocp_write_word(tp, MCU_TYPE_USB, USB_FW_TASK, ocp_data); in rtl8156_enable()
6146 ocp_write_word(tp, MCU_TYPE_USB, USB_FW_TASK, ocp_data); in rtl8156_enable()
6148 return rtl_enable(tp); in rtl8156_enable()
6151 static void rtl8156_disable(struct r8152 *tp) in rtl8156_disable() argument
6153 ocp_write_word(tp, MCU_TYPE_PLA, PLA_RX_FIFO_FULL, 0); in rtl8156_disable()
6154 ocp_write_word(tp, MCU_TYPE_PLA, PLA_RX_FIFO_EMPTY, 0); in rtl8156_disable()
6156 rtl8153_disable(tp); in rtl8156_disable()
6159 static int rtl8156b_enable(struct r8152 *tp) in rtl8156b_enable() argument
6164 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in rtl8156b_enable()
6167 set_tx_qlen(tp); in rtl8156b_enable()
6168 rtl_set_eee_plus(tp); in rtl8156b_enable()
6170 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_RX_AGGR_NUM); in rtl8156b_enable()
6172 ocp_write_word(tp, MCU_TYPE_USB, USB_RX_AGGR_NUM, ocp_data); in rtl8156b_enable()
6174 r8153_set_rx_early_timeout(tp); in rtl8156b_enable()
6175 r8153_set_rx_early_size(tp); in rtl8156b_enable()
6177 speed = rtl8152_get_speed(tp); in rtl8156b_enable()
6178 rtl_set_ifg(tp, speed); in rtl8156b_enable()
6180 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL4); in rtl8156b_enable()
6185 ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL4, ocp_data); in rtl8156b_enable()
6187 if (tp->udev->speed == USB_SPEED_HIGH) { in rtl8156b_enable()
6188 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_L1_CTRL); in rtl8156b_enable()
6194 ocp_write_word(tp, MCU_TYPE_USB, USB_L1_CTRL, ocp_data); in rtl8156b_enable()
6197 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_FW_TASK); in rtl8156b_enable()
6199 ocp_write_word(tp, MCU_TYPE_USB, USB_FW_TASK, ocp_data); in rtl8156b_enable()
6202 ocp_write_word(tp, MCU_TYPE_USB, USB_FW_TASK, ocp_data); in rtl8156b_enable()
6204 return rtl_enable(tp); in rtl8156b_enable()
6207 static int rtl8152_set_speed(struct r8152 *tp, u8 autoneg, u32 speed, u8 duplex, in rtl8152_set_speed() argument
6222 tp->ups_info.speed_duplex = FORCE_10M_FULL; in rtl8152_set_speed()
6224 tp->ups_info.speed_duplex = FORCE_10M_HALF; in rtl8152_set_speed()
6231 tp->ups_info.speed_duplex = FORCE_100M_FULL; in rtl8152_set_speed()
6233 tp->ups_info.speed_duplex = FORCE_100M_HALF; in rtl8152_set_speed()
6237 if (tp->mii.supports_gmii) { in rtl8152_set_speed()
6239 tp->ups_info.speed_duplex = NWAY_1000M_FULL; in rtl8152_set_speed()
6249 tp->mii.full_duplex = 1; in rtl8152_set_speed()
6251 tp->mii.full_duplex = 0; in rtl8152_set_speed()
6253 tp->mii.force_media = 1; in rtl8152_set_speed()
6261 if (tp->mii.supports_gmii) { in rtl8152_set_speed()
6264 if (tp->support_2500full) in rtl8152_set_speed()
6271 orig = r8152_mdio_read(tp, MII_ADVERTISE); in rtl8152_set_speed()
6276 tp->ups_info.speed_duplex = NWAY_10M_HALF; in rtl8152_set_speed()
6280 tp->ups_info.speed_duplex = NWAY_10M_FULL; in rtl8152_set_speed()
6285 tp->ups_info.speed_duplex = NWAY_100M_HALF; in rtl8152_set_speed()
6289 tp->ups_info.speed_duplex = NWAY_100M_FULL; in rtl8152_set_speed()
6293 r8152_mdio_write(tp, MII_ADVERTISE, new1); in rtl8152_set_speed()
6294 tp->mii.advertising = new1; in rtl8152_set_speed()
6297 if (tp->mii.supports_gmii) { in rtl8152_set_speed()
6298 orig = r8152_mdio_read(tp, MII_CTRL1000); in rtl8152_set_speed()
6304 tp->ups_info.speed_duplex = NWAY_1000M_FULL; in rtl8152_set_speed()
6308 r8152_mdio_write(tp, MII_CTRL1000, new1); in rtl8152_set_speed()
6311 if (tp->support_2500full) { in rtl8152_set_speed()
6312 orig = ocp_reg_read(tp, OCP_10GBT_CTRL); in rtl8152_set_speed()
6317 tp->ups_info.speed_duplex = NWAY_2500M_FULL; in rtl8152_set_speed()
6321 ocp_reg_write(tp, OCP_10GBT_CTRL, new1); in rtl8152_set_speed()
6326 tp->mii.force_media = 0; in rtl8152_set_speed()
6329 if (test_and_clear_bit(PHY_RESET, &tp->flags)) in rtl8152_set_speed()
6332 r8152_mdio_write(tp, MII_BMCR, bmcr); in rtl8152_set_speed()
6339 if ((r8152_mdio_read(tp, MII_BMCR) & BMCR_RESET) == 0) in rtl8152_set_speed()
6348 static void rtl8152_up(struct r8152 *tp) in rtl8152_up() argument
6350 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in rtl8152_up()
6353 r8152_aldps_en(tp, false); in rtl8152_up()
6354 r8152b_exit_oob(tp); in rtl8152_up()
6355 r8152_aldps_en(tp, true); in rtl8152_up()
6358 static void rtl8152_down(struct r8152 *tp) in rtl8152_down() argument
6360 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) { in rtl8152_down()
6361 rtl_drop_queued_tx(tp); in rtl8152_down()
6365 r8152_power_cut_en(tp, false); in rtl8152_down()
6366 r8152_aldps_en(tp, false); in rtl8152_down()
6367 r8152b_enter_oob(tp); in rtl8152_down()
6368 r8152_aldps_en(tp, true); in rtl8152_down()
6371 static void rtl8153_up(struct r8152 *tp) in rtl8153_up() argument
6375 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in rtl8153_up()
6378 r8153_u1u2en(tp, false); in rtl8153_up()
6379 r8153_u2p3en(tp, false); in rtl8153_up()
6380 r8153_aldps_en(tp, false); in rtl8153_up()
6381 r8153_first_init(tp); in rtl8153_up()
6383 ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_CONFIG6); in rtl8153_up()
6385 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CONFIG6, ocp_data); in rtl8153_up()
6387 ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_LWAKE_CTRL_REG); in rtl8153_up()
6389 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_LWAKE_CTRL_REG, ocp_data); in rtl8153_up()
6391 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_SSPHYLINK1); in rtl8153_up()
6393 ocp_write_word(tp, MCU_TYPE_USB, USB_SSPHYLINK1, ocp_data); in rtl8153_up()
6395 r8153_aldps_en(tp, true); in rtl8153_up()
6397 switch (tp->version) { in rtl8153_up()
6404 r8153_u2p3en(tp, true); in rtl8153_up()
6408 r8153_u1u2en(tp, true); in rtl8153_up()
6411 static void rtl8153_down(struct r8152 *tp) in rtl8153_down() argument
6415 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) { in rtl8153_down()
6416 rtl_drop_queued_tx(tp); in rtl8153_down()
6420 ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_CONFIG6); in rtl8153_down()
6422 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CONFIG6, ocp_data); in rtl8153_down()
6424 r8153_u1u2en(tp, false); in rtl8153_down()
6425 r8153_u2p3en(tp, false); in rtl8153_down()
6426 r8153_power_cut_en(tp, false); in rtl8153_down()
6427 r8153_aldps_en(tp, false); in rtl8153_down()
6428 r8153_enter_oob(tp); in rtl8153_down()
6429 r8153_aldps_en(tp, true); in rtl8153_down()
6432 static void rtl8153b_up(struct r8152 *tp) in rtl8153b_up() argument
6436 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in rtl8153b_up()
6439 r8153b_u1u2en(tp, false); in rtl8153b_up()
6440 r8153_u2p3en(tp, false); in rtl8153b_up()
6441 r8153_aldps_en(tp, false); in rtl8153b_up()
6443 r8153_first_init(tp); in rtl8153b_up()
6444 ocp_write_dword(tp, MCU_TYPE_USB, USB_RX_BUF_TH, RX_THR_B); in rtl8153b_up()
6446 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL3); in rtl8153b_up()
6448 ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL3, ocp_data); in rtl8153b_up()
6450 r8153_aldps_en(tp, true); in rtl8153b_up()
6452 if (tp->udev->speed >= USB_SPEED_SUPER) in rtl8153b_up()
6453 r8153b_u1u2en(tp, true); in rtl8153b_up()
6456 static void rtl8153b_down(struct r8152 *tp) in rtl8153b_down() argument
6460 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) { in rtl8153b_down()
6461 rtl_drop_queued_tx(tp); in rtl8153b_down()
6465 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL3); in rtl8153b_down()
6467 ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL3, ocp_data); in rtl8153b_down()
6469 r8153b_u1u2en(tp, false); in rtl8153b_down()
6470 r8153_u2p3en(tp, false); in rtl8153b_down()
6471 r8153b_power_cut_en(tp, false); in rtl8153b_down()
6472 r8153_aldps_en(tp, false); in rtl8153b_down()
6473 r8153_enter_oob(tp); in rtl8153b_down()
6474 r8153_aldps_en(tp, true); in rtl8153b_down()
6477 static void rtl8153c_change_mtu(struct r8152 *tp) in rtl8153c_change_mtu() argument
6479 ocp_write_word(tp, MCU_TYPE_PLA, PLA_RMS, mtu_to_size(tp->netdev->mtu)); in rtl8153c_change_mtu()
6480 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_MTPS, 10 * 1024 / 64); in rtl8153c_change_mtu()
6482 ocp_write_word(tp, MCU_TYPE_PLA, PLA_TXFIFO_CTRL, 512 / 64); in rtl8153c_change_mtu()
6487 if (tp->netdev->mtu < 8000) in rtl8153c_change_mtu()
6488 ocp_write_word(tp, MCU_TYPE_PLA, PLA_TXFIFO_FULL, 2048 / 8); in rtl8153c_change_mtu()
6490 ocp_write_word(tp, MCU_TYPE_PLA, PLA_TXFIFO_FULL, 900 / 8); in rtl8153c_change_mtu()
6493 static void rtl8153c_up(struct r8152 *tp) in rtl8153c_up() argument
6497 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in rtl8153c_up()
6500 r8153b_u1u2en(tp, false); in rtl8153c_up()
6501 r8153_u2p3en(tp, false); in rtl8153c_up()
6502 r8153_aldps_en(tp, false); in rtl8153c_up()
6504 rxdy_gated_en(tp, true); in rtl8153c_up()
6505 r8153_teredo_off(tp); in rtl8153c_up()
6507 ocp_data = ocp_read_dword(tp, MCU_TYPE_PLA, PLA_RCR); in rtl8153c_up()
6509 ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RCR, ocp_data); in rtl8153c_up()
6511 rtl8152_nic_reset(tp); in rtl8153c_up()
6512 rtl_reset_bmu(tp); in rtl8153c_up()
6514 ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL); in rtl8153c_up()
6516 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL, ocp_data); in rtl8153c_up()
6518 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7); in rtl8153c_up()
6520 ocp_write_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7, ocp_data); in rtl8153c_up()
6522 wait_oob_link_list_ready(tp); in rtl8153c_up()
6524 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7); in rtl8153c_up()
6526 ocp_write_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7, ocp_data); in rtl8153c_up()
6528 wait_oob_link_list_ready(tp); in rtl8153c_up()
6530 rtl_rx_vlan_en(tp, tp->netdev->features & NETIF_F_HW_VLAN_CTAG_RX); in rtl8153c_up()
6532 rtl8153c_change_mtu(tp); in rtl8153c_up()
6534 rtl8152_nic_reset(tp); in rtl8153c_up()
6537 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL0, 0x02); in rtl8153c_up()
6538 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_RXFIFO_FULL, 0x08); in rtl8153c_up()
6539 ocp_write_word(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL1, RXFIFO_THR2_NORMAL); in rtl8153c_up()
6540 ocp_write_word(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL2, RXFIFO_THR3_NORMAL); in rtl8153c_up()
6542 ocp_write_dword(tp, MCU_TYPE_USB, USB_RX_BUF_TH, RX_THR_B); in rtl8153c_up()
6544 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CRWECR, CRWECR_CONFIG); in rtl8153c_up()
6546 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_CONFIG34); in rtl8153c_up()
6548 ocp_write_word(tp, MCU_TYPE_PLA, PLA_CONFIG34, ocp_data); in rtl8153c_up()
6550 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CRWECR, CRWECR_NORAML); in rtl8153c_up()
6552 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL3); in rtl8153c_up()
6554 ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL3, ocp_data); in rtl8153c_up()
6556 r8153_aldps_en(tp, true); in rtl8153c_up()
6557 r8153b_u1u2en(tp, true); in rtl8153c_up()
6560 static void rtl8156_change_mtu(struct r8152 *tp) in rtl8156_change_mtu() argument
6562 u32 rx_max_size = mtu_to_size(tp->netdev->mtu); in rtl8156_change_mtu()
6564 ocp_write_word(tp, MCU_TYPE_PLA, PLA_RMS, rx_max_size); in rtl8156_change_mtu()
6565 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_MTPS, MTPS_JUMBO); in rtl8156_change_mtu()
6566 r8156_fc_parameter(tp); in rtl8156_change_mtu()
6569 ocp_write_word(tp, MCU_TYPE_PLA, PLA_TXFIFO_CTRL, 512 / 64); in rtl8156_change_mtu()
6570 ocp_write_word(tp, MCU_TYPE_PLA, PLA_TXFIFO_FULL, in rtl8156_change_mtu()
6574 static void rtl8156_up(struct r8152 *tp) in rtl8156_up() argument
6578 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in rtl8156_up()
6581 r8153b_u1u2en(tp, false); in rtl8156_up()
6582 r8153_u2p3en(tp, false); in rtl8156_up()
6583 r8153_aldps_en(tp, false); in rtl8156_up()
6585 rxdy_gated_en(tp, true); in rtl8156_up()
6586 r8153_teredo_off(tp); in rtl8156_up()
6588 ocp_data = ocp_read_dword(tp, MCU_TYPE_PLA, PLA_RCR); in rtl8156_up()
6590 ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RCR, ocp_data); in rtl8156_up()
6592 rtl8152_nic_reset(tp); in rtl8156_up()
6593 rtl_reset_bmu(tp); in rtl8156_up()
6595 ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL); in rtl8156_up()
6597 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL, ocp_data); in rtl8156_up()
6599 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7); in rtl8156_up()
6601 ocp_write_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7, ocp_data); in rtl8156_up()
6603 rtl_rx_vlan_en(tp, tp->netdev->features & NETIF_F_HW_VLAN_CTAG_RX); in rtl8156_up()
6605 rtl8156_change_mtu(tp); in rtl8156_up()
6607 switch (tp->version) { in rtl8156_up()
6611 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_BMU_CONFIG); in rtl8156_up()
6613 ocp_write_word(tp, MCU_TYPE_USB, USB_BMU_CONFIG, ocp_data); in rtl8156_up()
6620 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_RXFIFO_FULL); in rtl8156_up()
6623 ocp_write_word(tp, MCU_TYPE_PLA, PLA_RXFIFO_FULL, ocp_data); in rtl8156_up()
6625 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL3); in rtl8156_up()
6627 ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL3, ocp_data); in rtl8156_up()
6629 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_SPEED_OPTION); in rtl8156_up()
6631 ocp_write_word(tp, MCU_TYPE_USB, USB_SPEED_OPTION, ocp_data); in rtl8156_up()
6633 ocp_write_dword(tp, MCU_TYPE_USB, USB_RX_BUF_TH, 0x00600400); in rtl8156_up()
6635 if (tp->saved_wolopts != __rtl_get_wol(tp)) { in rtl8156_up()
6636 netif_warn(tp, ifup, tp->netdev, "wol setting is changed\n"); in rtl8156_up()
6637 __rtl_set_wol(tp, tp->saved_wolopts); in rtl8156_up()
6640 r8153_aldps_en(tp, true); in rtl8156_up()
6641 r8153_u2p3en(tp, true); in rtl8156_up()
6643 if (tp->udev->speed >= USB_SPEED_SUPER) in rtl8156_up()
6644 r8153b_u1u2en(tp, true); in rtl8156_up()
6647 static void rtl8156_down(struct r8152 *tp) in rtl8156_down() argument
6651 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) { in rtl8156_down()
6652 rtl_drop_queued_tx(tp); in rtl8156_down()
6656 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL3); in rtl8156_down()
6658 ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL3, ocp_data); in rtl8156_down()
6660 r8153b_u1u2en(tp, false); in rtl8156_down()
6661 r8153_u2p3en(tp, false); in rtl8156_down()
6662 r8153b_power_cut_en(tp, false); in rtl8156_down()
6663 r8153_aldps_en(tp, false); in rtl8156_down()
6665 ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL); in rtl8156_down()
6667 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL, ocp_data); in rtl8156_down()
6670 ocp_write_word(tp, MCU_TYPE_PLA, PLA_RXFIFO_FULL, 64 / 16); in rtl8156_down()
6671 ocp_write_word(tp, MCU_TYPE_PLA, PLA_RX_FIFO_FULL, 1024 / 16); in rtl8156_down()
6672 ocp_write_word(tp, MCU_TYPE_PLA, PLA_RX_FIFO_EMPTY, 4096 / 16); in rtl8156_down()
6674 rtl_disable(tp); in rtl8156_down()
6675 rtl_reset_bmu(tp); in rtl8156_down()
6677 ocp_write_word(tp, MCU_TYPE_PLA, PLA_RMS, 1522); in rtl8156_down()
6678 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_MTPS, MTPS_DEFAULT); in rtl8156_down()
6684 ocp_write_word(tp, MCU_TYPE_PLA, PLA_TEREDO_WAKE_BASE, 0x00ff); in rtl8156_down()
6686 ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL); in rtl8156_down()
6688 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL, ocp_data); in rtl8156_down()
6690 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7); in rtl8156_down()
6692 ocp_write_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7, ocp_data); in rtl8156_down()
6694 rtl_rx_vlan_en(tp, true); in rtl8156_down()
6695 rxdy_gated_en(tp, false); in rtl8156_down()
6697 ocp_data = ocp_read_dword(tp, MCU_TYPE_PLA, PLA_RCR); in rtl8156_down()
6699 ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RCR, ocp_data); in rtl8156_down()
6701 r8153_aldps_en(tp, true); in rtl8156_down()
6704 static bool rtl8152_in_nway(struct r8152 *tp) in rtl8152_in_nway() argument
6708 ocp_write_word(tp, MCU_TYPE_PLA, PLA_OCP_GPHY_BASE, 0x2000); in rtl8152_in_nway()
6709 tp->ocp_base = 0x2000; in rtl8152_in_nway()
6710 ocp_write_byte(tp, MCU_TYPE_PLA, 0xb014, 0x4c); /* phy state */ in rtl8152_in_nway()
6711 nway_state = ocp_read_word(tp, MCU_TYPE_PLA, 0xb01a); in rtl8152_in_nway()
6720 static bool rtl8153_in_nway(struct r8152 *tp) in rtl8153_in_nway() argument
6722 u16 phy_state = ocp_reg_read(tp, OCP_PHY_STATE) & 0xff; in rtl8153_in_nway()
6730 static void r8156_mdio_force_mode(struct r8152 *tp) in r8156_mdio_force_mode() argument
6738 data = ocp_reg_read(tp, 0xa5b4); in r8156_mdio_force_mode()
6741 ocp_reg_write(tp, 0xa5b4, data); in r8156_mdio_force_mode()
6745 static void set_carrier(struct r8152 *tp) in set_carrier() argument
6747 struct net_device *netdev = tp->netdev; in set_carrier()
6748 struct napi_struct *napi = &tp->napi; in set_carrier()
6751 speed = rtl8152_get_speed(tp); in set_carrier()
6755 tp->rtl_ops.enable(tp); in set_carrier()
6759 rtl_start_rx(tp); in set_carrier()
6760 clear_bit(RTL8152_SET_RX_MODE, &tp->flags); in set_carrier()
6764 netif_info(tp, link, netdev, "carrier on\n"); in set_carrier()
6766 skb_queue_len(&tp->tx_queue) < tp->tx_qlen) { in set_carrier()
6772 tasklet_disable(&tp->tx_tl); in set_carrier()
6774 tp->rtl_ops.disable(tp); in set_carrier()
6776 tasklet_enable(&tp->tx_tl); in set_carrier()
6777 netif_info(tp, link, netdev, "carrier off\n"); in set_carrier()
6784 struct r8152 *tp = container_of(work, struct r8152, schedule.work); in rtl_work_func_t() local
6789 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags) || !netif_running(tp->netdev)) in rtl_work_func_t()
6792 if (usb_autopm_get_interface(tp->intf) < 0) in rtl_work_func_t()
6795 if (!test_bit(WORK_ENABLE, &tp->flags)) in rtl_work_func_t()
6798 if (!mutex_trylock(&tp->control)) { in rtl_work_func_t()
6799 schedule_delayed_work(&tp->schedule, 0); in rtl_work_func_t()
6803 if (test_and_clear_bit(RTL8152_LINK_CHG, &tp->flags)) in rtl_work_func_t()
6804 set_carrier(tp); in rtl_work_func_t()
6806 if (test_and_clear_bit(RTL8152_SET_RX_MODE, &tp->flags)) in rtl_work_func_t()
6807 _rtl8152_set_rx_mode(tp->netdev); in rtl_work_func_t()
6810 if (test_and_clear_bit(SCHEDULE_TASKLET, &tp->flags) && in rtl_work_func_t()
6811 netif_carrier_ok(tp->netdev)) in rtl_work_func_t()
6812 tasklet_schedule(&tp->tx_tl); in rtl_work_func_t()
6814 if (test_and_clear_bit(RX_EPROTO, &tp->flags) && in rtl_work_func_t()
6815 !list_empty(&tp->rx_done)) in rtl_work_func_t()
6816 napi_schedule(&tp->napi); in rtl_work_func_t()
6818 mutex_unlock(&tp->control); in rtl_work_func_t()
6821 usb_autopm_put_interface(tp->intf); in rtl_work_func_t()
6826 struct r8152 *tp = container_of(work, struct r8152, hw_phy_work.work); in rtl_hw_phy_work_func_t() local
6828 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in rtl_hw_phy_work_func_t()
6831 if (usb_autopm_get_interface(tp->intf) < 0) in rtl_hw_phy_work_func_t()
6834 mutex_lock(&tp->control); in rtl_hw_phy_work_func_t()
6836 if (rtl8152_request_firmware(tp) == -ENODEV && tp->rtl_fw.retry) { in rtl_hw_phy_work_func_t()
6837 tp->rtl_fw.retry = false; in rtl_hw_phy_work_func_t()
6838 tp->rtl_fw.fw = NULL; in rtl_hw_phy_work_func_t()
6842 queue_delayed_work(system_long_wq, &tp->hw_phy_work, HZ * 10); in rtl_hw_phy_work_func_t()
6846 tp->rtl_ops.hw_phy_cfg(tp); in rtl_hw_phy_work_func_t()
6848 rtl8152_set_speed(tp, tp->autoneg, tp->speed, tp->duplex, in rtl_hw_phy_work_func_t()
6849 tp->advertising); in rtl_hw_phy_work_func_t()
6852 mutex_unlock(&tp->control); in rtl_hw_phy_work_func_t()
6854 usb_autopm_put_interface(tp->intf); in rtl_hw_phy_work_func_t()
6861 struct r8152 *tp = container_of(nb, struct r8152, pm_notifier); in rtl_notifier() local
6866 usb_autopm_get_interface(tp->intf); in rtl_notifier()
6871 usb_autopm_put_interface(tp->intf); in rtl_notifier()
6886 struct r8152 *tp = netdev_priv(netdev); in rtl8152_open() local
6889 if (work_busy(&tp->hw_phy_work.work) & WORK_BUSY_PENDING) { in rtl8152_open()
6890 cancel_delayed_work_sync(&tp->hw_phy_work); in rtl8152_open()
6891 rtl_hw_phy_work_func_t(&tp->hw_phy_work.work); in rtl8152_open()
6894 res = alloc_all_mem(tp); in rtl8152_open()
6898 res = usb_autopm_get_interface(tp->intf); in rtl8152_open()
6902 mutex_lock(&tp->control); in rtl8152_open()
6904 tp->rtl_ops.up(tp); in rtl8152_open()
6908 set_bit(WORK_ENABLE, &tp->flags); in rtl8152_open()
6910 res = usb_submit_urb(tp->intr_urb, GFP_KERNEL); in rtl8152_open()
6913 netif_device_detach(tp->netdev); in rtl8152_open()
6914 netif_warn(tp, ifup, netdev, "intr_urb submit failed: %d\n", in rtl8152_open()
6918 napi_enable(&tp->napi); in rtl8152_open()
6919 tasklet_enable(&tp->tx_tl); in rtl8152_open()
6921 mutex_unlock(&tp->control); in rtl8152_open()
6923 usb_autopm_put_interface(tp->intf); in rtl8152_open()
6925 tp->pm_notifier.notifier_call = rtl_notifier; in rtl8152_open()
6926 register_pm_notifier(&tp->pm_notifier); in rtl8152_open()
6931 mutex_unlock(&tp->control); in rtl8152_open()
6932 usb_autopm_put_interface(tp->intf); in rtl8152_open()
6934 free_all_mem(tp); in rtl8152_open()
6941 struct r8152 *tp = netdev_priv(netdev); in rtl8152_close() local
6945 unregister_pm_notifier(&tp->pm_notifier); in rtl8152_close()
6947 tasklet_disable(&tp->tx_tl); in rtl8152_close()
6948 clear_bit(WORK_ENABLE, &tp->flags); in rtl8152_close()
6949 usb_kill_urb(tp->intr_urb); in rtl8152_close()
6950 cancel_delayed_work_sync(&tp->schedule); in rtl8152_close()
6951 napi_disable(&tp->napi); in rtl8152_close()
6954 res = usb_autopm_get_interface(tp->intf); in rtl8152_close()
6955 if (res < 0 || test_bit(RTL8152_INACCESSIBLE, &tp->flags)) { in rtl8152_close()
6956 rtl_drop_queued_tx(tp); in rtl8152_close()
6957 rtl_stop_rx(tp); in rtl8152_close()
6959 mutex_lock(&tp->control); in rtl8152_close()
6961 tp->rtl_ops.down(tp); in rtl8152_close()
6963 mutex_unlock(&tp->control); in rtl8152_close()
6967 usb_autopm_put_interface(tp->intf); in rtl8152_close()
6969 free_all_mem(tp); in rtl8152_close()
6974 static void rtl_tally_reset(struct r8152 *tp) in rtl_tally_reset() argument
6978 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_RSTTALLY); in rtl_tally_reset()
6980 ocp_write_word(tp, MCU_TYPE_PLA, PLA_RSTTALLY, ocp_data); in rtl_tally_reset()
6983 static void r8152b_init(struct r8152 *tp) in r8152b_init() argument
6988 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in r8152b_init()
6991 data = r8152_mdio_read(tp, MII_BMCR); in r8152b_init()
6994 r8152_mdio_write(tp, MII_BMCR, data); in r8152b_init()
6997 r8152_aldps_en(tp, false); in r8152b_init()
6999 if (tp->version == RTL_VER_01) { in r8152b_init()
7000 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_LED_FEATURE); in r8152b_init()
7002 ocp_write_word(tp, MCU_TYPE_PLA, PLA_LED_FEATURE, ocp_data); in r8152b_init()
7005 r8152_power_cut_en(tp, false); in r8152b_init()
7007 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_PHY_PWR); in r8152b_init()
7009 ocp_write_word(tp, MCU_TYPE_PLA, PLA_PHY_PWR, ocp_data); in r8152b_init()
7010 ocp_data = ocp_read_dword(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL); in r8152b_init()
7013 ocp_write_dword(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL, ocp_data); in r8152b_init()
7016 ocp_write_word(tp, MCU_TYPE_PLA, PLA_GPHY_INTR_IMR, ocp_data); in r8152b_init()
7018 rtl_tally_reset(tp); in r8152b_init()
7021 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_USB_CTRL); in r8152b_init()
7023 ocp_write_word(tp, MCU_TYPE_USB, USB_USB_CTRL, ocp_data); in r8152b_init()
7026 static void r8153_init(struct r8152 *tp) in r8153_init() argument
7032 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in r8153_init()
7035 r8153_u1u2en(tp, false); in r8153_init()
7038 if (ocp_read_word(tp, MCU_TYPE_PLA, PLA_BOOT_CTRL) & in r8153_init()
7043 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in r8153_init()
7047 data = r8153_phy_status(tp, 0); in r8153_init()
7049 if (tp->version == RTL_VER_03 || tp->version == RTL_VER_04 || in r8153_init()
7050 tp->version == RTL_VER_05) in r8153_init()
7051 ocp_reg_write(tp, OCP_ADC_CFG, CKADSEL_L | ADC_EN | EN_EMI_L); in r8153_init()
7053 data = r8152_mdio_read(tp, MII_BMCR); in r8153_init()
7056 r8152_mdio_write(tp, MII_BMCR, data); in r8153_init()
7059 data = r8153_phy_status(tp, PHY_STAT_LAN_ON); in r8153_init()
7061 r8153_u2p3en(tp, false); in r8153_init()
7063 if (tp->version == RTL_VER_04) { in r8153_init()
7064 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_SSPHYLINK2); in r8153_init()
7067 ocp_write_word(tp, MCU_TYPE_USB, USB_SSPHYLINK2, ocp_data); in r8153_init()
7069 ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_USB2PHY); in r8153_init()
7071 ocp_write_byte(tp, MCU_TYPE_USB, USB_USB2PHY, ocp_data); in r8153_init()
7072 } else if (tp->version == RTL_VER_05) { in r8153_init()
7073 ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_DMY_REG0); in r8153_init()
7075 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_DMY_REG0, ocp_data); in r8153_init()
7077 ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_CSR_DUMMY1); in r8153_init()
7078 if (ocp_read_word(tp, MCU_TYPE_USB, USB_BURST_SIZE) == 0) in r8153_init()
7082 ocp_write_byte(tp, MCU_TYPE_USB, USB_CSR_DUMMY1, ocp_data); in r8153_init()
7083 } else if (tp->version == RTL_VER_06) { in r8153_init()
7084 ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_CSR_DUMMY1); in r8153_init()
7085 if (ocp_read_word(tp, MCU_TYPE_USB, USB_BURST_SIZE) == 0) in r8153_init()
7089 ocp_write_byte(tp, MCU_TYPE_USB, USB_CSR_DUMMY1, ocp_data); in r8153_init()
7091 r8153_queue_wake(tp, false); in r8153_init()
7093 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_EXTRA_STATUS); in r8153_init()
7094 if (rtl8152_get_speed(tp) & LINK_STATUS) in r8153_init()
7099 ocp_write_word(tp, MCU_TYPE_PLA, PLA_EXTRA_STATUS, ocp_data); in r8153_init()
7102 ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_CSR_DUMMY2); in r8153_init()
7104 ocp_write_byte(tp, MCU_TYPE_USB, USB_CSR_DUMMY2, ocp_data); in r8153_init()
7106 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_WDT11_CTRL); in r8153_init()
7108 ocp_write_word(tp, MCU_TYPE_USB, USB_WDT11_CTRL, ocp_data); in r8153_init()
7110 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_LED_FEATURE); in r8153_init()
7112 ocp_write_word(tp, MCU_TYPE_PLA, PLA_LED_FEATURE, ocp_data); in r8153_init()
7115 if (tp->version == RTL_VER_04 && tp->udev->speed < USB_SPEED_SUPER) in r8153_init()
7119 ocp_write_byte(tp, MCU_TYPE_USB, USB_LPM_CTRL, ocp_data); in r8153_init()
7121 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_AFE_CTRL2); in r8153_init()
7124 ocp_write_word(tp, MCU_TYPE_USB, USB_AFE_CTRL2, ocp_data); in r8153_init()
7126 ocp_write_word(tp, MCU_TYPE_USB, USB_CONNECT_TIMER, 0x0001); in r8153_init()
7128 r8153_power_cut_en(tp, false); in r8153_init()
7129 rtl_runtime_suspend_enable(tp, false); in r8153_init()
7130 r8153_mac_clk_speed_down(tp, false); in r8153_init()
7131 r8153_u1u2en(tp, true); in r8153_init()
7132 usb_enable_lpm(tp->udev); in r8153_init()
7134 ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_CONFIG6); in r8153_init()
7136 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CONFIG6, ocp_data); in r8153_init()
7138 ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_LWAKE_CTRL_REG); in r8153_init()
7140 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_LWAKE_CTRL_REG, ocp_data); in r8153_init()
7143 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_USB_CTRL); in r8153_init()
7145 if (tp->dell_tb_rx_agg_bug) in r8153_init()
7148 ocp_write_word(tp, MCU_TYPE_USB, USB_USB_CTRL, ocp_data); in r8153_init()
7150 rtl_tally_reset(tp); in r8153_init()
7152 switch (tp->udev->speed) { in r8153_init()
7155 tp->coalesce = COALESCE_SUPER; in r8153_init()
7158 tp->coalesce = COALESCE_HIGH; in r8153_init()
7161 tp->coalesce = COALESCE_SLOW; in r8153_init()
7166 static void r8153b_init(struct r8152 *tp) in r8153b_init() argument
7172 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in r8153b_init()
7175 r8153b_u1u2en(tp, false); in r8153b_init()
7178 if (ocp_read_word(tp, MCU_TYPE_PLA, PLA_BOOT_CTRL) & in r8153b_init()
7183 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in r8153b_init()
7187 data = r8153_phy_status(tp, 0); in r8153b_init()
7189 data = r8152_mdio_read(tp, MII_BMCR); in r8153b_init()
7192 r8152_mdio_write(tp, MII_BMCR, data); in r8153b_init()
7195 data = r8153_phy_status(tp, PHY_STAT_LAN_ON); in r8153b_init()
7197 r8153_u2p3en(tp, false); in r8153b_init()
7200 ocp_write_word(tp, MCU_TYPE_USB, USB_MSC_TIMER, 0x0fff); in r8153b_init()
7202 r8153b_power_cut_en(tp, false); in r8153b_init()
7203 r8153b_ups_en(tp, false); in r8153b_init()
7204 r8153_queue_wake(tp, false); in r8153b_init()
7205 rtl_runtime_suspend_enable(tp, false); in r8153b_init()
7207 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_EXTRA_STATUS); in r8153b_init()
7208 if (rtl8152_get_speed(tp) & LINK_STATUS) in r8153b_init()
7213 ocp_write_word(tp, MCU_TYPE_PLA, PLA_EXTRA_STATUS, ocp_data); in r8153b_init()
7215 if (tp->udev->speed >= USB_SPEED_SUPER) in r8153b_init()
7216 r8153b_u1u2en(tp, true); in r8153b_init()
7218 usb_enable_lpm(tp->udev); in r8153b_init()
7221 r8153_mac_clk_speed_down(tp, true); in r8153b_init()
7223 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL3); in r8153b_init()
7225 ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL3, ocp_data); in r8153b_init()
7227 if (tp->version == RTL_VER_09) { in r8153b_init()
7229 if (ocp_read_byte(tp, MCU_TYPE_PLA, 0xdc00) & BIT(5)) { in r8153b_init()
7230 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_PHY_PWR); in r8153b_init()
7232 ocp_write_word(tp, MCU_TYPE_PLA, PLA_PHY_PWR, ocp_data); in r8153b_init()
7236 set_bit(GREEN_ETHERNET, &tp->flags); in r8153b_init()
7239 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_USB_CTRL); in r8153b_init()
7241 ocp_write_word(tp, MCU_TYPE_USB, USB_USB_CTRL, ocp_data); in r8153b_init()
7243 rtl_tally_reset(tp); in r8153b_init()
7245 tp->coalesce = 15000; /* 15 us */ in r8153b_init()
7248 static void r8153c_init(struct r8152 *tp) in r8153c_init() argument
7254 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in r8153c_init()
7257 r8153b_u1u2en(tp, false); in r8153c_init()
7260 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CRWECR, CRWECR_CONFIG); in r8153c_init()
7261 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_CONFIG5); in r8153c_init()
7263 ocp_write_word(tp, MCU_TYPE_PLA, PLA_CONFIG5, ocp_data); in r8153c_init()
7264 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, 0xcbf0); in r8153c_init()
7266 ocp_write_word(tp, MCU_TYPE_USB, 0xcbf0, ocp_data); in r8153c_init()
7269 if (ocp_read_word(tp, MCU_TYPE_PLA, PLA_BOOT_CTRL) & in r8153c_init()
7274 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in r8153c_init()
7278 data = r8153_phy_status(tp, 0); in r8153c_init()
7280 data = r8152_mdio_read(tp, MII_BMCR); in r8153c_init()
7283 r8152_mdio_write(tp, MII_BMCR, data); in r8153c_init()
7286 data = r8153_phy_status(tp, PHY_STAT_LAN_ON); in r8153c_init()
7288 r8153_u2p3en(tp, false); in r8153c_init()
7291 ocp_write_word(tp, MCU_TYPE_USB, USB_MSC_TIMER, 0x0fff); in r8153c_init()
7293 r8153b_power_cut_en(tp, false); in r8153c_init()
7294 r8153c_ups_en(tp, false); in r8153c_init()
7295 r8153_queue_wake(tp, false); in r8153c_init()
7296 rtl_runtime_suspend_enable(tp, false); in r8153c_init()
7298 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_EXTRA_STATUS); in r8153c_init()
7299 if (rtl8152_get_speed(tp) & LINK_STATUS) in r8153c_init()
7305 ocp_write_word(tp, MCU_TYPE_PLA, PLA_EXTRA_STATUS, ocp_data); in r8153c_init()
7307 r8153b_u1u2en(tp, true); in r8153c_init()
7309 usb_enable_lpm(tp->udev); in r8153c_init()
7312 r8153_mac_clk_speed_down(tp, true); in r8153c_init()
7314 ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_MISC_2); in r8153c_init()
7316 ocp_write_byte(tp, MCU_TYPE_USB, USB_MISC_2, ocp_data); in r8153c_init()
7318 set_bit(GREEN_ETHERNET, &tp->flags); in r8153c_init()
7321 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_USB_CTRL); in r8153c_init()
7323 ocp_write_word(tp, MCU_TYPE_USB, USB_USB_CTRL, ocp_data); in r8153c_init()
7325 rtl_tally_reset(tp); in r8153c_init()
7327 tp->coalesce = 15000; /* 15 us */ in r8153c_init()
7330 static void r8156_hw_phy_cfg(struct r8152 *tp) in r8156_hw_phy_cfg() argument
7335 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_MISC_0); in r8156_hw_phy_cfg()
7338 ocp_write_word(tp, MCU_TYPE_USB, USB_MISC_0, ocp_data); in r8156_hw_phy_cfg()
7341 data = r8153_phy_status(tp, 0); in r8156_hw_phy_cfg()
7344 rtl8152_apply_firmware(tp, true); in r8156_hw_phy_cfg()
7346 data = ocp_reg_read(tp, 0xa468); in r8156_hw_phy_cfg()
7348 ocp_reg_write(tp, 0xa468, data); in r8156_hw_phy_cfg()
7353 rtl8152_apply_firmware(tp, false); in r8156_hw_phy_cfg()
7358 r8153_aldps_en(tp, false); in r8156_hw_phy_cfg()
7361 rtl_eee_enable(tp, false); in r8156_hw_phy_cfg()
7363 data = r8153_phy_status(tp, PHY_STAT_LAN_ON); in r8156_hw_phy_cfg()
7366 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_PHY_PWR); in r8156_hw_phy_cfg()
7368 ocp_write_word(tp, MCU_TYPE_PLA, PLA_PHY_PWR, ocp_data); in r8156_hw_phy_cfg()
7370 switch (tp->version) { in r8156_hw_phy_cfg()
7372 data = ocp_reg_read(tp, 0xad40); in r8156_hw_phy_cfg()
7375 ocp_reg_write(tp, 0xad40, data); in r8156_hw_phy_cfg()
7377 data = ocp_reg_read(tp, 0xad4e); in r8156_hw_phy_cfg()
7379 ocp_reg_write(tp, 0xad4e, data); in r8156_hw_phy_cfg()
7380 data = ocp_reg_read(tp, 0xad16); in r8156_hw_phy_cfg()
7383 ocp_reg_write(tp, 0xad16, data); in r8156_hw_phy_cfg()
7384 data = ocp_reg_read(tp, 0xad32); in r8156_hw_phy_cfg()
7387 ocp_reg_write(tp, 0xad32, data); in r8156_hw_phy_cfg()
7388 data = ocp_reg_read(tp, 0xac08); in r8156_hw_phy_cfg()
7390 ocp_reg_write(tp, 0xac08, data); in r8156_hw_phy_cfg()
7391 data = ocp_reg_read(tp, 0xac8a); in r8156_hw_phy_cfg()
7394 ocp_reg_write(tp, 0xac8a, data); in r8156_hw_phy_cfg()
7395 data = ocp_reg_read(tp, 0xad18); in r8156_hw_phy_cfg()
7397 ocp_reg_write(tp, 0xad18, data); in r8156_hw_phy_cfg()
7398 data = ocp_reg_read(tp, 0xad1a); in r8156_hw_phy_cfg()
7400 ocp_reg_write(tp, 0xad1a, data); in r8156_hw_phy_cfg()
7401 data = ocp_reg_read(tp, 0xad1c); in r8156_hw_phy_cfg()
7403 ocp_reg_write(tp, 0xad1c, data); in r8156_hw_phy_cfg()
7405 data = sram_read(tp, 0x80ea); in r8156_hw_phy_cfg()
7408 sram_write(tp, 0x80ea, data); in r8156_hw_phy_cfg()
7409 data = sram_read(tp, 0x80eb); in r8156_hw_phy_cfg()
7412 sram_write(tp, 0x80eb, data); in r8156_hw_phy_cfg()
7413 data = sram_read(tp, 0x80f8); in r8156_hw_phy_cfg()
7416 sram_write(tp, 0x80f8, data); in r8156_hw_phy_cfg()
7417 data = sram_read(tp, 0x80f1); in r8156_hw_phy_cfg()
7420 sram_write(tp, 0x80f1, data); in r8156_hw_phy_cfg()
7422 data = sram_read(tp, 0x80fe); in r8156_hw_phy_cfg()
7425 sram_write(tp, 0x80fe, data); in r8156_hw_phy_cfg()
7426 data = sram_read(tp, 0x8102); in r8156_hw_phy_cfg()
7429 sram_write(tp, 0x8102, data); in r8156_hw_phy_cfg()
7430 data = sram_read(tp, 0x8015); in r8156_hw_phy_cfg()
7433 sram_write(tp, 0x8015, data); in r8156_hw_phy_cfg()
7434 data = sram_read(tp, 0x8100); in r8156_hw_phy_cfg()
7437 sram_write(tp, 0x8100, data); in r8156_hw_phy_cfg()
7438 data = sram_read(tp, 0x8014); in r8156_hw_phy_cfg()
7441 sram_write(tp, 0x8014, data); in r8156_hw_phy_cfg()
7442 data = sram_read(tp, 0x8016); in r8156_hw_phy_cfg()
7445 sram_write(tp, 0x8016, data); in r8156_hw_phy_cfg()
7446 data = sram_read(tp, 0x80dc); in r8156_hw_phy_cfg()
7449 sram_write(tp, 0x80dc, data); in r8156_hw_phy_cfg()
7450 data = sram_read(tp, 0x80df); in r8156_hw_phy_cfg()
7452 sram_write(tp, 0x80df, data); in r8156_hw_phy_cfg()
7453 data = sram_read(tp, 0x80e1); in r8156_hw_phy_cfg()
7455 sram_write(tp, 0x80e1, data); in r8156_hw_phy_cfg()
7457 data = ocp_reg_read(tp, 0xbf06); in r8156_hw_phy_cfg()
7460 ocp_reg_write(tp, 0xbf06, data); in r8156_hw_phy_cfg()
7462 sram_write(tp, 0x819f, 0xddb6); in r8156_hw_phy_cfg()
7464 ocp_reg_write(tp, 0xbc34, 0x5555); in r8156_hw_phy_cfg()
7465 data = ocp_reg_read(tp, 0xbf0a); in r8156_hw_phy_cfg()
7468 ocp_reg_write(tp, 0xbf0a, data); in r8156_hw_phy_cfg()
7470 data = ocp_reg_read(tp, 0xbd2c); in r8156_hw_phy_cfg()
7472 ocp_reg_write(tp, 0xbd2c, data); in r8156_hw_phy_cfg()
7475 data = ocp_reg_read(tp, 0xad16); in r8156_hw_phy_cfg()
7477 ocp_reg_write(tp, 0xad16, data); in r8156_hw_phy_cfg()
7478 data = ocp_reg_read(tp, 0xad32); in r8156_hw_phy_cfg()
7481 ocp_reg_write(tp, 0xad32, data); in r8156_hw_phy_cfg()
7482 data = ocp_reg_read(tp, 0xac08); in r8156_hw_phy_cfg()
7484 ocp_reg_write(tp, 0xac08, data); in r8156_hw_phy_cfg()
7485 data = ocp_reg_read(tp, 0xacc0); in r8156_hw_phy_cfg()
7488 ocp_reg_write(tp, 0xacc0, data); in r8156_hw_phy_cfg()
7489 data = ocp_reg_read(tp, 0xad40); in r8156_hw_phy_cfg()
7492 ocp_reg_write(tp, 0xad40, data); in r8156_hw_phy_cfg()
7493 data = ocp_reg_read(tp, 0xac14); in r8156_hw_phy_cfg()
7495 ocp_reg_write(tp, 0xac14, data); in r8156_hw_phy_cfg()
7496 data = ocp_reg_read(tp, 0xac80); in r8156_hw_phy_cfg()
7498 ocp_reg_write(tp, 0xac80, data); in r8156_hw_phy_cfg()
7499 data = ocp_reg_read(tp, 0xac5e); in r8156_hw_phy_cfg()
7502 ocp_reg_write(tp, 0xac5e, data); in r8156_hw_phy_cfg()
7503 ocp_reg_write(tp, 0xad4c, 0x00a8); in r8156_hw_phy_cfg()
7504 ocp_reg_write(tp, 0xac5c, 0x01ff); in r8156_hw_phy_cfg()
7505 data = ocp_reg_read(tp, 0xac8a); in r8156_hw_phy_cfg()
7508 ocp_reg_write(tp, 0xac8a, data); in r8156_hw_phy_cfg()
7509 ocp_reg_write(tp, 0xb87c, 0x8157); in r8156_hw_phy_cfg()
7510 data = ocp_reg_read(tp, 0xb87e); in r8156_hw_phy_cfg()
7513 ocp_reg_write(tp, 0xb87e, data); in r8156_hw_phy_cfg()
7514 ocp_reg_write(tp, 0xb87c, 0x8159); in r8156_hw_phy_cfg()
7515 data = ocp_reg_read(tp, 0xb87e); in r8156_hw_phy_cfg()
7518 ocp_reg_write(tp, 0xb87e, data); in r8156_hw_phy_cfg()
7521 ocp_reg_write(tp, 0xb87c, 0x80a2); in r8156_hw_phy_cfg()
7522 ocp_reg_write(tp, 0xb87e, 0x0153); in r8156_hw_phy_cfg()
7523 ocp_reg_write(tp, 0xb87c, 0x809c); in r8156_hw_phy_cfg()
7524 ocp_reg_write(tp, 0xb87e, 0x0153); in r8156_hw_phy_cfg()
7527 ocp_write_word(tp, MCU_TYPE_PLA, PLA_EEE_TXTWSYS_2P5G, 0x0056); in r8156_hw_phy_cfg()
7529 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_USB_CFG); in r8156_hw_phy_cfg()
7531 ocp_write_word(tp, MCU_TYPE_PLA, PLA_USB_CFG, ocp_data); in r8156_hw_phy_cfg()
7533 sram_write(tp, 0x8257, 0x020f); /* XG PLL */ in r8156_hw_phy_cfg()
7534 sram_write(tp, 0x80ea, 0x7843); /* GIGA Master */ in r8156_hw_phy_cfg()
7536 if (rtl_phy_patch_request(tp, true, true)) in r8156_hw_phy_cfg()
7540 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL4); in r8156_hw_phy_cfg()
7542 ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL4, ocp_data); in r8156_hw_phy_cfg()
7544 data = ocp_reg_read(tp, OCP_DOWN_SPEED); in r8156_hw_phy_cfg()
7547 ocp_reg_write(tp, OCP_DOWN_SPEED, data); in r8156_hw_phy_cfg()
7548 tp->ups_info._10m_ckdiv = true; in r8156_hw_phy_cfg()
7549 tp->ups_info.eee_plloff_100 = false; in r8156_hw_phy_cfg()
7550 tp->ups_info.eee_plloff_giga = false; in r8156_hw_phy_cfg()
7552 data = ocp_reg_read(tp, OCP_POWER_CFG); in r8156_hw_phy_cfg()
7554 ocp_reg_write(tp, OCP_POWER_CFG, data); in r8156_hw_phy_cfg()
7555 tp->ups_info.eee_ckdiv = false; in r8156_hw_phy_cfg()
7557 ocp_reg_write(tp, OCP_SYSCLK_CFG, 0); in r8156_hw_phy_cfg()
7558 ocp_reg_write(tp, OCP_SYSCLK_CFG, sysclk_div_expo(5)); in r8156_hw_phy_cfg()
7559 tp->ups_info._250m_ckdiv = false; in r8156_hw_phy_cfg()
7561 rtl_phy_patch_request(tp, false, true); in r8156_hw_phy_cfg()
7564 data = ocp_reg_read(tp, 0xd068); in r8156_hw_phy_cfg()
7566 ocp_reg_write(tp, 0xd068, data); in r8156_hw_phy_cfg()
7569 data = sram_read(tp, 0x81a2); in r8156_hw_phy_cfg()
7571 sram_write(tp, 0x81a2, data); in r8156_hw_phy_cfg()
7572 data = ocp_reg_read(tp, 0xb54c); in r8156_hw_phy_cfg()
7575 ocp_reg_write(tp, 0xb54c, data); in r8156_hw_phy_cfg()
7578 data = ocp_reg_read(tp, 0xa454); in r8156_hw_phy_cfg()
7580 ocp_reg_write(tp, 0xa454, data); in r8156_hw_phy_cfg()
7583 data = ocp_reg_read(tp, OCP_10GBT_CTRL); in r8156_hw_phy_cfg()
7585 ocp_reg_write(tp, OCP_10GBT_CTRL, data); in r8156_hw_phy_cfg()
7586 data = ocp_reg_read(tp, 0xad4e); in r8156_hw_phy_cfg()
7588 ocp_reg_write(tp, 0xad4e, data); in r8156_hw_phy_cfg()
7589 data = ocp_reg_read(tp, 0xa86a); in r8156_hw_phy_cfg()
7591 ocp_reg_write(tp, 0xa86a, data); in r8156_hw_phy_cfg()
7594 if ((ocp_read_word(tp, MCU_TYPE_USB, USB_UPS_CFG) & MID_REVERSE) && in r8156_hw_phy_cfg()
7595 (ocp_reg_read(tp, 0xd068) & BIT(1))) { in r8156_hw_phy_cfg()
7598 data = ocp_reg_read(tp, 0xd068); in r8156_hw_phy_cfg()
7601 ocp_reg_write(tp, 0xd068, data); in r8156_hw_phy_cfg()
7602 swap_a = ocp_reg_read(tp, 0xd06a); in r8156_hw_phy_cfg()
7605 ocp_reg_write(tp, 0xd068, data); in r8156_hw_phy_cfg()
7606 swap_b = ocp_reg_read(tp, 0xd06a); in r8156_hw_phy_cfg()
7608 ocp_reg_write(tp, 0xd068, data); in r8156_hw_phy_cfg()
7609 ocp_reg_write(tp, 0xd06a, in r8156_hw_phy_cfg()
7612 ocp_reg_write(tp, 0xd068, data); in r8156_hw_phy_cfg()
7613 ocp_reg_write(tp, 0xd06a, in r8156_hw_phy_cfg()
7617 ocp_reg_write(tp, 0xd068, data); in r8156_hw_phy_cfg()
7618 swap_a = ocp_reg_read(tp, 0xd06a); in r8156_hw_phy_cfg()
7621 ocp_reg_write(tp, 0xd068, data); in r8156_hw_phy_cfg()
7622 swap_b = ocp_reg_read(tp, 0xd06a); in r8156_hw_phy_cfg()
7625 ocp_reg_write(tp, 0xd068, data); in r8156_hw_phy_cfg()
7626 ocp_reg_write(tp, 0xd06a, in r8156_hw_phy_cfg()
7630 ocp_reg_write(tp, 0xd068, data); in r8156_hw_phy_cfg()
7631 ocp_reg_write(tp, 0xd06a, in r8156_hw_phy_cfg()
7633 swap_a = ocp_reg_read(tp, 0xbd5a); in r8156_hw_phy_cfg()
7634 swap_b = ocp_reg_read(tp, 0xbd5c); in r8156_hw_phy_cfg()
7635 ocp_reg_write(tp, 0xbd5a, (swap_a & ~0x1f1f) | in r8156_hw_phy_cfg()
7638 ocp_reg_write(tp, 0xbd5c, (swap_b & ~0x1f1f) | in r8156_hw_phy_cfg()
7641 swap_a = ocp_reg_read(tp, 0xbc18); in r8156_hw_phy_cfg()
7642 swap_b = ocp_reg_read(tp, 0xbc1a); in r8156_hw_phy_cfg()
7643 ocp_reg_write(tp, 0xbc18, (swap_a & ~0x1f1f) | in r8156_hw_phy_cfg()
7646 ocp_reg_write(tp, 0xbc1a, (swap_b & ~0x1f1f) | in r8156_hw_phy_cfg()
7652 data = ocp_reg_read(tp, OCP_INTR_EN); in r8156_hw_phy_cfg()
7654 ocp_reg_write(tp, OCP_INTR_EN, data); in r8156_hw_phy_cfg()
7660 rtl_green_en(tp, test_bit(GREEN_ETHERNET, &tp->flags)); in r8156_hw_phy_cfg()
7662 data = ocp_reg_read(tp, 0xa428); in r8156_hw_phy_cfg()
7664 ocp_reg_write(tp, 0xa428, data); in r8156_hw_phy_cfg()
7665 data = ocp_reg_read(tp, 0xa5ea); in r8156_hw_phy_cfg()
7667 ocp_reg_write(tp, 0xa5ea, data); in r8156_hw_phy_cfg()
7668 tp->ups_info.lite_mode = 0; in r8156_hw_phy_cfg()
7670 if (tp->eee_en) in r8156_hw_phy_cfg()
7671 rtl_eee_enable(tp, true); in r8156_hw_phy_cfg()
7673 r8153_aldps_en(tp, true); in r8156_hw_phy_cfg()
7674 r8152b_enable_fc(tp); in r8156_hw_phy_cfg()
7675 r8153_u2p3en(tp, true); in r8156_hw_phy_cfg()
7677 set_bit(PHY_RESET, &tp->flags); in r8156_hw_phy_cfg()
7680 static void r8156b_hw_phy_cfg(struct r8152 *tp) in r8156b_hw_phy_cfg() argument
7685 switch (tp->version) { in r8156b_hw_phy_cfg()
7687 ocp_reg_write(tp, 0xbf86, 0x9000); in r8156b_hw_phy_cfg()
7688 data = ocp_reg_read(tp, 0xc402); in r8156b_hw_phy_cfg()
7690 ocp_reg_write(tp, 0xc402, data); in r8156b_hw_phy_cfg()
7692 ocp_reg_write(tp, 0xc402, data); in r8156b_hw_phy_cfg()
7693 ocp_reg_write(tp, 0xbd86, 0x1010); in r8156b_hw_phy_cfg()
7694 ocp_reg_write(tp, 0xbd88, 0x1010); in r8156b_hw_phy_cfg()
7695 data = ocp_reg_read(tp, 0xbd4e); in r8156b_hw_phy_cfg()
7698 ocp_reg_write(tp, 0xbd4e, data); in r8156b_hw_phy_cfg()
7699 data = ocp_reg_read(tp, 0xbf46); in r8156b_hw_phy_cfg()
7702 ocp_reg_write(tp, 0xbf46, data); in r8156b_hw_phy_cfg()
7706 r8156b_wait_loading_flash(tp); in r8156b_hw_phy_cfg()
7712 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_MISC_0); in r8156b_hw_phy_cfg()
7715 ocp_write_word(tp, MCU_TYPE_USB, USB_MISC_0, ocp_data); in r8156b_hw_phy_cfg()
7718 data = r8153_phy_status(tp, 0); in r8156b_hw_phy_cfg()
7721 rtl8152_apply_firmware(tp, true); in r8156b_hw_phy_cfg()
7723 data = ocp_reg_read(tp, 0xa466); in r8156b_hw_phy_cfg()
7725 ocp_reg_write(tp, 0xa466, data); in r8156b_hw_phy_cfg()
7727 data = ocp_reg_read(tp, 0xa468); in r8156b_hw_phy_cfg()
7729 ocp_reg_write(tp, 0xa468, data); in r8156b_hw_phy_cfg()
7734 rtl8152_apply_firmware(tp, false); in r8156b_hw_phy_cfg()
7738 data = r8152_mdio_read(tp, MII_BMCR); in r8156b_hw_phy_cfg()
7741 r8152_mdio_write(tp, MII_BMCR, data); in r8156b_hw_phy_cfg()
7745 r8153_aldps_en(tp, false); in r8156b_hw_phy_cfg()
7748 rtl_eee_enable(tp, false); in r8156b_hw_phy_cfg()
7750 data = r8153_phy_status(tp, PHY_STAT_LAN_ON); in r8156b_hw_phy_cfg()
7753 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_PHY_PWR); in r8156b_hw_phy_cfg()
7755 ocp_write_word(tp, MCU_TYPE_PLA, PLA_PHY_PWR, ocp_data); in r8156b_hw_phy_cfg()
7757 switch (tp->version) { in r8156b_hw_phy_cfg()
7759 data = ocp_reg_read(tp, 0xbc08); in r8156b_hw_phy_cfg()
7761 ocp_reg_write(tp, 0xbc08, data); in r8156b_hw_phy_cfg()
7763 data = sram_read(tp, 0x8fff); in r8156b_hw_phy_cfg()
7766 sram_write(tp, 0x8fff, data); in r8156b_hw_phy_cfg()
7768 data = ocp_reg_read(tp, 0xacda); in r8156b_hw_phy_cfg()
7770 ocp_reg_write(tp, 0xacda, data); in r8156b_hw_phy_cfg()
7771 data = ocp_reg_read(tp, 0xacde); in r8156b_hw_phy_cfg()
7773 ocp_reg_write(tp, 0xacde, data); in r8156b_hw_phy_cfg()
7774 ocp_reg_write(tp, 0xac8c, 0x0ffc); in r8156b_hw_phy_cfg()
7775 ocp_reg_write(tp, 0xac46, 0xb7b4); in r8156b_hw_phy_cfg()
7776 ocp_reg_write(tp, 0xac50, 0x0fbc); in r8156b_hw_phy_cfg()
7777 ocp_reg_write(tp, 0xac3c, 0x9240); in r8156b_hw_phy_cfg()
7778 ocp_reg_write(tp, 0xac4e, 0x0db4); in r8156b_hw_phy_cfg()
7779 ocp_reg_write(tp, 0xacc6, 0x0707); in r8156b_hw_phy_cfg()
7780 ocp_reg_write(tp, 0xacc8, 0xa0d3); in r8156b_hw_phy_cfg()
7781 ocp_reg_write(tp, 0xad08, 0x0007); in r8156b_hw_phy_cfg()
7783 ocp_reg_write(tp, 0xb87c, 0x8560); in r8156b_hw_phy_cfg()
7784 ocp_reg_write(tp, 0xb87e, 0x19cc); in r8156b_hw_phy_cfg()
7785 ocp_reg_write(tp, 0xb87c, 0x8562); in r8156b_hw_phy_cfg()
7786 ocp_reg_write(tp, 0xb87e, 0x19cc); in r8156b_hw_phy_cfg()
7787 ocp_reg_write(tp, 0xb87c, 0x8564); in r8156b_hw_phy_cfg()
7788 ocp_reg_write(tp, 0xb87e, 0x19cc); in r8156b_hw_phy_cfg()
7789 ocp_reg_write(tp, 0xb87c, 0x8566); in r8156b_hw_phy_cfg()
7790 ocp_reg_write(tp, 0xb87e, 0x147d); in r8156b_hw_phy_cfg()
7791 ocp_reg_write(tp, 0xb87c, 0x8568); in r8156b_hw_phy_cfg()
7792 ocp_reg_write(tp, 0xb87e, 0x147d); in r8156b_hw_phy_cfg()
7793 ocp_reg_write(tp, 0xb87c, 0x856a); in r8156b_hw_phy_cfg()
7794 ocp_reg_write(tp, 0xb87e, 0x147d); in r8156b_hw_phy_cfg()
7795 ocp_reg_write(tp, 0xb87c, 0x8ffe); in r8156b_hw_phy_cfg()
7796 ocp_reg_write(tp, 0xb87e, 0x0907); in r8156b_hw_phy_cfg()
7797 ocp_reg_write(tp, 0xb87c, 0x80d6); in r8156b_hw_phy_cfg()
7798 ocp_reg_write(tp, 0xb87e, 0x2801); in r8156b_hw_phy_cfg()
7799 ocp_reg_write(tp, 0xb87c, 0x80f2); in r8156b_hw_phy_cfg()
7800 ocp_reg_write(tp, 0xb87e, 0x2801); in r8156b_hw_phy_cfg()
7801 ocp_reg_write(tp, 0xb87c, 0x80f4); in r8156b_hw_phy_cfg()
7802 ocp_reg_write(tp, 0xb87e, 0x6077); in r8156b_hw_phy_cfg()
7803 ocp_reg_write(tp, 0xb506, 0x01e7); in r8156b_hw_phy_cfg()
7805 ocp_reg_write(tp, 0xb87c, 0x8013); in r8156b_hw_phy_cfg()
7806 ocp_reg_write(tp, 0xb87e, 0x0700); in r8156b_hw_phy_cfg()
7807 ocp_reg_write(tp, 0xb87c, 0x8fb9); in r8156b_hw_phy_cfg()
7808 ocp_reg_write(tp, 0xb87e, 0x2801); in r8156b_hw_phy_cfg()
7809 ocp_reg_write(tp, 0xb87c, 0x8fba); in r8156b_hw_phy_cfg()
7810 ocp_reg_write(tp, 0xb87e, 0x0100); in r8156b_hw_phy_cfg()
7811 ocp_reg_write(tp, 0xb87c, 0x8fbc); in r8156b_hw_phy_cfg()
7812 ocp_reg_write(tp, 0xb87e, 0x1900); in r8156b_hw_phy_cfg()
7813 ocp_reg_write(tp, 0xb87c, 0x8fbe); in r8156b_hw_phy_cfg()
7814 ocp_reg_write(tp, 0xb87e, 0xe100); in r8156b_hw_phy_cfg()
7815 ocp_reg_write(tp, 0xb87c, 0x8fc0); in r8156b_hw_phy_cfg()
7816 ocp_reg_write(tp, 0xb87e, 0x0800); in r8156b_hw_phy_cfg()
7817 ocp_reg_write(tp, 0xb87c, 0x8fc2); in r8156b_hw_phy_cfg()
7818 ocp_reg_write(tp, 0xb87e, 0xe500); in r8156b_hw_phy_cfg()
7819 ocp_reg_write(tp, 0xb87c, 0x8fc4); in r8156b_hw_phy_cfg()
7820 ocp_reg_write(tp, 0xb87e, 0x0f00); in r8156b_hw_phy_cfg()
7821 ocp_reg_write(tp, 0xb87c, 0x8fc6); in r8156b_hw_phy_cfg()
7822 ocp_reg_write(tp, 0xb87e, 0xf100); in r8156b_hw_phy_cfg()
7823 ocp_reg_write(tp, 0xb87c, 0x8fc8); in r8156b_hw_phy_cfg()
7824 ocp_reg_write(tp, 0xb87e, 0x0400); in r8156b_hw_phy_cfg()
7825 ocp_reg_write(tp, 0xb87c, 0x8fca); in r8156b_hw_phy_cfg()
7826 ocp_reg_write(tp, 0xb87e, 0xf300); in r8156b_hw_phy_cfg()
7827 ocp_reg_write(tp, 0xb87c, 0x8fcc); in r8156b_hw_phy_cfg()
7828 ocp_reg_write(tp, 0xb87e, 0xfd00); in r8156b_hw_phy_cfg()
7829 ocp_reg_write(tp, 0xb87c, 0x8fce); in r8156b_hw_phy_cfg()
7830 ocp_reg_write(tp, 0xb87e, 0xff00); in r8156b_hw_phy_cfg()
7831 ocp_reg_write(tp, 0xb87c, 0x8fd0); in r8156b_hw_phy_cfg()
7832 ocp_reg_write(tp, 0xb87e, 0xfb00); in r8156b_hw_phy_cfg()
7833 ocp_reg_write(tp, 0xb87c, 0x8fd2); in r8156b_hw_phy_cfg()
7834 ocp_reg_write(tp, 0xb87e, 0x0100); in r8156b_hw_phy_cfg()
7835 ocp_reg_write(tp, 0xb87c, 0x8fd4); in r8156b_hw_phy_cfg()
7836 ocp_reg_write(tp, 0xb87e, 0xf400); in r8156b_hw_phy_cfg()
7837 ocp_reg_write(tp, 0xb87c, 0x8fd6); in r8156b_hw_phy_cfg()
7838 ocp_reg_write(tp, 0xb87e, 0xff00); in r8156b_hw_phy_cfg()
7839 ocp_reg_write(tp, 0xb87c, 0x8fd8); in r8156b_hw_phy_cfg()
7840 ocp_reg_write(tp, 0xb87e, 0xf600); in r8156b_hw_phy_cfg()
7842 ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_USB_CFG); in r8156b_hw_phy_cfg()
7844 ocp_write_byte(tp, MCU_TYPE_PLA, PLA_USB_CFG, ocp_data); in r8156b_hw_phy_cfg()
7845 ocp_reg_write(tp, 0xb87c, 0x813d); in r8156b_hw_phy_cfg()
7846 ocp_reg_write(tp, 0xb87e, 0x390e); in r8156b_hw_phy_cfg()
7847 ocp_reg_write(tp, 0xb87c, 0x814f); in r8156b_hw_phy_cfg()
7848 ocp_reg_write(tp, 0xb87e, 0x790e); in r8156b_hw_phy_cfg()
7849 ocp_reg_write(tp, 0xb87c, 0x80b0); in r8156b_hw_phy_cfg()
7850 ocp_reg_write(tp, 0xb87e, 0x0f31); in r8156b_hw_phy_cfg()
7851 data = ocp_reg_read(tp, 0xbf4c); in r8156b_hw_phy_cfg()
7853 ocp_reg_write(tp, 0xbf4c, data); in r8156b_hw_phy_cfg()
7854 data = ocp_reg_read(tp, 0xbcca); in r8156b_hw_phy_cfg()
7856 ocp_reg_write(tp, 0xbcca, data); in r8156b_hw_phy_cfg()
7857 ocp_reg_write(tp, 0xb87c, 0x8141); in r8156b_hw_phy_cfg()
7858 ocp_reg_write(tp, 0xb87e, 0x320e); in r8156b_hw_phy_cfg()
7859 ocp_reg_write(tp, 0xb87c, 0x8153); in r8156b_hw_phy_cfg()
7860 ocp_reg_write(tp, 0xb87e, 0x720e); in r8156b_hw_phy_cfg()
7861 ocp_reg_write(tp, 0xb87c, 0x8529); in r8156b_hw_phy_cfg()
7862 ocp_reg_write(tp, 0xb87e, 0x050e); in r8156b_hw_phy_cfg()
7863 data = ocp_reg_read(tp, OCP_EEE_CFG); in r8156b_hw_phy_cfg()
7865 ocp_reg_write(tp, OCP_EEE_CFG, data); in r8156b_hw_phy_cfg()
7867 sram_write(tp, 0x816c, 0xc4a0); in r8156b_hw_phy_cfg()
7868 sram_write(tp, 0x8170, 0xc4a0); in r8156b_hw_phy_cfg()
7869 sram_write(tp, 0x8174, 0x04a0); in r8156b_hw_phy_cfg()
7870 sram_write(tp, 0x8178, 0x04a0); in r8156b_hw_phy_cfg()
7871 sram_write(tp, 0x817c, 0x0719); in r8156b_hw_phy_cfg()
7872 sram_write(tp, 0x8ff4, 0x0400); in r8156b_hw_phy_cfg()
7873 sram_write(tp, 0x8ff1, 0x0404); in r8156b_hw_phy_cfg()
7875 ocp_reg_write(tp, 0xbf4a, 0x001b); in r8156b_hw_phy_cfg()
7876 ocp_reg_write(tp, 0xb87c, 0x8033); in r8156b_hw_phy_cfg()
7877 ocp_reg_write(tp, 0xb87e, 0x7c13); in r8156b_hw_phy_cfg()
7878 ocp_reg_write(tp, 0xb87c, 0x8037); in r8156b_hw_phy_cfg()
7879 ocp_reg_write(tp, 0xb87e, 0x7c13); in r8156b_hw_phy_cfg()
7880 ocp_reg_write(tp, 0xb87c, 0x803b); in r8156b_hw_phy_cfg()
7881 ocp_reg_write(tp, 0xb87e, 0xfc32); in r8156b_hw_phy_cfg()
7882 ocp_reg_write(tp, 0xb87c, 0x803f); in r8156b_hw_phy_cfg()
7883 ocp_reg_write(tp, 0xb87e, 0x7c13); in r8156b_hw_phy_cfg()
7884 ocp_reg_write(tp, 0xb87c, 0x8043); in r8156b_hw_phy_cfg()
7885 ocp_reg_write(tp, 0xb87e, 0x7c13); in r8156b_hw_phy_cfg()
7886 ocp_reg_write(tp, 0xb87c, 0x8047); in r8156b_hw_phy_cfg()
7887 ocp_reg_write(tp, 0xb87e, 0x7c13); in r8156b_hw_phy_cfg()
7889 ocp_reg_write(tp, 0xb87c, 0x8145); in r8156b_hw_phy_cfg()
7890 ocp_reg_write(tp, 0xb87e, 0x370e); in r8156b_hw_phy_cfg()
7891 ocp_reg_write(tp, 0xb87c, 0x8157); in r8156b_hw_phy_cfg()
7892 ocp_reg_write(tp, 0xb87e, 0x770e); in r8156b_hw_phy_cfg()
7893 ocp_reg_write(tp, 0xb87c, 0x8169); in r8156b_hw_phy_cfg()
7894 ocp_reg_write(tp, 0xb87e, 0x0d0a); in r8156b_hw_phy_cfg()
7895 ocp_reg_write(tp, 0xb87c, 0x817b); in r8156b_hw_phy_cfg()
7896 ocp_reg_write(tp, 0xb87e, 0x1d0a); in r8156b_hw_phy_cfg()
7898 data = sram_read(tp, 0x8217); in r8156b_hw_phy_cfg()
7901 sram_write(tp, 0x8217, data); in r8156b_hw_phy_cfg()
7902 data = sram_read(tp, 0x821a); in r8156b_hw_phy_cfg()
7905 sram_write(tp, 0x821a, data); in r8156b_hw_phy_cfg()
7906 sram_write(tp, 0x80da, 0x0403); in r8156b_hw_phy_cfg()
7907 data = sram_read(tp, 0x80dc); in r8156b_hw_phy_cfg()
7910 sram_write(tp, 0x80dc, data); in r8156b_hw_phy_cfg()
7911 sram_write(tp, 0x80b3, 0x0384); in r8156b_hw_phy_cfg()
7912 sram_write(tp, 0x80b7, 0x2007); in r8156b_hw_phy_cfg()
7913 data = sram_read(tp, 0x80ba); in r8156b_hw_phy_cfg()
7916 sram_write(tp, 0x80ba, data); in r8156b_hw_phy_cfg()
7917 sram_write(tp, 0x80b5, 0xf009); in r8156b_hw_phy_cfg()
7918 data = sram_read(tp, 0x80bd); in r8156b_hw_phy_cfg()
7921 sram_write(tp, 0x80bd, data); in r8156b_hw_phy_cfg()
7922 sram_write(tp, 0x80c7, 0xf083); in r8156b_hw_phy_cfg()
7923 sram_write(tp, 0x80dd, 0x03f0); in r8156b_hw_phy_cfg()
7924 data = sram_read(tp, 0x80df); in r8156b_hw_phy_cfg()
7927 sram_write(tp, 0x80df, data); in r8156b_hw_phy_cfg()
7928 sram_write(tp, 0x80cb, 0x2007); in r8156b_hw_phy_cfg()
7929 data = sram_read(tp, 0x80ce); in r8156b_hw_phy_cfg()
7932 sram_write(tp, 0x80ce, data); in r8156b_hw_phy_cfg()
7933 sram_write(tp, 0x80c9, 0x8009); in r8156b_hw_phy_cfg()
7934 data = sram_read(tp, 0x80d1); in r8156b_hw_phy_cfg()
7937 sram_write(tp, 0x80d1, data); in r8156b_hw_phy_cfg()
7938 sram_write(tp, 0x80a3, 0x200a); in r8156b_hw_phy_cfg()
7939 sram_write(tp, 0x80a5, 0xf0ad); in r8156b_hw_phy_cfg()
7940 sram_write(tp, 0x809f, 0x6073); in r8156b_hw_phy_cfg()
7941 sram_write(tp, 0x80a1, 0x000b); in r8156b_hw_phy_cfg()
7942 data = sram_read(tp, 0x80a9); in r8156b_hw_phy_cfg()
7945 sram_write(tp, 0x80a9, data); in r8156b_hw_phy_cfg()
7947 if (rtl_phy_patch_request(tp, true, true)) in r8156b_hw_phy_cfg()
7950 data = ocp_reg_read(tp, 0xb896); in r8156b_hw_phy_cfg()
7952 ocp_reg_write(tp, 0xb896, data); in r8156b_hw_phy_cfg()
7953 data = ocp_reg_read(tp, 0xb892); in r8156b_hw_phy_cfg()
7955 ocp_reg_write(tp, 0xb892, data); in r8156b_hw_phy_cfg()
7956 ocp_reg_write(tp, 0xb88e, 0xc23e); in r8156b_hw_phy_cfg()
7957 ocp_reg_write(tp, 0xb890, 0x0000); in r8156b_hw_phy_cfg()
7958 ocp_reg_write(tp, 0xb88e, 0xc240); in r8156b_hw_phy_cfg()
7959 ocp_reg_write(tp, 0xb890, 0x0103); in r8156b_hw_phy_cfg()
7960 ocp_reg_write(tp, 0xb88e, 0xc242); in r8156b_hw_phy_cfg()
7961 ocp_reg_write(tp, 0xb890, 0x0507); in r8156b_hw_phy_cfg()
7962 ocp_reg_write(tp, 0xb88e, 0xc244); in r8156b_hw_phy_cfg()
7963 ocp_reg_write(tp, 0xb890, 0x090b); in r8156b_hw_phy_cfg()
7964 ocp_reg_write(tp, 0xb88e, 0xc246); in r8156b_hw_phy_cfg()
7965 ocp_reg_write(tp, 0xb890, 0x0c0e); in r8156b_hw_phy_cfg()
7966 ocp_reg_write(tp, 0xb88e, 0xc248); in r8156b_hw_phy_cfg()
7967 ocp_reg_write(tp, 0xb890, 0x1012); in r8156b_hw_phy_cfg()
7968 ocp_reg_write(tp, 0xb88e, 0xc24a); in r8156b_hw_phy_cfg()
7969 ocp_reg_write(tp, 0xb890, 0x1416); in r8156b_hw_phy_cfg()
7970 data = ocp_reg_read(tp, 0xb896); in r8156b_hw_phy_cfg()
7972 ocp_reg_write(tp, 0xb896, data); in r8156b_hw_phy_cfg()
7974 rtl_phy_patch_request(tp, false, true); in r8156b_hw_phy_cfg()
7976 data = ocp_reg_read(tp, 0xa86a); in r8156b_hw_phy_cfg()
7978 ocp_reg_write(tp, 0xa86a, data); in r8156b_hw_phy_cfg()
7979 data = ocp_reg_read(tp, 0xa6f0); in r8156b_hw_phy_cfg()
7981 ocp_reg_write(tp, 0xa6f0, data); in r8156b_hw_phy_cfg()
7983 ocp_reg_write(tp, 0xbfa0, 0xd70d); in r8156b_hw_phy_cfg()
7984 ocp_reg_write(tp, 0xbfa2, 0x4100); in r8156b_hw_phy_cfg()
7985 ocp_reg_write(tp, 0xbfa4, 0xe868); in r8156b_hw_phy_cfg()
7986 ocp_reg_write(tp, 0xbfa6, 0xdc59); in r8156b_hw_phy_cfg()
7987 ocp_reg_write(tp, 0xb54c, 0x3c18); in r8156b_hw_phy_cfg()
7988 data = ocp_reg_read(tp, 0xbfa4); in r8156b_hw_phy_cfg()
7990 ocp_reg_write(tp, 0xbfa4, data); in r8156b_hw_phy_cfg()
7991 data = sram_read(tp, 0x817d); in r8156b_hw_phy_cfg()
7993 sram_write(tp, 0x817d, data); in r8156b_hw_phy_cfg()
7997 data = ocp_reg_read(tp, 0xac46); in r8156b_hw_phy_cfg()
8000 ocp_reg_write(tp, 0xac46, data); in r8156b_hw_phy_cfg()
8001 data = ocp_reg_read(tp, 0xad30); in r8156b_hw_phy_cfg()
8004 ocp_reg_write(tp, 0xad30, data); in r8156b_hw_phy_cfg()
8008 ocp_reg_write(tp, 0xb87c, 0x80f5); in r8156b_hw_phy_cfg()
8009 ocp_reg_write(tp, 0xb87e, 0x760e); in r8156b_hw_phy_cfg()
8010 ocp_reg_write(tp, 0xb87c, 0x8107); in r8156b_hw_phy_cfg()
8011 ocp_reg_write(tp, 0xb87e, 0x360e); in r8156b_hw_phy_cfg()
8012 ocp_reg_write(tp, 0xb87c, 0x8551); in r8156b_hw_phy_cfg()
8013 data = ocp_reg_read(tp, 0xb87e); in r8156b_hw_phy_cfg()
8016 ocp_reg_write(tp, 0xb87e, data); in r8156b_hw_phy_cfg()
8019 data = ocp_reg_read(tp, 0xbf00); in r8156b_hw_phy_cfg()
8022 ocp_reg_write(tp, 0xbf00, data); in r8156b_hw_phy_cfg()
8023 data = ocp_reg_read(tp, 0xbf46); in r8156b_hw_phy_cfg()
8026 ocp_reg_write(tp, 0xbf46, data); in r8156b_hw_phy_cfg()
8029 sram_write(tp, 0x8044, 0x2417); in r8156b_hw_phy_cfg()
8030 sram_write(tp, 0x804a, 0x2417); in r8156b_hw_phy_cfg()
8031 sram_write(tp, 0x8050, 0x2417); in r8156b_hw_phy_cfg()
8032 sram_write(tp, 0x8056, 0x2417); in r8156b_hw_phy_cfg()
8033 sram_write(tp, 0x805c, 0x2417); in r8156b_hw_phy_cfg()
8034 sram_write(tp, 0x8062, 0x2417); in r8156b_hw_phy_cfg()
8035 sram_write(tp, 0x8068, 0x2417); in r8156b_hw_phy_cfg()
8036 sram_write(tp, 0x806e, 0x2417); in r8156b_hw_phy_cfg()
8037 sram_write(tp, 0x8074, 0x2417); in r8156b_hw_phy_cfg()
8038 sram_write(tp, 0x807a, 0x2417); in r8156b_hw_phy_cfg()
8041 data = ocp_reg_read(tp, 0xbf84); in r8156b_hw_phy_cfg()
8044 ocp_reg_write(tp, 0xbf84, data); in r8156b_hw_phy_cfg()
8051 data = ocp_reg_read(tp, OCP_INTR_EN); in r8156b_hw_phy_cfg()
8053 ocp_reg_write(tp, OCP_INTR_EN, data); in r8156b_hw_phy_cfg()
8055 if (rtl_phy_patch_request(tp, true, true)) in r8156b_hw_phy_cfg()
8058 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL4); in r8156b_hw_phy_cfg()
8060 ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL4, ocp_data); in r8156b_hw_phy_cfg()
8062 data = ocp_reg_read(tp, OCP_DOWN_SPEED); in r8156b_hw_phy_cfg()
8065 ocp_reg_write(tp, OCP_DOWN_SPEED, data); in r8156b_hw_phy_cfg()
8066 tp->ups_info._10m_ckdiv = true; in r8156b_hw_phy_cfg()
8067 tp->ups_info.eee_plloff_100 = false; in r8156b_hw_phy_cfg()
8068 tp->ups_info.eee_plloff_giga = false; in r8156b_hw_phy_cfg()
8070 data = ocp_reg_read(tp, OCP_POWER_CFG); in r8156b_hw_phy_cfg()
8072 ocp_reg_write(tp, OCP_POWER_CFG, data); in r8156b_hw_phy_cfg()
8073 tp->ups_info.eee_ckdiv = false; in r8156b_hw_phy_cfg()
8075 rtl_phy_patch_request(tp, false, true); in r8156b_hw_phy_cfg()
8077 rtl_green_en(tp, test_bit(GREEN_ETHERNET, &tp->flags)); in r8156b_hw_phy_cfg()
8079 data = ocp_reg_read(tp, 0xa428); in r8156b_hw_phy_cfg()
8081 ocp_reg_write(tp, 0xa428, data); in r8156b_hw_phy_cfg()
8082 data = ocp_reg_read(tp, 0xa5ea); in r8156b_hw_phy_cfg()
8084 ocp_reg_write(tp, 0xa5ea, data); in r8156b_hw_phy_cfg()
8085 tp->ups_info.lite_mode = 0; in r8156b_hw_phy_cfg()
8087 if (tp->eee_en) in r8156b_hw_phy_cfg()
8088 rtl_eee_enable(tp, true); in r8156b_hw_phy_cfg()
8090 r8153_aldps_en(tp, true); in r8156b_hw_phy_cfg()
8091 r8152b_enable_fc(tp); in r8156b_hw_phy_cfg()
8092 r8153_u2p3en(tp, true); in r8156b_hw_phy_cfg()
8094 set_bit(PHY_RESET, &tp->flags); in r8156b_hw_phy_cfg()
8097 static void r8156_init(struct r8152 *tp) in r8156_init() argument
8103 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in r8156_init()
8106 ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_ECM_OP); in r8156_init()
8108 ocp_write_byte(tp, MCU_TYPE_USB, USB_ECM_OP, ocp_data); in r8156_init()
8110 ocp_write_word(tp, MCU_TYPE_USB, USB_SPEED_OPTION, 0); in r8156_init()
8112 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_ECM_OPTION); in r8156_init()
8114 ocp_write_word(tp, MCU_TYPE_USB, USB_ECM_OPTION, ocp_data); in r8156_init()
8116 r8153b_u1u2en(tp, false); in r8156_init()
8119 if (ocp_read_word(tp, MCU_TYPE_PLA, PLA_BOOT_CTRL) & in r8156_init()
8124 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in r8156_init()
8128 data = r8153_phy_status(tp, 0); in r8156_init()
8130 data = ocp_reg_read(tp, 0xa468); in r8156_init()
8132 ocp_reg_write(tp, 0xa468, data); in r8156_init()
8135 data = r8152_mdio_read(tp, MII_BMCR); in r8156_init()
8138 r8152_mdio_write(tp, MII_BMCR, data); in r8156_init()
8141 data = r8153_phy_status(tp, PHY_STAT_LAN_ON); in r8156_init()
8144 r8153_u2p3en(tp, false); in r8156_init()
8147 ocp_write_word(tp, MCU_TYPE_USB, USB_MSC_TIMER, 0x0fff); in r8156_init()
8150 ocp_write_word(tp, MCU_TYPE_USB, USB_U1U2_TIMER, 500); in r8156_init()
8152 r8153b_power_cut_en(tp, false); in r8156_init()
8153 r8156_ups_en(tp, false); in r8156_init()
8154 r8153_queue_wake(tp, false); in r8156_init()
8155 rtl_runtime_suspend_enable(tp, false); in r8156_init()
8157 if (tp->udev->speed >= USB_SPEED_SUPER) in r8156_init()
8158 r8153b_u1u2en(tp, true); in r8156_init()
8160 usb_enable_lpm(tp->udev); in r8156_init()
8162 r8156_mac_clk_spd(tp, true); in r8156_init()
8164 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL3); in r8156_init()
8166 ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL3, ocp_data); in r8156_init()
8168 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_EXTRA_STATUS); in r8156_init()
8169 if (rtl8152_get_speed(tp) & LINK_STATUS) in r8156_init()
8174 ocp_write_word(tp, MCU_TYPE_PLA, PLA_EXTRA_STATUS, ocp_data); in r8156_init()
8176 set_bit(GREEN_ETHERNET, &tp->flags); in r8156_init()
8179 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_USB_CTRL); in r8156_init()
8181 ocp_write_word(tp, MCU_TYPE_USB, USB_USB_CTRL, ocp_data); in r8156_init()
8183 ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_BMU_CONFIG); in r8156_init()
8185 ocp_write_byte(tp, MCU_TYPE_USB, USB_BMU_CONFIG, ocp_data); in r8156_init()
8187 r8156_mdio_force_mode(tp); in r8156_init()
8188 rtl_tally_reset(tp); in r8156_init()
8190 tp->coalesce = 15000; /* 15 us */ in r8156_init()
8193 static void r8156b_init(struct r8152 *tp) in r8156b_init() argument
8199 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in r8156b_init()
8202 ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_ECM_OP); in r8156b_init()
8204 ocp_write_byte(tp, MCU_TYPE_USB, USB_ECM_OP, ocp_data); in r8156b_init()
8206 ocp_write_word(tp, MCU_TYPE_USB, USB_SPEED_OPTION, 0); in r8156b_init()
8208 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_ECM_OPTION); in r8156b_init()
8210 ocp_write_word(tp, MCU_TYPE_USB, USB_ECM_OPTION, ocp_data); in r8156b_init()
8212 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_U2P3_CTRL); in r8156b_init()
8214 ocp_write_word(tp, MCU_TYPE_USB, USB_U2P3_CTRL, ocp_data); in r8156b_init()
8216 r8153b_u1u2en(tp, false); in r8156b_init()
8218 switch (tp->version) { in r8156b_init()
8221 r8156b_wait_loading_flash(tp); in r8156b_init()
8228 if (ocp_read_word(tp, MCU_TYPE_PLA, PLA_BOOT_CTRL) & in r8156b_init()
8233 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in r8156b_init()
8237 data = r8153_phy_status(tp, 0); in r8156b_init()
8239 data = ocp_reg_read(tp, 0xa468); in r8156b_init()
8241 ocp_reg_write(tp, 0xa468, data); in r8156b_init()
8243 data = ocp_reg_read(tp, 0xa466); in r8156b_init()
8245 ocp_reg_write(tp, 0xa466, data); in r8156b_init()
8248 data = r8152_mdio_read(tp, MII_BMCR); in r8156b_init()
8251 r8152_mdio_write(tp, MII_BMCR, data); in r8156b_init()
8254 data = r8153_phy_status(tp, PHY_STAT_LAN_ON); in r8156b_init()
8256 r8153_u2p3en(tp, false); in r8156b_init()
8259 ocp_write_word(tp, MCU_TYPE_USB, USB_MSC_TIMER, 0x0fff); in r8156b_init()
8262 ocp_write_word(tp, MCU_TYPE_USB, USB_U1U2_TIMER, 500); in r8156b_init()
8264 r8153b_power_cut_en(tp, false); in r8156b_init()
8265 r8156_ups_en(tp, false); in r8156b_init()
8266 r8153_queue_wake(tp, false); in r8156b_init()
8267 rtl_runtime_suspend_enable(tp, false); in r8156b_init()
8269 if (tp->udev->speed >= USB_SPEED_SUPER) in r8156b_init()
8270 r8153b_u1u2en(tp, true); in r8156b_init()
8272 usb_enable_lpm(tp->udev); in r8156b_init()
8274 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_RCR); in r8156b_init()
8276 ocp_write_word(tp, MCU_TYPE_PLA, PLA_RCR, ocp_data); in r8156b_init()
8278 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_CPCR); in r8156b_init()
8280 ocp_write_word(tp, MCU_TYPE_PLA, PLA_CPCR, ocp_data); in r8156b_init()
8283 ocp_write_word(tp, MCU_TYPE_USB, USB_FC_TIMER, in r8156b_init()
8286 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_FW_CTRL); in r8156b_init()
8287 if (!(ocp_read_word(tp, MCU_TYPE_PLA, PLA_POL_GPIO_CTRL) & DACK_DET_EN)) in r8156b_init()
8290 ocp_write_word(tp, MCU_TYPE_USB, USB_FW_CTRL, ocp_data); in r8156b_init()
8292 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_FW_TASK); in r8156b_init()
8294 ocp_write_word(tp, MCU_TYPE_USB, USB_FW_TASK, ocp_data); in r8156b_init()
8296 r8156_mac_clk_spd(tp, true); in r8156b_init()
8298 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL3); in r8156b_init()
8300 ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL3, ocp_data); in r8156b_init()
8302 ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_EXTRA_STATUS); in r8156b_init()
8303 if (rtl8152_get_speed(tp) & LINK_STATUS) in r8156b_init()
8308 ocp_write_word(tp, MCU_TYPE_PLA, PLA_EXTRA_STATUS, ocp_data); in r8156b_init()
8310 set_bit(GREEN_ETHERNET, &tp->flags); in r8156b_init()
8313 ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_USB_CTRL); in r8156b_init()
8315 ocp_write_word(tp, MCU_TYPE_USB, USB_USB_CTRL, ocp_data); in r8156b_init()
8317 r8156_mdio_force_mode(tp); in r8156b_init()
8318 rtl_tally_reset(tp); in r8156b_init()
8320 tp->coalesce = 15000; /* 15 us */ in r8156b_init()
8356 struct r8152 *tp = usb_get_intfdata(intf); in rtl8152_pre_reset() local
8359 if (!tp || !test_bit(PROBED_WITH_NO_ERRORS, &tp->flags)) in rtl8152_pre_reset()
8362 netdev = tp->netdev; in rtl8152_pre_reset()
8367 tasklet_disable(&tp->tx_tl); in rtl8152_pre_reset()
8368 clear_bit(WORK_ENABLE, &tp->flags); in rtl8152_pre_reset()
8369 usb_kill_urb(tp->intr_urb); in rtl8152_pre_reset()
8370 cancel_delayed_work_sync(&tp->schedule); in rtl8152_pre_reset()
8371 napi_disable(&tp->napi); in rtl8152_pre_reset()
8373 mutex_lock(&tp->control); in rtl8152_pre_reset()
8374 set_bit(IN_PRE_RESET, &tp->flags); in rtl8152_pre_reset()
8375 tp->rtl_ops.disable(tp); in rtl8152_pre_reset()
8376 clear_bit(IN_PRE_RESET, &tp->flags); in rtl8152_pre_reset()
8377 mutex_unlock(&tp->control); in rtl8152_pre_reset()
8385 struct r8152 *tp = usb_get_intfdata(intf); in rtl8152_post_reset() local
8389 if (!tp || !test_bit(PROBED_WITH_NO_ERRORS, &tp->flags)) in rtl8152_post_reset()
8392 rtl_set_accessible(tp); in rtl8152_post_reset()
8395 if (determine_ethernet_addr(tp, &sa) >= 0) { in rtl8152_post_reset()
8397 dev_set_mac_address (tp->netdev, &sa, NULL); in rtl8152_post_reset()
8401 netdev = tp->netdev; in rtl8152_post_reset()
8405 set_bit(WORK_ENABLE, &tp->flags); in rtl8152_post_reset()
8407 mutex_lock(&tp->control); in rtl8152_post_reset()
8408 tp->rtl_ops.enable(tp); in rtl8152_post_reset()
8409 rtl_start_rx(tp); in rtl8152_post_reset()
8411 mutex_unlock(&tp->control); in rtl8152_post_reset()
8414 napi_enable(&tp->napi); in rtl8152_post_reset()
8415 tasklet_enable(&tp->tx_tl); in rtl8152_post_reset()
8417 usb_submit_urb(tp->intr_urb, GFP_KERNEL); in rtl8152_post_reset()
8419 if (!list_empty(&tp->rx_done)) in rtl8152_post_reset()
8420 napi_schedule(&tp->napi); in rtl8152_post_reset()
8425 static bool delay_autosuspend(struct r8152 *tp) in delay_autosuspend() argument
8427 bool sw_linking = !!netif_carrier_ok(tp->netdev); in delay_autosuspend()
8428 bool hw_linking = !!(rtl8152_get_speed(tp) & LINK_STATUS); in delay_autosuspend()
8434 if (work_busy(&tp->schedule.work) || sw_linking != hw_linking) in delay_autosuspend()
8440 if (!sw_linking && tp->rtl_ops.in_nway(tp)) in delay_autosuspend()
8442 else if (!skb_queue_empty(&tp->tx_queue)) in delay_autosuspend()
8448 static int rtl8152_runtime_resume(struct r8152 *tp) in rtl8152_runtime_resume() argument
8450 struct net_device *netdev = tp->netdev; in rtl8152_runtime_resume()
8453 struct napi_struct *napi = &tp->napi; in rtl8152_runtime_resume()
8455 tp->rtl_ops.autosuspend_en(tp, false); in rtl8152_runtime_resume()
8457 set_bit(WORK_ENABLE, &tp->flags); in rtl8152_runtime_resume()
8460 if (rtl8152_get_speed(tp) & LINK_STATUS) { in rtl8152_runtime_resume()
8461 rtl_start_rx(tp); in rtl8152_runtime_resume()
8464 tp->rtl_ops.disable(tp); in rtl8152_runtime_resume()
8465 netif_info(tp, link, netdev, "linking down\n"); in rtl8152_runtime_resume()
8470 clear_bit(SELECTIVE_SUSPEND, &tp->flags); in rtl8152_runtime_resume()
8473 if (!list_empty(&tp->rx_done)) in rtl8152_runtime_resume()
8474 napi_schedule(&tp->napi); in rtl8152_runtime_resume()
8476 usb_submit_urb(tp->intr_urb, GFP_NOIO); in rtl8152_runtime_resume()
8479 tp->rtl_ops.autosuspend_en(tp, false); in rtl8152_runtime_resume()
8481 clear_bit(SELECTIVE_SUSPEND, &tp->flags); in rtl8152_runtime_resume()
8487 static int rtl8152_system_resume(struct r8152 *tp) in rtl8152_system_resume() argument
8489 struct net_device *netdev = tp->netdev; in rtl8152_system_resume()
8494 tp->rtl_ops.up(tp); in rtl8152_system_resume()
8496 set_bit(WORK_ENABLE, &tp->flags); in rtl8152_system_resume()
8497 usb_submit_urb(tp->intr_urb, GFP_NOIO); in rtl8152_system_resume()
8503 static int rtl8152_runtime_suspend(struct r8152 *tp) in rtl8152_runtime_suspend() argument
8505 struct net_device *netdev = tp->netdev; in rtl8152_runtime_suspend()
8508 if (!tp->rtl_ops.autosuspend_en) in rtl8152_runtime_suspend()
8511 set_bit(SELECTIVE_SUSPEND, &tp->flags); in rtl8152_runtime_suspend()
8514 if (netif_running(netdev) && test_bit(WORK_ENABLE, &tp->flags)) { in rtl8152_runtime_suspend()
8520 rcr = ocp_read_dword(tp, MCU_TYPE_PLA, PLA_RCR); in rtl8152_runtime_suspend()
8522 ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RCR, ocp_data); in rtl8152_runtime_suspend()
8523 rxdy_gated_en(tp, true); in rtl8152_runtime_suspend()
8524 ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, in rtl8152_runtime_suspend()
8527 rxdy_gated_en(tp, false); in rtl8152_runtime_suspend()
8528 ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RCR, rcr); in rtl8152_runtime_suspend()
8529 clear_bit(SELECTIVE_SUSPEND, &tp->flags); in rtl8152_runtime_suspend()
8536 clear_bit(WORK_ENABLE, &tp->flags); in rtl8152_runtime_suspend()
8537 usb_kill_urb(tp->intr_urb); in rtl8152_runtime_suspend()
8539 tp->rtl_ops.autosuspend_en(tp, true); in rtl8152_runtime_suspend()
8542 struct napi_struct *napi = &tp->napi; in rtl8152_runtime_suspend()
8545 rtl_stop_rx(tp); in rtl8152_runtime_suspend()
8546 rxdy_gated_en(tp, false); in rtl8152_runtime_suspend()
8547 ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RCR, rcr); in rtl8152_runtime_suspend()
8551 if (delay_autosuspend(tp)) { in rtl8152_runtime_suspend()
8552 rtl8152_runtime_resume(tp); in rtl8152_runtime_suspend()
8561 static int rtl8152_system_suspend(struct r8152 *tp) in rtl8152_system_suspend() argument
8563 struct net_device *netdev = tp->netdev; in rtl8152_system_suspend()
8567 if (netif_running(netdev) && test_bit(WORK_ENABLE, &tp->flags)) { in rtl8152_system_suspend()
8568 struct napi_struct *napi = &tp->napi; in rtl8152_system_suspend()
8570 clear_bit(WORK_ENABLE, &tp->flags); in rtl8152_system_suspend()
8571 usb_kill_urb(tp->intr_urb); in rtl8152_system_suspend()
8572 tasklet_disable(&tp->tx_tl); in rtl8152_system_suspend()
8574 cancel_delayed_work_sync(&tp->schedule); in rtl8152_system_suspend()
8575 tp->rtl_ops.down(tp); in rtl8152_system_suspend()
8577 tasklet_enable(&tp->tx_tl); in rtl8152_system_suspend()
8585 struct r8152 *tp = usb_get_intfdata(intf); in rtl8152_suspend() local
8588 mutex_lock(&tp->control); in rtl8152_suspend()
8591 ret = rtl8152_runtime_suspend(tp); in rtl8152_suspend()
8593 ret = rtl8152_system_suspend(tp); in rtl8152_suspend()
8595 mutex_unlock(&tp->control); in rtl8152_suspend()
8602 struct r8152 *tp = usb_get_intfdata(intf); in rtl8152_resume() local
8605 mutex_lock(&tp->control); in rtl8152_resume()
8607 rtl_reset_ocp_base(tp); in rtl8152_resume()
8609 if (test_bit(SELECTIVE_SUSPEND, &tp->flags)) in rtl8152_resume()
8610 ret = rtl8152_runtime_resume(tp); in rtl8152_resume()
8612 ret = rtl8152_system_resume(tp); in rtl8152_resume()
8614 mutex_unlock(&tp->control); in rtl8152_resume()
8621 struct r8152 *tp = usb_get_intfdata(intf); in rtl8152_reset_resume() local
8623 clear_bit(SELECTIVE_SUSPEND, &tp->flags); in rtl8152_reset_resume()
8624 rtl_reset_ocp_base(tp); in rtl8152_reset_resume()
8625 tp->rtl_ops.init(tp); in rtl8152_reset_resume()
8626 queue_delayed_work(system_long_wq, &tp->hw_phy_work, 0); in rtl8152_reset_resume()
8627 set_ethernet_addr(tp, true); in rtl8152_reset_resume()
8633 struct r8152 *tp = netdev_priv(dev); in rtl8152_get_wol() local
8635 if (usb_autopm_get_interface(tp->intf) < 0) in rtl8152_get_wol()
8638 if (!rtl_can_wakeup(tp)) { in rtl8152_get_wol()
8642 mutex_lock(&tp->control); in rtl8152_get_wol()
8644 wol->wolopts = __rtl_get_wol(tp); in rtl8152_get_wol()
8645 mutex_unlock(&tp->control); in rtl8152_get_wol()
8648 usb_autopm_put_interface(tp->intf); in rtl8152_get_wol()
8653 struct r8152 *tp = netdev_priv(dev); in rtl8152_set_wol() local
8656 if (!rtl_can_wakeup(tp)) in rtl8152_set_wol()
8662 ret = usb_autopm_get_interface(tp->intf); in rtl8152_set_wol()
8666 mutex_lock(&tp->control); in rtl8152_set_wol()
8668 __rtl_set_wol(tp, wol->wolopts); in rtl8152_set_wol()
8669 tp->saved_wolopts = wol->wolopts & WAKE_ANY; in rtl8152_set_wol()
8671 mutex_unlock(&tp->control); in rtl8152_set_wol()
8673 usb_autopm_put_interface(tp->intf); in rtl8152_set_wol()
8681 struct r8152 *tp = netdev_priv(dev); in rtl8152_get_msglevel() local
8683 return tp->msg_enable; in rtl8152_get_msglevel()
8688 struct r8152 *tp = netdev_priv(dev); in rtl8152_set_msglevel() local
8690 tp->msg_enable = value; in rtl8152_set_msglevel()
8696 struct r8152 *tp = netdev_priv(netdev); in rtl8152_get_drvinfo() local
8700 usb_make_path(tp->udev, info->bus_info, sizeof(info->bus_info)); in rtl8152_get_drvinfo()
8701 if (!IS_ERR_OR_NULL(tp->rtl_fw.fw)) in rtl8152_get_drvinfo()
8702 strscpy(info->fw_version, tp->rtl_fw.version, in rtl8152_get_drvinfo()
8710 struct r8152 *tp = netdev_priv(netdev); in rtl8152_get_link_ksettings() local
8713 if (!tp->mii.mdio_read) in rtl8152_get_link_ksettings()
8716 ret = usb_autopm_get_interface(tp->intf); in rtl8152_get_link_ksettings()
8720 mutex_lock(&tp->control); in rtl8152_get_link_ksettings()
8722 mii_ethtool_get_link_ksettings(&tp->mii, cmd); in rtl8152_get_link_ksettings()
8725 cmd->link_modes.supported, tp->support_2500full); in rtl8152_get_link_ksettings()
8727 if (tp->support_2500full) { in rtl8152_get_link_ksettings()
8730 ocp_reg_read(tp, OCP_10GBT_CTRL) & MDIO_AN_10GBT_CTRL_ADV2_5G); in rtl8152_get_link_ksettings()
8734 ocp_reg_read(tp, OCP_10GBT_STAT) & MDIO_AN_10GBT_STAT_LP2_5G); in rtl8152_get_link_ksettings()
8736 if (is_speed_2500(rtl8152_get_speed(tp))) in rtl8152_get_link_ksettings()
8740 mutex_unlock(&tp->control); in rtl8152_get_link_ksettings()
8742 usb_autopm_put_interface(tp->intf); in rtl8152_get_link_ksettings()
8751 struct r8152 *tp = netdev_priv(dev); in rtl8152_set_link_ksettings() local
8755 ret = usb_autopm_get_interface(tp->intf); in rtl8152_set_link_ksettings()
8787 mutex_lock(&tp->control); in rtl8152_set_link_ksettings()
8789 ret = rtl8152_set_speed(tp, cmd->base.autoneg, cmd->base.speed, in rtl8152_set_link_ksettings()
8792 tp->autoneg = cmd->base.autoneg; in rtl8152_set_link_ksettings()
8793 tp->speed = cmd->base.speed; in rtl8152_set_link_ksettings()
8794 tp->duplex = cmd->base.duplex; in rtl8152_set_link_ksettings()
8795 tp->advertising = advertising; in rtl8152_set_link_ksettings()
8798 mutex_unlock(&tp->control); in rtl8152_set_link_ksettings()
8800 usb_autopm_put_interface(tp->intf); in rtl8152_set_link_ksettings()
8835 struct r8152 *tp = netdev_priv(dev); in rtl8152_get_ethtool_stats() local
8838 if (usb_autopm_get_interface(tp->intf) < 0) in rtl8152_get_ethtool_stats()
8841 generic_ocp_read(tp, PLA_TALLYCNT, sizeof(tally), &tally, MCU_TYPE_PLA); in rtl8152_get_ethtool_stats()
8843 usb_autopm_put_interface(tp->intf); in rtl8152_get_ethtool_stats()
8869 static int r8152_get_eee(struct r8152 *tp, struct ethtool_eee *eee) in r8152_get_eee() argument
8874 val = r8152_mmd_read(tp, MDIO_MMD_PCS, MDIO_PCS_EEE_ABLE); in r8152_get_eee()
8877 val = r8152_mmd_read(tp, MDIO_MMD_AN, MDIO_AN_EEE_ADV); in r8152_get_eee()
8880 val = r8152_mmd_read(tp, MDIO_MMD_AN, MDIO_AN_EEE_LPABLE); in r8152_get_eee()
8883 eee->eee_enabled = tp->eee_en; in r8152_get_eee()
8886 eee->advertised = tp->eee_adv; in r8152_get_eee()
8892 static int r8152_set_eee(struct r8152 *tp, struct ethtool_eee *eee) in r8152_set_eee() argument
8896 tp->eee_en = eee->eee_enabled; in r8152_set_eee()
8897 tp->eee_adv = val; in r8152_set_eee()
8899 rtl_eee_enable(tp, tp->eee_en); in r8152_set_eee()
8904 static int r8153_get_eee(struct r8152 *tp, struct ethtool_eee *eee) in r8153_get_eee() argument
8909 val = ocp_reg_read(tp, OCP_EEE_ABLE); in r8153_get_eee()
8912 val = ocp_reg_read(tp, OCP_EEE_ADV); in r8153_get_eee()
8915 val = ocp_reg_read(tp, OCP_EEE_LPABLE); in r8153_get_eee()
8918 eee->eee_enabled = tp->eee_en; in r8153_get_eee()
8921 eee->advertised = tp->eee_adv; in r8153_get_eee()
8930 struct r8152 *tp = netdev_priv(net); in rtl_ethtool_get_eee() local
8933 if (!tp->rtl_ops.eee_get) { in rtl_ethtool_get_eee()
8938 ret = usb_autopm_get_interface(tp->intf); in rtl_ethtool_get_eee()
8942 mutex_lock(&tp->control); in rtl_ethtool_get_eee()
8944 ret = tp->rtl_ops.eee_get(tp, edata); in rtl_ethtool_get_eee()
8946 mutex_unlock(&tp->control); in rtl_ethtool_get_eee()
8948 usb_autopm_put_interface(tp->intf); in rtl_ethtool_get_eee()
8957 struct r8152 *tp = netdev_priv(net); in rtl_ethtool_set_eee() local
8960 if (!tp->rtl_ops.eee_set) { in rtl_ethtool_set_eee()
8965 ret = usb_autopm_get_interface(tp->intf); in rtl_ethtool_set_eee()
8969 mutex_lock(&tp->control); in rtl_ethtool_set_eee()
8971 ret = tp->rtl_ops.eee_set(tp, edata); in rtl_ethtool_set_eee()
8973 ret = mii_nway_restart(&tp->mii); in rtl_ethtool_set_eee()
8975 mutex_unlock(&tp->control); in rtl_ethtool_set_eee()
8977 usb_autopm_put_interface(tp->intf); in rtl_ethtool_set_eee()
8985 struct r8152 *tp = netdev_priv(dev); in rtl8152_nway_reset() local
8988 ret = usb_autopm_get_interface(tp->intf); in rtl8152_nway_reset()
8992 mutex_lock(&tp->control); in rtl8152_nway_reset()
8994 ret = mii_nway_restart(&tp->mii); in rtl8152_nway_reset()
8996 mutex_unlock(&tp->control); in rtl8152_nway_reset()
8998 usb_autopm_put_interface(tp->intf); in rtl8152_nway_reset()
9009 struct r8152 *tp = netdev_priv(netdev); in rtl8152_get_coalesce() local
9011 switch (tp->version) { in rtl8152_get_coalesce()
9020 coalesce->rx_coalesce_usecs = tp->coalesce; in rtl8152_get_coalesce()
9030 struct r8152 *tp = netdev_priv(netdev); in rtl8152_set_coalesce() local
9033 switch (tp->version) { in rtl8152_set_coalesce()
9045 ret = usb_autopm_get_interface(tp->intf); in rtl8152_set_coalesce()
9049 mutex_lock(&tp->control); in rtl8152_set_coalesce()
9051 if (tp->coalesce != coalesce->rx_coalesce_usecs) { in rtl8152_set_coalesce()
9052 tp->coalesce = coalesce->rx_coalesce_usecs; in rtl8152_set_coalesce()
9056 napi_disable(&tp->napi); in rtl8152_set_coalesce()
9057 tp->rtl_ops.disable(tp); in rtl8152_set_coalesce()
9058 tp->rtl_ops.enable(tp); in rtl8152_set_coalesce()
9059 rtl_start_rx(tp); in rtl8152_set_coalesce()
9060 clear_bit(RTL8152_SET_RX_MODE, &tp->flags); in rtl8152_set_coalesce()
9062 napi_enable(&tp->napi); in rtl8152_set_coalesce()
9067 mutex_unlock(&tp->control); in rtl8152_set_coalesce()
9069 usb_autopm_put_interface(tp->intf); in rtl8152_set_coalesce()
9077 struct r8152 *tp = netdev_priv(netdev); in rtl8152_get_tunable() local
9081 *(u32 *)d = tp->rx_copybreak; in rtl8152_get_tunable()
9094 struct r8152 *tp = netdev_priv(netdev); in rtl8152_set_tunable() local
9101 netif_err(tp, rx_err, netdev, in rtl8152_set_tunable()
9106 if (tp->rx_copybreak != val) { in rtl8152_set_tunable()
9108 mutex_lock(&tp->control); in rtl8152_set_tunable()
9109 napi_disable(&tp->napi); in rtl8152_set_tunable()
9110 tp->rx_copybreak = val; in rtl8152_set_tunable()
9111 napi_enable(&tp->napi); in rtl8152_set_tunable()
9112 mutex_unlock(&tp->control); in rtl8152_set_tunable()
9114 tp->rx_copybreak = val; in rtl8152_set_tunable()
9130 struct r8152 *tp = netdev_priv(netdev); in rtl8152_get_ringparam() local
9133 ring->rx_pending = tp->rx_pending; in rtl8152_get_ringparam()
9141 struct r8152 *tp = netdev_priv(netdev); in rtl8152_set_ringparam() local
9146 if (tp->rx_pending != ring->rx_pending) { in rtl8152_set_ringparam()
9148 mutex_lock(&tp->control); in rtl8152_set_ringparam()
9149 napi_disable(&tp->napi); in rtl8152_set_ringparam()
9150 tp->rx_pending = ring->rx_pending; in rtl8152_set_ringparam()
9151 napi_enable(&tp->napi); in rtl8152_set_ringparam()
9152 mutex_unlock(&tp->control); in rtl8152_set_ringparam()
9154 tp->rx_pending = ring->rx_pending; in rtl8152_set_ringparam()
9163 struct r8152 *tp = netdev_priv(netdev); in rtl8152_get_pauseparam() local
9167 if (usb_autopm_get_interface(tp->intf) < 0) in rtl8152_get_pauseparam()
9170 mutex_lock(&tp->control); in rtl8152_get_pauseparam()
9172 bmcr = r8152_mdio_read(tp, MII_BMCR); in rtl8152_get_pauseparam()
9173 lcladv = r8152_mdio_read(tp, MII_ADVERTISE); in rtl8152_get_pauseparam()
9174 rmtadv = r8152_mdio_read(tp, MII_LPA); in rtl8152_get_pauseparam()
9176 mutex_unlock(&tp->control); in rtl8152_get_pauseparam()
9178 usb_autopm_put_interface(tp->intf); in rtl8152_get_pauseparam()
9200 struct r8152 *tp = netdev_priv(netdev); in rtl8152_set_pauseparam() local
9205 ret = usb_autopm_get_interface(tp->intf); in rtl8152_set_pauseparam()
9209 mutex_lock(&tp->control); in rtl8152_set_pauseparam()
9211 if (pause->autoneg && !(r8152_mdio_read(tp, MII_BMCR) & BMCR_ANENABLE)) { in rtl8152_set_pauseparam()
9222 old = r8152_mdio_read(tp, MII_ADVERTISE); in rtl8152_set_pauseparam()
9225 r8152_mdio_write(tp, MII_ADVERTISE, new1); in rtl8152_set_pauseparam()
9228 mutex_unlock(&tp->control); in rtl8152_set_pauseparam()
9229 usb_autopm_put_interface(tp->intf); in rtl8152_set_pauseparam()
9262 struct r8152 *tp = netdev_priv(netdev); in rtl8152_ioctl() local
9266 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in rtl8152_ioctl()
9269 res = usb_autopm_get_interface(tp->intf); in rtl8152_ioctl()
9279 mutex_lock(&tp->control); in rtl8152_ioctl()
9280 data->val_out = r8152_mdio_read(tp, data->reg_num); in rtl8152_ioctl()
9281 mutex_unlock(&tp->control); in rtl8152_ioctl()
9289 mutex_lock(&tp->control); in rtl8152_ioctl()
9290 r8152_mdio_write(tp, data->reg_num, data->val_in); in rtl8152_ioctl()
9291 mutex_unlock(&tp->control); in rtl8152_ioctl()
9298 usb_autopm_put_interface(tp->intf); in rtl8152_ioctl()
9306 struct r8152 *tp = netdev_priv(dev); in rtl8152_change_mtu() local
9309 switch (tp->version) { in rtl8152_change_mtu()
9319 ret = usb_autopm_get_interface(tp->intf); in rtl8152_change_mtu()
9323 mutex_lock(&tp->control); in rtl8152_change_mtu()
9328 if (tp->rtl_ops.change_mtu) in rtl8152_change_mtu()
9329 tp->rtl_ops.change_mtu(tp); in rtl8152_change_mtu()
9333 napi_disable(&tp->napi); in rtl8152_change_mtu()
9334 tasklet_disable(&tp->tx_tl); in rtl8152_change_mtu()
9335 tp->rtl_ops.disable(tp); in rtl8152_change_mtu()
9336 tp->rtl_ops.enable(tp); in rtl8152_change_mtu()
9337 rtl_start_rx(tp); in rtl8152_change_mtu()
9338 tasklet_enable(&tp->tx_tl); in rtl8152_change_mtu()
9339 napi_enable(&tp->napi); in rtl8152_change_mtu()
9345 mutex_unlock(&tp->control); in rtl8152_change_mtu()
9347 usb_autopm_put_interface(tp->intf); in rtl8152_change_mtu()
9366 static void rtl8152_unload(struct r8152 *tp) in rtl8152_unload() argument
9368 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in rtl8152_unload()
9371 if (tp->version != RTL_VER_01) in rtl8152_unload()
9372 r8152_power_cut_en(tp, true); in rtl8152_unload()
9375 static void rtl8153_unload(struct r8152 *tp) in rtl8153_unload() argument
9377 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in rtl8153_unload()
9380 r8153_power_cut_en(tp, false); in rtl8153_unload()
9383 static void rtl8153b_unload(struct r8152 *tp) in rtl8153b_unload() argument
9385 if (test_bit(RTL8152_INACCESSIBLE, &tp->flags)) in rtl8153b_unload()
9388 r8153b_power_cut_en(tp, false); in rtl8153b_unload()
9391 static int rtl_ops_init(struct r8152 *tp) in rtl_ops_init() argument
9393 struct rtl_ops *ops = &tp->rtl_ops; in rtl_ops_init()
9396 switch (tp->version) { in rtl_ops_init()
9411 tp->rx_buf_sz = 16 * 1024; in rtl_ops_init()
9412 tp->eee_en = true; in rtl_ops_init()
9413 tp->eee_adv = MDIO_EEE_100TX; in rtl_ops_init()
9432 if (tp->udev->speed < USB_SPEED_SUPER) in rtl_ops_init()
9433 tp->rx_buf_sz = 16 * 1024; in rtl_ops_init()
9435 tp->rx_buf_sz = 32 * 1024; in rtl_ops_init()
9436 tp->eee_en = true; in rtl_ops_init()
9437 tp->eee_adv = MDIO_EEE_1000T | MDIO_EEE_100TX; in rtl_ops_init()
9454 tp->rx_buf_sz = 32 * 1024; in rtl_ops_init()
9455 tp->eee_en = true; in rtl_ops_init()
9456 tp->eee_adv = MDIO_EEE_1000T | MDIO_EEE_100TX; in rtl_ops_init()
9460 tp->eee_en = true; in rtl_ops_init()
9461 tp->eee_adv = MDIO_EEE_1000T | MDIO_EEE_100TX; in rtl_ops_init()
9476 tp->rx_buf_sz = 48 * 1024; in rtl_ops_init()
9477 tp->support_2500full = 1; in rtl_ops_init()
9482 tp->support_2500full = 1; in rtl_ops_init()
9485 tp->eee_en = true; in rtl_ops_init()
9486 tp->eee_adv = MDIO_EEE_1000T | MDIO_EEE_100TX; in rtl_ops_init()
9499 tp->rx_buf_sz = 48 * 1024; in rtl_ops_init()
9515 tp->rx_buf_sz = 32 * 1024; in rtl_ops_init()
9516 tp->eee_en = true; in rtl_ops_init()
9517 tp->eee_adv = MDIO_EEE_1000T | MDIO_EEE_100TX; in rtl_ops_init()
9522 dev_err(&tp->intf->dev, "Unknown Device\n"); in rtl_ops_init()
9545 static int rtl_fw_init(struct r8152 *tp) in rtl_fw_init() argument
9547 struct rtl_fw *rtl_fw = &tp->rtl_fw; in rtl_fw_init()
9549 switch (tp->version) { in rtl_fw_init()
9720 struct r8152 *tp; in rtl8152_probe_once() local
9732 tp = netdev_priv(netdev); in rtl8152_probe_once()
9733 tp->msg_enable = 0x7FFF; in rtl8152_probe_once()
9735 tp->udev = udev; in rtl8152_probe_once()
9736 tp->netdev = netdev; in rtl8152_probe_once()
9737 tp->intf = intf; in rtl8152_probe_once()
9738 tp->version = version; in rtl8152_probe_once()
9740 tp->pipe_ctrl_in = usb_rcvctrlpipe(udev, 0); in rtl8152_probe_once()
9741 tp->pipe_ctrl_out = usb_sndctrlpipe(udev, 0); in rtl8152_probe_once()
9742 tp->pipe_in = usb_rcvbulkpipe(udev, 1); in rtl8152_probe_once()
9743 tp->pipe_out = usb_sndbulkpipe(udev, 2); in rtl8152_probe_once()
9744 tp->pipe_intr = usb_rcvintpipe(udev, 3); in rtl8152_probe_once()
9750 tp->mii.supports_gmii = 0; in rtl8152_probe_once()
9753 tp->mii.supports_gmii = 1; in rtl8152_probe_once()
9757 ret = rtl_ops_init(tp); in rtl8152_probe_once()
9761 rtl_fw_init(tp); in rtl8152_probe_once()
9763 mutex_init(&tp->control); in rtl8152_probe_once()
9764 INIT_DELAYED_WORK(&tp->schedule, rtl_work_func_t); in rtl8152_probe_once()
9765 INIT_DELAYED_WORK(&tp->hw_phy_work, rtl_hw_phy_work_func_t); in rtl8152_probe_once()
9766 tasklet_setup(&tp->tx_tl, bottom_half); in rtl8152_probe_once()
9767 tasklet_disable(&tp->tx_tl); in rtl8152_probe_once()
9784 if (tp->version == RTL_VER_01) { in rtl8152_probe_once()
9789 tp->lenovo_macpassthru = rtl8152_supports_lenovo_macpassthru(udev); in rtl8152_probe_once()
9795 tp->dell_tb_rx_agg_bug = 1; in rtl8152_probe_once()
9803 switch (tp->version) { in rtl8152_probe_once()
9830 tp->mii.dev = netdev; in rtl8152_probe_once()
9831 tp->mii.mdio_read = read_mii_word; in rtl8152_probe_once()
9832 tp->mii.mdio_write = write_mii_word; in rtl8152_probe_once()
9833 tp->mii.phy_id_mask = 0x3f; in rtl8152_probe_once()
9834 tp->mii.reg_num_mask = 0x1f; in rtl8152_probe_once()
9835 tp->mii.phy_id = R8152_PHY_ID; in rtl8152_probe_once()
9837 tp->autoneg = AUTONEG_ENABLE; in rtl8152_probe_once()
9838 tp->speed = SPEED_100; in rtl8152_probe_once()
9839 tp->advertising = RTL_ADVERTISED_10_HALF | RTL_ADVERTISED_10_FULL | in rtl8152_probe_once()
9841 if (tp->mii.supports_gmii) { in rtl8152_probe_once()
9842 if (tp->support_2500full && in rtl8152_probe_once()
9843 tp->udev->speed >= USB_SPEED_SUPER) { in rtl8152_probe_once()
9844 tp->speed = SPEED_2500; in rtl8152_probe_once()
9845 tp->advertising |= RTL_ADVERTISED_2500_FULL; in rtl8152_probe_once()
9847 tp->speed = SPEED_1000; in rtl8152_probe_once()
9849 tp->advertising |= RTL_ADVERTISED_1000_FULL; in rtl8152_probe_once()
9851 tp->duplex = DUPLEX_FULL; in rtl8152_probe_once()
9853 tp->rx_copybreak = RTL8152_RXFG_HEADSZ; in rtl8152_probe_once()
9854 tp->rx_pending = 10 * RTL8152_MAX_RX; in rtl8152_probe_once()
9858 if (!rtl_can_wakeup(tp)) in rtl8152_probe_once()
9859 __rtl_set_wol(tp, 0); in rtl8152_probe_once()
9861 tp->saved_wolopts = __rtl_get_wol(tp); in rtl8152_probe_once()
9863 tp->rtl_ops.init(tp); in rtl8152_probe_once()
9866 tp->rtl_fw.retry = true; in rtl8152_probe_once()
9868 queue_delayed_work(system_long_wq, &tp->hw_phy_work, 0); in rtl8152_probe_once()
9869 set_ethernet_addr(tp, false); in rtl8152_probe_once()
9871 usb_set_intfdata(intf, tp); in rtl8152_probe_once()
9873 netif_napi_add(netdev, &tp->napi, r8152_poll); in rtl8152_probe_once()
9881 if (tp->saved_wolopts) in rtl8152_probe_once()
9889 if (test_bit(PROBE_SHOULD_RETRY, &tp->flags)) in rtl8152_probe_once()
9892 set_bit(PROBED_WITH_NO_ERRORS, &tp->flags); in rtl8152_probe_once()
9893 netif_info(tp, probe, netdev, "%s\n", DRIVER_VERSION); in rtl8152_probe_once()
9901 tasklet_kill(&tp->tx_tl); in rtl8152_probe_once()
9902 cancel_delayed_work_sync(&tp->hw_phy_work); in rtl8152_probe_once()
9903 if (tp->rtl_ops.unload) in rtl8152_probe_once()
9904 tp->rtl_ops.unload(tp); in rtl8152_probe_once()
9905 rtl8152_release_firmware(tp); in rtl8152_probe_once()
9908 if (test_bit(PROBE_SHOULD_RETRY, &tp->flags)) in rtl8152_probe_once()
9950 struct r8152 *tp = usb_get_intfdata(intf); in rtl8152_disconnect() local
9953 if (tp) { in rtl8152_disconnect()
9954 rtl_set_unplug(tp); in rtl8152_disconnect()
9956 unregister_netdev(tp->netdev); in rtl8152_disconnect()
9957 tasklet_kill(&tp->tx_tl); in rtl8152_disconnect()
9958 cancel_delayed_work_sync(&tp->hw_phy_work); in rtl8152_disconnect()
9959 if (tp->rtl_ops.unload) in rtl8152_disconnect()
9960 tp->rtl_ops.unload(tp); in rtl8152_disconnect()
9961 rtl8152_release_firmware(tp); in rtl8152_disconnect()
9962 free_netdev(tp->netdev); in rtl8152_disconnect()