From 1a424d423823ae97080922348408e2377eaaca76 Mon Sep 17 00:00:00 2001 From: Awais Belal Date: Fri, 28 Aug 2015 15:08:31 +0500 Subject: [PATCH] ethernet: integrate r8168 driver The NIC on AMD Falcon x86 family requires the r8168 driver to function properly otherwise conflicts with the on-board DASH controller are observed which results in a failure to bring up the ethernet interface. Signed-off-by: Awais Belal --- drivers/net/ethernet/realtek/Kconfig | 9 + drivers/net/ethernet/realtek/Makefile | 3 + drivers/net/ethernet/realtek/r8168.h | 1524 ++ drivers/net/ethernet/realtek/r8168_asf.c | 419 + drivers/net/ethernet/realtek/r8168_asf.h | 294 + drivers/net/ethernet/realtek/r8168_dash.h | 193 + drivers/net/ethernet/realtek/r8168_n.c | 25364 +++++++++++++++++++++++++ drivers/net/ethernet/realtek/r8168_realwow.h | 117 + drivers/net/ethernet/realtek/rtl_eeprom.c | 291 + drivers/net/ethernet/realtek/rtl_eeprom.h | 55 + drivers/net/ethernet/realtek/rtltool.c | 304 + drivers/net/ethernet/realtek/rtltool.h | 49 + 12 files changed, 28622 insertions(+) create mode 100755 drivers/net/ethernet/realtek/r8168.h create mode 100755 drivers/net/ethernet/realtek/r8168_asf.c create mode 100755 drivers/net/ethernet/realtek/r8168_asf.h create mode 100755 drivers/net/ethernet/realtek/r8168_dash.h create mode 100755 drivers/net/ethernet/realtek/r8168_n.c create mode 100755 drivers/net/ethernet/realtek/r8168_realwow.h create mode 100755 drivers/net/ethernet/realtek/rtl_eeprom.c create mode 100755 drivers/net/ethernet/realtek/rtl_eeprom.h create mode 100755 drivers/net/ethernet/realtek/rtltool.c create mode 100755 drivers/net/ethernet/realtek/rtltool.h diff --git a/drivers/net/ethernet/realtek/Kconfig b/drivers/net/ethernet/realtek/Kconfig index ae5d027..54667fb 100644 --- a/drivers/net/ethernet/realtek/Kconfig +++ b/drivers/net/ethernet/realtek/Kconfig @@ -112,4 +112,13 @@ config R8169 To compile this driver as a module, choose M here: the module will be called r8169. This is recommended. +config R8168 + tristate "Realtek 8168 gigabit ethernet support" + depends on PCI + ---help--- + Say Y here if you have a Realtek 8168 PCI Gigabit Ethernet adapter. + + To compile this driver as a module, choose M here: the module + will be called r8168. This is recommended. + endif # NET_VENDOR_REALTEK diff --git a/drivers/net/ethernet/realtek/Makefile b/drivers/net/ethernet/realtek/Makefile index 71b1da3..2de09ca 100644 --- a/drivers/net/ethernet/realtek/Makefile +++ b/drivers/net/ethernet/realtek/Makefile @@ -6,3 +6,6 @@ obj-$(CONFIG_8139CP) += 8139cp.o obj-$(CONFIG_8139TOO) += 8139too.o obj-$(CONFIG_ATP) += atp.o obj-$(CONFIG_R8169) += r8169.o + +r8168-y += r8168_n.o r8168_asf.o rtl_eeprom.o rtltool.o +obj-$(CONFIG_R8168) += r8168.o diff --git a/drivers/net/ethernet/realtek/r8168.h b/drivers/net/ethernet/realtek/r8168.h new file mode 100755 index 0000000..95dec0e --- /dev/null +++ b/drivers/net/ethernet/realtek/r8168.h @@ -0,0 +1,1524 @@ +/* +################################################################################ +# +# r8168 is the Linux device driver released for Realtek Gigabit Ethernet +# controllers with PCI-Express interface. +# +# Copyright(c) 2015 Realtek Semiconductor Corp. All rights reserved. +# +# This program is free software; you can redistribute it and/or modify it +# under the terms of the GNU General Public License as published by the Free +# Software Foundation; either version 2 of the License, or (at your option) +# any later version. +# +# This program is distributed in the hope that it will be useful, but WITHOUT +# ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or +# FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for +# more details. +# +# You should have received a copy of the GNU General Public License along with +# this program; if not, see . +# +# Author: +# Realtek NIC software team +# No. 2, Innovation Road II, Hsinchu Science Park, Hsinchu 300, Taiwan +# +################################################################################ +*/ + +/************************************************************************************ + * This product is covered by one or more of the following patents: + * US6,570,884, US6,115,776, and US6,327,625. + ***********************************************************************************/ + +#include "r8168_dash.h" +#include "r8168_realwow.h" + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,4,37) +#define ENABLE_R8168_PROCFS +#endif + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,10,0) +#define NETIF_F_HW_VLAN_RX NETIF_F_HW_VLAN_CTAG_RX +#define NETIF_F_HW_VLAN_TX NETIF_F_HW_VLAN_CTAG_TX +#endif + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,8,0) +#define __devinit +#define __devexit +#define __devexit_p(func) func +#endif + +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,19) +#define CHECKSUM_PARTIAL CHECKSUM_HW +#endif + +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,0) +#define irqreturn_t void +#define IRQ_HANDLED 1 +#define IRQ_NONE 0 +#define IRQ_RETVAL(x) +#endif + +#ifndef HAVE_FREE_NETDEV +#define free_netdev(x) kfree(x) +#endif + +#ifndef SET_NETDEV_DEV +#define SET_NETDEV_DEV(net, pdev) +#endif + +#ifndef SET_MODULE_OWNER +#define SET_MODULE_OWNER(dev) +#endif + +#ifndef SA_SHIRQ +#define SA_SHIRQ IRQF_SHARED +#endif + +#ifndef NETIF_F_GSO +#define gso_size tso_size +#define gso_segs tso_segs +#endif + +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,29) +#ifdef CONFIG_NET_POLL_CONTROLLER +#define RTL_NET_POLL_CONTROLLER dev->poll_controller=rtl8168_netpoll +#else +#define RTL_NET_POLL_CONTROLLER +#endif + +#ifdef CONFIG_R8168_VLAN +#define RTL_SET_VLAN dev->vlan_rx_register=rtl8168_vlan_rx_register +#else +#define RTL_SET_VLAN +#endif + +#define RTL_NET_DEVICE_OPS(ops) dev->open=rtl8168_open; \ + dev->hard_start_xmit=rtl8168_start_xmit; \ + dev->get_stats=rtl8168_get_stats; \ + dev->stop=rtl8168_close; \ + dev->tx_timeout=rtl8168_tx_timeout; \ + dev->set_multicast_list=rtl8168_set_rx_mode; \ + dev->change_mtu=rtl8168_change_mtu; \ + dev->set_mac_address=rtl8168_set_mac_address; \ + dev->do_ioctl=rtl8168_do_ioctl; \ + RTL_NET_POLL_CONTROLLER; \ + RTL_SET_VLAN; +#else +#define RTL_NET_DEVICE_OPS(ops) dev->netdev_ops=&ops +#endif + +#ifndef FALSE +#define FALSE 0 +#endif + +#ifndef TRUE +#define TRUE 1 +#endif + +#ifndef false +#define false 0 +#endif + +#ifndef true +#define true 1 +#endif + +//Hardware will continue interrupt 10 times after interrupt finished. +#define RTK_KEEP_INTERRUPT_COUNT (10) + +//Due to the hardware design of RTL8111B, the low 32 bit address of receive +//buffer must be 8-byte alignment. +#ifndef NET_IP_ALIGN +#define NET_IP_ALIGN 2 +#endif +#define RTK_RX_ALIGN 8 + +#ifdef CONFIG_R8168_NAPI +#define NAPI_SUFFIX "-NAPI" +#else +#define NAPI_SUFFIX "" +#endif + +#define RTL8168_VERSION "8.040.00" NAPI_SUFFIX +#define MODULENAME "r8168" +#define PFX MODULENAME ": " + +#define GPL_CLAIM "\ +r8168 Copyright (C) 2015 Realtek NIC software team \n \ +This program comes with ABSOLUTELY NO WARRANTY; for details, please see . \n \ +This is free software, and you are welcome to redistribute it under certain conditions; see . \n" + +#ifdef RTL8168_DEBUG +#define assert(expr) \ + if(!(expr)) { \ + printk( "Assertion failed! %s,%s,%s,line=%d\n", \ + #expr,__FILE__,__FUNCTION__,__LINE__); \ + } +#define dprintk(fmt, args...) do { printk(PFX fmt, ## args); } while (0) +#else +#define assert(expr) do {} while (0) +#define dprintk(fmt, args...) do {} while (0) +#endif /* RTL8168_DEBUG */ + +#define R8168_MSG_DEFAULT \ + (NETIF_MSG_DRV | NETIF_MSG_PROBE | NETIF_MSG_IFUP | NETIF_MSG_IFDOWN) + +#define TX_BUFFS_AVAIL(tp) \ + (tp->dirty_tx + NUM_TX_DESC - tp->cur_tx - 1) + +#ifdef CONFIG_R8168_NAPI +#define rtl8168_rx_hwaccel_skb vlan_hwaccel_receive_skb +#define rtl8168_rx_quota(count, quota) min(count, quota) +#else +#define rtl8168_rx_hwaccel_skb vlan_hwaccel_rx +#define rtl8168_rx_quota(count, quota) count +#endif + +/* MAC address length */ +#ifndef MAC_ADDR_LEN +#define MAC_ADDR_LEN 6 +#endif + +#ifndef MAC_PROTOCOL_LEN +#define MAC_PROTOCOL_LEN 2 +#endif + +#define Reserved2_data 7 +#define RX_DMA_BURST 7 /* Maximum PCI burst, '6' is 1024 */ +#define TX_DMA_BURST_unlimited 7 +#define TX_DMA_BURST_1024 6 +#define TX_DMA_BURST_512 5 +#define TX_DMA_BURST_256 4 +#define TX_DMA_BURST_128 3 +#define TX_DMA_BURST_64 2 +#define TX_DMA_BURST_32 1 +#define TX_DMA_BURST_16 0 +#define Reserved1_data 0x3F +#define RxPacketMaxSize 0x3FE8 /* 16K - 1 - ETH_HLEN - VLAN - CRC... */ +#define Jumbo_Frame_2k (2 * 1024) +#define Jumbo_Frame_3k (3 * 1024) +#define Jumbo_Frame_4k (4 * 1024) +#define Jumbo_Frame_5k (5 * 1024) +#define Jumbo_Frame_6k (6 * 1024) +#define Jumbo_Frame_7k (7 * 1024) +#define Jumbo_Frame_8k (8 * 1024) +#define Jumbo_Frame_9k (9 * 1024) +#define InterFrameGap 0x03 /* 3 means InterFrameGap = the shortest one */ +#define RxEarly_off_V1 (0x07 << 11) +#define RxEarly_off_V2 (1 << 11) +#define Rx_Single_fetch_V2 (1 << 14) + +#define R8168_REGS_SIZE (256) +#define R8168_MAC_REGS_SIZE (256) +#define R8168_PHY_REGS_SIZE (16*2) +#define R8168_EPHY_REGS_SIZE (31*2) +#define R8168_ERI_REGS_SIZE (0x100) +#define R8168_REGS_DUMP_SIZE (0x400) +#define R8168_NAPI_WEIGHT 64 + +#define RTL8168_TX_TIMEOUT (6 * HZ) +#define RTL8168_LINK_TIMEOUT (1 * HZ) +#define RTL8168_ESD_TIMEOUT (2 * HZ) + +#define NUM_TX_DESC 1024 /* Number of Tx descriptor registers */ +#define NUM_RX_DESC 1024 /* Number of Rx descriptor registers */ + +#define RX_BUF_SIZE 0x05F3 /* 0x05F3 = 1522bye + 1 */ +#define R8168_TX_RING_BYTES (NUM_TX_DESC * sizeof(struct TxDesc)) +#define R8168_RX_RING_BYTES (NUM_RX_DESC * sizeof(struct RxDesc)) + +#define NODE_ADDRESS_SIZE 6 + +#define SHORT_PACKET_PADDING_BUF_SIZE 256 + +/* write/read MMIO register */ +#define RTL_W8(reg, val8) writeb ((val8), ioaddr + (reg)) +#define RTL_W16(reg, val16) writew ((val16), ioaddr + (reg)) +#define RTL_W32(reg, val32) writel ((val32), ioaddr + (reg)) +#define RTL_R8(reg) readb (ioaddr + (reg)) +#define RTL_R16(reg) readw (ioaddr + (reg)) +#define RTL_R32(reg) ((unsigned long) readl (ioaddr + (reg))) + +#ifndef DMA_64BIT_MASK +#define DMA_64BIT_MASK 0xffffffffffffffffULL +#endif + +#ifndef DMA_32BIT_MASK +#define DMA_32BIT_MASK 0x00000000ffffffffULL +#endif + +#ifndef NETDEV_TX_OK +#define NETDEV_TX_OK 0 /* driver took care of packet */ +#endif + +#ifndef NETDEV_TX_BUSY +#define NETDEV_TX_BUSY 1 /* driver tx path was busy*/ +#endif + +#ifndef NETDEV_TX_LOCKED +#define NETDEV_TX_LOCKED -1 /* driver tx lock was already taken */ +#endif + +#ifndef ADVERTISED_Pause +#define ADVERTISED_Pause (1 << 13) +#endif + +#ifndef ADVERTISED_Asym_Pause +#define ADVERTISED_Asym_Pause (1 << 14) +#endif + +#ifndef ADVERTISE_PAUSE_CAP +#define ADVERTISE_PAUSE_CAP 0x400 +#endif + +#ifndef ADVERTISE_PAUSE_ASYM +#define ADVERTISE_PAUSE_ASYM 0x800 +#endif + +#ifndef MII_CTRL1000 +#define MII_CTRL1000 0x09 +#endif + +#ifndef ADVERTISE_1000FULL +#define ADVERTISE_1000FULL 0x200 +#endif + +#ifndef ADVERTISE_1000HALF +#define ADVERTISE_1000HALF 0x100 +#endif + +/*****************************************************************************/ + +//#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,3) +#if (( LINUX_VERSION_CODE < KERNEL_VERSION(2,4,27) ) || \ + (( LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0) ) && \ + ( LINUX_VERSION_CODE < KERNEL_VERSION(2,6,3) ))) +/* copied from linux kernel 2.6.20 include/linux/netdev.h */ +#define NETDEV_ALIGN 32 +#define NETDEV_ALIGN_CONST (NETDEV_ALIGN - 1) + +static inline void *netdev_priv(struct net_device *dev) +{ + return (char *)dev + ((sizeof(struct net_device) + + NETDEV_ALIGN_CONST) + & ~NETDEV_ALIGN_CONST); +} +#endif //LINUX_VERSION_CODE < KERNEL_VERSION(2,6,3) + +/*****************************************************************************/ +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,22) +#define RTLDEV tp +#else +#define RTLDEV dev +#endif //LINUX_VERSION_CODE < KERNEL_VERSION(2,6,22) +/*****************************************************************************/ + +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24) +typedef struct net_device *napi_ptr; +typedef int *napi_budget; + +#define napi dev +#define RTL_NAPI_CONFIG(ndev, priv, function, weig) ndev->poll=function; \ + ndev->weight=weig; +#define RTL_NAPI_DEL(priv) +#define RTL_NAPI_QUOTA(budget, ndev) min(*budget, ndev->quota) +#define RTL_GET_PRIV(stuct_ptr, priv_struct) netdev_priv(stuct_ptr) +#define RTL_GET_NETDEV(priv_ptr) +#define RTL_RX_QUOTA(ndev, budget) ndev->quota +#define RTL_NAPI_QUOTA_UPDATE(ndev, work_done, budget) *budget -= work_done; \ + ndev->quota -= work_done; +#define RTL_NETIF_RX_COMPLETE(dev, napi) netif_rx_complete(dev) +#define RTL_NETIF_RX_SCHEDULE_PREP(dev, napi) netif_rx_schedule_prep(dev) +#define __RTL_NETIF_RX_SCHEDULE(dev, napi) __netif_rx_schedule(dev) +#define RTL_NAPI_RETURN_VALUE work_done >= work_to_do +#define RTL_NAPI_ENABLE(dev, napi) netif_poll_enable(dev) +#define RTL_NAPI_DISABLE(dev, napi) netif_poll_disable(dev) +#define DMA_BIT_MASK(value) ((1ULL << value) - 1) +#else +typedef struct napi_struct *napi_ptr; +typedef int napi_budget; + +#define RTL_NAPI_CONFIG(ndev, priv, function, weight) netif_napi_add(ndev, &priv->napi, function, weight) +#define RTL_NAPI_DEL(priv) netif_napi_del(&priv->napi) +#define RTL_NAPI_QUOTA(budget, ndev) min(budget, budget) +#define RTL_GET_PRIV(stuct_ptr, priv_struct) container_of(stuct_ptr, priv_struct, stuct_ptr) +#define RTL_GET_NETDEV(priv_ptr) struct net_device *dev = priv_ptr->dev; +#define RTL_RX_QUOTA(ndev, budget) budget +#define RTL_NAPI_QUOTA_UPDATE(ndev, work_done, budget) +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,29) +#define RTL_NETIF_RX_COMPLETE(dev, napi) netif_rx_complete(dev, napi) +#define RTL_NETIF_RX_SCHEDULE_PREP(dev, napi) netif_rx_schedule_prep(dev, napi) +#define __RTL_NETIF_RX_SCHEDULE(dev, napi) __netif_rx_schedule(dev, napi) +#endif +#if LINUX_VERSION_CODE == KERNEL_VERSION(2,6,29) +#define RTL_NETIF_RX_COMPLETE(dev, napi) netif_rx_complete(napi) +#define RTL_NETIF_RX_SCHEDULE_PREP(dev, napi) netif_rx_schedule_prep(napi) +#define __RTL_NETIF_RX_SCHEDULE(dev, napi) __netif_rx_schedule(napi) +#endif +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,29) +#define RTL_NETIF_RX_COMPLETE(dev, napi) napi_complete(napi) +#define RTL_NETIF_RX_SCHEDULE_PREP(dev, napi) napi_schedule_prep(napi) +#define __RTL_NETIF_RX_SCHEDULE(dev, napi) __napi_schedule(napi) +#endif +#define RTL_NAPI_RETURN_VALUE work_done +#define RTL_NAPI_ENABLE(dev, napi) napi_enable(napi) +#define RTL_NAPI_DISABLE(dev, napi) napi_disable(napi) +#endif //LINUX_VERSION_CODE < KERNEL_VERSION(2,6,24) + +/*****************************************************************************/ +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,9) +#ifdef __CHECKER__ +#define __iomem __attribute__((noderef, address_space(2))) +extern void __chk_io_ptr(void __iomem *); +#define __bitwise __attribute__((bitwise)) +#else +#define __iomem +#define __chk_io_ptr(x) (void)0 +#define __bitwise +#endif +#endif //LINUX_VERSION_CODE < KERNEL_VERSION(2,6,9) + +/*****************************************************************************/ +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,8) +#ifdef __CHECKER__ +#define __force __attribute__((force)) +#else +#define __force +#endif +#endif //LINUX_VERSION_CODE < KERNEL_VERSION(2,6,8) + +#ifndef module_param +#define module_param(v,t,p) MODULE_PARM(v, "i"); +#endif + +#ifndef PCI_DEVICE +#define PCI_DEVICE(vend,dev) \ + .vendor = (vend), .device = (dev), \ + .subvendor = PCI_ANY_ID, .subdevice = PCI_ANY_ID +#endif + +/*****************************************************************************/ +/* 2.5.28 => 2.4.23 */ +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,5,28) ) + +static inline void _kc_synchronize_irq(void) +{ + synchronize_irq(); +} +#undef synchronize_irq +#define synchronize_irq(X) _kc_synchronize_irq() + +#include +#define work_struct tq_struct +#undef INIT_WORK +#define INIT_WORK(a,b,c) INIT_TQUEUE(a,(void (*)(void *))b,c) +#undef container_of +#define container_of list_entry +#define schedule_work schedule_task +#define flush_scheduled_work flush_scheduled_tasks +#endif /* 2.5.28 => 2.4.17 */ + +/*****************************************************************************/ +/* 2.6.4 => 2.6.0 */ +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,6,4) ) +#define MODULE_VERSION(_version) MODULE_INFO(version, _version) +#endif /* 2.6.4 => 2.6.0 */ +/*****************************************************************************/ +/* 2.6.0 => 2.5.28 */ +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,6,0) ) +#define MODULE_INFO(version, _version) +#ifndef CONFIG_E1000_DISABLE_PACKET_SPLIT +#define CONFIG_E1000_DISABLE_PACKET_SPLIT 1 +#endif + +#define pci_set_consistent_dma_mask(dev,mask) 1 + +#undef dev_put +#define dev_put(dev) __dev_put(dev) + +#ifndef skb_fill_page_desc +#define skb_fill_page_desc _kc_skb_fill_page_desc +extern void _kc_skb_fill_page_desc(struct sk_buff *skb, int i, struct page *page, int off, int size); +#endif + +#ifndef pci_dma_mapping_error +#define pci_dma_mapping_error _kc_pci_dma_mapping_error +static inline int _kc_pci_dma_mapping_error(dma_addr_t dma_addr) +{ + return dma_addr == 0; +} +#endif + +#undef ALIGN +#define ALIGN(x,a) (((x)+(a)-1)&~((a)-1)) + +#endif /* 2.6.0 => 2.5.28 */ + +/*****************************************************************************/ +/* 2.4.22 => 2.4.17 */ +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,4,22) ) +#define pci_name(x) ((x)->slot_name) +#endif /* 2.4.22 => 2.4.17 */ + +/*****************************************************************************/ +/* 2.6.5 => 2.6.0 */ +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,6,5) ) +#define pci_dma_sync_single_for_cpu pci_dma_sync_single +#define pci_dma_sync_single_for_device pci_dma_sync_single_for_cpu +#endif /* 2.6.5 => 2.6.0 */ + +/*****************************************************************************/ + +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,0) +/* + * initialize a work-struct's func and data pointers: + */ +#define PREPARE_WORK(_work, _func, _data) \ + do { \ + (_work)->func = _func; \ + (_work)->data = _data; \ + } while (0) + +#endif +/*****************************************************************************/ +/* 2.6.4 => 2.6.0 */ +#if ( LINUX_VERSION_CODE < KERNEL_VERSION(2,4,25) || \ + ( LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,0) && \ + LINUX_VERSION_CODE < KERNEL_VERSION(2,6,4) ) ) +#define ETHTOOL_OPS_COMPAT +#endif /* 2.6.4 => 2.6.0 */ + +/*****************************************************************************/ +/* Installations with ethtool version without eeprom, adapter id, or statistics + * support */ + +#ifndef ETH_GSTRING_LEN +#define ETH_GSTRING_LEN 32 +#endif + +#ifndef ETHTOOL_GSTATS +#define ETHTOOL_GSTATS 0x1d +#undef ethtool_drvinfo +#define ethtool_drvinfo k_ethtool_drvinfo +struct k_ethtool_drvinfo { + u32 cmd; + char driver[32]; + char version[32]; + char fw_version[32]; + char bus_info[32]; + char reserved1[32]; + char reserved2[16]; + u32 n_stats; + u32 testinfo_len; + u32 eedump_len; + u32 regdump_len; +}; + +struct ethtool_stats { + u32 cmd; + u32 n_stats; + u64 data[0]; +}; +#endif /* ETHTOOL_GSTATS */ + +#ifndef ETHTOOL_PHYS_ID +#define ETHTOOL_PHYS_ID 0x1c +#endif /* ETHTOOL_PHYS_ID */ + +#ifndef ETHTOOL_GSTRINGS +#define ETHTOOL_GSTRINGS 0x1b +enum ethtool_stringset { + ETH_SS_TEST = 0, + ETH_SS_STATS, +}; +struct ethtool_gstrings { + u32 cmd; /* ETHTOOL_GSTRINGS */ + u32 string_set; /* string set id e.c. ETH_SS_TEST, etc*/ + u32 len; /* number of strings in the string set */ + u8 data[0]; +}; +#endif /* ETHTOOL_GSTRINGS */ + +#ifndef ETHTOOL_TEST +#define ETHTOOL_TEST 0x1a +enum ethtool_test_flags { + ETH_TEST_FL_OFFLINE = (1 << 0), + ETH_TEST_FL_FAILED = (1 << 1), +}; +struct ethtool_test { + u32 cmd; + u32 flags; + u32 reserved; + u32 len; + u64 data[0]; +}; +#endif /* ETHTOOL_TEST */ + +#ifndef ETHTOOL_GEEPROM +#define ETHTOOL_GEEPROM 0xb +#undef ETHTOOL_GREGS +struct ethtool_eeprom { + u32 cmd; + u32 magic; + u32 offset; + u32 len; + u8 data[0]; +}; + +struct ethtool_value { + u32 cmd; + u32 data; +}; +#endif /* ETHTOOL_GEEPROM */ + +#ifndef ETHTOOL_GLINK +#define ETHTOOL_GLINK 0xa +#endif /* ETHTOOL_GLINK */ + +#ifndef ETHTOOL_GREGS +#define ETHTOOL_GREGS 0x00000004 /* Get NIC registers */ +#define ethtool_regs _kc_ethtool_regs +/* for passing big chunks of data */ +struct _kc_ethtool_regs { + u32 cmd; + u32 version; /* driver-specific, indicates different chips/revs */ + u32 len; /* bytes */ + u8 data[0]; +}; +#endif /* ETHTOOL_GREGS */ + +#ifndef ETHTOOL_GMSGLVL +#define ETHTOOL_GMSGLVL 0x00000007 /* Get driver message level */ +#endif +#ifndef ETHTOOL_SMSGLVL +#define ETHTOOL_SMSGLVL 0x00000008 /* Set driver msg level, priv. */ +#endif +#ifndef ETHTOOL_NWAY_RST +#define ETHTOOL_NWAY_RST 0x00000009 /* Restart autonegotiation, priv */ +#endif +#ifndef ETHTOOL_GLINK +#define ETHTOOL_GLINK 0x0000000a /* Get link status */ +#endif +#ifndef ETHTOOL_GEEPROM +#define ETHTOOL_GEEPROM 0x0000000b /* Get EEPROM data */ +#endif +#ifndef ETHTOOL_SEEPROM +#define ETHTOOL_SEEPROM 0x0000000c /* Set EEPROM data */ +#endif +#ifndef ETHTOOL_GCOALESCE +#define ETHTOOL_GCOALESCE 0x0000000e /* Get coalesce config */ +/* for configuring coalescing parameters of chip */ +#define ethtool_coalesce _kc_ethtool_coalesce +struct _kc_ethtool_coalesce { + u32 cmd; /* ETHTOOL_{G,S}COALESCE */ + + /* How many usecs to delay an RX interrupt after + * a packet arrives. If 0, only rx_max_coalesced_frames + * is used. + */ + u32 rx_coalesce_usecs; + + /* How many packets to delay an RX interrupt after + * a packet arrives. If 0, only rx_coalesce_usecs is + * used. It is illegal to set both usecs and max frames + * to zero as this would cause RX interrupts to never be + * generated. + */ + u32 rx_max_coalesced_frames; + + /* Same as above two parameters, except that these values + * apply while an IRQ is being serviced by the host. Not + * all cards support this feature and the values are ignored + * in that case. + */ + u32 rx_coalesce_usecs_irq; + u32 rx_max_coalesced_frames_irq; + + /* How many usecs to delay a TX interrupt after + * a packet is sent. If 0, only tx_max_coalesced_frames + * is used. + */ + u32 tx_coalesce_usecs; + + /* How many packets to delay a TX interrupt after + * a packet is sent. If 0, only tx_coalesce_usecs is + * used. It is illegal to set both usecs and max frames + * to zero as this would cause TX interrupts to never be + * generated. + */ + u32 tx_max_coalesced_frames; + + /* Same as above two parameters, except that these values + * apply while an IRQ is being serviced by the host. Not + * all cards support this feature and the values are ignored + * in that case. + */ + u32 tx_coalesce_usecs_irq; + u32 tx_max_coalesced_frames_irq; + + /* How many usecs to delay in-memory statistics + * block updates. Some drivers do not have an in-memory + * statistic block, and in such cases this value is ignored. + * This value must not be zero. + */ + u32 stats_block_coalesce_usecs; + + /* Adaptive RX/TX coalescing is an algorithm implemented by + * some drivers to improve latency under low packet rates and + * improve throughput under high packet rates. Some drivers + * only implement one of RX or TX adaptive coalescing. Anything + * not implemented by the driver causes these values to be + * silently ignored. + */ + u32 use_adaptive_rx_coalesce; + u32 use_adaptive_tx_coalesce; + + /* When the packet rate (measured in packets per second) + * is below pkt_rate_low, the {rx,tx}_*_low parameters are + * used. + */ + u32 pkt_rate_low; + u32 rx_coalesce_usecs_low; + u32 rx_max_coalesced_frames_low; + u32 tx_coalesce_usecs_low; + u32 tx_max_coalesced_frames_low; + + /* When the packet rate is below pkt_rate_high but above + * pkt_rate_low (both measured in packets per second) the + * normal {rx,tx}_* coalescing parameters are used. + */ + + /* When the packet rate is (measured in packets per second) + * is above pkt_rate_high, the {rx,tx}_*_high parameters are + * used. + */ + u32 pkt_rate_high; + u32 rx_coalesce_usecs_high; + u32 rx_max_coalesced_frames_high; + u32 tx_coalesce_usecs_high; + u32 tx_max_coalesced_frames_high; + + /* How often to do adaptive coalescing packet rate sampling, + * measured in seconds. Must not be zero. + */ + u32 rate_sample_interval; +}; +#endif /* ETHTOOL_GCOALESCE */ + +#ifndef ETHTOOL_SCOALESCE +#define ETHTOOL_SCOALESCE 0x0000000f /* Set coalesce config. */ +#endif +#ifndef ETHTOOL_GRINGPARAM +#define ETHTOOL_GRINGPARAM 0x00000010 /* Get ring parameters */ +/* for configuring RX/TX ring parameters */ +#define ethtool_ringparam _kc_ethtool_ringparam +struct _kc_ethtool_ringparam { + u32 cmd; /* ETHTOOL_{G,S}RINGPARAM */ + + /* Read only attributes. These indicate the maximum number + * of pending RX/TX ring entries the driver will allow the + * user to set. + */ + u32 rx_max_pending; + u32 rx_mini_max_pending; + u32 rx_jumbo_max_pending; + u32 tx_max_pending; + + /* Values changeable by the user. The valid values are + * in the range 1 to the "*_max_pending" counterpart above. + */ + u32 rx_pending; + u32 rx_mini_pending; + u32 rx_jumbo_pending; + u32 tx_pending; +}; +#endif /* ETHTOOL_GRINGPARAM */ + +#ifndef ETHTOOL_SRINGPARAM +#define ETHTOOL_SRINGPARAM 0x00000011 /* Set ring parameters, priv. */ +#endif +#ifndef ETHTOOL_GPAUSEPARAM +#define ETHTOOL_GPAUSEPARAM 0x00000012 /* Get pause parameters */ +/* for configuring link flow control parameters */ +#define ethtool_pauseparam _kc_ethtool_pauseparam +struct _kc_ethtool_pauseparam { + u32 cmd; /* ETHTOOL_{G,S}PAUSEPARAM */ + + /* If the link is being auto-negotiated (via ethtool_cmd.autoneg + * being true) the user may set 'autonet' here non-zero to have the + * pause parameters be auto-negotiated too. In such a case, the + * {rx,tx}_pause values below determine what capabilities are + * advertised. + * + * If 'autoneg' is zero or the link is not being auto-negotiated, + * then {rx,tx}_pause force the driver to use/not-use pause + * flow control. + */ + u32 autoneg; + u32 rx_pause; + u32 tx_pause; +}; +#endif /* ETHTOOL_GPAUSEPARAM */ + +#ifndef ETHTOOL_SPAUSEPARAM +#define ETHTOOL_SPAUSEPARAM 0x00000013 /* Set pause parameters. */ +#endif +#ifndef ETHTOOL_GRXCSUM +#define ETHTOOL_GRXCSUM 0x00000014 /* Get RX hw csum enable (ethtool_value) */ +#endif +#ifndef ETHTOOL_SRXCSUM +#define ETHTOOL_SRXCSUM 0x00000015 /* Set RX hw csum enable (ethtool_value) */ +#endif +#ifndef ETHTOOL_GTXCSUM +#define ETHTOOL_GTXCSUM 0x00000016 /* Get TX hw csum enable (ethtool_value) */ +#endif +#ifndef ETHTOOL_STXCSUM +#define ETHTOOL_STXCSUM 0x00000017 /* Set TX hw csum enable (ethtool_value) */ +#endif +#ifndef ETHTOOL_GSG +#define ETHTOOL_GSG 0x00000018 /* Get scatter-gather enable +* (ethtool_value) */ +#endif +#ifndef ETHTOOL_SSG +#define ETHTOOL_SSG 0x00000019 /* Set scatter-gather enable +* (ethtool_value). */ +#endif +#ifndef ETHTOOL_TEST +#define ETHTOOL_TEST 0x0000001a /* execute NIC self-test, priv. */ +#endif +#ifndef ETHTOOL_GSTRINGS +#define ETHTOOL_GSTRINGS 0x0000001b /* get specified string set */ +#endif +#ifndef ETHTOOL_PHYS_ID +#define ETHTOOL_PHYS_ID 0x0000001c /* identify the NIC */ +#endif +#ifndef ETHTOOL_GSTATS +#define ETHTOOL_GSTATS 0x0000001d /* get NIC-specific statistics */ +#endif +#ifndef ETHTOOL_GTSO +#define ETHTOOL_GTSO 0x0000001e /* Get TSO enable (ethtool_value) */ +#endif +#ifndef ETHTOOL_STSO +#define ETHTOOL_STSO 0x0000001f /* Set TSO enable (ethtool_value) */ +#endif + +#ifndef ETHTOOL_BUSINFO_LEN +#define ETHTOOL_BUSINFO_LEN 32 +#endif + +/*****************************************************************************/ + +enum RTL8168_DSM_STATE { + DSM_MAC_INIT = 1, + DSM_NIC_GOTO_D3 = 2, + DSM_IF_DOWN = 3, + DSM_NIC_RESUME_D3 = 4, + DSM_IF_UP = 5, +}; + +enum RTL8168_registers { + MAC0 = 0x00, /* Ethernet hardware address. */ + MAC4 = 0x04, + MAR0 = 0x08, /* Multicast filter. */ + CounterAddrLow = 0x10, + CounterAddrHigh = 0x14, + CustomLED = 0x18, + TxDescStartAddrLow = 0x20, + TxDescStartAddrHigh = 0x24, + TxHDescStartAddrLow = 0x28, + TxHDescStartAddrHigh = 0x2c, + FLASH = 0x30, + ERSR = 0x36, + ChipCmd = 0x37, + TxPoll = 0x38, + IntrMask = 0x3C, + IntrStatus = 0x3E, + TxConfig = 0x40, + RxConfig = 0x44, + TCTR = 0x48, + Cfg9346 = 0x50, + Config0 = 0x51, + Config1 = 0x52, + Config2 = 0x53, + Config3 = 0x54, + Config4 = 0x55, + Config5 = 0x56, + TDFNR = 0x57, + TimeInt0 = 0x58, + TimeInt1 = 0x5C, + PHYAR = 0x60, + CSIDR = 0x64, + CSIAR = 0x68, + PHYstatus = 0x6C, + MACDBG = 0x6D, + GPIO = 0x6E, + PMCH = 0x6F, + ERIDR = 0x70, + ERIAR = 0x74, + EPHY_RXER_NUM = 0x7C, + EPHYAR = 0x80, + TimeInt2 = 0x8C, + OCPDR = 0xB0, + MACOCP = 0xB0, + OCPAR = 0xB4, + SecMAC0 = 0xB4, + SecMAC4 = 0xB8, + PHYOCP = 0xB8, + DBG_reg = 0xD1, + TwiCmdReg = 0xD2, + MCUCmd_reg = 0xD3, + RxMaxSize = 0xDA, + EFUSEAR = 0xDC, + CPlusCmd = 0xE0, + IntrMitigate = 0xE2, + RxDescAddrLow = 0xE4, + RxDescAddrHigh = 0xE8, + MTPS = 0xEC, + FuncEvent = 0xF0, + PPSW = 0xF2, + FuncEventMask = 0xF4, + TimeInt3 = 0xF4, + FuncPresetState = 0xF8, + IBCR0 = 0xF8, + IBCR2 = 0xF9, + IBIMR0 = 0xFA, + IBISR0 = 0xFB, + FuncForceEvent = 0xFC, +}; + +enum RTL8168_register_content { + /* InterruptStatusBits */ + SYSErr = 0x8000, + PCSTimeout = 0x4000, + SWInt = 0x0100, + TxDescUnavail = 0x0080, + RxFIFOOver = 0x0040, + LinkChg = 0x0020, + RxDescUnavail = 0x0010, + TxErr = 0x0008, + TxOK = 0x0004, + RxErr = 0x0002, + RxOK = 0x0001, + + /* RxStatusDesc */ + RxRWT = (1 << 22), + RxRES = (1 << 21), + RxRUNT = (1 << 20), + RxCRC = (1 << 19), + + /* ChipCmdBits */ + StopReq = 0x80, + CmdReset = 0x10, + CmdRxEnb = 0x08, + CmdTxEnb = 0x04, + RxBufEmpty = 0x01, + + /* Cfg9346Bits */ + Cfg9346_Lock = 0x00, + Cfg9346_Unlock = 0xC0, + Cfg9346_EEDO = (1 << 0), + Cfg9346_EEDI = (1 << 1), + Cfg9346_EESK = (1 << 2), + Cfg9346_EECS = (1 << 3), + Cfg9346_EEM0 = (1 << 6), + Cfg9346_EEM1 = (1 << 7), + + /* rx_mode_bits */ + AcceptErr = 0x20, + AcceptRunt = 0x10, + AcceptBroadcast = 0x08, + AcceptMulticast = 0x04, + AcceptMyPhys = 0x02, + AcceptAllPhys = 0x01, + + /* Transmit Priority Polling*/ + HPQ = 0x80, + NPQ = 0x40, + FSWInt = 0x01, + + /* RxConfigBits */ + Reserved2_shift = 13, + RxCfgDMAShift = 8, + RxCfg_128_int_en = (1 << 15), + RxCfg_fet_multi_en = (1 << 14), + RxCfg_half_refetch = (1 << 13), + RxCfg_9356SEL = (1 << 6), + + /* TxConfigBits */ + TxInterFrameGapShift = 24, + TxDMAShift = 8, /* DMA burst value (0-7) is shift this many bits */ + TxMACLoopBack = (1 << 17), /* MAC loopback */ + + /* Config1 register */ + LEDS1 = (1 << 7), + LEDS0 = (1 << 6), + Speed_down = (1 << 4), + MEMMAP = (1 << 3), + IOMAP = (1 << 2), + VPD = (1 << 1), + PMEnable = (1 << 0), /* Power Management Enable */ + + /* Config2 register */ + PMSTS_En = (1 << 5), + + /* Config3 register */ + Isolate_en = (1 << 12), /* Isolate enable */ + MagicPacket = (1 << 5), /* Wake up when receives a Magic Packet */ + LinkUp = (1 << 4), /* This bit is reserved in RTL8168B.*/ + /* Wake up when the cable connection is re-established */ + ECRCEN = (1 << 3), /* This bit is reserved in RTL8168B*/ + Jumbo_En0 = (1 << 2), /* This bit is reserved in RTL8168B*/ + RDY_TO_L23 = (1 << 1), /* This bit is reserved in RTL8168B*/ + Beacon_en = (1 << 0), /* This bit is reserved in RTL8168B*/ + + /* Config4 register */ + Jumbo_En1 = (1 << 1), /* This bit is reserved in RTL8168B*/ + + /* Config5 register */ + BWF = (1 << 6), /* Accept Broadcast wakeup frame */ + MWF = (1 << 5), /* Accept Multicast wakeup frame */ + UWF = (1 << 4), /* Accept Unicast wakeup frame */ + LanWake = (1 << 1), /* LanWake enable/disable */ + PMEStatus = (1 << 0), /* PME status can be reset by PCI RST# */ + + /* CPlusCmd */ + EnableBist = (1 << 15), + Macdbgo_oe = (1 << 14), + Normal_mode = (1 << 13), + Force_halfdup = (1 << 12), + Force_rxflow_en = (1 << 11), + Force_txflow_en = (1 << 10), + Cxpl_dbg_sel = (1 << 9),//This bit is reserved in RTL8168B + ASF = (1 << 8),//This bit is reserved in RTL8168C + PktCntrDisable = (1 << 7), + RxVlan = (1 << 6), + RxChkSum = (1 << 5), + Macdbgo_sel = 0x001C, + INTT_0 = 0x0000, + INTT_1 = 0x0001, + INTT_2 = 0x0002, + INTT_3 = 0x0003, + + /* rtl8168_PHYstatus */ + PowerSaveStatus = 0x80, + TxFlowCtrl = 0x40, + RxFlowCtrl = 0x20, + _1000bpsF = 0x10, + _100bps = 0x08, + _10bps = 0x04, + LinkStatus = 0x02, + FullDup = 0x01, + + /* DBG_reg */ + Fix_Nak_1 = (1 << 4), + Fix_Nak_2 = (1 << 3), + DBGPIN_E2 = (1 << 0), + + /* DumpCounterCommand */ + CounterDump = 0x8, + + /* PHY access */ + PHYAR_Flag = 0x80000000, + PHYAR_Write = 0x80000000, + PHYAR_Read = 0x00000000, + PHYAR_Reg_Mask = 0x1f, + PHYAR_Reg_shift = 16, + PHYAR_Data_Mask = 0xffff, + + /* EPHY access */ + EPHYAR_Flag = 0x80000000, + EPHYAR_Write = 0x80000000, + EPHYAR_Read = 0x00000000, + EPHYAR_Reg_Mask = 0x1f, + EPHYAR_Reg_shift = 16, + EPHYAR_Data_Mask = 0xffff, + + /* CSI access */ + CSIAR_Flag = 0x80000000, + CSIAR_Write = 0x80000000, + CSIAR_Read = 0x00000000, + CSIAR_ByteEn = 0x0f, + CSIAR_ByteEn_shift = 12, + CSIAR_Addr_Mask = 0x0fff, + + /* ERI access */ + ERIAR_Flag = 0x80000000, + ERIAR_Write = 0x80000000, + ERIAR_Read = 0x00000000, + ERIAR_Addr_Align = 4, /* ERI access register address must be 4 byte alignment */ + ERIAR_ExGMAC = 0, + ERIAR_MSIX = 1, + ERIAR_ASF = 2, + ERIAR_OOB = 2, + ERIAR_Type_shift = 16, + ERIAR_ByteEn = 0x0f, + ERIAR_ByteEn_shift = 12, + + /* OCP GPHY access */ + OCPDR_Write = 0x80000000, + OCPDR_Read = 0x00000000, + OCPDR_Reg_Mask = 0xFF, + OCPDR_Data_Mask = 0xFFFF, + OCPDR_GPHY_Reg_shift = 16, + OCPAR_Flag = 0x80000000, + OCPAR_GPHY_Write = 0x8000F060, + OCPAR_GPHY_Read = 0x0000F060, + OCPR_Write = 0x80000000, + OCPR_Read = 0x00000000, + OCPR_Addr_Reg_shift = 16, + OCPR_Flag = 0x80000000, + OCP_STD_PHY_BASE_PAGE = 0x0A40, + + /* MCU Command */ + Now_is_oob = (1 << 7), + Txfifo_empty = (1 << 5), + Rxfifo_empty = (1 << 4), + + /* E-FUSE access */ + EFUSE_WRITE = 0x80000000, + EFUSE_WRITE_OK = 0x00000000, + EFUSE_READ = 0x00000000, + EFUSE_READ_OK = 0x80000000, + EFUSE_Reg_Mask = 0x03FF, + EFUSE_Reg_Shift = 8, + EFUSE_Check_Cnt = 300, + EFUSE_READ_FAIL = 0xFF, + EFUSE_Data_Mask = 0x000000FF, + + /* GPIO */ + GPIO_en = (1 << 0), + +}; + +enum _DescStatusBit { + DescOwn = (1 << 31), /* Descriptor is owned by NIC */ + RingEnd = (1 << 30), /* End of descriptor ring */ + FirstFrag = (1 << 29), /* First segment of a packet */ + LastFrag = (1 << 28), /* Final segment of a packet */ + + /* Tx private */ + /*------ offset 0 of tx descriptor ------*/ + LargeSend = (1 << 27), /* TCP Large Send Offload (TSO) */ + LargeSend_DP = (1 << 16), /* TCP Large Send Offload (TSO) */ + MSSShift = 16, /* MSS value position */ + MSSMask = 0x7FFU, /* MSS value 11 bits */ + TxIPCS = (1 << 18), /* Calculate IP checksum */ + TxUDPCS = (1 << 17), /* Calculate UDP/IP checksum */ + TxTCPCS = (1 << 16), /* Calculate TCP/IP checksum */ + TxVlanTag = (1 << 17), /* Add VLAN tag */ + + /*@@@@@@ offset 4 of tx descriptor => bits for RTL8168C/CP only begin @@@@@@*/ + TxUDPCS_C = (1 << 31), /* Calculate UDP/IP checksum */ + TxTCPCS_C = (1 << 30), /* Calculate TCP/IP checksum */ + TxIPCS_C = (1 << 29), /* Calculate IP checksum */ + /*@@@@@@ offset 4 of tx descriptor => bits for RTL8168C/CP only end @@@@@@*/ + + + /* Rx private */ + /*------ offset 0 of rx descriptor ------*/ + PID1 = (1 << 18), /* Protocol ID bit 1/2 */ + PID0 = (1 << 17), /* Protocol ID bit 2/2 */ + +#define RxProtoUDP (PID1) +#define RxProtoTCP (PID0) +#define RxProtoIP (PID1 | PID0) +#define RxProtoMask RxProtoIP + + RxIPF = (1 << 16), /* IP checksum failed */ + RxUDPF = (1 << 15), /* UDP/IP checksum failed */ + RxTCPF = (1 << 14), /* TCP/IP checksum failed */ + RxVlanTag = (1 << 16), /* VLAN tag available */ + + /*@@@@@@ offset 0 of rx descriptor => bits for RTL8168C/CP only begin @@@@@@*/ + RxUDPT = (1 << 18), + RxTCPT = (1 << 17), + /*@@@@@@ offset 0 of rx descriptor => bits for RTL8168C/CP only end @@@@@@*/ + + /*@@@@@@ offset 4 of rx descriptor => bits for RTL8168C/CP only begin @@@@@@*/ + RxV6F = (1 << 31), + RxV4F = (1 << 30), + /*@@@@@@ offset 4 of rx descriptor => bits for RTL8168C/CP only end @@@@@@*/ +}; + +enum features { +// RTL_FEATURE_WOL = (1 << 0), + RTL_FEATURE_MSI = (1 << 1), +}; + +enum wol_capability { + WOL_DISABLED = 0, + WOL_ENABLED = 1 +}; + +enum bits { + BIT_0 = (1 << 0), + BIT_1 = (1 << 1), + BIT_2 = (1 << 2), + BIT_3 = (1 << 3), + BIT_4 = (1 << 4), + BIT_5 = (1 << 5), + BIT_6 = (1 << 6), + BIT_7 = (1 << 7), + BIT_8 = (1 << 8), + BIT_9 = (1 << 9), + BIT_10 = (1 << 10), + BIT_11 = (1 << 11), + BIT_12 = (1 << 12), + BIT_13 = (1 << 13), + BIT_14 = (1 << 14), + BIT_15 = (1 << 15), + BIT_16 = (1 << 16), + BIT_17 = (1 << 17), + BIT_18 = (1 << 18), + BIT_19 = (1 << 19), + BIT_20 = (1 << 20), + BIT_21 = (1 << 21), + BIT_22 = (1 << 22), + BIT_23 = (1 << 23), + BIT_24 = (1 << 24), + BIT_25 = (1 << 25), + BIT_26 = (1 << 26), + BIT_27 = (1 << 27), + BIT_28 = (1 << 28), + BIT_29 = (1 << 29), + BIT_30 = (1 << 30), + BIT_31 = (1 << 31) +}; + +enum effuse { + EFUSE_NOT_SUPPORT = 0, + EFUSE_SUPPORT_V1, + EFUSE_SUPPORT_V2, + EFUSE_SUPPORT_V3, +}; +#define RsvdMask 0x3fffc000 + +struct TxDesc { + u32 opts1; + u32 opts2; + u64 addr; +}; + +struct RxDesc { + u32 opts1; + u32 opts2; + u64 addr; +}; + +struct ring_info { + struct sk_buff *skb; + u32 len; + u8 __pad[sizeof(void *) - sizeof(u32)]; +}; + +struct pci_resource { + u8 cmd; + u8 cls; + u16 io_base_h; + u16 io_base_l; + u16 mem_base_h; + u16 mem_base_l; + u8 ilr; + u16 resv_0x1c_h; + u16 resv_0x1c_l; + u16 resv_0x20_h; + u16 resv_0x20_l; + u16 resv_0x24_h; + u16 resv_0x24_l; + u16 resv_0x2c_h; + u16 resv_0x2c_l; + u32 pci_sn_l; + u32 pci_sn_h; +}; + +struct rtl8168_private { + void __iomem *mmio_addr; /* memory map physical address */ + struct pci_dev *pci_dev; /* Index of PCI device */ + struct net_device *dev; +#ifdef CONFIG_R8168_NAPI +#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,24) + struct napi_struct napi; +#endif +#endif + struct net_device_stats stats; /* statistics of net device */ + spinlock_t lock; /* spin lock flag */ + spinlock_t phy_lock; /* spin lock flag for GPHY */ + u32 msg_enable; + u32 tx_tcp_csum_cmd; + u32 tx_udp_csum_cmd; + u32 tx_ip_csum_cmd; + int max_jumbo_frame_size; + int chipset; + u32 mcfg; + u32 cur_rx; /* Index into the Rx descriptor buffer of next Rx pkt. */ + u32 cur_tx; /* Index into the Tx descriptor buffer of next Rx pkt. */ + u32 dirty_rx; + u32 dirty_tx; + struct TxDesc *TxDescArray; /* 256-aligned Tx descriptor ring */ + struct RxDesc *RxDescArray; /* 256-aligned Rx descriptor ring */ + dma_addr_t TxPhyAddr; + dma_addr_t RxPhyAddr; + struct sk_buff *Rx_skbuff[NUM_RX_DESC]; /* Rx data buffers */ + struct ring_info tx_skb[NUM_TX_DESC]; /* Tx data buffers */ + unsigned rx_buf_sz; + struct timer_list esd_timer; + struct timer_list link_timer; + struct pci_resource pci_cfg_space; + unsigned int esd_flag; + unsigned int pci_cfg_is_read; + unsigned int rtl8168_rx_config; + u16 cp_cmd; + u16 intr_mask; + u16 timer_intr_mask; + int phy_auto_nego_reg; + int phy_1000_ctrl_reg; + u8 org_mac_addr[NODE_ADDRESS_SIZE]; + struct rtl8168_counters *tally_vaddr; + dma_addr_t tally_paddr; + +#ifdef CONFIG_R8168_VLAN + struct vlan_group *vlgrp; +#endif + u8 wol_enabled; + u32 wol_opts; + u8 efuse_ver; + u8 eeprom_type; + u8 autoneg; + u8 duplex; + u16 speed; + u16 eeprom_len; + u16 cur_page; + u32 bios_setting; + + int (*set_speed)(struct net_device *, u8 autoneg, u16 speed, u8 duplex); + void (*get_settings)(struct net_device *, struct ethtool_cmd *); + void (*phy_reset_enable)(struct net_device *); + unsigned int (*phy_reset_pending)(struct net_device *); + unsigned int (*link_ok)(struct net_device *); +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,20) + struct work_struct task; +#else + struct delayed_work task; +#endif + unsigned features; + + u8 org_pci_offset_99; + u8 org_pci_offset_180; + u8 issue_offset_99_event; + + u8 org_pci_offset_80; + u8 org_pci_offset_81; + u8 use_timer_interrrupt; + + u32 keep_intr_cnt; + + u8 HwIcVerUnknown; + u8 NotWrRamCodeToMicroP; + u8 NotWrMcuPatchCode; + u8 HwHasWrRamCodeToMicroP; + + u16 sw_ram_code_ver; + u16 hw_ram_code_ver; + + u8 rtk_enable_diag; + + u8 ShortPacketSwChecksum; + + u8 UseSwPaddingShortPkt; + + void *ShortPacketEmptyBuffer; + dma_addr_t ShortPacketEmptyBufferPhy; + + u8 RequireAdcBiasPatch; + u16 AdcBiasPatchIoffset; + + u8 RequireAdjustUpsTxLinkPulseTiming; + u16 SwrCnt1msIni; + + u8 HwSuppNowIsOobVer; + + u8 RequiredSecLanDonglePatch; + + //Dash+++++++++++++++++ + u8 HwSuppDashVer; + u8 DASH; + +#ifdef ENABLE_DASH_SUPPORT + u16 AfterRecvFromFwBufLen; + u8 AfterRecvFromFwBuf[RECV_FROM_FW_BUF_SIZE]; + u16 AfterSendToFwBufLen; + u8 AfterSendToFwBuf[SEND_TO_FW_BUF_SIZE]; + u16 SendToFwBufferLen; + u32 SizeOfSendToFwBuffer ; + u32 SizeOfSendToFwBufferMemAlloc ; + u32 NumOfSendToFwBuffer ; + + u8 OobReq; + u8 OobAck; + u32 OobReqComplete; + u32 OobAckComplete; + + u8 RcvFwReqSysOkEvt; + u8 RcvFwDashOkEvt; + u8 SendFwHostOkEvt; + + u8 DashFwDisableRx; + + void *UnalignedSendToFwBufferVa; + void *SendToFwBuffer ; + u64 SendToFwBufferPhy ; + u8 SendingToFw; + u64 UnalignedSendToFwBufferPa; + PTX_DASH_SEND_FW_DESC TxDashSendFwDesc; + u64 TxDashSendFwDescPhy; + u8 *UnalignedTxDashSendFwDescVa; + u32 SizeOfTxDashSendFwDescMemAlloc; + u32 SizeOfTxDashSendFwDesc ; + u32 NumTxDashSendFwDesc ; + u32 CurrNumTxDashSendFwDesc ; + u64 UnalignedTxDashSendFwDescPa; + + u32 NumRecvFromFwBuffer ; + u32 SizeOfRecvFromFwBuffer ; + u32 SizeOfRecvFromFwBufferMemAlloc ; + void *RecvFromFwBuffer ; + u64 RecvFromFwBufferPhy ; + + void *UnalignedRecvFromFwBufferVa; + u64 UnalignedRecvFromFwBufferPa; + PRX_DASH_FROM_FW_DESC RxDashRecvFwDesc; + u64 RxDashRecvFwDescPhy; + u8 *UnalignedRxDashRecvFwDescVa; + u32 SizeOfRxDashRecvFwDescMemAlloc; + u32 SizeOfRxDashRecvFwDesc ; + u32 NumRxDashRecvFwDesc ; + u32 CurrNumRxDashRecvFwDesc ; + u64 UnalignedRxDashRecvFwDescPa; + u8 DashReqRegValue; + u16 HostReqValue; + + u32 CmacResetIsrCounter; + u8 CmacResetIsr1st ; + u8 CmacResetIsr2nd ; + u8 CmacResetting ; + u8 CmacOobIssueCmacReset ; + //Dash----------------- +#endif //ENABLE_DASH_SUPPORT + + //Realwow++++++++++++++ + u8 HwSuppKCPOffloadVer; + + u8 EnableDhcpTimeoutWake; + u8 EnableTeredoOffload; + u8 EnableKCPOffload; +#ifdef ENABLE_REALWOW_SUPPORT + u32 DhcpTimeout; + MP_KCP_INFO MpKCPInfo; + //Realwow-------------- +#endif //ENABLE_REALWOW_SUPPORT + +#ifdef ENABLE_R8168_PROCFS + //Procfs support + struct proc_dir_entry *proc_dir; +#endif +}; + +enum eetype { + EEPROM_TYPE_NONE=0, + EEPROM_TYPE_93C46, + EEPROM_TYPE_93C56, + EEPROM_TWSI +}; + +enum mcfg { + CFG_METHOD_1=0, + CFG_METHOD_2, + CFG_METHOD_3, + CFG_METHOD_4, + CFG_METHOD_5, + CFG_METHOD_6, + CFG_METHOD_7, + CFG_METHOD_8, + CFG_METHOD_9 , + CFG_METHOD_10, + CFG_METHOD_11, + CFG_METHOD_12, + CFG_METHOD_13, + CFG_METHOD_14, + CFG_METHOD_15, + CFG_METHOD_16, + CFG_METHOD_17, + CFG_METHOD_18, + CFG_METHOD_19, + CFG_METHOD_20, + CFG_METHOD_21, + CFG_METHOD_22, + CFG_METHOD_23, + CFG_METHOD_24, + CFG_METHOD_25, + CFG_METHOD_26, + CFG_METHOD_27, + CFG_METHOD_28, + CFG_METHOD_29, + CFG_METHOD_30, + CFG_METHOD_MAX, + CFG_METHOD_DEFAULT = 0xFF +}; + +#define OOB_CMD_RESET 0x00 +#define OOB_CMD_DRIVER_START 0x05 +#define OOB_CMD_DRIVER_STOP 0x06 +#define OOB_CMD_SET_IPMAC 0x41 + + +//Ram Code Version +#define NIC_RAMCODE_VERSION_CFG_METHOD_14 (0x0057) +#define NIC_RAMCODE_VERSION_CFG_METHOD_16 (0x0055) +#define NIC_RAMCODE_VERSION_CFG_METHOD_18 (0x0044) +#define NIC_RAMCODE_VERSION_CFG_METHOD_20 (0x0044) +#define NIC_RAMCODE_VERSION_CFG_METHOD_21 (0x0042) +#define NIC_RAMCODE_VERSION_CFG_METHOD_24 (0x0001) +#define NIC_RAMCODE_VERSION_CFG_METHOD_23 (0x0015) +#define NIC_RAMCODE_VERSION_CFG_METHOD_26 (0x0012) +#define NIC_RAMCODE_VERSION_CFG_METHOD_28 (0x0010) +#define NIC_RAMCODE_VERSION_CFG_METHOD_29 (0x0018) + +//hwoptimize +#define HW_PATCH_SAMSUNG_LAN_DONGLE (BIT_2) + +void mdio_write(struct rtl8168_private *tp, u32 RegAddr, u32 value); +void mdio_prot_write(struct rtl8168_private *tp, u32 RegAddr, u32 value); +void rtl8168_ephy_write(void __iomem *ioaddr, int RegAddr, int value); +void mac_ocp_write(struct rtl8168_private *tp, u16 reg_addr, u16 value); +u16 mac_ocp_read(struct rtl8168_private *tp, u16 reg_addr); +void ClearEthPhyBit(struct rtl8168_private *tp, u8 addr, u16 mask); +void SetEthPhyBit(struct rtl8168_private *tp, u8 addr, u16 mask); +void OCP_write(struct rtl8168_private *tp, u16 addr, u8 len, u32 data); +void OOB_notify(struct rtl8168_private *tp, u8 cmd); +void rtl8168_init_ring_indexes(struct rtl8168_private *tp); +void rtl8168_wait_ll_share_fifo_ready(struct net_device *dev); +int rtl8168_eri_write(void __iomem *ioaddr, int addr, int len, u32 value, int type); +void OOB_mutex_lock(struct rtl8168_private *tp); +u32 mdio_read(struct rtl8168_private *tp, u32 RegAddr); +u32 OCP_read(struct rtl8168_private *tp, u16 addr, u8 len); +u32 rtl8168_eri_read(void __iomem *ioaddr, int addr, int len, int type); +u16 rtl8168_ephy_read(void __iomem *ioaddr, int RegAddr); +void rtl8168_hw_disable_mac_mcu_bps(struct net_device *dev); +void rtl8168_wait_txrx_fifo_empty(struct net_device *dev); +void EnableNowIsOob(struct rtl8168_private *tp); +void DisableNowIsOob(struct rtl8168_private *tp); +void OOB_mutex_unlock(struct rtl8168_private *tp); +void Dash2DisableTx(struct rtl8168_private *tp); +void Dash2EnableTx(struct rtl8168_private *tp); +void Dash2DisableRx(struct rtl8168_private *tp); +void Dash2EnableRx(struct rtl8168_private *tp); + + +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,34) +#define netdev_mc_count(dev) ((dev)->mc_count) +#define netdev_mc_empty(dev) (netdev_mc_count(dev) == 0) +#define netdev_for_each_mc_addr(mclist, dev) \ + for (mclist = dev->mc_list; mclist; mclist = mclist->next) +#endif diff --git a/drivers/net/ethernet/realtek/r8168_asf.c b/drivers/net/ethernet/realtek/r8168_asf.c new file mode 100755 index 0000000..ac7e343 --- /dev/null +++ b/drivers/net/ethernet/realtek/r8168_asf.c @@ -0,0 +1,419 @@ +/* +################################################################################ +# +# r8168 is the Linux device driver released for Realtek Gigabit Ethernet +# controllers with PCI-Express interface. +# +# Copyright(c) 2015 Realtek Semiconductor Corp. All rights reserved. +# +# This program is free software; you can redistribute it and/or modify it +# under the terms of the GNU General Public License as published by the Free +# Software Foundation; either version 2 of the License, or (at your option) +# any later version. +# +# This program is distributed in the hope that it will be useful, but WITHOUT +# ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or +# FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for +# more details. +# +# You should have received a copy of the GNU General Public License along with +# this program; if not, see . +# +# Author: +# Realtek NIC software team +# No. 2, Innovation Road II, Hsinchu Science Park, Hsinchu 300, Taiwan +# +################################################################################ +*/ + +/************************************************************************************ + * This product is covered by one or more of the following patents: + * US6,570,884, US6,115,776, and US6,327,625. + ***********************************************************************************/ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include + +#include "r8168.h" +#include "r8168_asf.h" +#include "rtl_eeprom.h" + +int rtl8168_asf_ioctl(struct net_device *dev, + struct ifreq *ifr) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + void *user_data = ifr->ifr_data; + struct asf_ioctl_struct asf_usrdata; + + if (tp->mcfg != CFG_METHOD_7 && tp->mcfg != CFG_METHOD_8) + return -EOPNOTSUPP; + + if (copy_from_user(&asf_usrdata, user_data, sizeof(struct asf_ioctl_struct))) + return -EFAULT; + + switch (asf_usrdata.offset) { + case HBPeriod: + rtl8168_asf_hbperiod(ioaddr, asf_usrdata.arg, asf_usrdata.u.data); + break; + case WD8Timer: + break; + case WD16Rst: + rtl8168_asf_wd16rst(ioaddr, asf_usrdata.arg, asf_usrdata.u.data); + break; + case WD8Rst: + rtl8168_asf_time_period(ioaddr, asf_usrdata.arg, WD8Rst, asf_usrdata.u.data); + break; + case LSnsrPollCycle: + rtl8168_asf_time_period(ioaddr, asf_usrdata.arg, LSnsrPollCycle, asf_usrdata.u.data); + break; + case ASFSnsrPollPrd: + rtl8168_asf_time_period(ioaddr, asf_usrdata.arg, ASFSnsrPollPrd, asf_usrdata.u.data); + break; + case AlertReSendItvl: + rtl8168_asf_time_period(ioaddr, asf_usrdata.arg, AlertReSendItvl, asf_usrdata.u.data); + break; + case SMBAddr: + rtl8168_asf_rw_hexadecimal(ioaddr, asf_usrdata.arg, SMBAddr, RW_ONE_BYTE, asf_usrdata.u.data); + break; + case ASFConfigR0: + rtl8168_asf_config_regs(ioaddr, asf_usrdata.arg, ASFConfigR0, asf_usrdata.u.data); + break; + case ASFConfigR1: + rtl8168_asf_config_regs(ioaddr, asf_usrdata.arg, ASFConfigR1, asf_usrdata.u.data); + break; + case ConsoleMA: + rtl8168_asf_console_mac(tp, asf_usrdata.arg, asf_usrdata.u.data); + break; + case ConsoleIP: + rtl8168_asf_ip_address(ioaddr, asf_usrdata.arg, ConsoleIP, asf_usrdata.u.data); + break; + case IPAddr: + rtl8168_asf_ip_address(tp, asf_usrdata.arg, IPAddr, asf_usrdata.u.data); + break; + case UUID: + rtl8168_asf_rw_uuid(ioaddr, asf_usrdata.arg, asf_usrdata.u.data); + break; + case IANA: + rtl8168_asf_rw_iana(ioaddr, asf_usrdata.arg, asf_usrdata.u.data); + break; + case SysID: + rtl8168_asf_rw_systemid(ioaddr, asf_usrdata.arg, asf_usrdata.u.data); + break; + case Community: + rtl8168_asf_community_string(ioaddr, asf_usrdata.arg, asf_usrdata.u.string); + break; + case StringLength: + rtl8168_asf_community_string_len(ioaddr, asf_usrdata.arg, asf_usrdata.u.data); + break; + case FmCapMsk: + rtl8168_asf_capability_masks(ioaddr, asf_usrdata.arg, FmCapMsk, asf_usrdata.u.data); + break; + case SpCMDMsk: + rtl8168_asf_capability_masks(ioaddr, asf_usrdata.arg, SpCMDMsk, asf_usrdata.u.data); + break; + case SysCapMsk: + rtl8168_asf_capability_masks(ioaddr, asf_usrdata.arg, SysCapMsk, asf_usrdata.u.data); + break; + case RmtRstAddr: + rtl8168_asf_rw_hexadecimal(ioaddr, asf_usrdata.arg, RmtRstAddr, RW_ONE_BYTE, asf_usrdata.u.data); + break; + case RmtRstCmd: + rtl8168_asf_rw_hexadecimal(ioaddr, asf_usrdata.arg, RmtRstCmd, RW_ONE_BYTE, asf_usrdata.u.data); + break; + case RmtRstData: + rtl8168_asf_rw_hexadecimal(ioaddr, asf_usrdata.arg, RmtRstData, RW_ONE_BYTE, asf_usrdata.u.data); + break; + case RmtPwrOffAddr: + rtl8168_asf_rw_hexadecimal(ioaddr, asf_usrdata.arg, RmtPwrOffAddr, RW_ONE_BYTE, asf_usrdata.u.data); + break; + case RmtPwrOffCmd: + rtl8168_asf_rw_hexadecimal(ioaddr, asf_usrdata.arg, RmtPwrOffCmd, RW_ONE_BYTE, asf_usrdata.u.data); + break; + case RmtPwrOffData: + rtl8168_asf_rw_hexadecimal(ioaddr, asf_usrdata.arg, RmtPwrOffData, RW_ONE_BYTE, asf_usrdata.u.data); + break; + case RmtPwrOnAddr: + rtl8168_asf_rw_hexadecimal(ioaddr, asf_usrdata.arg, RmtPwrOnAddr, RW_ONE_BYTE, asf_usrdata.u.data); + break; + case RmtPwrOnCmd: + rtl8168_asf_rw_hexadecimal(ioaddr, asf_usrdata.arg, RmtPwrOnCmd, RW_ONE_BYTE, asf_usrdata.u.data); + break; + case RmtPwrOnData: + rtl8168_asf_rw_hexadecimal(ioaddr, asf_usrdata.arg, RmtPwrOnData, RW_ONE_BYTE, asf_usrdata.u.data); + break; + case RmtPCRAddr: + rtl8168_asf_rw_hexadecimal(ioaddr, asf_usrdata.arg, RmtPCRAddr, RW_ONE_BYTE, asf_usrdata.u.data); + break; + case RmtPCRCmd: + rtl8168_asf_rw_hexadecimal(ioaddr, asf_usrdata.arg, RmtPCRCmd, RW_ONE_BYTE, asf_usrdata.u.data); + break; + case RmtPCRData: + rtl8168_asf_rw_hexadecimal(ioaddr, asf_usrdata.arg, RmtPCRData, RW_ONE_BYTE, asf_usrdata.u.data); + break; + case ASFSnsr0Addr: + rtl8168_asf_rw_hexadecimal(ioaddr, asf_usrdata.arg, ASFSnsr0Addr, RW_ONE_BYTE, asf_usrdata.u.data); + break; + case LSnsrAddr0: + rtl8168_asf_rw_hexadecimal(ioaddr, asf_usrdata.arg, LSnsrAddr0, RW_ONE_BYTE, asf_usrdata.u.data); + break; + case KO: + /* Get/Set Key Operation */ + rtl8168_asf_key_access(ioaddr, asf_usrdata.arg, KO, asf_usrdata.u.data); + break; + case KA: + /* Get/Set Key Administrator */ + rtl8168_asf_key_access(ioaddr, asf_usrdata.arg, KA, asf_usrdata.u.data); + break; + case KG: + /* Get/Set Key Generation */ + rtl8168_asf_key_access(ioaddr, asf_usrdata.arg, KG, asf_usrdata.u.data); + break; + case KR: + /* Get/Set Key Random */ + rtl8168_asf_key_access(tp, asf_usrdata.arg, KR, asf_usrdata.u.data); + break; + default: + return -EOPNOTSUPP; + } + + if (copy_to_user(user_data, &asf_usrdata, sizeof(struct asf_ioctl_struct))) + return -EFAULT; + + return 0; +} + +void rtl8168_asf_hbperiod(void __iomem *ioaddr, int arg, unsigned int *data) +{ + if (arg == ASF_GET) + data[ASFHBPERIOD] = rtl8168_eri_read(ioaddr, HBPeriod, RW_TWO_BYTES, ERIAR_ASF); + else if (arg == ASF_SET) { + rtl8168_eri_write(ioaddr, HBPeriod, RW_TWO_BYTES, data[ASFHBPERIOD], ERIAR_ASF); + rtl8168_eri_write(ioaddr, 0x1EC, RW_ONE_BYTE, 0x07, ERIAR_ASF); + } +} + +void rtl8168_asf_wd16rst(void __iomem *ioaddr, int arg, unsigned int *data) +{ + data[ASFWD16RST] = rtl8168_eri_read(ioaddr, WD16Rst, RW_TWO_BYTES, ERIAR_ASF); +} + +void rtl8168_asf_console_mac(struct rtl8168_private *tp, int arg, unsigned int *data) +{ + void __iomem *ioaddr=tp->mmio_addr; + int i; + + if (arg == ASF_GET) { + for (i = 0; i < 6; i++) + data[i] = rtl8168_eri_read(ioaddr, ConsoleMA + i, RW_ONE_BYTE, ERIAR_ASF); + } else if (arg == ASF_SET) { + for (i = 0; i < 6; i++) + rtl8168_eri_write(ioaddr, ConsoleMA + i, RW_ONE_BYTE, data[i], ERIAR_ASF); + + /* write the new console MAC address to EEPROM */ + rtl_eeprom_write_sc(tp, 70, (data[1] << 8) | data[0]); + rtl_eeprom_write_sc(tp, 71, (data[3] << 8) | data[2]); + rtl_eeprom_write_sc(tp, 72, (data[5] << 8) | data[4]); + } +} + +void rtl8168_asf_ip_address(struct rtl8168_private *tp, int arg, int offset, unsigned int *data) +{ + void __iomem *ioaddr=tp->mmio_addr; + int i; + int eeprom_off = 0; + + if (arg == ASF_GET) { + for (i = 0; i < 4; i++) + data[i] = rtl8168_eri_read(ioaddr, offset + i, RW_ONE_BYTE, ERIAR_ASF); + } else if (arg == ASF_SET) { + for (i = 0; i < 4; i++) + rtl8168_eri_write(ioaddr, offset + i, RW_ONE_BYTE, data[i], ERIAR_ASF); + + if (offset == ConsoleIP) + eeprom_off = 73; + else if (offset == IPAddr) + eeprom_off = 75; + + /* write the new IP address to EEPROM */ + rtl_eeprom_write_sc(tp, eeprom_off, (data[1] << 8) | data[0]); + rtl_eeprom_write_sc(tp, eeprom_off + 1, (data[3] << 8) | data[2]); + + } +} + +void rtl8168_asf_config_regs(void __iomem *ioaddr, int arg, int offset, unsigned int *data) +{ + unsigned int value; + + if (arg == ASF_GET) { + data[ASFCAPABILITY] = (rtl8168_eri_read(ioaddr, offset, RW_ONE_BYTE, ERIAR_ASF) & data[ASFCONFIG]) ? FUNCTION_ENABLE : FUNCTION_DISABLE; + } else if (arg == ASF_SET) { + value = rtl8168_eri_read(ioaddr, offset, RW_ONE_BYTE, ERIAR_ASF); + + if (data[ASFCAPABILITY] == FUNCTION_ENABLE) + value |= data[ASFCONFIG]; + else if (data[ASFCAPABILITY] == FUNCTION_DISABLE) + value &= ~data[ASFCONFIG]; + + rtl8168_eri_write(ioaddr, offset, RW_ONE_BYTE, value, ERIAR_ASF); + } +} + +void rtl8168_asf_capability_masks(void __iomem *ioaddr, int arg, int offset, unsigned int *data) +{ + unsigned int len, bit_mask; + + bit_mask = DISABLE_MASK; + + if (offset == FmCapMsk) { + /* System firmware capabilities */ + len = RW_FOUR_BYTES; + if (data[ASFCAPMASK] == FUNCTION_ENABLE) + bit_mask = FMW_CAP_MASK; + } else if (offset == SpCMDMsk) { + /* Special commands */ + len = RW_TWO_BYTES; + if (data[ASFCAPMASK] == FUNCTION_ENABLE) + bit_mask = SPC_CMD_MASK; + } else { + /* System capability (offset == SysCapMsk)*/ + len = RW_ONE_BYTE; + if (data[ASFCAPMASK] == FUNCTION_ENABLE) + bit_mask = SYS_CAP_MASK; + } + + if (arg == ASF_GET) + data[ASFCAPMASK] = rtl8168_eri_read(ioaddr, offset, len, ERIAR_ASF) ? FUNCTION_ENABLE : FUNCTION_DISABLE; + else /* arg == ASF_SET */ + rtl8168_eri_write(ioaddr, offset, len, bit_mask, ERIAR_ASF); +} + +void rtl8168_asf_community_string(void __iomem *ioaddr, int arg, char *string) +{ + int i; + + if (arg == ASF_GET) { + for (i = 0; i < COMMU_STR_MAX_LEN; i++) + string[i] = rtl8168_eri_read(ioaddr, Community + i, RW_ONE_BYTE, ERIAR_ASF); + } else { /* arg == ASF_SET */ + for (i = 0; i < COMMU_STR_MAX_LEN; i++) + rtl8168_eri_write(ioaddr, Community + i, RW_ONE_BYTE, string[i], ERIAR_ASF); + } +} + +void rtl8168_asf_community_string_len(void __iomem *ioaddr, int arg, unsigned int *data) +{ + if (arg == ASF_GET) + data[ASFCOMMULEN] = rtl8168_eri_read(ioaddr, StringLength, RW_ONE_BYTE, ERIAR_ASF); + else /* arg == ASF_SET */ + rtl8168_eri_write(ioaddr, StringLength, RW_ONE_BYTE, data[ASFCOMMULEN], ERIAR_ASF); +} + +void rtl8168_asf_time_period(void __iomem *ioaddr, int arg, int offset, unsigned int *data) +{ + int pos = 0; + + if (offset == WD8Rst) + pos = ASFWD8RESET; + else if (offset == LSnsrPollCycle) + pos = ASFLSNRPOLLCYC; + else if (offset == ASFSnsrPollPrd) + pos = ASFSNRPOLLCYC; + else if (offset == AlertReSendItvl) + pos = ASFALERTRESND; + + if (arg == ASF_GET) + data[pos] = rtl8168_eri_read(ioaddr, offset, RW_ONE_BYTE, ERIAR_ASF); + else /* arg == ASF_SET */ + rtl8168_eri_write(ioaddr, offset, RW_ONE_BYTE, data[pos], ERIAR_ASF); + +} + +void rtl8168_asf_key_access(struct rtl8168_private *tp, int arg, int offset, unsigned int *data) +{ + void __iomem *ioaddr=tp->mmio_addr; + int i, j; + int key_off = 0; + + if (arg == ASF_GET) { + for (i = 0; i < KEY_LEN; i++) + data[i] = rtl8168_eri_read(ioaddr, offset + KEY_LEN - (i + 1), RW_ONE_BYTE, ERIAR_ASF); + } else { + if (offset == KO) + key_off = 162; + else if (offset == KA) + key_off = 172; + else if (offset == KG) + key_off = 182; + else if (offset == KR) + key_off = 192; + + /* arg == ASF_SET */ + for (i = 0; i < KEY_LEN; i++) + rtl8168_eri_write(ioaddr, offset + KEY_LEN - (i + 1), RW_ONE_BYTE, data[i], ERIAR_ASF); + + /* write the new key to EEPROM */ + for (i = 0, j = 19; i < 10; i++, j = j - 2) + rtl_eeprom_write_sc(tp, key_off + i, (data[j - 1] << 8) | data[j]); + } +} + +void rtl8168_asf_rw_hexadecimal(void __iomem *ioaddr, int arg, int offset, int len, unsigned int *data) +{ + if (arg == ASF_GET) + data[ASFRWHEXNUM] = rtl8168_eri_read(ioaddr, offset, len, ERIAR_ASF); + else /* arg == ASF_SET */ + rtl8168_eri_write(ioaddr, offset, len, data[ASFRWHEXNUM], ERIAR_ASF); +} + +void rtl8168_asf_rw_systemid(void __iomem *ioaddr, int arg, unsigned int *data) +{ + int i; + + if (arg == ASF_GET) + for (i = 0; i < SYSID_LEN ; i++) + data[i] = rtl8168_eri_read(ioaddr, SysID + i, RW_ONE_BYTE, ERIAR_ASF); + else /* arg == ASF_SET */ + for (i = 0; i < SYSID_LEN ; i++) + rtl8168_eri_write(ioaddr, SysID + i, RW_ONE_BYTE, data[i], ERIAR_ASF); +} + +void rtl8168_asf_rw_iana(void __iomem *ioaddr, int arg, unsigned int *data) +{ + int i; + + if (arg == ASF_GET) + for (i = 0; i < RW_FOUR_BYTES; i++) + data[i] = rtl8168_eri_read(ioaddr, IANA + i, RW_ONE_BYTE, ERIAR_ASF); + else /* arg == ASF_SET */ + for (i = 0; i < RW_FOUR_BYTES; i++) + rtl8168_eri_write(ioaddr, IANA + i, RW_ONE_BYTE, data[i], ERIAR_ASF); +} + +void rtl8168_asf_rw_uuid(void __iomem *ioaddr, int arg, unsigned int *data) +{ + int i, j; + + if (arg == ASF_GET) + for (i = UUID_LEN - 1, j = 0; i >= 0 ; i--, j++) + data[j] = rtl8168_eri_read(ioaddr, UUID + i, RW_ONE_BYTE, ERIAR_ASF); + else /* arg == ASF_SET */ + for (i = UUID_LEN - 1, j = 0; i >= 0 ; i--, j++) + rtl8168_eri_write(ioaddr, UUID + i, RW_ONE_BYTE, data[j], ERIAR_ASF); +} diff --git a/drivers/net/ethernet/realtek/r8168_asf.h b/drivers/net/ethernet/realtek/r8168_asf.h new file mode 100755 index 0000000..e4097f2 --- /dev/null +++ b/drivers/net/ethernet/realtek/r8168_asf.h @@ -0,0 +1,294 @@ +/* +################################################################################ +# +# r8168 is the Linux device driver released for Realtek Gigabit Ethernet +# controllers with PCI-Express interface. +# +# Copyright(c) 2015 Realtek Semiconductor Corp. All rights reserved. +# +# This program is free software; you can redistribute it and/or modify it +# under the terms of the GNU General Public License as published by the Free +# Software Foundation; either version 2 of the License, or (at your option) +# any later version. +# +# This program is distributed in the hope that it will be useful, but WITHOUT +# ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or +# FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for +# more details. +# +# You should have received a copy of the GNU General Public License along with +# this program; if not, see . +# +# Author: +# Realtek NIC software team +# No. 2, Innovation Road II, Hsinchu Science Park, Hsinchu 300, Taiwan +# +################################################################################ +*/ + +/************************************************************************************ + * This product is covered by one or more of the following patents: + * US6,570,884, US6,115,776, and US6,327,625. + ***********************************************************************************/ + +#define SIOCDEVPRIVATE_RTLASF SIOCDEVPRIVATE + +#define FUNCTION_ENABLE 1 +#define FUNCTION_DISABLE 0 + +#define ASFCONFIG 0 +#define ASFCAPABILITY 1 +#define ASFCOMMULEN 0 +#define ASFHBPERIOD 0 +#define ASFWD16RST 0 +#define ASFCAPMASK 0 +#define ASFALERTRESND 0 +#define ASFLSNRPOLLCYC 0 +#define ASFSNRPOLLCYC 0 +#define ASFWD8RESET 0 +#define ASFRWHEXNUM 0 + +#define FMW_CAP_MASK 0x0000F867 +#define SPC_CMD_MASK 0x1F00 +#define SYS_CAP_MASK 0xFF +#define DISABLE_MASK 0x00 + +#define MAX_DATA_LEN 200 +#define MAX_STR_LEN 200 + +#define COMMU_STR_MAX_LEN 23 + +#define KEY_LEN 20 +#define UUID_LEN 16 +#define SYSID_LEN 2 + +#define RW_ONE_BYTE 1 +#define RW_TWO_BYTES 2 +#define RW_FOUR_BYTES 4 + +enum asf_registers { + HBPeriod = 0x0000, + WD8Rst = 0x0002, + WD8Timer = 0x0003, + WD16Rst = 0x0004, + LSnsrPollCycle = 0x0006, + ASFSnsrPollPrd = 0x0007, + AlertReSendCnt = 0x0008, + AlertReSendItvl = 0x0009, + SMBAddr = 0x000A, + SMBCap = 0x000B, + ASFConfigR0 = 0x000C, + ASFConfigR1 = 0x000D, + WD16Timer = 0x000E, + ConsoleMA = 0x0010, + ConsoleIP = 0x0016, + IPAddr = 0x001A, + + UUID = 0x0020, + IANA = 0x0030, + SysID = 0x0034, + Community = 0x0036, + StringLength = 0x004D, + LC = 0x004E, + EntityInst = 0x004F, + FmCapMsk = 0x0050, + SpCMDMsk = 0x0054, + SysCapMsk = 0x0056, + WDSysSt = 0x0057, + RxMsgType = 0x0058, + RxSpCMD = 0x0059, + RxSpCMDPa = 0x005A, + RxBtOpMsk = 0x005C, + RmtRstAddr = 0x005E, + RmtRstCmd = 0x005F, + RmtRstData = 0x0060, + RmtPwrOffAddr = 0x0061, + RmtPwrOffCmd = 0x0062, + RmtPwrOffData = 0x0063, + RmtPwrOnAddr = 0x0064, + RmtPwrOnCmd = 0x0065, + RmtPwrOnData = 0x0066, + RmtPCRAddr = 0x0067, + RmtPCRCmd = 0x0068, + RmtPCRData = 0x0069, + RMCP_IANA = 0x006A, + RMCP_OEM = 0x006E, + ASFSnsr0Addr = 0x0070, + + ASFSnsrEvSt = 0x0073, + ASFSnsrEvAlert = 0x0081, + + LSnsrNo = 0x00AD, + AssrtEvntMsk = 0x00AE, + DeAssrtEvntMsk = 0x00AF, + + LSnsrAddr0 = 0x00B0, + LAlertCMD0 = 0x00B1, + LAlertDataMsk0 = 0x00B2, + LAlertCmp0 = 0x00B3, + LAlertESnsrT0 = 0x00B4, + LAlertET0 = 0x00B5, + LAlertEOffset0 = 0x00B6, + LAlertES0 = 0x00B7, + LAlertSN0 = 0x00B8, + LAlertEntity0 = 0x00B9, + LAlertEI0 = 0x00BA, + LSnsrState0 = 0x00BB, + + LSnsrAddr1 = 0x00BD, + LAlertCMD1 = 0x00BE, + LAlertDataMsk1 = 0x00BF, + LAlertCmp1 = 0x00C0, + LAlertESnsrT1 = 0x00C1, + LAlertET1 = 0x00C2, + LAlertEOffset1 = 0x00C3, + LAlertES1 = 0x00C4, + LAlertSN1 = 0x00C5, + LAlertEntity1 = 0x00C6, + LAlertEI1 = 0x00C7, + LSnsrState1 = 0x00C8, + + LSnsrAddr2 = 0x00CA, + LAlertCMD2 = 0x00CB, + LAlertDataMsk2 = 0x00CC, + LAlertCmp2 = 0x00CD, + LAlertESnsrT2 = 0x00CE, + LAlertET2 = 0x00CF, + LAlertEOffset2 = 0x00D0, + LAlertES2 = 0x00D1, + LAlertSN2 = 0x00D2, + LAlertEntity2 = 0x00D3, + LAlertEI2 = 0x00D4, + LSnsrState2 = 0x00D5, + + LSnsrAddr3 = 0x00D7, + LAlertCMD3 = 0x00D8, + LAlertDataMsk3 = 0x00D9, + LAlertCmp3 = 0x00DA, + LAlertESnsrT3 = 0x00DB, + LAlertET3 = 0x00DC, + LAlertEOffset3 = 0x00DD, + LAlertES3 = 0x00DE, + LAlertSN3 = 0x00DF, + LAlertEntity3 = 0x00E0, + LAlertEI3 = 0x00E1, + LSnsrState3 = 0x00E2, + + LSnsrAddr4 = 0x00E4, + LAlertCMD4 = 0x00E5, + LAlertDataMsk4 = 0x00E6, + LAlertCmp4 = 0x00E7, + LAlertESnsrT4 = 0x00E8, + LAlertET4 = 0x00E9, + LAlertEOffset4 = 0x00EA, + LAlertES4 = 0x00EB, + LAlertSN4 = 0x00EC, + LAlertEntity4 = 0x00ED, + LAlertEI4 = 0x00EE, + LSnsrState4 = 0x00EF, + + LSnsrAddr5 = 0x00F1, + LAlertCMD5 = 0x00F2, + LAlertDataMsk5 = 0x00F3, + LAlertCmp5 = 0x00F4, + LAlertESnsrT5 = 0x00F5, + LAlertET5 = 0x00F6, + LAlertEOffset5 = 0x00F7, + LAlertES5 = 0x00F8, + LAlertSN5 = 0x00F9, + LAlertEntity5 = 0x00FA, + LAlertEI5 = 0x00FB, + LSnsrState5 = 0x00FC, + + LSnsrAddr6 = 0x00FE, + LAlertCMD6 = 0x00FF, + LAlertDataMsk6 = 0x0100, + LAlertCmp6 = 0x0101, + LAlertESnsrT6 = 0x0102, + LAlertET6 = 0x0103, + LAlertEOffset6 = 0x0104, + LAlertES6 = 0x0105, + LAlertSN6 = 0x0106, + LAlertEntity6 = 0x0107, + LAlertEI6 = 0x0108, + LSnsrState6 = 0x0109, + + LSnsrAddr7 = 0x010B, + LAlertCMD7 = 0x010C, + LAlertDataMsk7 = 0x010D, + LAlertCmp7 = 0x010E, + LAlertESnsrT7 = 0x010F, + LAlertET7 = 0x0110, + LAlertEOffset7 = 0x0111, + LAlertES7 = 0x0112, + LAlertSN7 = 0x0113, + LAlertEntity7 = 0x0114, + LAlertEI7 = 0x0115, + LSnsrState7 = 0x0116, + LAssert = 0x0117, + LDAssert = 0x0118, + IPServiceType = 0x0119, + IPIdfr = 0x011A, + FlagFOffset = 0x011C, + TTL = 0x011E, + HbtEI = 0x011F, + MgtConSID1 = 0x0120, + MgtConSID2 = 0x0124, + MgdCltSID = 0x0128, + StCd = 0x012C, + MgtConUR = 0x012D, + MgtConUNL = 0x012E, + + AuthPd = 0x0130, + IntyPd = 0x0138, + MgtConRN = 0x0140, + MgdCtlRN = 0x0150, + MgtConUN = 0x0160, + Rakp2IntCk = 0x0170, + KO = 0x017C, + KA = 0x0190, + KG = 0x01A4, + KR = 0x01B8, + CP = 0x01CC, + CQ = 0x01D0, + KC = 0x01D4, + ConsoleSid = 0x01E8, + + SIK1 = 0x01FC, + SIK2 = 0x0210, + Udpsrc_port = 0x0224, + Udpdes_port = 0x0226, + Asf_debug_mux = 0x0228 +}; + +enum asf_cmdln_opt { + ASF_GET, + ASF_SET, + ASF_HELP +}; + +struct asf_ioctl_struct { + unsigned int arg; + unsigned int offset; + union { + unsigned int data[MAX_DATA_LEN]; + char string[MAX_STR_LEN]; + } u; +}; + +int rtl8168_asf_ioctl(struct net_device *dev, struct ifreq *ifr); +void rtl8168_asf_hbperiod(void __iomem *ioaddr, int arg, unsigned int *data); +void rtl8168_asf_wd16rst(void __iomem *ioaddr, int arg, unsigned int *data); +void rtl8168_asf_console_mac(struct rtl8168_private *, int arg, unsigned int *data); +void rtl8168_asf_ip_address(struct rtl8168_private *, int arg, int offset, unsigned int *data); +void rtl8168_asf_config_regs(void __iomem *ioaddr, int arg, int offset, unsigned int *data); +void rtl8168_asf_capability_masks(void __iomem *ioaddr, int arg, int offset, unsigned int *data); +void rtl8168_asf_community_string(void __iomem *ioaddr, int arg, char *string); +void rtl8168_asf_community_string_len(void __iomem *ioaddr, int arg, unsigned int *data); +void rtl8168_asf_alert_resend_interval(void __iomem *ioaddr, int arg, unsigned int *data); +void rtl8168_asf_time_period(void __iomem *ioaddr, int arg, int offset, unsigned int *data); +void rtl8168_asf_key_access(struct rtl8168_private *, int arg, int offset, unsigned int *data); +void rtl8168_asf_rw_hexadecimal(void __iomem *ioaddr, int arg, int offset, int len, unsigned int *data); +void rtl8168_asf_rw_iana(void __iomem *ioaddr, int arg, unsigned int *data); +void rtl8168_asf_rw_uuid(void __iomem *ioaddr, int arg, unsigned int *data); +void rtl8168_asf_rw_systemid(void __iomem *ioaddr, int arg, unsigned int *data); diff --git a/drivers/net/ethernet/realtek/r8168_dash.h b/drivers/net/ethernet/realtek/r8168_dash.h new file mode 100755 index 0000000..19fac01 --- /dev/null +++ b/drivers/net/ethernet/realtek/r8168_dash.h @@ -0,0 +1,193 @@ +/* +################################################################################ +# +# r8168 is the Linux device driver released for Realtek Gigabit Ethernet +# controllers with PCI-Express interface. +# +# Copyright(c) 2015 Realtek Semiconductor Corp. All rights reserved. +# +# This program is free software; you can redistribute it and/or modify it +# under the terms of the GNU General Public License as published by the Free +# Software Foundation; either version 2 of the License, or (at your option) +# any later version. +# +# This program is distributed in the hope that it will be useful, but WITHOUT +# ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or +# FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for +# more details. +# +# You should have received a copy of the GNU General Public License along with +# this program; if not, see . +# +# Author: +# Realtek NIC software team +# No. 2, Innovation Road II, Hsinchu Science Park, Hsinchu 300, Taiwan +# +################################################################################ +*/ + +/************************************************************************************ + * This product is covered by one or more of the following patents: + * US6,570,884, US6,115,776, and US6,327,625. + ***********************************************************************************/ + +#ifndef _LINUX_R8168_DASH_H +#define _LINUX_R8168_DASH_H + +#define SIOCDEVPRIVATE_RTLDASH SIOCDEVPRIVATE+2 + +enum rtl_dash_cmd { + + RTL_DASH_ARP_NS_OFFLOAD=0, + RTL_DASH_SET_OOB_IPMAC, + RTL_DASH_NOTIFY_OOB, + + RTL_DASH_SEND_BUFFER_DATA_TO_DASH_FW, + RTL_DASH_CHECK_SEND_BUFFER_TO_DASH_FW_COMPLETE, + RTL_DASH_GET_RCV_FROM_FW_BUFFER_DATA, + + RTLT_DASH_COMMAND_INVALID +}; + +struct rtl_dash_ip_mac { + struct sockaddr ifru_addr; + struct sockaddr ifru_netmask; + struct sockaddr ifru_hwaddr; +}; + +struct rtl_dash_ioctl_struct { + __u32 cmd; + __u32 offset; + __u32 len; + union { + __u32 data; + void *data_buffer; + }; +}; + +typedef struct _RX_DASH_FROM_FW_DESC { + u16 length; + u8 statusLowByte; + u8 statusHighByte; + u32 resv; + u64 BufferAddress; +} +RX_DASH_FROM_FW_DESC, *PRX_DASH_FROM_FW_DESC; + +typedef struct _TX_DASH_SEND_FW_DESC { + u16 length; + u8 statusLowByte; + u8 statusHighByte; + u32 resv; + u64 BufferAddress; +} +TX_DASH_SEND_FW_DESC, *PTX_DASH_SEND_FW_DESC; + +typedef struct _OSOOBHdr { + u32 len; + u8 type; + u8 flag; + u8 hostReqV; + u8 res; +} +OSOOBHdr, *POSOOBHdr; + +typedef struct _RX_DASH_BUFFER_TYPE_2 { + OSOOBHdr oobhdr; + void *RxDataBuffer; +} +RX_DASH_BUFFER_TYPE_2, *PRX_DASH_BUFFER_TYPE_2; + +#define ALIGN_8 (0x7) +#define ALIGN_16 (0xf) +#define ALIGN_32 (0x1f) +#define ALIGN_64 (0x3f) +#define ALIGN_256 (0xff) +#define ALIGN_4096 (0xfff) + +#define OCP_REG_CONFIG0 (0x10) +#define OCP_REG_CONFIG0_REV_F (0xB8) +#define OCP_REG_DASH_POLL (0x30) +#define OCP_REG_HOST_REQ (0x34) +#define OCP_REG_DASH_REQ (0x35) +#define OCP_REG_CR (0x36) +#define OCP_REG_DMEMSTA (0x38) +#define OCP_REG_GPHYAR (0x60) + + +#define OCP_REG_CONFIG0_DASHEN BIT_15 +#define OCP_REG_CONFIG0_OOBRESET BIT_14 +#define OCP_REG_CONFIG0_APRDY BIT_13 +#define OCP_REG_CONFIG0_FIRMWARERDY BIT_12 +#define OCP_REG_CONFIG0_DRIVERRDY BIT_11 +#define OCP_REG_CONFIG0_OOB_WDT BIT_9 +#define OCP_REG_CONFIG0_DRV_WAIT_OOB BIT_8 +#define OCP_REG_CONFIG0_TLSEN BIT_7 + +#define HW_DASH_SUPPORT_DASH(_M) ((_M)->HwSuppDashVer > 0 ) +#define HW_DASH_SUPPORT_TYPE_1(_M) ((_M)->HwSuppDashVer == 1 ) +#define HW_DASH_SUPPORT_TYPE_2(_M) ((_M)->HwSuppDashVer == 2 ) + +#define RECV_FROM_FW_BUF_SIZE (1518) +#define SEND_TO_FW_BUF_SIZE (1518) + +#define RX_DASH_FROM_FW_OWN BIT_15 +#define TX_DASH_SEND_FW_OWN BIT_15 +#define TX_DASH_SEND_FW_OWN_HIGHBYTE BIT_7 + +#define TXS_CC3_0 (BIT_0|BIT_1|BIT_2|BIT_3) +#define TXS_EXC BIT_4 +#define TXS_LNKF BIT_5 +#define TXS_OWC BIT_6 +#define TXS_TES BIT_7 +#define TXS_UNF BIT_9 +#define TXS_LGSEN BIT_11 +#define TXS_LS BIT_12 +#define TXS_FS BIT_13 +#define TXS_EOR BIT_14 +#define TXS_OWN BIT_15 + +#define TPPool_HRDY 0x20 + +#define HostReqReg (0xC0) +#define SystemMasterDescStartAddrLow (0xF0) +#define SystemMasterDescStartAddrHigh (0xF4) +#define SystemSlaveDescStartAddrLow (0xF8) +#define SystemSlaveDescStartAddrHigh (0xFC) + +//DASH Request Type +#define WSMANREG 0x01 +#define OSPUSHDATA 0x02 + +#define RXS_OWN BIT_15 +#define RXS_EOR BIT_14 +#define RXS_FS BIT_13 +#define RXS_LS BIT_12 + +#define ISRIMR_DP_DASH_OK BIT_15 +#define ISRIMR_DP_HOST_OK BIT_13 +#define ISRIMR_DP_REQSYS_OK BIT_11 + +#define ISRIMR_DASH_INTR_EN BIT_12 +#define ISRIMR_DASH_INTR_CMAC_RESET BIT_15 + +#define ISRIMR_DASH_TYPE2_ROK BIT_0 +#define ISRIMR_DASH_TYPE2_RDU BIT_1 +#define ISRIMR_DASH_TYPE2_TOK BIT_2 +#define ISRIMR_DASH_TYPE2_TDU BIT_3 +#define ISRIMR_DASH_TYPE2_TX_FIFO_FULL BIT_4 +#define ISRIMR_DASH_TYPE2_TX_DISABLE_IDLE BIT_5 +#define ISRIMR_DASH_TYPE2_RX_DISABLE_IDLE BIT_6 + +#define CMAC_OOB_STOP 0x25 +#define CMAC_OOB_INIT 0x26 +#define CMAC_OOB_RESET 0x2a + +int rtl8168_dash_ioctl(struct net_device *dev, struct ifreq *ifr); +void HandleDashInterrupt(struct net_device *dev); +int AllocateDashShareMemory(struct net_device *dev); +void FreeAllocatedDashShareMemory(struct net_device *dev); +void DashHwInit(struct net_device *dev); + + +#endif /* _LINUX_R8168_DASH_H */ \ No newline at end of file diff --git a/drivers/net/ethernet/realtek/r8168_n.c b/drivers/net/ethernet/realtek/r8168_n.c new file mode 100755 index 0000000..8b08e63 --- /dev/null +++ b/drivers/net/ethernet/realtek/r8168_n.c @@ -0,0 +1,25364 @@ +/* +################################################################################ +# +# r8168 is the Linux device driver released for Realtek Gigabit Ethernet +# controllers with PCI-Express interface. +# +# Copyright(c) 2015 Realtek Semiconductor Corp. All rights reserved. +# +# This program is free software; you can redistribute it and/or modify it +# under the terms of the GNU General Public License as published by the Free +# Software Foundation; either version 2 of the License, or (at your option) +# any later version. +# +# This program is distributed in the hope that it will be useful, but WITHOUT +# ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or +# FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for +# more details. +# +# You should have received a copy of the GNU General Public License along with +# this program; if not, see . +# +# Author: +# Realtek NIC software team +# No. 2, Innovation Road II, Hsinchu Science Park, Hsinchu 300, Taiwan +# +################################################################################ +*/ + +/************************************************************************************ + * This product is covered by one or more of the following patents: + * US6,570,884, US6,115,776, and US6,327,625. + ***********************************************************************************/ + +/* + * This driver is modified from r8169.c in Linux kernel 2.6.18 + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,26) +#include +#endif +#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,4,37) +#include +#endif + +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,0) +#define dev_printk(A,B,fmt,args...) printk(A fmt,##args) +#else +#include +#include +#endif + +#include +#include +#include + +#include "r8168.h" +#include "r8168_asf.h" +#include "rtl_eeprom.h" +#include "rtltool.h" + +#ifdef ENABLE_R8168_PROCFS +#include +#include +#endif + +/* Maximum events (Rx packets, etc.) to handle at each interrupt. */ +static const int max_interrupt_work = 20; + +/* Maximum number of multicast addresses to filter (vs. Rx-all-multicast). + The RTL chips use a 64 element hash table based on the Ethernet CRC. */ +static const int multicast_filter_limit = 32; + +#define _R(NAME,MAC,RCR,MASK, JumFrameSz) \ + { .name = NAME, .mcfg = MAC, .RCR_Cfg = RCR, .RxConfigMask = MASK, .jumbo_frame_sz = JumFrameSz } + +static const struct { + const char *name; + u8 mcfg; + u32 RCR_Cfg; + u32 RxConfigMask; /* Clears the bits supported by this chip */ + u32 jumbo_frame_sz; +} rtl_chip_info[] = { + _R("RTL8168B/8111B", + CFG_METHOD_1, + (Reserved2_data << Reserved2_shift) | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e1880, + Jumbo_Frame_4k), + + _R("RTL8168B/8111B", + CFG_METHOD_2, + (Reserved2_data << Reserved2_shift) | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e1880, + Jumbo_Frame_4k), + + _R("RTL8168B/8111B", + CFG_METHOD_3, + (Reserved2_data << Reserved2_shift) | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e1880, + Jumbo_Frame_4k), + + _R("RTL8168C/8111C", + CFG_METHOD_4, + RxCfg_128_int_en | RxCfg_fet_multi_en | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e1880, + Jumbo_Frame_6k), + + _R("RTL8168C/8111C", + CFG_METHOD_5, + RxCfg_128_int_en | RxCfg_fet_multi_en | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e1880, + Jumbo_Frame_6k), + + _R("RTL8168C/8111C", + CFG_METHOD_6, + RxCfg_128_int_en | RxCfg_fet_multi_en | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e1880, + Jumbo_Frame_6k), + + _R("RTL8168CP/8111CP", + CFG_METHOD_7, + RxCfg_128_int_en | RxCfg_fet_multi_en | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e1880, + Jumbo_Frame_6k), + + _R("RTL8168CP/8111CP", + CFG_METHOD_8, + RxCfg_128_int_en | RxCfg_fet_multi_en | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e1880, + Jumbo_Frame_6k), + + _R("RTL8168D/8111D", + CFG_METHOD_9, + RxCfg_128_int_en | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e1880, + Jumbo_Frame_9k), + + _R("RTL8168D/8111D", + CFG_METHOD_10, + RxCfg_128_int_en | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e1880, + Jumbo_Frame_9k), + + _R("RTL8168DP/8111DP", + CFG_METHOD_11, + RxCfg_128_int_en | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e1880, + Jumbo_Frame_9k), + + _R("RTL8168DP/8111DP", + CFG_METHOD_12, + RxCfg_128_int_en | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e1880, + Jumbo_Frame_9k), + + _R("RTL8168DP/8111DP", + CFG_METHOD_13, + RxCfg_128_int_en | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e1880, + Jumbo_Frame_9k), + + _R("RTL8168E/8111E", + CFG_METHOD_14, + RxCfg_128_int_en | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e1880, + Jumbo_Frame_9k), + + _R("RTL8168E/8111E", + CFG_METHOD_15, + RxCfg_128_int_en | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e1880, + Jumbo_Frame_9k), + + _R("RTL8168E-VL/8111E-VL", + CFG_METHOD_16, + RxCfg_128_int_en | RxEarly_off_V1 | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e0080, + Jumbo_Frame_9k), + + _R("RTL8168E-VL/8111E-VL", + CFG_METHOD_17, + RxCfg_128_int_en | RxEarly_off_V1 | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e1880, + Jumbo_Frame_9k), + + _R("RTL8168F/8111F", + CFG_METHOD_18, + RxCfg_128_int_en | RxEarly_off_V1 | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e1880, + Jumbo_Frame_9k), + + _R("RTL8168F/8111F", + CFG_METHOD_19, + RxCfg_128_int_en | RxEarly_off_V1 | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e1880, + Jumbo_Frame_9k), + + _R("RTL8411", + CFG_METHOD_20, + RxCfg_128_int_en | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e1880, + Jumbo_Frame_9k), + + _R("RTL8168G/8111G", + CFG_METHOD_21, + RxCfg_128_int_en | RxEarly_off_V2 | Rx_Single_fetch_V2 | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e5880, + Jumbo_Frame_9k), + + _R("RTL8168G/8111G", + CFG_METHOD_22, + RxCfg_128_int_en | RxEarly_off_V2 | Rx_Single_fetch_V2 | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e5880, + Jumbo_Frame_9k), + + _R("RTL8168EP/8111EP", + CFG_METHOD_23, + RxCfg_128_int_en | RxEarly_off_V2 | Rx_Single_fetch_V2 | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e5880, + Jumbo_Frame_9k), + + _R("RTL8168GU/8111GU", + CFG_METHOD_24, + RxCfg_128_int_en | RxEarly_off_V2 | Rx_Single_fetch_V2 | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e5880, + Jumbo_Frame_9k), + + _R("RTL8168GU/8111GU", + CFG_METHOD_25, + RxCfg_128_int_en | RxEarly_off_V2 | Rx_Single_fetch_V2 | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e5880, + Jumbo_Frame_9k), + + _R("8411B", + CFG_METHOD_26, + RxCfg_128_int_en | RxEarly_off_V2 | Rx_Single_fetch_V2 | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e5880, + Jumbo_Frame_9k), + + _R("RTL8168EP/8111EP", + CFG_METHOD_27, + RxCfg_128_int_en | RxEarly_off_V2 | Rx_Single_fetch_V2 | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e5880, + Jumbo_Frame_9k), + + _R("RTL8168EP/8111EP", + CFG_METHOD_28, + RxCfg_128_int_en | RxEarly_off_V2 | Rx_Single_fetch_V2 | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e5880, + Jumbo_Frame_9k), + + _R("RTL8168H/8111H", + CFG_METHOD_29, + RxCfg_128_int_en | RxEarly_off_V2 | Rx_Single_fetch_V2 | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e5880, + Jumbo_Frame_9k), + + _R("RTL8168H/8111H", + CFG_METHOD_30, + RxCfg_128_int_en | RxEarly_off_V2 | Rx_Single_fetch_V2 | (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e5880, + Jumbo_Frame_9k), + + _R("Unknown", + CFG_METHOD_DEFAULT, + (RX_DMA_BURST << RxCfgDMAShift), + 0xff7e5880, + RX_BUF_SIZE) +}; +#undef _R + +#ifndef PCI_VENDOR_ID_DLINK +#define PCI_VENDOR_ID_DLINK 0x1186 +#endif + +static struct pci_device_id rtl8168_pci_tbl[] = { + { PCI_DEVICE(PCI_VENDOR_ID_REALTEK, 0x8168), }, + { PCI_VENDOR_ID_DLINK, 0x4300, 0x1186, 0x4b10,}, + {0,}, +}; + +MODULE_DEVICE_TABLE(pci, rtl8168_pci_tbl); + +static int rx_copybreak = 200; +static int timer_count = 0x2600; + +static struct { + u32 msg_enable; +} debug = { -1 }; + +static unsigned short speed = SPEED_1000; +static int duplex = DUPLEX_FULL; +static int autoneg = AUTONEG_ENABLE; +#ifdef CONFIG_ASPM +static int aspm = 1; +#else +static int aspm = 0; +#endif +#ifdef ENABLE_S5WOL +static int s5wol = 1; +#else +static int s5wol = 0; +#endif +#ifdef ENABLE_EEE +static int eee_enable = 1; +#else +static int eee_enable = 0; +#endif +static ulong hwoptimize = 0; + +MODULE_AUTHOR("Realtek and the Linux r8168 crew "); +MODULE_DESCRIPTION("RealTek RTL-8168 Gigabit Ethernet driver"); + +module_param(speed, ushort, 0); +MODULE_PARM_DESC(speed, "force phy operation. Deprecated by ethtool (8)."); + +module_param(duplex, int, 0); +MODULE_PARM_DESC(duplex, "force phy operation. Deprecated by ethtool (8)."); + +module_param(autoneg, int, 0); +MODULE_PARM_DESC(autoneg, "force phy operation. Deprecated by ethtool (8)."); + +module_param(aspm, int, 0); +MODULE_PARM_DESC(aspm, "Enable ASPM."); + +module_param(s5wol, int, 0); +MODULE_PARM_DESC(s5wol, "Enable Shutdown Wake On Lan."); + +module_param(rx_copybreak, int, 0); +MODULE_PARM_DESC(rx_copybreak, "Copy breakpoint for copy-only-tiny-frames"); + +module_param(timer_count, int, 0); +MODULE_PARM_DESC(timer_count, "Timer Interrupt Interval."); + +module_param(eee_enable, int, 0); +MODULE_PARM_DESC(eee_enable, "Enable Energy Efficient Ethernet."); + +module_param(hwoptimize, ulong, 0); +MODULE_PARM_DESC(hwoptimize, "Enable HW optimization function."); + +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) +module_param_named(debug, debug.msg_enable, int, 0); +MODULE_PARM_DESC(debug, "Debug verbosity level (0=none, ..., 16=all)"); +#endif//LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + +MODULE_LICENSE("GPL"); + +MODULE_VERSION(RTL8168_VERSION); + +static void rtl8168_sleep_rx_enable(struct net_device *dev); +static void rtl8168_dsm(struct net_device *dev, int dev_state); + +static void rtl8168_esd_timer(unsigned long __opaque); +static void rtl8168_link_timer(unsigned long __opaque); +static void rtl8168_tx_clear(struct rtl8168_private *tp); +static void rtl8168_rx_clear(struct rtl8168_private *tp); + +static int rtl8168_open(struct net_device *dev); +static int rtl8168_start_xmit(struct sk_buff *skb, struct net_device *dev); +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,19) +static irqreturn_t rtl8168_interrupt(int irq, void *dev_instance, struct pt_regs *regs); +#else +static irqreturn_t rtl8168_interrupt(int irq, void *dev_instance); +#endif +static void rtl8168_rx_desc_offset0_init(struct rtl8168_private *, int); +static int rtl8168_init_ring(struct net_device *dev); +static void rtl8168_hw_config(struct net_device *dev); +static void rtl8168_hw_start(struct net_device *dev); +static int rtl8168_close(struct net_device *dev); +static void rtl8168_set_rx_mode(struct net_device *dev); +static void rtl8168_tx_timeout(struct net_device *dev); +static struct net_device_stats *rtl8168_get_stats(struct net_device *dev); +static int rtl8168_rx_interrupt(struct net_device *, struct rtl8168_private *, void __iomem *, u32 budget); +static int rtl8168_change_mtu(struct net_device *dev, int new_mtu); +static void rtl8168_down(struct net_device *dev); + +static int rtl8168_set_mac_address(struct net_device *dev, void *p); +void rtl8168_rar_set(struct rtl8168_private *tp, uint8_t *addr); +static void rtl8168_desc_addr_fill(struct rtl8168_private *); +static void rtl8168_tx_desc_init(struct rtl8168_private *tp); +static void rtl8168_rx_desc_init(struct rtl8168_private *tp); + +static void rtl8168_hw_reset(struct net_device *dev); + +static void rtl8168_phy_power_up(struct net_device *dev); +static void rtl8168_phy_power_down(struct net_device *dev); +static int rtl8168_set_speed(struct net_device *dev, u8 autoneg, u16 speed, u8 duplex); + +#ifdef CONFIG_R8168_NAPI +static int rtl8168_poll(napi_ptr napi, napi_budget budget); +#endif + +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,0) +#undef ethtool_ops +#define ethtool_ops _kc_ethtool_ops + +struct _kc_ethtool_ops { + int (*get_settings)(struct net_device *, struct ethtool_cmd *); + int (*set_settings)(struct net_device *, struct ethtool_cmd *); + void (*get_drvinfo)(struct net_device *, struct ethtool_drvinfo *); + int (*get_regs_len)(struct net_device *); + void (*get_regs)(struct net_device *, struct ethtool_regs *, void *); + void (*get_wol)(struct net_device *, struct ethtool_wolinfo *); + int (*set_wol)(struct net_device *, struct ethtool_wolinfo *); + u32 (*get_msglevel)(struct net_device *); + void (*set_msglevel)(struct net_device *, u32); + int (*nway_reset)(struct net_device *); + u32 (*get_link)(struct net_device *); + int (*get_eeprom_len)(struct net_device *); + int (*get_eeprom)(struct net_device *, struct ethtool_eeprom *, u8 *); + int (*set_eeprom)(struct net_device *, struct ethtool_eeprom *, u8 *); + int (*get_coalesce)(struct net_device *, struct ethtool_coalesce *); + int (*set_coalesce)(struct net_device *, struct ethtool_coalesce *); + void (*get_ringparam)(struct net_device *, struct ethtool_ringparam *); + int (*set_ringparam)(struct net_device *, struct ethtool_ringparam *); + void (*get_pauseparam)(struct net_device *, + struct ethtool_pauseparam*); + int (*set_pauseparam)(struct net_device *, + struct ethtool_pauseparam*); + u32 (*get_rx_csum)(struct net_device *); + int (*set_rx_csum)(struct net_device *, u32); + u32 (*get_tx_csum)(struct net_device *); + int (*set_tx_csum)(struct net_device *, u32); + u32 (*get_sg)(struct net_device *); + int (*set_sg)(struct net_device *, u32); + u32 (*get_tso)(struct net_device *); + int (*set_tso)(struct net_device *, u32); + int (*self_test_count)(struct net_device *); + void (*self_test)(struct net_device *, struct ethtool_test *, u64 *); + void (*get_strings)(struct net_device *, u32 stringset, u8 *); + int (*phys_id)(struct net_device *, u32); + int (*get_stats_count)(struct net_device *); + void (*get_ethtool_stats)(struct net_device *, struct ethtool_stats *, + u64 *); +} *ethtool_ops = NULL; + +#undef SET_ETHTOOL_OPS +#define SET_ETHTOOL_OPS(netdev, ops) (ethtool_ops = (ops)) + +#endif //LINUX_VERSION_CODE < KERNEL_VERSION(2,6,0) + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,16,0) +#ifndef SET_ETHTOOL_OPS +#define SET_ETHTOOL_OPS(netdev,ops) \ + ( (netdev)->ethtool_ops = (ops) ) +#endif //SET_ETHTOOL_OPS +#endif //LINUX_VERSION_CODE >= KERNEL_VERSION(3,16,0) + +//#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,5) +#ifndef netif_msg_init +#define netif_msg_init _kc_netif_msg_init +/* copied from linux kernel 2.6.20 include/linux/netdevice.h */ +static inline u32 netif_msg_init(int debug_value, int default_msg_enable_bits) +{ + /* use default */ + if (debug_value < 0 || debug_value >= (sizeof(u32) * 8)) + return default_msg_enable_bits; + if (debug_value == 0) /* no output */ + return 0; + /* set low N bits */ + return (1 << debug_value) - 1; +} + +#endif //LINUX_VERSION_CODE < KERNEL_VERSION(2,6,5) + +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,22) +static inline void eth_copy_and_sum (struct sk_buff *dest, + const unsigned char *src, + int len, int base) +{ + memcpy (dest->data, src, len); +} +#endif //LINUX_VERSION_CODE > KERNEL_VERSION(2,6,22) + +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,7) +/* copied from linux kernel 2.6.20 /include/linux/time.h */ +/* Parameters used to convert the timespec values: */ +#define MSEC_PER_SEC 1000L + +/* copied from linux kernel 2.6.20 /include/linux/jiffies.h */ +/* + * Change timeval to jiffies, trying to avoid the + * most obvious overflows.. + * + * And some not so obvious. + * + * Note that we don't want to return MAX_LONG, because + * for various timeout reasons we often end up having + * to wait "jiffies+1" in order to guarantee that we wait + * at _least_ "jiffies" - so "jiffies+1" had better still + * be positive. + */ +#define MAX_JIFFY_OFFSET ((~0UL >> 1)-1) + +/* + * Convert jiffies to milliseconds and back. + * + * Avoid unnecessary multiplications/divisions in the + * two most common HZ cases: + */ +static inline unsigned int _kc_jiffies_to_msecs(const unsigned long j) +{ +#if HZ <= MSEC_PER_SEC && !(MSEC_PER_SEC % HZ) + return (MSEC_PER_SEC / HZ) * j; +#elif HZ > MSEC_PER_SEC && !(HZ % MSEC_PER_SEC) + return (j + (HZ / MSEC_PER_SEC) - 1)/(HZ / MSEC_PER_SEC); +#else + return (j * MSEC_PER_SEC) / HZ; +#endif +} + +static inline unsigned long _kc_msecs_to_jiffies(const unsigned int m) +{ + if (m > _kc_jiffies_to_msecs(MAX_JIFFY_OFFSET)) + return MAX_JIFFY_OFFSET; +#if HZ <= MSEC_PER_SEC && !(MSEC_PER_SEC % HZ) + return (m + (MSEC_PER_SEC / HZ) - 1) / (MSEC_PER_SEC / HZ); +#elif HZ > MSEC_PER_SEC && !(HZ % MSEC_PER_SEC) + return m * (HZ / MSEC_PER_SEC); +#else + return (m * HZ + MSEC_PER_SEC - 1) / MSEC_PER_SEC; +#endif +} +#endif //LINUX_VERSION_CODE < KERNEL_VERSION(2,6,7) + + +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,11) + +/* copied from linux kernel 2.6.12.6 /include/linux/pm.h */ +typedef int __bitwise pci_power_t; + +/* copied from linux kernel 2.6.12.6 /include/linux/pci.h */ +typedef u32 __bitwise pm_message_t; + +#define PCI_D0 ((pci_power_t __force) 0) +#define PCI_D1 ((pci_power_t __force) 1) +#define PCI_D2 ((pci_power_t __force) 2) +#define PCI_D3hot ((pci_power_t __force) 3) +#define PCI_D3cold ((pci_power_t __force) 4) +#define PCI_POWER_ERROR ((pci_power_t __force) -1) + +/* copied from linux kernel 2.6.12.6 /drivers/pci/pci.c */ +/** + * pci_choose_state - Choose the power state of a PCI device + * @dev: PCI device to be suspended + * @state: target sleep state for the whole system. This is the value + * that is passed to suspend() function. + * + * Returns PCI power state suitable for given device and given system + * message. + */ + +pci_power_t pci_choose_state(struct pci_dev *dev, pm_message_t state) +{ + if (!pci_find_capability(dev, PCI_CAP_ID_PM)) + return PCI_D0; + + switch (state) { + case 0: + return PCI_D0; + case 3: + return PCI_D3hot; + default: + printk("They asked me for state %d\n", state); +// BUG(); + } + return PCI_D0; +} +#endif //LINUX_VERSION_CODE < KERNEL_VERSION(2,6,11) + +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,9) +/** + * msleep_interruptible - sleep waiting for waitqueue interruptions + * @msecs: Time in milliseconds to sleep for + */ +#define msleep_interruptible _kc_msleep_interruptible +unsigned long _kc_msleep_interruptible(unsigned int msecs) +{ + unsigned long timeout = _kc_msecs_to_jiffies(msecs); + + while (timeout && !signal_pending(current)) { + set_current_state(TASK_INTERRUPTIBLE); + timeout = schedule_timeout(timeout); + } + return _kc_jiffies_to_msecs(timeout); +} +#endif //LINUX_VERSION_CODE < KERNEL_VERSION(2,6,9) + +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,7) +/* copied from linux kernel 2.6.20 include/linux/sched.h */ +#ifndef __sched +#define __sched __attribute__((__section__(".sched.text"))) +#endif + +/* copied from linux kernel 2.6.20 kernel/timer.c */ +signed long __sched schedule_timeout_uninterruptible(signed long timeout) +{ + __set_current_state(TASK_UNINTERRUPTIBLE); + return schedule_timeout(timeout); +} + +/* copied from linux kernel 2.6.20 include/linux/mii.h */ +#undef if_mii +#define if_mii _kc_if_mii +static inline struct mii_ioctl_data *if_mii(struct ifreq *rq) +{ + return (struct mii_ioctl_data *) &rq->ifr_ifru; +} +#endif //LINUX_VERSION_CODE < KERNEL_VERSION(2,6,7) + +static const char rtl8168_gstrings[][ETH_GSTRING_LEN] = { + "tx_packets", + "rx_packets", + "tx_errors", + "rx_errors", + "rx_missed", + "align_errors", + "tx_single_collisions", + "tx_multi_collisions", + "unicast", + "broadcast", + "multicast", + "tx_aborted", + "tx_underrun", +}; + +struct rtl8168_counters { + u64 tx_packets; + u64 rx_packets; + u64 tx_errors; + u32 rx_errors; + u16 rx_missed; + u16 align_errors; + u32 tx_one_collision; + u32 tx_multi_collision; + u64 rx_unicast; + u64 rx_broadcast; + u32 rx_multicast; + u16 tx_aborted; + u16 tx_underun; +}; + +#ifdef ENABLE_R8168_PROCFS +/**************************************************************************** +* -----------------------------PROCFS STUFF------------------------- +***************************************************************************** +*/ + +static struct proc_dir_entry *rtl8168_proc; +static int proc_init_num = 0; + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,10,0) +static int proc_get_driver_variable(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + struct rtl8168_private *tp = netdev_priv(dev); + unsigned long flags; + + seq_puts(m, "\nDump Driver Variable\n"); + + spin_lock_irqsave(&tp->lock, flags); + seq_puts(m, "Variable\tValue\n----------\t-----\n"); + seq_printf(m, "MODULENAME\t%s\n", MODULENAME); + seq_printf(m, "driver version\t%s\n", RTL8168_VERSION); + seq_printf(m, "chipset\t%d\n", tp->chipset); + seq_printf(m, "chipset_name\t%s\n", rtl_chip_info[tp->chipset].name); + seq_printf(m, "mtu\t%d\n", dev->mtu); + seq_printf(m, "NUM_RX_DESC\t0x%x\n", NUM_RX_DESC); + seq_printf(m, "cur_rx\t0x%x\n", tp->cur_rx); + seq_printf(m, "dirty_rx\t0x%x\n", tp->dirty_rx); + seq_printf(m, "NUM_TX_DESC\t0x%x\n", NUM_TX_DESC); + seq_printf(m, "cur_tx\t0x%x\n", tp->cur_tx); + seq_printf(m, "dirty_tx\t0x%x\n", tp->dirty_tx); + seq_printf(m, "rx_buf_sz\t0x%x\n", tp->rx_buf_sz); + seq_printf(m, "esd_flag\t0x%x\n", tp->esd_flag); + seq_printf(m, "pci_cfg_is_read\t0x%x\n", tp->pci_cfg_is_read); + seq_printf(m, "rtl8168_rx_config\t0x%x\n", tp->rtl8168_rx_config); + seq_printf(m, "cp_cmd\t0x%x\n", tp->cp_cmd); + seq_printf(m, "intr_mask\t0x%x\n", tp->intr_mask); + seq_printf(m, "timer_intr_mask\t0x%x\n", tp->timer_intr_mask); + seq_printf(m, "wol_enabled\t0x%x\n", tp->wol_enabled); + seq_printf(m, "wol_opts\t0x%x\n", tp->wol_opts); + seq_printf(m, "efuse_ver\t0x%x\n", tp->efuse_ver); + seq_printf(m, "eeprom_type\t0x%x\n", tp->eeprom_type); + seq_printf(m, "autoneg\t0x%x\n", tp->autoneg); + seq_printf(m, "duplex\t0x%x\n", tp->duplex); + seq_printf(m, "speed\t%d\n", tp->speed); + seq_printf(m, "eeprom_len\t0x%x\n", tp->eeprom_len); + seq_printf(m, "cur_page\t0x%x\n", tp->cur_page); + seq_printf(m, "bios_setting\t0x%x\n", tp->bios_setting); + seq_printf(m, "features\t0x%x\n", tp->features); + seq_printf(m, "org_pci_offset_99\t0x%x\n", tp->org_pci_offset_99); + seq_printf(m, "org_pci_offset_180\t0x%x\n", tp->org_pci_offset_180); + seq_printf(m, "issue_offset_99_event\t0x%x\n", tp->issue_offset_99_event); + seq_printf(m, "org_pci_offset_80\t0x%x\n", tp->org_pci_offset_80); + seq_printf(m, "org_pci_offset_81\t0x%x\n", tp->org_pci_offset_81); + seq_printf(m, "use_timer_interrrupt\t0x%x\n", tp->use_timer_interrrupt); + seq_printf(m, "HwIcVerUnknown\t0x%x\n", tp->HwIcVerUnknown); + seq_printf(m, "NotWrRamCodeToMicroP\t0x%x\n", tp->NotWrRamCodeToMicroP); + seq_printf(m, "NotWrMcuPatchCode\t0x%x\n", tp->NotWrMcuPatchCode); + seq_printf(m, "HwHasWrRamCodeToMicroP\t0x%x\n", tp->HwHasWrRamCodeToMicroP); + seq_printf(m, "sw_ram_code_ver\t0x%x\n", tp->sw_ram_code_ver); + seq_printf(m, "hw_ram_code_ver\t0x%x\n", tp->hw_ram_code_ver); + seq_printf(m, "rtk_enable_diag\t0x%x\n", tp->rtk_enable_diag); + seq_printf(m, "ShortPacketSwChecksum\t0x%x\n", tp->ShortPacketSwChecksum); + seq_printf(m, "UseSwPaddingShortPkt\t0x%x\n", tp->UseSwPaddingShortPkt); + seq_printf(m, "RequireAdcBiasPatch\t0x%x\n", tp->RequireAdcBiasPatch); + seq_printf(m, "AdcBiasPatchIoffset\t0x%x\n", tp->AdcBiasPatchIoffset); + seq_printf(m, "RequireAdjustUpsTxLinkPulseTiming\t0x%x\n", tp->RequireAdjustUpsTxLinkPulseTiming); + seq_printf(m, "SwrCnt1msIni\t0x%x\n", tp->SwrCnt1msIni); + seq_printf(m, "HwSuppNowIsOobVer\t0x%x\n", tp->HwSuppNowIsOobVer); + seq_printf(m, "RequiredSecLanDonglePatch\t0x%x\n", tp->RequiredSecLanDonglePatch); + seq_printf(m, "HwSuppDashVer\t0x%x\n", tp->HwSuppDashVer); + seq_printf(m, "DASH\t0x%x\n", tp->DASH); + seq_printf(m, "HwSuppKCPOffloadVer\t0x%x\n", tp->HwSuppKCPOffloadVer); + spin_unlock_irqrestore(&tp->lock, flags); + + seq_putc(m, '\n'); + return 0; +} + +static int proc_get_tally_counter(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + struct rtl8168_counters *counters; + dma_addr_t paddr; + u32 cmd; + u32 WaitCnt; + unsigned long flags; + + seq_puts(m, "\nDump Tally Counter\n"); + + ASSERT_RTNL(); + + counters = tp->tally_vaddr; + paddr = tp->tally_paddr; + if (!counters) { + seq_puts(m, "\nDump Tally Counter Fail\n"); + return 0; + } + + spin_lock_irqsave(&tp->lock, flags); + RTL_W32(CounterAddrHigh, (u64)paddr >> 32); + cmd = (u64)paddr & DMA_BIT_MASK(32); + RTL_W32(CounterAddrLow, cmd); + RTL_W32(CounterAddrLow, cmd | CounterDump); + + WaitCnt = 0; + while (RTL_R32(CounterAddrLow) & CounterDump) { + udelay(10); + + WaitCnt++; + if (WaitCnt > 20) + break; + } + spin_unlock_irqrestore(&tp->lock, flags); + + seq_puts(m, "Statistics\tValue\n----------\t-----\n"); + seq_printf(m, "tx_packets\t%lld\n", le64_to_cpu(counters->tx_packets)); + seq_printf(m, "rx_packets\t%lld\n", le64_to_cpu(counters->rx_packets)); + seq_printf(m, "tx_errors\t%lld\n", le64_to_cpu(counters->tx_errors)); + seq_printf(m, "rx_missed\t%lld\n", le64_to_cpu(counters->rx_missed)); + seq_printf(m, "align_errors\t%lld\n", le64_to_cpu(counters->align_errors)); + seq_printf(m, "tx_one_collision\t%lld\n", le64_to_cpu(counters->tx_one_collision)); + seq_printf(m, "tx_multi_collision\t%lld\n", le64_to_cpu(counters->tx_multi_collision)); + seq_printf(m, "rx_unicast\t%lld\n", le64_to_cpu(counters->rx_unicast)); + seq_printf(m, "rx_broadcast\t%lld\n", le64_to_cpu(counters->rx_broadcast)); + seq_printf(m, "rx_multicast\t%lld\n", le64_to_cpu(counters->rx_multicast)); + seq_printf(m, "tx_aborted\t%lld\n", le64_to_cpu(counters->tx_aborted)); + seq_printf(m, "tx_underun\t%lld\n", le64_to_cpu(counters->tx_underun)); + + seq_putc(m, '\n'); + return 0; +} + +static int proc_get_registers(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + int i, n, max = R8168_MAC_REGS_SIZE; + u8 byte_rd; + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + unsigned long flags; + + seq_puts(m, "\nDump MAC Registers\n"); + seq_puts(m, "Offset\tValue\n------\t-----\n"); + + spin_lock_irqsave(&tp->lock, flags); + for (n = 0; n < max;) { + seq_printf(m, "\n0x%02x:\t", n); + + for (i = 0; i < 16 && n < max; i++, n++) { + byte_rd = readb(ioaddr + n); + seq_printf(m, "%02x ", byte_rd); + } + } + spin_unlock_irqrestore(&tp->lock, flags); + + seq_putc(m, '\n'); + return 0; +} + +static int proc_get_pcie_phy(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + int i, n, max = R8168_EPHY_REGS_SIZE/2; + u16 word_rd; + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + unsigned long flags; + + seq_puts(m, "\nDump PCIE PHY\n"); + seq_puts(m, "\nOffset\tValue\n------\t-----\n "); + + spin_lock_irqsave(&tp->lock, flags); + for (n = 0; n < max;) { + seq_printf(m, "\n0x%02x:\t", n); + + for (i = 0; i < 8 && n < max; i++, n++) { + word_rd = rtl8168_ephy_read(ioaddr, n); + seq_printf(m, "%04x ", word_rd); + } + } + spin_unlock_irqrestore(&tp->lock, flags); + + seq_putc(m, '\n'); + return 0; +} + +static int proc_get_eth_phy(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + int i, n, max = R8168_PHY_REGS_SIZE/2; + u16 word_rd; + struct rtl8168_private *tp = netdev_priv(dev); + unsigned long flags; + + seq_puts(m, "\nDump Ethernet PHY\n"); + seq_puts(m, "\nOffset\tValue\n------\t-----\n "); + + spin_lock_irqsave(&tp->lock, flags); + seq_puts(m, "\n####################page 0##################\n "); + mdio_write(tp, 0x1f, 0x0000); + for (n = 0; n < max;) { + seq_printf(m, "\n0x%02x:\t", n); + + for (i = 0; i < 8 && n < max; i++, n++) { + word_rd = mdio_read(tp, n); + seq_printf(m, "%04x ", word_rd); + } + } + spin_unlock_irqrestore(&tp->lock, flags); + + seq_putc(m, '\n'); + return 0; +} + +static int proc_get_extended_registers(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + int i, n, max = R8168_ERI_REGS_SIZE; + u32 dword_rd; + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + unsigned long flags; + + switch (tp->mcfg) { + case CFG_METHOD_1: + case CFG_METHOD_2: + case CFG_METHOD_3: + /* RTL8168B does not support Extend GMAC */ + seq_puts(m, "\nNot Support Dump Extended Registers\n"); + return 0; + } + + seq_puts(m, "\nDump Extended Registers\n"); + seq_puts(m, "\nOffset\tValue\n------\t-----\n "); + + spin_lock_irqsave(&tp->lock, flags); + for (n = 0; n < max;) { + seq_printf(m, "\n0x%02x:\t", n); + + for (i = 0; i < 4 && n < max; i++, n+=4) { + dword_rd = rtl8168_eri_read(ioaddr, n, 4, ERIAR_ExGMAC); + seq_printf(m, "%08x ", dword_rd); + } + } + spin_unlock_irqrestore(&tp->lock, flags); + + seq_putc(m, '\n'); + return 0; +} +#else + +static int proc_get_driver_variable(char *page, char **start, + off_t offset, int count, + int *eof, void *data) +{ + struct net_device *dev = data; + struct rtl8168_private *tp = netdev_priv(dev); + unsigned long flags; + int len = 0; + + len += snprintf(page + len, count - len, + "\nDump Driver Driver\n"); + + spin_lock_irqsave(&tp->lock, flags); + len += snprintf(page + len, count - len, + "Variable\tValue\n----------\t-----\n"); + + len += snprintf(page + len, count - len, + "MODULENAME\t%s\n" + "driver version\t%s\n" + "chipset\t%d\n" + "chipset_name\t%s\n" + "mtu\t%d\n" + "NUM_RX_DESC\t0x%x\n" + "cur_rx\t0x%x\n" + "dirty_rx\t0x%x\n" + "NUM_TX_DESC\t0x%x\n" + "cur_tx\t0x%x\n" + "dirty_tx\t0x%x\n" + "rx_buf_sz\t0x%x\n" + "esd_flag\t0x%x\n" + "pci_cfg_is_read\t0x%x\n" + "rtl8168_rx_config\t0x%x\n" + "cp_cmd\t0x%x\n" + "intr_mask\t0x%x\n" + "timer_intr_mask\t0x%x\n" + "wol_enabled\t0x%x\n" + "wol_opts\t0x%x\n" + "efuse_ver\t0x%x\n" + "eeprom_type\t0x%x\n" + "autoneg\t0x%x\n" + "duplex\t0x%x\n" + "speed\t%d\n" + "eeprom_len\t0x%x\n" + "cur_page\t0x%x\n" + "bios_setting\t0x%x\n" + "features\t0x%x\n" + "org_pci_offset_99\t0x%x\n" + "org_pci_offset_180\t0x%x\n" + "issue_offset_99_event\t0x%x\n" + "org_pci_offset_80\t0x%x\n" + "org_pci_offset_81\t0x%x\n" + "use_timer_interrrupt\t0x%x\n" + "HwIcVerUnknown\t0x%x\n" + "NotWrRamCodeToMicroP\t0x%x\n" + "NotWrMcuPatchCode\t0x%x\n" + "HwHasWrRamCodeToMicroP\t0x%x\n" + "sw_ram_code_ver\t0x%x\n" + "hw_ram_code_ver\t0x%x\n" + "rtk_enable_diag\t0x%x\n" + "ShortPacketSwChecksum\t0x%x\n" + "UseSwPaddingShortPkt\t0x%x\n" + "RequireAdcBiasPatch\t0x%x\n" + "AdcBiasPatchIoffset\t0x%x\n" + "RequireAdjustUpsTxLinkPulseTiming\t0x%x\n" + "SwrCnt1msIni\t0x%x\n" + "HwSuppNowIsOobVer\t0x%x\n" + "RequiredSecLanDonglePatch\t0x%x\n" + "HwSuppDashVer\t0x%x\n" + "DASH\t0x%x\n" + "HwSuppKCPOffloadVer\t0x%x\n", + MODULENAME, + RTL8168_VERSION, + tp->chipset, + rtl_chip_info[tp->chipset].name, + dev->mtu, + NUM_RX_DESC, + tp->cur_rx, + tp->dirty_rx, + NUM_TX_DESC, + tp->cur_tx, + tp->dirty_tx, + tp->rx_buf_sz, + tp->esd_flag, + tp->pci_cfg_is_read, + tp->rtl8168_rx_config, + tp->cp_cmd, + tp->intr_mask, + tp->timer_intr_mask, + tp->wol_enabled, + tp->wol_opts, + tp->efuse_ver, + tp->eeprom_type, + tp->autoneg, + tp->duplex, + tp->speed, + tp->eeprom_len, + tp->cur_page, + tp->bios_setting, + tp->features, + tp->org_pci_offset_99, + tp->org_pci_offset_180, + tp->issue_offset_99_event, + tp->org_pci_offset_80, + tp->org_pci_offset_81, + tp->use_timer_interrrupt, + tp->HwIcVerUnknown, + tp->NotWrRamCodeToMicroP, + tp->NotWrMcuPatchCode, + tp->HwHasWrRamCodeToMicroP, + tp->sw_ram_code_ver, + tp->hw_ram_code_ver, + tp->rtk_enable_diag, + tp->ShortPacketSwChecksum, + tp->UseSwPaddingShortPkt, + tp->RequireAdcBiasPatch, + tp->AdcBiasPatchIoffset, + tp->RequireAdjustUpsTxLinkPulseTiming, + tp->SwrCnt1msIni, + tp->HwSuppNowIsOobVer, + tp->RequiredSecLanDonglePatch, + tp->HwSuppDashVer, + tp->DASH, + tp->HwSuppKCPOffloadVer + ); + spin_unlock_irqrestore(&tp->lock, flags); + + len += snprintf(page + len, count - len, "\n"); + + *eof = 1; + return len; +} + +static int proc_get_tally_counter(char *page, char **start, + off_t offset, int count, + int *eof, void *data) +{ + struct net_device *dev = data; + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + struct rtl8168_counters *counters; + dma_addr_t paddr; + u32 cmd; + u32 WaitCnt; + unsigned long flags; + int len = 0; + + len += snprintf(page + len, count - len, + "\nDump Tally Counter\n"); + + ASSERT_RTNL(); + + counters = tp->tally_vaddr; + paddr = tp->tally_paddr; + if (!counters) { + len += snprintf(page + len, count - len, + "\nDump Tally Counter Fail\n"); + goto out; + } + + spin_lock_irqsave(&tp->lock, flags); + RTL_W32(CounterAddrHigh, (u64)paddr >> 32); + cmd = (u64)paddr & DMA_BIT_MASK(32); + RTL_W32(CounterAddrLow, cmd); + RTL_W32(CounterAddrLow, cmd | CounterDump); + + WaitCnt = 0; + while (RTL_R32(CounterAddrLow) & CounterDump) { + udelay(10); + + WaitCnt++; + if (WaitCnt > 20) + break; + } + spin_unlock_irqrestore(&tp->lock, flags); + + len += snprintf(page + len, count - len, + "Statistics\tValue\n----------\t-----\n"); + + len += snprintf(page + len, count - len, + "tx_packets\t%lld\n" + "rx_packets\t%lld\n" + "tx_errors\t%lld\n" + "rx_missed\t%lld\n" + "align_errors\t%lld\n" + "tx_one_collision\t%lld\n" + "tx_multi_collision\t%lld\n" + "rx_unicast\t%lld\n" + "rx_broadcast\t%lld\n" + "rx_multicast\t%lld\n" + "tx_aborted\t%lld\n" + "tx_underun\t%lld\n", + le64_to_cpu(counters->tx_packets), + le64_to_cpu(counters->rx_packets), + le64_to_cpu(counters->tx_errors), + le64_to_cpu(counters->rx_missed), + le64_to_cpu(counters->align_errors), + le64_to_cpu(counters->tx_one_collision), + le64_to_cpu(counters->tx_multi_collision), + le64_to_cpu(counters->rx_unicast), + le64_to_cpu(counters->rx_broadcast), + le64_to_cpu(counters->rx_multicast), + le64_to_cpu(counters->tx_aborted), + le64_to_cpu(counters->tx_underun) + ); + + len += snprintf(page + len, count - len, "\n"); +out: + *eof = 1; + return len; +} + +static int proc_get_registers(char *page, char **start, + off_t offset, int count, + int *eof, void *data) +{ + struct net_device *dev = data; + int i, n, max = R8168_MAC_REGS_SIZE; + u8 byte_rd; + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + unsigned long flags; + int len = 0; + + len += snprintf(page + len, count - len, + "\nDump MAC Registers\n" + "Offset\tValue\n------\t-----\n"); + + spin_lock_irqsave(&tp->lock, flags); + for (n = 0; n < max;) { + len += snprintf(page + len, count - len, + "\n0x%02x:\t", + n); + + for (i = 0; i < 16 && n < max; i++, n++) { + byte_rd = readb(ioaddr + n); + len += snprintf(page + len, count - len, + "%02x ", + byte_rd); + } + } + spin_unlock_irqrestore(&tp->lock, flags); + + len += snprintf(page + len, count - len, "\n"); + + *eof = 1; + return len; +} + +static int proc_get_pcie_phy(char *page, char **start, + off_t offset, int count, + int *eof, void *data) +{ + struct net_device *dev = data; + int i, n, max = R8168_EPHY_REGS_SIZE/2; + u16 word_rd; + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + unsigned long flags; + int len = 0; + + len += snprintf(page + len, count - len, + "\nDump PCIE PHY\n" + "Offset\tValue\n------\t-----\n"); + + spin_lock_irqsave(&tp->lock, flags); + for (n = 0; n < max;) { + len += snprintf(page + len, count - len, + "\n0x%02x:\t", + n); + + for (i = 0; i < 8 && n < max; i++, n++) { + word_rd = rtl8168_ephy_read(ioaddr, n); + len += snprintf(page + len, count - len, + "%04x ", + word_rd); + } + } + spin_unlock_irqrestore(&tp->lock, flags); + + len += snprintf(page + len, count - len, "\n"); + + *eof = 1; + return len; +} + +static int proc_get_eth_phy(char *page, char **start, + off_t offset, int count, + int *eof, void *data) +{ + struct net_device *dev = data; + int i, n, max = R8168_PHY_REGS_SIZE/2; + u16 word_rd; + struct rtl8168_private *tp = netdev_priv(dev); + unsigned long flags; + int len = 0; + + len += snprintf(page + len, count - len, + "\nDump Ethernet PHY\n" + "Offset\tValue\n------\t-----\n"); + + spin_lock_irqsave(&tp->lock, flags); + len += snprintf(page + len, count - len, + "\n####################page 0##################\n"); + mdio_write(tp, 0x1f, 0x0000); + for (n = 0; n < max;) { + len += snprintf(page + len, count - len, + "\n0x%02x:\t", + n); + + for (i = 0; i < 8 && n < max; i++, n++) { + word_rd = mdio_read(tp, n); + len += snprintf(page + len, count - len, + "%04x ", + word_rd); + } + } + spin_unlock_irqrestore(&tp->lock, flags); + + len += snprintf(page + len, count - len, "\n"); + + *eof = 1; + return len; +} + +static int proc_get_extended_registers(char *page, char **start, + off_t offset, int count, + int *eof, void *data) +{ + struct net_device *dev = data; + int i, n, max = R8168_ERI_REGS_SIZE; + u32 dword_rd; + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + unsigned long flags; + int len = 0; + + switch (tp->mcfg) { + case CFG_METHOD_1: + case CFG_METHOD_2: + case CFG_METHOD_3: + /* RTL8168B does not support Extend GMAC */ + len += snprintf(page + len, count - len, + "\nNot Support Dump Extended Registers\n"); + + goto out; + } + + len += snprintf(page + len, count - len, + "\nDump Extended Registers\n" + "Offset\tValue\n------\t-----\n"); + + spin_lock_irqsave(&tp->lock, flags); + for (n = 0; n < max;) { + len += snprintf(page + len, count - len, + "\n0x%02x:\t", + n); + + for (i = 0; i < 4 && n < max; i++, n+=4) { + dword_rd = rtl8168_eri_read(ioaddr, n, 4, ERIAR_ExGMAC); + len += snprintf(page + len, count - len, + "%08x ", + dword_rd); + } + } + spin_unlock_irqrestore(&tp->lock, flags); + + len += snprintf(page + len, count - len, "\n"); +out: + *eof = 1; + return len; +} + +#endif +static void rtl8168_proc_module_init(void) +{ + //in case /proc/net/r8168 already exist +#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,10,0) + remove_proc_subtree(MODULENAME, init_net.proc_net); +#else + remove_proc_entry(MODULENAME, init_net.proc_net); +#endif + + //create /proc/net/r8168 + rtl8168_proc = proc_mkdir(MODULENAME, init_net.proc_net); +} + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,10,0) +/* + * seq_file wrappers for procfile show routines. + */ +static int rtl8168_proc_open(struct inode *inode, struct file *file) +{ + struct net_device *dev = proc_get_parent_data(inode); + int (*show)(struct seq_file *, void *) = PDE_DATA(inode); + + return single_open(file, show, dev); +} + +static const struct file_operations rtl8168_proc_fops = { + .open = rtl8168_proc_open, + .read = seq_read, + .llseek = seq_lseek, + .release = single_release, +}; +#endif + +/* + * Table of proc files we need to create. + */ +struct rtl8168_proc_file { + char name[12]; +#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,10,0) + int (*show)(struct seq_file *, void *); +#else + int (*show)(char *, char **, off_t, int, int *, void *); +#endif +}; + +static const struct rtl8168_proc_file rtl8168_proc_files[] = { + { "driver_var", &proc_get_driver_variable }, + { "tally", &proc_get_tally_counter }, + { "registers", &proc_get_registers }, + { "pcie_phy", &proc_get_pcie_phy }, + { "eth_phy", &proc_get_eth_phy }, + { "ext_regs", &proc_get_extended_registers }, + { "" } +}; + +static void rtl8168_proc_init(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + const struct rtl8168_proc_file *f; + struct proc_dir_entry *dir; + + if (rtl8168_proc && !tp->proc_dir) { +#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,10,0) + dir = proc_mkdir_data(dev->name, 0, rtl8168_proc, dev); + if (!dir) { + printk("Unable to initialize /proc/net/%s/%s\n", + MODULENAME, dev->name); + return; + } + + tp->proc_dir = dir; + proc_init_num++; + + for (f = rtl8168_proc_files; f->name[0]; f++) { + if (!proc_create_data(f->name, S_IFREG | S_IRUGO, dir, + &rtl8168_proc_fops, f->show)) { + printk("Unable to initialize " + "/proc/net/%s/%s/%s\n", + MODULENAME, dev->name, f->name); + return; + } + } +#else + dir = proc_mkdir(dev->name, rtl8168_proc); + if (!dir) { + printk("Unable to initialize /proc/net/%s/%s\n", + MODULENAME, dev->name); + return; + } + + tp->proc_dir = dir; + proc_init_num++; + + for (f = rtl8168_proc_files; f->name[0]; f++) { + if (!create_proc_read_entry(f->name, S_IFREG | S_IRUGO, + dir, f->show, dev)) { + printk("Unable to initialize " + "/proc/net/%s/%s/%s\n", + MODULENAME, dev->name, f->name); + return; + } + } +#endif + } +} + +static void rtl8168_proc_remove(struct net_device *dev) +{ +#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,10,0) + remove_proc_subtree(dev->name, rtl8168_proc); + proc_init_num--; +#else + const struct rtl8168_proc_file *f; + struct rtl8168_private *tp = netdev_priv(dev); + + for (f = rtl8168_proc_files; f->name[0]; f++) + remove_proc_entry(f->name, tp->proc_dir); + + remove_proc_entry(dev->name, rtl8168_proc); + proc_init_num--; +#endif +} + +#endif //ENABLE_R8168_PROCFS + +static inline u16 map_phy_ocp_addr(u16 PageNum, u8 RegNum) +{ + u16 OcpPageNum = 0; + u8 OcpRegNum = 0; + u16 OcpPhyAddress = 0; + + if( PageNum == 0 ) { + OcpPageNum = OCP_STD_PHY_BASE_PAGE + ( RegNum / 8 ); + OcpRegNum = 0x10 + ( RegNum % 8 ); + } else { + OcpPageNum = PageNum; + OcpRegNum = RegNum; + } + + OcpPageNum <<= 4; + + if( OcpRegNum < 16 ) { + OcpPhyAddress = 0; + } else { + OcpRegNum -= 16; + OcpRegNum <<= 1; + + OcpPhyAddress = OcpPageNum + OcpRegNum; + } + + + return OcpPhyAddress; +} + +static void mdio_write_phy_ocp(struct rtl8168_private *tp, + u16 PageNum, + u32 RegAddr, + u32 value) +{ + void __iomem *ioaddr = tp->mmio_addr; + u32 data32; + u16 ocp_addr; + int i; + + ocp_addr = map_phy_ocp_addr(PageNum, RegAddr); + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,18) + WARN_ON_ONCE(ocp_addr % 2); +#endif + data32 = ocp_addr/2; + data32 <<= OCPR_Addr_Reg_shift; + data32 |= OCPR_Write | value; + + RTL_W32(PHYOCP, data32); + for (i = 0; i < 100; i++) { + udelay(1); + + if (!(RTL_R32(PHYOCP) & OCPR_Flag)) + break; + } +} + +static void mdio_real_write(struct rtl8168_private *tp, + u32 RegAddr, + u32 value) +{ + void __iomem *ioaddr = tp->mmio_addr; + int i; + + if (RegAddr == 0x1F) { + tp->cur_page = value; + } + + if (tp->mcfg == CFG_METHOD_11) { + RTL_W32(OCPDR, OCPDR_Write | + (RegAddr & OCPDR_Reg_Mask) << OCPDR_GPHY_Reg_shift | + (value & OCPDR_Data_Mask)); + RTL_W32(OCPAR, OCPAR_GPHY_Write); + RTL_W32(EPHY_RXER_NUM, 0); + + for (i = 0; i < 100; i++) { + mdelay(1); + if (!(RTL_R32(OCPAR) & OCPAR_Flag)) + break; + } + } else if (tp->mcfg == CFG_METHOD_21 || tp->mcfg == CFG_METHOD_22 || + tp->mcfg == CFG_METHOD_23 || tp->mcfg == CFG_METHOD_24 || + tp->mcfg == CFG_METHOD_25 || tp->mcfg == CFG_METHOD_26 || + tp->mcfg == CFG_METHOD_27 || tp->mcfg == CFG_METHOD_28 || + tp->mcfg == CFG_METHOD_29 || tp->mcfg == CFG_METHOD_30) { + if (RegAddr == 0x1F) { + return; + } + mdio_write_phy_ocp(tp, tp->cur_page, RegAddr, value); + } else { + if (tp->mcfg == CFG_METHOD_12 || tp->mcfg == CFG_METHOD_13) + RTL_W32(0xD0, RTL_R32(0xD0) & ~0x00020000); + + RTL_W32(PHYAR, PHYAR_Write | + (RegAddr & PHYAR_Reg_Mask) << PHYAR_Reg_shift | + (value & PHYAR_Data_Mask)); + + for (i = 0; i < 10; i++) { + udelay(100); + + /* Check if the RTL8168 has completed writing to the specified MII register */ + if (!(RTL_R32(PHYAR) & PHYAR_Flag)) { + udelay(20); + break; + } + } + + if (tp->mcfg == CFG_METHOD_12 || tp->mcfg == CFG_METHOD_13) + RTL_W32(0xD0, RTL_R32(0xD0) | 0x00020000); + } +} + +void mdio_write(struct rtl8168_private *tp, + u32 RegAddr, + u32 value) +{ + if (tp->rtk_enable_diag) return; + + mdio_real_write(tp, RegAddr, value); +} + +void mdio_prot_write(struct rtl8168_private *tp, + u32 RegAddr, + u32 value) +{ + mdio_real_write(tp, RegAddr, value); +} + +static u32 mdio_read_phy_ocp(struct rtl8168_private *tp, + u16 PageNum, + u32 RegAddr) +{ + void __iomem *ioaddr = tp->mmio_addr; + u32 data32; + u16 ocp_addr; + int i, value = 0; + + ocp_addr = map_phy_ocp_addr(PageNum, RegAddr); + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,18) + WARN_ON_ONCE(ocp_addr % 2); +#endif + data32 = ocp_addr/2; + data32 <<= OCPR_Addr_Reg_shift; + + RTL_W32(PHYOCP, data32); + for (i = 0; i < 100; i++) { + udelay(1); + + if (RTL_R32(PHYOCP) & OCPR_Flag) + break; + } + value = RTL_R32(PHYOCP) & OCPDR_Data_Mask; + + return value; +} + +u32 mdio_read(struct rtl8168_private *tp, + u32 RegAddr) +{ + void __iomem *ioaddr = tp->mmio_addr; + int i, value = 0; + + if (tp->mcfg==CFG_METHOD_11) { + RTL_W32(OCPDR, OCPDR_Read | + (RegAddr & OCPDR_Reg_Mask) << OCPDR_GPHY_Reg_shift); + RTL_W32(OCPAR, OCPAR_GPHY_Write); + RTL_W32(EPHY_RXER_NUM, 0); + + for (i = 0; i < 100; i++) { + mdelay(1); + if (!(RTL_R32(OCPAR) & OCPAR_Flag)) + break; + } + + mdelay(1); + RTL_W32(OCPAR, OCPAR_GPHY_Read); + RTL_W32(EPHY_RXER_NUM, 0); + + for (i = 0; i < 100; i++) { + mdelay(1); + if (RTL_R32(OCPAR) & OCPAR_Flag) + break; + } + + value = RTL_R32(OCPDR) & OCPDR_Data_Mask; + } else if (tp->mcfg == CFG_METHOD_21 || tp->mcfg == CFG_METHOD_22 || + tp->mcfg == CFG_METHOD_23 || tp->mcfg == CFG_METHOD_24 || + tp->mcfg == CFG_METHOD_25 || tp->mcfg == CFG_METHOD_26 || + tp->mcfg == CFG_METHOD_27 || tp->mcfg == CFG_METHOD_28 || + tp->mcfg == CFG_METHOD_29 || tp->mcfg == CFG_METHOD_30) { + value = mdio_read_phy_ocp(tp, tp->cur_page, RegAddr); + } else { + if (tp->mcfg == CFG_METHOD_12 || tp->mcfg == CFG_METHOD_13) + RTL_W32(0xD0, RTL_R32(0xD0) & ~0x00020000); + + RTL_W32(PHYAR, + PHYAR_Read | (RegAddr & PHYAR_Reg_Mask) << PHYAR_Reg_shift); + + for (i = 0; i < 10; i++) { + udelay(100); + + /* Check if the RTL8168 has completed retrieving data from the specified MII register */ + if (RTL_R32(PHYAR) & PHYAR_Flag) { + value = RTL_R32(PHYAR) & PHYAR_Data_Mask; + udelay(20); + break; + } + } + + if (tp->mcfg == CFG_METHOD_12 || tp->mcfg == CFG_METHOD_13) + RTL_W32(0xD0, RTL_R32(0xD0) | 0x00020000); + } + + return value; +} + +static void ClearAndSetEthPhyBit(struct rtl8168_private *tp, u8 addr, u16 clearmask, u16 setmask) +{ + u16 PhyRegValue; + + + PhyRegValue = mdio_read( tp, addr ); + PhyRegValue &= ~clearmask; + PhyRegValue |= setmask; + mdio_write( tp, addr, PhyRegValue); +} + +void ClearEthPhyBit(struct rtl8168_private *tp, u8 addr, u16 mask) +{ + ClearAndSetEthPhyBit( tp, + addr, + mask, + 0 + ); +} + +void SetEthPhyBit(struct rtl8168_private *tp, u8 addr, u16 mask) +{ + ClearAndSetEthPhyBit( tp, + addr, + 0, + mask + ); +} + +void mac_ocp_write(struct rtl8168_private *tp, u16 reg_addr, u16 value) +{ + void __iomem *ioaddr = tp->mmio_addr; + u32 data32; + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,18) + WARN_ON_ONCE(reg_addr % 2); +#endif + + data32 = reg_addr/2; + data32 <<= OCPR_Addr_Reg_shift; + data32 += value; + data32 |= OCPR_Write; + + RTL_W32(MACOCP, data32); +} + +u16 mac_ocp_read(struct rtl8168_private *tp, u16 reg_addr) +{ + void __iomem *ioaddr = tp->mmio_addr; + u32 data32; + u16 data16 = 0; + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,18) + WARN_ON_ONCE(reg_addr % 2); +#endif + + data32 = reg_addr/2; + data32 <<= OCPR_Addr_Reg_shift; + + RTL_W32(MACOCP, data32); + data16 = (u16)RTL_R32(MACOCP); + + return data16; +} + +static u32 real_ocp_read(struct rtl8168_private *tp, u16 addr, u8 len) +{ + void __iomem *ioaddr = tp->mmio_addr; + int i, val_shift, shift = 0; + u32 value1 = 0, value2 = 0, mask; + + if (len > 4 || len <= 0) + return -1; + + while (len > 0) { + val_shift = addr % 4; + addr = addr & ~0x3; + + RTL_W32(OCPAR, (0x0F<<12) | (addr&0xFFF)); + + for (i = 0; i < 20; i++) { + udelay(100); + if (RTL_R32(OCPAR) & OCPAR_Flag) + break; + } + + if (len == 1) mask = (0xFF << (val_shift * 8)) & 0xFFFFFFFF; + else if (len == 2) mask = (0xFFFF << (val_shift * 8)) & 0xFFFFFFFF; + else if (len == 3) mask = (0xFFFFFF << (val_shift * 8)) & 0xFFFFFFFF; + else mask = (0xFFFFFFFF << (val_shift * 8)) & 0xFFFFFFFF; + + value1 = RTL_R32(OCPDR) & mask; + value2 |= (value1 >> val_shift * 8) << shift * 8; + + if (len <= 4 - val_shift) { + len = 0; + } else { + len -= (4 - val_shift); + shift = 4 - val_shift; + addr += 4; + } + } + + udelay(20); + + return value2; +} + +u32 OCP_read(struct rtl8168_private *tp, u16 addr, u8 len) +{ + void __iomem *ioaddr = tp->mmio_addr; + u32 value = 0; + + if (tp->mcfg == CFG_METHOD_23 || tp->mcfg == CFG_METHOD_27 || + tp->mcfg == CFG_METHOD_28) { + value = rtl8168_eri_read(ioaddr, addr, len, ERIAR_OOB); + } else { + value = real_ocp_read(tp, addr, len); + } + + return value; +} + +static int real_ocp_write(struct rtl8168_private *tp, u16 addr, u8 len, u32 value) +{ + void __iomem *ioaddr = tp->mmio_addr; + int i, val_shift, shift = 0; + u32 value1 = 0, mask; + + if (len > 4 || len <= 0) + return -1; + + while (len > 0) { + val_shift = addr % 4; + addr = addr & ~0x3; + + if (len == 1) mask = (0xFF << (val_shift * 8)) & 0xFFFFFFFF; + else if (len == 2) mask = (0xFFFF << (val_shift * 8)) & 0xFFFFFFFF; + else if (len == 3) mask = (0xFFFFFF << (val_shift * 8)) & 0xFFFFFFFF; + else mask = (0xFFFFFFFF << (val_shift * 8)) & 0xFFFFFFFF; + + value1 = OCP_read(tp, addr, 4) & ~mask; + value1 |= ((value << val_shift * 8) >> shift * 8); + + RTL_W32(OCPDR, value1); + RTL_W32(OCPAR, OCPAR_Flag | (0x0F<<12) | (addr&0xFFF)); + + for (i = 0; i < 10; i++) { + udelay(100); + + /* Check if the RTL8168 has completed ERI write */ + if (!(RTL_R32(OCPAR) & OCPAR_Flag)) + break; + } + + if (len <= 4 - val_shift) { + len = 0; + } else { + len -= (4 - val_shift); + shift = 4 - val_shift; + addr += 4; + } + } + + udelay(20); + + return 0; +} + +void OCP_write(struct rtl8168_private *tp, u16 addr, u8 len, u32 value) +{ + void __iomem *ioaddr = tp->mmio_addr; + + if (tp->mcfg == CFG_METHOD_23 || tp->mcfg == CFG_METHOD_27 || + tp->mcfg == CFG_METHOD_28) { + rtl8168_eri_write(ioaddr, addr, len, value, ERIAR_OOB); + } else { + real_ocp_write(tp, addr, len, value); + } +} + +void OOB_mutex_lock(struct rtl8168_private *tp) +{ + u8 reg_16, reg_a0; + u32 wait_cnt_0, wait_Cnt_1; + u16 ocp_reg_mutex_ib; + u16 ocp_reg_mutex_oob; + u16 ocp_reg_mutex_prio; + + switch (tp->mcfg) { + case CFG_METHOD_11: + case CFG_METHOD_12: + ocp_reg_mutex_oob = 0x16; + ocp_reg_mutex_ib = 0x17; + ocp_reg_mutex_prio = 0x9C; + break; + case CFG_METHOD_13: + ocp_reg_mutex_oob = 0x06; + ocp_reg_mutex_ib = 0x07; + ocp_reg_mutex_prio = 0x9C; + break; + case CFG_METHOD_23: + case CFG_METHOD_27: + case CFG_METHOD_28: + default: + ocp_reg_mutex_oob = 0x110; + ocp_reg_mutex_ib = 0x114; + ocp_reg_mutex_prio = 0x11C; + break; + } + + OCP_write(tp, ocp_reg_mutex_ib, 1, BIT_0); + reg_16 = OCP_read(tp, ocp_reg_mutex_oob, 1); + wait_cnt_0 = 0; + while(reg_16) { + reg_a0 = OCP_read(tp, ocp_reg_mutex_prio, 1); + if(reg_a0) { + OCP_write(tp, ocp_reg_mutex_ib, 1, 0x00); + reg_a0 = OCP_read(tp, ocp_reg_mutex_prio, 1); + wait_Cnt_1 = 0; + while(reg_a0) { + reg_a0 = OCP_read(tp, ocp_reg_mutex_prio, 1); + + wait_Cnt_1++; + + if(wait_Cnt_1 > 2000) + break; + }; + OCP_write(tp, ocp_reg_mutex_ib, 1, BIT_0); + + } + reg_16 = OCP_read(tp, ocp_reg_mutex_oob, 1); + + wait_cnt_0++; + + if(wait_cnt_0 > 2000) + break; + }; +} + +void OOB_mutex_unlock(struct rtl8168_private *tp) +{ + u16 ocp_reg_mutex_ib; + u16 ocp_reg_mutex_oob; + u16 ocp_reg_mutex_prio; + + switch (tp->mcfg) { + case CFG_METHOD_11: + case CFG_METHOD_12: + ocp_reg_mutex_oob = 0x16; + ocp_reg_mutex_ib = 0x17; + ocp_reg_mutex_prio = 0x9C; + break; + case CFG_METHOD_13: + ocp_reg_mutex_oob = 0x06; + ocp_reg_mutex_ib = 0x07; + ocp_reg_mutex_prio = 0x9C; + break; + case CFG_METHOD_23: + case CFG_METHOD_27: + case CFG_METHOD_28: + default: + ocp_reg_mutex_oob = 0x110; + ocp_reg_mutex_ib = 0x114; + ocp_reg_mutex_prio = 0x11C; + break; + } + + OCP_write(tp, ocp_reg_mutex_prio, 1, BIT_0); + OCP_write(tp, ocp_reg_mutex_ib, 1, 0x00); +} + +void OOB_notify(struct rtl8168_private *tp, u8 cmd) +{ + void __iomem *ioaddr = tp->mmio_addr; + + rtl8168_eri_write(ioaddr, 0xE8, 1, cmd, ERIAR_ExGMAC); + + OCP_write(tp, 0x30, 1, 0x01); +} + +static int rtl8168_check_dash(struct rtl8168_private *tp) +{ + if (tp->mcfg == CFG_METHOD_23 || tp->mcfg == CFG_METHOD_27 || + tp->mcfg == CFG_METHOD_28) { + if (OCP_read(tp, 0x128, 1) & BIT_0) + return 1; + else + return 0; + } else { + u32 reg; + + if (tp->mcfg == CFG_METHOD_13) + reg = 0xb8; + else + reg = 0x10; + + if (OCP_read(tp, reg, 2) & 0x00008000) + return 1; + else + return 0; + } +} + +void Dash2DisableTx(struct rtl8168_private *tp) +{ + void __iomem *ioaddr = tp->mmio_addr; + + if (!tp->DASH) return; + + if( HW_DASH_SUPPORT_TYPE_2( tp ) ) { + u16 WaitCnt; + u8 TmpUchar; + + //Disable oob Tx + RTL_W8(IBCR2, RTL_R8(IBCR2) & ~( BIT_0 )); + WaitCnt = 0; + + //wait oob tx disable + do { + TmpUchar = RTL_R8(IBISR0); + + if( TmpUchar & ISRIMR_DASH_TYPE2_TX_DISABLE_IDLE ) { + break; + } + + udelay( 50 ); + WaitCnt++; + } while(WaitCnt < 2000); + + //Clear ISRIMR_DASH_TYPE2_TX_DISABLE_IDLE + RTL_W8(IBISR0, RTL_R8(IBISR0) | ISRIMR_DASH_TYPE2_TX_DISABLE_IDLE); + } +} + +void Dash2EnableTx(struct rtl8168_private *tp) +{ + void __iomem *ioaddr = tp->mmio_addr; + + if (!tp->DASH) return; + + if( HW_DASH_SUPPORT_TYPE_2( tp ) ) + RTL_W8(IBCR2, RTL_R8(IBCR2) | BIT_0); +} + +void Dash2DisableRx(struct rtl8168_private *tp) +{ + void __iomem *ioaddr = tp->mmio_addr; + + if (!tp->DASH) return; + + if( HW_DASH_SUPPORT_TYPE_2( tp ) ) + RTL_W8(IBCR0, RTL_R8(IBCR0) & ~( BIT_0 )); +} + +void Dash2EnableRx(struct rtl8168_private *tp) +{ + void __iomem *ioaddr = tp->mmio_addr; + + if (!tp->DASH) return; + + if( HW_DASH_SUPPORT_TYPE_2( tp ) ) + RTL_W8(IBCR0, RTL_R8(IBCR0) | BIT_0); +} + +static void Dash2DisableTxRx(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + + if( HW_DASH_SUPPORT_TYPE_2( tp ) ) { + Dash2DisableTx( tp ); + Dash2DisableRx( tp ); + } +} + +static void rtl8168_driver_start(struct rtl8168_private *tp) +{ + void __iomem *ioaddr = tp->mmio_addr; + + if (!tp->DASH) + return; + + if (tp->mcfg == CFG_METHOD_23 || tp->mcfg == CFG_METHOD_27 || + tp->mcfg == CFG_METHOD_28) { + int timeout; + u32 tmp_value; + + OCP_write(tp, 0x180, 1, OOB_CMD_DRIVER_START); + tmp_value = OCP_read(tp, 0x30, 1); + tmp_value |= BIT_0; + OCP_write(tp, 0x30, 1, tmp_value); + + for (timeout = 0; timeout < 10; timeout++) { + mdelay(10); + if (OCP_read(tp, 0x124, 1) & BIT_0) + break; + } + } else { + int timeout; + u32 reg; + + if (tp->mcfg == CFG_METHOD_13) { + RTL_W8(TwiCmdReg, RTL_R8(TwiCmdReg) | ( BIT_7 )); + } + + OOB_notify(tp, OOB_CMD_DRIVER_START); + + if (tp->mcfg == CFG_METHOD_13) + reg = 0xB8; + else + reg = 0x10; + + for (timeout = 0; timeout < 10; timeout++) { + mdelay(10); + if (OCP_read(tp, reg, 2) & BIT_11) + break; + } + } +} + +static void rtl8168_driver_stop(struct rtl8168_private *tp) +{ + void __iomem *ioaddr = tp->mmio_addr; + + if (!tp->DASH) + return; + + if (tp->mcfg == CFG_METHOD_23 || tp->mcfg == CFG_METHOD_27 || + tp->mcfg == CFG_METHOD_28) { + struct net_device *dev = tp->dev; + int timeout; + u32 tmp_value; + + Dash2DisableTxRx(dev); + + OCP_write(tp, 0x180, 1, OOB_CMD_DRIVER_STOP); + tmp_value = OCP_read(tp, 0x30, 1); + tmp_value |= BIT_0; + OCP_write(tp, 0x30, 1, tmp_value); + + for (timeout = 0; timeout < 10; timeout++) { + mdelay(10); + if (!(OCP_read(tp, 0x124, 1) & BIT_0)) + break; + } + } else { + int timeout; + u32 reg; + + OOB_notify(tp, OOB_CMD_DRIVER_STOP); + + if (tp->mcfg == CFG_METHOD_13) + reg = 0xB8; + else + reg = 0x10; + + for (timeout = 0; timeout < 10; timeout++) { + mdelay(10); + if ((OCP_read(tp, reg, 2) & BIT_11) == 0) + break; + } + + if (tp->mcfg == CFG_METHOD_13) { + RTL_W8(TwiCmdReg, RTL_R8(TwiCmdReg) & ~( BIT_7 )); + } + } +} + +void rtl8168_ephy_write(void __iomem *ioaddr, int RegAddr, int value) +{ + int i; + + RTL_W32(EPHYAR, + EPHYAR_Write | + (RegAddr & EPHYAR_Reg_Mask) << EPHYAR_Reg_shift | + (value & EPHYAR_Data_Mask)); + + for (i = 0; i < 10; i++) { + udelay(100); + + /* Check if the RTL8168 has completed EPHY write */ + if (!(RTL_R32(EPHYAR) & EPHYAR_Flag)) + break; + } + + udelay(20); +} + +u16 rtl8168_ephy_read(void __iomem *ioaddr, int RegAddr) +{ + int i; + u16 value = 0xffff; + + RTL_W32(EPHYAR, + EPHYAR_Read | (RegAddr & EPHYAR_Reg_Mask) << EPHYAR_Reg_shift); + + for (i = 0; i < 10; i++) { + udelay(100); + + /* Check if the RTL8168 has completed EPHY read */ + if (RTL_R32(EPHYAR) & EPHYAR_Flag) { + value = (u16) (RTL_R32(EPHYAR) & EPHYAR_Data_Mask); + break; + } + } + + udelay(20); + + return value; +} + +static void ClearAndSetPCIePhyBit(struct rtl8168_private *tp, u8 addr, u16 clearmask, u16 setmask) +{ + void __iomem *ioaddr = tp->mmio_addr; + u16 EphyValue; + + EphyValue = rtl8168_ephy_read( ioaddr, addr ); + EphyValue &= ~clearmask; + EphyValue |= setmask; + rtl8168_ephy_write( ioaddr, addr, EphyValue); +} + +static void ClearPCIePhyBit(struct rtl8168_private *tp, u8 addr, u16 mask) +{ + ClearAndSetPCIePhyBit( tp, + addr, + mask, + 0 + ); +} + +static void SetPCIePhyBit( struct rtl8168_private *tp, u8 addr, u16 mask) +{ + ClearAndSetPCIePhyBit( tp, + addr, + 0, + mask + ); +} + +static u32 +rtl8168_csi_other_fun_read(struct rtl8168_private *tp, + u8 multi_fun_sel_bit, + u32 addr) +{ + void __iomem *ioaddr = tp->mmio_addr; + u32 cmd; + int i; + u32 value = 0; + + cmd = CSIAR_Read | CSIAR_ByteEn << CSIAR_ByteEn_shift | (addr & CSIAR_Addr_Mask); + + if (tp->mcfg != CFG_METHOD_20 && tp->mcfg != CFG_METHOD_23 && + tp->mcfg != CFG_METHOD_26 && tp->mcfg != CFG_METHOD_27 && + tp->mcfg != CFG_METHOD_28) { + multi_fun_sel_bit = 0; + } + + if( multi_fun_sel_bit > 7 ) { + return 0xffffffff; + } + + cmd |= multi_fun_sel_bit << 16; + + RTL_W32(CSIAR, cmd); + + for (i = 0; i < 10; i++) { + udelay(100); + + /* Check if the RTL8168 has completed CSI read */ + if (RTL_R32(CSIAR) & CSIAR_Flag) { + value = (u32)RTL_R32(CSIDR); + break; + } + } + + udelay(20); + + return value; +} + +static void +rtl8168_csi_other_fun_write(struct rtl8168_private *tp, + u8 multi_fun_sel_bit, + u32 addr, + u32 value) +{ + void __iomem *ioaddr = tp->mmio_addr; + u32 cmd; + int i; + + RTL_W32(CSIDR, value); + cmd = CSIAR_Write | CSIAR_ByteEn << CSIAR_ByteEn_shift | (addr & CSIAR_Addr_Mask); + if (tp->mcfg != CFG_METHOD_20 && tp->mcfg != CFG_METHOD_23 && + tp->mcfg != CFG_METHOD_26 && tp->mcfg != CFG_METHOD_27 && + tp->mcfg != CFG_METHOD_28) { + multi_fun_sel_bit = 0; + } + + if( multi_fun_sel_bit > 7 ) { + return; + } + + cmd |= multi_fun_sel_bit << 16; + + RTL_W32(CSIAR, cmd); + + for (i = 0; i < 10; i++) { + udelay(100); + + /* Check if the RTL8168 has completed CSI write */ + if (!(RTL_R32(CSIAR) & CSIAR_Flag)) + break; + } + + udelay(20); +} + +static u32 +rtl8168_csi_read(struct rtl8168_private *tp, + u32 addr) +{ + u8 multi_fun_sel_bit; + + if (tp->mcfg == CFG_METHOD_20) + multi_fun_sel_bit = 2; + else if (tp->mcfg == CFG_METHOD_26) + multi_fun_sel_bit = 1; + else + multi_fun_sel_bit = 0; + + + return rtl8168_csi_other_fun_read(tp, multi_fun_sel_bit, addr); +} + +static void +rtl8168_csi_write(struct rtl8168_private *tp, + u32 addr, + u32 value) +{ + u8 multi_fun_sel_bit; + + if (tp->mcfg == CFG_METHOD_20) + multi_fun_sel_bit = 2; + else if (tp->mcfg == CFG_METHOD_26) + multi_fun_sel_bit = 1; + else + multi_fun_sel_bit = 0; + + rtl8168_csi_other_fun_write(tp, multi_fun_sel_bit, addr, value); +} + +static u8 +rtl8168_csi_fun0_read_byte(struct rtl8168_private *tp, + u32 addr) +{ + u8 RetVal = 0; + + if (tp->mcfg == CFG_METHOD_20 || tp->mcfg == CFG_METHOD_26) { + u32 TmpUlong; + u16 RegAlignAddr; + u8 ShiftByte; + + RegAlignAddr = addr & ~(0x3); + ShiftByte = addr & (0x3); + TmpUlong = rtl8168_csi_other_fun_read(tp, 0, addr); + TmpUlong >>= (8*ShiftByte); + RetVal = (u8)TmpUlong; + } else { + struct pci_dev *pdev = tp->pci_dev; + + pci_read_config_byte(pdev, addr, &RetVal); + } + + udelay(20); + + return RetVal; +} + +static void +rtl8168_csi_fun0_write_byte(struct rtl8168_private *tp, + u32 addr, + u8 value) +{ + if (tp->mcfg == CFG_METHOD_20 || tp->mcfg == CFG_METHOD_26) { + u32 TmpUlong; + u16 RegAlignAddr; + u8 ShiftByte; + + RegAlignAddr = addr & ~(0x3); + ShiftByte = addr & (0x3); + TmpUlong = rtl8168_csi_other_fun_read(tp, 0, RegAlignAddr); + TmpUlong &= ~(0xFF << (8*ShiftByte)); + TmpUlong |= (value << (8*ShiftByte)); + rtl8168_csi_other_fun_write( tp, 0, RegAlignAddr, TmpUlong ); + } else { + struct pci_dev *pdev = tp->pci_dev; + + pci_write_config_byte(pdev, addr, value); + } + + udelay(20); +} + +u32 rtl8168_eri_read(void __iomem *ioaddr, int addr, int len, int type) +{ + int i, val_shift, shift = 0; + u32 value1 = 0, value2 = 0, mask; + u32 eri_cmd; + + if (len > 4 || len <= 0) + return -1; + + while (len > 0) { + val_shift = addr % ERIAR_Addr_Align; + addr = addr & ~0x3; + + eri_cmd = ERIAR_Read | + type << ERIAR_Type_shift | + ERIAR_ByteEn << ERIAR_ByteEn_shift | + (addr & 0x0FFF); + if (addr & 0xF000) { + u32 tmp; + + tmp = addr & 0xF000; + tmp >>= 12; + eri_cmd |= (tmp << 20) & 0x00F00000; + } + + RTL_W32(ERIAR, eri_cmd); + + for (i = 0; i < 10; i++) { + udelay(100); + + /* Check if the RTL8168 has completed ERI read */ + if (RTL_R32(ERIAR) & ERIAR_Flag) + break; + } + + if (len == 1) mask = (0xFF << (val_shift * 8)) & 0xFFFFFFFF; + else if (len == 2) mask = (0xFFFF << (val_shift * 8)) & 0xFFFFFFFF; + else if (len == 3) mask = (0xFFFFFF << (val_shift * 8)) & 0xFFFFFFFF; + else mask = (0xFFFFFFFF << (val_shift * 8)) & 0xFFFFFFFF; + + value1 = RTL_R32(ERIDR) & mask; + value2 |= (value1 >> val_shift * 8) << shift * 8; + + if (len <= 4 - val_shift) { + len = 0; + } else { + len -= (4 - val_shift); + shift = 4 - val_shift; + addr += 4; + } + } + + udelay(20); + + return value2; +} + +int rtl8168_eri_write(void __iomem *ioaddr, int addr, int len, u32 value, int type) +{ + + int i, val_shift, shift = 0; + u32 value1 = 0, mask; + u32 eri_cmd; + + if (len > 4 || len <= 0) + return -1; + + while (len > 0) { + val_shift = addr % ERIAR_Addr_Align; + addr = addr & ~0x3; + + if (len == 1) mask = (0xFF << (val_shift * 8)) & 0xFFFFFFFF; + else if (len == 2) mask = (0xFFFF << (val_shift * 8)) & 0xFFFFFFFF; + else if (len == 3) mask = (0xFFFFFF << (val_shift * 8)) & 0xFFFFFFFF; + else mask = (0xFFFFFFFF << (val_shift * 8)) & 0xFFFFFFFF; + + value1 = rtl8168_eri_read(ioaddr, addr, 4, type) & ~mask; + value1 |= ((value << val_shift * 8) >> shift * 8); + + RTL_W32(ERIDR, value1); + + eri_cmd = ERIAR_Write | + type << ERIAR_Type_shift | + ERIAR_ByteEn << ERIAR_ByteEn_shift | + (addr & 0x0FFF); + if (addr & 0xF000) { + u32 tmp; + + tmp = addr & 0xF000; + tmp >>= 12; + eri_cmd |= (tmp << 20) & 0x00F00000; + } + + RTL_W32(ERIAR, eri_cmd); + + for (i = 0; i < 10; i++) { + udelay(100); + + /* Check if the RTL8168 has completed ERI write */ + if (!(RTL_R32(ERIAR) & ERIAR_Flag)) + break; + } + + if (len <= 4 - val_shift) { + len = 0; + } else { + len -= (4 - val_shift); + shift = 4 - val_shift; + addr += 4; + } + } + + udelay(20); + + return 0; +} + +static void +rtl8168_enable_rxdvgate(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + + switch (tp->mcfg) { + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + RTL_W8(0xF2, RTL_R8(0xF2) | BIT_3); + mdelay(2); + break; + } +} + +static void +rtl8168_disable_rxdvgate(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + + switch (tp->mcfg) { + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + RTL_W8(0xF2, RTL_R8(0xF2) & ~BIT_3); + mdelay(2); + break; + } +} + +void +rtl8168_wait_txrx_fifo_empty(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + int i; + + switch (tp->mcfg) { + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + for (i = 0; i < 10; i++) { + udelay(100); + if (RTL_R32(TxConfig) & BIT_11) + break; + } + + for (i = 0; i < 10; i++) { + udelay(100); + if ((RTL_R8(MCUCmd_reg) & (Txfifo_empty | Rxfifo_empty)) == (Txfifo_empty | Rxfifo_empty)) + break; + + } + break; + } +} + +#ifdef ENABLE_DASH_SUPPORT + +inline void +rtl8168_enable_dash2_interrupt(struct rtl8168_private *tp, void __iomem *ioaddr) +{ + if (!tp->DASH) return; + + if( HW_DASH_SUPPORT_TYPE_2( tp ) ) + RTL_W8(IBIMR0, ( ISRIMR_DASH_TYPE2_ROK | ISRIMR_DASH_TYPE2_TOK | ISRIMR_DASH_TYPE2_TDU | ISRIMR_DASH_TYPE2_RDU | ISRIMR_DASH_TYPE2_RX_DISABLE_IDLE )); +} + +static inline void +rtl8168_disable_dash2_interrupt(struct rtl8168_private *tp, void __iomem *ioaddr) +{ + if (!tp->DASH) return; + + if( HW_DASH_SUPPORT_TYPE_2( tp ) ) + RTL_W8(IBIMR0, 0); +} +#endif + +static inline void +rtl8168_enable_hw_interrupt(struct rtl8168_private *tp, void __iomem *ioaddr) +{ + RTL_W16(IntrMask, tp->intr_mask); + +#ifdef ENABLE_DASH_SUPPORT + if (tp->DASH) + rtl8168_enable_dash2_interrupt(tp, ioaddr); +#endif +} + +static inline void +rtl8168_disable_hw_interrupt(struct rtl8168_private *tp, void __iomem *ioaddr) +{ + RTL_W16(IntrMask, 0x0000); + +#ifdef ENABLE_DASH_SUPPORT + if (tp->DASH) + rtl8168_disable_dash2_interrupt(tp, ioaddr); +#endif +} + + +static inline void +rtl8168_switch_to_hw_interrupt(struct rtl8168_private *tp, void __iomem *ioaddr) +{ + RTL_W32(TimeInt0, 0x0000); + + rtl8168_enable_hw_interrupt(tp, ioaddr); +} + +static inline void +rtl8168_switch_to_timer_interrupt(struct rtl8168_private *tp, void __iomem *ioaddr) +{ + if (tp->use_timer_interrrupt) { + RTL_W32(TCTR, timer_count); + RTL_W32(TimeInt0, timer_count); + RTL_W16(IntrMask, tp->timer_intr_mask); + +#ifdef ENABLE_DASH_SUPPORT + if (tp->DASH) + rtl8168_enable_dash2_interrupt(tp, ioaddr); +#endif + } else { + rtl8168_switch_to_hw_interrupt(tp, ioaddr); + } +} + +static void +rtl8168_irq_mask_and_ack(struct rtl8168_private *tp, void __iomem *ioaddr) +{ + rtl8168_disable_hw_interrupt(tp, ioaddr); + RTL_W16(IntrStatus, RTL_R16(IntrStatus)); + +#ifdef ENABLE_DASH_SUPPORT + if ( tp->DASH ) { + if( HW_DASH_SUPPORT_TYPE_2( tp ) ) { + RTL_W8(IBISR0, RTL_R16(IBISR0)); + } + } +#endif +} + +static void +rtl8168_nic_reset(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + int i; + + RTL_W32(RxConfig, (RX_DMA_BURST << RxCfgDMAShift)); + + rtl8168_enable_rxdvgate(dev); + + rtl8168_wait_txrx_fifo_empty(dev); + + switch (tp->mcfg) { + case CFG_METHOD_1: + case CFG_METHOD_2: + case CFG_METHOD_3: + mdelay(10); + break; + case CFG_METHOD_4: + case CFG_METHOD_5: + case CFG_METHOD_6: + case CFG_METHOD_7: + case CFG_METHOD_8: + case CFG_METHOD_9: + case CFG_METHOD_10: + case CFG_METHOD_14: + case CFG_METHOD_15: + RTL_W8(ChipCmd, StopReq | CmdRxEnb | CmdTxEnb); + udelay(100); + break; + case CFG_METHOD_11: + case CFG_METHOD_12: + case CFG_METHOD_13: + while (RTL_R8(TxPoll) & NPQ) + udelay(20); + break; + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + mdelay(2); + break; + default: + mdelay(10); + break; + } + + /* Soft reset the chip. */ + RTL_W8(ChipCmd, CmdReset); + + /* Check that the chip has finished the reset. */ + for (i = 100; i > 0; i--) { + udelay(100); + if ((RTL_R8(ChipCmd) & CmdReset) == 0) + break; + } + + switch (tp->mcfg) { + case CFG_METHOD_11: + OOB_mutex_lock(tp); + OCP_write(tp, 0x10, 2, OCP_read(tp, 0x010, 2)&~0x00004000); + OOB_mutex_unlock(tp); + + OOB_notify(tp, OOB_CMD_RESET); + + for (i = 0; i < 10; i++) { + mdelay(10); + if (OCP_read(tp, 0x010, 2)&0x00004000) + break; + } + + for (i = 0; i < 5; i++) { + if ( OCP_read(tp, 0x034, 1) == 0) + break; + } + break; + } +} + +static void +rtl8168_hw_clear_timer_int(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + + RTL_W32(TimeInt0, 0x0000); + + switch (tp->mcfg) { + case CFG_METHOD_4: + case CFG_METHOD_5: + case CFG_METHOD_6: + case CFG_METHOD_7: + case CFG_METHOD_8: + RTL_W32(TimeInt1, 0x0000); + break; + case CFG_METHOD_9: + case CFG_METHOD_10: + case CFG_METHOD_11: + case CFG_METHOD_12: + case CFG_METHOD_13: + case CFG_METHOD_14: + case CFG_METHOD_15: + case CFG_METHOD_16: + case CFG_METHOD_17: + case CFG_METHOD_18: + case CFG_METHOD_19: + case CFG_METHOD_20: + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + RTL_W32(TimeInt1, 0x0000); + RTL_W32(TimeInt2, 0x0000); + RTL_W32(TimeInt3, 0x0000); + break; + } +} + +static void +rtl8168_hw_reset(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + + /* Disable interrupts */ + rtl8168_irq_mask_and_ack(tp, ioaddr); + + rtl8168_hw_clear_timer_int(dev); + + rtl8168_nic_reset(dev); +} + +static void rtl8168_mac_loopback_test(struct rtl8168_private *tp) +{ + void __iomem *ioaddr = tp->mmio_addr; + struct net_device *dev = tp->dev; + struct sk_buff *skb, *rx_skb; + dma_addr_t mapping; + struct TxDesc *txd; + struct RxDesc *rxd; + void *tmpAddr; + u32 len, rx_len, rx_cmd; + u16 type; + u8 pattern; + int i; + + if (tp->DASH) + return; + + pattern = 0x5A; + len = 60; + type = htons(ETH_P_IP); + txd = tp->TxDescArray; + rxd = tp->RxDescArray; + rx_skb = tp->Rx_skbuff[0]; + RTL_W32(TxConfig, (RTL_R32(TxConfig) & ~0x00060000) | 0x00020000); + + do { + skb = dev_alloc_skb(len + RTK_RX_ALIGN); + if (unlikely(!skb)) + dev_printk(KERN_NOTICE, &tp->pci_dev->dev, "-ENOMEM;\n"); + } while (unlikely(skb == NULL)); + skb_reserve(skb, RTK_RX_ALIGN); + + memcpy(skb_put(skb, dev->addr_len), dev->dev_addr, dev->addr_len); + memcpy(skb_put(skb, dev->addr_len), dev->dev_addr, dev->addr_len); + memcpy(skb_put(skb, sizeof(type)), &type, sizeof(type)); + tmpAddr = skb_put(skb, len - 14); + + mapping = pci_map_single(tp->pci_dev, skb->data, len, PCI_DMA_TODEVICE); + pci_dma_sync_single_for_cpu(tp->pci_dev, le64_to_cpu(mapping), + len, PCI_DMA_TODEVICE); + txd->addr = cpu_to_le64(mapping); + txd->opts2 = 0; + while (1) { + memset(tmpAddr, pattern++, len - 14); + pci_dma_sync_single_for_device(tp->pci_dev, + le64_to_cpu(mapping), + len, PCI_DMA_TODEVICE); + txd->opts1 = cpu_to_le32(DescOwn | FirstFrag | LastFrag | len); + + RTL_W32(RxConfig, RTL_R32(RxConfig) | AcceptMyPhys); + + smp_wmb(); + RTL_W8(TxPoll, NPQ); /* set polling bit */ + + for (i = 0; i < 50; i++) { + udelay(200); + rx_cmd = le32_to_cpu(rxd->opts1); + if ((rx_cmd & DescOwn) == 0) + break; + } + + RTL_W32(RxConfig, RTL_R32(RxConfig) & ~(AcceptErr | AcceptRunt | AcceptBroadcast | AcceptMulticast | AcceptMyPhys | AcceptAllPhys)); + + rx_len = rx_cmd & 0x3FFF; + rx_len -= 4; + rxd->opts1 = cpu_to_le32(DescOwn | tp->rx_buf_sz); + + pci_dma_sync_single_for_cpu(tp->pci_dev, le64_to_cpu(mapping), len, PCI_DMA_TODEVICE); + + if (rx_len == len) { + pci_dma_sync_single_for_cpu(tp->pci_dev, le64_to_cpu(rxd->addr), tp->rx_buf_sz, PCI_DMA_FROMDEVICE); + i = memcmp(skb->data, rx_skb->data, rx_len); + pci_dma_sync_single_for_device(tp->pci_dev, le64_to_cpu(rxd->addr), tp->rx_buf_sz, PCI_DMA_FROMDEVICE); + if (i == 0) { +// dev_printk(KERN_INFO, &tp->pci_dev->dev, "loopback test finished\n",rx_len,len); + break; + } + } + + rtl8168_hw_reset(dev); + rtl8168_disable_rxdvgate(dev); + RTL_W8(ChipCmd, CmdTxEnb | CmdRxEnb); + } + tp->dirty_tx++; + tp->dirty_rx++; + tp->cur_tx++; + tp->cur_rx++; + pci_unmap_single(tp->pci_dev, le64_to_cpu(mapping), + len, PCI_DMA_TODEVICE); + RTL_W32(TxConfig, RTL_R32(TxConfig) & ~0x00060000); + dev_kfree_skb_any(skb); + RTL_W16(IntrStatus, 0xFFBF); +} + +static unsigned int +rtl8168_xmii_reset_pending(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + unsigned int retval; + unsigned long flags; + + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1f, 0x0000); + retval = mdio_read(tp, MII_BMCR) & BMCR_RESET; + spin_unlock_irqrestore(&tp->phy_lock, flags); + + return retval; +} + +static unsigned int +rtl8168_xmii_link_ok(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + unsigned int retval; + + retval = (RTL_R8(PHYstatus) & LinkStatus) ? 1 : 0; + + return retval; +} + +static void +rtl8168_xmii_reset_enable(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + int i, val = 0; + unsigned long flags; + + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, MII_BMCR, BMCR_RESET | BMCR_ANENABLE); + + for (i = 0; i < 2500; i++) { + val = mdio_read(tp, MII_BMCR) & BMCR_RESET; + + if (!val) { + spin_unlock_irqrestore(&tp->phy_lock, flags); + return; + } + + mdelay(1); + } + + spin_unlock_irqrestore(&tp->phy_lock, flags); + + if (netif_msg_link(tp)) + printk(KERN_ERR "%s: PHY reset failed.\n", dev->name); +} + +static void +rtl8168dp_10mbps_gphy_para(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + u8 status = RTL_R8(PHYstatus); + unsigned long flags; + + spin_lock_irqsave(&tp->phy_lock, flags); + if ((status & LinkStatus) && (status & _10bps)) { + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x10, 0x04EE); + } else { + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x10, 0x01EE); + } + spin_unlock_irqrestore(&tp->phy_lock, flags); +} + +void rtl8168_init_ring_indexes(struct rtl8168_private *tp) +{ + tp->dirty_tx = 0; + tp->dirty_rx = 0; + tp->cur_tx = 0; + tp->cur_rx = 0; +} + +static void +rtl8168_issue_offset_99_event(struct rtl8168_private *tp) +{ + void __iomem *ioaddr = tp->mmio_addr; + u32 csi_tmp; + + switch (tp->mcfg) { + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_27: + case CFG_METHOD_28: + if (tp->mcfg == CFG_METHOD_24 || tp->mcfg == CFG_METHOD_25 || + tp->mcfg == CFG_METHOD_27 || tp->mcfg == CFG_METHOD_28) { + rtl8168_eri_write(ioaddr, 0x3FC, 4, 0x00000000, ERIAR_ExGMAC); + } else { + rtl8168_eri_write(ioaddr, 0x3FC, 4, 0x083C083C, ERIAR_ExGMAC); + } + csi_tmp = rtl8168_eri_read(ioaddr, 0x3F8, 1, ERIAR_ExGMAC); + csi_tmp |= BIT_0; + rtl8168_eri_write(ioaddr, 0x3F8, 1, csi_tmp, ERIAR_ExGMAC); + break; + case CFG_METHOD_29: + case CFG_METHOD_30: + csi_tmp = rtl8168_eri_read(ioaddr, 0x1EA, 1, ERIAR_ExGMAC); + csi_tmp |= BIT_0; + rtl8168_eri_write(ioaddr, 0x1EA, 1, csi_tmp, ERIAR_ExGMAC); + break; + } +} + +#ifdef ENABLE_DASH_SUPPORT +static void +NICChkTypeEnableDashInterrupt(struct rtl8168_private *tp) +{ + void __iomem *ioaddr = tp->mmio_addr; + + if (tp->DASH) { + // + // even disconnected, enable 3 dash interrupt mask bits for in-band/out-band communication + // + if( HW_DASH_SUPPORT_TYPE_2( tp ) ) { + rtl8168_enable_dash2_interrupt(tp, ioaddr); + RTL_W16(IntrMask, (ISRIMR_DASH_INTR_EN | ISRIMR_DASH_INTR_CMAC_RESET)); + } else { + RTL_W16(IntrMask, (ISRIMR_DP_DASH_OK | ISRIMR_DP_HOST_OK | ISRIMR_DP_REQSYS_OK)); + } + } +} +#endif + +static void +rtl8168_check_link_status(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + int link_status_on; + unsigned long flags; + + link_status_on = tp->link_ok(dev); + + if (tp->mcfg == CFG_METHOD_11) + rtl8168dp_10mbps_gphy_para(dev); + + if (netif_carrier_ok(dev) != link_status_on) { + if (link_status_on) { + if (tp->mcfg == CFG_METHOD_18 || tp->mcfg == CFG_METHOD_19 || tp->mcfg == CFG_METHOD_20) { + if (RTL_R8(PHYstatus) & _1000bpsF) { + rtl8168_eri_write(ioaddr, 0x1bc, 4, 0x00000011, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0x1dc, 4, 0x00000005, ERIAR_ExGMAC); + } else { + rtl8168_eri_write(ioaddr, 0x1bc, 4, 0x0000001f, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0x1dc, 4, 0x0000003f, ERIAR_ExGMAC); + } + } else if ((tp->mcfg == CFG_METHOD_16 || tp->mcfg == CFG_METHOD_17) && netif_running(dev)) { + if (tp->mcfg == CFG_METHOD_16 && (RTL_R8(PHYstatus) & _10bps)) { + RTL_W32(RxConfig, RTL_R32(RxConfig) | AcceptAllPhys); + } else if (tp->mcfg == CFG_METHOD_17) { + if (RTL_R8(PHYstatus) & _1000bpsF) { + rtl8168_eri_write(ioaddr, 0x1bc, 4, 0x00000011, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0x1dc, 4, 0x00000005, ERIAR_ExGMAC); + } else if (RTL_R8(PHYstatus) & _100bps) { + rtl8168_eri_write(ioaddr, 0x1bc, 4, 0x0000001f, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0x1dc, 4, 0x00000005, ERIAR_ExGMAC); + } else { + rtl8168_eri_write(ioaddr, 0x1bc, 4, 0x0000001f, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0x1dc, 4, 0x0000003f, ERIAR_ExGMAC); + } + } + } else if ((tp->mcfg == CFG_METHOD_14 || tp->mcfg == CFG_METHOD_15) && eee_enable ==1) { + /*Full -Duplex mode*/ + if (RTL_R8(PHYstatus)&FullDup) { + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0006); + mdio_write(tp, 0x00, 0x5a30); + mdio_write(tp, 0x1F, 0x0000); + spin_unlock_irqrestore(&tp->phy_lock, flags); + if (RTL_R8(PHYstatus) & (_10bps | _100bps)) + RTL_W32(TxConfig, (RTL_R32(TxConfig) & ~BIT_19) | BIT_25); + + } else { + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0006); + mdio_write(tp, 0x00, 0x5a00); + mdio_write(tp, 0x1F, 0x0000); + spin_unlock_irqrestore(&tp->phy_lock, flags); + if (RTL_R8(PHYstatus) & (_10bps | _100bps)) + RTL_W32(TxConfig, (RTL_R32(TxConfig) & ~BIT_19) | (InterFrameGap << TxInterFrameGapShift)); + } + } else if ((tp->mcfg == CFG_METHOD_21 || tp->mcfg == CFG_METHOD_22 || + tp->mcfg == CFG_METHOD_23 || tp->mcfg == CFG_METHOD_24 || + tp->mcfg == CFG_METHOD_25 || tp->mcfg == CFG_METHOD_26 || + tp->mcfg == CFG_METHOD_27 || tp->mcfg == CFG_METHOD_28 || + tp->mcfg == CFG_METHOD_29 || tp->mcfg == CFG_METHOD_30) && + netif_running(dev)) { + if (RTL_R8(PHYstatus)&FullDup) + RTL_W32(TxConfig, (RTL_R32(TxConfig) | (BIT_24 | BIT_25)) & ~BIT_19); + else + RTL_W32(TxConfig, (RTL_R32(TxConfig) | BIT_25) & ~(BIT_19 | BIT_24)); + } + + if (tp->mcfg == CFG_METHOD_21 || tp->mcfg == CFG_METHOD_22 || + tp->mcfg == CFG_METHOD_27 || tp->mcfg == CFG_METHOD_28) { + /*half mode*/ + if (!(RTL_R8(PHYstatus)&FullDup)) { + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, MII_ADVERTISE, mdio_read(tp, MII_ADVERTISE)&~(ADVERTISE_PAUSE_CAP|ADVERTISE_PAUSE_ASYM)); + spin_unlock_irqrestore(&tp->phy_lock, flags); + } + } + + rtl8168_hw_start(dev); + + netif_carrier_on(dev); + + netif_wake_queue(dev); + + if (netif_msg_ifup(tp)) + printk(KERN_INFO PFX "%s: link up\n", dev->name); + } else { + if (netif_msg_ifdown(tp)) + printk(KERN_INFO PFX "%s: link down\n", dev->name); + + netif_stop_queue(dev); + + netif_carrier_off(dev); + + rtl8168_hw_reset(dev); + + rtl8168_tx_clear(tp); + + rtl8168_rx_clear(tp); + + rtl8168_init_ring(dev); + + rtl8168_set_speed(dev, tp->autoneg, tp->speed, tp->duplex); + + switch (tp->mcfg) { + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_27: + case CFG_METHOD_28: + if (tp->org_pci_offset_99 & BIT_2) + tp->issue_offset_99_event = TRUE; + break; + } + +#ifdef ENABLE_DASH_SUPPORT + if (tp->DASH) { + NICChkTypeEnableDashInterrupt(tp); + } +#endif + } + } + + if (!link_status_on) { + switch (tp->mcfg) { + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_27: + case CFG_METHOD_28: + if (tp->issue_offset_99_event) { + if (!(RTL_R8(PHYstatus) & PowerSaveStatus)) { + tp->issue_offset_99_event = FALSE; + rtl8168_issue_offset_99_event(tp); + } + } + break; + } + } +} + +static void +rtl8168_link_option(u8 *aut, + u16 *spd, + u8 *dup) +{ + if ((*spd != SPEED_1000) && (*spd != SPEED_100) && (*spd != SPEED_10)) + *spd = SPEED_1000; + + if ((*dup != DUPLEX_FULL) && (*dup != DUPLEX_HALF)) + *dup = DUPLEX_FULL; + + if ((*aut != AUTONEG_ENABLE) && (*aut != AUTONEG_DISABLE)) + *aut = AUTONEG_ENABLE; +} + +void +rtl8168_wait_ll_share_fifo_ready(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + int i; + + for (i = 0; i < 10; i++) { + udelay(100); + if (RTL_R16(0xD2) & BIT_9) + break; + } +} + +static void +rtl8168_disable_pci_offset_99(struct rtl8168_private *tp) +{ + void __iomem *ioaddr = tp->mmio_addr; + u32 csi_tmp; + + switch (tp->mcfg) { + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + csi_tmp = rtl8168_eri_read(ioaddr, 0x3F2, 2, ERIAR_ExGMAC); + csi_tmp &= ~(BIT_0 | BIT_1); + rtl8168_eri_write(ioaddr, 0x3F2, 2, csi_tmp, ERIAR_ExGMAC); + break; + } + + switch (tp->mcfg) { + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_26: + case CFG_METHOD_29: + case CFG_METHOD_30: + rtl8168_csi_fun0_write_byte(tp, 0x99, 0x00); + break; + } +} + +static void +rtl8168_enable_pci_offset_99(struct rtl8168_private *tp) +{ + void __iomem *ioaddr = tp->mmio_addr; + u32 csi_tmp; + + switch (tp->mcfg) { + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_26: + case CFG_METHOD_29: + case CFG_METHOD_30: + rtl8168_csi_fun0_write_byte(tp, 0x99, tp->org_pci_offset_99); + break; + } + + switch (tp->mcfg) { + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + csi_tmp = rtl8168_eri_read(ioaddr, 0x3F2, 2, ERIAR_ExGMAC); + csi_tmp &= ~(BIT_0 | BIT_1); + if (!(tp->org_pci_offset_99 & (BIT_5 | BIT_6))) + csi_tmp |= BIT_1; + if (!(tp->org_pci_offset_99 & BIT_2)) + csi_tmp |= BIT_0; + rtl8168_eri_write(ioaddr, 0x3F2, 2, csi_tmp, ERIAR_ExGMAC); + break; + } +} + +static void +rtl8168_init_pci_offset_99(struct rtl8168_private *tp) +{ + void __iomem *ioaddr = tp->mmio_addr; + u32 csi_tmp; + + switch (tp->mcfg) { + case CFG_METHOD_26: + csi_tmp = rtl8168_eri_read(ioaddr, 0x5C2, 1, ERIAR_ExGMAC); + csi_tmp &= ~BIT_1; + rtl8168_eri_write(ioaddr, 0x5C2, 1, csi_tmp, ERIAR_ExGMAC); + break; + } + + switch (tp->mcfg) { + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + csi_tmp = rtl8168_eri_read(ioaddr, 0x3F2, 2, ERIAR_ExGMAC); + csi_tmp &= ~( BIT_8 | BIT_9 | BIT_10 | BIT_11 | BIT_12 | BIT_13 | BIT_14 | BIT_15 ); + csi_tmp |= ( BIT_9 | BIT_10 | BIT_13 | BIT_14 | BIT_15 ); + rtl8168_eri_write(ioaddr, 0x3F2, 2, csi_tmp, ERIAR_ExGMAC); + csi_tmp = rtl8168_eri_read(ioaddr, 0x3F5, 1, ERIAR_ExGMAC); + csi_tmp |= BIT_6 | BIT_7; + rtl8168_eri_write(ioaddr, 0x3F5, 1, csi_tmp, ERIAR_ExGMAC); + mac_ocp_write(tp, 0xE02C, 0x1880); + mac_ocp_write(tp, 0xE02E, 0x4880); + break; + } + + switch (tp->mcfg) { + case CFG_METHOD_26: + csi_tmp = rtl8168_eri_read(ioaddr, 0x5C8, 1, ERIAR_ExGMAC); + csi_tmp |= BIT_0; + rtl8168_eri_write(ioaddr, 0x5C8, 1, csi_tmp, ERIAR_ExGMAC); + break; + } + + switch (tp->mcfg) { + case CFG_METHOD_23: + rtl8168_eri_write(ioaddr, 0x2E8, 2, 0x883C, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0x2EA, 2, 0x8C12, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0x2EC, 2, 0x9003, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0x2E2, 2, 0x883C, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0x2E4, 2, 0x8C12, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0x2E6, 2, 0x9003, ERIAR_ExGMAC); + break; + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + rtl8168_eri_write(ioaddr, 0x2E8, 2, 0x9003, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0x2EA, 2, 0x9003, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0x2EC, 2, 0x9003, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0x2E2, 2, 0x883C, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0x2E4, 2, 0x8C12, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0x2E6, 2, 0x9003, ERIAR_ExGMAC); + break; + } + + switch (tp->mcfg) { + case CFG_METHOD_26: + case CFG_METHOD_29: + case CFG_METHOD_30: + RTL_W8(0xB6, RTL_R8(0xB6) | BIT_0); + + csi_tmp = rtl8168_eri_read(ioaddr, 0x5C8, 1, ERIAR_ExGMAC); + csi_tmp |= BIT_0; + rtl8168_eri_write(ioaddr, 0x5C8, 1, csi_tmp, ERIAR_ExGMAC); + break; + } + + switch (tp->mcfg) { + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + csi_tmp = rtl8168_eri_read(ioaddr, 0x3FA, 2, ERIAR_ExGMAC); + csi_tmp |= BIT_14; + rtl8168_eri_write(ioaddr, 0x3FA, 2, csi_tmp, ERIAR_ExGMAC); + break; + } + + rtl8168_enable_pci_offset_99(tp); +} + +static void +rtl8168_disable_pci_offset_180(struct rtl8168_private *tp) +{ + void __iomem *ioaddr = tp->mmio_addr; + u32 csi_tmp; + + switch (tp->mcfg) { + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + csi_tmp = rtl8168_eri_read(ioaddr, 0x1E2, 1, ERIAR_ExGMAC); + csi_tmp &= ~BIT_2; + rtl8168_eri_write(ioaddr, 0x1E2, 1, csi_tmp, ERIAR_ExGMAC); + break; + } + + switch (tp->mcfg) { + case CFG_METHOD_26: + rtl8168_eri_write(ioaddr, 0x1E9, 1, 0x0A, ERIAR_ExGMAC); + break; + } +} + +static void +rtl8168_enable_pci_offset_180(struct rtl8168_private *tp) +{ + void __iomem *ioaddr = tp->mmio_addr; + u32 csi_tmp; + + switch (tp->mcfg) { + case CFG_METHOD_25: + case CFG_METHOD_28: + csi_tmp = rtl8168_eri_read(ioaddr, 0x1E8, 4, ERIAR_ExGMAC); + csi_tmp &= ~(0x0000FF00); + csi_tmp |= (0x00006400); + rtl8168_eri_write(ioaddr, 0x1E8, 4, csi_tmp, ERIAR_ExGMAC); + + csi_tmp = rtl8168_eri_read(ioaddr, 0x1E4, 4, ERIAR_ExGMAC); + csi_tmp &= ~(0x0000FF00); + rtl8168_eri_write(ioaddr, 0x1E4, 4, csi_tmp, ERIAR_ExGMAC); + break; + } + + switch (tp->mcfg) { + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + csi_tmp = rtl8168_eri_read(ioaddr, 0x1E2, 1, ERIAR_ExGMAC); + csi_tmp |= BIT_2; + rtl8168_eri_write(ioaddr, 0x1E2, 1, csi_tmp, ERIAR_ExGMAC); + break; + } + + switch (tp->mcfg) { + case CFG_METHOD_26: + rtl8168_eri_write(ioaddr, 0x1E9, 1, 0x64, ERIAR_ExGMAC); + break; + } + + mac_ocp_write(tp, 0xE094, 0x0000); +} + +static void +rtl8168_init_pci_offset_180(struct rtl8168_private *tp) +{ + if (tp->org_pci_offset_180 & (BIT_0|BIT_1)) + rtl8168_enable_pci_offset_180(tp); + else + rtl8168_disable_pci_offset_180(tp); +} + +static void +rtl8168_set_pci_99_180_exit_driver_para(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + + switch (tp->mcfg) { + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + rtl8168_issue_offset_99_event(tp); + break; + } + + switch (tp->mcfg) { + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + rtl8168_disable_pci_offset_99(tp); + break; + } + switch (tp->mcfg) { + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + rtl8168_disable_pci_offset_180(tp); + break; + } +} + +static void +rtl8168_hw_d3_para(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + unsigned long flags; + + RTL_W16(RxMaxSize, RX_BUF_SIZE); + + switch (tp->mcfg) { + case CFG_METHOD_14: + case CFG_METHOD_15: + case CFG_METHOD_16: + case CFG_METHOD_17: + case CFG_METHOD_18: + case CFG_METHOD_19: + case CFG_METHOD_20: + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + RTL_W8(0xF1, RTL_R8(0xF1) & ~BIT_7); + RTL_W8(Cfg9346, Cfg9346_Unlock); + RTL_W8(Config2, RTL_R8(Config2) & ~BIT_7); + RTL_W8(Config5, RTL_R8(Config5) & ~BIT_0); + RTL_W8(Cfg9346, Cfg9346_Lock); + break; + } + + if (tp->mcfg == CFG_METHOD_21 || tp->mcfg == CFG_METHOD_22 || + tp->mcfg == CFG_METHOD_23 || tp->mcfg == CFG_METHOD_24 || + tp->mcfg == CFG_METHOD_25 || tp->mcfg == CFG_METHOD_26 || + tp->mcfg == CFG_METHOD_27 || tp->mcfg == CFG_METHOD_28) { + rtl8168_eri_write(ioaddr, 0x2F8, 2, 0x0064, ERIAR_ExGMAC); + } + + if (tp->bios_setting & BIT_28) { + if (tp->mcfg == CFG_METHOD_18 || tp->mcfg == CFG_METHOD_19 || + tp->mcfg == CFG_METHOD_20) { + u32 gphy_val; + + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, 0x04, 0x0061); + mdio_write(tp, 0x09, 0x0000); + mdio_write(tp, 0x00, 0x9200); + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B80); + gphy_val = mdio_read(tp, 0x06); + gphy_val &= ~BIT_7; + mdio_write(tp, 0x06, gphy_val); + mdelay(1); + mdio_write(tp, 0x1F, 0x0007); + mdio_write(tp, 0x1E, 0x002C); + gphy_val = mdio_read(tp, 0x16); + gphy_val &= ~BIT_10; + mdio_write(tp, 0x16, gphy_val); + mdio_write(tp, 0x1F, 0x0000); + spin_unlock_irqrestore(&tp->phy_lock, flags); + } + } + + rtl8168_set_pci_99_180_exit_driver_para(dev); + + /*disable ocp phy power saving*/ + if (tp->mcfg == CFG_METHOD_25 || tp->mcfg == CFG_METHOD_26 || + tp->mcfg == CFG_METHOD_27 || tp->mcfg == CFG_METHOD_28 || + tp->mcfg == CFG_METHOD_29 || tp->mcfg == CFG_METHOD_30) { + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write_phy_ocp(tp, 0x0C41, 0x13, 0x0000); + mdio_write_phy_ocp(tp, 0x0C41, 0x13, 0x0500); + spin_unlock_irqrestore(&tp->phy_lock, flags); + } + + rtl8168_disable_rxdvgate(dev); +} + +#define WAKE_ANY (WAKE_PHY | WAKE_MAGIC | WAKE_UCAST | WAKE_BCAST | WAKE_MCAST) + +static void +rtl8168_get_hw_wol(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + u8 options; + u32 csi_tmp; + unsigned long flags; + + + spin_lock_irqsave(&tp->lock, flags); + + tp->wol_opts = 0; + options = RTL_R8(Config1); + if (!(options & PMEnable)) + goto out_unlock; + + options = RTL_R8(Config3); + if (options & LinkUp) + tp->wol_opts |= WAKE_PHY; + + switch (tp->mcfg) { + case CFG_METHOD_16: + case CFG_METHOD_17: + case CFG_METHOD_18: + case CFG_METHOD_19: + case CFG_METHOD_20: + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + csi_tmp = rtl8168_eri_read(ioaddr, 0xDE, 1, ERIAR_ExGMAC); + if (csi_tmp & BIT_0) + tp->wol_opts |= WAKE_MAGIC; + break; + default: + if (options & MagicPacket) + tp->wol_opts |= WAKE_MAGIC; + break; + } + + options = RTL_R8(Config5); + if (options & UWF) + tp->wol_opts |= WAKE_UCAST; + if (options & BWF) + tp->wol_opts |= WAKE_BCAST; + if (options & MWF) + tp->wol_opts |= WAKE_MCAST; + +out_unlock: + tp->wol_enabled = (tp->wol_opts) ? WOL_ENABLED : WOL_DISABLED; + + spin_unlock_irqrestore(&tp->lock, flags); +} + +static void +rtl8168_set_hw_wol(struct net_device *dev, u32 wolopts) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + int i,tmp; + u32 csi_tmp; + static struct { + u32 opt; + u16 reg; + u8 mask; + } cfg[] = { + { WAKE_PHY, Config3, LinkUp }, + { WAKE_UCAST, Config5, UWF }, + { WAKE_BCAST, Config5, BWF }, + { WAKE_MCAST, Config5, MWF }, + { WAKE_ANY, Config5, LanWake }, + { WAKE_MAGIC, Config3, MagicPacket }, + }; + + RTL_W8(Cfg9346, Cfg9346_Unlock); + + switch (tp->mcfg) { + case CFG_METHOD_16: + case CFG_METHOD_17: + case CFG_METHOD_18: + case CFG_METHOD_19: + case CFG_METHOD_20: + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + tmp = ARRAY_SIZE(cfg) - 1; + + csi_tmp = rtl8168_eri_read(ioaddr, 0xDE, 1, ERIAR_ExGMAC); + if (wolopts & WAKE_MAGIC) + csi_tmp |= BIT_0; + else + csi_tmp &= ~BIT_0; + rtl8168_eri_write(ioaddr, 0xDE, 1, csi_tmp, ERIAR_ExGMAC); + break; + default: + tmp = ARRAY_SIZE(cfg); + break; + } + + for (i = 0; i < tmp; i++) { + u8 options = RTL_R8(cfg[i].reg) & ~cfg[i].mask; + if (wolopts & cfg[i].opt) + options |= cfg[i].mask; + RTL_W8(cfg[i].reg, options); + } + + RTL_W8(Cfg9346, Cfg9346_Lock); +} + +static void +rtl8168_powerdown_pll(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + + if (tp->wol_enabled == WOL_ENABLED || tp->DASH || tp->EnableKCPOffload) { + int auto_nego; + int giga_ctrl; + u16 val; + unsigned long flags; + + rtl8168_set_hw_wol(dev, tp->wol_opts); + + if (tp->mcfg == CFG_METHOD_16 || tp->mcfg == CFG_METHOD_17 || + tp->mcfg == CFG_METHOD_21 || tp->mcfg == CFG_METHOD_22 || + tp->mcfg == CFG_METHOD_24 || tp->mcfg == CFG_METHOD_25 || + tp->mcfg == CFG_METHOD_26 || tp->mcfg == CFG_METHOD_23 || + tp->mcfg == CFG_METHOD_27 || tp->mcfg == CFG_METHOD_28 || + tp->mcfg == CFG_METHOD_29 || tp->mcfg == CFG_METHOD_30) { + RTL_W8(Cfg9346, Cfg9346_Unlock); + RTL_W8(Config2, RTL_R8(Config2) | PMSTS_En); + RTL_W8(Cfg9346, Cfg9346_Lock); + } + + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0000); + auto_nego = mdio_read(tp, MII_ADVERTISE); + auto_nego &= ~(ADVERTISE_10HALF | ADVERTISE_10FULL + | ADVERTISE_100HALF | ADVERTISE_100FULL); + + val = mdio_read(tp, MII_LPA); + +#ifdef CONFIG_DOWN_SPEED_100 + auto_nego |= (ADVERTISE_100FULL | ADVERTISE_100HALF | ADVERTISE_10HALF | ADVERTISE_10FULL); +#else + if (val & (LPA_10HALF | LPA_10FULL)) + auto_nego |= (ADVERTISE_10HALF | ADVERTISE_10FULL); + else + auto_nego |= (ADVERTISE_100FULL | ADVERTISE_100HALF | ADVERTISE_10HALF | ADVERTISE_10FULL); +#endif + + if (tp->DASH) + auto_nego |= (ADVERTISE_100FULL | ADVERTISE_100HALF | ADVERTISE_10HALF | ADVERTISE_10FULL); + + if (((tp->mcfg == CFG_METHOD_7) || (tp->mcfg == CFG_METHOD_8)) && (RTL_R16(CPlusCmd) & ASF)) + auto_nego |= (ADVERTISE_100FULL | ADVERTISE_100HALF | ADVERTISE_10HALF | ADVERTISE_10FULL); + + giga_ctrl = mdio_read(tp, MII_CTRL1000) & ~(ADVERTISE_1000HALF | ADVERTISE_1000FULL); + mdio_write(tp, MII_ADVERTISE, auto_nego); + mdio_write(tp, MII_CTRL1000, giga_ctrl); + mdio_write(tp, MII_BMCR, BMCR_RESET | BMCR_ANENABLE | BMCR_ANRESTART); + spin_unlock_irqrestore(&tp->phy_lock, flags); + + RTL_W32(RxConfig, RTL_R32(RxConfig) | AcceptBroadcast | AcceptMulticast | AcceptMyPhys); + + return; + } + + if (tp->DASH) + return; + + if (((tp->mcfg == CFG_METHOD_7) || (tp->mcfg == CFG_METHOD_8)) && (RTL_R16(CPlusCmd) & ASF)) + return; + + rtl8168_phy_power_down(dev); + + switch (tp->mcfg) { + case CFG_METHOD_9: + case CFG_METHOD_10: + case CFG_METHOD_11: + case CFG_METHOD_12: + case CFG_METHOD_13: + case CFG_METHOD_14: + case CFG_METHOD_15: + case CFG_METHOD_17: + case CFG_METHOD_18: + case CFG_METHOD_19: + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + RTL_W8(PMCH, RTL_R8(PMCH) & ~BIT_7); + break; + } +} + +static void rtl8168_powerup_pll(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + + + switch (tp->mcfg) { + case CFG_METHOD_9: + case CFG_METHOD_10: + case CFG_METHOD_11: + case CFG_METHOD_12: + case CFG_METHOD_13: + case CFG_METHOD_14: + case CFG_METHOD_15: + case CFG_METHOD_17: + case CFG_METHOD_18: + case CFG_METHOD_19: + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + RTL_W8(PMCH, RTL_R8(PMCH) | BIT_7 | BIT_6); + break; + } + + rtl8168_phy_power_up(dev); +} + +static void +rtl8168_get_wol(struct net_device *dev, + struct ethtool_wolinfo *wol) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + u8 options; + unsigned long flags; + + wol->wolopts = 0; + + if (tp->mcfg == CFG_METHOD_DEFAULT) { + wol->supported = 0; + return; + } else { + wol->supported = WAKE_ANY; + } + + spin_lock_irqsave(&tp->lock, flags); + + options = RTL_R8(Config1); + if (!(options & PMEnable)) + goto out_unlock; + + wol->wolopts = tp->wol_opts; + +out_unlock: + spin_unlock_irqrestore(&tp->lock, flags); +} + +static int +rtl8168_set_wol(struct net_device *dev, + struct ethtool_wolinfo *wol) +{ + struct rtl8168_private *tp = netdev_priv(dev); + unsigned long flags; + + if (tp->mcfg == CFG_METHOD_DEFAULT) + return -EOPNOTSUPP; + + spin_lock_irqsave(&tp->lock, flags); + + tp->wol_opts = wol->wolopts; + + tp->wol_enabled = (tp->wol_opts) ? WOL_ENABLED : WOL_DISABLED; + + spin_unlock_irqrestore(&tp->lock, flags); + + return 0; +} + +static void +rtl8168_get_drvinfo(struct net_device *dev, + struct ethtool_drvinfo *info) +{ + struct rtl8168_private *tp = netdev_priv(dev); + + strcpy(info->driver, MODULENAME); + strcpy(info->version, RTL8168_VERSION); + strcpy(info->bus_info, pci_name(tp->pci_dev)); + info->regdump_len = R8168_REGS_DUMP_SIZE; + info->eedump_len = tp->eeprom_len; +} + +static int +rtl8168_get_regs_len(struct net_device *dev) +{ + return R8168_REGS_DUMP_SIZE; +} + +static int +rtl8168_set_speed_xmii(struct net_device *dev, + u8 autoneg, + u16 speed, + u8 duplex) +{ + struct rtl8168_private *tp = netdev_priv(dev); + int auto_nego = 0; + int giga_ctrl = 0; + int bmcr_true_force = 0; + unsigned long flags; + + if (tp->mcfg == CFG_METHOD_29 || tp->mcfg == CFG_METHOD_30) { + //Disable Giga Lite + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0A42); + ClearEthPhyBit(tp, 0x14, BIT_9); + mdio_write(tp, 0x1F, 0x0A40); + mdio_write(tp, 0x1F, 0x0000); + spin_unlock_irqrestore(&tp->phy_lock, flags); + } + + if ((speed != SPEED_1000) && + (speed != SPEED_100) && + (speed != SPEED_10)) { + speed = SPEED_1000; + duplex = DUPLEX_FULL; + } + + auto_nego = mdio_read(tp, MII_ADVERTISE); + auto_nego &= ~(ADVERTISE_10HALF | ADVERTISE_10FULL | ADVERTISE_100HALF | ADVERTISE_100FULL | ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM); + + giga_ctrl = mdio_read(tp, MII_CTRL1000); + giga_ctrl &= ~(ADVERTISE_1000HALF | ADVERTISE_1000FULL); + + if ((autoneg == AUTONEG_ENABLE) || (speed == SPEED_1000)) { + /*n-way force*/ + if ((speed == SPEED_10) && (duplex == DUPLEX_HALF)) { + auto_nego |= ADVERTISE_10HALF; + } else if ((speed == SPEED_10) && (duplex == DUPLEX_FULL)) { + auto_nego |= ADVERTISE_10HALF | + ADVERTISE_10FULL; + } else if ((speed == SPEED_100) && (duplex == DUPLEX_HALF)) { + auto_nego |= ADVERTISE_100HALF | + ADVERTISE_10HALF | + ADVERTISE_10FULL; + } else if ((speed == SPEED_100) && (duplex == DUPLEX_FULL)) { + auto_nego |= ADVERTISE_100HALF | + ADVERTISE_100FULL | + ADVERTISE_10HALF | + ADVERTISE_10FULL; + } else if (speed == SPEED_1000) { + giga_ctrl |= ADVERTISE_1000HALF | + ADVERTISE_1000FULL; + + auto_nego |= ADVERTISE_100HALF | + ADVERTISE_100FULL | + ADVERTISE_10HALF | + ADVERTISE_10FULL; + } + + //flow control + if (dev->mtu <= ETH_DATA_LEN) + auto_nego |= ADVERTISE_PAUSE_CAP|ADVERTISE_PAUSE_ASYM; + + tp->phy_auto_nego_reg = auto_nego; + tp->phy_1000_ctrl_reg = giga_ctrl; + + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, MII_ADVERTISE, auto_nego); + mdio_write(tp, MII_CTRL1000, giga_ctrl); + mdio_write(tp, MII_BMCR, BMCR_RESET | BMCR_ANENABLE | BMCR_ANRESTART); + spin_unlock_irqrestore(&tp->phy_lock, flags); + mdelay(20); + } else { + /*true force*/ +#ifndef BMCR_SPEED100 +#define BMCR_SPEED100 0x0040 +#endif + +#ifndef BMCR_SPEED10 +#define BMCR_SPEED10 0x0000 +#endif + if ((speed == SPEED_10) && (duplex == DUPLEX_HALF)) { + bmcr_true_force = BMCR_SPEED10; + } else if ((speed == SPEED_10) && (duplex == DUPLEX_FULL)) { + bmcr_true_force = BMCR_SPEED10 | BMCR_FULLDPLX; + } else if ((speed == SPEED_100) && (duplex == DUPLEX_HALF)) { + bmcr_true_force = BMCR_SPEED100; + } else if ((speed == SPEED_100) && (duplex == DUPLEX_FULL)) { + bmcr_true_force = BMCR_SPEED100 | BMCR_FULLDPLX; + } + + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, MII_BMCR, bmcr_true_force); + spin_unlock_irqrestore(&tp->phy_lock, flags); + } + + tp->autoneg = autoneg; + tp->speed = speed; + tp->duplex = duplex; + + if (tp->mcfg == CFG_METHOD_11) + rtl8168dp_10mbps_gphy_para(dev); + + return 0; +} + +static int +rtl8168_set_speed(struct net_device *dev, + u8 autoneg, + u16 speed, + u8 duplex) +{ + struct rtl8168_private *tp = netdev_priv(dev); + int ret; + + ret = tp->set_speed(dev, autoneg, speed, duplex); + + return ret; +} + +static int +rtl8168_set_settings(struct net_device *dev, + struct ethtool_cmd *cmd) +{ + struct rtl8168_private *tp = netdev_priv(dev); + int ret; + unsigned long flags; + + spin_lock_irqsave(&tp->lock, flags); + ret = rtl8168_set_speed(dev, cmd->autoneg, cmd->speed, cmd->duplex); + spin_unlock_irqrestore(&tp->lock, flags); + + return ret; +} + +#if LINUX_VERSION_CODE < KERNEL_VERSION(3,3,0) +static u32 +rtl8168_get_tx_csum(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + u32 ret; + unsigned long flags; + + spin_lock_irqsave(&tp->lock, flags); + ret = ((dev->features & NETIF_F_IP_CSUM) != 0); + spin_unlock_irqrestore(&tp->lock, flags); + + return ret; +} + +static u32 +rtl8168_get_rx_csum(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + u32 ret; + unsigned long flags; + + spin_lock_irqsave(&tp->lock, flags); + ret = tp->cp_cmd & RxChkSum; + spin_unlock_irqrestore(&tp->lock, flags); + + return ret; +} + +static int +rtl8168_set_tx_csum(struct net_device *dev, + u32 data) +{ + struct rtl8168_private *tp = netdev_priv(dev); + unsigned long flags; + + if (tp->mcfg == CFG_METHOD_DEFAULT) + return -EOPNOTSUPP; + + spin_lock_irqsave(&tp->lock, flags); + + if (data) + dev->features |= NETIF_F_IP_CSUM; + else + dev->features &= ~NETIF_F_IP_CSUM; + + spin_unlock_irqrestore(&tp->lock, flags); + + return 0; +} + +static int +rtl8168_set_rx_csum(struct net_device *dev, + u32 data) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + unsigned long flags; + + if (tp->mcfg == CFG_METHOD_DEFAULT) + return -EOPNOTSUPP; + + spin_lock_irqsave(&tp->lock, flags); + + if (data) + tp->cp_cmd |= RxChkSum; + else + tp->cp_cmd &= ~RxChkSum; + + RTL_W16(CPlusCmd, tp->cp_cmd); + + spin_unlock_irqrestore(&tp->lock, flags); + + return 0; +} +#endif + +#ifdef CONFIG_R8168_VLAN + +static inline u32 +rtl8168_tx_vlan_tag(struct rtl8168_private *tp, + struct sk_buff *skb) +{ + u32 tag; + +#if LINUX_VERSION_CODE < KERNEL_VERSION(3,0,0) + tag = (tp->vlgrp && vlan_tx_tag_present(skb)) ? + TxVlanTag | swab16(vlan_tx_tag_get(skb)) : 0x00; +#elif LINUX_VERSION_CODE < KERNEL_VERSION(4,0,0) + tag = (vlan_tx_tag_present(skb)) ? + TxVlanTag | swab16(vlan_tx_tag_get(skb)) : 0x00; +#else + tag = (skb_vlan_tag_present(skb)) ? + TxVlanTag | swab16(skb_vlan_tag_get(skb)) : 0x00; +#endif + + return tag; +} + +#if LINUX_VERSION_CODE < KERNEL_VERSION(3,0,0) + +static void +rtl8168_vlan_rx_register(struct net_device *dev, + struct vlan_group *grp) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + unsigned long flags; + + spin_lock_irqsave(&tp->lock, flags); + tp->vlgrp = grp; + if (tp->vlgrp) + tp->cp_cmd |= RxVlan; + else + tp->cp_cmd &= ~RxVlan; + RTL_W16(CPlusCmd, tp->cp_cmd); + RTL_R16(CPlusCmd); + spin_unlock_irqrestore(&tp->lock, flags); +} + +#endif + +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,22) +static void +rtl8168_vlan_rx_kill_vid(struct net_device *dev, + unsigned short vid) +{ + struct rtl8168_private *tp = netdev_priv(dev); + unsigned long flags; + + spin_lock_irqsave(&tp->lock, flags); +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21) + if (tp->vlgrp) + tp->vlgrp->vlan_devices[vid] = NULL; +#else + vlan_group_set_device(tp->vlgrp, vid, NULL); +#endif //LINUX_VERSION_CODE < KERNEL_VERSION(2,6,21) + spin_unlock_irqrestore(&tp->lock, flags); +} +#endif //LINUX_VERSION_CODE < KERNEL_VERSION(2,6,22) + +static int +rtl8168_rx_vlan_skb(struct rtl8168_private *tp, + struct RxDesc *desc, + struct sk_buff *skb) +{ + u32 opts2 = le32_to_cpu(desc->opts2); + int ret = -1; + +#if LINUX_VERSION_CODE < KERNEL_VERSION(3,0,0) + if (tp->vlgrp && (opts2 & RxVlanTag)) { + rtl8168_rx_hwaccel_skb(skb, tp->vlgrp, + swab16(opts2 & 0xffff)); + ret = 0; + } +#elif LINUX_VERSION_CODE < KERNEL_VERSION(3,10,0) + if (opts2 & RxVlanTag) + __vlan_hwaccel_put_tag(skb, swab16(opts2 & 0xffff)); +#else + if (opts2 & RxVlanTag) + __vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), swab16(opts2 & 0xffff)); +#endif + + desc->opts2 = 0; + return ret; +} + +#else /* !CONFIG_R8168_VLAN */ + +static inline u32 +rtl8168_tx_vlan_tag(struct rtl8168_private *tp, + struct sk_buff *skb) +{ + return 0; +} + +static int +rtl8168_rx_vlan_skb(struct rtl8168_private *tp, + struct RxDesc *desc, + struct sk_buff *skb) +{ + return -1; +} + +#endif + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,0,0) + +#if LINUX_VERSION_CODE < KERNEL_VERSION(3,3,0) +static u32 rtl8168_fix_features(struct net_device *dev, u32 features) +#else +static netdev_features_t rtl8168_fix_features(struct net_device *dev, + netdev_features_t features) +#endif +{ + struct rtl8168_private *tp = netdev_priv(dev); + unsigned long flags; + + spin_lock_irqsave(&tp->lock, flags); + if (dev->mtu > ETH_DATA_LEN) { + features &= ~NETIF_F_ALL_TSO; + features &= ~NETIF_F_ALL_CSUM; + } + spin_unlock_irqrestore(&tp->lock, flags); + + return features; +} + +#if LINUX_VERSION_CODE < KERNEL_VERSION(3,3,0) +static int rtl8168_hw_set_features(struct net_device *dev, u32 features) +#else +static int rtl8168_hw_set_features(struct net_device *dev, + netdev_features_t features) +#endif +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + + if (features & NETIF_F_RXCSUM) + tp->cp_cmd |= RxChkSum; + else + tp->cp_cmd &= ~RxChkSum; + + if (dev->features & NETIF_F_HW_VLAN_RX) + tp->cp_cmd |= RxVlan; + else + tp->cp_cmd &= ~RxVlan; + + RTL_W16(CPlusCmd, tp->cp_cmd); + RTL_R16(CPlusCmd); + + return 0; +} + +#if LINUX_VERSION_CODE < KERNEL_VERSION(3,3,0) +static int rtl8168_set_features(struct net_device *dev, u32 features) +#else +static int rtl8168_set_features(struct net_device *dev, + netdev_features_t features) +#endif +{ + struct rtl8168_private *tp = netdev_priv(dev); + unsigned long flags; + + spin_lock_irqsave(&tp->lock, flags); + + rtl8168_hw_set_features(dev, features); + + spin_unlock_irqrestore(&tp->lock, flags); + + return 0; +} + +#endif + +static void rtl8168_gset_xmii(struct net_device *dev, + struct ethtool_cmd *cmd) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + u8 status; + unsigned long flags; + + cmd->supported = SUPPORTED_10baseT_Half | + SUPPORTED_10baseT_Full | + SUPPORTED_100baseT_Half | + SUPPORTED_100baseT_Full | + SUPPORTED_1000baseT_Full | + SUPPORTED_Autoneg | + SUPPORTED_TP; + + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0000); + cmd->autoneg = (mdio_read(tp, MII_BMCR) & BMCR_ANENABLE) ? 1 : 0; + spin_unlock_irqrestore(&tp->phy_lock, flags); + cmd->advertising = ADVERTISED_TP | ADVERTISED_Autoneg; + + if (tp->phy_auto_nego_reg & ADVERTISE_10HALF) + cmd->advertising |= ADVERTISED_10baseT_Half; + if (tp->phy_auto_nego_reg & ADVERTISE_10FULL) + cmd->advertising |= ADVERTISED_10baseT_Full; + if (tp->phy_auto_nego_reg & ADVERTISE_100HALF) + cmd->advertising |= ADVERTISED_100baseT_Half; + if (tp->phy_auto_nego_reg & ADVERTISE_100FULL) + cmd->advertising |= ADVERTISED_100baseT_Full; + if (tp->phy_1000_ctrl_reg & ADVERTISE_1000FULL) + cmd->advertising |= ADVERTISED_1000baseT_Full; + + status = RTL_R8(PHYstatus); + + if (status & _1000bpsF) + cmd->speed = SPEED_1000; + else if (status & _100bps) + cmd->speed = SPEED_100; + else if (status & _10bps) + cmd->speed = SPEED_10; + + if (status & TxFlowCtrl) + cmd->advertising |= ADVERTISED_Asym_Pause; + + if (status & RxFlowCtrl) + cmd->advertising |= ADVERTISED_Pause; + + cmd->duplex = ((status & _1000bpsF) || (status & FullDup)) ? + DUPLEX_FULL : DUPLEX_HALF; + + +} + +static int +rtl8168_get_settings(struct net_device *dev, + struct ethtool_cmd *cmd) +{ + struct rtl8168_private *tp = netdev_priv(dev); + + tp->get_settings(dev, cmd); + + return 0; +} + +static void rtl8168_get_regs(struct net_device *dev, struct ethtool_regs *regs, + void *p) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + unsigned int i; + u8 *data = p; + unsigned long flags; + + if (regs->len < R8168_REGS_DUMP_SIZE) + return /* -EINVAL */; + + memset(p, 0, regs->len); + + spin_lock_irqsave(&tp->lock, flags); + for (i = 0; i < R8168_MAC_REGS_SIZE; i++) + *data++ = readb(ioaddr + i); + spin_unlock_irqrestore(&tp->lock, flags); + data = (u8*)p + 256; + + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0000); + for (i = 0; i < R8168_PHY_REGS_SIZE/2; i++) { + *(u16*)data = mdio_read(tp, i); + data += 2; + } + data = (u8*)p + 256 * 2; + + for (i = 0; i < R8168_EPHY_REGS_SIZE/2; i++) { + *(u16*)data = rtl8168_ephy_read(ioaddr, i); + data += 2; + } + data = (u8*)p + 256 * 3; + + switch (tp->mcfg) { + case CFG_METHOD_1: + case CFG_METHOD_2: + case CFG_METHOD_3: + /* RTL8168B does not support Extend GMAC */ + break; + default: + for (i = 0; i < R8168_ERI_REGS_SIZE; i+=4) { + *(u32*)data = rtl8168_eri_read(ioaddr, i , 4, ERIAR_ExGMAC); + data += 4; + } + break; + } + spin_unlock_irqrestore(&tp->phy_lock, flags); +} + +static u32 +rtl8168_get_msglevel(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + + return tp->msg_enable; +} + +static void +rtl8168_set_msglevel(struct net_device *dev, + u32 value) +{ + struct rtl8168_private *tp = netdev_priv(dev); + + tp->msg_enable = value; +} + +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,33) +static int rtl8168_get_stats_count(struct net_device *dev) +{ + return ARRAY_SIZE(rtl8168_gstrings); +} +#else +static int rtl8168_get_sset_count(struct net_device *dev, int sset) +{ + switch (sset) { + case ETH_SS_STATS: + return ARRAY_SIZE(rtl8168_gstrings); + default: + return -EOPNOTSUPP; + } +} +#endif +static void +rtl8168_get_ethtool_stats(struct net_device *dev, + struct ethtool_stats *stats, + u64 *data) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + struct rtl8168_counters *counters; + dma_addr_t paddr; + u32 cmd; + u32 WaitCnt; + unsigned long flags; + + ASSERT_RTNL(); + + counters = tp->tally_vaddr; + paddr = tp->tally_paddr; + if (!counters) + return; + + spin_lock_irqsave(&tp->lock, flags); + RTL_W32(CounterAddrHigh, (u64)paddr >> 32); + cmd = (u64)paddr & DMA_BIT_MASK(32); + RTL_W32(CounterAddrLow, cmd); + RTL_W32(CounterAddrLow, cmd | CounterDump); + + WaitCnt = 0; + while (RTL_R32(CounterAddrLow) & CounterDump) { + udelay(10); + + WaitCnt++; + if (WaitCnt > 20) + break; + } + spin_unlock_irqrestore(&tp->lock, flags); + + data[0] = le64_to_cpu(counters->tx_packets); + data[1] = le64_to_cpu(counters->rx_packets); + data[2] = le64_to_cpu(counters->tx_errors); + data[3] = le32_to_cpu(counters->rx_errors); + data[4] = le16_to_cpu(counters->rx_missed); + data[5] = le16_to_cpu(counters->align_errors); + data[6] = le32_to_cpu(counters->tx_one_collision); + data[7] = le32_to_cpu(counters->tx_multi_collision); + data[8] = le64_to_cpu(counters->rx_unicast); + data[9] = le64_to_cpu(counters->rx_broadcast); + data[10] = le32_to_cpu(counters->rx_multicast); + data[11] = le16_to_cpu(counters->tx_aborted); + data[12] = le16_to_cpu(counters->tx_underun); +} + +static void +rtl8168_get_strings(struct net_device *dev, + u32 stringset, + u8 *data) +{ + switch (stringset) { + case ETH_SS_STATS: + memcpy(data, *rtl8168_gstrings, sizeof(rtl8168_gstrings)); + break; + } +} +static int rtl_get_eeprom_len(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + + return tp->eeprom_len; +} + +static int rtl_get_eeprom(struct net_device *dev, struct ethtool_eeprom *eeprom, u8 *buf) +{ + struct rtl8168_private *tp = netdev_priv(dev); + int i,j,ret; + int start_w, end_w; + int VPD_addr, VPD_data; + u32 *eeprom_buff; + u16 tmp; + void __iomem *ioaddr = tp->mmio_addr; + + if (tp->eeprom_type == EEPROM_TYPE_NONE) { + dev_printk(KERN_DEBUG, &tp->pci_dev->dev, "Detect none EEPROM\n"); + return -EOPNOTSUPP; + } else if (eeprom->len == 0 || (eeprom->offset+eeprom->len) > tp->eeprom_len) { + dev_printk(KERN_DEBUG, &tp->pci_dev->dev, "Invalid parameter\n"); + return -EINVAL; + } + + switch (tp->mcfg) { + case CFG_METHOD_9: + case CFG_METHOD_10: + VPD_addr = 0xCE; + VPD_data = 0xD0; + break; + + case CFG_METHOD_1: + case CFG_METHOD_2: + case CFG_METHOD_3: + case CFG_METHOD_11: + case CFG_METHOD_12: + case CFG_METHOD_13: + return -EOPNOTSUPP; + default: + VPD_addr = 0xD2; + VPD_data = 0xD4; + break; + } + + start_w = eeprom->offset >> 2; + end_w = (eeprom->offset + eeprom->len - 1) >> 2; + + eeprom_buff = kmalloc(sizeof(u32)*(end_w - start_w + 1), GFP_KERNEL); + if (!eeprom_buff) + return -ENOMEM; + + RTL_W8(Cfg9346, Cfg9346_Unlock); + ret = -EFAULT; + for (i=start_w; i<=end_w; i++) { + pci_write_config_word(tp->pci_dev, VPD_addr, (u16)i*4); + ret = -EFAULT; + for (j = 0; j < 10; j++) { + udelay(400); + pci_read_config_word(tp->pci_dev, VPD_addr, &tmp); + if (tmp&0x8000) { + ret = 0; + break; + } + } + + if (ret) + break; + + pci_read_config_dword(tp->pci_dev, VPD_data, &eeprom_buff[i-start_w]); + } + RTL_W8(Cfg9346, Cfg9346_Lock); + + if (!ret) + memcpy(buf, (u8 *)eeprom_buff + (eeprom->offset & 3), eeprom->len); + + kfree(eeprom_buff); + + return ret; +} + +#undef ethtool_op_get_link +#define ethtool_op_get_link _kc_ethtool_op_get_link +u32 _kc_ethtool_op_get_link(struct net_device *dev) +{ + return netif_carrier_ok(dev) ? 1 : 0; +} + +#if LINUX_VERSION_CODE < KERNEL_VERSION(3,3,0) +#undef ethtool_op_get_sg +#define ethtool_op_get_sg _kc_ethtool_op_get_sg +u32 _kc_ethtool_op_get_sg(struct net_device *dev) +{ +#ifdef NETIF_F_SG + return (dev->features & NETIF_F_SG) != 0; +#else + return 0; +#endif +} + +#undef ethtool_op_set_sg +#define ethtool_op_set_sg _kc_ethtool_op_set_sg +int _kc_ethtool_op_set_sg(struct net_device *dev, u32 data) +{ + struct rtl8168_private *tp = netdev_priv(dev); + + if (tp->mcfg == CFG_METHOD_DEFAULT) + return -EOPNOTSUPP; + +#ifdef NETIF_F_SG + if (data) + dev->features |= NETIF_F_SG; + else + dev->features &= ~NETIF_F_SG; +#endif + + return 0; +} +#endif + +static const struct ethtool_ops rtl8168_ethtool_ops = { + .get_drvinfo = rtl8168_get_drvinfo, + .get_regs_len = rtl8168_get_regs_len, + .get_link = ethtool_op_get_link, + .get_settings = rtl8168_get_settings, + .set_settings = rtl8168_set_settings, + .get_msglevel = rtl8168_get_msglevel, + .set_msglevel = rtl8168_set_msglevel, +#if LINUX_VERSION_CODE < KERNEL_VERSION(3,3,0) + .get_rx_csum = rtl8168_get_rx_csum, + .set_rx_csum = rtl8168_set_rx_csum, + .get_tx_csum = rtl8168_get_tx_csum, + .set_tx_csum = rtl8168_set_tx_csum, + .get_sg = ethtool_op_get_sg, + .set_sg = ethtool_op_set_sg, +#ifdef NETIF_F_TSO + .get_tso = ethtool_op_get_tso, + .set_tso = ethtool_op_set_tso, +#endif +#endif + .get_regs = rtl8168_get_regs, + .get_wol = rtl8168_get_wol, + .set_wol = rtl8168_set_wol, + .get_strings = rtl8168_get_strings, +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,33) + .get_stats_count = rtl8168_get_stats_count, +#else + .get_sset_count = rtl8168_get_sset_count, +#endif + .get_ethtool_stats = rtl8168_get_ethtool_stats, +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,23) +#ifdef ETHTOOL_GPERMADDR + .get_perm_addr = ethtool_op_get_perm_addr, +#endif +#endif //LINUX_VERSION_CODE < KERNEL_VERSION(2,6,23) + .get_eeprom = rtl_get_eeprom, + .get_eeprom_len = rtl_get_eeprom_len, +#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,5,0) + .get_ts_info = ethtool_op_get_ts_info, +#endif //LINUX_VERSION_CODE >= KERNEL_VERSION(3,5,0) +}; + + +static int rtl8168_enable_EEE(struct rtl8168_private *tp) +{ + void __iomem *ioaddr = tp->mmio_addr; + int ret; + u16 data; + u16 PhyRegValue; + u32 WaitCnt; + unsigned long flags; + + ret = 0; + switch (tp->mcfg) { + case CFG_METHOD_14: + case CFG_METHOD_15: + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0007); + mdio_write(tp, 0x1E, 0x0020); + data = mdio_read(tp, 0x15) | 0x0100; + mdio_write(tp, 0x15, data); + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B85); + data = mdio_read(tp, 0x06) | 0x2000; + mdio_write(tp, 0x06, data); + mdio_write(tp, 0x1F, 0x0006); + mdio_write(tp, 0x00, 0x5A30); + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, 0x0D, 0x0007); + mdio_write(tp, 0x0E, 0x003C); + mdio_write(tp, 0x0D, 0x4007); + mdio_write(tp, 0x0E, 0x0006); + mdio_write(tp, 0x0D, 0x0000); + spin_unlock_irqrestore(&tp->phy_lock, flags); + if ((RTL_R8(Config4)&0x40) && (RTL_R8(0x6D) & BIT_7)) { + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8AC8); + mdio_write(tp, 0x06, RTL_R16(CustomLED)); + mdio_write(tp, 0x05, 0x8B82); + data = mdio_read(tp, 0x06) | 0x0010; + mdio_write(tp, 0x05, 0x8B82); + mdio_write(tp, 0x06, data); + mdio_write(tp, 0x1F, 0x0000); + spin_unlock_irqrestore(&tp->phy_lock, flags); + } + break; + + case CFG_METHOD_16: + case CFG_METHOD_17: + spin_lock_irqsave(&tp->phy_lock, flags); + data = rtl8168_eri_read(ioaddr,0x1B0 ,4,ERIAR_ExGMAC) | 0x0003; + rtl8168_eri_write(ioaddr, 0x1B0, 4, data, ERIAR_ExGMAC); + mdio_write(tp,0x1F , 0x0004); + mdio_write(tp,0x1F , 0x0007); + mdio_write(tp,0x1E , 0x0020); + data = mdio_read(tp, 0x15)|0x0100; + mdio_write(tp,0x15 , data); + mdio_write(tp,0x1F , 0x0002); + mdio_write(tp,0x1F , 0x0005); + mdio_write(tp,0x05 , 0x8B85); + data = mdio_read(tp, 0x06)|0x2000; + mdio_write(tp,0x06 , data); + mdio_write(tp,0x1F , 0x0000); + mdio_write(tp,0x0D , 0x0007); + mdio_write(tp,0x0E , 0x003C); + mdio_write(tp,0x0D , 0x4007); + mdio_write(tp,0x0E , 0x0006); + mdio_write(tp,0x1D , 0x0000); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + + case CFG_METHOD_18: + case CFG_METHOD_19: + case CFG_METHOD_20: + spin_lock_irqsave(&tp->phy_lock, flags); + data = rtl8168_eri_read(ioaddr,0x1B0 ,4,ERIAR_ExGMAC); + data |= BIT_1 | BIT_0; + rtl8168_eri_write(ioaddr, 0x1B0, 4, data, ERIAR_ExGMAC); + mdio_write(tp, 0x1F, 0x0007); + mdio_write(tp, 0x1e, 0x0020); + data = mdio_read(tp, 0x15); + data |= BIT_8; + mdio_write(tp, 0x15, data); + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B85); + data = mdio_read(tp, 0x06); + data |= BIT_13; + mdio_write(tp, 0x06, data); + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, 0x0D, 0x0007); + mdio_write(tp, 0x0E, 0x003C); + mdio_write(tp, 0x0D, 0x4007); + mdio_write(tp, 0x0E, 0x0006); + mdio_write(tp, 0x0D, 0x0000); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + spin_lock_irqsave(&tp->phy_lock, flags); + data = rtl8168_eri_read(ioaddr, 0x1B0, 4, ERIAR_ExGMAC); + data |= BIT_1 | BIT_0; + rtl8168_eri_write(ioaddr, 0x1B0, 4, data, ERIAR_ExGMAC); + mdio_write(tp, 0x1F, 0x0A43); + data = mdio_read(tp, 0x11); + mdio_write(tp, 0x11, data | BIT_4); + mdio_write(tp, 0x1F, 0x0A5D); + mdio_write(tp, 0x10, 0x0006); + mdio_write(tp, 0x1F, 0x0000); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + + default: +// dev_printk(KERN_DEBUG, &tp->pci_dev->dev, "Not Support EEE\n"); + ret = -EOPNOTSUPP; + break; + } + + switch (tp->mcfg) { + case CFG_METHOD_29: + case CFG_METHOD_30: + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0A4A); + SetEthPhyBit(tp, 0x11, BIT_9); + mdio_write(tp, 0x1F, 0x0A42); + SetEthPhyBit(tp, 0x14, BIT_7); + mdio_write(tp, 0x1F, 0x0000); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + } + + /*Advanced EEE*/ + switch (tp->mcfg) { + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_29: + case CFG_METHOD_30: + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp,0x1F, 0x0B82); + SetEthPhyBit(tp, 0x10, BIT_4); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp,0x1F, 0x0B80); + WaitCnt = 0; + do { + PhyRegValue = mdio_read(tp, 0x10); + PhyRegValue &= 0x0040; + udelay(100); + WaitCnt++; + } while(PhyRegValue != 0x0040 && WaitCnt <1000); + + mdio_write(tp, 0x1F, 0x0000); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + } + + switch (tp->mcfg) { + case CFG_METHOD_25: + rtl8168_eri_write(ioaddr, 0x1EA, 1, 0xFA, ERIAR_ExGMAC); + + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0A43); + data = mdio_read(tp, 0x10); + if (data & BIT_10) { + mdio_write(tp, 0x1F, 0x0A42); + data = mdio_read(tp, 0x16); + data &= ~(BIT_1); + mdio_write(tp, 0x16, data); + } else { + mdio_write(tp, 0x1F, 0x0A42); + data = mdio_read(tp, 0x16); + data |= BIT_1; + mdio_write(tp, 0x16, data); + } + mdio_write(tp, 0x1F, 0x0000); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + case CFG_METHOD_26: + data = mac_ocp_read(tp, 0xE052); + data |= BIT_0; + mac_ocp_write(tp, 0xE052, data); + data = mac_ocp_read(tp, 0xE056); + data &= 0xFF0F; + data |= (BIT_4 | BIT_5 | BIT_6); + mac_ocp_write(tp, 0xE056, data); + + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0A43); + data = mdio_read(tp, 0x10); + if (data & BIT_10) { + mdio_write(tp, 0x1F, 0x0A42); + data = mdio_read(tp, 0x16); + data &= ~(BIT_1); + mdio_write(tp, 0x16, data); + } else { + mdio_write(tp, 0x1F, 0x0A42); + data = mdio_read(tp, 0x16); + data |= BIT_1; + mdio_write(tp, 0x16, data); + } + mdio_write(tp, 0x1F, 0x0000); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + case CFG_METHOD_27: + case CFG_METHOD_28: + OOB_mutex_lock(tp); + data = mac_ocp_read(tp, 0xE052); + data |= BIT_0; + mac_ocp_write(tp, 0xE052, data); + OOB_mutex_unlock(tp); + data = mac_ocp_read(tp, 0xE056); + data &= 0xFF0F; + data |= (BIT_4 | BIT_5 | BIT_6); + mac_ocp_write(tp, 0xE056, data); + break; + case CFG_METHOD_29: + case CFG_METHOD_30: + data = mac_ocp_read(tp, 0xE052); + data |= BIT_0; + mac_ocp_write(tp, 0xE052, data); + + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0A43); + data = mdio_read(tp, 0x10) | BIT_15; + mdio_write(tp, 0x10, data); + + mdio_write(tp, 0x1F, 0x0A44); + data = mdio_read( tp, 0x11 ) | BIT_12 | BIT_13| BIT_14; + mdio_write(tp, 0x11, data); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + } + + switch (tp->mcfg) { + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_29: + case CFG_METHOD_30: + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0B82); + ClearEthPhyBit(tp, 0x10, BIT_4); + mdio_write(tp, 0x1F, 0x0000); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + } + + return ret; +} + +static int rtl8168_disable_EEE(struct rtl8168_private *tp) +{ + void __iomem *ioaddr = tp->mmio_addr; + int ret; + u16 data; + u16 PhyRegValue; + u32 WaitCnt; + unsigned long flags; + + ret = 0; + switch (tp->mcfg) { + case CFG_METHOD_14: + case CFG_METHOD_15: + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B85); + data = mdio_read(tp, 0x06) & ~0x2000; + mdio_write(tp, 0x06, data); + mdio_write(tp, 0x1F, 0x0007); + mdio_write(tp, 0x1E, 0x0020); + data = mdio_read(tp, 0x15) & ~0x0100; + mdio_write(tp, 0x15, data); + mdio_write(tp, 0x1F, 0x0006); + mdio_write(tp, 0x00, 0x5A00); + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, 0x0D, 0x0007); + mdio_write(tp, 0x0E, 0x003C); + mdio_write(tp, 0x0D, 0x4007); + mdio_write(tp, 0x0E, 0x0000); + mdio_write(tp, 0x0D, 0x0000); + mdio_write(tp, 0x1F, 0x0000); + spin_unlock_irqrestore(&tp->phy_lock, flags); + if (RTL_R8(Config4) & 0x40) { + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B82); + data = mdio_read(tp, 0x06) & ~0x0010; + mdio_write(tp, 0x05, 0x8B82); + mdio_write(tp, 0x06, data); + mdio_write(tp, 0x1F, 0x0000); + spin_unlock_irqrestore(&tp->phy_lock, flags); + } + break; + + case CFG_METHOD_16: + case CFG_METHOD_17: + spin_lock_irqsave(&tp->phy_lock, flags); + data = rtl8168_eri_read(ioaddr,0x1B0 ,4,ERIAR_ExGMAC)& ~0x0003; + rtl8168_eri_write(ioaddr, 0x1B0, 4, data, ERIAR_ExGMAC); + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B85); + data = mdio_read(tp, 0x06) & ~0x2000; + mdio_write(tp, 0x06, data); + mdio_write(tp, 0x1F, 0x0004); + mdio_write(tp, 0x1F, 0x0007); + mdio_write(tp, 0x1E, 0x0020); + data = mdio_read(tp, 0x15) & ~0x0100; + mdio_write(tp,0x15 , data); + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, 0x0D, 0x0007); + mdio_write(tp, 0x0E, 0x003C); + mdio_write(tp, 0x0D, 0x4007); + mdio_write(tp, 0x0E, 0x0000); + mdio_write(tp, 0x0D, 0x0000); + mdio_write(tp, 0x1F, 0x0000); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + + case CFG_METHOD_18: + case CFG_METHOD_19: + case CFG_METHOD_20: + spin_lock_irqsave(&tp->phy_lock, flags); + data = rtl8168_eri_read(ioaddr,0x1B0 ,4,ERIAR_ExGMAC); + data &= ~(BIT_1 | BIT_0); + rtl8168_eri_write(ioaddr, 0x1B0, 4, data, ERIAR_ExGMAC); + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B85); + data = mdio_read(tp, 0x06); + data &= ~BIT_13; + mdio_write(tp, 0x06, data); + mdio_write(tp, 0x1F, 0x0007); + mdio_write(tp, 0x1e, 0x0020); + data = mdio_read(tp, 0x15); + data &= ~BIT_8; + mdio_write(tp, 0x15, data); + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, 0x0D, 0x0007); + mdio_write(tp, 0x0E, 0x003C); + mdio_write(tp, 0x0D, 0x4007); + mdio_write(tp, 0x0E, 0x0000); + mdio_write(tp, 0x0D, 0x0000); + mdio_write(tp, 0x1F, 0x0000); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + spin_lock_irqsave(&tp->phy_lock, flags); + data = rtl8168_eri_read(ioaddr, 0x1B0, 4, ERIAR_ExGMAC); + data &= ~(BIT_1 | BIT_0); + rtl8168_eri_write(ioaddr, 0x1B0, 4, data, ERIAR_ExGMAC); + mdio_write(tp, 0x1F, 0x0A43); + data = mdio_read(tp, 0x11); + mdio_write(tp, 0x11, data & ~BIT_4); + mdio_write(tp, 0x1F, 0x0A5D); + mdio_write(tp, 0x10, 0x0000); + mdio_write(tp, 0x1F, 0x0000); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + + default: +// dev_printk(KERN_DEBUG, &tp->pci_dev->dev, "Not Support EEE\n"); + ret = -EOPNOTSUPP; + break; + } + + switch (tp->mcfg) { + case CFG_METHOD_29: + case CFG_METHOD_30: + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0A42); + ClearEthPhyBit(tp, 0x14, BIT_7); + mdio_write(tp, 0x1F, 0x0A4A); + ClearEthPhyBit(tp, 0x11, BIT_9); + mdio_write(tp, 0x1F, 0x0000); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + } + + /*Advanced EEE*/ + switch (tp->mcfg) { + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_29: + case CFG_METHOD_30: + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp,0x1F, 0x0B82); + SetEthPhyBit(tp, 0x10, BIT_4); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp,0x1F, 0x0B80); + WaitCnt = 0; + do { + PhyRegValue = mdio_read(tp, 0x10); + PhyRegValue &= 0x0040; + udelay(100); + WaitCnt++; + } while(PhyRegValue != 0x0040 && WaitCnt <1000); + + mdio_write(tp, 0x1F, 0x0000); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + } + + switch (tp->mcfg) { + case CFG_METHOD_25: + rtl8168_eri_write(ioaddr, 0x1EA, 1, 0x00, ERIAR_ExGMAC); + + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0A42); + data = mdio_read(tp, 0x16); + data &= ~(BIT_1); + mdio_write(tp, 0x16, data); + mdio_write(tp, 0x1F, 0x0000); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + case CFG_METHOD_26: + data = mac_ocp_read(tp, 0xE052); + data &= ~(BIT_0); + mac_ocp_write(tp, 0xE052, data); + + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0A42); + data = mdio_read(tp, 0x16); + data &= ~(BIT_1); + mdio_write(tp, 0x16, data); + mdio_write(tp, 0x1F, 0x0000); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + case CFG_METHOD_27: + case CFG_METHOD_28: + data = mac_ocp_read(tp, 0xE052); + data &= ~(BIT_0); + mac_ocp_write(tp, 0xE052, data); + break; + case CFG_METHOD_29: + case CFG_METHOD_30: + data = mac_ocp_read(tp, 0xE052); + data &= ~(BIT_0); + mac_ocp_write(tp, 0xE052, data); + + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0A43); + data = mdio_read(tp, 0x10) & ~(BIT_15); + mdio_write(tp, 0x10, data); + + mdio_write(tp, 0x1F, 0x0A44); + data = mdio_read( tp, 0x11 ) & ~(BIT_12 | BIT_13 | BIT_14); + mdio_write(tp, 0x11, data); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + } + + switch (tp->mcfg) { + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_29: + case CFG_METHOD_30: + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0B82); + ClearEthPhyBit(tp, 0x10, BIT_4); + mdio_write(tp, 0x1F, 0x0000); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + } + + return ret; +} + +#if 0 + +static int rtl8168_enable_green_feature(struct rtl8168_private *tp) +{ + u16 gphy_val; + unsigned long flags; + + switch (tp->mcfg) { + case CFG_METHOD_14: + case CFG_METHOD_15: + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0003); + gphy_val = mdio_read(tp, 0x10) | 0x0400; + mdio_write(tp, 0x10, gphy_val); + gphy_val = mdio_read(tp, 0x19) | 0x0001; + mdio_write(tp, 0x19, gphy_val); + mdio_write(tp, 0x1F, 0x0005); + gphy_val = mdio_read(tp, 0x01) & ~0x0100; + mdio_write(tp, 0x01, gphy_val); + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, 0x00, 0x9200); + spin_unlock_irqrestore(&tp->phy_lock, flags); + mdelay(20); + break; + + case CFG_METHOD_17: + case CFG_METHOD_18: + case CFG_METHOD_19: + case CFG_METHOD_20: + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1f, 0x0003); + gphy_val = mdio_read(tp, 0x10); + gphy_val |= BIT_10; + mdio_write(tp, 0x10, gphy_val); + gphy_val = mdio_read(tp, 0x19); + gphy_val |= BIT_0; + mdio_write(tp, 0x19, gphy_val); + mdio_write(tp, 0x1F, 0x0005); + gphy_val = mdio_read(tp, 0x01); + gphy_val |= BIT_8; + mdio_write(tp, 0x01, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x00, 0x9200); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + case CFG_METHOD_21: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x8011); + if (tp->mcfg == CFG_METHOD_29 || tp->mcfg == CFG_METHOD_30) { + SetEthPhyBit( tp, 0x14, BIT_15 ); + } else { + SetEthPhyBit( tp, 0x14, BIT_14 ); + } + mdio_write(tp, 0x1F, 0x0A40); + mdio_write(tp, 0x00, 0x9200); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + + default: + dev_printk(KERN_DEBUG, &tp->pci_dev->dev, "Not Support Green Feature\n"); + break; + } + + return 0; +} + +static int rtl8168_disable_green_feature(struct rtl8168_private *tp) +{ + u16 gphy_val; + unsigned long flags; + + switch (tp->mcfg) { + case CFG_METHOD_14: + case CFG_METHOD_15: + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0005); + gphy_val = mdio_read(tp, 0x01) | 0x0100; + mdio_write(tp, 0x01, gphy_val); + mdio_write(tp, 0x1F, 0x0003); + gphy_val = mdio_read(tp, 0x10) & ~0x0400; + mdio_write(tp, 0x10, gphy_val); + gphy_val = mdio_read(tp, 0x19) & ~0x0001; + mdio_write(tp, 0x19, gphy_val); + mdio_write(tp, 0x1F, 0x0002); + gphy_val = mdio_read(tp, 0x06) & ~0x7000; + gphy_val |= 0x3000; + mdio_write(tp, 0x06, gphy_val); + gphy_val = mdio_read(tp, 0x0D) & 0x0700; + gphy_val |= 0x0500; + mdio_write(tp, 0x0D, gphy_val); + mdio_write(tp, 0x1F, 0x0000); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + + case CFG_METHOD_17: + case CFG_METHOD_18: + case CFG_METHOD_19: + case CFG_METHOD_20: + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1f, 0x0003); + gphy_val = mdio_read(tp, 0x19); + gphy_val &= ~BIT_0; + mdio_write(tp, 0x19, gphy_val); + gphy_val = mdio_read(tp, 0x10); + gphy_val &= ~BIT_10; + mdio_write(tp, 0x10, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + case CFG_METHOD_21: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x8011); + if (tp->mcfg == CFG_METHOD_29 || tp->mcfg == CFG_METHOD_30) { + ClearEthPhyBit( tp, 0x14, BIT_15 ); + } else { + ClearEthPhyBit( tp, 0x14, BIT_14 ); + } + mdio_write(tp, 0x1F, 0x0A40); + mdio_write(tp, 0x00, 0x9200); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + + default: + dev_printk(KERN_DEBUG, &tp->pci_dev->dev, "Not Support Green Feature\n"); + break; + } + + return 0; +} + +#endif + +static void rtl8168_get_mac_version(struct rtl8168_private *tp, void __iomem *ioaddr) +{ + u32 reg,val32; + u32 ICVerID; + + val32 = RTL_R32(TxConfig) ; + reg = val32 & 0x7c800000; + ICVerID = val32 & 0x00700000; + + switch (reg) { + case 0x30000000: + tp->mcfg = CFG_METHOD_1; + tp->efuse_ver = EFUSE_NOT_SUPPORT; + break; + case 0x38000000: + if (ICVerID == 0x00000000) { + tp->mcfg = CFG_METHOD_2; + } else if (ICVerID == 0x00500000) { + tp->mcfg = CFG_METHOD_3; + } else { + tp->mcfg = CFG_METHOD_3; + tp->HwIcVerUnknown = TRUE; + } + tp->efuse_ver = EFUSE_NOT_SUPPORT; + break; + case 0x3C000000: + if (ICVerID == 0x00000000) { + tp->mcfg = CFG_METHOD_4; + } else if (ICVerID == 0x00200000) { + tp->mcfg = CFG_METHOD_5; + } else if (ICVerID == 0x00400000) { + tp->mcfg = CFG_METHOD_6; + } else { + tp->mcfg = CFG_METHOD_6; + tp->HwIcVerUnknown = TRUE; + } + tp->efuse_ver = EFUSE_NOT_SUPPORT; + break; + case 0x3C800000: + if (ICVerID == 0x00100000) { + tp->mcfg = CFG_METHOD_7; + } else if (ICVerID == 0x00300000) { + tp->mcfg = CFG_METHOD_8; + } else { + tp->mcfg = CFG_METHOD_8; + tp->HwIcVerUnknown = TRUE; + } + tp->efuse_ver = EFUSE_NOT_SUPPORT; + break; + case 0x28000000: + if (ICVerID == 0x00100000) { + tp->mcfg = CFG_METHOD_9; + } else if (ICVerID == 0x00300000) { + tp->mcfg = CFG_METHOD_10; + } else { + tp->mcfg = CFG_METHOD_10; + tp->HwIcVerUnknown = TRUE; + } + tp->efuse_ver = EFUSE_SUPPORT_V1; + break; + case 0x28800000: + if (ICVerID == 0x00000000) { + tp->mcfg = CFG_METHOD_11; + } else if (ICVerID == 0x00200000) { + tp->mcfg = CFG_METHOD_12; + RTL_W32(0xD0, RTL_R32(0xD0) | 0x00020000); + } else if (ICVerID == 0x00300000) { + tp->mcfg = CFG_METHOD_13; + } else { + tp->mcfg = CFG_METHOD_13; + tp->HwIcVerUnknown = TRUE; + } + tp->efuse_ver = EFUSE_SUPPORT_V1; + break; + case 0x2C000000: + if (ICVerID == 0x00100000) { + tp->mcfg = CFG_METHOD_14; + } else if (ICVerID == 0x00200000) { + tp->mcfg = CFG_METHOD_15; + } else { + tp->mcfg = CFG_METHOD_15; + tp->HwIcVerUnknown = TRUE; + } + tp->efuse_ver = EFUSE_SUPPORT_V2; + break; + case 0x2C800000: + if (ICVerID == 0x00000000) { + tp->mcfg = CFG_METHOD_16; + } else if (ICVerID == 0x00100000) { + tp->mcfg = CFG_METHOD_17; + } else { + tp->mcfg = CFG_METHOD_17; + tp->HwIcVerUnknown = TRUE; + } + tp->efuse_ver = EFUSE_SUPPORT_V3; + break; + case 0x48000000: + if (ICVerID == 0x00000000) { + tp->mcfg = CFG_METHOD_18; + } else if (ICVerID == 0x00100000) { + tp->mcfg = CFG_METHOD_19; + } else { + tp->mcfg = CFG_METHOD_19; + tp->HwIcVerUnknown = TRUE; + } + tp->efuse_ver = EFUSE_SUPPORT_V3; + break; + case 0x48800000: + if (ICVerID == 0x00000000) { + tp->mcfg = CFG_METHOD_20; + } else { + tp->mcfg = CFG_METHOD_20; + tp->HwIcVerUnknown = TRUE; + } + + tp->efuse_ver = EFUSE_SUPPORT_V3; + break; + case 0x4C000000: + if (ICVerID == 0x00000000) { + tp->mcfg = CFG_METHOD_21; + } else if (ICVerID == 0x00100000) { + tp->mcfg = CFG_METHOD_22; + } else { + tp->mcfg = CFG_METHOD_22; + tp->HwIcVerUnknown = TRUE; + } + tp->efuse_ver = EFUSE_SUPPORT_V3; + break; + case 0x50000000: + if (ICVerID == 0x00000000) { + tp->mcfg = CFG_METHOD_23; + } else if (ICVerID == 0x00100000) { + tp->mcfg = CFG_METHOD_27; + } else if (ICVerID == 0x00200000) { + tp->mcfg = CFG_METHOD_28; + } else { + tp->mcfg = CFG_METHOD_28; + tp->HwIcVerUnknown = TRUE; + } + tp->efuse_ver = EFUSE_SUPPORT_V3; + break; + case 0x50800000: + if (ICVerID == 0x00000000) { + tp->mcfg = CFG_METHOD_24; + } else if (ICVerID == 0x00100000) { + tp->mcfg = CFG_METHOD_25; + } else { + tp->mcfg = CFG_METHOD_25; + tp->HwIcVerUnknown = TRUE; + } + tp->efuse_ver = EFUSE_SUPPORT_V3; + break; + case 0x5C800000: + if (ICVerID == 0x00000000) { + tp->mcfg = CFG_METHOD_26; + } else { + tp->mcfg = CFG_METHOD_26; + tp->HwIcVerUnknown = TRUE; + } + + tp->efuse_ver = EFUSE_SUPPORT_V3; + break; + case 0x54000000: + if (ICVerID == 0x00000000) { + tp->mcfg = CFG_METHOD_29; + } else if (ICVerID == 0x00100000) { + tp->mcfg = CFG_METHOD_30; + } else { + tp->mcfg = CFG_METHOD_30; + tp->HwIcVerUnknown = TRUE; + } + + tp->efuse_ver = EFUSE_SUPPORT_V3; + break; + default: + printk("unknown chip version (%x)\n",reg); + tp->mcfg = CFG_METHOD_DEFAULT; + tp->HwIcVerUnknown = TRUE; + tp->efuse_ver = EFUSE_NOT_SUPPORT; + break; + } +} + +static void +rtl8168_print_mac_version(struct rtl8168_private *tp) +{ + int i; + for (i = ARRAY_SIZE(rtl_chip_info) - 1; i >= 0; i--) { + if (tp->mcfg == rtl_chip_info[i].mcfg) { + dprintk("Realtek PCIe GBE Family Controller mcfg = %04d\n", + rtl_chip_info[i].mcfg); + return; + } + } + + dprintk("mac_version == Unknown\n"); +} + +static u8 rtl8168_calc_efuse_dummy_bit(u16 reg) +{ + int s,a,b; + u8 dummyBitPos = 0; + + + s=reg% 32; + a=s % 16; + b=s/16; + + if (s/16) { + dummyBitPos = (u8)(16-a); + } else { + dummyBitPos = (u8)a; + } + + return dummyBitPos; +} + +static u32 rtl8168_decode_efuse_cmd(struct rtl8168_private *tp, u32 DwCmd) +{ + u16 reg = (u16)((DwCmd & 0x00FE0000) >> 17); + u32 DummyPos = rtl8168_calc_efuse_dummy_bit(reg); + u32 DeCodeDwCmd = DwCmd; + u32 Dw17BitData; + + + if(tp->efuse_ver < 3) { + DeCodeDwCmd = (DwCmd>>(DummyPos+1))< 0) { + DeCodeDwCmd |= ((DwCmd<<(32-DummyPos))>>(32-DummyPos)); + } + } else { + reg = (u16)((DwCmd & 0x007F0000) >> 16); + DummyPos = rtl8168_calc_efuse_dummy_bit(reg); + Dw17BitData = ((DwCmd & BIT_23) >> 23); + Dw17BitData <<= 16; + Dw17BitData |= (DwCmd & 0x0000FFFF); + DeCodeDwCmd = (Dw17BitData>>(DummyPos+1))< 0) { + DeCodeDwCmd |= ((Dw17BitData<<(32-DummyPos))>>(32-DummyPos)); + } + } + + return DeCodeDwCmd; +} + +static u8 rtl8168_efuse_read(struct rtl8168_private *tp, u16 reg) +{ + void __iomem *ioaddr = tp->mmio_addr; + u8 efuse_data = 0; + u32 temp; + int cnt; + + if (tp->efuse_ver == EFUSE_NOT_SUPPORT) + return EFUSE_READ_FAIL; + + if (tp->efuse_ver == EFUSE_SUPPORT_V1) { + temp = EFUSE_READ | ((reg & EFUSE_Reg_Mask) << EFUSE_Reg_Shift); + RTL_W32(EFUSEAR, temp); + + cnt = 0; + do { + udelay(100); + temp = RTL_R32(EFUSEAR); + cnt++; + } while (!(temp & EFUSE_READ_OK) && (cnt < EFUSE_Check_Cnt)); + + if (cnt == EFUSE_Check_Cnt) + efuse_data = EFUSE_READ_FAIL; + else + efuse_data = (u8)(RTL_R32(EFUSEAR) & EFUSE_Data_Mask); + } else if (tp->efuse_ver == EFUSE_SUPPORT_V2) { + temp = (reg/2) & 0x03ff; + temp <<= 17; + temp |= EFUSE_READ; + RTL_W32(EFUSEAR, temp); + + cnt = 0; + do { + udelay(100); + temp = RTL_R32(EFUSEAR); + cnt++; + } while (!(temp & EFUSE_READ_OK) && (cnt < EFUSE_Check_Cnt)); + + if (cnt == EFUSE_Check_Cnt) { + efuse_data = EFUSE_READ_FAIL; + } else { + temp = RTL_R32(EFUSEAR); + temp = rtl8168_decode_efuse_cmd(tp, temp); + + if(reg%2) { + temp >>= 8; + efuse_data = (u8)temp; + } else { + efuse_data = (u8)temp; + } + } + + } else if (tp->efuse_ver == EFUSE_SUPPORT_V3) { + temp = (reg/2) & 0x03ff; + temp <<= 16; + temp |= EFUSE_READ; + RTL_W32(EFUSEAR, temp); + + cnt = 0; + do { + udelay(100); + temp = RTL_R32(EFUSEAR); + cnt++; + } while (!(temp & EFUSE_READ_OK) && (cnt < EFUSE_Check_Cnt)); + + if (cnt == EFUSE_Check_Cnt) { + efuse_data = EFUSE_READ_FAIL; + } else { + temp = RTL_R32(EFUSEAR); + temp = rtl8168_decode_efuse_cmd(tp, temp); + + if(reg%2) { + temp >>= 8; + efuse_data = (u8)temp; + } else { + efuse_data = (u8)temp; + } + } + } + + udelay(20); + + return efuse_data; +} + +static void +rtl8168_tally_counter_addr_fill(struct rtl8168_private *tp) +{ + void __iomem *ioaddr = tp->mmio_addr; + + if (!tp->tally_paddr) + return; + + RTL_W32(CounterAddrHigh, (u64)tp->tally_paddr >> 32); + RTL_W32(CounterAddrLow, (u64)tp->tally_paddr & (DMA_BIT_MASK(32))); +} + +static void +rtl8168_tally_counter_clear(struct rtl8168_private *tp) +{ + void __iomem *ioaddr = tp->mmio_addr; + + if (tp->mcfg == CFG_METHOD_1 || tp->mcfg == CFG_METHOD_2 || + tp->mcfg == CFG_METHOD_3 ) + return; + + if (!tp->tally_paddr) + return; + + RTL_W32(CounterAddrHigh, (u64)tp->tally_paddr >> 32); + RTL_W32(CounterAddrLow, (u64)tp->tally_paddr & (DMA_BIT_MASK(32) | BIT_0)); +} + +static int +rtl8168_is_ups_resume(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + + return (mac_ocp_read(tp, 0xD408) & BIT_0); +} + +static void +rtl8168_clear_ups_resume_bit(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + + mac_ocp_write(tp, 0xD408, mac_ocp_read(tp, 0xD408) & ~(BIT_0)); +} + +static void +rtl8168_wait_phy_ups_resume(struct net_device *dev, u16 PhyState) +{ + struct rtl8168_private *tp = netdev_priv(dev); + u16 TmpPhyState; + int i=0; + + do { + TmpPhyState = mdio_read_phy_ocp(tp, 0x0A42, 0x10); + TmpPhyState &= 0x7; + mdelay(1); + i++; + } while ((i < 100) && (TmpPhyState != PhyState)); + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,18) + WARN_ON_ONCE(i == 100); +#endif +} + +void +EnableNowIsOob(struct rtl8168_private *tp) +{ + void __iomem *ioaddr = tp->mmio_addr; + + if( tp->HwSuppNowIsOobVer == 1 ) { + RTL_W8(MCUCmd_reg, RTL_R8(MCUCmd_reg) | Now_is_oob); + } +} + +void +DisableNowIsOob(struct rtl8168_private *tp) +{ + void __iomem *ioaddr = tp->mmio_addr; + + if( tp->HwSuppNowIsOobVer == 1 ) { + RTL_W8(MCUCmd_reg, RTL_R8(MCUCmd_reg) & ~Now_is_oob); + } +} + +static void +rtl8168_exit_oob(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + u16 data16; + + switch (tp->mcfg) { + case CFG_METHOD_23: + case CFG_METHOD_27: + case CFG_METHOD_28: + Dash2DisableTxRx(dev); + break; + } + + switch (tp->mcfg) { + case CFG_METHOD_11: + case CFG_METHOD_12: + case CFG_METHOD_13: + case CFG_METHOD_23: + case CFG_METHOD_27: + case CFG_METHOD_28: + if (tp->DASH) { + rtl8168_driver_stop(tp); + rtl8168_driver_start(tp); +#ifdef ENABLE_DASH_SUPPORT + DashHwInit(dev); +#endif + } + break; + } + + //Disable realwow function + switch (tp->mcfg) { + case CFG_METHOD_18: + case CFG_METHOD_19: + RTL_W32(MACOCP, 0xE5A90000); + RTL_W32(MACOCP, 0xF2100010); + break; + case CFG_METHOD_20: + RTL_W32(MACOCP, 0xE5A90000); + RTL_W32(MACOCP, 0xE4640000); + RTL_W32(MACOCP, 0xF2100010); + break; + case CFG_METHOD_21: + case CFG_METHOD_22: + RTL_W32(MACOCP, 0x605E0000); + RTL_W32(MACOCP, (0xE05E << 16) | (RTL_R32(MACOCP) & 0xFFFE)); + RTL_W32(MACOCP, 0xE9720000); + RTL_W32(MACOCP, 0xF2140010); + break; + case CFG_METHOD_26: + RTL_W32(MACOCP, 0xE05E00FF); + RTL_W32(MACOCP, 0xE9720000); + mac_ocp_write(tp, 0xE428, 0x0010); + break; + } + +#ifndef ENABLE_REALWOW_SUPPORT + switch (tp->mcfg) { + case CFG_METHOD_21: + case CFG_METHOD_22: + rtl8168_eri_write(ioaddr, 0x174, 2, 0x0000, ERIAR_ExGMAC); + mac_ocp_write(tp, 0xE428, 0x0010); + break; + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_28: + rtl8168_eri_write(ioaddr, 0x174, 2, 0x00FF, ERIAR_ExGMAC); + mac_ocp_write(tp, 0xE428, 0x0010); + break; + case CFG_METHOD_29: + case CFG_METHOD_30: { + u32 csi_tmp; + csi_tmp = rtl8168_eri_read(ioaddr, 0x174, 2, ERIAR_ExGMAC); + csi_tmp &= ~(BIT_8); + csi_tmp |= (BIT_15); + rtl8168_eri_write(ioaddr, 0x174, 2, csi_tmp, ERIAR_ExGMAC); + mac_ocp_write(tp, 0xE428, 0x0010); + } + break; + } +#endif //ENABLE_REALWOW_SUPPORT + +#ifdef ENABLE_REALWOW_SUPPORT + realwow_hw_init(dev); +#endif + + rtl8168_nic_reset(dev); + + switch (tp->mcfg) { + case CFG_METHOD_20: + rtl8168_wait_ll_share_fifo_ready(dev); + + data16 = mac_ocp_read(tp, 0xD4DE) | BIT_15; + mac_ocp_write(tp, 0xD4DE, data16); + + rtl8168_wait_ll_share_fifo_ready(dev); + break; + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + DisableNowIsOob(tp); + + data16 = mac_ocp_read(tp, 0xE8DE) & ~BIT_14; + mac_ocp_write(tp, 0xE8DE, data16); + rtl8168_wait_ll_share_fifo_ready(dev); + + data16 = mac_ocp_read(tp, 0xE8DE) | BIT_15; + mac_ocp_write(tp, 0xE8DE, data16); + + rtl8168_wait_ll_share_fifo_ready(dev); + break; + } + + //wait ups resume (phy state 2) + switch (tp->mcfg) { + case CFG_METHOD_29: + case CFG_METHOD_30: + if (rtl8168_is_ups_resume(dev)) { + unsigned long flags; + + spin_lock_irqsave(&tp->phy_lock, flags); + + rtl8168_wait_phy_ups_resume(dev, 2); + + spin_unlock_irqrestore(&tp->phy_lock, flags); + + rtl8168_clear_ups_resume_bit(dev); + } + break; + }; +} + +void +rtl8168_hw_disable_mac_mcu_bps(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + + switch (tp->mcfg) { + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + mac_ocp_write(tp, 0xFC28, 0x0000); + mac_ocp_write(tp, 0xFC2A, 0x0000); + mac_ocp_write(tp, 0xFC2C, 0x0000); + mac_ocp_write(tp, 0xFC2E, 0x0000); + mac_ocp_write(tp, 0xFC30, 0x0000); + mac_ocp_write(tp, 0xFC32, 0x0000); + mac_ocp_write(tp, 0xFC34, 0x0000); + mac_ocp_write(tp, 0xFC36, 0x0000); + mdelay(3); + mac_ocp_write(tp, 0xFC26, 0x0000); + break; + } +} + +static void +rtl8168_hw_mac_mcu_config(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + + if (tp->NotWrMcuPatchCode == TRUE) return; + + if (tp->mcfg == CFG_METHOD_21) { + mac_ocp_write(tp, 0xE43C, 0x0000); + mac_ocp_write(tp, 0xE43E, 0x0000); + + mac_ocp_write(tp, 0xE434, 0x0004); + mac_ocp_write(tp, 0xE43C, 0x0004); + + rtl8168_hw_disable_mac_mcu_bps(dev); + + mac_ocp_write( tp, 0xF800, 0xE008 ); + mac_ocp_write( tp, 0xF802, 0xE01B ); + mac_ocp_write( tp, 0xF804, 0xE01D ); + mac_ocp_write( tp, 0xF806, 0xE01F ); + mac_ocp_write( tp, 0xF808, 0xE022 ); + mac_ocp_write( tp, 0xF80A, 0xE025 ); + mac_ocp_write( tp, 0xF80C, 0xE031 ); + mac_ocp_write( tp, 0xF80E, 0xE04D ); + mac_ocp_write( tp, 0xF810, 0x49D2 ); + mac_ocp_write( tp, 0xF812, 0xF10D ); + mac_ocp_write( tp, 0xF814, 0x766C ); + mac_ocp_write( tp, 0xF816, 0x49E2 ); + mac_ocp_write( tp, 0xF818, 0xF00A ); + mac_ocp_write( tp, 0xF81A, 0x1EC0 ); + mac_ocp_write( tp, 0xF81C, 0x8EE1 ); + mac_ocp_write( tp, 0xF81E, 0xC60A ); + mac_ocp_write( tp, 0xF820, 0x77C0 ); + mac_ocp_write( tp, 0xF822, 0x4870 ); + mac_ocp_write( tp, 0xF824, 0x9FC0 ); + mac_ocp_write( tp, 0xF826, 0x1EA0 ); + mac_ocp_write( tp, 0xF828, 0xC707 ); + mac_ocp_write( tp, 0xF82A, 0x8EE1 ); + mac_ocp_write( tp, 0xF82C, 0x9D6C ); + mac_ocp_write( tp, 0xF82E, 0xC603 ); + mac_ocp_write( tp, 0xF830, 0xBE00 ); + mac_ocp_write( tp, 0xF832, 0xB416 ); + mac_ocp_write( tp, 0xF834, 0x0076 ); + mac_ocp_write( tp, 0xF836, 0xE86C ); + mac_ocp_write( tp, 0xF838, 0xC602 ); + mac_ocp_write( tp, 0xF83A, 0xBE00 ); + mac_ocp_write( tp, 0xF83C, 0xA000 ); + mac_ocp_write( tp, 0xF83E, 0xC602 ); + mac_ocp_write( tp, 0xF840, 0xBE00 ); + mac_ocp_write( tp, 0xF842, 0x0000 ); + mac_ocp_write( tp, 0xF844, 0x1B76 ); + mac_ocp_write( tp, 0xF846, 0xC202 ); + mac_ocp_write( tp, 0xF848, 0xBA00 ); + mac_ocp_write( tp, 0xF84A, 0x059C ); + mac_ocp_write( tp, 0xF84C, 0x1B76 ); + mac_ocp_write( tp, 0xF84E, 0xC602 ); + mac_ocp_write( tp, 0xF850, 0xBE00 ); + mac_ocp_write( tp, 0xF852, 0x065A ); + mac_ocp_write( tp, 0xF854, 0x74E6 ); + mac_ocp_write( tp, 0xF856, 0x1B78 ); + mac_ocp_write( tp, 0xF858, 0x46DC ); + mac_ocp_write( tp, 0xF85A, 0x1300 ); + mac_ocp_write( tp, 0xF85C, 0xF005 ); + mac_ocp_write( tp, 0xF85E, 0x74F8 ); + mac_ocp_write( tp, 0xF860, 0x48C3 ); + mac_ocp_write( tp, 0xF862, 0x48C4 ); + mac_ocp_write( tp, 0xF864, 0x8CF8 ); + mac_ocp_write( tp, 0xF866, 0x64E7 ); + mac_ocp_write( tp, 0xF868, 0xC302 ); + mac_ocp_write( tp, 0xF86A, 0xBB00 ); + mac_ocp_write( tp, 0xF86C, 0x06A0 ); + mac_ocp_write( tp, 0xF86E, 0x74E4 ); + mac_ocp_write( tp, 0xF870, 0x49C5 ); + mac_ocp_write( tp, 0xF872, 0xF106 ); + mac_ocp_write( tp, 0xF874, 0x49C6 ); + mac_ocp_write( tp, 0xF876, 0xF107 ); + mac_ocp_write( tp, 0xF878, 0x48C8 ); + mac_ocp_write( tp, 0xF87A, 0x48C9 ); + mac_ocp_write( tp, 0xF87C, 0xE011 ); + mac_ocp_write( tp, 0xF87E, 0x48C9 ); + mac_ocp_write( tp, 0xF880, 0x4848 ); + mac_ocp_write( tp, 0xF882, 0xE00E ); + mac_ocp_write( tp, 0xF884, 0x4848 ); + mac_ocp_write( tp, 0xF886, 0x49C7 ); + mac_ocp_write( tp, 0xF888, 0xF00A ); + mac_ocp_write( tp, 0xF88A, 0x48C9 ); + mac_ocp_write( tp, 0xF88C, 0xC60D ); + mac_ocp_write( tp, 0xF88E, 0x1D1F ); + mac_ocp_write( tp, 0xF890, 0x8DC2 ); + mac_ocp_write( tp, 0xF892, 0x1D00 ); + mac_ocp_write( tp, 0xF894, 0x8DC3 ); + mac_ocp_write( tp, 0xF896, 0x1D11 ); + mac_ocp_write( tp, 0xF898, 0x8DC0 ); + mac_ocp_write( tp, 0xF89A, 0xE002 ); + mac_ocp_write( tp, 0xF89C, 0x4849 ); + mac_ocp_write( tp, 0xF89E, 0x94E5 ); + mac_ocp_write( tp, 0xF8A0, 0xC602 ); + mac_ocp_write( tp, 0xF8A2, 0xBE00 ); + mac_ocp_write( tp, 0xF8A4, 0x01F0 ); + mac_ocp_write( tp, 0xF8A6, 0xE434 ); + mac_ocp_write( tp, 0xF8A8, 0x49D9 ); + mac_ocp_write( tp, 0xF8AA, 0xF01B ); + mac_ocp_write( tp, 0xF8AC, 0xC31E ); + mac_ocp_write( tp, 0xF8AE, 0x7464 ); + mac_ocp_write( tp, 0xF8B0, 0x49C4 ); + mac_ocp_write( tp, 0xF8B2, 0xF114 ); + mac_ocp_write( tp, 0xF8B4, 0xC31B ); + mac_ocp_write( tp, 0xF8B6, 0x6460 ); + mac_ocp_write( tp, 0xF8B8, 0x14FA ); + mac_ocp_write( tp, 0xF8BA, 0xFA02 ); + mac_ocp_write( tp, 0xF8BC, 0xE00F ); + mac_ocp_write( tp, 0xF8BE, 0xC317 ); + mac_ocp_write( tp, 0xF8C0, 0x7460 ); + mac_ocp_write( tp, 0xF8C2, 0x49C0 ); + mac_ocp_write( tp, 0xF8C4, 0xF10B ); + mac_ocp_write( tp, 0xF8C6, 0xC311 ); + mac_ocp_write( tp, 0xF8C8, 0x7462 ); + mac_ocp_write( tp, 0xF8CA, 0x48C1 ); + mac_ocp_write( tp, 0xF8CC, 0x9C62 ); + mac_ocp_write( tp, 0xF8CE, 0x4841 ); + mac_ocp_write( tp, 0xF8D0, 0x9C62 ); + mac_ocp_write( tp, 0xF8D2, 0xC30A ); + mac_ocp_write( tp, 0xF8D4, 0x1C04 ); + mac_ocp_write( tp, 0xF8D6, 0x8C60 ); + mac_ocp_write( tp, 0xF8D8, 0xE004 ); + mac_ocp_write( tp, 0xF8DA, 0x1C15 ); + mac_ocp_write( tp, 0xF8DC, 0xC305 ); + mac_ocp_write( tp, 0xF8DE, 0x8C60 ); + mac_ocp_write( tp, 0xF8E0, 0xC602 ); + mac_ocp_write( tp, 0xF8E2, 0xBE00 ); + mac_ocp_write( tp, 0xF8E4, 0x0384 ); + mac_ocp_write( tp, 0xF8E6, 0xE434 ); + mac_ocp_write( tp, 0xF8E8, 0xE030 ); + mac_ocp_write( tp, 0xF8EA, 0xE61C ); + mac_ocp_write( tp, 0xF8EC, 0xE906 ); + + mac_ocp_write( tp, 0xFC26, 0x8000 ); + + mac_ocp_write( tp, 0xFC28, 0x0075 ); + mac_ocp_write( tp, 0xFC2E, 0x059B ); + mac_ocp_write( tp, 0xFC30, 0x0659 ); + mac_ocp_write( tp, 0xFC32, 0x0000 ); + mac_ocp_write( tp, 0xFC34, 0x0000 ); + mac_ocp_write( tp, 0xFC36, 0x0000 ); + } else if (tp->mcfg == CFG_METHOD_24) { + rtl8168_hw_disable_mac_mcu_bps(dev); + + mac_ocp_write( tp, 0xF800, 0xE008 ); + mac_ocp_write( tp, 0xF802, 0xE011 ); + mac_ocp_write( tp, 0xF804, 0xE015 ); + mac_ocp_write( tp, 0xF806, 0xE018 ); + mac_ocp_write( tp, 0xF808, 0xE01B ); + mac_ocp_write( tp, 0xF80A, 0xE027 ); + mac_ocp_write( tp, 0xF80C, 0xE043 ); + mac_ocp_write( tp, 0xF80E, 0xE065 ); + mac_ocp_write( tp, 0xF810, 0x49E2 ); + mac_ocp_write( tp, 0xF812, 0xF005 ); + mac_ocp_write( tp, 0xF814, 0x49EA ); + mac_ocp_write( tp, 0xF816, 0xF003 ); + mac_ocp_write( tp, 0xF818, 0xC404 ); + mac_ocp_write( tp, 0xF81A, 0xBC00 ); + mac_ocp_write( tp, 0xF81C, 0xC403 ); + mac_ocp_write( tp, 0xF81E, 0xBC00 ); + mac_ocp_write( tp, 0xF820, 0x0496 ); + mac_ocp_write( tp, 0xF822, 0x051A ); + mac_ocp_write( tp, 0xF824, 0x1D01 ); + mac_ocp_write( tp, 0xF826, 0x8DE8 ); + mac_ocp_write( tp, 0xF828, 0xC602 ); + mac_ocp_write( tp, 0xF82A, 0xBE00 ); + mac_ocp_write( tp, 0xF82C, 0x0206 ); + mac_ocp_write( tp, 0xF82E, 0x1B76 ); + mac_ocp_write( tp, 0xF830, 0xC202 ); + mac_ocp_write( tp, 0xF832, 0xBA00 ); + mac_ocp_write( tp, 0xF834, 0x058A ); + mac_ocp_write( tp, 0xF836, 0x1B76 ); + mac_ocp_write( tp, 0xF838, 0xC602 ); + mac_ocp_write( tp, 0xF83A, 0xBE00 ); + mac_ocp_write( tp, 0xF83C, 0x0648 ); + mac_ocp_write( tp, 0xF83E, 0x74E6 ); + mac_ocp_write( tp, 0xF840, 0x1B78 ); + mac_ocp_write( tp, 0xF842, 0x46DC ); + mac_ocp_write( tp, 0xF844, 0x1300 ); + mac_ocp_write( tp, 0xF846, 0xF005 ); + mac_ocp_write( tp, 0xF848, 0x74F8 ); + mac_ocp_write( tp, 0xF84A, 0x48C3 ); + mac_ocp_write( tp, 0xF84C, 0x48C4 ); + mac_ocp_write( tp, 0xF84E, 0x8CF8 ); + mac_ocp_write( tp, 0xF850, 0x64E7 ); + mac_ocp_write( tp, 0xF852, 0xC302 ); + mac_ocp_write( tp, 0xF854, 0xBB00 ); + mac_ocp_write( tp, 0xF856, 0x068E ); + mac_ocp_write( tp, 0xF858, 0x74E4 ); + mac_ocp_write( tp, 0xF85A, 0x49C5 ); + mac_ocp_write( tp, 0xF85C, 0xF106 ); + mac_ocp_write( tp, 0xF85E, 0x49C6 ); + mac_ocp_write( tp, 0xF860, 0xF107 ); + mac_ocp_write( tp, 0xF862, 0x48C8 ); + mac_ocp_write( tp, 0xF864, 0x48C9 ); + mac_ocp_write( tp, 0xF866, 0xE011 ); + mac_ocp_write( tp, 0xF868, 0x48C9 ); + mac_ocp_write( tp, 0xF86A, 0x4848 ); + mac_ocp_write( tp, 0xF86C, 0xE00E ); + mac_ocp_write( tp, 0xF86E, 0x4848 ); + mac_ocp_write( tp, 0xF870, 0x49C7 ); + mac_ocp_write( tp, 0xF872, 0xF00A ); + mac_ocp_write( tp, 0xF874, 0x48C9 ); + mac_ocp_write( tp, 0xF876, 0xC60D ); + mac_ocp_write( tp, 0xF878, 0x1D1F ); + mac_ocp_write( tp, 0xF87A, 0x8DC2 ); + mac_ocp_write( tp, 0xF87C, 0x1D00 ); + mac_ocp_write( tp, 0xF87E, 0x8DC3 ); + mac_ocp_write( tp, 0xF880, 0x1D11 ); + mac_ocp_write( tp, 0xF882, 0x8DC0 ); + mac_ocp_write( tp, 0xF884, 0xE002 ); + mac_ocp_write( tp, 0xF886, 0x4849 ); + mac_ocp_write( tp, 0xF888, 0x94E5 ); + mac_ocp_write( tp, 0xF88A, 0xC602 ); + mac_ocp_write( tp, 0xF88C, 0xBE00 ); + mac_ocp_write( tp, 0xF88E, 0x0238 ); + mac_ocp_write( tp, 0xF890, 0xE434 ); + mac_ocp_write( tp, 0xF892, 0x49D9 ); + mac_ocp_write( tp, 0xF894, 0xF01B ); + mac_ocp_write( tp, 0xF896, 0xC31E ); + mac_ocp_write( tp, 0xF898, 0x7464 ); + mac_ocp_write( tp, 0xF89A, 0x49C4 ); + mac_ocp_write( tp, 0xF89C, 0xF114 ); + mac_ocp_write( tp, 0xF89E, 0xC31B ); + mac_ocp_write( tp, 0xF8A0, 0x6460 ); + mac_ocp_write( tp, 0xF8A2, 0x14FA ); + mac_ocp_write( tp, 0xF8A4, 0xFA02 ); + mac_ocp_write( tp, 0xF8A6, 0xE00F ); + mac_ocp_write( tp, 0xF8A8, 0xC317 ); + mac_ocp_write( tp, 0xF8AA, 0x7460 ); + mac_ocp_write( tp, 0xF8AC, 0x49C0 ); + mac_ocp_write( tp, 0xF8AE, 0xF10B ); + mac_ocp_write( tp, 0xF8B0, 0xC311 ); + mac_ocp_write( tp, 0xF8B2, 0x7462 ); + mac_ocp_write( tp, 0xF8B4, 0x48C1 ); + mac_ocp_write( tp, 0xF8B6, 0x9C62 ); + mac_ocp_write( tp, 0xF8B8, 0x4841 ); + mac_ocp_write( tp, 0xF8BA, 0x9C62 ); + mac_ocp_write( tp, 0xF8BC, 0xC30A ); + mac_ocp_write( tp, 0xF8BE, 0x1C04 ); + mac_ocp_write( tp, 0xF8C0, 0x8C60 ); + mac_ocp_write( tp, 0xF8C2, 0xE004 ); + mac_ocp_write( tp, 0xF8C4, 0x1C15 ); + mac_ocp_write( tp, 0xF8C6, 0xC305 ); + mac_ocp_write( tp, 0xF8C8, 0x8C60 ); + mac_ocp_write( tp, 0xF8CA, 0xC602 ); + mac_ocp_write( tp, 0xF8CC, 0xBE00 ); + mac_ocp_write( tp, 0xF8CE, 0x0374 ); + mac_ocp_write( tp, 0xF8D0, 0xE434 ); + mac_ocp_write( tp, 0xF8D2, 0xE030 ); + mac_ocp_write( tp, 0xF8D4, 0xE61C ); + mac_ocp_write( tp, 0xF8D6, 0xE906 ); + mac_ocp_write( tp, 0xF8D8, 0xC602 ); + mac_ocp_write( tp, 0xF8DA, 0xBE00 ); + mac_ocp_write( tp, 0xF8DC, 0x0000 ); + + mac_ocp_write( tp, 0xFC26, 0x8000 ); + + mac_ocp_write( tp, 0xFC28, 0x0493 ); + mac_ocp_write( tp, 0xFC2A, 0x0205 ); + mac_ocp_write( tp, 0xFC2C, 0x0589 ); + mac_ocp_write( tp, 0xFC2E, 0x0647 ); + mac_ocp_write( tp, 0xFC30, 0x0000 ); + mac_ocp_write( tp, 0xFC32, 0x0215 ); + mac_ocp_write( tp, 0xFC34, 0x0285 ); + } else if (tp->mcfg == CFG_METHOD_25) { + rtl8168_hw_disable_mac_mcu_bps(dev); + + mac_ocp_write( tp, 0xF800, 0xE008 ); + mac_ocp_write( tp, 0xF802, 0xE00A ); + mac_ocp_write( tp, 0xF804, 0xE01D ); + mac_ocp_write( tp, 0xF806, 0xE033 ); + mac_ocp_write( tp, 0xF808, 0xE042 ); + mac_ocp_write( tp, 0xF80A, 0xE044 ); + mac_ocp_write( tp, 0xF80C, 0xE046 ); + mac_ocp_write( tp, 0xF80E, 0xE048 ); + mac_ocp_write( tp, 0xF810, 0xC602 ); + mac_ocp_write( tp, 0xF812, 0xBE00 ); + mac_ocp_write( tp, 0xF814, 0x0000 ); + mac_ocp_write( tp, 0xF816, 0xC513 ); + mac_ocp_write( tp, 0xF818, 0x64A0 ); + mac_ocp_write( tp, 0xF81A, 0x49C1 ); + mac_ocp_write( tp, 0xF81C, 0xF00A ); + mac_ocp_write( tp, 0xF81E, 0x1CEA ); + mac_ocp_write( tp, 0xF820, 0x2242 ); + mac_ocp_write( tp, 0xF822, 0x0402 ); + mac_ocp_write( tp, 0xF824, 0xC50B ); + mac_ocp_write( tp, 0xF826, 0x9CA2 ); + mac_ocp_write( tp, 0xF828, 0x1C11 ); + mac_ocp_write( tp, 0xF82A, 0x9CA0 ); + mac_ocp_write( tp, 0xF82C, 0xC506 ); + mac_ocp_write( tp, 0xF82E, 0xBD00 ); + mac_ocp_write( tp, 0xF830, 0x7444 ); + mac_ocp_write( tp, 0xF832, 0xC502 ); + mac_ocp_write( tp, 0xF834, 0xBD00 ); + mac_ocp_write( tp, 0xF836, 0x0A30 ); + mac_ocp_write( tp, 0xF838, 0x0A46 ); + mac_ocp_write( tp, 0xF83A, 0xE434 ); + mac_ocp_write( tp, 0xF83C, 0xE096 ); + mac_ocp_write( tp, 0xF83E, 0x49D9 ); + mac_ocp_write( tp, 0xF840, 0xF00F ); + mac_ocp_write( tp, 0xF842, 0xC512 ); + mac_ocp_write( tp, 0xF844, 0x74A0 ); + mac_ocp_write( tp, 0xF846, 0x48C8 ); + mac_ocp_write( tp, 0xF848, 0x48CA ); + mac_ocp_write( tp, 0xF84A, 0x9CA0 ); + mac_ocp_write( tp, 0xF84C, 0xC50F ); + mac_ocp_write( tp, 0xF84E, 0x1B00 ); + mac_ocp_write( tp, 0xF850, 0x9BA0 ); + mac_ocp_write( tp, 0xF852, 0x1B1C ); + mac_ocp_write( tp, 0xF854, 0x483F ); + mac_ocp_write( tp, 0xF856, 0x9BA2 ); + mac_ocp_write( tp, 0xF858, 0x1B04 ); + mac_ocp_write( tp, 0xF85A, 0xC5F0 ); + mac_ocp_write( tp, 0xF85C, 0x9BA0 ); + mac_ocp_write( tp, 0xF85E, 0xC602 ); + mac_ocp_write( tp, 0xF860, 0xBE00 ); + mac_ocp_write( tp, 0xF862, 0x03DE ); + mac_ocp_write( tp, 0xF864, 0xE434 ); + mac_ocp_write( tp, 0xF866, 0xE096 ); + mac_ocp_write( tp, 0xF868, 0xE860 ); + mac_ocp_write( tp, 0xF86A, 0xDE20 ); + mac_ocp_write( tp, 0xF86C, 0xC50F ); + mac_ocp_write( tp, 0xF86E, 0x76A4 ); + mac_ocp_write( tp, 0xF870, 0x49E3 ); + mac_ocp_write( tp, 0xF872, 0xF007 ); + mac_ocp_write( tp, 0xF874, 0x49C0 ); + mac_ocp_write( tp, 0xF876, 0xF103 ); + mac_ocp_write( tp, 0xF878, 0xC607 ); + mac_ocp_write( tp, 0xF87A, 0xBE00 ); + mac_ocp_write( tp, 0xF87C, 0xC606 ); + mac_ocp_write( tp, 0xF87E, 0xBE00 ); + mac_ocp_write( tp, 0xF880, 0xC602 ); + mac_ocp_write( tp, 0xF882, 0xBE00 ); + mac_ocp_write( tp, 0xF884, 0x0A88 ); + mac_ocp_write( tp, 0xF886, 0x0A64 ); + mac_ocp_write( tp, 0xF888, 0x0A68 ); + mac_ocp_write( tp, 0xF88A, 0xDC00 ); + mac_ocp_write( tp, 0xF88C, 0xC602 ); + mac_ocp_write( tp, 0xF88E, 0xBE00 ); + mac_ocp_write( tp, 0xF890, 0x0000 ); + mac_ocp_write( tp, 0xF892, 0xC602 ); + mac_ocp_write( tp, 0xF894, 0xBE00 ); + mac_ocp_write( tp, 0xF896, 0x0000 ); + mac_ocp_write( tp, 0xF898, 0xC602 ); + mac_ocp_write( tp, 0xF89A, 0xBE00 ); + mac_ocp_write( tp, 0xF89C, 0x0000 ); + mac_ocp_write( tp, 0xF89E, 0xC602 ); + mac_ocp_write( tp, 0xF8A0, 0xBE00 ); + mac_ocp_write( tp, 0xF8A2, 0x0000 ); + + mac_ocp_write( tp, 0xFC26, 0x8000 ); + + mac_ocp_write( tp, 0xFC2A, 0x0A2F ); + mac_ocp_write( tp, 0xFC2C, 0x0297 ); + mac_ocp_write( tp, 0xFC2E, 0x0A61 ); + } else if (tp->mcfg == CFG_METHOD_26) { + rtl8168_hw_disable_mac_mcu_bps(dev); + + mac_ocp_write( tp, 0xF800, 0xE008 ); + mac_ocp_write( tp, 0xF802, 0xE00A ); + mac_ocp_write( tp, 0xF804, 0xE00C ); + mac_ocp_write( tp, 0xF806, 0xE00E ); + mac_ocp_write( tp, 0xF808, 0xE027 ); + mac_ocp_write( tp, 0xF80A, 0xE04F ); + mac_ocp_write( tp, 0xF80C, 0xE05E ); + mac_ocp_write( tp, 0xF80E, 0xE065 ); + mac_ocp_write( tp, 0xF810, 0xC602 ); + mac_ocp_write( tp, 0xF812, 0xBE00 ); + mac_ocp_write( tp, 0xF814, 0x0000 ); + mac_ocp_write( tp, 0xF816, 0xC502 ); + mac_ocp_write( tp, 0xF818, 0xBD00 ); + mac_ocp_write( tp, 0xF81A, 0x074C ); + mac_ocp_write( tp, 0xF81C, 0xC302 ); + mac_ocp_write( tp, 0xF81E, 0xBB00 ); + mac_ocp_write( tp, 0xF820, 0x080A ); + mac_ocp_write( tp, 0xF822, 0x6420 ); + mac_ocp_write( tp, 0xF824, 0x48C2 ); + mac_ocp_write( tp, 0xF826, 0x8C20 ); + mac_ocp_write( tp, 0xF828, 0xC516 ); + mac_ocp_write( tp, 0xF82A, 0x64A4 ); + mac_ocp_write( tp, 0xF82C, 0x49C0 ); + mac_ocp_write( tp, 0xF82E, 0xF009 ); + mac_ocp_write( tp, 0xF830, 0x74A2 ); + mac_ocp_write( tp, 0xF832, 0x8CA5 ); + mac_ocp_write( tp, 0xF834, 0x74A0 ); + mac_ocp_write( tp, 0xF836, 0xC50E ); + mac_ocp_write( tp, 0xF838, 0x9CA2 ); + mac_ocp_write( tp, 0xF83A, 0x1C11 ); + mac_ocp_write( tp, 0xF83C, 0x9CA0 ); + mac_ocp_write( tp, 0xF83E, 0xE006 ); + mac_ocp_write( tp, 0xF840, 0x74F8 ); + mac_ocp_write( tp, 0xF842, 0x48C4 ); + mac_ocp_write( tp, 0xF844, 0x8CF8 ); + mac_ocp_write( tp, 0xF846, 0xC404 ); + mac_ocp_write( tp, 0xF848, 0xBC00 ); + mac_ocp_write( tp, 0xF84A, 0xC403 ); + mac_ocp_write( tp, 0xF84C, 0xBC00 ); + mac_ocp_write( tp, 0xF84E, 0x0BF2 ); + mac_ocp_write( tp, 0xF850, 0x0C0A ); + mac_ocp_write( tp, 0xF852, 0xE434 ); + mac_ocp_write( tp, 0xF854, 0xD3C0 ); + mac_ocp_write( tp, 0xF856, 0x49D9 ); + mac_ocp_write( tp, 0xF858, 0xF01F ); + mac_ocp_write( tp, 0xF85A, 0xC526 ); + mac_ocp_write( tp, 0xF85C, 0x64A5 ); + mac_ocp_write( tp, 0xF85E, 0x1400 ); + mac_ocp_write( tp, 0xF860, 0xF007 ); + mac_ocp_write( tp, 0xF862, 0x0C01 ); + mac_ocp_write( tp, 0xF864, 0x8CA5 ); + mac_ocp_write( tp, 0xF866, 0x1C15 ); + mac_ocp_write( tp, 0xF868, 0xC51B ); + mac_ocp_write( tp, 0xF86A, 0x9CA0 ); + mac_ocp_write( tp, 0xF86C, 0xE013 ); + mac_ocp_write( tp, 0xF86E, 0xC519 ); + mac_ocp_write( tp, 0xF870, 0x74A0 ); + mac_ocp_write( tp, 0xF872, 0x48C4 ); + mac_ocp_write( tp, 0xF874, 0x8CA0 ); + mac_ocp_write( tp, 0xF876, 0xC516 ); + mac_ocp_write( tp, 0xF878, 0x74A4 ); + mac_ocp_write( tp, 0xF87A, 0x48C8 ); + mac_ocp_write( tp, 0xF87C, 0x48CA ); + mac_ocp_write( tp, 0xF87E, 0x9CA4 ); + mac_ocp_write( tp, 0xF880, 0xC512 ); + mac_ocp_write( tp, 0xF882, 0x1B00 ); + mac_ocp_write( tp, 0xF884, 0x9BA0 ); + mac_ocp_write( tp, 0xF886, 0x1B1C ); + mac_ocp_write( tp, 0xF888, 0x483F ); + mac_ocp_write( tp, 0xF88A, 0x9BA2 ); + mac_ocp_write( tp, 0xF88C, 0x1B04 ); + mac_ocp_write( tp, 0xF88E, 0xC508 ); + mac_ocp_write( tp, 0xF890, 0x9BA0 ); + mac_ocp_write( tp, 0xF892, 0xC505 ); + mac_ocp_write( tp, 0xF894, 0xBD00 ); + mac_ocp_write( tp, 0xF896, 0xC502 ); + mac_ocp_write( tp, 0xF898, 0xBD00 ); + mac_ocp_write( tp, 0xF89A, 0x0300 ); + mac_ocp_write( tp, 0xF89C, 0x051E ); + mac_ocp_write( tp, 0xF89E, 0xE434 ); + mac_ocp_write( tp, 0xF8A0, 0xE018 ); + mac_ocp_write( tp, 0xF8A2, 0xE092 ); + mac_ocp_write( tp, 0xF8A4, 0xDE20 ); + mac_ocp_write( tp, 0xF8A6, 0xD3C0 ); + mac_ocp_write( tp, 0xF8A8, 0xC50F ); + mac_ocp_write( tp, 0xF8AA, 0x76A4 ); + mac_ocp_write( tp, 0xF8AC, 0x49E3 ); + mac_ocp_write( tp, 0xF8AE, 0xF007 ); + mac_ocp_write( tp, 0xF8B0, 0x49C0 ); + mac_ocp_write( tp, 0xF8B2, 0xF103 ); + mac_ocp_write( tp, 0xF8B4, 0xC607 ); + mac_ocp_write( tp, 0xF8B6, 0xBE00 ); + mac_ocp_write( tp, 0xF8B8, 0xC606 ); + mac_ocp_write( tp, 0xF8BA, 0xBE00 ); + mac_ocp_write( tp, 0xF8BC, 0xC602 ); + mac_ocp_write( tp, 0xF8BE, 0xBE00 ); + mac_ocp_write( tp, 0xF8C0, 0x0C4C ); + mac_ocp_write( tp, 0xF8C2, 0x0C28 ); + mac_ocp_write( tp, 0xF8C4, 0x0C2C ); + mac_ocp_write( tp, 0xF8C6, 0xDC00 ); + mac_ocp_write( tp, 0xF8C8, 0xC707 ); + mac_ocp_write( tp, 0xF8CA, 0x1D00 ); + mac_ocp_write( tp, 0xF8CC, 0x8DE2 ); + mac_ocp_write( tp, 0xF8CE, 0x48C1 ); + mac_ocp_write( tp, 0xF8D0, 0xC502 ); + mac_ocp_write( tp, 0xF8D2, 0xBD00 ); + mac_ocp_write( tp, 0xF8D4, 0x00AA ); + mac_ocp_write( tp, 0xF8D6, 0xE0C0 ); + mac_ocp_write( tp, 0xF8D8, 0xC502 ); + mac_ocp_write( tp, 0xF8DA, 0xBD00 ); + mac_ocp_write( tp, 0xF8DC, 0x0132 ); + + mac_ocp_write( tp, 0xFC26, 0x8000 ); + + mac_ocp_write( tp, 0xFC2A, 0x0743 ); + mac_ocp_write( tp, 0xFC2C, 0x0801 ); + mac_ocp_write( tp, 0xFC2E, 0x0BE9 ); + mac_ocp_write( tp, 0xFC30, 0x02FD ); + mac_ocp_write( tp, 0xFC32, 0x0C25 ); + mac_ocp_write( tp, 0xFC34, 0x00A9 ); + mac_ocp_write( tp, 0xFC36, 0x012D ); + } else if (tp->mcfg == CFG_METHOD_27) { + rtl8168_hw_disable_mac_mcu_bps(dev); + + mac_ocp_write( tp, 0xF800, 0xE008 ); + mac_ocp_write( tp, 0xF802, 0xE0D3 ); + mac_ocp_write( tp, 0xF804, 0xE0D6 ); + mac_ocp_write( tp, 0xF806, 0xE0D9 ); + mac_ocp_write( tp, 0xF808, 0xE0DB ); + mac_ocp_write( tp, 0xF80A, 0xE0DD ); + mac_ocp_write( tp, 0xF80C, 0xE0DF ); + mac_ocp_write( tp, 0xF80E, 0xE0E1 ); + mac_ocp_write( tp, 0xF810, 0xC251 ); + mac_ocp_write( tp, 0xF812, 0x7340 ); + mac_ocp_write( tp, 0xF814, 0x49B1 ); + mac_ocp_write( tp, 0xF816, 0xF010 ); + mac_ocp_write( tp, 0xF818, 0x1D02 ); + mac_ocp_write( tp, 0xF81A, 0x8D40 ); + mac_ocp_write( tp, 0xF81C, 0xC202 ); + mac_ocp_write( tp, 0xF81E, 0xBA00 ); + mac_ocp_write( tp, 0xF820, 0x2C3A ); + mac_ocp_write( tp, 0xF822, 0xC0F0 ); + mac_ocp_write( tp, 0xF824, 0xE8DE ); + mac_ocp_write( tp, 0xF826, 0x2000 ); + mac_ocp_write( tp, 0xF828, 0x8000 ); + mac_ocp_write( tp, 0xF82A, 0xC0B6 ); + mac_ocp_write( tp, 0xF82C, 0x268C ); + mac_ocp_write( tp, 0xF82E, 0x752C ); + mac_ocp_write( tp, 0xF830, 0x49D4 ); + mac_ocp_write( tp, 0xF832, 0xF112 ); + mac_ocp_write( tp, 0xF834, 0xE025 ); + mac_ocp_write( tp, 0xF836, 0xC2F6 ); + mac_ocp_write( tp, 0xF838, 0x7146 ); + mac_ocp_write( tp, 0xF83A, 0xC2F5 ); + mac_ocp_write( tp, 0xF83C, 0x7340 ); + mac_ocp_write( tp, 0xF83E, 0x49BE ); + mac_ocp_write( tp, 0xF840, 0xF103 ); + mac_ocp_write( tp, 0xF842, 0xC7F2 ); + mac_ocp_write( tp, 0xF844, 0xE002 ); + mac_ocp_write( tp, 0xF846, 0xC7F1 ); + mac_ocp_write( tp, 0xF848, 0x304F ); + mac_ocp_write( tp, 0xF84A, 0x6226 ); + mac_ocp_write( tp, 0xF84C, 0x49A1 ); + mac_ocp_write( tp, 0xF84E, 0xF1F0 ); + mac_ocp_write( tp, 0xF850, 0x7222 ); + mac_ocp_write( tp, 0xF852, 0x49A0 ); + mac_ocp_write( tp, 0xF854, 0xF1ED ); + mac_ocp_write( tp, 0xF856, 0x2525 ); + mac_ocp_write( tp, 0xF858, 0x1F28 ); + mac_ocp_write( tp, 0xF85A, 0x3097 ); + mac_ocp_write( tp, 0xF85C, 0x3091 ); + mac_ocp_write( tp, 0xF85E, 0x9A36 ); + mac_ocp_write( tp, 0xF860, 0x752C ); + mac_ocp_write( tp, 0xF862, 0x21DC ); + mac_ocp_write( tp, 0xF864, 0x25BC ); + mac_ocp_write( tp, 0xF866, 0xC6E2 ); + mac_ocp_write( tp, 0xF868, 0x77C0 ); + mac_ocp_write( tp, 0xF86A, 0x1304 ); + mac_ocp_write( tp, 0xF86C, 0xF014 ); + mac_ocp_write( tp, 0xF86E, 0x1303 ); + mac_ocp_write( tp, 0xF870, 0xF014 ); + mac_ocp_write( tp, 0xF872, 0x1302 ); + mac_ocp_write( tp, 0xF874, 0xF014 ); + mac_ocp_write( tp, 0xF876, 0x1301 ); + mac_ocp_write( tp, 0xF878, 0xF014 ); + mac_ocp_write( tp, 0xF87A, 0x49D4 ); + mac_ocp_write( tp, 0xF87C, 0xF103 ); + mac_ocp_write( tp, 0xF87E, 0xC3D7 ); + mac_ocp_write( tp, 0xF880, 0xBB00 ); + mac_ocp_write( tp, 0xF882, 0xC618 ); + mac_ocp_write( tp, 0xF884, 0x67C6 ); + mac_ocp_write( tp, 0xF886, 0x752E ); + mac_ocp_write( tp, 0xF888, 0x22D7 ); + mac_ocp_write( tp, 0xF88A, 0x26DD ); + mac_ocp_write( tp, 0xF88C, 0x1505 ); + mac_ocp_write( tp, 0xF88E, 0xF013 ); + mac_ocp_write( tp, 0xF890, 0xC60A ); + mac_ocp_write( tp, 0xF892, 0xBE00 ); + mac_ocp_write( tp, 0xF894, 0xC309 ); + mac_ocp_write( tp, 0xF896, 0xBB00 ); + mac_ocp_write( tp, 0xF898, 0xC308 ); + mac_ocp_write( tp, 0xF89A, 0xBB00 ); + mac_ocp_write( tp, 0xF89C, 0xC307 ); + mac_ocp_write( tp, 0xF89E, 0xBB00 ); + mac_ocp_write( tp, 0xF8A0, 0xC306 ); + mac_ocp_write( tp, 0xF8A2, 0xBB00 ); + mac_ocp_write( tp, 0xF8A4, 0x25C8 ); + mac_ocp_write( tp, 0xF8A6, 0x25A6 ); + mac_ocp_write( tp, 0xF8A8, 0x25AC ); + mac_ocp_write( tp, 0xF8AA, 0x25B2 ); + mac_ocp_write( tp, 0xF8AC, 0x25B8 ); + mac_ocp_write( tp, 0xF8AE, 0xCD08 ); + mac_ocp_write( tp, 0xF8B0, 0x0000 ); + mac_ocp_write( tp, 0xF8B2, 0xC0BC ); + mac_ocp_write( tp, 0xF8B4, 0xC2FF ); + mac_ocp_write( tp, 0xF8B6, 0x7340 ); + mac_ocp_write( tp, 0xF8B8, 0x49B0 ); + mac_ocp_write( tp, 0xF8BA, 0xF04E ); + mac_ocp_write( tp, 0xF8BC, 0x1F46 ); + mac_ocp_write( tp, 0xF8BE, 0x308F ); + mac_ocp_write( tp, 0xF8C0, 0xC3F7 ); + mac_ocp_write( tp, 0xF8C2, 0x1C04 ); + mac_ocp_write( tp, 0xF8C4, 0xE84D ); + mac_ocp_write( tp, 0xF8C6, 0x1401 ); + mac_ocp_write( tp, 0xF8C8, 0xF147 ); + mac_ocp_write( tp, 0xF8CA, 0x7226 ); + mac_ocp_write( tp, 0xF8CC, 0x49A7 ); + mac_ocp_write( tp, 0xF8CE, 0xF044 ); + mac_ocp_write( tp, 0xF8D0, 0x7222 ); + mac_ocp_write( tp, 0xF8D2, 0x2525 ); + mac_ocp_write( tp, 0xF8D4, 0x1F30 ); + mac_ocp_write( tp, 0xF8D6, 0x3097 ); + mac_ocp_write( tp, 0xF8D8, 0x3091 ); + mac_ocp_write( tp, 0xF8DA, 0x7340 ); + mac_ocp_write( tp, 0xF8DC, 0xC4EA ); + mac_ocp_write( tp, 0xF8DE, 0x401C ); + mac_ocp_write( tp, 0xF8E0, 0xF006 ); + mac_ocp_write( tp, 0xF8E2, 0xC6E8 ); + mac_ocp_write( tp, 0xF8E4, 0x75C0 ); + mac_ocp_write( tp, 0xF8E6, 0x49D7 ); + mac_ocp_write( tp, 0xF8E8, 0xF105 ); + mac_ocp_write( tp, 0xF8EA, 0xE036 ); + mac_ocp_write( tp, 0xF8EC, 0x1D08 ); + mac_ocp_write( tp, 0xF8EE, 0x8DC1 ); + mac_ocp_write( tp, 0xF8F0, 0x0208 ); + mac_ocp_write( tp, 0xF8F2, 0x6640 ); + mac_ocp_write( tp, 0xF8F4, 0x2764 ); + mac_ocp_write( tp, 0xF8F6, 0x1606 ); + mac_ocp_write( tp, 0xF8F8, 0xF12F ); + mac_ocp_write( tp, 0xF8FA, 0x6346 ); + mac_ocp_write( tp, 0xF8FC, 0x133B ); + mac_ocp_write( tp, 0xF8FE, 0xF12C ); + mac_ocp_write( tp, 0xF900, 0x9B34 ); + mac_ocp_write( tp, 0xF902, 0x1B18 ); + mac_ocp_write( tp, 0xF904, 0x3093 ); + mac_ocp_write( tp, 0xF906, 0xC32A ); + mac_ocp_write( tp, 0xF908, 0x1C10 ); + mac_ocp_write( tp, 0xF90A, 0xE82A ); + mac_ocp_write( tp, 0xF90C, 0x1401 ); + mac_ocp_write( tp, 0xF90E, 0xF124 ); + mac_ocp_write( tp, 0xF910, 0x1A36 ); + mac_ocp_write( tp, 0xF912, 0x308A ); + mac_ocp_write( tp, 0xF914, 0x7322 ); + mac_ocp_write( tp, 0xF916, 0x25B5 ); + mac_ocp_write( tp, 0xF918, 0x0B0E ); + mac_ocp_write( tp, 0xF91A, 0x1C00 ); + mac_ocp_write( tp, 0xF91C, 0xE82C ); + mac_ocp_write( tp, 0xF91E, 0xC71F ); + mac_ocp_write( tp, 0xF920, 0x4027 ); + mac_ocp_write( tp, 0xF922, 0xF11A ); + mac_ocp_write( tp, 0xF924, 0xE838 ); + mac_ocp_write( tp, 0xF926, 0x1F42 ); + mac_ocp_write( tp, 0xF928, 0x308F ); + mac_ocp_write( tp, 0xF92A, 0x1B08 ); + mac_ocp_write( tp, 0xF92C, 0xE824 ); + mac_ocp_write( tp, 0xF92E, 0x7236 ); + mac_ocp_write( tp, 0xF930, 0x7746 ); + mac_ocp_write( tp, 0xF932, 0x1700 ); + mac_ocp_write( tp, 0xF934, 0xF00D ); + mac_ocp_write( tp, 0xF936, 0xC313 ); + mac_ocp_write( tp, 0xF938, 0x401F ); + mac_ocp_write( tp, 0xF93A, 0xF103 ); + mac_ocp_write( tp, 0xF93C, 0x1F00 ); + mac_ocp_write( tp, 0xF93E, 0x9F46 ); + mac_ocp_write( tp, 0xF940, 0x7744 ); + mac_ocp_write( tp, 0xF942, 0x449F ); + mac_ocp_write( tp, 0xF944, 0x445F ); + mac_ocp_write( tp, 0xF946, 0xE817 ); + mac_ocp_write( tp, 0xF948, 0xC70A ); + mac_ocp_write( tp, 0xF94A, 0x4027 ); + mac_ocp_write( tp, 0xF94C, 0xF105 ); + mac_ocp_write( tp, 0xF94E, 0xC302 ); + mac_ocp_write( tp, 0xF950, 0xBB00 ); + mac_ocp_write( tp, 0xF952, 0x2E08 ); + mac_ocp_write( tp, 0xF954, 0x2DC2 ); + mac_ocp_write( tp, 0xF956, 0xC7FF ); + mac_ocp_write( tp, 0xF958, 0xBF00 ); + mac_ocp_write( tp, 0xF95A, 0xCDB8 ); + mac_ocp_write( tp, 0xF95C, 0xFFFF ); + mac_ocp_write( tp, 0xF95E, 0x0C02 ); + mac_ocp_write( tp, 0xF960, 0xA554 ); + mac_ocp_write( tp, 0xF962, 0xA5DC ); + mac_ocp_write( tp, 0xF964, 0x402F ); + mac_ocp_write( tp, 0xF966, 0xF105 ); + mac_ocp_write( tp, 0xF968, 0x1400 ); + mac_ocp_write( tp, 0xF96A, 0xF1FA ); + mac_ocp_write( tp, 0xF96C, 0x1C01 ); + mac_ocp_write( tp, 0xF96E, 0xE002 ); + mac_ocp_write( tp, 0xF970, 0x1C00 ); + mac_ocp_write( tp, 0xF972, 0xFF80 ); + mac_ocp_write( tp, 0xF974, 0x49B0 ); + mac_ocp_write( tp, 0xF976, 0xF004 ); + mac_ocp_write( tp, 0xF978, 0x0B01 ); + mac_ocp_write( tp, 0xF97A, 0xA1D3 ); + mac_ocp_write( tp, 0xF97C, 0xE003 ); + mac_ocp_write( tp, 0xF97E, 0x0B02 ); + mac_ocp_write( tp, 0xF980, 0xA5D3 ); + mac_ocp_write( tp, 0xF982, 0x3127 ); + mac_ocp_write( tp, 0xF984, 0x3720 ); + mac_ocp_write( tp, 0xF986, 0x0B02 ); + mac_ocp_write( tp, 0xF988, 0xA5D3 ); + mac_ocp_write( tp, 0xF98A, 0x3127 ); + mac_ocp_write( tp, 0xF98C, 0x3720 ); + mac_ocp_write( tp, 0xF98E, 0x1300 ); + mac_ocp_write( tp, 0xF990, 0xF1FB ); + mac_ocp_write( tp, 0xF992, 0xFF80 ); + mac_ocp_write( tp, 0xF994, 0x7322 ); + mac_ocp_write( tp, 0xF996, 0x25B5 ); + mac_ocp_write( tp, 0xF998, 0x1E28 ); + mac_ocp_write( tp, 0xF99A, 0x30DE ); + mac_ocp_write( tp, 0xF99C, 0x30D9 ); + mac_ocp_write( tp, 0xF99E, 0x7264 ); + mac_ocp_write( tp, 0xF9A0, 0x1E11 ); + mac_ocp_write( tp, 0xF9A2, 0x2368 ); + mac_ocp_write( tp, 0xF9A4, 0x3116 ); + mac_ocp_write( tp, 0xF9A6, 0xFF80 ); + mac_ocp_write( tp, 0xF9A8, 0x1B7E ); + mac_ocp_write( tp, 0xF9AA, 0xC602 ); + mac_ocp_write( tp, 0xF9AC, 0xBE00 ); + mac_ocp_write( tp, 0xF9AE, 0x06A6 ); + mac_ocp_write( tp, 0xF9B0, 0x1B7E ); + mac_ocp_write( tp, 0xF9B2, 0xC602 ); + mac_ocp_write( tp, 0xF9B4, 0xBE00 ); + mac_ocp_write( tp, 0xF9B6, 0x0764 ); + mac_ocp_write( tp, 0xF9B8, 0xC602 ); + mac_ocp_write( tp, 0xF9BA, 0xBE00 ); + mac_ocp_write( tp, 0xF9BC, 0x0000 ); + mac_ocp_write( tp, 0xF9BE, 0xC602 ); + mac_ocp_write( tp, 0xF9C0, 0xBE00 ); + mac_ocp_write( tp, 0xF9C2, 0x0000 ); + mac_ocp_write( tp, 0xF9C4, 0xC602 ); + mac_ocp_write( tp, 0xF9C6, 0xBE00 ); + mac_ocp_write( tp, 0xF9C8, 0x0000 ); + mac_ocp_write( tp, 0xF9CA, 0xC602 ); + mac_ocp_write( tp, 0xF9CC, 0xBE00 ); + mac_ocp_write( tp, 0xF9CE, 0x0000 ); + mac_ocp_write( tp, 0xF9D0, 0xC602 ); + mac_ocp_write( tp, 0xF9D2, 0xBE00 ); + mac_ocp_write( tp, 0xF9D4, 0x0000 ); + + mac_ocp_write( tp, 0xFC26, 0x8000 ); + + mac_ocp_write( tp, 0xFC28, 0x2549 ); + mac_ocp_write( tp, 0xFC2A, 0x06A5 ); + mac_ocp_write( tp, 0xFC2C, 0x0763 ); + } else if (tp->mcfg == CFG_METHOD_28) { + rtl8168_hw_disable_mac_mcu_bps(dev); + + mac_ocp_write( tp, 0xF800, 0xE008 ); + mac_ocp_write( tp, 0xF802, 0xE017 ); + mac_ocp_write( tp, 0xF804, 0xE019 ); + mac_ocp_write( tp, 0xF806, 0xE01B ); + mac_ocp_write( tp, 0xF808, 0xE01D ); + mac_ocp_write( tp, 0xF80A, 0xE01F ); + mac_ocp_write( tp, 0xF80C, 0xE021 ); + mac_ocp_write( tp, 0xF80E, 0xE023 ); + mac_ocp_write( tp, 0xF810, 0xC50F ); + mac_ocp_write( tp, 0xF812, 0x76A4 ); + mac_ocp_write( tp, 0xF814, 0x49E3 ); + mac_ocp_write( tp, 0xF816, 0xF007 ); + mac_ocp_write( tp, 0xF818, 0x49C0 ); + mac_ocp_write( tp, 0xF81A, 0xF103 ); + mac_ocp_write( tp, 0xF81C, 0xC607 ); + mac_ocp_write( tp, 0xF81E, 0xBE00 ); + mac_ocp_write( tp, 0xF820, 0xC606 ); + mac_ocp_write( tp, 0xF822, 0xBE00 ); + mac_ocp_write( tp, 0xF824, 0xC602 ); + mac_ocp_write( tp, 0xF826, 0xBE00 ); + mac_ocp_write( tp, 0xF828, 0x0BDA ); + mac_ocp_write( tp, 0xF82A, 0x0BB0 ); + mac_ocp_write( tp, 0xF82C, 0x0BBA ); + mac_ocp_write( tp, 0xF82E, 0xDC00 ); + mac_ocp_write( tp, 0xF830, 0xC602 ); + mac_ocp_write( tp, 0xF832, 0xBE00 ); + mac_ocp_write( tp, 0xF834, 0x0000 ); + mac_ocp_write( tp, 0xF836, 0xC602 ); + mac_ocp_write( tp, 0xF838, 0xBE00 ); + mac_ocp_write( tp, 0xF83A, 0x0000 ); + mac_ocp_write( tp, 0xF83C, 0xC602 ); + mac_ocp_write( tp, 0xF83E, 0xBE00 ); + mac_ocp_write( tp, 0xF840, 0x0000 ); + mac_ocp_write( tp, 0xF842, 0xC602 ); + mac_ocp_write( tp, 0xF844, 0xBE00 ); + mac_ocp_write( tp, 0xF846, 0x0000 ); + mac_ocp_write( tp, 0xF848, 0xC602 ); + mac_ocp_write( tp, 0xF84A, 0xBE00 ); + mac_ocp_write( tp, 0xF84C, 0x0000 ); + mac_ocp_write( tp, 0xF84E, 0xC602 ); + mac_ocp_write( tp, 0xF850, 0xBE00 ); + mac_ocp_write( tp, 0xF852, 0x0000 ); + mac_ocp_write( tp, 0xF854, 0xC602 ); + mac_ocp_write( tp, 0xF856, 0xBE00 ); + mac_ocp_write( tp, 0xF858, 0x0000 ); + + mac_ocp_write( tp, 0xFC26, 0x8000 ); + + mac_ocp_write( tp, 0xFC28, 0x0BB3 ); + } else if (tp->mcfg == CFG_METHOD_29 || tp->mcfg == CFG_METHOD_30) { + rtl8168_hw_disable_mac_mcu_bps(dev); + + mac_ocp_write(tp, 0xF800, 0xE008); + mac_ocp_write(tp, 0xF802, 0xE00F); + mac_ocp_write(tp, 0xF804, 0xE011); + mac_ocp_write(tp, 0xF806, 0xE047); + mac_ocp_write(tp, 0xF808, 0xE049); + mac_ocp_write(tp, 0xF80A, 0xE073); + mac_ocp_write(tp, 0xF80C, 0xE075); + mac_ocp_write(tp, 0xF80E, 0xE077); + mac_ocp_write(tp, 0xF810, 0xC707); + mac_ocp_write(tp, 0xF812, 0x1D00); + mac_ocp_write(tp, 0xF814, 0x8DE2); + mac_ocp_write(tp, 0xF816, 0x48C1); + mac_ocp_write(tp, 0xF818, 0xC502); + mac_ocp_write(tp, 0xF81A, 0xBD00); + mac_ocp_write(tp, 0xF81C, 0x00E4); + mac_ocp_write(tp, 0xF81E, 0xE0C0); + mac_ocp_write(tp, 0xF820, 0xC502); + mac_ocp_write(tp, 0xF822, 0xBD00); + mac_ocp_write(tp, 0xF824, 0x0216); + mac_ocp_write(tp, 0xF826, 0xC634); + mac_ocp_write(tp, 0xF828, 0x75C0); + mac_ocp_write(tp, 0xF82A, 0x49D3); + mac_ocp_write(tp, 0xF82C, 0xF027); + mac_ocp_write(tp, 0xF82E, 0xC631); + mac_ocp_write(tp, 0xF830, 0x75C0); + mac_ocp_write(tp, 0xF832, 0x49D3); + mac_ocp_write(tp, 0xF834, 0xF123); + mac_ocp_write(tp, 0xF836, 0xC627); + mac_ocp_write(tp, 0xF838, 0x75C0); + mac_ocp_write(tp, 0xF83A, 0xB405); + mac_ocp_write(tp, 0xF83C, 0xC525); + mac_ocp_write(tp, 0xF83E, 0x9DC0); + mac_ocp_write(tp, 0xF840, 0xC621); + mac_ocp_write(tp, 0xF842, 0x75C8); + mac_ocp_write(tp, 0xF844, 0x49D5); + mac_ocp_write(tp, 0xF846, 0xF00A); + mac_ocp_write(tp, 0xF848, 0x49D6); + mac_ocp_write(tp, 0xF84A, 0xF008); + mac_ocp_write(tp, 0xF84C, 0x49D7); + mac_ocp_write(tp, 0xF84E, 0xF006); + mac_ocp_write(tp, 0xF850, 0x49D8); + mac_ocp_write(tp, 0xF852, 0xF004); + mac_ocp_write(tp, 0xF854, 0x75D2); + mac_ocp_write(tp, 0xF856, 0x49D9); + mac_ocp_write(tp, 0xF858, 0xF111); + mac_ocp_write(tp, 0xF85A, 0xC517); + mac_ocp_write(tp, 0xF85C, 0x9DC8); + mac_ocp_write(tp, 0xF85E, 0xC516); + mac_ocp_write(tp, 0xF860, 0x9DD2); + mac_ocp_write(tp, 0xF862, 0xC618); + mac_ocp_write(tp, 0xF864, 0x75C0); + mac_ocp_write(tp, 0xF866, 0x49D4); + mac_ocp_write(tp, 0xF868, 0xF003); + mac_ocp_write(tp, 0xF86A, 0x49D0); + mac_ocp_write(tp, 0xF86C, 0xF104); + mac_ocp_write(tp, 0xF86E, 0xC60A); + mac_ocp_write(tp, 0xF870, 0xC50E); + mac_ocp_write(tp, 0xF872, 0x9DC0); + mac_ocp_write(tp, 0xF874, 0xB005); + mac_ocp_write(tp, 0xF876, 0xC607); + mac_ocp_write(tp, 0xF878, 0x9DC0); + mac_ocp_write(tp, 0xF87A, 0xB007); + mac_ocp_write(tp, 0xF87C, 0xC602); + mac_ocp_write(tp, 0xF87E, 0xBE00); + mac_ocp_write(tp, 0xF880, 0x1A06); + mac_ocp_write(tp, 0xF882, 0xB400); + mac_ocp_write(tp, 0xF884, 0xE86C); + mac_ocp_write(tp, 0xF886, 0xA000); + mac_ocp_write(tp, 0xF888, 0x01E1); + mac_ocp_write(tp, 0xF88A, 0x0200); + mac_ocp_write(tp, 0xF88C, 0x9200); + mac_ocp_write(tp, 0xF88E, 0xE84C); + mac_ocp_write(tp, 0xF890, 0xE004); + mac_ocp_write(tp, 0xF892, 0xE908); + mac_ocp_write(tp, 0xF894, 0xC502); + mac_ocp_write(tp, 0xF896, 0xBD00); + mac_ocp_write(tp, 0xF898, 0x0B58); + mac_ocp_write(tp, 0xF89A, 0xB407); + mac_ocp_write(tp, 0xF89C, 0xB404); + mac_ocp_write(tp, 0xF89E, 0x2195); + mac_ocp_write(tp, 0xF8A0, 0x25BD); + mac_ocp_write(tp, 0xF8A2, 0x9BE0); + mac_ocp_write(tp, 0xF8A4, 0x1C1C); + mac_ocp_write(tp, 0xF8A6, 0x484F); + mac_ocp_write(tp, 0xF8A8, 0x9CE2); + mac_ocp_write(tp, 0xF8AA, 0x72E2); + mac_ocp_write(tp, 0xF8AC, 0x49AE); + mac_ocp_write(tp, 0xF8AE, 0xF1FE); + mac_ocp_write(tp, 0xF8B0, 0x0B00); + mac_ocp_write(tp, 0xF8B2, 0xF116); + mac_ocp_write(tp, 0xF8B4, 0xC71C); + mac_ocp_write(tp, 0xF8B6, 0xC419); + mac_ocp_write(tp, 0xF8B8, 0x9CE0); + mac_ocp_write(tp, 0xF8BA, 0x1C13); + mac_ocp_write(tp, 0xF8BC, 0x484F); + mac_ocp_write(tp, 0xF8BE, 0x9CE2); + mac_ocp_write(tp, 0xF8C0, 0x74E2); + mac_ocp_write(tp, 0xF8C2, 0x49CE); + mac_ocp_write(tp, 0xF8C4, 0xF1FE); + mac_ocp_write(tp, 0xF8C6, 0xC412); + mac_ocp_write(tp, 0xF8C8, 0x9CE0); + mac_ocp_write(tp, 0xF8CA, 0x1C13); + mac_ocp_write(tp, 0xF8CC, 0x484F); + mac_ocp_write(tp, 0xF8CE, 0x9CE2); + mac_ocp_write(tp, 0xF8D0, 0x74E2); + mac_ocp_write(tp, 0xF8D2, 0x49CE); + mac_ocp_write(tp, 0xF8D4, 0xF1FE); + mac_ocp_write(tp, 0xF8D6, 0xC70C); + mac_ocp_write(tp, 0xF8D8, 0x74F8); + mac_ocp_write(tp, 0xF8DA, 0x48C3); + mac_ocp_write(tp, 0xF8DC, 0x8CF8); + mac_ocp_write(tp, 0xF8DE, 0xB004); + mac_ocp_write(tp, 0xF8E0, 0xB007); + mac_ocp_write(tp, 0xF8E2, 0xC502); + mac_ocp_write(tp, 0xF8E4, 0xBD00); + mac_ocp_write(tp, 0xF8E6, 0x0F24); + mac_ocp_write(tp, 0xF8E8, 0x0481); + mac_ocp_write(tp, 0xF8EA, 0x0C81); + mac_ocp_write(tp, 0xF8EC, 0xDE24); + mac_ocp_write(tp, 0xF8EE, 0xE000); + mac_ocp_write(tp, 0xF8F0, 0xC602); + mac_ocp_write(tp, 0xF8F2, 0xBE00); + mac_ocp_write(tp, 0xF8F4, 0x0CA4); + mac_ocp_write(tp, 0xF8F6, 0xC502); + mac_ocp_write(tp, 0xF8F8, 0xBD00); + mac_ocp_write(tp, 0xF8FA, 0x0000); + mac_ocp_write(tp, 0xF8FC, 0xC602); + mac_ocp_write(tp, 0xF8FE, 0xBE00); + mac_ocp_write(tp, 0xF900, 0x0000); + + mac_ocp_write(tp, 0xFC26, 0x8000); + + mac_ocp_write(tp, 0xFC28, 0x00E2); + mac_ocp_write(tp, 0xFC2A, 0x0210); + mac_ocp_write(tp, 0xFC2C, 0x1A04); + mac_ocp_write(tp, 0xFC2E, 0x0B26); + + mac_ocp_write(tp, 0xFC38, 0x003F); + } +} + +static void +rtl8168_hw_init(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + unsigned long flags; + + switch (tp->mcfg) { + case CFG_METHOD_14: + case CFG_METHOD_15: + case CFG_METHOD_16: + case CFG_METHOD_17: + case CFG_METHOD_18: + case CFG_METHOD_19: + case CFG_METHOD_20: + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + RTL_W8(Cfg9346, Cfg9346_Unlock); + RTL_W8(Config5, RTL_R8(Config5) & ~BIT_0); + RTL_W8(Config2, RTL_R8(Config2) & ~BIT_7); + RTL_W8(Cfg9346, Cfg9346_Lock); + RTL_W8(0xF1, RTL_R8(0xF1) & ~BIT_7); + break; + } + + //Disable UPS + switch (tp->mcfg) { + case CFG_METHOD_29: + case CFG_METHOD_30: + mac_ocp_write(tp, 0xD400, mac_ocp_read( tp, 0xD400) & ~(BIT_0)); + break; + } + + //Disable DMA Aggregation + switch (tp->mcfg) { + case CFG_METHOD_29: + case CFG_METHOD_30: + mac_ocp_write(tp, 0xE63E, mac_ocp_read( tp, 0xE63E) & ~(BIT_3 | BIT_2 | BIT_1)); + mac_ocp_write(tp, 0xE63E, mac_ocp_read( tp, 0xE63E) | (BIT_0)); + mac_ocp_write(tp, 0xE63E, mac_ocp_read( tp, 0xE63E) & ~(BIT_0)); + mac_ocp_write(tp, 0xC094, 0x0); + mac_ocp_write(tp, 0xC09E, 0x0); + break; + } + + switch (tp->mcfg) { + case CFG_METHOD_9: + case CFG_METHOD_10: + RTL_W8(DBG_reg, RTL_R8(DBG_reg) | BIT_1 | BIT_7); + break; + } + + switch (tp->mcfg) { + case CFG_METHOD_14: + case CFG_METHOD_15: + case CFG_METHOD_16: + case CFG_METHOD_17: + case CFG_METHOD_18: + case CFG_METHOD_19: + RTL_W8(0xF2, (RTL_R8(0xF2) & ~(BIT_2 | BIT_1 | BIT_0))); + break; + } + + switch (tp->mcfg) { + case CFG_METHOD_16: + case CFG_METHOD_17: + case CFG_METHOD_18: + case CFG_METHOD_19: + case CFG_METHOD_20: + if (aspm) { + RTL_W8(0x6E, RTL_R8(0x6E) | BIT_6); + rtl8168_eri_write(ioaddr, 0x1AE, 2, 0x0403, ERIAR_ExGMAC); + } + break; + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_29: + case CFG_METHOD_30: + if (aspm) { + if ((mac_ocp_read(tp, 0xDC00) & BIT_3) || (RTL_R8(Config0) & 0x07)) { + RTL_W8(0x6E, RTL_R8(0x6E) | BIT_6); + rtl8168_eri_write(ioaddr, 0x1AE, 2, 0x0403, ERIAR_ExGMAC); + } + } + break; + } + + if (tp->mcfg == CFG_METHOD_10 || tp->mcfg == CFG_METHOD_14 || tp->mcfg == CFG_METHOD_15) + RTL_W8(0xF3, RTL_R8(0xF3) | BIT_2); + + rtl8168_hw_mac_mcu_config(dev); + + /*disable ocp phy power saving*/ + if (tp->mcfg == CFG_METHOD_25 || tp->mcfg == CFG_METHOD_26 || + tp->mcfg == CFG_METHOD_27 || tp->mcfg == CFG_METHOD_28 || + tp->mcfg == CFG_METHOD_29 || tp->mcfg == CFG_METHOD_30) { + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write_phy_ocp(tp, 0x0C41, 0x13, 0x0000); + mdio_write_phy_ocp(tp, 0x0C41, 0x13, 0x0500); + spin_unlock_irqrestore(&tp->phy_lock, flags); + } +} + +static void +rtl8168_hw_ephy_config(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + u16 ephy_data; + + + if (tp->mcfg == CFG_METHOD_4) { + /*Set EPHY registers begin*/ + /*Set EPHY register offset 0x02 bit 11 to 0 and bit 12 to 1*/ + ephy_data = rtl8168_ephy_read(ioaddr, 0x02); + ephy_data &= ~BIT_11; + ephy_data |= BIT_12; + rtl8168_ephy_write(ioaddr, 0x02, ephy_data); + + /*Set EPHY register offset 0x03 bit 1 to 1*/ + ephy_data = rtl8168_ephy_read(ioaddr, 0x03); + ephy_data |= (1 << 1); + rtl8168_ephy_write(ioaddr, 0x03, ephy_data); + + /*Set EPHY register offset 0x06 bit 7 to 0*/ + ephy_data = rtl8168_ephy_read(ioaddr, 0x06); + ephy_data &= ~(1 << 7); + rtl8168_ephy_write(ioaddr, 0x06, ephy_data); + /*Set EPHY registers end*/ + } else if (tp->mcfg == CFG_METHOD_5) { + /* set EPHY registers */ + SetPCIePhyBit(tp, 0x01, BIT_0); + + ClearAndSetPCIePhyBit(tp, + 0x03, + BIT_10, + BIT_5 + ); + } else if (tp->mcfg == CFG_METHOD_9) { + /* set EPHY registers */ + rtl8168_ephy_write(ioaddr, 0x01, 0x7C7F); + rtl8168_ephy_write(ioaddr, 0x02, 0x011F); + if(tp->eeprom_type != EEPROM_TYPE_NONE) { + ClearAndSetPCIePhyBit(tp, + 0x03, + 0xFFB0, + 0x05B0 + ); + } else { + ClearAndSetPCIePhyBit(tp, + 0x03, + 0xFFF0, + 0x05F0 + ); + } + rtl8168_ephy_write(ioaddr, 0x06, 0xB271); + rtl8168_ephy_write(ioaddr, 0x07, 0xCE00); + } else if (tp->mcfg == CFG_METHOD_10) { + /* set EPHY registers */ + rtl8168_ephy_write(ioaddr, 0x01, 0x6C7F); + rtl8168_ephy_write(ioaddr, 0x02, 0x011F); + ClearAndSetPCIePhyBit(tp, + 0x03, + 0xFFF0, + 0x01B0 + ); + rtl8168_ephy_write(ioaddr, 0x1A, 0x0546); + rtl8168_ephy_write(ioaddr, 0x1C, 0x80C4); + rtl8168_ephy_write(ioaddr, 0x1D, 0x78E5); + rtl8168_ephy_write(ioaddr, 0x0A, 0x8100); + } else if (tp->mcfg == CFG_METHOD_12) { + ephy_data = rtl8168_ephy_read(ioaddr, 0x0B); + rtl8168_ephy_write(ioaddr, 0x0B, ephy_data|0x48); + ephy_data = rtl8168_ephy_read(ioaddr, 0x19); + ephy_data &= ~0x20; + rtl8168_ephy_write(ioaddr, 0x19, ephy_data|0x50); + ephy_data = rtl8168_ephy_read(ioaddr, 0x0C); + ephy_data &= ~0x100; + rtl8168_ephy_write(ioaddr, 0x0C, ephy_data|0x20); + } else if (tp->mcfg == CFG_METHOD_14 || tp->mcfg == CFG_METHOD_15) { + /* set EPHY registers */ + ephy_data = rtl8168_ephy_read(ioaddr, 0x00) & ~0x0200; + ephy_data |= 0x0100; + rtl8168_ephy_write(ioaddr, 0x00, ephy_data); + + ephy_data = rtl8168_ephy_read(ioaddr, 0x00); + ephy_data |= 0x0004; + rtl8168_ephy_write(ioaddr, 0x00, ephy_data); + + ephy_data = rtl8168_ephy_read(ioaddr, 0x06) & ~0x0002; + ephy_data |= 0x0001; + rtl8168_ephy_write(ioaddr, 0x06, ephy_data); + + ephy_data = rtl8168_ephy_read(ioaddr, 0x06); + ephy_data |= 0x0030; + rtl8168_ephy_write(ioaddr, 0x06, ephy_data); + + ephy_data = rtl8168_ephy_read(ioaddr, 0x07); + ephy_data |= 0x2000; + rtl8168_ephy_write(ioaddr, 0x07, ephy_data); + + ephy_data = rtl8168_ephy_read(ioaddr, 0x00); + ephy_data |= 0x0020; + rtl8168_ephy_write(ioaddr, 0x00, ephy_data); + + ephy_data = rtl8168_ephy_read(ioaddr, 0x03) & ~0x5800; + ephy_data |= 0x2000; + rtl8168_ephy_write(ioaddr, 0x03, ephy_data); + + ephy_data = rtl8168_ephy_read(ioaddr, 0x03); + ephy_data |= 0x0001; + rtl8168_ephy_write(ioaddr, 0x03, ephy_data); + + ephy_data = rtl8168_ephy_read(ioaddr, 0x01) & ~0x0800; + ephy_data |= 0x1000; + rtl8168_ephy_write(ioaddr, 0x01, ephy_data); + + ephy_data = rtl8168_ephy_read(ioaddr, 0x07); + ephy_data |= 0x4000; + rtl8168_ephy_write(ioaddr, 0x07, ephy_data); + + ephy_data = rtl8168_ephy_read(ioaddr, 0x1E); + ephy_data |= 0x2000; + rtl8168_ephy_write(ioaddr, 0x1E, ephy_data); + + rtl8168_ephy_write(ioaddr, 0x19, 0xFE6C); + + ephy_data = rtl8168_ephy_read(ioaddr, 0x0A); + ephy_data |= 0x0040; + rtl8168_ephy_write(ioaddr, 0x0A, ephy_data); + } else if (tp->mcfg == CFG_METHOD_16 || tp->mcfg == CFG_METHOD_17) { + if (tp->mcfg == CFG_METHOD_16) { + rtl8168_ephy_write(ioaddr, 0x06, 0xF020); + rtl8168_ephy_write(ioaddr, 0x07, 0x01FF); + rtl8168_ephy_write(ioaddr, 0x00, 0x5027); + rtl8168_ephy_write(ioaddr, 0x01, 0x0003); + rtl8168_ephy_write(ioaddr, 0x02, 0x2D16); + rtl8168_ephy_write(ioaddr, 0x03, 0x6D49); + rtl8168_ephy_write(ioaddr, 0x08, 0x0006); + rtl8168_ephy_write(ioaddr, 0x0A, 0x00C8); + } + + ephy_data = rtl8168_ephy_read(ioaddr, 0x09); + ephy_data |= BIT_7; + rtl8168_ephy_write(ioaddr, 0x09, ephy_data); + + ephy_data = rtl8168_ephy_read(ioaddr, 0x19); + ephy_data |= (BIT_2 | BIT_5 | BIT_9); + rtl8168_ephy_write(ioaddr, 0x19, ephy_data); + + ephy_data = rtl8168_ephy_read(ioaddr, 0x00); + ephy_data |= BIT_3; + rtl8168_ephy_write(ioaddr, 0x00, ephy_data); + ephy_data = rtl8168_ephy_read(ioaddr, 0x0C); + ephy_data &= ~(BIT_13 | BIT_12 | BIT_11 | BIT_10 | BIT_8 | BIT_7 | BIT_6 | BIT_5 | BIT_4); + ephy_data |= BIT_9; + rtl8168_ephy_write(ioaddr, 0x0C, ephy_data); + } else if (tp->mcfg == CFG_METHOD_18 || tp->mcfg == CFG_METHOD_19) { + if (tp->mcfg == CFG_METHOD_18) { + ephy_data = rtl8168_ephy_read(ioaddr, 0x06); + ephy_data |= BIT_5; + ephy_data &= ~(BIT_7 | BIT_6); + rtl8168_ephy_write(ioaddr, 0x06, ephy_data); + + ephy_data = rtl8168_ephy_read(ioaddr, 0x08); + ephy_data |= BIT_1; + ephy_data &= ~BIT_0; + rtl8168_ephy_write(ioaddr, 0x08, ephy_data); + } + + ephy_data = rtl8168_ephy_read(ioaddr, 0x09); + ephy_data |= BIT_7; + rtl8168_ephy_write(ioaddr, 0x09, ephy_data); + + ephy_data = rtl8168_ephy_read(ioaddr, 0x19); + ephy_data |= (BIT_2 | BIT_5 | BIT_9); + rtl8168_ephy_write(ioaddr, 0x19, ephy_data); + + ephy_data = rtl8168_ephy_read(ioaddr, 0x00); + ephy_data |= BIT_3; + rtl8168_ephy_write(ioaddr, 0x00, ephy_data); + ephy_data = rtl8168_ephy_read(ioaddr, 0x0C); + ephy_data &= ~(BIT_13 | BIT_12 | BIT_11 | BIT_10 | BIT_8 | BIT_7 | BIT_6 | BIT_5 | BIT_4); + ephy_data |= BIT_9; + rtl8168_ephy_write(ioaddr, 0x0C, ephy_data); + } else if (tp->mcfg == CFG_METHOD_20) { + ephy_data = rtl8168_ephy_read(ioaddr, 0x06); + ephy_data |= BIT_5; + ephy_data &= ~(BIT_7 | BIT_6); + rtl8168_ephy_write(ioaddr, 0x06, ephy_data); + + rtl8168_ephy_write(ioaddr, 0x0f, 0x5200); + + ephy_data = rtl8168_ephy_read(ioaddr, 0x19); + ephy_data |= (BIT_2 | BIT_5 | BIT_9); + rtl8168_ephy_write(ioaddr, 0x19, ephy_data); + + ephy_data = rtl8168_ephy_read(ioaddr, 0x00); + ephy_data |= BIT_3; + rtl8168_ephy_write(ioaddr, 0x00, ephy_data); + ephy_data = rtl8168_ephy_read(ioaddr, 0x0C); + ephy_data &= ~(BIT_13 | BIT_12 | BIT_11 | BIT_10 | BIT_8 | BIT_7 | BIT_6 | BIT_5 | BIT_4); + ephy_data |= BIT_9; + rtl8168_ephy_write(ioaddr, 0x0C, ephy_data); + } else if (tp->mcfg == CFG_METHOD_21 || tp->mcfg == CFG_METHOD_22) { + + ephy_data = rtl8168_ephy_read(ioaddr, 0x00); + ephy_data &= ~(BIT_3); + rtl8168_ephy_write(ioaddr, 0x00, ephy_data); + ephy_data = rtl8168_ephy_read(ioaddr, 0x0C); + ephy_data &= ~(BIT_13 | BIT_12 | BIT_11 | BIT_10 | BIT_9 | BIT_8 | BIT_7 | BIT_6 | BIT_5 | BIT_4); + ephy_data |= (BIT_5 | BIT_11); + rtl8168_ephy_write(ioaddr, 0x0C, ephy_data); + + ephy_data = rtl8168_ephy_read(ioaddr, 0x1E); + ephy_data |= (BIT_0); + rtl8168_ephy_write(ioaddr, 0x1E, ephy_data); + + ephy_data = rtl8168_ephy_read(ioaddr, 0x19); + ephy_data &= ~(BIT_15); + rtl8168_ephy_write(ioaddr, 0x19, ephy_data); + } else if (tp->mcfg == CFG_METHOD_25) { + ephy_data = rtl8168_ephy_read(ioaddr, 0x00); + ephy_data &= ~BIT_3; + rtl8168_ephy_write(ioaddr, 0x00, ephy_data); + ephy_data = rtl8168_ephy_read(ioaddr, 0x0C); + ephy_data &= ~(BIT_13 | BIT_12 | BIT_11 | BIT_10| BIT_9 | BIT_8 | BIT_7 | BIT_6 | BIT_5 | BIT_4); + ephy_data |= (BIT_5 | BIT_11); + rtl8168_ephy_write(ioaddr, 0x0C, ephy_data); + + rtl8168_ephy_write(ioaddr, 0x19, 0x7C00); + rtl8168_ephy_write(ioaddr, 0x1E, 0x20EB); + rtl8168_ephy_write(ioaddr, 0x0D, 0x1666); + rtl8168_ephy_write(ioaddr, 0x00, 0x10A3); + rtl8168_ephy_write(ioaddr, 0x06, 0xF050); + } else if (tp->mcfg == CFG_METHOD_26) { + ClearPCIePhyBit(tp, 0x00, BIT_3); + ClearAndSetPCIePhyBit( tp, + 0x0C, + (BIT_13 | BIT_12 | BIT_10 | BIT_9 | BIT_8 | BIT_7 | BIT_6 | BIT_4), + (BIT_5 | BIT_11) + ); + ClearPCIePhyBit(tp, 0x1E, BIT_0); + ClearPCIePhyBit(tp, 0x19, BIT_15); + + ClearPCIePhyBit(tp, 0x19, (BIT_5 | BIT_0)); + + SetPCIePhyBit(tp, 0x1E, BIT_13); + ClearPCIePhyBit(tp, 0x0D, BIT_8); + SetPCIePhyBit(tp, 0x0D, BIT_9); + SetPCIePhyBit(tp, 0x00, BIT_7); + + SetPCIePhyBit(tp, 0x06, BIT_4); + } else if (tp->mcfg == CFG_METHOD_23) { + rtl8168_ephy_write(ioaddr, 0x00, 0x10AB); + rtl8168_ephy_write(ioaddr, 0x06, 0xf030); + rtl8168_ephy_write(ioaddr, 0x08, 0x2006); + rtl8168_ephy_write(ioaddr, 0x0D, 0x1666); + + ephy_data = rtl8168_ephy_read(ioaddr, 0x0C); + ephy_data &= ~(BIT_13 | BIT_12 | BIT_11 | BIT_10 | BIT_9 | BIT_8 | BIT_7 | BIT_6 | BIT_5 | BIT_4); + rtl8168_ephy_write(ioaddr, 0x0C, ephy_data); + } else if (tp->mcfg == CFG_METHOD_27) { + rtl8168_ephy_write(ioaddr, 0x00, 0x10A3); + rtl8168_ephy_write(ioaddr, 0x19, 0xFC00); + rtl8168_ephy_write(ioaddr, 0x1E, 0x20EA); + } else if (tp->mcfg == CFG_METHOD_28) { + SetPCIePhyBit(tp, 0x00, BIT_7); + ClearAndSetPCIePhyBit(tp, + 0x0D, + BIT_8, + BIT_9 + ); + ClearPCIePhyBit(tp, 0x19, (BIT_15 | BIT_5 | BIT_0)); + SetPCIePhyBit(tp, 0x1E, BIT_13); + + } else if (tp->mcfg == CFG_METHOD_29 || tp->mcfg == CFG_METHOD_30) { + ClearPCIePhyBit(tp, 0x1E, BIT_11); + + SetPCIePhyBit(tp, 0x1E, BIT_0); + SetPCIePhyBit(tp, 0x1D, BIT_11); + + rtl8168_ephy_write(ioaddr, 0x05, 0x2089); + rtl8168_ephy_write(ioaddr, 0x06, 0x5881); + + rtl8168_ephy_write(ioaddr, 0x04, 0x154A); + rtl8168_ephy_write(ioaddr, 0x01, 0x068B); + } +} + +static int +rtl8168_check_hw_phy_mcu_code_ver(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + int ram_code_ver_match = 0; + + switch (tp->mcfg) { + case CFG_METHOD_14: + case CFG_METHOD_15: + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B60); + tp->hw_ram_code_ver = mdio_read(tp, 0x06); + mdio_write(tp, 0x1F, 0x0000); + break; + case CFG_METHOD_16: + case CFG_METHOD_17: + case CFG_METHOD_18: + case CFG_METHOD_19: + case CFG_METHOD_20: + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B30); + tp->hw_ram_code_ver = mdio_read(tp, 0x06); + mdio_write(tp, 0x1F, 0x0000); + break; + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_29: + case CFG_METHOD_30: + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x801E); + tp->hw_ram_code_ver = mdio_read(tp, 0x14); + mdio_write(tp, 0x1F, 0x0000); + break; + default: + tp->hw_ram_code_ver = ~0; + break; + } + + if( tp->hw_ram_code_ver == tp->sw_ram_code_ver) { + ram_code_ver_match = 1; + tp->HwHasWrRamCodeToMicroP = TRUE; + } + + return ram_code_ver_match; +} + +static void +rtl8168_write_hw_phy_mcu_code_ver(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + + switch (tp->mcfg) { + case CFG_METHOD_14: + case CFG_METHOD_15: + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B60); + mdio_write(tp, 0x06, tp->sw_ram_code_ver); + mdio_write(tp, 0x1F, 0x0000); + tp->hw_ram_code_ver = tp->sw_ram_code_ver; + break; + case CFG_METHOD_16: + case CFG_METHOD_17: + case CFG_METHOD_18: + case CFG_METHOD_19: + case CFG_METHOD_20: + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B30); + mdio_write(tp, 0x06, tp->sw_ram_code_ver); + mdio_write(tp, 0x1F, 0x0000); + tp->hw_ram_code_ver = tp->sw_ram_code_ver; + break; + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_29: + case CFG_METHOD_30: + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x801E); + mdio_write(tp, 0x14, tp->sw_ram_code_ver); + mdio_write(tp, 0x1F, 0x0000); + tp->hw_ram_code_ver = tp->sw_ram_code_ver; + break; + } +} +static int +rtl8168_phy_ram_code_check(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + u16 PhyRegValue; + u32 WaitCnt; + int retval = TRUE; + + switch(tp->mcfg) { + case CFG_METHOD_21: + mdio_write(tp, 0x1f, 0x0A40); + PhyRegValue = mdio_read(tp, 0x10); + PhyRegValue &= ~(BIT_11); + mdio_write(tp, 0x10, PhyRegValue); + + + mdio_write(tp, 0x1f, 0x0A00); + PhyRegValue = mdio_read(tp, 0x10); + PhyRegValue &= ~(BIT_12 | BIT_13 | BIT_14 | BIT_15); + mdio_write(tp, 0x10, PhyRegValue); + + mdio_write(tp, 0x1f, 0x0A43); + mdio_write(tp, 0x13, 0x8010); + PhyRegValue = mdio_read(tp, 0x14); + PhyRegValue &= ~(BIT_11); + mdio_write(tp, 0x14, PhyRegValue); + + mdio_write(tp,0x1f, 0x0B82); + PhyRegValue = mdio_read(tp, 0x10); + PhyRegValue |= BIT_4; + mdio_write(tp,0x10, PhyRegValue); + + mdio_write(tp,0x1f, 0x0B80); + WaitCnt = 0; + do { + PhyRegValue = mdio_read(tp, 0x10); + PhyRegValue &= 0x0040; + udelay(100); + WaitCnt++; + } while(PhyRegValue != 0x0040 && WaitCnt <1000); + + if(WaitCnt == 1000) { + retval = FALSE ; + } + + mdio_write(tp, 0x1f, 0x0A40); + mdio_write(tp, 0x10, 0x0140); + + mdio_write(tp, 0x1f, 0x0A4A); + PhyRegValue = mdio_read(tp, 0x13); + PhyRegValue &= ~(BIT_6); + PhyRegValue |= (BIT_7); + mdio_write(tp, 0x13, PhyRegValue); + + mdio_write(tp, 0x1f, 0x0A44); + PhyRegValue = mdio_read(tp, 0x14); + PhyRegValue |= (BIT_2); + mdio_write(tp, 0x14, PhyRegValue); + + mdio_write(tp, 0x1f, 0x0A50); + PhyRegValue = mdio_read(tp, 0x11); + PhyRegValue |= (BIT_11|BIT_12); + mdio_write(tp, 0x11, PhyRegValue); + + mdio_write(tp, 0x1f, 0x0B82); + PhyRegValue = mdio_read(tp, 0x10); + PhyRegValue &= ~(BIT_4); + mdio_write(tp, 0x10, PhyRegValue); + + mdio_write(tp,0x1f, 0x0A22); + WaitCnt = 0; + do { + PhyRegValue = mdio_read(tp, 0x12); + PhyRegValue &= 0x0010; + udelay(100); + WaitCnt++; + } while(PhyRegValue != 0x0010 && WaitCnt <1000); + + if(WaitCnt == 1000) { + retval = FALSE; + } + + mdio_write(tp, 0x1f, 0x0A40); + mdio_write(tp, 0x10, 0x1040); + + mdio_write(tp, 0x1f, 0x0A4A); + PhyRegValue = mdio_read(tp, 0x13); + PhyRegValue &= ~(BIT_6|BIT_7); + mdio_write(tp, 0x13, PhyRegValue); + + mdio_write(tp, 0x1f, 0x0A44); + PhyRegValue = mdio_read(tp, 0x14); + PhyRegValue &= ~(BIT_2); + mdio_write(tp, 0x14, PhyRegValue); + + mdio_write(tp, 0x1f, 0x0A50); + PhyRegValue = mdio_read(tp, 0x11); + PhyRegValue &= ~(BIT_11|BIT_12); + mdio_write(tp, 0x11, PhyRegValue); + + mdio_write(tp, 0x1f, 0x0A43); + mdio_write(tp, 0x13, 0x8010); + PhyRegValue = mdio_read(tp, 0x14); + PhyRegValue |= (BIT_11); + mdio_write(tp, 0x14, PhyRegValue); + + mdio_write(tp,0x1f, 0x0B82); + PhyRegValue = mdio_read(tp, 0x10); + PhyRegValue |= BIT_4; + mdio_write(tp,0x10, PhyRegValue); + + mdio_write(tp,0x1f, 0x0B80); + WaitCnt = 0; + do { + PhyRegValue = mdio_read(tp, 0x10); + PhyRegValue &= 0x0040; + udelay(100); + WaitCnt++; + } while(PhyRegValue != 0x0040 && WaitCnt <1000); + + if( WaitCnt == 1000) { + retval = FALSE; + } + + mdio_write(tp, 0x1f, 0x0A20); + PhyRegValue = mdio_read(tp, 0x13); + if(PhyRegValue & BIT_11) { + if(PhyRegValue & BIT_10) { + retval = FALSE; + } + } + + mdio_write(tp, 0x1f, 0x0B82); + PhyRegValue = mdio_read(tp, 0x10); + PhyRegValue &= ~(BIT_4); + mdio_write(tp, 0x10, PhyRegValue); + + mdelay(2); + break; + default: + break; + } + + mdio_write(tp, 0x1F, 0x0000); + + return retval; +} + +static void +rtl8168_set_phy_ram_code_check_fail_flag(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + u16 TmpUshort; + + switch(tp->mcfg) { + case CFG_METHOD_21: + TmpUshort = mac_ocp_read(tp, 0xD3C0); + TmpUshort |= BIT_0; + mac_ocp_write(tp, 0xD3C0, TmpUshort); + break; + } +} + +static void +rtl8168_set_phy_mcu_8168e_1(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + unsigned int gphy_val,i; + + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x00, 0x1800); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0023); + mdio_write(tp, 0x17, 0x0117); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1E, 0x002C); + mdio_write(tp, 0x1B, 0x5000); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x16, 0x4104); + for (i = 0; i < 200; i++) { + udelay(100); + gphy_val = mdio_read(tp, 0x1E); + gphy_val &= 0x03FF; + if (gphy_val == 0x000C) + break; + } + mdio_write(tp, 0x1f, 0x0005); + for (i = 0; i < 200; i++) { + udelay(100); + gphy_val = mdio_read(tp, 0x07); + if ((gphy_val & BIT_5) == 0) + break; + } + gphy_val = mdio_read(tp, 0x07); + if (gphy_val & BIT_5) { + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x00a1); + mdio_write(tp, 0x17, 0x1000); + mdio_write(tp, 0x17, 0x0000); + mdio_write(tp, 0x17, 0x2000); + mdio_write(tp, 0x1e, 0x002f); + mdio_write(tp, 0x18, 0x9bfb); + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x07, 0x0000); + mdio_write(tp, 0x1f, 0x0000); + } + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x05, 0xfff6); + mdio_write(tp, 0x06, 0x0080); + gphy_val = mdio_read(tp, 0x00); + gphy_val &= ~(BIT_7); + mdio_write(tp, 0x00, gphy_val); + mdio_write(tp, 0x1f, 0x0002); + gphy_val = mdio_read(tp, 0x08); + gphy_val &= ~(BIT_7); + mdio_write(tp, 0x08, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0023); + mdio_write(tp, 0x16, 0x0306); + mdio_write(tp, 0x16, 0x0307); + mdio_write(tp, 0x15, 0x000e); + mdio_write(tp, 0x19, 0x000a); + mdio_write(tp, 0x15, 0x0010); + mdio_write(tp, 0x19, 0x0008); + mdio_write(tp, 0x15, 0x0018); + mdio_write(tp, 0x19, 0x4801); + mdio_write(tp, 0x15, 0x0019); + mdio_write(tp, 0x19, 0x6801); + mdio_write(tp, 0x15, 0x001a); + mdio_write(tp, 0x19, 0x66a1); + mdio_write(tp, 0x15, 0x001f); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0020); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0021); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0022); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0023); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0024); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0025); + mdio_write(tp, 0x19, 0x64a1); + mdio_write(tp, 0x15, 0x0026); + mdio_write(tp, 0x19, 0x40ea); + mdio_write(tp, 0x15, 0x0027); + mdio_write(tp, 0x19, 0x4503); + mdio_write(tp, 0x15, 0x0028); + mdio_write(tp, 0x19, 0x9f00); + mdio_write(tp, 0x15, 0x0029); + mdio_write(tp, 0x19, 0xa631); + mdio_write(tp, 0x15, 0x002a); + mdio_write(tp, 0x19, 0x9717); + mdio_write(tp, 0x15, 0x002b); + mdio_write(tp, 0x19, 0x302c); + mdio_write(tp, 0x15, 0x002c); + mdio_write(tp, 0x19, 0x4802); + mdio_write(tp, 0x15, 0x002d); + mdio_write(tp, 0x19, 0x58da); + mdio_write(tp, 0x15, 0x002e); + mdio_write(tp, 0x19, 0x400d); + mdio_write(tp, 0x15, 0x002f); + mdio_write(tp, 0x19, 0x4488); + mdio_write(tp, 0x15, 0x0030); + mdio_write(tp, 0x19, 0x9e00); + mdio_write(tp, 0x15, 0x0031); + mdio_write(tp, 0x19, 0x63c8); + mdio_write(tp, 0x15, 0x0032); + mdio_write(tp, 0x19, 0x6481); + mdio_write(tp, 0x15, 0x0033); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0034); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0035); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0036); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0037); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0038); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0039); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x003a); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x003b); + mdio_write(tp, 0x19, 0x63e8); + mdio_write(tp, 0x15, 0x003c); + mdio_write(tp, 0x19, 0x7d00); + mdio_write(tp, 0x15, 0x003d); + mdio_write(tp, 0x19, 0x59d4); + mdio_write(tp, 0x15, 0x003e); + mdio_write(tp, 0x19, 0x63f8); + mdio_write(tp, 0x15, 0x0040); + mdio_write(tp, 0x19, 0x64a1); + mdio_write(tp, 0x15, 0x0041); + mdio_write(tp, 0x19, 0x30de); + mdio_write(tp, 0x15, 0x0044); + mdio_write(tp, 0x19, 0x480f); + mdio_write(tp, 0x15, 0x0045); + mdio_write(tp, 0x19, 0x6800); + mdio_write(tp, 0x15, 0x0046); + mdio_write(tp, 0x19, 0x6680); + mdio_write(tp, 0x15, 0x0047); + mdio_write(tp, 0x19, 0x7c10); + mdio_write(tp, 0x15, 0x0048); + mdio_write(tp, 0x19, 0x63c8); + mdio_write(tp, 0x15, 0x0049); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x004a); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x004b); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x004c); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x004d); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x004e); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x004f); + mdio_write(tp, 0x19, 0x40ea); + mdio_write(tp, 0x15, 0x0050); + mdio_write(tp, 0x19, 0x4503); + mdio_write(tp, 0x15, 0x0051); + mdio_write(tp, 0x19, 0x58ca); + mdio_write(tp, 0x15, 0x0052); + mdio_write(tp, 0x19, 0x63c8); + mdio_write(tp, 0x15, 0x0053); + mdio_write(tp, 0x19, 0x63d8); + mdio_write(tp, 0x15, 0x0054); + mdio_write(tp, 0x19, 0x66a0); + mdio_write(tp, 0x15, 0x0055); + mdio_write(tp, 0x19, 0x9f00); + mdio_write(tp, 0x15, 0x0056); + mdio_write(tp, 0x19, 0x3000); + mdio_write(tp, 0x15, 0x006E); + mdio_write(tp, 0x19, 0x9afa); + mdio_write(tp, 0x15, 0x00a1); + mdio_write(tp, 0x19, 0x3044); + mdio_write(tp, 0x15, 0x00ab); + mdio_write(tp, 0x19, 0x5820); + mdio_write(tp, 0x15, 0x00ac); + mdio_write(tp, 0x19, 0x5e04); + mdio_write(tp, 0x15, 0x00ad); + mdio_write(tp, 0x19, 0xb60c); + mdio_write(tp, 0x15, 0x00af); + mdio_write(tp, 0x19, 0x000a); + mdio_write(tp, 0x15, 0x00b2); + mdio_write(tp, 0x19, 0x30b9); + mdio_write(tp, 0x15, 0x00b9); + mdio_write(tp, 0x19, 0x4408); + mdio_write(tp, 0x15, 0x00ba); + mdio_write(tp, 0x19, 0x480b); + mdio_write(tp, 0x15, 0x00bb); + mdio_write(tp, 0x19, 0x5e00); + mdio_write(tp, 0x15, 0x00bc); + mdio_write(tp, 0x19, 0x405f); + mdio_write(tp, 0x15, 0x00bd); + mdio_write(tp, 0x19, 0x4448); + mdio_write(tp, 0x15, 0x00be); + mdio_write(tp, 0x19, 0x4020); + mdio_write(tp, 0x15, 0x00bf); + mdio_write(tp, 0x19, 0x4468); + mdio_write(tp, 0x15, 0x00c0); + mdio_write(tp, 0x19, 0x9c02); + mdio_write(tp, 0x15, 0x00c1); + mdio_write(tp, 0x19, 0x58a0); + mdio_write(tp, 0x15, 0x00c2); + mdio_write(tp, 0x19, 0xb605); + mdio_write(tp, 0x15, 0x00c3); + mdio_write(tp, 0x19, 0xc0d3); + mdio_write(tp, 0x15, 0x00c4); + mdio_write(tp, 0x19, 0x00e6); + mdio_write(tp, 0x15, 0x00c5); + mdio_write(tp, 0x19, 0xdaec); + mdio_write(tp, 0x15, 0x00c6); + mdio_write(tp, 0x19, 0x00fa); + mdio_write(tp, 0x15, 0x00c7); + mdio_write(tp, 0x19, 0x9df9); + mdio_write(tp, 0x15, 0x00c8); + mdio_write(tp, 0x19, 0x307a); + mdio_write(tp, 0x15, 0x0112); + mdio_write(tp, 0x19, 0x6421); + mdio_write(tp, 0x15, 0x0113); + mdio_write(tp, 0x19, 0x7c08); + mdio_write(tp, 0x15, 0x0114); + mdio_write(tp, 0x19, 0x63f0); + mdio_write(tp, 0x15, 0x0115); + mdio_write(tp, 0x19, 0x4003); + mdio_write(tp, 0x15, 0x0116); + mdio_write(tp, 0x19, 0x4418); + mdio_write(tp, 0x15, 0x0117); + mdio_write(tp, 0x19, 0x9b00); + mdio_write(tp, 0x15, 0x0118); + mdio_write(tp, 0x19, 0x6461); + mdio_write(tp, 0x15, 0x0119); + mdio_write(tp, 0x19, 0x64e1); + mdio_write(tp, 0x15, 0x011a); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0150); + mdio_write(tp, 0x19, 0x7c80); + mdio_write(tp, 0x15, 0x0151); + mdio_write(tp, 0x19, 0x6461); + mdio_write(tp, 0x15, 0x0152); + mdio_write(tp, 0x19, 0x4003); + mdio_write(tp, 0x15, 0x0153); + mdio_write(tp, 0x19, 0x4540); + mdio_write(tp, 0x15, 0x0154); + mdio_write(tp, 0x19, 0x9f00); + mdio_write(tp, 0x15, 0x0155); + mdio_write(tp, 0x19, 0x9d00); + mdio_write(tp, 0x15, 0x0156); + mdio_write(tp, 0x19, 0x7c40); + mdio_write(tp, 0x15, 0x0157); + mdio_write(tp, 0x19, 0x6421); + mdio_write(tp, 0x15, 0x0158); + mdio_write(tp, 0x19, 0x7c80); + mdio_write(tp, 0x15, 0x0159); + mdio_write(tp, 0x19, 0x64a1); + mdio_write(tp, 0x15, 0x015a); + mdio_write(tp, 0x19, 0x30fe); + mdio_write(tp, 0x15, 0x021e); + mdio_write(tp, 0x19, 0x5410); + mdio_write(tp, 0x15, 0x0225); + mdio_write(tp, 0x19, 0x5400); + mdio_write(tp, 0x15, 0x023D); + mdio_write(tp, 0x19, 0x4050); + mdio_write(tp, 0x15, 0x0295); + mdio_write(tp, 0x19, 0x6c08); + mdio_write(tp, 0x15, 0x02bd); + mdio_write(tp, 0x19, 0xa523); + mdio_write(tp, 0x15, 0x02be); + mdio_write(tp, 0x19, 0x32ca); + mdio_write(tp, 0x15, 0x02ca); + mdio_write(tp, 0x19, 0x48b3); + mdio_write(tp, 0x15, 0x02cb); + mdio_write(tp, 0x19, 0x4020); + mdio_write(tp, 0x15, 0x02cc); + mdio_write(tp, 0x19, 0x4823); + mdio_write(tp, 0x15, 0x02cd); + mdio_write(tp, 0x19, 0x4510); + mdio_write(tp, 0x15, 0x02ce); + mdio_write(tp, 0x19, 0xb63a); + mdio_write(tp, 0x15, 0x02cf); + mdio_write(tp, 0x19, 0x7dc8); + mdio_write(tp, 0x15, 0x02d6); + mdio_write(tp, 0x19, 0x9bf8); + mdio_write(tp, 0x15, 0x02d8); + mdio_write(tp, 0x19, 0x85f6); + mdio_write(tp, 0x15, 0x02d9); + mdio_write(tp, 0x19, 0x32e0); + mdio_write(tp, 0x15, 0x02e0); + mdio_write(tp, 0x19, 0x4834); + mdio_write(tp, 0x15, 0x02e1); + mdio_write(tp, 0x19, 0x6c08); + mdio_write(tp, 0x15, 0x02e2); + mdio_write(tp, 0x19, 0x4020); + mdio_write(tp, 0x15, 0x02e3); + mdio_write(tp, 0x19, 0x4824); + mdio_write(tp, 0x15, 0x02e4); + mdio_write(tp, 0x19, 0x4520); + mdio_write(tp, 0x15, 0x02e5); + mdio_write(tp, 0x19, 0x4008); + mdio_write(tp, 0x15, 0x02e6); + mdio_write(tp, 0x19, 0x4560); + mdio_write(tp, 0x15, 0x02e7); + mdio_write(tp, 0x19, 0x9d04); + mdio_write(tp, 0x15, 0x02e8); + mdio_write(tp, 0x19, 0x48c4); + mdio_write(tp, 0x15, 0x02e9); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x02ea); + mdio_write(tp, 0x19, 0x4844); + mdio_write(tp, 0x15, 0x02eb); + mdio_write(tp, 0x19, 0x7dc8); + mdio_write(tp, 0x15, 0x02f0); + mdio_write(tp, 0x19, 0x9cf7); + mdio_write(tp, 0x15, 0x02f1); + mdio_write(tp, 0x19, 0xdf94); + mdio_write(tp, 0x15, 0x02f2); + mdio_write(tp, 0x19, 0x0002); + mdio_write(tp, 0x15, 0x02f3); + mdio_write(tp, 0x19, 0x6810); + mdio_write(tp, 0x15, 0x02f4); + mdio_write(tp, 0x19, 0xb614); + mdio_write(tp, 0x15, 0x02f5); + mdio_write(tp, 0x19, 0xc42b); + mdio_write(tp, 0x15, 0x02f6); + mdio_write(tp, 0x19, 0x00d4); + mdio_write(tp, 0x15, 0x02f7); + mdio_write(tp, 0x19, 0xc455); + mdio_write(tp, 0x15, 0x02f8); + mdio_write(tp, 0x19, 0x0093); + mdio_write(tp, 0x15, 0x02f9); + mdio_write(tp, 0x19, 0x92ee); + mdio_write(tp, 0x15, 0x02fa); + mdio_write(tp, 0x19, 0xefed); + mdio_write(tp, 0x15, 0x02fb); + mdio_write(tp, 0x19, 0x3312); + mdio_write(tp, 0x15, 0x0312); + mdio_write(tp, 0x19, 0x49b5); + mdio_write(tp, 0x15, 0x0313); + mdio_write(tp, 0x19, 0x7d00); + mdio_write(tp, 0x15, 0x0314); + mdio_write(tp, 0x19, 0x4d00); + mdio_write(tp, 0x15, 0x0315); + mdio_write(tp, 0x19, 0x6810); + mdio_write(tp, 0x15, 0x031e); + mdio_write(tp, 0x19, 0x404f); + mdio_write(tp, 0x15, 0x031f); + mdio_write(tp, 0x19, 0x44c8); + mdio_write(tp, 0x15, 0x0320); + mdio_write(tp, 0x19, 0xd64f); + mdio_write(tp, 0x15, 0x0321); + mdio_write(tp, 0x19, 0x00e7); + mdio_write(tp, 0x15, 0x0322); + mdio_write(tp, 0x19, 0x7c08); + mdio_write(tp, 0x15, 0x0323); + mdio_write(tp, 0x19, 0x8203); + mdio_write(tp, 0x15, 0x0324); + mdio_write(tp, 0x19, 0x4d48); + mdio_write(tp, 0x15, 0x0325); + mdio_write(tp, 0x19, 0x3327); + mdio_write(tp, 0x15, 0x0326); + mdio_write(tp, 0x19, 0x4d40); + mdio_write(tp, 0x15, 0x0327); + mdio_write(tp, 0x19, 0xc8d7); + mdio_write(tp, 0x15, 0x0328); + mdio_write(tp, 0x19, 0x0003); + mdio_write(tp, 0x15, 0x0329); + mdio_write(tp, 0x19, 0x7c20); + mdio_write(tp, 0x15, 0x032a); + mdio_write(tp, 0x19, 0x4c20); + mdio_write(tp, 0x15, 0x032b); + mdio_write(tp, 0x19, 0xc8ed); + mdio_write(tp, 0x15, 0x032c); + mdio_write(tp, 0x19, 0x00f4); + mdio_write(tp, 0x15, 0x032d); + mdio_write(tp, 0x19, 0x82b3); + mdio_write(tp, 0x15, 0x032e); + mdio_write(tp, 0x19, 0xd11d); + mdio_write(tp, 0x15, 0x032f); + mdio_write(tp, 0x19, 0x00b1); + mdio_write(tp, 0x15, 0x0330); + mdio_write(tp, 0x19, 0xde18); + mdio_write(tp, 0x15, 0x0331); + mdio_write(tp, 0x19, 0x0008); + mdio_write(tp, 0x15, 0x0332); + mdio_write(tp, 0x19, 0x91ee); + mdio_write(tp, 0x15, 0x0333); + mdio_write(tp, 0x19, 0x3339); + mdio_write(tp, 0x15, 0x033a); + mdio_write(tp, 0x19, 0x4064); + mdio_write(tp, 0x15, 0x0340); + mdio_write(tp, 0x19, 0x9e06); + mdio_write(tp, 0x15, 0x0341); + mdio_write(tp, 0x19, 0x7c08); + mdio_write(tp, 0x15, 0x0342); + mdio_write(tp, 0x19, 0x8203); + mdio_write(tp, 0x15, 0x0343); + mdio_write(tp, 0x19, 0x4d48); + mdio_write(tp, 0x15, 0x0344); + mdio_write(tp, 0x19, 0x3346); + mdio_write(tp, 0x15, 0x0345); + mdio_write(tp, 0x19, 0x4d40); + mdio_write(tp, 0x15, 0x0346); + mdio_write(tp, 0x19, 0xd11d); + mdio_write(tp, 0x15, 0x0347); + mdio_write(tp, 0x19, 0x0099); + mdio_write(tp, 0x15, 0x0348); + mdio_write(tp, 0x19, 0xbb17); + mdio_write(tp, 0x15, 0x0349); + mdio_write(tp, 0x19, 0x8102); + mdio_write(tp, 0x15, 0x034a); + mdio_write(tp, 0x19, 0x334d); + mdio_write(tp, 0x15, 0x034b); + mdio_write(tp, 0x19, 0xa22c); + mdio_write(tp, 0x15, 0x034c); + mdio_write(tp, 0x19, 0x3397); + mdio_write(tp, 0x15, 0x034d); + mdio_write(tp, 0x19, 0x91f2); + mdio_write(tp, 0x15, 0x034e); + mdio_write(tp, 0x19, 0xc218); + mdio_write(tp, 0x15, 0x034f); + mdio_write(tp, 0x19, 0x00f0); + mdio_write(tp, 0x15, 0x0350); + mdio_write(tp, 0x19, 0x3397); + mdio_write(tp, 0x15, 0x0351); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0364); + mdio_write(tp, 0x19, 0xbc05); + mdio_write(tp, 0x15, 0x0367); + mdio_write(tp, 0x19, 0xa1fc); + mdio_write(tp, 0x15, 0x0368); + mdio_write(tp, 0x19, 0x3377); + mdio_write(tp, 0x15, 0x0369); + mdio_write(tp, 0x19, 0x328b); + mdio_write(tp, 0x15, 0x036a); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0377); + mdio_write(tp, 0x19, 0x4b97); + mdio_write(tp, 0x15, 0x0378); + mdio_write(tp, 0x19, 0x6818); + mdio_write(tp, 0x15, 0x0379); + mdio_write(tp, 0x19, 0x4b07); + mdio_write(tp, 0x15, 0x037a); + mdio_write(tp, 0x19, 0x40ac); + mdio_write(tp, 0x15, 0x037b); + mdio_write(tp, 0x19, 0x4445); + mdio_write(tp, 0x15, 0x037c); + mdio_write(tp, 0x19, 0x404e); + mdio_write(tp, 0x15, 0x037d); + mdio_write(tp, 0x19, 0x4461); + mdio_write(tp, 0x15, 0x037e); + mdio_write(tp, 0x19, 0x9c09); + mdio_write(tp, 0x15, 0x037f); + mdio_write(tp, 0x19, 0x63da); + mdio_write(tp, 0x15, 0x0380); + mdio_write(tp, 0x19, 0x5440); + mdio_write(tp, 0x15, 0x0381); + mdio_write(tp, 0x19, 0x4b98); + mdio_write(tp, 0x15, 0x0382); + mdio_write(tp, 0x19, 0x7c60); + mdio_write(tp, 0x15, 0x0383); + mdio_write(tp, 0x19, 0x4c00); + mdio_write(tp, 0x15, 0x0384); + mdio_write(tp, 0x19, 0x4b08); + mdio_write(tp, 0x15, 0x0385); + mdio_write(tp, 0x19, 0x63d8); + mdio_write(tp, 0x15, 0x0386); + mdio_write(tp, 0x19, 0x338d); + mdio_write(tp, 0x15, 0x0387); + mdio_write(tp, 0x19, 0xd64f); + mdio_write(tp, 0x15, 0x0388); + mdio_write(tp, 0x19, 0x0080); + mdio_write(tp, 0x15, 0x0389); + mdio_write(tp, 0x19, 0x820c); + mdio_write(tp, 0x15, 0x038a); + mdio_write(tp, 0x19, 0xa10b); + mdio_write(tp, 0x15, 0x038b); + mdio_write(tp, 0x19, 0x9df3); + mdio_write(tp, 0x15, 0x038c); + mdio_write(tp, 0x19, 0x3395); + mdio_write(tp, 0x15, 0x038d); + mdio_write(tp, 0x19, 0xd64f); + mdio_write(tp, 0x15, 0x038e); + mdio_write(tp, 0x19, 0x00f9); + mdio_write(tp, 0x15, 0x038f); + mdio_write(tp, 0x19, 0xc017); + mdio_write(tp, 0x15, 0x0390); + mdio_write(tp, 0x19, 0x0005); + mdio_write(tp, 0x15, 0x0391); + mdio_write(tp, 0x19, 0x6c0b); + mdio_write(tp, 0x15, 0x0392); + mdio_write(tp, 0x19, 0xa103); + mdio_write(tp, 0x15, 0x0393); + mdio_write(tp, 0x19, 0x6c08); + mdio_write(tp, 0x15, 0x0394); + mdio_write(tp, 0x19, 0x9df9); + mdio_write(tp, 0x15, 0x0395); + mdio_write(tp, 0x19, 0x6c08); + mdio_write(tp, 0x15, 0x0396); + mdio_write(tp, 0x19, 0x3397); + mdio_write(tp, 0x15, 0x0399); + mdio_write(tp, 0x19, 0x6810); + mdio_write(tp, 0x15, 0x03a4); + mdio_write(tp, 0x19, 0x7c08); + mdio_write(tp, 0x15, 0x03a5); + mdio_write(tp, 0x19, 0x8203); + mdio_write(tp, 0x15, 0x03a6); + mdio_write(tp, 0x19, 0x4d08); + mdio_write(tp, 0x15, 0x03a7); + mdio_write(tp, 0x19, 0x33a9); + mdio_write(tp, 0x15, 0x03a8); + mdio_write(tp, 0x19, 0x4d00); + mdio_write(tp, 0x15, 0x03a9); + mdio_write(tp, 0x19, 0x9bfa); + mdio_write(tp, 0x15, 0x03aa); + mdio_write(tp, 0x19, 0x33b6); + mdio_write(tp, 0x15, 0x03bb); + mdio_write(tp, 0x19, 0x4056); + mdio_write(tp, 0x15, 0x03bc); + mdio_write(tp, 0x19, 0x44e9); + mdio_write(tp, 0x15, 0x03bd); + mdio_write(tp, 0x19, 0x405e); + mdio_write(tp, 0x15, 0x03be); + mdio_write(tp, 0x19, 0x44f8); + mdio_write(tp, 0x15, 0x03bf); + mdio_write(tp, 0x19, 0xd64f); + mdio_write(tp, 0x15, 0x03c0); + mdio_write(tp, 0x19, 0x0037); + mdio_write(tp, 0x15, 0x03c1); + mdio_write(tp, 0x19, 0xbd37); + mdio_write(tp, 0x15, 0x03c2); + mdio_write(tp, 0x19, 0x9cfd); + mdio_write(tp, 0x15, 0x03c3); + mdio_write(tp, 0x19, 0xc639); + mdio_write(tp, 0x15, 0x03c4); + mdio_write(tp, 0x19, 0x0011); + mdio_write(tp, 0x15, 0x03c5); + mdio_write(tp, 0x19, 0x9b03); + mdio_write(tp, 0x15, 0x03c6); + mdio_write(tp, 0x19, 0x7c01); + mdio_write(tp, 0x15, 0x03c7); + mdio_write(tp, 0x19, 0x4c01); + mdio_write(tp, 0x15, 0x03c8); + mdio_write(tp, 0x19, 0x9e03); + mdio_write(tp, 0x15, 0x03c9); + mdio_write(tp, 0x19, 0x7c20); + mdio_write(tp, 0x15, 0x03ca); + mdio_write(tp, 0x19, 0x4c20); + mdio_write(tp, 0x15, 0x03cb); + mdio_write(tp, 0x19, 0x9af4); + mdio_write(tp, 0x15, 0x03cc); + mdio_write(tp, 0x19, 0x7c12); + mdio_write(tp, 0x15, 0x03cd); + mdio_write(tp, 0x19, 0x4c52); + mdio_write(tp, 0x15, 0x03ce); + mdio_write(tp, 0x19, 0x4470); + mdio_write(tp, 0x15, 0x03cf); + mdio_write(tp, 0x19, 0x7c12); + mdio_write(tp, 0x15, 0x03d0); + mdio_write(tp, 0x19, 0x4c40); + mdio_write(tp, 0x15, 0x03d1); + mdio_write(tp, 0x19, 0x33bf); + mdio_write(tp, 0x15, 0x03d6); + mdio_write(tp, 0x19, 0x4047); + mdio_write(tp, 0x15, 0x03d7); + mdio_write(tp, 0x19, 0x4469); + mdio_write(tp, 0x15, 0x03d8); + mdio_write(tp, 0x19, 0x492b); + mdio_write(tp, 0x15, 0x03d9); + mdio_write(tp, 0x19, 0x4479); + mdio_write(tp, 0x15, 0x03da); + mdio_write(tp, 0x19, 0x7c09); + mdio_write(tp, 0x15, 0x03db); + mdio_write(tp, 0x19, 0x8203); + mdio_write(tp, 0x15, 0x03dc); + mdio_write(tp, 0x19, 0x4d48); + mdio_write(tp, 0x15, 0x03dd); + mdio_write(tp, 0x19, 0x33df); + mdio_write(tp, 0x15, 0x03de); + mdio_write(tp, 0x19, 0x4d40); + mdio_write(tp, 0x15, 0x03df); + mdio_write(tp, 0x19, 0xd64f); + mdio_write(tp, 0x15, 0x03e0); + mdio_write(tp, 0x19, 0x0017); + mdio_write(tp, 0x15, 0x03e1); + mdio_write(tp, 0x19, 0xbd17); + mdio_write(tp, 0x15, 0x03e2); + mdio_write(tp, 0x19, 0x9b03); + mdio_write(tp, 0x15, 0x03e3); + mdio_write(tp, 0x19, 0x7c20); + mdio_write(tp, 0x15, 0x03e4); + mdio_write(tp, 0x19, 0x4c20); + mdio_write(tp, 0x15, 0x03e5); + mdio_write(tp, 0x19, 0x88f5); + mdio_write(tp, 0x15, 0x03e6); + mdio_write(tp, 0x19, 0xc428); + mdio_write(tp, 0x15, 0x03e7); + mdio_write(tp, 0x19, 0x0008); + mdio_write(tp, 0x15, 0x03e8); + mdio_write(tp, 0x19, 0x9af2); + mdio_write(tp, 0x15, 0x03e9); + mdio_write(tp, 0x19, 0x7c12); + mdio_write(tp, 0x15, 0x03ea); + mdio_write(tp, 0x19, 0x4c52); + mdio_write(tp, 0x15, 0x03eb); + mdio_write(tp, 0x19, 0x4470); + mdio_write(tp, 0x15, 0x03ec); + mdio_write(tp, 0x19, 0x7c12); + mdio_write(tp, 0x15, 0x03ed); + mdio_write(tp, 0x19, 0x4c40); + mdio_write(tp, 0x15, 0x03ee); + mdio_write(tp, 0x19, 0x33da); + mdio_write(tp, 0x15, 0x03ef); + mdio_write(tp, 0x19, 0x3312); + mdio_write(tp, 0x16, 0x0306); + mdio_write(tp, 0x16, 0x0300); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x17, 0x2179); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0040); + mdio_write(tp, 0x18, 0x0645); + mdio_write(tp, 0x19, 0xe200); + mdio_write(tp, 0x18, 0x0655); + mdio_write(tp, 0x19, 0x9000); + mdio_write(tp, 0x18, 0x0d05); + mdio_write(tp, 0x19, 0xbe00); + mdio_write(tp, 0x18, 0x0d15); + mdio_write(tp, 0x19, 0xd300); + mdio_write(tp, 0x18, 0x0d25); + mdio_write(tp, 0x19, 0xfe00); + mdio_write(tp, 0x18, 0x0d35); + mdio_write(tp, 0x19, 0x4000); + mdio_write(tp, 0x18, 0x0d45); + mdio_write(tp, 0x19, 0x7f00); + mdio_write(tp, 0x18, 0x0d55); + mdio_write(tp, 0x19, 0x1000); + mdio_write(tp, 0x18, 0x0d65); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x18, 0x0d75); + mdio_write(tp, 0x19, 0x8200); + mdio_write(tp, 0x18, 0x0d85); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x18, 0x0d95); + mdio_write(tp, 0x19, 0x7000); + mdio_write(tp, 0x18, 0x0da5); + mdio_write(tp, 0x19, 0x0f00); + mdio_write(tp, 0x18, 0x0db5); + mdio_write(tp, 0x19, 0x0100); + mdio_write(tp, 0x18, 0x0dc5); + mdio_write(tp, 0x19, 0x9b00); + mdio_write(tp, 0x18, 0x0dd5); + mdio_write(tp, 0x19, 0x7f00); + mdio_write(tp, 0x18, 0x0de5); + mdio_write(tp, 0x19, 0xe000); + mdio_write(tp, 0x18, 0x0df5); + mdio_write(tp, 0x19, 0xef00); + mdio_write(tp, 0x18, 0x16d5); + mdio_write(tp, 0x19, 0xe200); + mdio_write(tp, 0x18, 0x16e5); + mdio_write(tp, 0x19, 0xab00); + mdio_write(tp, 0x18, 0x2904); + mdio_write(tp, 0x19, 0x4000); + mdio_write(tp, 0x18, 0x2914); + mdio_write(tp, 0x19, 0x7f00); + mdio_write(tp, 0x18, 0x2924); + mdio_write(tp, 0x19, 0x0100); + mdio_write(tp, 0x18, 0x2934); + mdio_write(tp, 0x19, 0x2000); + mdio_write(tp, 0x18, 0x2944); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x18, 0x2954); + mdio_write(tp, 0x19, 0x4600); + mdio_write(tp, 0x18, 0x2964); + mdio_write(tp, 0x19, 0xfc00); + mdio_write(tp, 0x18, 0x2974); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x18, 0x2984); + mdio_write(tp, 0x19, 0x5000); + mdio_write(tp, 0x18, 0x2994); + mdio_write(tp, 0x19, 0x9d00); + mdio_write(tp, 0x18, 0x29a4); + mdio_write(tp, 0x19, 0xff00); + mdio_write(tp, 0x18, 0x29b4); + mdio_write(tp, 0x19, 0x4000); + mdio_write(tp, 0x18, 0x29c4); + mdio_write(tp, 0x19, 0x7f00); + mdio_write(tp, 0x18, 0x29d4); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x18, 0x29e4); + mdio_write(tp, 0x19, 0x2000); + mdio_write(tp, 0x18, 0x29f4); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x18, 0x2a04); + mdio_write(tp, 0x19, 0xe600); + mdio_write(tp, 0x18, 0x2a14); + mdio_write(tp, 0x19, 0xff00); + mdio_write(tp, 0x18, 0x2a24); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x18, 0x2a34); + mdio_write(tp, 0x19, 0x5000); + mdio_write(tp, 0x18, 0x2a44); + mdio_write(tp, 0x19, 0x8500); + mdio_write(tp, 0x18, 0x2a54); + mdio_write(tp, 0x19, 0x7f00); + mdio_write(tp, 0x18, 0x2a64); + mdio_write(tp, 0x19, 0xac00); + mdio_write(tp, 0x18, 0x2a74); + mdio_write(tp, 0x19, 0x0800); + mdio_write(tp, 0x18, 0x2a84); + mdio_write(tp, 0x19, 0xfc00); + mdio_write(tp, 0x18, 0x2a94); + mdio_write(tp, 0x19, 0xe000); + mdio_write(tp, 0x18, 0x2aa4); + mdio_write(tp, 0x19, 0x7400); + mdio_write(tp, 0x18, 0x2ab4); + mdio_write(tp, 0x19, 0x4000); + mdio_write(tp, 0x18, 0x2ac4); + mdio_write(tp, 0x19, 0x7f00); + mdio_write(tp, 0x18, 0x2ad4); + mdio_write(tp, 0x19, 0x0100); + mdio_write(tp, 0x18, 0x2ae4); + mdio_write(tp, 0x19, 0xff00); + mdio_write(tp, 0x18, 0x2af4); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x18, 0x2b04); + mdio_write(tp, 0x19, 0x4400); + mdio_write(tp, 0x18, 0x2b14); + mdio_write(tp, 0x19, 0xfc00); + mdio_write(tp, 0x18, 0x2b24); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x18, 0x2b34); + mdio_write(tp, 0x19, 0x4000); + mdio_write(tp, 0x18, 0x2b44); + mdio_write(tp, 0x19, 0x9d00); + mdio_write(tp, 0x18, 0x2b54); + mdio_write(tp, 0x19, 0xff00); + mdio_write(tp, 0x18, 0x2b64); + mdio_write(tp, 0x19, 0x4000); + mdio_write(tp, 0x18, 0x2b74); + mdio_write(tp, 0x19, 0x7f00); + mdio_write(tp, 0x18, 0x2b84); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x18, 0x2b94); + mdio_write(tp, 0x19, 0xff00); + mdio_write(tp, 0x18, 0x2ba4); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x18, 0x2bb4); + mdio_write(tp, 0x19, 0xfc00); + mdio_write(tp, 0x18, 0x2bc4); + mdio_write(tp, 0x19, 0xff00); + mdio_write(tp, 0x18, 0x2bd4); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x18, 0x2be4); + mdio_write(tp, 0x19, 0x4000); + mdio_write(tp, 0x18, 0x2bf4); + mdio_write(tp, 0x19, 0x8900); + mdio_write(tp, 0x18, 0x2c04); + mdio_write(tp, 0x19, 0x8300); + mdio_write(tp, 0x18, 0x2c14); + mdio_write(tp, 0x19, 0xe000); + mdio_write(tp, 0x18, 0x2c24); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x18, 0x2c34); + mdio_write(tp, 0x19, 0xac00); + mdio_write(tp, 0x18, 0x2c44); + mdio_write(tp, 0x19, 0x0800); + mdio_write(tp, 0x18, 0x2c54); + mdio_write(tp, 0x19, 0xfa00); + mdio_write(tp, 0x18, 0x2c64); + mdio_write(tp, 0x19, 0xe100); + mdio_write(tp, 0x18, 0x2c74); + mdio_write(tp, 0x19, 0x7f00); + mdio_write(tp, 0x18, 0x0001); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x17, 0x2100); + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x05, 0xfff6); + mdio_write(tp, 0x06, 0x0080); + mdio_write(tp, 0x05, 0x8b88); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x05, 0x8000); + mdio_write(tp, 0x06, 0xd480); + mdio_write(tp, 0x06, 0xc1e4); + mdio_write(tp, 0x06, 0x8b9a); + mdio_write(tp, 0x06, 0xe58b); + mdio_write(tp, 0x06, 0x9bee); + mdio_write(tp, 0x06, 0x8b83); + mdio_write(tp, 0x06, 0x41bf); + mdio_write(tp, 0x06, 0x8b88); + mdio_write(tp, 0x06, 0xec00); + mdio_write(tp, 0x06, 0x19a9); + mdio_write(tp, 0x06, 0x8b90); + mdio_write(tp, 0x06, 0xf9ee); + mdio_write(tp, 0x06, 0xfff6); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0xfff7); + mdio_write(tp, 0x06, 0xffe0); + mdio_write(tp, 0x06, 0xe140); + mdio_write(tp, 0x06, 0xe1e1); + mdio_write(tp, 0x06, 0x41f7); + mdio_write(tp, 0x06, 0x2ff6); + mdio_write(tp, 0x06, 0x28e4); + mdio_write(tp, 0x06, 0xe140); + mdio_write(tp, 0x06, 0xe5e1); + mdio_write(tp, 0x06, 0x41f7); + mdio_write(tp, 0x06, 0x0002); + mdio_write(tp, 0x06, 0x020c); + mdio_write(tp, 0x06, 0x0202); + mdio_write(tp, 0x06, 0x1d02); + mdio_write(tp, 0x06, 0x0230); + mdio_write(tp, 0x06, 0x0202); + mdio_write(tp, 0x06, 0x4002); + mdio_write(tp, 0x06, 0x028b); + mdio_write(tp, 0x06, 0x0280); + mdio_write(tp, 0x06, 0x6c02); + mdio_write(tp, 0x06, 0x8085); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x88e1); + mdio_write(tp, 0x06, 0x8b89); + mdio_write(tp, 0x06, 0x1e01); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x8a1e); + mdio_write(tp, 0x06, 0x01e1); + mdio_write(tp, 0x06, 0x8b8b); + mdio_write(tp, 0x06, 0x1e01); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x8c1e); + mdio_write(tp, 0x06, 0x01e1); + mdio_write(tp, 0x06, 0x8b8d); + mdio_write(tp, 0x06, 0x1e01); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x8e1e); + mdio_write(tp, 0x06, 0x01a0); + mdio_write(tp, 0x06, 0x00c7); + mdio_write(tp, 0x06, 0xaec3); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0x8b8d); + mdio_write(tp, 0x06, 0xad20); + mdio_write(tp, 0x06, 0x10ee); + mdio_write(tp, 0x06, 0x8b8d); + mdio_write(tp, 0x06, 0x0002); + mdio_write(tp, 0x06, 0x1310); + mdio_write(tp, 0x06, 0x021f); + mdio_write(tp, 0x06, 0x9d02); + mdio_write(tp, 0x06, 0x1f0c); + mdio_write(tp, 0x06, 0x0227); + mdio_write(tp, 0x06, 0x49fc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x8ead); + mdio_write(tp, 0x06, 0x200b); + mdio_write(tp, 0x06, 0xf620); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x8e02); + mdio_write(tp, 0x06, 0x830e); + mdio_write(tp, 0x06, 0x021b); + mdio_write(tp, 0x06, 0x67ad); + mdio_write(tp, 0x06, 0x2211); + mdio_write(tp, 0x06, 0xf622); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x8e02); + mdio_write(tp, 0x06, 0x2ba5); + mdio_write(tp, 0x06, 0x022a); + mdio_write(tp, 0x06, 0x2402); + mdio_write(tp, 0x06, 0x80c6); + mdio_write(tp, 0x06, 0x022a); + mdio_write(tp, 0x06, 0xf0ad); + mdio_write(tp, 0x06, 0x2511); + mdio_write(tp, 0x06, 0xf625); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x8e02); + mdio_write(tp, 0x06, 0x8226); + mdio_write(tp, 0x06, 0x0204); + mdio_write(tp, 0x06, 0x0302); + mdio_write(tp, 0x06, 0x19cc); + mdio_write(tp, 0x06, 0x022b); + mdio_write(tp, 0x06, 0x5bfc); + mdio_write(tp, 0x06, 0x04ee); + mdio_write(tp, 0x06, 0x8b8d); + mdio_write(tp, 0x06, 0x0105); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0x8b83); + mdio_write(tp, 0x06, 0xad24); + mdio_write(tp, 0x06, 0x44e0); + mdio_write(tp, 0x06, 0xe022); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0x23ad); + mdio_write(tp, 0x06, 0x223b); + mdio_write(tp, 0x06, 0xe08a); + mdio_write(tp, 0x06, 0xbea0); + mdio_write(tp, 0x06, 0x0005); + mdio_write(tp, 0x06, 0x0228); + mdio_write(tp, 0x06, 0xdeae); + mdio_write(tp, 0x06, 0x42a0); + mdio_write(tp, 0x06, 0x0105); + mdio_write(tp, 0x06, 0x0228); + mdio_write(tp, 0x06, 0xf1ae); + mdio_write(tp, 0x06, 0x3aa0); + mdio_write(tp, 0x06, 0x0205); + mdio_write(tp, 0x06, 0x0281); + mdio_write(tp, 0x06, 0x25ae); + mdio_write(tp, 0x06, 0x32a0); + mdio_write(tp, 0x06, 0x0305); + mdio_write(tp, 0x06, 0x0229); + mdio_write(tp, 0x06, 0x9aae); + mdio_write(tp, 0x06, 0x2aa0); + mdio_write(tp, 0x06, 0x0405); + mdio_write(tp, 0x06, 0x0229); + mdio_write(tp, 0x06, 0xaeae); + mdio_write(tp, 0x06, 0x22a0); + mdio_write(tp, 0x06, 0x0505); + mdio_write(tp, 0x06, 0x0229); + mdio_write(tp, 0x06, 0xd7ae); + mdio_write(tp, 0x06, 0x1aa0); + mdio_write(tp, 0x06, 0x0605); + mdio_write(tp, 0x06, 0x0229); + mdio_write(tp, 0x06, 0xfeae); + mdio_write(tp, 0x06, 0x12ee); + mdio_write(tp, 0x06, 0x8ac0); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0x8ac1); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0x8ac6); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0x8abe); + mdio_write(tp, 0x06, 0x00ae); + mdio_write(tp, 0x06, 0x00fc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0x022a); + mdio_write(tp, 0x06, 0x67e0); + mdio_write(tp, 0x06, 0xe022); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0x230d); + mdio_write(tp, 0x06, 0x0658); + mdio_write(tp, 0x06, 0x03a0); + mdio_write(tp, 0x06, 0x0202); + mdio_write(tp, 0x06, 0xae2d); + mdio_write(tp, 0x06, 0xa001); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0x2da0); + mdio_write(tp, 0x06, 0x004d); + mdio_write(tp, 0x06, 0xe0e2); + mdio_write(tp, 0x06, 0x00e1); + mdio_write(tp, 0x06, 0xe201); + mdio_write(tp, 0x06, 0xad24); + mdio_write(tp, 0x06, 0x44e0); + mdio_write(tp, 0x06, 0x8ac2); + mdio_write(tp, 0x06, 0xe48a); + mdio_write(tp, 0x06, 0xc4e0); + mdio_write(tp, 0x06, 0x8ac3); + mdio_write(tp, 0x06, 0xe48a); + mdio_write(tp, 0x06, 0xc5ee); + mdio_write(tp, 0x06, 0x8abe); + mdio_write(tp, 0x06, 0x03e0); + mdio_write(tp, 0x06, 0x8b83); + mdio_write(tp, 0x06, 0xad25); + mdio_write(tp, 0x06, 0x3aee); + mdio_write(tp, 0x06, 0x8abe); + mdio_write(tp, 0x06, 0x05ae); + mdio_write(tp, 0x06, 0x34e0); + mdio_write(tp, 0x06, 0x8ace); + mdio_write(tp, 0x06, 0xae03); + mdio_write(tp, 0x06, 0xe08a); + mdio_write(tp, 0x06, 0xcfe1); + mdio_write(tp, 0x06, 0x8ac2); + mdio_write(tp, 0x06, 0x4905); + mdio_write(tp, 0x06, 0xe58a); + mdio_write(tp, 0x06, 0xc4e1); + mdio_write(tp, 0x06, 0x8ac3); + mdio_write(tp, 0x06, 0x4905); + mdio_write(tp, 0x06, 0xe58a); + mdio_write(tp, 0x06, 0xc5ee); + mdio_write(tp, 0x06, 0x8abe); + mdio_write(tp, 0x06, 0x0502); + mdio_write(tp, 0x06, 0x2ab6); + mdio_write(tp, 0x06, 0xac20); + mdio_write(tp, 0x06, 0x1202); + mdio_write(tp, 0x06, 0x819b); + mdio_write(tp, 0x06, 0xac20); + mdio_write(tp, 0x06, 0x0cee); + mdio_write(tp, 0x06, 0x8ac1); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0x8ac6); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0x8abe); + mdio_write(tp, 0x06, 0x02fc); + mdio_write(tp, 0x06, 0x04d0); + mdio_write(tp, 0x06, 0x0002); + mdio_write(tp, 0x06, 0x81ad); + mdio_write(tp, 0x06, 0x590f); + mdio_write(tp, 0x06, 0x3902); + mdio_write(tp, 0x06, 0xaa04); + mdio_write(tp, 0x06, 0xd001); + mdio_write(tp, 0x06, 0xae02); + mdio_write(tp, 0x06, 0xd000); + mdio_write(tp, 0x06, 0x04f9); + mdio_write(tp, 0x06, 0xfae2); + mdio_write(tp, 0x06, 0xe2d2); + mdio_write(tp, 0x06, 0xe3e2); + mdio_write(tp, 0x06, 0xd3f9); + mdio_write(tp, 0x06, 0x5af7); + mdio_write(tp, 0x06, 0xe6e2); + mdio_write(tp, 0x06, 0xd2e7); + mdio_write(tp, 0x06, 0xe2d3); + mdio_write(tp, 0x06, 0xe2e0); + mdio_write(tp, 0x06, 0x2ce3); + mdio_write(tp, 0x06, 0xe02d); + mdio_write(tp, 0x06, 0xf95b); + mdio_write(tp, 0x06, 0xe01e); + mdio_write(tp, 0x06, 0x30e6); + mdio_write(tp, 0x06, 0xe02c); + mdio_write(tp, 0x06, 0xe7e0); + mdio_write(tp, 0x06, 0x2de2); + mdio_write(tp, 0x06, 0xe2cc); + mdio_write(tp, 0x06, 0xe3e2); + mdio_write(tp, 0x06, 0xcdf9); + mdio_write(tp, 0x06, 0x5a0f); + mdio_write(tp, 0x06, 0x6a50); + mdio_write(tp, 0x06, 0xe6e2); + mdio_write(tp, 0x06, 0xcce7); + mdio_write(tp, 0x06, 0xe2cd); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x3ce1); + mdio_write(tp, 0x06, 0xe03d); + mdio_write(tp, 0x06, 0xef64); + mdio_write(tp, 0x06, 0xfde0); + mdio_write(tp, 0x06, 0xe2cc); + mdio_write(tp, 0x06, 0xe1e2); + mdio_write(tp, 0x06, 0xcd58); + mdio_write(tp, 0x06, 0x0f5a); + mdio_write(tp, 0x06, 0xf01e); + mdio_write(tp, 0x06, 0x02e4); + mdio_write(tp, 0x06, 0xe2cc); + mdio_write(tp, 0x06, 0xe5e2); + mdio_write(tp, 0x06, 0xcdfd); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x2ce1); + mdio_write(tp, 0x06, 0xe02d); + mdio_write(tp, 0x06, 0x59e0); + mdio_write(tp, 0x06, 0x5b1f); + mdio_write(tp, 0x06, 0x1e13); + mdio_write(tp, 0x06, 0xe4e0); + mdio_write(tp, 0x06, 0x2ce5); + mdio_write(tp, 0x06, 0xe02d); + mdio_write(tp, 0x06, 0xfde0); + mdio_write(tp, 0x06, 0xe2d2); + mdio_write(tp, 0x06, 0xe1e2); + mdio_write(tp, 0x06, 0xd358); + mdio_write(tp, 0x06, 0xf75a); + mdio_write(tp, 0x06, 0x081e); + mdio_write(tp, 0x06, 0x02e4); + mdio_write(tp, 0x06, 0xe2d2); + mdio_write(tp, 0x06, 0xe5e2); + mdio_write(tp, 0x06, 0xd3ef); + mdio_write(tp, 0x06, 0x46fe); + mdio_write(tp, 0x06, 0xfd04); + mdio_write(tp, 0x06, 0xf8f9); + mdio_write(tp, 0x06, 0xfaef); + mdio_write(tp, 0x06, 0x69e0); + mdio_write(tp, 0x06, 0xe022); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0x2358); + mdio_write(tp, 0x06, 0xc4e1); + mdio_write(tp, 0x06, 0x8b6e); + mdio_write(tp, 0x06, 0x1f10); + mdio_write(tp, 0x06, 0x9e58); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x6ead); + mdio_write(tp, 0x06, 0x2222); + mdio_write(tp, 0x06, 0xac27); + mdio_write(tp, 0x06, 0x55ac); + mdio_write(tp, 0x06, 0x2602); + mdio_write(tp, 0x06, 0xae1a); + mdio_write(tp, 0x06, 0xd106); + mdio_write(tp, 0x06, 0xbf3b); + mdio_write(tp, 0x06, 0xba02); + mdio_write(tp, 0x06, 0x2dc1); + mdio_write(tp, 0x06, 0xd107); + mdio_write(tp, 0x06, 0xbf3b); + mdio_write(tp, 0x06, 0xbd02); + mdio_write(tp, 0x06, 0x2dc1); + mdio_write(tp, 0x06, 0xd107); + mdio_write(tp, 0x06, 0xbf3b); + mdio_write(tp, 0x06, 0xc002); + mdio_write(tp, 0x06, 0x2dc1); + mdio_write(tp, 0x06, 0xae30); + mdio_write(tp, 0x06, 0xd103); + mdio_write(tp, 0x06, 0xbf3b); + mdio_write(tp, 0x06, 0xc302); + mdio_write(tp, 0x06, 0x2dc1); + mdio_write(tp, 0x06, 0xd100); + mdio_write(tp, 0x06, 0xbf3b); + mdio_write(tp, 0x06, 0xc602); + mdio_write(tp, 0x06, 0x2dc1); + mdio_write(tp, 0x06, 0xd100); + mdio_write(tp, 0x06, 0xbf82); + mdio_write(tp, 0x06, 0xca02); + mdio_write(tp, 0x06, 0x2dc1); + mdio_write(tp, 0x06, 0xd10f); + mdio_write(tp, 0x06, 0xbf3b); + mdio_write(tp, 0x06, 0xba02); + mdio_write(tp, 0x06, 0x2dc1); + mdio_write(tp, 0x06, 0xd101); + mdio_write(tp, 0x06, 0xbf3b); + mdio_write(tp, 0x06, 0xbd02); + mdio_write(tp, 0x06, 0x2dc1); + mdio_write(tp, 0x06, 0xd101); + mdio_write(tp, 0x06, 0xbf3b); + mdio_write(tp, 0x06, 0xc002); + mdio_write(tp, 0x06, 0x2dc1); + mdio_write(tp, 0x06, 0xef96); + mdio_write(tp, 0x06, 0xfefd); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xd100); + mdio_write(tp, 0x06, 0xbf3b); + mdio_write(tp, 0x06, 0xc302); + mdio_write(tp, 0x06, 0x2dc1); + mdio_write(tp, 0x06, 0xd011); + mdio_write(tp, 0x06, 0x022b); + mdio_write(tp, 0x06, 0xfb59); + mdio_write(tp, 0x06, 0x03ef); + mdio_write(tp, 0x06, 0x01d1); + mdio_write(tp, 0x06, 0x00a0); + mdio_write(tp, 0x06, 0x0002); + mdio_write(tp, 0x06, 0xd101); + mdio_write(tp, 0x06, 0xbf3b); + mdio_write(tp, 0x06, 0xc602); + mdio_write(tp, 0x06, 0x2dc1); + mdio_write(tp, 0x06, 0xd111); + mdio_write(tp, 0x06, 0xad20); + mdio_write(tp, 0x06, 0x020c); + mdio_write(tp, 0x06, 0x11ad); + mdio_write(tp, 0x06, 0x2102); + mdio_write(tp, 0x06, 0x0c12); + mdio_write(tp, 0x06, 0xbf82); + mdio_write(tp, 0x06, 0xca02); + mdio_write(tp, 0x06, 0x2dc1); + mdio_write(tp, 0x06, 0xaec8); + mdio_write(tp, 0x06, 0x70e4); + mdio_write(tp, 0x06, 0x2602); + mdio_write(tp, 0x06, 0x82d1); + mdio_write(tp, 0x06, 0x05f8); + mdio_write(tp, 0x06, 0xfaef); + mdio_write(tp, 0x06, 0x69e0); + mdio_write(tp, 0x06, 0xe2fe); + mdio_write(tp, 0x06, 0xe1e2); + mdio_write(tp, 0x06, 0xffad); + mdio_write(tp, 0x06, 0x2d1a); + mdio_write(tp, 0x06, 0xe0e1); + mdio_write(tp, 0x06, 0x4ee1); + mdio_write(tp, 0x06, 0xe14f); + mdio_write(tp, 0x06, 0xac2d); + mdio_write(tp, 0x06, 0x22f6); + mdio_write(tp, 0x06, 0x0302); + mdio_write(tp, 0x06, 0x033b); + mdio_write(tp, 0x06, 0xf703); + mdio_write(tp, 0x06, 0xf706); + mdio_write(tp, 0x06, 0xbf84); + mdio_write(tp, 0x06, 0x4402); + mdio_write(tp, 0x06, 0x2d21); + mdio_write(tp, 0x06, 0xae11); + mdio_write(tp, 0x06, 0xe0e1); + mdio_write(tp, 0x06, 0x4ee1); + mdio_write(tp, 0x06, 0xe14f); + mdio_write(tp, 0x06, 0xad2d); + mdio_write(tp, 0x06, 0x08bf); + mdio_write(tp, 0x06, 0x844f); + mdio_write(tp, 0x06, 0x022d); + mdio_write(tp, 0x06, 0x21f6); + mdio_write(tp, 0x06, 0x06ef); + mdio_write(tp, 0x06, 0x96fe); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8fa); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0x0283); + mdio_write(tp, 0x06, 0x4502); + mdio_write(tp, 0x06, 0x83a2); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x00e1); + mdio_write(tp, 0x06, 0xe001); + mdio_write(tp, 0x06, 0xad27); + mdio_write(tp, 0x06, 0x1fd1); + mdio_write(tp, 0x06, 0x01bf); + mdio_write(tp, 0x06, 0x843b); + mdio_write(tp, 0x06, 0x022d); + mdio_write(tp, 0x06, 0xc1e0); + mdio_write(tp, 0x06, 0xe020); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0x21ad); + mdio_write(tp, 0x06, 0x200e); + mdio_write(tp, 0x06, 0xd100); + mdio_write(tp, 0x06, 0xbf84); + mdio_write(tp, 0x06, 0x3b02); + mdio_write(tp, 0x06, 0x2dc1); + mdio_write(tp, 0x06, 0xbf3b); + mdio_write(tp, 0x06, 0x9602); + mdio_write(tp, 0x06, 0x2d21); + mdio_write(tp, 0x06, 0xef96); + mdio_write(tp, 0x06, 0xfefc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xf9fa); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x87ad); + mdio_write(tp, 0x06, 0x204c); + mdio_write(tp, 0x06, 0xd200); + mdio_write(tp, 0x06, 0xe0e2); + mdio_write(tp, 0x06, 0x0058); + mdio_write(tp, 0x06, 0x010c); + mdio_write(tp, 0x06, 0x021e); + mdio_write(tp, 0x06, 0x20e0); + mdio_write(tp, 0x06, 0xe000); + mdio_write(tp, 0x06, 0x5810); + mdio_write(tp, 0x06, 0x1e20); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x3658); + mdio_write(tp, 0x06, 0x031e); + mdio_write(tp, 0x06, 0x20e0); + mdio_write(tp, 0x06, 0xe022); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0x2358); + mdio_write(tp, 0x06, 0xe01e); + mdio_write(tp, 0x06, 0x20e0); + mdio_write(tp, 0x06, 0x8b64); + mdio_write(tp, 0x06, 0x1f02); + mdio_write(tp, 0x06, 0x9e22); + mdio_write(tp, 0x06, 0xe68b); + mdio_write(tp, 0x06, 0x64ad); + mdio_write(tp, 0x06, 0x3214); + mdio_write(tp, 0x06, 0xad34); + mdio_write(tp, 0x06, 0x11ef); + mdio_write(tp, 0x06, 0x0258); + mdio_write(tp, 0x06, 0x039e); + mdio_write(tp, 0x06, 0x07ad); + mdio_write(tp, 0x06, 0x3508); + mdio_write(tp, 0x06, 0x5ac0); + mdio_write(tp, 0x06, 0x9f04); + mdio_write(tp, 0x06, 0xd101); + mdio_write(tp, 0x06, 0xae02); + mdio_write(tp, 0x06, 0xd100); + mdio_write(tp, 0x06, 0xbf84); + mdio_write(tp, 0x06, 0x3e02); + mdio_write(tp, 0x06, 0x2dc1); + mdio_write(tp, 0x06, 0xef96); + mdio_write(tp, 0x06, 0xfefd); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8f9); + mdio_write(tp, 0x06, 0xfbe0); + mdio_write(tp, 0x06, 0x8b85); + mdio_write(tp, 0x06, 0xad25); + mdio_write(tp, 0x06, 0x22e0); + mdio_write(tp, 0x06, 0xe022); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0x23e2); + mdio_write(tp, 0x06, 0xe036); + mdio_write(tp, 0x06, 0xe3e0); + mdio_write(tp, 0x06, 0x375a); + mdio_write(tp, 0x06, 0xc40d); + mdio_write(tp, 0x06, 0x0158); + mdio_write(tp, 0x06, 0x021e); + mdio_write(tp, 0x06, 0x20e3); + mdio_write(tp, 0x06, 0x8ae7); + mdio_write(tp, 0x06, 0xac31); + mdio_write(tp, 0x06, 0x60ac); + mdio_write(tp, 0x06, 0x3a08); + mdio_write(tp, 0x06, 0xac3e); + mdio_write(tp, 0x06, 0x26ae); + mdio_write(tp, 0x06, 0x67af); + mdio_write(tp, 0x06, 0x8437); + mdio_write(tp, 0x06, 0xad37); + mdio_write(tp, 0x06, 0x61e0); + mdio_write(tp, 0x06, 0x8ae8); + mdio_write(tp, 0x06, 0x10e4); + mdio_write(tp, 0x06, 0x8ae8); + mdio_write(tp, 0x06, 0xe18a); + mdio_write(tp, 0x06, 0xe91b); + mdio_write(tp, 0x06, 0x109e); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0x51d1); + mdio_write(tp, 0x06, 0x00bf); + mdio_write(tp, 0x06, 0x8441); + mdio_write(tp, 0x06, 0x022d); + mdio_write(tp, 0x06, 0xc1ee); + mdio_write(tp, 0x06, 0x8ae8); + mdio_write(tp, 0x06, 0x00ae); + mdio_write(tp, 0x06, 0x43ad); + mdio_write(tp, 0x06, 0x3627); + mdio_write(tp, 0x06, 0xe08a); + mdio_write(tp, 0x06, 0xeee1); + mdio_write(tp, 0x06, 0x8aef); + mdio_write(tp, 0x06, 0xef74); + mdio_write(tp, 0x06, 0xe08a); + mdio_write(tp, 0x06, 0xeae1); + mdio_write(tp, 0x06, 0x8aeb); + mdio_write(tp, 0x06, 0x1b74); + mdio_write(tp, 0x06, 0x9e2e); + mdio_write(tp, 0x06, 0x14e4); + mdio_write(tp, 0x06, 0x8aea); + mdio_write(tp, 0x06, 0xe58a); + mdio_write(tp, 0x06, 0xebef); + mdio_write(tp, 0x06, 0x74e0); + mdio_write(tp, 0x06, 0x8aee); + mdio_write(tp, 0x06, 0xe18a); + mdio_write(tp, 0x06, 0xef1b); + mdio_write(tp, 0x06, 0x479e); + mdio_write(tp, 0x06, 0x0fae); + mdio_write(tp, 0x06, 0x19ee); + mdio_write(tp, 0x06, 0x8aea); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0x8aeb); + mdio_write(tp, 0x06, 0x00ae); + mdio_write(tp, 0x06, 0x0fac); + mdio_write(tp, 0x06, 0x390c); + mdio_write(tp, 0x06, 0xd101); + mdio_write(tp, 0x06, 0xbf84); + mdio_write(tp, 0x06, 0x4102); + mdio_write(tp, 0x06, 0x2dc1); + mdio_write(tp, 0x06, 0xee8a); + mdio_write(tp, 0x06, 0xe800); + mdio_write(tp, 0x06, 0xe68a); + mdio_write(tp, 0x06, 0xe7ff); + mdio_write(tp, 0x06, 0xfdfc); + mdio_write(tp, 0x06, 0x0400); + mdio_write(tp, 0x06, 0xe234); + mdio_write(tp, 0x06, 0xcce2); + mdio_write(tp, 0x06, 0x0088); + mdio_write(tp, 0x06, 0xe200); + mdio_write(tp, 0x06, 0xa725); + mdio_write(tp, 0x06, 0xe50a); + mdio_write(tp, 0x06, 0x1de5); + mdio_write(tp, 0x06, 0x0a2c); + mdio_write(tp, 0x06, 0xe50a); + mdio_write(tp, 0x06, 0x6de5); + mdio_write(tp, 0x06, 0x0a1d); + mdio_write(tp, 0x06, 0xe50a); + mdio_write(tp, 0x06, 0x1ce5); + mdio_write(tp, 0x06, 0x0a2d); + mdio_write(tp, 0x06, 0xa755); + mdio_write(tp, 0x05, 0x8b64); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x05, 0x8b94); + mdio_write(tp, 0x06, 0x82cd); + mdio_write(tp, 0x05, 0x8b85); + mdio_write(tp, 0x06, 0x2000); + mdio_write(tp, 0x05, 0x8aee); + mdio_write(tp, 0x06, 0x03b8); + mdio_write(tp, 0x05, 0x8ae8); + mdio_write(tp, 0x06, 0x0002); + gphy_val = mdio_read(tp, 0x01); + gphy_val |= BIT_0; + mdio_write(tp, 0x01, gphy_val); + gphy_val = mdio_read(tp, 0x00); + gphy_val |= BIT_0; + mdio_write(tp, 0x00, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x1f, 0x0005); + for (i = 0; i < 200; i++) { + udelay(100); + gphy_val = mdio_read(tp, 0x00); + if (gphy_val & BIT_7) + break; + } + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0023); + gphy_val = mdio_read(tp, 0x17); + gphy_val &= ~(BIT_0); + if (tp->RequiredSecLanDonglePatch) + gphy_val &= ~(BIT_2); + mdio_write(tp, 0x17, gphy_val); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0028); + mdio_write(tp, 0x15, 0x0010); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0041); + mdio_write(tp, 0x15, 0x0802); + mdio_write(tp, 0x16, 0x2185); + mdio_write(tp, 0x1f, 0x0000); +} + +static void +rtl8168_set_phy_mcu_8168e_2(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + unsigned int gphy_val,i; + + if (rtl8168_efuse_read(tp, 0x22) == 0x0c) { + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x00, 0x1800); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0023); + mdio_write(tp, 0x17, 0x0117); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1E, 0x002C); + mdio_write(tp, 0x1B, 0x5000); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x16, 0x4104); + for (i = 0; i < 200; i++) { + udelay(100); + gphy_val = mdio_read(tp, 0x1E); + gphy_val &= 0x03FF; + if (gphy_val==0x000C) + break; + } + mdio_write(tp, 0x1f, 0x0005); + for (i = 0; i < 200; i++) { + udelay(100); + gphy_val = mdio_read(tp, 0x07); + if ((gphy_val & BIT_5) == 0) + break; + } + gphy_val = mdio_read(tp, 0x07); + if (gphy_val & BIT_5) { + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x00a1); + mdio_write(tp, 0x17, 0x1000); + mdio_write(tp, 0x17, 0x0000); + mdio_write(tp, 0x17, 0x2000); + mdio_write(tp, 0x1e, 0x002f); + mdio_write(tp, 0x18, 0x9bfb); + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x07, 0x0000); + mdio_write(tp, 0x1f, 0x0000); + } + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x05, 0xfff6); + mdio_write(tp, 0x06, 0x0080); + gphy_val = mdio_read(tp, 0x00); + gphy_val &= ~(BIT_7); + mdio_write(tp, 0x00, gphy_val); + mdio_write(tp, 0x1f, 0x0002); + gphy_val = mdio_read(tp, 0x08); + gphy_val &= ~(BIT_7); + mdio_write(tp, 0x08, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0023); + mdio_write(tp, 0x16, 0x0306); + mdio_write(tp, 0x16, 0x0307); + mdio_write(tp, 0x15, 0x000e); + mdio_write(tp, 0x19, 0x000a); + mdio_write(tp, 0x15, 0x0010); + mdio_write(tp, 0x19, 0x0008); + mdio_write(tp, 0x15, 0x0018); + mdio_write(tp, 0x19, 0x4801); + mdio_write(tp, 0x15, 0x0019); + mdio_write(tp, 0x19, 0x6801); + mdio_write(tp, 0x15, 0x001a); + mdio_write(tp, 0x19, 0x66a1); + mdio_write(tp, 0x15, 0x001f); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0020); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0021); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0022); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0023); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0024); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0025); + mdio_write(tp, 0x19, 0x64a1); + mdio_write(tp, 0x15, 0x0026); + mdio_write(tp, 0x19, 0x40ea); + mdio_write(tp, 0x15, 0x0027); + mdio_write(tp, 0x19, 0x4503); + mdio_write(tp, 0x15, 0x0028); + mdio_write(tp, 0x19, 0x9f00); + mdio_write(tp, 0x15, 0x0029); + mdio_write(tp, 0x19, 0xa631); + mdio_write(tp, 0x15, 0x002a); + mdio_write(tp, 0x19, 0x9717); + mdio_write(tp, 0x15, 0x002b); + mdio_write(tp, 0x19, 0x302c); + mdio_write(tp, 0x15, 0x002c); + mdio_write(tp, 0x19, 0x4802); + mdio_write(tp, 0x15, 0x002d); + mdio_write(tp, 0x19, 0x58da); + mdio_write(tp, 0x15, 0x002e); + mdio_write(tp, 0x19, 0x400d); + mdio_write(tp, 0x15, 0x002f); + mdio_write(tp, 0x19, 0x4488); + mdio_write(tp, 0x15, 0x0030); + mdio_write(tp, 0x19, 0x9e00); + mdio_write(tp, 0x15, 0x0031); + mdio_write(tp, 0x19, 0x63c8); + mdio_write(tp, 0x15, 0x0032); + mdio_write(tp, 0x19, 0x6481); + mdio_write(tp, 0x15, 0x0033); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0034); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0035); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0036); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0037); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0038); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0039); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x003a); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x003b); + mdio_write(tp, 0x19, 0x63e8); + mdio_write(tp, 0x15, 0x003c); + mdio_write(tp, 0x19, 0x7d00); + mdio_write(tp, 0x15, 0x003d); + mdio_write(tp, 0x19, 0x59d4); + mdio_write(tp, 0x15, 0x003e); + mdio_write(tp, 0x19, 0x63f8); + mdio_write(tp, 0x15, 0x0040); + mdio_write(tp, 0x19, 0x64a1); + mdio_write(tp, 0x15, 0x0041); + mdio_write(tp, 0x19, 0x30de); + mdio_write(tp, 0x15, 0x0044); + mdio_write(tp, 0x19, 0x480f); + mdio_write(tp, 0x15, 0x0045); + mdio_write(tp, 0x19, 0x6800); + mdio_write(tp, 0x15, 0x0046); + mdio_write(tp, 0x19, 0x6680); + mdio_write(tp, 0x15, 0x0047); + mdio_write(tp, 0x19, 0x7c10); + mdio_write(tp, 0x15, 0x0048); + mdio_write(tp, 0x19, 0x63c8); + mdio_write(tp, 0x15, 0x0049); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x004a); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x004b); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x004c); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x004d); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x004e); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x004f); + mdio_write(tp, 0x19, 0x40ea); + mdio_write(tp, 0x15, 0x0050); + mdio_write(tp, 0x19, 0x4503); + mdio_write(tp, 0x15, 0x0051); + mdio_write(tp, 0x19, 0x58ca); + mdio_write(tp, 0x15, 0x0052); + mdio_write(tp, 0x19, 0x63c8); + mdio_write(tp, 0x15, 0x0053); + mdio_write(tp, 0x19, 0x63d8); + mdio_write(tp, 0x15, 0x0054); + mdio_write(tp, 0x19, 0x66a0); + mdio_write(tp, 0x15, 0x0055); + mdio_write(tp, 0x19, 0x9f00); + mdio_write(tp, 0x15, 0x0056); + mdio_write(tp, 0x19, 0x3000); + mdio_write(tp, 0x15, 0x00a1); + mdio_write(tp, 0x19, 0x3044); + mdio_write(tp, 0x15, 0x00ab); + mdio_write(tp, 0x19, 0x5820); + mdio_write(tp, 0x15, 0x00ac); + mdio_write(tp, 0x19, 0x5e04); + mdio_write(tp, 0x15, 0x00ad); + mdio_write(tp, 0x19, 0xb60c); + mdio_write(tp, 0x15, 0x00af); + mdio_write(tp, 0x19, 0x000a); + mdio_write(tp, 0x15, 0x00b2); + mdio_write(tp, 0x19, 0x30b9); + mdio_write(tp, 0x15, 0x00b9); + mdio_write(tp, 0x19, 0x4408); + mdio_write(tp, 0x15, 0x00ba); + mdio_write(tp, 0x19, 0x480b); + mdio_write(tp, 0x15, 0x00bb); + mdio_write(tp, 0x19, 0x5e00); + mdio_write(tp, 0x15, 0x00bc); + mdio_write(tp, 0x19, 0x405f); + mdio_write(tp, 0x15, 0x00bd); + mdio_write(tp, 0x19, 0x4448); + mdio_write(tp, 0x15, 0x00be); + mdio_write(tp, 0x19, 0x4020); + mdio_write(tp, 0x15, 0x00bf); + mdio_write(tp, 0x19, 0x4468); + mdio_write(tp, 0x15, 0x00c0); + mdio_write(tp, 0x19, 0x9c02); + mdio_write(tp, 0x15, 0x00c1); + mdio_write(tp, 0x19, 0x58a0); + mdio_write(tp, 0x15, 0x00c2); + mdio_write(tp, 0x19, 0xb605); + mdio_write(tp, 0x15, 0x00c3); + mdio_write(tp, 0x19, 0xc0d3); + mdio_write(tp, 0x15, 0x00c4); + mdio_write(tp, 0x19, 0x00e6); + mdio_write(tp, 0x15, 0x00c5); + mdio_write(tp, 0x19, 0xdaec); + mdio_write(tp, 0x15, 0x00c6); + mdio_write(tp, 0x19, 0x00fa); + mdio_write(tp, 0x15, 0x00c7); + mdio_write(tp, 0x19, 0x9df9); + mdio_write(tp, 0x15, 0x0112); + mdio_write(tp, 0x19, 0x6421); + mdio_write(tp, 0x15, 0x0113); + mdio_write(tp, 0x19, 0x7c08); + mdio_write(tp, 0x15, 0x0114); + mdio_write(tp, 0x19, 0x63f0); + mdio_write(tp, 0x15, 0x0115); + mdio_write(tp, 0x19, 0x4003); + mdio_write(tp, 0x15, 0x0116); + mdio_write(tp, 0x19, 0x4418); + mdio_write(tp, 0x15, 0x0117); + mdio_write(tp, 0x19, 0x9b00); + mdio_write(tp, 0x15, 0x0118); + mdio_write(tp, 0x19, 0x6461); + mdio_write(tp, 0x15, 0x0119); + mdio_write(tp, 0x19, 0x64e1); + mdio_write(tp, 0x15, 0x011a); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0150); + mdio_write(tp, 0x19, 0x7c80); + mdio_write(tp, 0x15, 0x0151); + mdio_write(tp, 0x19, 0x6461); + mdio_write(tp, 0x15, 0x0152); + mdio_write(tp, 0x19, 0x4003); + mdio_write(tp, 0x15, 0x0153); + mdio_write(tp, 0x19, 0x4540); + mdio_write(tp, 0x15, 0x0154); + mdio_write(tp, 0x19, 0x9f00); + mdio_write(tp, 0x15, 0x0155); + mdio_write(tp, 0x19, 0x9d00); + mdio_write(tp, 0x15, 0x0156); + mdio_write(tp, 0x19, 0x7c40); + mdio_write(tp, 0x15, 0x0157); + mdio_write(tp, 0x19, 0x6421); + mdio_write(tp, 0x15, 0x0158); + mdio_write(tp, 0x19, 0x7c80); + mdio_write(tp, 0x15, 0x0159); + mdio_write(tp, 0x19, 0x64a1); + mdio_write(tp, 0x15, 0x015a); + mdio_write(tp, 0x19, 0x30fe); + mdio_write(tp, 0x15, 0x029c); + mdio_write(tp, 0x19, 0x0070); + mdio_write(tp, 0x15, 0x02b2); + mdio_write(tp, 0x19, 0x005a); + mdio_write(tp, 0x15, 0x02bd); + mdio_write(tp, 0x19, 0xa522); + mdio_write(tp, 0x15, 0x02ce); + mdio_write(tp, 0x19, 0xb63e); + mdio_write(tp, 0x15, 0x02d9); + mdio_write(tp, 0x19, 0x32df); + mdio_write(tp, 0x15, 0x02df); + mdio_write(tp, 0x19, 0x4500); + mdio_write(tp, 0x15, 0x02e7); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x02f4); + mdio_write(tp, 0x19, 0xb618); + mdio_write(tp, 0x15, 0x02fb); + mdio_write(tp, 0x19, 0xb900); + mdio_write(tp, 0x15, 0x02fc); + mdio_write(tp, 0x19, 0x49b5); + mdio_write(tp, 0x15, 0x02fd); + mdio_write(tp, 0x19, 0x6812); + mdio_write(tp, 0x15, 0x02fe); + mdio_write(tp, 0x19, 0x66a0); + mdio_write(tp, 0x15, 0x02ff); + mdio_write(tp, 0x19, 0x9900); + mdio_write(tp, 0x15, 0x0300); + mdio_write(tp, 0x19, 0x64a0); + mdio_write(tp, 0x15, 0x0301); + mdio_write(tp, 0x19, 0x3316); + mdio_write(tp, 0x15, 0x0308); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x030c); + mdio_write(tp, 0x19, 0x3000); + mdio_write(tp, 0x15, 0x0312); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0313); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0314); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0315); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0316); + mdio_write(tp, 0x19, 0x49b5); + mdio_write(tp, 0x15, 0x0317); + mdio_write(tp, 0x19, 0x7d00); + mdio_write(tp, 0x15, 0x0318); + mdio_write(tp, 0x19, 0x4d00); + mdio_write(tp, 0x15, 0x0319); + mdio_write(tp, 0x19, 0x6810); + mdio_write(tp, 0x15, 0x031a); + mdio_write(tp, 0x19, 0x6c08); + mdio_write(tp, 0x15, 0x031b); + mdio_write(tp, 0x19, 0x4925); + mdio_write(tp, 0x15, 0x031c); + mdio_write(tp, 0x19, 0x403b); + mdio_write(tp, 0x15, 0x031d); + mdio_write(tp, 0x19, 0xa602); + mdio_write(tp, 0x15, 0x031e); + mdio_write(tp, 0x19, 0x402f); + mdio_write(tp, 0x15, 0x031f); + mdio_write(tp, 0x19, 0x4484); + mdio_write(tp, 0x15, 0x0320); + mdio_write(tp, 0x19, 0x40c8); + mdio_write(tp, 0x15, 0x0321); + mdio_write(tp, 0x19, 0x44c4); + mdio_write(tp, 0x15, 0x0322); + mdio_write(tp, 0x19, 0x404f); + mdio_write(tp, 0x15, 0x0323); + mdio_write(tp, 0x19, 0x44c8); + mdio_write(tp, 0x15, 0x0324); + mdio_write(tp, 0x19, 0xd64f); + mdio_write(tp, 0x15, 0x0325); + mdio_write(tp, 0x19, 0x00e7); + mdio_write(tp, 0x15, 0x0326); + mdio_write(tp, 0x19, 0x7c08); + mdio_write(tp, 0x15, 0x0327); + mdio_write(tp, 0x19, 0x8203); + mdio_write(tp, 0x15, 0x0328); + mdio_write(tp, 0x19, 0x4d48); + mdio_write(tp, 0x15, 0x0329); + mdio_write(tp, 0x19, 0x332b); + mdio_write(tp, 0x15, 0x032a); + mdio_write(tp, 0x19, 0x4d40); + mdio_write(tp, 0x15, 0x032c); + mdio_write(tp, 0x19, 0x00f8); + mdio_write(tp, 0x15, 0x032d); + mdio_write(tp, 0x19, 0x82b2); + mdio_write(tp, 0x15, 0x032f); + mdio_write(tp, 0x19, 0x00b0); + mdio_write(tp, 0x15, 0x0332); + mdio_write(tp, 0x19, 0x91f2); + mdio_write(tp, 0x15, 0x033f); + mdio_write(tp, 0x19, 0xb6cd); + mdio_write(tp, 0x15, 0x0340); + mdio_write(tp, 0x19, 0x9e01); + mdio_write(tp, 0x15, 0x0341); + mdio_write(tp, 0x19, 0xd11d); + mdio_write(tp, 0x15, 0x0342); + mdio_write(tp, 0x19, 0x009d); + mdio_write(tp, 0x15, 0x0343); + mdio_write(tp, 0x19, 0xbb1c); + mdio_write(tp, 0x15, 0x0344); + mdio_write(tp, 0x19, 0x8102); + mdio_write(tp, 0x15, 0x0345); + mdio_write(tp, 0x19, 0x3348); + mdio_write(tp, 0x15, 0x0346); + mdio_write(tp, 0x19, 0xa231); + mdio_write(tp, 0x15, 0x0347); + mdio_write(tp, 0x19, 0x335b); + mdio_write(tp, 0x15, 0x0348); + mdio_write(tp, 0x19, 0x91f7); + mdio_write(tp, 0x15, 0x0349); + mdio_write(tp, 0x19, 0xc218); + mdio_write(tp, 0x15, 0x034a); + mdio_write(tp, 0x19, 0x00f5); + mdio_write(tp, 0x15, 0x034b); + mdio_write(tp, 0x19, 0x335b); + mdio_write(tp, 0x15, 0x034c); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x034d); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x034e); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x034f); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0350); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x035b); + mdio_write(tp, 0x19, 0xa23c); + mdio_write(tp, 0x15, 0x035c); + mdio_write(tp, 0x19, 0x7c08); + mdio_write(tp, 0x15, 0x035d); + mdio_write(tp, 0x19, 0x4c00); + mdio_write(tp, 0x15, 0x035e); + mdio_write(tp, 0x19, 0x3397); + mdio_write(tp, 0x15, 0x0363); + mdio_write(tp, 0x19, 0xb6a9); + mdio_write(tp, 0x15, 0x0366); + mdio_write(tp, 0x19, 0x00f5); + mdio_write(tp, 0x15, 0x0382); + mdio_write(tp, 0x19, 0x7c40); + mdio_write(tp, 0x15, 0x0388); + mdio_write(tp, 0x19, 0x0084); + mdio_write(tp, 0x15, 0x0389); + mdio_write(tp, 0x19, 0xdd17); + mdio_write(tp, 0x15, 0x038a); + mdio_write(tp, 0x19, 0x000b); + mdio_write(tp, 0x15, 0x038b); + mdio_write(tp, 0x19, 0xa10a); + mdio_write(tp, 0x15, 0x038c); + mdio_write(tp, 0x19, 0x337e); + mdio_write(tp, 0x15, 0x038d); + mdio_write(tp, 0x19, 0x6c0b); + mdio_write(tp, 0x15, 0x038e); + mdio_write(tp, 0x19, 0xa107); + mdio_write(tp, 0x15, 0x038f); + mdio_write(tp, 0x19, 0x6c08); + mdio_write(tp, 0x15, 0x0390); + mdio_write(tp, 0x19, 0xc017); + mdio_write(tp, 0x15, 0x0391); + mdio_write(tp, 0x19, 0x0004); + mdio_write(tp, 0x15, 0x0392); + mdio_write(tp, 0x19, 0xd64f); + mdio_write(tp, 0x15, 0x0393); + mdio_write(tp, 0x19, 0x00f4); + mdio_write(tp, 0x15, 0x0397); + mdio_write(tp, 0x19, 0x4098); + mdio_write(tp, 0x15, 0x0398); + mdio_write(tp, 0x19, 0x4408); + mdio_write(tp, 0x15, 0x0399); + mdio_write(tp, 0x19, 0x55bf); + mdio_write(tp, 0x15, 0x039a); + mdio_write(tp, 0x19, 0x4bb9); + mdio_write(tp, 0x15, 0x039b); + mdio_write(tp, 0x19, 0x6810); + mdio_write(tp, 0x15, 0x039c); + mdio_write(tp, 0x19, 0x4b29); + mdio_write(tp, 0x15, 0x039d); + mdio_write(tp, 0x19, 0x4041); + mdio_write(tp, 0x15, 0x039e); + mdio_write(tp, 0x19, 0x442a); + mdio_write(tp, 0x15, 0x039f); + mdio_write(tp, 0x19, 0x4029); + mdio_write(tp, 0x15, 0x03aa); + mdio_write(tp, 0x19, 0x33b8); + mdio_write(tp, 0x15, 0x03b6); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03b7); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03b8); + mdio_write(tp, 0x19, 0x543f); + mdio_write(tp, 0x15, 0x03b9); + mdio_write(tp, 0x19, 0x499a); + mdio_write(tp, 0x15, 0x03ba); + mdio_write(tp, 0x19, 0x7c40); + mdio_write(tp, 0x15, 0x03bb); + mdio_write(tp, 0x19, 0x4c40); + mdio_write(tp, 0x15, 0x03bc); + mdio_write(tp, 0x19, 0x490a); + mdio_write(tp, 0x15, 0x03bd); + mdio_write(tp, 0x19, 0x405e); + mdio_write(tp, 0x15, 0x03c2); + mdio_write(tp, 0x19, 0x9a03); + mdio_write(tp, 0x15, 0x03c4); + mdio_write(tp, 0x19, 0x0015); + mdio_write(tp, 0x15, 0x03c5); + mdio_write(tp, 0x19, 0x9e03); + mdio_write(tp, 0x15, 0x03c8); + mdio_write(tp, 0x19, 0x9cf7); + mdio_write(tp, 0x15, 0x03c9); + mdio_write(tp, 0x19, 0x7c12); + mdio_write(tp, 0x15, 0x03ca); + mdio_write(tp, 0x19, 0x4c52); + mdio_write(tp, 0x15, 0x03cb); + mdio_write(tp, 0x19, 0x4458); + mdio_write(tp, 0x15, 0x03cd); + mdio_write(tp, 0x19, 0x4c40); + mdio_write(tp, 0x15, 0x03ce); + mdio_write(tp, 0x19, 0x33bf); + mdio_write(tp, 0x15, 0x03cf); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03d0); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03d1); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03d5); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03d6); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03d7); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03d8); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03d9); + mdio_write(tp, 0x19, 0x49bb); + mdio_write(tp, 0x15, 0x03da); + mdio_write(tp, 0x19, 0x4478); + mdio_write(tp, 0x15, 0x03db); + mdio_write(tp, 0x19, 0x492b); + mdio_write(tp, 0x15, 0x03dc); + mdio_write(tp, 0x19, 0x7c01); + mdio_write(tp, 0x15, 0x03dd); + mdio_write(tp, 0x19, 0x4c00); + mdio_write(tp, 0x15, 0x03de); + mdio_write(tp, 0x19, 0xbd1a); + mdio_write(tp, 0x15, 0x03df); + mdio_write(tp, 0x19, 0xc428); + mdio_write(tp, 0x15, 0x03e0); + mdio_write(tp, 0x19, 0x0008); + mdio_write(tp, 0x15, 0x03e1); + mdio_write(tp, 0x19, 0x9cfd); + mdio_write(tp, 0x15, 0x03e2); + mdio_write(tp, 0x19, 0x7c12); + mdio_write(tp, 0x15, 0x03e3); + mdio_write(tp, 0x19, 0x4c52); + mdio_write(tp, 0x15, 0x03e4); + mdio_write(tp, 0x19, 0x4458); + mdio_write(tp, 0x15, 0x03e5); + mdio_write(tp, 0x19, 0x7c12); + mdio_write(tp, 0x15, 0x03e6); + mdio_write(tp, 0x19, 0x4c40); + mdio_write(tp, 0x15, 0x03e7); + mdio_write(tp, 0x19, 0x33de); + mdio_write(tp, 0x15, 0x03e8); + mdio_write(tp, 0x19, 0xc218); + mdio_write(tp, 0x15, 0x03e9); + mdio_write(tp, 0x19, 0x0002); + mdio_write(tp, 0x15, 0x03ea); + mdio_write(tp, 0x19, 0x32df); + mdio_write(tp, 0x15, 0x03eb); + mdio_write(tp, 0x19, 0x3316); + mdio_write(tp, 0x15, 0x03ec); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03ed); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03ee); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03ef); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03f7); + mdio_write(tp, 0x19, 0x330c); + mdio_write(tp, 0x16, 0x0306); + mdio_write(tp, 0x16, 0x0300); + + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x05, 0xfff6); + mdio_write(tp, 0x06, 0x0080); + mdio_write(tp, 0x05, 0x8000); + mdio_write(tp, 0x06, 0x0280); + mdio_write(tp, 0x06, 0x48f7); + mdio_write(tp, 0x06, 0x00e0); + mdio_write(tp, 0x06, 0xfff7); + mdio_write(tp, 0x06, 0xa080); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0xf602); + mdio_write(tp, 0x06, 0x0200); + mdio_write(tp, 0x06, 0x0280); + mdio_write(tp, 0x06, 0x9002); + mdio_write(tp, 0x06, 0x0224); + mdio_write(tp, 0x06, 0x0202); + mdio_write(tp, 0x06, 0x3402); + mdio_write(tp, 0x06, 0x027f); + mdio_write(tp, 0x06, 0x0280); + mdio_write(tp, 0x06, 0xa602); + mdio_write(tp, 0x06, 0x80bf); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x88e1); + mdio_write(tp, 0x06, 0x8b89); + mdio_write(tp, 0x06, 0x1e01); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x8a1e); + mdio_write(tp, 0x06, 0x01e1); + mdio_write(tp, 0x06, 0x8b8b); + mdio_write(tp, 0x06, 0x1e01); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x8c1e); + mdio_write(tp, 0x06, 0x01e1); + mdio_write(tp, 0x06, 0x8b8d); + mdio_write(tp, 0x06, 0x1e01); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x8e1e); + mdio_write(tp, 0x06, 0x01a0); + mdio_write(tp, 0x06, 0x00c7); + mdio_write(tp, 0x06, 0xaebb); + mdio_write(tp, 0x06, 0xee8a); + mdio_write(tp, 0x06, 0xe600); + mdio_write(tp, 0x06, 0xee8a); + mdio_write(tp, 0x06, 0xee03); + mdio_write(tp, 0x06, 0xee8a); + mdio_write(tp, 0x06, 0xefb8); + mdio_write(tp, 0x06, 0xee8a); + mdio_write(tp, 0x06, 0xe902); + mdio_write(tp, 0x06, 0xee8b); + mdio_write(tp, 0x06, 0x8285); + mdio_write(tp, 0x06, 0xee8b); + mdio_write(tp, 0x06, 0x8520); + mdio_write(tp, 0x06, 0xee8b); + mdio_write(tp, 0x06, 0x8701); + mdio_write(tp, 0x06, 0xd481); + mdio_write(tp, 0x06, 0x35e4); + mdio_write(tp, 0x06, 0x8b94); + mdio_write(tp, 0x06, 0xe58b); + mdio_write(tp, 0x06, 0x95bf); + mdio_write(tp, 0x06, 0x8b88); + mdio_write(tp, 0x06, 0xec00); + mdio_write(tp, 0x06, 0x19a9); + mdio_write(tp, 0x06, 0x8b90); + mdio_write(tp, 0x06, 0xf9ee); + mdio_write(tp, 0x06, 0xfff6); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0xfff7); + mdio_write(tp, 0x06, 0xffe0); + mdio_write(tp, 0x06, 0xe140); + mdio_write(tp, 0x06, 0xe1e1); + mdio_write(tp, 0x06, 0x41f7); + mdio_write(tp, 0x06, 0x2ff6); + mdio_write(tp, 0x06, 0x28e4); + mdio_write(tp, 0x06, 0xe140); + mdio_write(tp, 0x06, 0xe5e1); + mdio_write(tp, 0x06, 0x4104); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0x8b89); + mdio_write(tp, 0x06, 0xad20); + mdio_write(tp, 0x06, 0x0dee); + mdio_write(tp, 0x06, 0x8b89); + mdio_write(tp, 0x06, 0x0002); + mdio_write(tp, 0x06, 0x82f4); + mdio_write(tp, 0x06, 0x021f); + mdio_write(tp, 0x06, 0x4102); + mdio_write(tp, 0x06, 0x2812); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0x8b8d); + mdio_write(tp, 0x06, 0xad20); + mdio_write(tp, 0x06, 0x10ee); + mdio_write(tp, 0x06, 0x8b8d); + mdio_write(tp, 0x06, 0x0002); + mdio_write(tp, 0x06, 0x139d); + mdio_write(tp, 0x06, 0x0281); + mdio_write(tp, 0x06, 0xd602); + mdio_write(tp, 0x06, 0x1f99); + mdio_write(tp, 0x06, 0x0227); + mdio_write(tp, 0x06, 0xeafc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x8ead); + mdio_write(tp, 0x06, 0x2014); + mdio_write(tp, 0x06, 0xf620); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x8e02); + mdio_write(tp, 0x06, 0x8104); + mdio_write(tp, 0x06, 0x021b); + mdio_write(tp, 0x06, 0xf402); + mdio_write(tp, 0x06, 0x2c9c); + mdio_write(tp, 0x06, 0x0281); + mdio_write(tp, 0x06, 0x7902); + mdio_write(tp, 0x06, 0x8443); + mdio_write(tp, 0x06, 0xad22); + mdio_write(tp, 0x06, 0x11f6); + mdio_write(tp, 0x06, 0x22e4); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0x022c); + mdio_write(tp, 0x06, 0x4602); + mdio_write(tp, 0x06, 0x2ac5); + mdio_write(tp, 0x06, 0x0229); + mdio_write(tp, 0x06, 0x2002); + mdio_write(tp, 0x06, 0x2b91); + mdio_write(tp, 0x06, 0xad25); + mdio_write(tp, 0x06, 0x11f6); + mdio_write(tp, 0x06, 0x25e4); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0x0284); + mdio_write(tp, 0x06, 0xe202); + mdio_write(tp, 0x06, 0x043a); + mdio_write(tp, 0x06, 0x021a); + mdio_write(tp, 0x06, 0x5902); + mdio_write(tp, 0x06, 0x2bfc); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8fa); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x00e1); + mdio_write(tp, 0x06, 0xe001); + mdio_write(tp, 0x06, 0xad27); + mdio_write(tp, 0x06, 0x1fd1); + mdio_write(tp, 0x06, 0x01bf); + mdio_write(tp, 0x06, 0x8638); + mdio_write(tp, 0x06, 0x022f); + mdio_write(tp, 0x06, 0x50e0); + mdio_write(tp, 0x06, 0xe020); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0x21ad); + mdio_write(tp, 0x06, 0x200e); + mdio_write(tp, 0x06, 0xd100); + mdio_write(tp, 0x06, 0xbf86); + mdio_write(tp, 0x06, 0x3802); + mdio_write(tp, 0x06, 0x2f50); + mdio_write(tp, 0x06, 0xbf3d); + mdio_write(tp, 0x06, 0x3902); + mdio_write(tp, 0x06, 0x2eb0); + mdio_write(tp, 0x06, 0xef96); + mdio_write(tp, 0x06, 0xfefc); + mdio_write(tp, 0x06, 0x0402); + mdio_write(tp, 0x06, 0x8591); + mdio_write(tp, 0x06, 0x0281); + mdio_write(tp, 0x06, 0x3c05); + mdio_write(tp, 0x06, 0xf8fa); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0xe0e2); + mdio_write(tp, 0x06, 0xfee1); + mdio_write(tp, 0x06, 0xe2ff); + mdio_write(tp, 0x06, 0xad2d); + mdio_write(tp, 0x06, 0x1ae0); + mdio_write(tp, 0x06, 0xe14e); + mdio_write(tp, 0x06, 0xe1e1); + mdio_write(tp, 0x06, 0x4fac); + mdio_write(tp, 0x06, 0x2d22); + mdio_write(tp, 0x06, 0xf603); + mdio_write(tp, 0x06, 0x0203); + mdio_write(tp, 0x06, 0x36f7); + mdio_write(tp, 0x06, 0x03f7); + mdio_write(tp, 0x06, 0x06bf); + mdio_write(tp, 0x06, 0x8622); + mdio_write(tp, 0x06, 0x022e); + mdio_write(tp, 0x06, 0xb0ae); + mdio_write(tp, 0x06, 0x11e0); + mdio_write(tp, 0x06, 0xe14e); + mdio_write(tp, 0x06, 0xe1e1); + mdio_write(tp, 0x06, 0x4fad); + mdio_write(tp, 0x06, 0x2d08); + mdio_write(tp, 0x06, 0xbf86); + mdio_write(tp, 0x06, 0x2d02); + mdio_write(tp, 0x06, 0x2eb0); + mdio_write(tp, 0x06, 0xf606); + mdio_write(tp, 0x06, 0xef96); + mdio_write(tp, 0x06, 0xfefc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xf9fa); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x87ad); + mdio_write(tp, 0x06, 0x204c); + mdio_write(tp, 0x06, 0xd200); + mdio_write(tp, 0x06, 0xe0e2); + mdio_write(tp, 0x06, 0x0058); + mdio_write(tp, 0x06, 0x010c); + mdio_write(tp, 0x06, 0x021e); + mdio_write(tp, 0x06, 0x20e0); + mdio_write(tp, 0x06, 0xe000); + mdio_write(tp, 0x06, 0x5810); + mdio_write(tp, 0x06, 0x1e20); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x3658); + mdio_write(tp, 0x06, 0x031e); + mdio_write(tp, 0x06, 0x20e0); + mdio_write(tp, 0x06, 0xe022); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0x2358); + mdio_write(tp, 0x06, 0xe01e); + mdio_write(tp, 0x06, 0x20e0); + mdio_write(tp, 0x06, 0x8ae6); + mdio_write(tp, 0x06, 0x1f02); + mdio_write(tp, 0x06, 0x9e22); + mdio_write(tp, 0x06, 0xe68a); + mdio_write(tp, 0x06, 0xe6ad); + mdio_write(tp, 0x06, 0x3214); + mdio_write(tp, 0x06, 0xad34); + mdio_write(tp, 0x06, 0x11ef); + mdio_write(tp, 0x06, 0x0258); + mdio_write(tp, 0x06, 0x039e); + mdio_write(tp, 0x06, 0x07ad); + mdio_write(tp, 0x06, 0x3508); + mdio_write(tp, 0x06, 0x5ac0); + mdio_write(tp, 0x06, 0x9f04); + mdio_write(tp, 0x06, 0xd101); + mdio_write(tp, 0x06, 0xae02); + mdio_write(tp, 0x06, 0xd100); + mdio_write(tp, 0x06, 0xbf86); + mdio_write(tp, 0x06, 0x3e02); + mdio_write(tp, 0x06, 0x2f50); + mdio_write(tp, 0x06, 0xef96); + mdio_write(tp, 0x06, 0xfefd); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8f9); + mdio_write(tp, 0x06, 0xfae0); + mdio_write(tp, 0x06, 0x8b81); + mdio_write(tp, 0x06, 0xac26); + mdio_write(tp, 0x06, 0x0ee0); + mdio_write(tp, 0x06, 0x8b81); + mdio_write(tp, 0x06, 0xac21); + mdio_write(tp, 0x06, 0x08e0); + mdio_write(tp, 0x06, 0x8b87); + mdio_write(tp, 0x06, 0xac24); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0x6bee); + mdio_write(tp, 0x06, 0xe0ea); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0xe0eb); + mdio_write(tp, 0x06, 0x00e2); + mdio_write(tp, 0x06, 0xe07c); + mdio_write(tp, 0x06, 0xe3e0); + mdio_write(tp, 0x06, 0x7da5); + mdio_write(tp, 0x06, 0x1111); + mdio_write(tp, 0x06, 0x15d2); + mdio_write(tp, 0x06, 0x60d6); + mdio_write(tp, 0x06, 0x6666); + mdio_write(tp, 0x06, 0x0207); + mdio_write(tp, 0x06, 0xf9d2); + mdio_write(tp, 0x06, 0xa0d6); + mdio_write(tp, 0x06, 0xaaaa); + mdio_write(tp, 0x06, 0x0207); + mdio_write(tp, 0x06, 0xf902); + mdio_write(tp, 0x06, 0x825c); + mdio_write(tp, 0x06, 0xae44); + mdio_write(tp, 0x06, 0xa566); + mdio_write(tp, 0x06, 0x6602); + mdio_write(tp, 0x06, 0xae38); + mdio_write(tp, 0x06, 0xa5aa); + mdio_write(tp, 0x06, 0xaa02); + mdio_write(tp, 0x06, 0xae32); + mdio_write(tp, 0x06, 0xeee0); + mdio_write(tp, 0x06, 0xea04); + mdio_write(tp, 0x06, 0xeee0); + mdio_write(tp, 0x06, 0xeb06); + mdio_write(tp, 0x06, 0xe2e0); + mdio_write(tp, 0x06, 0x7ce3); + mdio_write(tp, 0x06, 0xe07d); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x38e1); + mdio_write(tp, 0x06, 0xe039); + mdio_write(tp, 0x06, 0xad2e); + mdio_write(tp, 0x06, 0x21ad); + mdio_write(tp, 0x06, 0x3f13); + mdio_write(tp, 0x06, 0xe0e4); + mdio_write(tp, 0x06, 0x14e1); + mdio_write(tp, 0x06, 0xe415); + mdio_write(tp, 0x06, 0x6880); + mdio_write(tp, 0x06, 0xe4e4); + mdio_write(tp, 0x06, 0x14e5); + mdio_write(tp, 0x06, 0xe415); + mdio_write(tp, 0x06, 0x0282); + mdio_write(tp, 0x06, 0x5cae); + mdio_write(tp, 0x06, 0x0bac); + mdio_write(tp, 0x06, 0x3e02); + mdio_write(tp, 0x06, 0xae06); + mdio_write(tp, 0x06, 0x0282); + mdio_write(tp, 0x06, 0x8602); + mdio_write(tp, 0x06, 0x82b0); + mdio_write(tp, 0x06, 0xfefd); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8e1); + mdio_write(tp, 0x06, 0x8b2e); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x81ad); + mdio_write(tp, 0x06, 0x2605); + mdio_write(tp, 0x06, 0x0221); + mdio_write(tp, 0x06, 0xf3f7); + mdio_write(tp, 0x06, 0x28e0); + mdio_write(tp, 0x06, 0x8b81); + mdio_write(tp, 0x06, 0xad21); + mdio_write(tp, 0x06, 0x0502); + mdio_write(tp, 0x06, 0x22f8); + mdio_write(tp, 0x06, 0xf729); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x87ad); + mdio_write(tp, 0x06, 0x2405); + mdio_write(tp, 0x06, 0x0282); + mdio_write(tp, 0x06, 0xebf7); + mdio_write(tp, 0x06, 0x2ae5); + mdio_write(tp, 0x06, 0x8b2e); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0x8b81); + mdio_write(tp, 0x06, 0xad26); + mdio_write(tp, 0x06, 0x0302); + mdio_write(tp, 0x06, 0x2134); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x81ad); + mdio_write(tp, 0x06, 0x2109); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x2eac); + mdio_write(tp, 0x06, 0x2003); + mdio_write(tp, 0x06, 0x0283); + mdio_write(tp, 0x06, 0x52e0); + mdio_write(tp, 0x06, 0x8b87); + mdio_write(tp, 0x06, 0xad24); + mdio_write(tp, 0x06, 0x09e0); + mdio_write(tp, 0x06, 0x8b2e); + mdio_write(tp, 0x06, 0xac21); + mdio_write(tp, 0x06, 0x0302); + mdio_write(tp, 0x06, 0x8337); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8e1); + mdio_write(tp, 0x06, 0x8b2e); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x81ad); + mdio_write(tp, 0x06, 0x2608); + mdio_write(tp, 0x06, 0xe085); + mdio_write(tp, 0x06, 0xd2ad); + mdio_write(tp, 0x06, 0x2502); + mdio_write(tp, 0x06, 0xf628); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x81ad); + mdio_write(tp, 0x06, 0x210a); + mdio_write(tp, 0x06, 0xe086); + mdio_write(tp, 0x06, 0x0af6); + mdio_write(tp, 0x06, 0x27a0); + mdio_write(tp, 0x06, 0x0502); + mdio_write(tp, 0x06, 0xf629); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x87ad); + mdio_write(tp, 0x06, 0x2408); + mdio_write(tp, 0x06, 0xe08a); + mdio_write(tp, 0x06, 0xedad); + mdio_write(tp, 0x06, 0x2002); + mdio_write(tp, 0x06, 0xf62a); + mdio_write(tp, 0x06, 0xe58b); + mdio_write(tp, 0x06, 0x2ea1); + mdio_write(tp, 0x06, 0x0003); + mdio_write(tp, 0x06, 0x0221); + mdio_write(tp, 0x06, 0x11fc); + mdio_write(tp, 0x06, 0x04ee); + mdio_write(tp, 0x06, 0x8aed); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0x8aec); + mdio_write(tp, 0x06, 0x0004); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0x8b87); + mdio_write(tp, 0x06, 0xad24); + mdio_write(tp, 0x06, 0x3ae0); + mdio_write(tp, 0x06, 0xe0ea); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0xeb58); + mdio_write(tp, 0x06, 0xf8d1); + mdio_write(tp, 0x06, 0x01e4); + mdio_write(tp, 0x06, 0xe0ea); + mdio_write(tp, 0x06, 0xe5e0); + mdio_write(tp, 0x06, 0xebe0); + mdio_write(tp, 0x06, 0xe07c); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0x7d5c); + mdio_write(tp, 0x06, 0x00ff); + mdio_write(tp, 0x06, 0x3c00); + mdio_write(tp, 0x06, 0x1eab); + mdio_write(tp, 0x06, 0x1ce0); + mdio_write(tp, 0x06, 0xe04c); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0x4d58); + mdio_write(tp, 0x06, 0xc1e4); + mdio_write(tp, 0x06, 0xe04c); + mdio_write(tp, 0x06, 0xe5e0); + mdio_write(tp, 0x06, 0x4de0); + mdio_write(tp, 0x06, 0xe0ee); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0x3ce4); + mdio_write(tp, 0x06, 0xe0ee); + mdio_write(tp, 0x06, 0xe5e0); + mdio_write(tp, 0x06, 0xeffc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x87ad); + mdio_write(tp, 0x06, 0x2412); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0xeee1); + mdio_write(tp, 0x06, 0xe0ef); + mdio_write(tp, 0x06, 0x59c3); + mdio_write(tp, 0x06, 0xe4e0); + mdio_write(tp, 0x06, 0xeee5); + mdio_write(tp, 0x06, 0xe0ef); + mdio_write(tp, 0x06, 0xee8a); + mdio_write(tp, 0x06, 0xed01); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0x8b81); + mdio_write(tp, 0x06, 0xac25); + mdio_write(tp, 0x06, 0x0502); + mdio_write(tp, 0x06, 0x8363); + mdio_write(tp, 0x06, 0xae03); + mdio_write(tp, 0x06, 0x0225); + mdio_write(tp, 0x06, 0x16fc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xf9fa); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0xfae0); + mdio_write(tp, 0x06, 0x860a); + mdio_write(tp, 0x06, 0xa000); + mdio_write(tp, 0x06, 0x19e0); + mdio_write(tp, 0x06, 0x860b); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x331b); + mdio_write(tp, 0x06, 0x109e); + mdio_write(tp, 0x06, 0x04aa); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0x06ee); + mdio_write(tp, 0x06, 0x860a); + mdio_write(tp, 0x06, 0x01ae); + mdio_write(tp, 0x06, 0xe602); + mdio_write(tp, 0x06, 0x241e); + mdio_write(tp, 0x06, 0xae14); + mdio_write(tp, 0x06, 0xa001); + mdio_write(tp, 0x06, 0x1402); + mdio_write(tp, 0x06, 0x2426); + mdio_write(tp, 0x06, 0xbf26); + mdio_write(tp, 0x06, 0x6d02); + mdio_write(tp, 0x06, 0x2eb0); + mdio_write(tp, 0x06, 0xee86); + mdio_write(tp, 0x06, 0x0b00); + mdio_write(tp, 0x06, 0xee86); + mdio_write(tp, 0x06, 0x0a02); + mdio_write(tp, 0x06, 0xaf84); + mdio_write(tp, 0x06, 0x3ca0); + mdio_write(tp, 0x06, 0x0252); + mdio_write(tp, 0x06, 0xee86); + mdio_write(tp, 0x06, 0x0400); + mdio_write(tp, 0x06, 0xee86); + mdio_write(tp, 0x06, 0x0500); + mdio_write(tp, 0x06, 0xe086); + mdio_write(tp, 0x06, 0x0be1); + mdio_write(tp, 0x06, 0x8b32); + mdio_write(tp, 0x06, 0x1b10); + mdio_write(tp, 0x06, 0x9e04); + mdio_write(tp, 0x06, 0xaa02); + mdio_write(tp, 0x06, 0xaecb); + mdio_write(tp, 0x06, 0xee86); + mdio_write(tp, 0x06, 0x0b00); + mdio_write(tp, 0x06, 0x0224); + mdio_write(tp, 0x06, 0x3ae2); + mdio_write(tp, 0x06, 0x8604); + mdio_write(tp, 0x06, 0xe386); + mdio_write(tp, 0x06, 0x05ef); + mdio_write(tp, 0x06, 0x65e2); + mdio_write(tp, 0x06, 0x8606); + mdio_write(tp, 0x06, 0xe386); + mdio_write(tp, 0x06, 0x071b); + mdio_write(tp, 0x06, 0x56aa); + mdio_write(tp, 0x06, 0x0eef); + mdio_write(tp, 0x06, 0x56e6); + mdio_write(tp, 0x06, 0x8606); + mdio_write(tp, 0x06, 0xe786); + mdio_write(tp, 0x06, 0x07e2); + mdio_write(tp, 0x06, 0x8609); + mdio_write(tp, 0x06, 0xe686); + mdio_write(tp, 0x06, 0x08e0); + mdio_write(tp, 0x06, 0x8609); + mdio_write(tp, 0x06, 0xa000); + mdio_write(tp, 0x06, 0x07ee); + mdio_write(tp, 0x06, 0x860a); + mdio_write(tp, 0x06, 0x03af); + mdio_write(tp, 0x06, 0x8369); + mdio_write(tp, 0x06, 0x0224); + mdio_write(tp, 0x06, 0x8e02); + mdio_write(tp, 0x06, 0x2426); + mdio_write(tp, 0x06, 0xae48); + mdio_write(tp, 0x06, 0xa003); + mdio_write(tp, 0x06, 0x21e0); + mdio_write(tp, 0x06, 0x8608); + mdio_write(tp, 0x06, 0xe186); + mdio_write(tp, 0x06, 0x091b); + mdio_write(tp, 0x06, 0x019e); + mdio_write(tp, 0x06, 0x0caa); + mdio_write(tp, 0x06, 0x0502); + mdio_write(tp, 0x06, 0x249d); + mdio_write(tp, 0x06, 0xaee7); + mdio_write(tp, 0x06, 0x0224); + mdio_write(tp, 0x06, 0x8eae); + mdio_write(tp, 0x06, 0xe2ee); + mdio_write(tp, 0x06, 0x860a); + mdio_write(tp, 0x06, 0x04ee); + mdio_write(tp, 0x06, 0x860b); + mdio_write(tp, 0x06, 0x00af); + mdio_write(tp, 0x06, 0x8369); + mdio_write(tp, 0x06, 0xa004); + mdio_write(tp, 0x06, 0x15e0); + mdio_write(tp, 0x06, 0x860b); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x341b); + mdio_write(tp, 0x06, 0x109e); + mdio_write(tp, 0x06, 0x05aa); + mdio_write(tp, 0x06, 0x03af); + mdio_write(tp, 0x06, 0x8383); + mdio_write(tp, 0x06, 0xee86); + mdio_write(tp, 0x06, 0x0a05); + mdio_write(tp, 0x06, 0xae0c); + mdio_write(tp, 0x06, 0xa005); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0x0702); + mdio_write(tp, 0x06, 0x2309); + mdio_write(tp, 0x06, 0xee86); + mdio_write(tp, 0x06, 0x0a00); + mdio_write(tp, 0x06, 0xfeef); + mdio_write(tp, 0x06, 0x96fe); + mdio_write(tp, 0x06, 0xfdfc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xf9fa); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0xfbe0); + mdio_write(tp, 0x06, 0x8b85); + mdio_write(tp, 0x06, 0xad25); + mdio_write(tp, 0x06, 0x22e0); + mdio_write(tp, 0x06, 0xe022); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0x23e2); + mdio_write(tp, 0x06, 0xe036); + mdio_write(tp, 0x06, 0xe3e0); + mdio_write(tp, 0x06, 0x375a); + mdio_write(tp, 0x06, 0xc40d); + mdio_write(tp, 0x06, 0x0158); + mdio_write(tp, 0x06, 0x021e); + mdio_write(tp, 0x06, 0x20e3); + mdio_write(tp, 0x06, 0x8ae7); + mdio_write(tp, 0x06, 0xac31); + mdio_write(tp, 0x06, 0x60ac); + mdio_write(tp, 0x06, 0x3a08); + mdio_write(tp, 0x06, 0xac3e); + mdio_write(tp, 0x06, 0x26ae); + mdio_write(tp, 0x06, 0x67af); + mdio_write(tp, 0x06, 0x84db); + mdio_write(tp, 0x06, 0xad37); + mdio_write(tp, 0x06, 0x61e0); + mdio_write(tp, 0x06, 0x8ae8); + mdio_write(tp, 0x06, 0x10e4); + mdio_write(tp, 0x06, 0x8ae8); + mdio_write(tp, 0x06, 0xe18a); + mdio_write(tp, 0x06, 0xe91b); + mdio_write(tp, 0x06, 0x109e); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0x51d1); + mdio_write(tp, 0x06, 0x00bf); + mdio_write(tp, 0x06, 0x863b); + mdio_write(tp, 0x06, 0x022f); + mdio_write(tp, 0x06, 0x50ee); + mdio_write(tp, 0x06, 0x8ae8); + mdio_write(tp, 0x06, 0x00ae); + mdio_write(tp, 0x06, 0x43ad); + mdio_write(tp, 0x06, 0x3627); + mdio_write(tp, 0x06, 0xe08a); + mdio_write(tp, 0x06, 0xeee1); + mdio_write(tp, 0x06, 0x8aef); + mdio_write(tp, 0x06, 0xef74); + mdio_write(tp, 0x06, 0xe08a); + mdio_write(tp, 0x06, 0xeae1); + mdio_write(tp, 0x06, 0x8aeb); + mdio_write(tp, 0x06, 0x1b74); + mdio_write(tp, 0x06, 0x9e2e); + mdio_write(tp, 0x06, 0x14e4); + mdio_write(tp, 0x06, 0x8aea); + mdio_write(tp, 0x06, 0xe58a); + mdio_write(tp, 0x06, 0xebef); + mdio_write(tp, 0x06, 0x74e0); + mdio_write(tp, 0x06, 0x8aee); + mdio_write(tp, 0x06, 0xe18a); + mdio_write(tp, 0x06, 0xef1b); + mdio_write(tp, 0x06, 0x479e); + mdio_write(tp, 0x06, 0x0fae); + mdio_write(tp, 0x06, 0x19ee); + mdio_write(tp, 0x06, 0x8aea); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0x8aeb); + mdio_write(tp, 0x06, 0x00ae); + mdio_write(tp, 0x06, 0x0fac); + mdio_write(tp, 0x06, 0x390c); + mdio_write(tp, 0x06, 0xd101); + mdio_write(tp, 0x06, 0xbf86); + mdio_write(tp, 0x06, 0x3b02); + mdio_write(tp, 0x06, 0x2f50); + mdio_write(tp, 0x06, 0xee8a); + mdio_write(tp, 0x06, 0xe800); + mdio_write(tp, 0x06, 0xe68a); + mdio_write(tp, 0x06, 0xe7ff); + mdio_write(tp, 0x06, 0xef96); + mdio_write(tp, 0x06, 0xfefd); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8f9); + mdio_write(tp, 0x06, 0xfaef); + mdio_write(tp, 0x06, 0x69e0); + mdio_write(tp, 0x06, 0xe022); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0x2358); + mdio_write(tp, 0x06, 0xc4e1); + mdio_write(tp, 0x06, 0x8b6e); + mdio_write(tp, 0x06, 0x1f10); + mdio_write(tp, 0x06, 0x9e24); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x6ead); + mdio_write(tp, 0x06, 0x2218); + mdio_write(tp, 0x06, 0xac27); + mdio_write(tp, 0x06, 0x0dac); + mdio_write(tp, 0x06, 0x2605); + mdio_write(tp, 0x06, 0x0203); + mdio_write(tp, 0x06, 0x8fae); + mdio_write(tp, 0x06, 0x1302); + mdio_write(tp, 0x06, 0x03c8); + mdio_write(tp, 0x06, 0xae0e); + mdio_write(tp, 0x06, 0x0203); + mdio_write(tp, 0x06, 0xe102); + mdio_write(tp, 0x06, 0x8520); + mdio_write(tp, 0x06, 0xae06); + mdio_write(tp, 0x06, 0x0203); + mdio_write(tp, 0x06, 0x8f02); + mdio_write(tp, 0x06, 0x8566); + mdio_write(tp, 0x06, 0xef96); + mdio_write(tp, 0x06, 0xfefd); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8fa); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x82ad); + mdio_write(tp, 0x06, 0x2737); + mdio_write(tp, 0x06, 0xbf86); + mdio_write(tp, 0x06, 0x4402); + mdio_write(tp, 0x06, 0x2f23); + mdio_write(tp, 0x06, 0xac28); + mdio_write(tp, 0x06, 0x2ed1); + mdio_write(tp, 0x06, 0x01bf); + mdio_write(tp, 0x06, 0x8647); + mdio_write(tp, 0x06, 0x022f); + mdio_write(tp, 0x06, 0x50bf); + mdio_write(tp, 0x06, 0x8641); + mdio_write(tp, 0x06, 0x022f); + mdio_write(tp, 0x06, 0x23e5); + mdio_write(tp, 0x06, 0x8af0); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x22e1); + mdio_write(tp, 0x06, 0xe023); + mdio_write(tp, 0x06, 0xac2e); + mdio_write(tp, 0x06, 0x04d1); + mdio_write(tp, 0x06, 0x01ae); + mdio_write(tp, 0x06, 0x02d1); + mdio_write(tp, 0x06, 0x00bf); + mdio_write(tp, 0x06, 0x8641); + mdio_write(tp, 0x06, 0x022f); + mdio_write(tp, 0x06, 0x50d1); + mdio_write(tp, 0x06, 0x01bf); + mdio_write(tp, 0x06, 0x8644); + mdio_write(tp, 0x06, 0x022f); + mdio_write(tp, 0x06, 0x50ef); + mdio_write(tp, 0x06, 0x96fe); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8fa); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0xbf86); + mdio_write(tp, 0x06, 0x4702); + mdio_write(tp, 0x06, 0x2f23); + mdio_write(tp, 0x06, 0xad28); + mdio_write(tp, 0x06, 0x19d1); + mdio_write(tp, 0x06, 0x00bf); + mdio_write(tp, 0x06, 0x8644); + mdio_write(tp, 0x06, 0x022f); + mdio_write(tp, 0x06, 0x50e1); + mdio_write(tp, 0x06, 0x8af0); + mdio_write(tp, 0x06, 0xbf86); + mdio_write(tp, 0x06, 0x4102); + mdio_write(tp, 0x06, 0x2f50); + mdio_write(tp, 0x06, 0xd100); + mdio_write(tp, 0x06, 0xbf86); + mdio_write(tp, 0x06, 0x4702); + mdio_write(tp, 0x06, 0x2f50); + mdio_write(tp, 0x06, 0xef96); + mdio_write(tp, 0x06, 0xfefc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xe0e2); + mdio_write(tp, 0x06, 0xfee1); + mdio_write(tp, 0x06, 0xe2ff); + mdio_write(tp, 0x06, 0xad2e); + mdio_write(tp, 0x06, 0x63e0); + mdio_write(tp, 0x06, 0xe038); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0x39ad); + mdio_write(tp, 0x06, 0x2f10); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x34e1); + mdio_write(tp, 0x06, 0xe035); + mdio_write(tp, 0x06, 0xf726); + mdio_write(tp, 0x06, 0xe4e0); + mdio_write(tp, 0x06, 0x34e5); + mdio_write(tp, 0x06, 0xe035); + mdio_write(tp, 0x06, 0xae0e); + mdio_write(tp, 0x06, 0xe0e2); + mdio_write(tp, 0x06, 0xd6e1); + mdio_write(tp, 0x06, 0xe2d7); + mdio_write(tp, 0x06, 0xf728); + mdio_write(tp, 0x06, 0xe4e2); + mdio_write(tp, 0x06, 0xd6e5); + mdio_write(tp, 0x06, 0xe2d7); + mdio_write(tp, 0x06, 0xe0e2); + mdio_write(tp, 0x06, 0x34e1); + mdio_write(tp, 0x06, 0xe235); + mdio_write(tp, 0x06, 0xf72b); + mdio_write(tp, 0x06, 0xe4e2); + mdio_write(tp, 0x06, 0x34e5); + mdio_write(tp, 0x06, 0xe235); + mdio_write(tp, 0x06, 0xd07d); + mdio_write(tp, 0x06, 0xb0fe); + mdio_write(tp, 0x06, 0xe0e2); + mdio_write(tp, 0x06, 0x34e1); + mdio_write(tp, 0x06, 0xe235); + mdio_write(tp, 0x06, 0xf62b); + mdio_write(tp, 0x06, 0xe4e2); + mdio_write(tp, 0x06, 0x34e5); + mdio_write(tp, 0x06, 0xe235); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x34e1); + mdio_write(tp, 0x06, 0xe035); + mdio_write(tp, 0x06, 0xf626); + mdio_write(tp, 0x06, 0xe4e0); + mdio_write(tp, 0x06, 0x34e5); + mdio_write(tp, 0x06, 0xe035); + mdio_write(tp, 0x06, 0xe0e2); + mdio_write(tp, 0x06, 0xd6e1); + mdio_write(tp, 0x06, 0xe2d7); + mdio_write(tp, 0x06, 0xf628); + mdio_write(tp, 0x06, 0xe4e2); + mdio_write(tp, 0x06, 0xd6e5); + mdio_write(tp, 0x06, 0xe2d7); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xae20); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0xa725); + mdio_write(tp, 0x06, 0xe50a); + mdio_write(tp, 0x06, 0x1de5); + mdio_write(tp, 0x06, 0x0a2c); + mdio_write(tp, 0x06, 0xe50a); + mdio_write(tp, 0x06, 0x6de5); + mdio_write(tp, 0x06, 0x0a1d); + mdio_write(tp, 0x06, 0xe50a); + mdio_write(tp, 0x06, 0x1ce5); + mdio_write(tp, 0x06, 0x0a2d); + mdio_write(tp, 0x06, 0xa755); + mdio_write(tp, 0x06, 0x00e2); + mdio_write(tp, 0x06, 0x3488); + mdio_write(tp, 0x06, 0xe200); + mdio_write(tp, 0x06, 0xcce2); + mdio_write(tp, 0x06, 0x0055); + mdio_write(tp, 0x06, 0xe020); + mdio_write(tp, 0x06, 0x55e2); + mdio_write(tp, 0x06, 0xd600); + mdio_write(tp, 0x06, 0xe24a); + gphy_val = mdio_read(tp, 0x01); + gphy_val |= BIT_0; + mdio_write(tp, 0x01, gphy_val); + gphy_val = mdio_read(tp, 0x00); + gphy_val |= BIT_0; + mdio_write(tp, 0x00, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x17, 0x2179); + mdio_write(tp, 0x1f, 0x0001); + mdio_write(tp, 0x10, 0xf274); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0042); + mdio_write(tp, 0x15, 0x0f00); + mdio_write(tp, 0x15, 0x0f00); + mdio_write(tp, 0x16, 0x7408); + mdio_write(tp, 0x15, 0x0e00); + mdio_write(tp, 0x15, 0x0f00); + mdio_write(tp, 0x15, 0x0f01); + mdio_write(tp, 0x16, 0x4000); + mdio_write(tp, 0x15, 0x0e01); + mdio_write(tp, 0x15, 0x0f01); + mdio_write(tp, 0x15, 0x0f02); + mdio_write(tp, 0x16, 0x9400); + mdio_write(tp, 0x15, 0x0e02); + mdio_write(tp, 0x15, 0x0f02); + mdio_write(tp, 0x15, 0x0f03); + mdio_write(tp, 0x16, 0x7408); + mdio_write(tp, 0x15, 0x0e03); + mdio_write(tp, 0x15, 0x0f03); + mdio_write(tp, 0x15, 0x0f04); + mdio_write(tp, 0x16, 0x4008); + mdio_write(tp, 0x15, 0x0e04); + mdio_write(tp, 0x15, 0x0f04); + mdio_write(tp, 0x15, 0x0f05); + mdio_write(tp, 0x16, 0x9400); + mdio_write(tp, 0x15, 0x0e05); + mdio_write(tp, 0x15, 0x0f05); + mdio_write(tp, 0x15, 0x0f06); + mdio_write(tp, 0x16, 0x0803); + mdio_write(tp, 0x15, 0x0e06); + mdio_write(tp, 0x15, 0x0f06); + mdio_write(tp, 0x15, 0x0d00); + mdio_write(tp, 0x15, 0x0100); + mdio_write(tp, 0x1f, 0x0001); + mdio_write(tp, 0x10, 0xf074); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x17, 0x2149); + + mdio_write(tp, 0x1f, 0x0005); + for (i = 0; i < 200; i++) { + udelay(100); + gphy_val = mdio_read(tp, 0x00); + if (gphy_val & BIT_7) + break; + } + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0023); + gphy_val = mdio_read(tp, 0x17); + gphy_val &= ~(BIT_0); + if (tp->RequiredSecLanDonglePatch) + gphy_val &= ~(BIT_2); + mdio_write(tp, 0x17, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0023); + gphy_val = mdio_read(tp, 0x17); + gphy_val |= BIT_14; + mdio_write(tp, 0x17, gphy_val); + mdio_write(tp, 0x1e, 0x0020); + gphy_val = mdio_read(tp, 0x1b); + gphy_val |= BIT_7; + mdio_write(tp, 0x1b, gphy_val); + mdio_write(tp, 0x1e, 0x0041); + mdio_write(tp, 0x15, 0x0e02); + mdio_write(tp, 0x1e, 0x0028); + gphy_val = mdio_read(tp, 0x19); + gphy_val |= BIT_15; + mdio_write(tp, 0x19, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + } else { + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x00, 0x1800); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0023); + mdio_write(tp, 0x17, 0x0117); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1E, 0x002C); + mdio_write(tp, 0x1B, 0x5000); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x16, 0x4104); + for (i = 0; i < 200; i++) { + udelay(100); + gphy_val = mdio_read(tp, 0x1E); + gphy_val &= 0x03FF; + if (gphy_val==0x000C) + break; + } + mdio_write(tp, 0x1f, 0x0005); + for (i = 0; i < 200; i++) { + udelay(100); + gphy_val = mdio_read(tp, 0x07); + if ((gphy_val & BIT_5) == 0) + break; + } + gphy_val = mdio_read(tp, 0x07); + if (gphy_val & BIT_5) { + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x00a1); + mdio_write(tp, 0x17, 0x1000); + mdio_write(tp, 0x17, 0x0000); + mdio_write(tp, 0x17, 0x2000); + mdio_write(tp, 0x1e, 0x002f); + mdio_write(tp, 0x18, 0x9bfb); + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x07, 0x0000); + mdio_write(tp, 0x1f, 0x0000); + } + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x05, 0xfff6); + mdio_write(tp, 0x06, 0x0080); + gphy_val = mdio_read(tp, 0x00); + gphy_val &= ~(BIT_7); + mdio_write(tp, 0x00, gphy_val); + mdio_write(tp, 0x1f, 0x0002); + gphy_val = mdio_read(tp, 0x08); + gphy_val &= ~(BIT_7); + mdio_write(tp, 0x08, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0023); + mdio_write(tp, 0x16, 0x0306); + mdio_write(tp, 0x16, 0x0307); + mdio_write(tp, 0x15, 0x000e); + mdio_write(tp, 0x19, 0x000a); + mdio_write(tp, 0x15, 0x0010); + mdio_write(tp, 0x19, 0x0008); + mdio_write(tp, 0x15, 0x0018); + mdio_write(tp, 0x19, 0x4801); + mdio_write(tp, 0x15, 0x0019); + mdio_write(tp, 0x19, 0x6801); + mdio_write(tp, 0x15, 0x001a); + mdio_write(tp, 0x19, 0x66a1); + mdio_write(tp, 0x15, 0x001f); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0020); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0021); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0022); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0023); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0024); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0025); + mdio_write(tp, 0x19, 0x64a1); + mdio_write(tp, 0x15, 0x0026); + mdio_write(tp, 0x19, 0x40ea); + mdio_write(tp, 0x15, 0x0027); + mdio_write(tp, 0x19, 0x4503); + mdio_write(tp, 0x15, 0x0028); + mdio_write(tp, 0x19, 0x9f00); + mdio_write(tp, 0x15, 0x0029); + mdio_write(tp, 0x19, 0xa631); + mdio_write(tp, 0x15, 0x002a); + mdio_write(tp, 0x19, 0x9717); + mdio_write(tp, 0x15, 0x002b); + mdio_write(tp, 0x19, 0x302c); + mdio_write(tp, 0x15, 0x002c); + mdio_write(tp, 0x19, 0x4802); + mdio_write(tp, 0x15, 0x002d); + mdio_write(tp, 0x19, 0x58da); + mdio_write(tp, 0x15, 0x002e); + mdio_write(tp, 0x19, 0x400d); + mdio_write(tp, 0x15, 0x002f); + mdio_write(tp, 0x19, 0x4488); + mdio_write(tp, 0x15, 0x0030); + mdio_write(tp, 0x19, 0x9e00); + mdio_write(tp, 0x15, 0x0031); + mdio_write(tp, 0x19, 0x63c8); + mdio_write(tp, 0x15, 0x0032); + mdio_write(tp, 0x19, 0x6481); + mdio_write(tp, 0x15, 0x0033); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0034); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0035); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0036); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0037); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0038); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0039); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x003a); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x003b); + mdio_write(tp, 0x19, 0x63e8); + mdio_write(tp, 0x15, 0x003c); + mdio_write(tp, 0x19, 0x7d00); + mdio_write(tp, 0x15, 0x003d); + mdio_write(tp, 0x19, 0x59d4); + mdio_write(tp, 0x15, 0x003e); + mdio_write(tp, 0x19, 0x63f8); + mdio_write(tp, 0x15, 0x0040); + mdio_write(tp, 0x19, 0x64a1); + mdio_write(tp, 0x15, 0x0041); + mdio_write(tp, 0x19, 0x30de); + mdio_write(tp, 0x15, 0x0044); + mdio_write(tp, 0x19, 0x480f); + mdio_write(tp, 0x15, 0x0045); + mdio_write(tp, 0x19, 0x6800); + mdio_write(tp, 0x15, 0x0046); + mdio_write(tp, 0x19, 0x6680); + mdio_write(tp, 0x15, 0x0047); + mdio_write(tp, 0x19, 0x7c10); + mdio_write(tp, 0x15, 0x0048); + mdio_write(tp, 0x19, 0x63c8); + mdio_write(tp, 0x15, 0x0049); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x004a); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x004b); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x004c); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x004d); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x004e); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x004f); + mdio_write(tp, 0x19, 0x40ea); + mdio_write(tp, 0x15, 0x0050); + mdio_write(tp, 0x19, 0x4503); + mdio_write(tp, 0x15, 0x0051); + mdio_write(tp, 0x19, 0x58ca); + mdio_write(tp, 0x15, 0x0052); + mdio_write(tp, 0x19, 0x63c8); + mdio_write(tp, 0x15, 0x0053); + mdio_write(tp, 0x19, 0x63d8); + mdio_write(tp, 0x15, 0x0054); + mdio_write(tp, 0x19, 0x66a0); + mdio_write(tp, 0x15, 0x0055); + mdio_write(tp, 0x19, 0x9f00); + mdio_write(tp, 0x15, 0x0056); + mdio_write(tp, 0x19, 0x3000); + mdio_write(tp, 0x15, 0x00a1); + mdio_write(tp, 0x19, 0x3044); + mdio_write(tp, 0x15, 0x00ab); + mdio_write(tp, 0x19, 0x5820); + mdio_write(tp, 0x15, 0x00ac); + mdio_write(tp, 0x19, 0x5e04); + mdio_write(tp, 0x15, 0x00ad); + mdio_write(tp, 0x19, 0xb60c); + mdio_write(tp, 0x15, 0x00af); + mdio_write(tp, 0x19, 0x000a); + mdio_write(tp, 0x15, 0x00b2); + mdio_write(tp, 0x19, 0x30b9); + mdio_write(tp, 0x15, 0x00b9); + mdio_write(tp, 0x19, 0x4408); + mdio_write(tp, 0x15, 0x00ba); + mdio_write(tp, 0x19, 0x480b); + mdio_write(tp, 0x15, 0x00bb); + mdio_write(tp, 0x19, 0x5e00); + mdio_write(tp, 0x15, 0x00bc); + mdio_write(tp, 0x19, 0x405f); + mdio_write(tp, 0x15, 0x00bd); + mdio_write(tp, 0x19, 0x4448); + mdio_write(tp, 0x15, 0x00be); + mdio_write(tp, 0x19, 0x4020); + mdio_write(tp, 0x15, 0x00bf); + mdio_write(tp, 0x19, 0x4468); + mdio_write(tp, 0x15, 0x00c0); + mdio_write(tp, 0x19, 0x9c02); + mdio_write(tp, 0x15, 0x00c1); + mdio_write(tp, 0x19, 0x58a0); + mdio_write(tp, 0x15, 0x00c2); + mdio_write(tp, 0x19, 0xb605); + mdio_write(tp, 0x15, 0x00c3); + mdio_write(tp, 0x19, 0xc0d3); + mdio_write(tp, 0x15, 0x00c4); + mdio_write(tp, 0x19, 0x00e6); + mdio_write(tp, 0x15, 0x00c5); + mdio_write(tp, 0x19, 0xdaec); + mdio_write(tp, 0x15, 0x00c6); + mdio_write(tp, 0x19, 0x00fa); + mdio_write(tp, 0x15, 0x00c7); + mdio_write(tp, 0x19, 0x9df9); + mdio_write(tp, 0x15, 0x0112); + mdio_write(tp, 0x19, 0x6421); + mdio_write(tp, 0x15, 0x0113); + mdio_write(tp, 0x19, 0x7c08); + mdio_write(tp, 0x15, 0x0114); + mdio_write(tp, 0x19, 0x63f0); + mdio_write(tp, 0x15, 0x0115); + mdio_write(tp, 0x19, 0x4003); + mdio_write(tp, 0x15, 0x0116); + mdio_write(tp, 0x19, 0x4418); + mdio_write(tp, 0x15, 0x0117); + mdio_write(tp, 0x19, 0x9b00); + mdio_write(tp, 0x15, 0x0118); + mdio_write(tp, 0x19, 0x6461); + mdio_write(tp, 0x15, 0x0119); + mdio_write(tp, 0x19, 0x64e1); + mdio_write(tp, 0x15, 0x011a); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0150); + mdio_write(tp, 0x19, 0x7c80); + mdio_write(tp, 0x15, 0x0151); + mdio_write(tp, 0x19, 0x6461); + mdio_write(tp, 0x15, 0x0152); + mdio_write(tp, 0x19, 0x4003); + mdio_write(tp, 0x15, 0x0153); + mdio_write(tp, 0x19, 0x4540); + mdio_write(tp, 0x15, 0x0154); + mdio_write(tp, 0x19, 0x9f00); + mdio_write(tp, 0x15, 0x0155); + mdio_write(tp, 0x19, 0x9d00); + mdio_write(tp, 0x15, 0x0156); + mdio_write(tp, 0x19, 0x7c40); + mdio_write(tp, 0x15, 0x0157); + mdio_write(tp, 0x19, 0x6421); + mdio_write(tp, 0x15, 0x0158); + mdio_write(tp, 0x19, 0x7c80); + mdio_write(tp, 0x15, 0x0159); + mdio_write(tp, 0x19, 0x64a1); + mdio_write(tp, 0x15, 0x015a); + mdio_write(tp, 0x19, 0x30fe); + mdio_write(tp, 0x15, 0x029c); + mdio_write(tp, 0x19, 0x0070); + mdio_write(tp, 0x15, 0x02b2); + mdio_write(tp, 0x19, 0x005a); + mdio_write(tp, 0x15, 0x02bd); + mdio_write(tp, 0x19, 0xa522); + mdio_write(tp, 0x15, 0x02ce); + mdio_write(tp, 0x19, 0xb63e); + mdio_write(tp, 0x15, 0x02d9); + mdio_write(tp, 0x19, 0x32df); + mdio_write(tp, 0x15, 0x02df); + mdio_write(tp, 0x19, 0x4500); + mdio_write(tp, 0x15, 0x02f4); + mdio_write(tp, 0x19, 0xb618); + mdio_write(tp, 0x15, 0x02fb); + mdio_write(tp, 0x19, 0xb900); + mdio_write(tp, 0x15, 0x02fc); + mdio_write(tp, 0x19, 0x49b5); + mdio_write(tp, 0x15, 0x02fd); + mdio_write(tp, 0x19, 0x6812); + mdio_write(tp, 0x15, 0x02fe); + mdio_write(tp, 0x19, 0x66a0); + mdio_write(tp, 0x15, 0x02ff); + mdio_write(tp, 0x19, 0x9900); + mdio_write(tp, 0x15, 0x0300); + mdio_write(tp, 0x19, 0x64a0); + mdio_write(tp, 0x15, 0x0301); + mdio_write(tp, 0x19, 0x3316); + mdio_write(tp, 0x15, 0x0308); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x030c); + mdio_write(tp, 0x19, 0x3000); + mdio_write(tp, 0x15, 0x0312); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0313); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0314); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0315); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0316); + mdio_write(tp, 0x19, 0x49b5); + mdio_write(tp, 0x15, 0x0317); + mdio_write(tp, 0x19, 0x7d00); + mdio_write(tp, 0x15, 0x0318); + mdio_write(tp, 0x19, 0x4d00); + mdio_write(tp, 0x15, 0x0319); + mdio_write(tp, 0x19, 0x6810); + mdio_write(tp, 0x15, 0x031a); + mdio_write(tp, 0x19, 0x6c08); + mdio_write(tp, 0x15, 0x031b); + mdio_write(tp, 0x19, 0x4925); + mdio_write(tp, 0x15, 0x031c); + mdio_write(tp, 0x19, 0x403b); + mdio_write(tp, 0x15, 0x031d); + mdio_write(tp, 0x19, 0xa602); + mdio_write(tp, 0x15, 0x031e); + mdio_write(tp, 0x19, 0x402f); + mdio_write(tp, 0x15, 0x031f); + mdio_write(tp, 0x19, 0x4484); + mdio_write(tp, 0x15, 0x0320); + mdio_write(tp, 0x19, 0x40c8); + mdio_write(tp, 0x15, 0x0321); + mdio_write(tp, 0x19, 0x44c4); + mdio_write(tp, 0x15, 0x0322); + mdio_write(tp, 0x19, 0x404f); + mdio_write(tp, 0x15, 0x0323); + mdio_write(tp, 0x19, 0x44c8); + mdio_write(tp, 0x15, 0x0324); + mdio_write(tp, 0x19, 0xd64f); + mdio_write(tp, 0x15, 0x0325); + mdio_write(tp, 0x19, 0x00e7); + mdio_write(tp, 0x15, 0x0326); + mdio_write(tp, 0x19, 0x7c08); + mdio_write(tp, 0x15, 0x0327); + mdio_write(tp, 0x19, 0x8203); + mdio_write(tp, 0x15, 0x0328); + mdio_write(tp, 0x19, 0x4d48); + mdio_write(tp, 0x15, 0x0329); + mdio_write(tp, 0x19, 0x332b); + mdio_write(tp, 0x15, 0x032a); + mdio_write(tp, 0x19, 0x4d40); + mdio_write(tp, 0x15, 0x032c); + mdio_write(tp, 0x19, 0x00f8); + mdio_write(tp, 0x15, 0x032d); + mdio_write(tp, 0x19, 0x82b2); + mdio_write(tp, 0x15, 0x032f); + mdio_write(tp, 0x19, 0x00b0); + mdio_write(tp, 0x15, 0x0332); + mdio_write(tp, 0x19, 0x91f2); + mdio_write(tp, 0x15, 0x033f); + mdio_write(tp, 0x19, 0xb6cd); + mdio_write(tp, 0x15, 0x0340); + mdio_write(tp, 0x19, 0x9e01); + mdio_write(tp, 0x15, 0x0341); + mdio_write(tp, 0x19, 0xd11d); + mdio_write(tp, 0x15, 0x0342); + mdio_write(tp, 0x19, 0x009d); + mdio_write(tp, 0x15, 0x0343); + mdio_write(tp, 0x19, 0xbb1c); + mdio_write(tp, 0x15, 0x0344); + mdio_write(tp, 0x19, 0x8102); + mdio_write(tp, 0x15, 0x0345); + mdio_write(tp, 0x19, 0x3348); + mdio_write(tp, 0x15, 0x0346); + mdio_write(tp, 0x19, 0xa231); + mdio_write(tp, 0x15, 0x0347); + mdio_write(tp, 0x19, 0x335b); + mdio_write(tp, 0x15, 0x0348); + mdio_write(tp, 0x19, 0x91f7); + mdio_write(tp, 0x15, 0x0349); + mdio_write(tp, 0x19, 0xc218); + mdio_write(tp, 0x15, 0x034a); + mdio_write(tp, 0x19, 0x00f5); + mdio_write(tp, 0x15, 0x034b); + mdio_write(tp, 0x19, 0x335b); + mdio_write(tp, 0x15, 0x034c); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x034d); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x034e); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x034f); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0350); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x035b); + mdio_write(tp, 0x19, 0xa23c); + mdio_write(tp, 0x15, 0x035c); + mdio_write(tp, 0x19, 0x7c08); + mdio_write(tp, 0x15, 0x035d); + mdio_write(tp, 0x19, 0x4c00); + mdio_write(tp, 0x15, 0x035e); + mdio_write(tp, 0x19, 0x3397); + mdio_write(tp, 0x15, 0x0363); + mdio_write(tp, 0x19, 0xb6a9); + mdio_write(tp, 0x15, 0x0366); + mdio_write(tp, 0x19, 0x00f5); + mdio_write(tp, 0x15, 0x0382); + mdio_write(tp, 0x19, 0x7c40); + mdio_write(tp, 0x15, 0x0388); + mdio_write(tp, 0x19, 0x0084); + mdio_write(tp, 0x15, 0x0389); + mdio_write(tp, 0x19, 0xdd17); + mdio_write(tp, 0x15, 0x038a); + mdio_write(tp, 0x19, 0x000b); + mdio_write(tp, 0x15, 0x038b); + mdio_write(tp, 0x19, 0xa10a); + mdio_write(tp, 0x15, 0x038c); + mdio_write(tp, 0x19, 0x337e); + mdio_write(tp, 0x15, 0x038d); + mdio_write(tp, 0x19, 0x6c0b); + mdio_write(tp, 0x15, 0x038e); + mdio_write(tp, 0x19, 0xa107); + mdio_write(tp, 0x15, 0x038f); + mdio_write(tp, 0x19, 0x6c08); + mdio_write(tp, 0x15, 0x0390); + mdio_write(tp, 0x19, 0xc017); + mdio_write(tp, 0x15, 0x0391); + mdio_write(tp, 0x19, 0x0004); + mdio_write(tp, 0x15, 0x0392); + mdio_write(tp, 0x19, 0xd64f); + mdio_write(tp, 0x15, 0x0393); + mdio_write(tp, 0x19, 0x00f4); + mdio_write(tp, 0x15, 0x0397); + mdio_write(tp, 0x19, 0x4098); + mdio_write(tp, 0x15, 0x0398); + mdio_write(tp, 0x19, 0x4408); + mdio_write(tp, 0x15, 0x0399); + mdio_write(tp, 0x19, 0x55bf); + mdio_write(tp, 0x15, 0x039a); + mdio_write(tp, 0x19, 0x4bb9); + mdio_write(tp, 0x15, 0x039b); + mdio_write(tp, 0x19, 0x6810); + mdio_write(tp, 0x15, 0x039c); + mdio_write(tp, 0x19, 0x4b29); + mdio_write(tp, 0x15, 0x039d); + mdio_write(tp, 0x19, 0x4041); + mdio_write(tp, 0x15, 0x039e); + mdio_write(tp, 0x19, 0x442a); + mdio_write(tp, 0x15, 0x039f); + mdio_write(tp, 0x19, 0x4029); + mdio_write(tp, 0x15, 0x03aa); + mdio_write(tp, 0x19, 0x33b8); + mdio_write(tp, 0x15, 0x03b6); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03b7); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03b8); + mdio_write(tp, 0x19, 0x543f); + mdio_write(tp, 0x15, 0x03b9); + mdio_write(tp, 0x19, 0x499a); + mdio_write(tp, 0x15, 0x03ba); + mdio_write(tp, 0x19, 0x7c40); + mdio_write(tp, 0x15, 0x03bb); + mdio_write(tp, 0x19, 0x4c40); + mdio_write(tp, 0x15, 0x03bc); + mdio_write(tp, 0x19, 0x490a); + mdio_write(tp, 0x15, 0x03bd); + mdio_write(tp, 0x19, 0x405e); + mdio_write(tp, 0x15, 0x03c2); + mdio_write(tp, 0x19, 0x9a03); + mdio_write(tp, 0x15, 0x03c4); + mdio_write(tp, 0x19, 0x0015); + mdio_write(tp, 0x15, 0x03c5); + mdio_write(tp, 0x19, 0x9e03); + mdio_write(tp, 0x15, 0x03c8); + mdio_write(tp, 0x19, 0x9cf7); + mdio_write(tp, 0x15, 0x03c9); + mdio_write(tp, 0x19, 0x7c12); + mdio_write(tp, 0x15, 0x03ca); + mdio_write(tp, 0x19, 0x4c52); + mdio_write(tp, 0x15, 0x03cb); + mdio_write(tp, 0x19, 0x4458); + mdio_write(tp, 0x15, 0x03cd); + mdio_write(tp, 0x19, 0x4c40); + mdio_write(tp, 0x15, 0x03ce); + mdio_write(tp, 0x19, 0x33bf); + mdio_write(tp, 0x15, 0x03cf); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03d0); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03d1); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03d5); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03d6); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03d7); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03d8); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03d9); + mdio_write(tp, 0x19, 0x49bb); + mdio_write(tp, 0x15, 0x03da); + mdio_write(tp, 0x19, 0x4478); + mdio_write(tp, 0x15, 0x03db); + mdio_write(tp, 0x19, 0x492b); + mdio_write(tp, 0x15, 0x03dc); + mdio_write(tp, 0x19, 0x7c01); + mdio_write(tp, 0x15, 0x03dd); + mdio_write(tp, 0x19, 0x4c00); + mdio_write(tp, 0x15, 0x03de); + mdio_write(tp, 0x19, 0xbd1a); + mdio_write(tp, 0x15, 0x03df); + mdio_write(tp, 0x19, 0xc428); + mdio_write(tp, 0x15, 0x03e0); + mdio_write(tp, 0x19, 0x0008); + mdio_write(tp, 0x15, 0x03e1); + mdio_write(tp, 0x19, 0x9cfd); + mdio_write(tp, 0x15, 0x03e2); + mdio_write(tp, 0x19, 0x7c12); + mdio_write(tp, 0x15, 0x03e3); + mdio_write(tp, 0x19, 0x4c52); + mdio_write(tp, 0x15, 0x03e4); + mdio_write(tp, 0x19, 0x4458); + mdio_write(tp, 0x15, 0x03e5); + mdio_write(tp, 0x19, 0x7c12); + mdio_write(tp, 0x15, 0x03e6); + mdio_write(tp, 0x19, 0x4c40); + mdio_write(tp, 0x15, 0x03e7); + mdio_write(tp, 0x19, 0x33de); + mdio_write(tp, 0x15, 0x03e8); + mdio_write(tp, 0x19, 0xc218); + mdio_write(tp, 0x15, 0x03e9); + mdio_write(tp, 0x19, 0x0002); + mdio_write(tp, 0x15, 0x03ea); + mdio_write(tp, 0x19, 0x32df); + mdio_write(tp, 0x15, 0x03eb); + mdio_write(tp, 0x19, 0x3316); + mdio_write(tp, 0x15, 0x03ec); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03ed); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03ee); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03ef); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03f7); + mdio_write(tp, 0x19, 0x330c); + mdio_write(tp, 0x16, 0x0306); + mdio_write(tp, 0x16, 0x0300); + + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x05, 0xfff6); + mdio_write(tp, 0x06, 0x0080); + mdio_write(tp, 0x05, 0x8000); + mdio_write(tp, 0x06, 0x0280); + mdio_write(tp, 0x06, 0x48f7); + mdio_write(tp, 0x06, 0x00e0); + mdio_write(tp, 0x06, 0xfff7); + mdio_write(tp, 0x06, 0xa080); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0xf602); + mdio_write(tp, 0x06, 0x0200); + mdio_write(tp, 0x06, 0x0280); + mdio_write(tp, 0x06, 0x9002); + mdio_write(tp, 0x06, 0x0224); + mdio_write(tp, 0x06, 0x0202); + mdio_write(tp, 0x06, 0x3402); + mdio_write(tp, 0x06, 0x027f); + mdio_write(tp, 0x06, 0x0280); + mdio_write(tp, 0x06, 0xa602); + mdio_write(tp, 0x06, 0x80bf); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x88e1); + mdio_write(tp, 0x06, 0x8b89); + mdio_write(tp, 0x06, 0x1e01); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x8a1e); + mdio_write(tp, 0x06, 0x01e1); + mdio_write(tp, 0x06, 0x8b8b); + mdio_write(tp, 0x06, 0x1e01); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x8c1e); + mdio_write(tp, 0x06, 0x01e1); + mdio_write(tp, 0x06, 0x8b8d); + mdio_write(tp, 0x06, 0x1e01); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x8e1e); + mdio_write(tp, 0x06, 0x01a0); + mdio_write(tp, 0x06, 0x00c7); + mdio_write(tp, 0x06, 0xaebb); + mdio_write(tp, 0x06, 0xee8a); + mdio_write(tp, 0x06, 0xe600); + mdio_write(tp, 0x06, 0xee8a); + mdio_write(tp, 0x06, 0xee03); + mdio_write(tp, 0x06, 0xee8a); + mdio_write(tp, 0x06, 0xefb8); + mdio_write(tp, 0x06, 0xee8a); + mdio_write(tp, 0x06, 0xe902); + mdio_write(tp, 0x06, 0xee8b); + mdio_write(tp, 0x06, 0x8285); + mdio_write(tp, 0x06, 0xee8b); + mdio_write(tp, 0x06, 0x8520); + mdio_write(tp, 0x06, 0xee8b); + mdio_write(tp, 0x06, 0x8701); + mdio_write(tp, 0x06, 0xd481); + mdio_write(tp, 0x06, 0x35e4); + mdio_write(tp, 0x06, 0x8b94); + mdio_write(tp, 0x06, 0xe58b); + mdio_write(tp, 0x06, 0x95bf); + mdio_write(tp, 0x06, 0x8b88); + mdio_write(tp, 0x06, 0xec00); + mdio_write(tp, 0x06, 0x19a9); + mdio_write(tp, 0x06, 0x8b90); + mdio_write(tp, 0x06, 0xf9ee); + mdio_write(tp, 0x06, 0xfff6); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0xfff7); + mdio_write(tp, 0x06, 0xffe0); + mdio_write(tp, 0x06, 0xe140); + mdio_write(tp, 0x06, 0xe1e1); + mdio_write(tp, 0x06, 0x41f7); + mdio_write(tp, 0x06, 0x2ff6); + mdio_write(tp, 0x06, 0x28e4); + mdio_write(tp, 0x06, 0xe140); + mdio_write(tp, 0x06, 0xe5e1); + mdio_write(tp, 0x06, 0x4104); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0x8b89); + mdio_write(tp, 0x06, 0xad20); + mdio_write(tp, 0x06, 0x0dee); + mdio_write(tp, 0x06, 0x8b89); + mdio_write(tp, 0x06, 0x0002); + mdio_write(tp, 0x06, 0x82f4); + mdio_write(tp, 0x06, 0x021f); + mdio_write(tp, 0x06, 0x4102); + mdio_write(tp, 0x06, 0x2812); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0x8b8d); + mdio_write(tp, 0x06, 0xad20); + mdio_write(tp, 0x06, 0x10ee); + mdio_write(tp, 0x06, 0x8b8d); + mdio_write(tp, 0x06, 0x0002); + mdio_write(tp, 0x06, 0x139d); + mdio_write(tp, 0x06, 0x0281); + mdio_write(tp, 0x06, 0xd602); + mdio_write(tp, 0x06, 0x1f99); + mdio_write(tp, 0x06, 0x0227); + mdio_write(tp, 0x06, 0xeafc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x8ead); + mdio_write(tp, 0x06, 0x2014); + mdio_write(tp, 0x06, 0xf620); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x8e02); + mdio_write(tp, 0x06, 0x8104); + mdio_write(tp, 0x06, 0x021b); + mdio_write(tp, 0x06, 0xf402); + mdio_write(tp, 0x06, 0x2c9c); + mdio_write(tp, 0x06, 0x0281); + mdio_write(tp, 0x06, 0x7902); + mdio_write(tp, 0x06, 0x8443); + mdio_write(tp, 0x06, 0xad22); + mdio_write(tp, 0x06, 0x11f6); + mdio_write(tp, 0x06, 0x22e4); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0x022c); + mdio_write(tp, 0x06, 0x4602); + mdio_write(tp, 0x06, 0x2ac5); + mdio_write(tp, 0x06, 0x0229); + mdio_write(tp, 0x06, 0x2002); + mdio_write(tp, 0x06, 0x2b91); + mdio_write(tp, 0x06, 0xad25); + mdio_write(tp, 0x06, 0x11f6); + mdio_write(tp, 0x06, 0x25e4); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0x0284); + mdio_write(tp, 0x06, 0xe202); + mdio_write(tp, 0x06, 0x043a); + mdio_write(tp, 0x06, 0x021a); + mdio_write(tp, 0x06, 0x5902); + mdio_write(tp, 0x06, 0x2bfc); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8fa); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x00e1); + mdio_write(tp, 0x06, 0xe001); + mdio_write(tp, 0x06, 0xad27); + mdio_write(tp, 0x06, 0x1fd1); + mdio_write(tp, 0x06, 0x01bf); + mdio_write(tp, 0x06, 0x8638); + mdio_write(tp, 0x06, 0x022f); + mdio_write(tp, 0x06, 0x50e0); + mdio_write(tp, 0x06, 0xe020); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0x21ad); + mdio_write(tp, 0x06, 0x200e); + mdio_write(tp, 0x06, 0xd100); + mdio_write(tp, 0x06, 0xbf86); + mdio_write(tp, 0x06, 0x3802); + mdio_write(tp, 0x06, 0x2f50); + mdio_write(tp, 0x06, 0xbf3d); + mdio_write(tp, 0x06, 0x3902); + mdio_write(tp, 0x06, 0x2eb0); + mdio_write(tp, 0x06, 0xef96); + mdio_write(tp, 0x06, 0xfefc); + mdio_write(tp, 0x06, 0x0402); + mdio_write(tp, 0x06, 0x8591); + mdio_write(tp, 0x06, 0x0281); + mdio_write(tp, 0x06, 0x3c05); + mdio_write(tp, 0x06, 0xf8fa); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0xe0e2); + mdio_write(tp, 0x06, 0xfee1); + mdio_write(tp, 0x06, 0xe2ff); + mdio_write(tp, 0x06, 0xad2d); + mdio_write(tp, 0x06, 0x1ae0); + mdio_write(tp, 0x06, 0xe14e); + mdio_write(tp, 0x06, 0xe1e1); + mdio_write(tp, 0x06, 0x4fac); + mdio_write(tp, 0x06, 0x2d22); + mdio_write(tp, 0x06, 0xf603); + mdio_write(tp, 0x06, 0x0203); + mdio_write(tp, 0x06, 0x36f7); + mdio_write(tp, 0x06, 0x03f7); + mdio_write(tp, 0x06, 0x06bf); + mdio_write(tp, 0x06, 0x8622); + mdio_write(tp, 0x06, 0x022e); + mdio_write(tp, 0x06, 0xb0ae); + mdio_write(tp, 0x06, 0x11e0); + mdio_write(tp, 0x06, 0xe14e); + mdio_write(tp, 0x06, 0xe1e1); + mdio_write(tp, 0x06, 0x4fad); + mdio_write(tp, 0x06, 0x2d08); + mdio_write(tp, 0x06, 0xbf86); + mdio_write(tp, 0x06, 0x2d02); + mdio_write(tp, 0x06, 0x2eb0); + mdio_write(tp, 0x06, 0xf606); + mdio_write(tp, 0x06, 0xef96); + mdio_write(tp, 0x06, 0xfefc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xf9fa); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x87ad); + mdio_write(tp, 0x06, 0x204c); + mdio_write(tp, 0x06, 0xd200); + mdio_write(tp, 0x06, 0xe0e2); + mdio_write(tp, 0x06, 0x0058); + mdio_write(tp, 0x06, 0x010c); + mdio_write(tp, 0x06, 0x021e); + mdio_write(tp, 0x06, 0x20e0); + mdio_write(tp, 0x06, 0xe000); + mdio_write(tp, 0x06, 0x5810); + mdio_write(tp, 0x06, 0x1e20); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x3658); + mdio_write(tp, 0x06, 0x031e); + mdio_write(tp, 0x06, 0x20e0); + mdio_write(tp, 0x06, 0xe022); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0x2358); + mdio_write(tp, 0x06, 0xe01e); + mdio_write(tp, 0x06, 0x20e0); + mdio_write(tp, 0x06, 0x8ae6); + mdio_write(tp, 0x06, 0x1f02); + mdio_write(tp, 0x06, 0x9e22); + mdio_write(tp, 0x06, 0xe68a); + mdio_write(tp, 0x06, 0xe6ad); + mdio_write(tp, 0x06, 0x3214); + mdio_write(tp, 0x06, 0xad34); + mdio_write(tp, 0x06, 0x11ef); + mdio_write(tp, 0x06, 0x0258); + mdio_write(tp, 0x06, 0x039e); + mdio_write(tp, 0x06, 0x07ad); + mdio_write(tp, 0x06, 0x3508); + mdio_write(tp, 0x06, 0x5ac0); + mdio_write(tp, 0x06, 0x9f04); + mdio_write(tp, 0x06, 0xd101); + mdio_write(tp, 0x06, 0xae02); + mdio_write(tp, 0x06, 0xd100); + mdio_write(tp, 0x06, 0xbf86); + mdio_write(tp, 0x06, 0x3e02); + mdio_write(tp, 0x06, 0x2f50); + mdio_write(tp, 0x06, 0xef96); + mdio_write(tp, 0x06, 0xfefd); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8f9); + mdio_write(tp, 0x06, 0xfae0); + mdio_write(tp, 0x06, 0x8b81); + mdio_write(tp, 0x06, 0xac26); + mdio_write(tp, 0x06, 0x0ee0); + mdio_write(tp, 0x06, 0x8b81); + mdio_write(tp, 0x06, 0xac21); + mdio_write(tp, 0x06, 0x08e0); + mdio_write(tp, 0x06, 0x8b87); + mdio_write(tp, 0x06, 0xac24); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0x6bee); + mdio_write(tp, 0x06, 0xe0ea); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0xe0eb); + mdio_write(tp, 0x06, 0x00e2); + mdio_write(tp, 0x06, 0xe07c); + mdio_write(tp, 0x06, 0xe3e0); + mdio_write(tp, 0x06, 0x7da5); + mdio_write(tp, 0x06, 0x1111); + mdio_write(tp, 0x06, 0x15d2); + mdio_write(tp, 0x06, 0x60d6); + mdio_write(tp, 0x06, 0x6666); + mdio_write(tp, 0x06, 0x0207); + mdio_write(tp, 0x06, 0xf9d2); + mdio_write(tp, 0x06, 0xa0d6); + mdio_write(tp, 0x06, 0xaaaa); + mdio_write(tp, 0x06, 0x0207); + mdio_write(tp, 0x06, 0xf902); + mdio_write(tp, 0x06, 0x825c); + mdio_write(tp, 0x06, 0xae44); + mdio_write(tp, 0x06, 0xa566); + mdio_write(tp, 0x06, 0x6602); + mdio_write(tp, 0x06, 0xae38); + mdio_write(tp, 0x06, 0xa5aa); + mdio_write(tp, 0x06, 0xaa02); + mdio_write(tp, 0x06, 0xae32); + mdio_write(tp, 0x06, 0xeee0); + mdio_write(tp, 0x06, 0xea04); + mdio_write(tp, 0x06, 0xeee0); + mdio_write(tp, 0x06, 0xeb06); + mdio_write(tp, 0x06, 0xe2e0); + mdio_write(tp, 0x06, 0x7ce3); + mdio_write(tp, 0x06, 0xe07d); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x38e1); + mdio_write(tp, 0x06, 0xe039); + mdio_write(tp, 0x06, 0xad2e); + mdio_write(tp, 0x06, 0x21ad); + mdio_write(tp, 0x06, 0x3f13); + mdio_write(tp, 0x06, 0xe0e4); + mdio_write(tp, 0x06, 0x14e1); + mdio_write(tp, 0x06, 0xe415); + mdio_write(tp, 0x06, 0x6880); + mdio_write(tp, 0x06, 0xe4e4); + mdio_write(tp, 0x06, 0x14e5); + mdio_write(tp, 0x06, 0xe415); + mdio_write(tp, 0x06, 0x0282); + mdio_write(tp, 0x06, 0x5cae); + mdio_write(tp, 0x06, 0x0bac); + mdio_write(tp, 0x06, 0x3e02); + mdio_write(tp, 0x06, 0xae06); + mdio_write(tp, 0x06, 0x0282); + mdio_write(tp, 0x06, 0x8602); + mdio_write(tp, 0x06, 0x82b0); + mdio_write(tp, 0x06, 0xfefd); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8e1); + mdio_write(tp, 0x06, 0x8b2e); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x81ad); + mdio_write(tp, 0x06, 0x2605); + mdio_write(tp, 0x06, 0x0221); + mdio_write(tp, 0x06, 0xf3f7); + mdio_write(tp, 0x06, 0x28e0); + mdio_write(tp, 0x06, 0x8b81); + mdio_write(tp, 0x06, 0xad21); + mdio_write(tp, 0x06, 0x0502); + mdio_write(tp, 0x06, 0x22f8); + mdio_write(tp, 0x06, 0xf729); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x87ad); + mdio_write(tp, 0x06, 0x2405); + mdio_write(tp, 0x06, 0x0282); + mdio_write(tp, 0x06, 0xebf7); + mdio_write(tp, 0x06, 0x2ae5); + mdio_write(tp, 0x06, 0x8b2e); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0x8b81); + mdio_write(tp, 0x06, 0xad26); + mdio_write(tp, 0x06, 0x0302); + mdio_write(tp, 0x06, 0x2134); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x81ad); + mdio_write(tp, 0x06, 0x2109); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x2eac); + mdio_write(tp, 0x06, 0x2003); + mdio_write(tp, 0x06, 0x0283); + mdio_write(tp, 0x06, 0x52e0); + mdio_write(tp, 0x06, 0x8b87); + mdio_write(tp, 0x06, 0xad24); + mdio_write(tp, 0x06, 0x09e0); + mdio_write(tp, 0x06, 0x8b2e); + mdio_write(tp, 0x06, 0xac21); + mdio_write(tp, 0x06, 0x0302); + mdio_write(tp, 0x06, 0x8337); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8e1); + mdio_write(tp, 0x06, 0x8b2e); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x81ad); + mdio_write(tp, 0x06, 0x2608); + mdio_write(tp, 0x06, 0xe085); + mdio_write(tp, 0x06, 0xd2ad); + mdio_write(tp, 0x06, 0x2502); + mdio_write(tp, 0x06, 0xf628); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x81ad); + mdio_write(tp, 0x06, 0x210a); + mdio_write(tp, 0x06, 0xe086); + mdio_write(tp, 0x06, 0x0af6); + mdio_write(tp, 0x06, 0x27a0); + mdio_write(tp, 0x06, 0x0502); + mdio_write(tp, 0x06, 0xf629); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x87ad); + mdio_write(tp, 0x06, 0x2408); + mdio_write(tp, 0x06, 0xe08a); + mdio_write(tp, 0x06, 0xedad); + mdio_write(tp, 0x06, 0x2002); + mdio_write(tp, 0x06, 0xf62a); + mdio_write(tp, 0x06, 0xe58b); + mdio_write(tp, 0x06, 0x2ea1); + mdio_write(tp, 0x06, 0x0003); + mdio_write(tp, 0x06, 0x0221); + mdio_write(tp, 0x06, 0x11fc); + mdio_write(tp, 0x06, 0x04ee); + mdio_write(tp, 0x06, 0x8aed); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0x8aec); + mdio_write(tp, 0x06, 0x0004); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0x8b87); + mdio_write(tp, 0x06, 0xad24); + mdio_write(tp, 0x06, 0x3ae0); + mdio_write(tp, 0x06, 0xe0ea); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0xeb58); + mdio_write(tp, 0x06, 0xf8d1); + mdio_write(tp, 0x06, 0x01e4); + mdio_write(tp, 0x06, 0xe0ea); + mdio_write(tp, 0x06, 0xe5e0); + mdio_write(tp, 0x06, 0xebe0); + mdio_write(tp, 0x06, 0xe07c); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0x7d5c); + mdio_write(tp, 0x06, 0x00ff); + mdio_write(tp, 0x06, 0x3c00); + mdio_write(tp, 0x06, 0x1eab); + mdio_write(tp, 0x06, 0x1ce0); + mdio_write(tp, 0x06, 0xe04c); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0x4d58); + mdio_write(tp, 0x06, 0xc1e4); + mdio_write(tp, 0x06, 0xe04c); + mdio_write(tp, 0x06, 0xe5e0); + mdio_write(tp, 0x06, 0x4de0); + mdio_write(tp, 0x06, 0xe0ee); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0x3ce4); + mdio_write(tp, 0x06, 0xe0ee); + mdio_write(tp, 0x06, 0xe5e0); + mdio_write(tp, 0x06, 0xeffc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x87ad); + mdio_write(tp, 0x06, 0x2412); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0xeee1); + mdio_write(tp, 0x06, 0xe0ef); + mdio_write(tp, 0x06, 0x59c3); + mdio_write(tp, 0x06, 0xe4e0); + mdio_write(tp, 0x06, 0xeee5); + mdio_write(tp, 0x06, 0xe0ef); + mdio_write(tp, 0x06, 0xee8a); + mdio_write(tp, 0x06, 0xed01); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0x8b81); + mdio_write(tp, 0x06, 0xac25); + mdio_write(tp, 0x06, 0x0502); + mdio_write(tp, 0x06, 0x8363); + mdio_write(tp, 0x06, 0xae03); + mdio_write(tp, 0x06, 0x0225); + mdio_write(tp, 0x06, 0x16fc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xf9fa); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0xfae0); + mdio_write(tp, 0x06, 0x860a); + mdio_write(tp, 0x06, 0xa000); + mdio_write(tp, 0x06, 0x19e0); + mdio_write(tp, 0x06, 0x860b); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x331b); + mdio_write(tp, 0x06, 0x109e); + mdio_write(tp, 0x06, 0x04aa); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0x06ee); + mdio_write(tp, 0x06, 0x860a); + mdio_write(tp, 0x06, 0x01ae); + mdio_write(tp, 0x06, 0xe602); + mdio_write(tp, 0x06, 0x241e); + mdio_write(tp, 0x06, 0xae14); + mdio_write(tp, 0x06, 0xa001); + mdio_write(tp, 0x06, 0x1402); + mdio_write(tp, 0x06, 0x2426); + mdio_write(tp, 0x06, 0xbf26); + mdio_write(tp, 0x06, 0x6d02); + mdio_write(tp, 0x06, 0x2eb0); + mdio_write(tp, 0x06, 0xee86); + mdio_write(tp, 0x06, 0x0b00); + mdio_write(tp, 0x06, 0xee86); + mdio_write(tp, 0x06, 0x0a02); + mdio_write(tp, 0x06, 0xaf84); + mdio_write(tp, 0x06, 0x3ca0); + mdio_write(tp, 0x06, 0x0252); + mdio_write(tp, 0x06, 0xee86); + mdio_write(tp, 0x06, 0x0400); + mdio_write(tp, 0x06, 0xee86); + mdio_write(tp, 0x06, 0x0500); + mdio_write(tp, 0x06, 0xe086); + mdio_write(tp, 0x06, 0x0be1); + mdio_write(tp, 0x06, 0x8b32); + mdio_write(tp, 0x06, 0x1b10); + mdio_write(tp, 0x06, 0x9e04); + mdio_write(tp, 0x06, 0xaa02); + mdio_write(tp, 0x06, 0xaecb); + mdio_write(tp, 0x06, 0xee86); + mdio_write(tp, 0x06, 0x0b00); + mdio_write(tp, 0x06, 0x0224); + mdio_write(tp, 0x06, 0x3ae2); + mdio_write(tp, 0x06, 0x8604); + mdio_write(tp, 0x06, 0xe386); + mdio_write(tp, 0x06, 0x05ef); + mdio_write(tp, 0x06, 0x65e2); + mdio_write(tp, 0x06, 0x8606); + mdio_write(tp, 0x06, 0xe386); + mdio_write(tp, 0x06, 0x071b); + mdio_write(tp, 0x06, 0x56aa); + mdio_write(tp, 0x06, 0x0eef); + mdio_write(tp, 0x06, 0x56e6); + mdio_write(tp, 0x06, 0x8606); + mdio_write(tp, 0x06, 0xe786); + mdio_write(tp, 0x06, 0x07e2); + mdio_write(tp, 0x06, 0x8609); + mdio_write(tp, 0x06, 0xe686); + mdio_write(tp, 0x06, 0x08e0); + mdio_write(tp, 0x06, 0x8609); + mdio_write(tp, 0x06, 0xa000); + mdio_write(tp, 0x06, 0x07ee); + mdio_write(tp, 0x06, 0x860a); + mdio_write(tp, 0x06, 0x03af); + mdio_write(tp, 0x06, 0x8369); + mdio_write(tp, 0x06, 0x0224); + mdio_write(tp, 0x06, 0x8e02); + mdio_write(tp, 0x06, 0x2426); + mdio_write(tp, 0x06, 0xae48); + mdio_write(tp, 0x06, 0xa003); + mdio_write(tp, 0x06, 0x21e0); + mdio_write(tp, 0x06, 0x8608); + mdio_write(tp, 0x06, 0xe186); + mdio_write(tp, 0x06, 0x091b); + mdio_write(tp, 0x06, 0x019e); + mdio_write(tp, 0x06, 0x0caa); + mdio_write(tp, 0x06, 0x0502); + mdio_write(tp, 0x06, 0x249d); + mdio_write(tp, 0x06, 0xaee7); + mdio_write(tp, 0x06, 0x0224); + mdio_write(tp, 0x06, 0x8eae); + mdio_write(tp, 0x06, 0xe2ee); + mdio_write(tp, 0x06, 0x860a); + mdio_write(tp, 0x06, 0x04ee); + mdio_write(tp, 0x06, 0x860b); + mdio_write(tp, 0x06, 0x00af); + mdio_write(tp, 0x06, 0x8369); + mdio_write(tp, 0x06, 0xa004); + mdio_write(tp, 0x06, 0x15e0); + mdio_write(tp, 0x06, 0x860b); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x341b); + mdio_write(tp, 0x06, 0x109e); + mdio_write(tp, 0x06, 0x05aa); + mdio_write(tp, 0x06, 0x03af); + mdio_write(tp, 0x06, 0x8383); + mdio_write(tp, 0x06, 0xee86); + mdio_write(tp, 0x06, 0x0a05); + mdio_write(tp, 0x06, 0xae0c); + mdio_write(tp, 0x06, 0xa005); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0x0702); + mdio_write(tp, 0x06, 0x2309); + mdio_write(tp, 0x06, 0xee86); + mdio_write(tp, 0x06, 0x0a00); + mdio_write(tp, 0x06, 0xfeef); + mdio_write(tp, 0x06, 0x96fe); + mdio_write(tp, 0x06, 0xfdfc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xf9fa); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0xfbe0); + mdio_write(tp, 0x06, 0x8b85); + mdio_write(tp, 0x06, 0xad25); + mdio_write(tp, 0x06, 0x22e0); + mdio_write(tp, 0x06, 0xe022); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0x23e2); + mdio_write(tp, 0x06, 0xe036); + mdio_write(tp, 0x06, 0xe3e0); + mdio_write(tp, 0x06, 0x375a); + mdio_write(tp, 0x06, 0xc40d); + mdio_write(tp, 0x06, 0x0158); + mdio_write(tp, 0x06, 0x021e); + mdio_write(tp, 0x06, 0x20e3); + mdio_write(tp, 0x06, 0x8ae7); + mdio_write(tp, 0x06, 0xac31); + mdio_write(tp, 0x06, 0x60ac); + mdio_write(tp, 0x06, 0x3a08); + mdio_write(tp, 0x06, 0xac3e); + mdio_write(tp, 0x06, 0x26ae); + mdio_write(tp, 0x06, 0x67af); + mdio_write(tp, 0x06, 0x84db); + mdio_write(tp, 0x06, 0xad37); + mdio_write(tp, 0x06, 0x61e0); + mdio_write(tp, 0x06, 0x8ae8); + mdio_write(tp, 0x06, 0x10e4); + mdio_write(tp, 0x06, 0x8ae8); + mdio_write(tp, 0x06, 0xe18a); + mdio_write(tp, 0x06, 0xe91b); + mdio_write(tp, 0x06, 0x109e); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0x51d1); + mdio_write(tp, 0x06, 0x00bf); + mdio_write(tp, 0x06, 0x863b); + mdio_write(tp, 0x06, 0x022f); + mdio_write(tp, 0x06, 0x50ee); + mdio_write(tp, 0x06, 0x8ae8); + mdio_write(tp, 0x06, 0x00ae); + mdio_write(tp, 0x06, 0x43ad); + mdio_write(tp, 0x06, 0x3627); + mdio_write(tp, 0x06, 0xe08a); + mdio_write(tp, 0x06, 0xeee1); + mdio_write(tp, 0x06, 0x8aef); + mdio_write(tp, 0x06, 0xef74); + mdio_write(tp, 0x06, 0xe08a); + mdio_write(tp, 0x06, 0xeae1); + mdio_write(tp, 0x06, 0x8aeb); + mdio_write(tp, 0x06, 0x1b74); + mdio_write(tp, 0x06, 0x9e2e); + mdio_write(tp, 0x06, 0x14e4); + mdio_write(tp, 0x06, 0x8aea); + mdio_write(tp, 0x06, 0xe58a); + mdio_write(tp, 0x06, 0xebef); + mdio_write(tp, 0x06, 0x74e0); + mdio_write(tp, 0x06, 0x8aee); + mdio_write(tp, 0x06, 0xe18a); + mdio_write(tp, 0x06, 0xef1b); + mdio_write(tp, 0x06, 0x479e); + mdio_write(tp, 0x06, 0x0fae); + mdio_write(tp, 0x06, 0x19ee); + mdio_write(tp, 0x06, 0x8aea); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0x8aeb); + mdio_write(tp, 0x06, 0x00ae); + mdio_write(tp, 0x06, 0x0fac); + mdio_write(tp, 0x06, 0x390c); + mdio_write(tp, 0x06, 0xd101); + mdio_write(tp, 0x06, 0xbf86); + mdio_write(tp, 0x06, 0x3b02); + mdio_write(tp, 0x06, 0x2f50); + mdio_write(tp, 0x06, 0xee8a); + mdio_write(tp, 0x06, 0xe800); + mdio_write(tp, 0x06, 0xe68a); + mdio_write(tp, 0x06, 0xe7ff); + mdio_write(tp, 0x06, 0xef96); + mdio_write(tp, 0x06, 0xfefd); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8f9); + mdio_write(tp, 0x06, 0xfaef); + mdio_write(tp, 0x06, 0x69e0); + mdio_write(tp, 0x06, 0xe022); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0x2358); + mdio_write(tp, 0x06, 0xc4e1); + mdio_write(tp, 0x06, 0x8b6e); + mdio_write(tp, 0x06, 0x1f10); + mdio_write(tp, 0x06, 0x9e24); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x6ead); + mdio_write(tp, 0x06, 0x2218); + mdio_write(tp, 0x06, 0xac27); + mdio_write(tp, 0x06, 0x0dac); + mdio_write(tp, 0x06, 0x2605); + mdio_write(tp, 0x06, 0x0203); + mdio_write(tp, 0x06, 0x8fae); + mdio_write(tp, 0x06, 0x1302); + mdio_write(tp, 0x06, 0x03c8); + mdio_write(tp, 0x06, 0xae0e); + mdio_write(tp, 0x06, 0x0203); + mdio_write(tp, 0x06, 0xe102); + mdio_write(tp, 0x06, 0x8520); + mdio_write(tp, 0x06, 0xae06); + mdio_write(tp, 0x06, 0x0203); + mdio_write(tp, 0x06, 0x8f02); + mdio_write(tp, 0x06, 0x8566); + mdio_write(tp, 0x06, 0xef96); + mdio_write(tp, 0x06, 0xfefd); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8fa); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x82ad); + mdio_write(tp, 0x06, 0x2737); + mdio_write(tp, 0x06, 0xbf86); + mdio_write(tp, 0x06, 0x4402); + mdio_write(tp, 0x06, 0x2f23); + mdio_write(tp, 0x06, 0xac28); + mdio_write(tp, 0x06, 0x2ed1); + mdio_write(tp, 0x06, 0x01bf); + mdio_write(tp, 0x06, 0x8647); + mdio_write(tp, 0x06, 0x022f); + mdio_write(tp, 0x06, 0x50bf); + mdio_write(tp, 0x06, 0x8641); + mdio_write(tp, 0x06, 0x022f); + mdio_write(tp, 0x06, 0x23e5); + mdio_write(tp, 0x06, 0x8af0); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x22e1); + mdio_write(tp, 0x06, 0xe023); + mdio_write(tp, 0x06, 0xac2e); + mdio_write(tp, 0x06, 0x04d1); + mdio_write(tp, 0x06, 0x01ae); + mdio_write(tp, 0x06, 0x02d1); + mdio_write(tp, 0x06, 0x00bf); + mdio_write(tp, 0x06, 0x8641); + mdio_write(tp, 0x06, 0x022f); + mdio_write(tp, 0x06, 0x50d1); + mdio_write(tp, 0x06, 0x01bf); + mdio_write(tp, 0x06, 0x8644); + mdio_write(tp, 0x06, 0x022f); + mdio_write(tp, 0x06, 0x50ef); + mdio_write(tp, 0x06, 0x96fe); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8fa); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0xbf86); + mdio_write(tp, 0x06, 0x4702); + mdio_write(tp, 0x06, 0x2f23); + mdio_write(tp, 0x06, 0xad28); + mdio_write(tp, 0x06, 0x19d1); + mdio_write(tp, 0x06, 0x00bf); + mdio_write(tp, 0x06, 0x8644); + mdio_write(tp, 0x06, 0x022f); + mdio_write(tp, 0x06, 0x50e1); + mdio_write(tp, 0x06, 0x8af0); + mdio_write(tp, 0x06, 0xbf86); + mdio_write(tp, 0x06, 0x4102); + mdio_write(tp, 0x06, 0x2f50); + mdio_write(tp, 0x06, 0xd100); + mdio_write(tp, 0x06, 0xbf86); + mdio_write(tp, 0x06, 0x4702); + mdio_write(tp, 0x06, 0x2f50); + mdio_write(tp, 0x06, 0xef96); + mdio_write(tp, 0x06, 0xfefc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xe0e2); + mdio_write(tp, 0x06, 0xfee1); + mdio_write(tp, 0x06, 0xe2ff); + mdio_write(tp, 0x06, 0xad2e); + mdio_write(tp, 0x06, 0x63e0); + mdio_write(tp, 0x06, 0xe038); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0x39ad); + mdio_write(tp, 0x06, 0x2f10); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x34e1); + mdio_write(tp, 0x06, 0xe035); + mdio_write(tp, 0x06, 0xf726); + mdio_write(tp, 0x06, 0xe4e0); + mdio_write(tp, 0x06, 0x34e5); + mdio_write(tp, 0x06, 0xe035); + mdio_write(tp, 0x06, 0xae0e); + mdio_write(tp, 0x06, 0xe0e2); + mdio_write(tp, 0x06, 0xd6e1); + mdio_write(tp, 0x06, 0xe2d7); + mdio_write(tp, 0x06, 0xf728); + mdio_write(tp, 0x06, 0xe4e2); + mdio_write(tp, 0x06, 0xd6e5); + mdio_write(tp, 0x06, 0xe2d7); + mdio_write(tp, 0x06, 0xe0e2); + mdio_write(tp, 0x06, 0x34e1); + mdio_write(tp, 0x06, 0xe235); + mdio_write(tp, 0x06, 0xf72b); + mdio_write(tp, 0x06, 0xe4e2); + mdio_write(tp, 0x06, 0x34e5); + mdio_write(tp, 0x06, 0xe235); + mdio_write(tp, 0x06, 0xd07d); + mdio_write(tp, 0x06, 0xb0fe); + mdio_write(tp, 0x06, 0xe0e2); + mdio_write(tp, 0x06, 0x34e1); + mdio_write(tp, 0x06, 0xe235); + mdio_write(tp, 0x06, 0xf62b); + mdio_write(tp, 0x06, 0xe4e2); + mdio_write(tp, 0x06, 0x34e5); + mdio_write(tp, 0x06, 0xe235); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x34e1); + mdio_write(tp, 0x06, 0xe035); + mdio_write(tp, 0x06, 0xf626); + mdio_write(tp, 0x06, 0xe4e0); + mdio_write(tp, 0x06, 0x34e5); + mdio_write(tp, 0x06, 0xe035); + mdio_write(tp, 0x06, 0xe0e2); + mdio_write(tp, 0x06, 0xd6e1); + mdio_write(tp, 0x06, 0xe2d7); + mdio_write(tp, 0x06, 0xf628); + mdio_write(tp, 0x06, 0xe4e2); + mdio_write(tp, 0x06, 0xd6e5); + mdio_write(tp, 0x06, 0xe2d7); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xae20); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0xa725); + mdio_write(tp, 0x06, 0xe50a); + mdio_write(tp, 0x06, 0x1de5); + mdio_write(tp, 0x06, 0x0a2c); + mdio_write(tp, 0x06, 0xe50a); + mdio_write(tp, 0x06, 0x6de5); + mdio_write(tp, 0x06, 0x0a1d); + mdio_write(tp, 0x06, 0xe50a); + mdio_write(tp, 0x06, 0x1ce5); + mdio_write(tp, 0x06, 0x0a2d); + mdio_write(tp, 0x06, 0xa755); + mdio_write(tp, 0x06, 0x00e2); + mdio_write(tp, 0x06, 0x3488); + mdio_write(tp, 0x06, 0xe200); + mdio_write(tp, 0x06, 0xcce2); + mdio_write(tp, 0x06, 0x0055); + mdio_write(tp, 0x06, 0xe020); + mdio_write(tp, 0x06, 0x55e2); + mdio_write(tp, 0x06, 0xd600); + mdio_write(tp, 0x06, 0xe24a); + gphy_val = mdio_read(tp, 0x01); + gphy_val |= BIT_0; + mdio_write(tp, 0x01, gphy_val); + gphy_val = mdio_read(tp, 0x00); + gphy_val |= BIT_0; + mdio_write(tp, 0x00, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + + mdio_write(tp, 0x1f, 0x0005); + for (i = 0; i < 200; i++) { + udelay(100); + gphy_val = mdio_read(tp, 0x00); + if (gphy_val & BIT_7) + break; + } + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0023); + gphy_val = mdio_read(tp, 0x17); + gphy_val &= ~(BIT_0); + if (tp->RequiredSecLanDonglePatch) + gphy_val &= ~(BIT_2); + mdio_write(tp, 0x17, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + } +} + +static void +rtl8168_set_phy_mcu_8168evl_1(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + unsigned int gphy_val,i; + + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x00, 0x1800); + gphy_val = mdio_read(tp, 0x15); + gphy_val &= ~(BIT_12); + mdio_write(tp, 0x15, gphy_val); + mdelay(20); + mdio_write(tp, 0x1f, 0x0004); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0023); + gphy_val = mdio_read(tp, 0x17); + if ((gphy_val & BIT_11) == 0x0000) { + gphy_val |= BIT_0; + mdio_write(tp, 0x17, gphy_val); + for (i = 0; i < 200; i++) { + udelay(100); + gphy_val = mdio_read(tp, 0x17); + if (gphy_val & BIT_11) + break; + } + } + gphy_val = mdio_read(tp, 0x17); + gphy_val |= BIT_0; + mdio_write(tp, 0x17, gphy_val); + mdio_write(tp, 0x1f, 0x0004); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1E, 0x002C); + mdio_write(tp, 0x1B, 0x5000); + mdio_write(tp, 0x1E, 0x002d); + mdio_write(tp, 0x19, 0x0004); + mdio_write(tp, 0x1f, 0x0002); + mdio_write(tp, 0x1f, 0x0000); + for (i = 0; i < 200; i++) { + udelay(100); + gphy_val = mdio_read(tp, 0x1E); + if ((gphy_val & 0x03FF) == 0x0014) + break; + } + mdio_write(tp, 0x1f, 0x0005); + for (i = 0; i < 200; i++) { + udelay(100); + gphy_val = mdio_read(tp, 0x07); + if ((gphy_val & BIT_5) == 0) + break; + } + gphy_val = mdio_read(tp, 0x07); + if (gphy_val & BIT_5) { + mdio_write(tp, 0x1f, 0x0004); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x00a1); + mdio_write(tp, 0x17, 0x1000); + mdio_write(tp, 0x17, 0x0000); + mdio_write(tp, 0x17, 0x2000); + mdio_write(tp, 0x1e, 0x002f); + mdio_write(tp, 0x18, 0x9bfb); + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x07, 0x0000); + mdio_write(tp, 0x1f, 0x0002); + mdio_write(tp, 0x1f, 0x0000); + } + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x05, 0xfff6); + mdio_write(tp, 0x06, 0x0080); + gphy_val = mdio_read(tp, 0x00); + gphy_val &= ~(BIT_7); + mdio_write(tp, 0x00, gphy_val); + mdio_write(tp, 0x1f, 0x0004); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0023); + mdio_write(tp, 0x16, 0x0306); + mdio_write(tp, 0x16, 0x0307); + mdio_write(tp, 0x15, 0x0000); + mdio_write(tp, 0x19, 0x407d); + mdio_write(tp, 0x15, 0x0001); + mdio_write(tp, 0x19, 0x440f); + mdio_write(tp, 0x15, 0x0002); + mdio_write(tp, 0x19, 0x7c03); + mdio_write(tp, 0x15, 0x0003); + mdio_write(tp, 0x19, 0x6c03); + mdio_write(tp, 0x15, 0x0004); + mdio_write(tp, 0x19, 0xc4d5); + mdio_write(tp, 0x15, 0x0005); + mdio_write(tp, 0x19, 0x00ff); + mdio_write(tp, 0x15, 0x0006); + mdio_write(tp, 0x19, 0x74f0); + mdio_write(tp, 0x15, 0x0007); + mdio_write(tp, 0x19, 0x4880); + mdio_write(tp, 0x15, 0x0008); + mdio_write(tp, 0x19, 0x4c00); + mdio_write(tp, 0x15, 0x0009); + mdio_write(tp, 0x19, 0x4800); + mdio_write(tp, 0x15, 0x000a); + mdio_write(tp, 0x19, 0x5000); + mdio_write(tp, 0x15, 0x000b); + mdio_write(tp, 0x19, 0x4400); + mdio_write(tp, 0x15, 0x000c); + mdio_write(tp, 0x19, 0x7801); + mdio_write(tp, 0x15, 0x000d); + mdio_write(tp, 0x19, 0x4000); + mdio_write(tp, 0x15, 0x000e); + mdio_write(tp, 0x19, 0x7800); + mdio_write(tp, 0x15, 0x000f); + mdio_write(tp, 0x19, 0x7010); + mdio_write(tp, 0x15, 0x0010); + mdio_write(tp, 0x19, 0x6804); + mdio_write(tp, 0x15, 0x0011); + mdio_write(tp, 0x19, 0x64a0); + mdio_write(tp, 0x15, 0x0012); + mdio_write(tp, 0x19, 0x63da); + mdio_write(tp, 0x15, 0x0013); + mdio_write(tp, 0x19, 0x63d8); + mdio_write(tp, 0x15, 0x0014); + mdio_write(tp, 0x19, 0x6f05); + mdio_write(tp, 0x15, 0x0015); + mdio_write(tp, 0x19, 0x5420); + mdio_write(tp, 0x15, 0x0016); + mdio_write(tp, 0x19, 0x58ce); + mdio_write(tp, 0x15, 0x0017); + mdio_write(tp, 0x19, 0x5cf3); + mdio_write(tp, 0x15, 0x0018); + mdio_write(tp, 0x19, 0xb600); + mdio_write(tp, 0x15, 0x0019); + mdio_write(tp, 0x19, 0xc659); + mdio_write(tp, 0x15, 0x001a); + mdio_write(tp, 0x19, 0x0018); + mdio_write(tp, 0x15, 0x001b); + mdio_write(tp, 0x19, 0xc403); + mdio_write(tp, 0x15, 0x001c); + mdio_write(tp, 0x19, 0x0016); + mdio_write(tp, 0x15, 0x001d); + mdio_write(tp, 0x19, 0xaa05); + mdio_write(tp, 0x15, 0x001e); + mdio_write(tp, 0x19, 0xc503); + mdio_write(tp, 0x15, 0x001f); + mdio_write(tp, 0x19, 0x0003); + mdio_write(tp, 0x15, 0x0020); + mdio_write(tp, 0x19, 0x89f8); + mdio_write(tp, 0x15, 0x0021); + mdio_write(tp, 0x19, 0x32ae); + mdio_write(tp, 0x15, 0x0022); + mdio_write(tp, 0x19, 0x7c03); + mdio_write(tp, 0x15, 0x0023); + mdio_write(tp, 0x19, 0x6c03); + mdio_write(tp, 0x15, 0x0024); + mdio_write(tp, 0x19, 0x7c03); + mdio_write(tp, 0x15, 0x0025); + mdio_write(tp, 0x19, 0x6801); + mdio_write(tp, 0x15, 0x0026); + mdio_write(tp, 0x19, 0x66a0); + mdio_write(tp, 0x15, 0x0027); + mdio_write(tp, 0x19, 0xa300); + mdio_write(tp, 0x15, 0x0028); + mdio_write(tp, 0x19, 0x64a0); + mdio_write(tp, 0x15, 0x0029); + mdio_write(tp, 0x19, 0x76f0); + mdio_write(tp, 0x15, 0x002a); + mdio_write(tp, 0x19, 0x7670); + mdio_write(tp, 0x15, 0x002b); + mdio_write(tp, 0x19, 0x7630); + mdio_write(tp, 0x15, 0x002c); + mdio_write(tp, 0x19, 0x31a6); + mdio_write(tp, 0x15, 0x002d); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x002e); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x002f); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0030); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0031); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0032); + mdio_write(tp, 0x19, 0x4801); + mdio_write(tp, 0x15, 0x0033); + mdio_write(tp, 0x19, 0x6803); + mdio_write(tp, 0x15, 0x0034); + mdio_write(tp, 0x19, 0x66a1); + mdio_write(tp, 0x15, 0x0035); + mdio_write(tp, 0x19, 0x7c03); + mdio_write(tp, 0x15, 0x0036); + mdio_write(tp, 0x19, 0x6c03); + mdio_write(tp, 0x15, 0x0037); + mdio_write(tp, 0x19, 0xa300); + mdio_write(tp, 0x15, 0x0038); + mdio_write(tp, 0x19, 0x64a1); + mdio_write(tp, 0x15, 0x0039); + mdio_write(tp, 0x19, 0x7c08); + mdio_write(tp, 0x15, 0x003a); + mdio_write(tp, 0x19, 0x74f8); + mdio_write(tp, 0x15, 0x003b); + mdio_write(tp, 0x19, 0x63d0); + mdio_write(tp, 0x15, 0x003c); + mdio_write(tp, 0x19, 0x7ff0); + mdio_write(tp, 0x15, 0x003d); + mdio_write(tp, 0x19, 0x77f0); + mdio_write(tp, 0x15, 0x003e); + mdio_write(tp, 0x19, 0x7ff0); + mdio_write(tp, 0x15, 0x003f); + mdio_write(tp, 0x19, 0x7750); + mdio_write(tp, 0x15, 0x0040); + mdio_write(tp, 0x19, 0x63d8); + mdio_write(tp, 0x15, 0x0041); + mdio_write(tp, 0x19, 0x7cf0); + mdio_write(tp, 0x15, 0x0042); + mdio_write(tp, 0x19, 0x7708); + mdio_write(tp, 0x15, 0x0043); + mdio_write(tp, 0x19, 0xa654); + mdio_write(tp, 0x15, 0x0044); + mdio_write(tp, 0x19, 0x304a); + mdio_write(tp, 0x15, 0x0045); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0046); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0047); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0048); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0049); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x004a); + mdio_write(tp, 0x19, 0x4802); + mdio_write(tp, 0x15, 0x004b); + mdio_write(tp, 0x19, 0x4003); + mdio_write(tp, 0x15, 0x004c); + mdio_write(tp, 0x19, 0x4440); + mdio_write(tp, 0x15, 0x004d); + mdio_write(tp, 0x19, 0x63c8); + mdio_write(tp, 0x15, 0x004e); + mdio_write(tp, 0x19, 0x6481); + mdio_write(tp, 0x15, 0x004f); + mdio_write(tp, 0x19, 0x9d00); + mdio_write(tp, 0x15, 0x0050); + mdio_write(tp, 0x19, 0x63e8); + mdio_write(tp, 0x15, 0x0051); + mdio_write(tp, 0x19, 0x7d00); + mdio_write(tp, 0x15, 0x0052); + mdio_write(tp, 0x19, 0x5900); + mdio_write(tp, 0x15, 0x0053); + mdio_write(tp, 0x19, 0x63f8); + mdio_write(tp, 0x15, 0x0054); + mdio_write(tp, 0x19, 0x64a1); + mdio_write(tp, 0x15, 0x0055); + mdio_write(tp, 0x19, 0x3116); + mdio_write(tp, 0x15, 0x0056); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0057); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0058); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0059); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x005a); + mdio_write(tp, 0x19, 0x7c03); + mdio_write(tp, 0x15, 0x005b); + mdio_write(tp, 0x19, 0x6c03); + mdio_write(tp, 0x15, 0x005c); + mdio_write(tp, 0x19, 0x7c08); + mdio_write(tp, 0x15, 0x005d); + mdio_write(tp, 0x19, 0x6000); + mdio_write(tp, 0x15, 0x005e); + mdio_write(tp, 0x19, 0x59ce); + mdio_write(tp, 0x15, 0x005f); + mdio_write(tp, 0x19, 0x4400); + mdio_write(tp, 0x15, 0x0060); + mdio_write(tp, 0x19, 0x7d00); + mdio_write(tp, 0x15, 0x0061); + mdio_write(tp, 0x19, 0x72b0); + mdio_write(tp, 0x15, 0x0062); + mdio_write(tp, 0x19, 0x400e); + mdio_write(tp, 0x15, 0x0063); + mdio_write(tp, 0x19, 0x4440); + mdio_write(tp, 0x15, 0x0064); + mdio_write(tp, 0x19, 0x9d00); + mdio_write(tp, 0x15, 0x0065); + mdio_write(tp, 0x19, 0x7f00); + mdio_write(tp, 0x15, 0x0066); + mdio_write(tp, 0x19, 0x70b0); + mdio_write(tp, 0x15, 0x0067); + mdio_write(tp, 0x19, 0x7c08); + mdio_write(tp, 0x15, 0x0068); + mdio_write(tp, 0x19, 0x6008); + mdio_write(tp, 0x15, 0x0069); + mdio_write(tp, 0x19, 0x7cf0); + mdio_write(tp, 0x15, 0x006a); + mdio_write(tp, 0x19, 0x7750); + mdio_write(tp, 0x15, 0x006b); + mdio_write(tp, 0x19, 0x4007); + mdio_write(tp, 0x15, 0x006c); + mdio_write(tp, 0x19, 0x4500); + mdio_write(tp, 0x15, 0x006d); + mdio_write(tp, 0x19, 0x4023); + mdio_write(tp, 0x15, 0x006e); + mdio_write(tp, 0x19, 0x4580); + mdio_write(tp, 0x15, 0x006f); + mdio_write(tp, 0x19, 0x9f00); + mdio_write(tp, 0x15, 0x0070); + mdio_write(tp, 0x19, 0xcd78); + mdio_write(tp, 0x15, 0x0071); + mdio_write(tp, 0x19, 0x0003); + mdio_write(tp, 0x15, 0x0072); + mdio_write(tp, 0x19, 0xbe02); + mdio_write(tp, 0x15, 0x0073); + mdio_write(tp, 0x19, 0x3070); + mdio_write(tp, 0x15, 0x0074); + mdio_write(tp, 0x19, 0x7cf0); + mdio_write(tp, 0x15, 0x0075); + mdio_write(tp, 0x19, 0x77f0); + mdio_write(tp, 0x15, 0x0076); + mdio_write(tp, 0x19, 0x4400); + mdio_write(tp, 0x15, 0x0077); + mdio_write(tp, 0x19, 0x4007); + mdio_write(tp, 0x15, 0x0078); + mdio_write(tp, 0x19, 0x4500); + mdio_write(tp, 0x15, 0x0079); + mdio_write(tp, 0x19, 0x4023); + mdio_write(tp, 0x15, 0x007a); + mdio_write(tp, 0x19, 0x4580); + mdio_write(tp, 0x15, 0x007b); + mdio_write(tp, 0x19, 0x9f00); + mdio_write(tp, 0x15, 0x007c); + mdio_write(tp, 0x19, 0xce80); + mdio_write(tp, 0x15, 0x007d); + mdio_write(tp, 0x19, 0x0004); + mdio_write(tp, 0x15, 0x007e); + mdio_write(tp, 0x19, 0xce80); + mdio_write(tp, 0x15, 0x007f); + mdio_write(tp, 0x19, 0x0002); + mdio_write(tp, 0x15, 0x0080); + mdio_write(tp, 0x19, 0x307c); + mdio_write(tp, 0x15, 0x0081); + mdio_write(tp, 0x19, 0x4400); + mdio_write(tp, 0x15, 0x0082); + mdio_write(tp, 0x19, 0x480f); + mdio_write(tp, 0x15, 0x0083); + mdio_write(tp, 0x19, 0x6802); + mdio_write(tp, 0x15, 0x0084); + mdio_write(tp, 0x19, 0x6680); + mdio_write(tp, 0x15, 0x0085); + mdio_write(tp, 0x19, 0x7c10); + mdio_write(tp, 0x15, 0x0086); + mdio_write(tp, 0x19, 0x6010); + mdio_write(tp, 0x15, 0x0087); + mdio_write(tp, 0x19, 0x400a); + mdio_write(tp, 0x15, 0x0088); + mdio_write(tp, 0x19, 0x4580); + mdio_write(tp, 0x15, 0x0089); + mdio_write(tp, 0x19, 0x9e00); + mdio_write(tp, 0x15, 0x008a); + mdio_write(tp, 0x19, 0x7d00); + mdio_write(tp, 0x15, 0x008b); + mdio_write(tp, 0x19, 0x5800); + mdio_write(tp, 0x15, 0x008c); + mdio_write(tp, 0x19, 0x63c8); + mdio_write(tp, 0x15, 0x008d); + mdio_write(tp, 0x19, 0x63d8); + mdio_write(tp, 0x15, 0x008e); + mdio_write(tp, 0x19, 0x66a0); + mdio_write(tp, 0x15, 0x008f); + mdio_write(tp, 0x19, 0x8300); + mdio_write(tp, 0x15, 0x0090); + mdio_write(tp, 0x19, 0x7ff0); + mdio_write(tp, 0x15, 0x0091); + mdio_write(tp, 0x19, 0x74f0); + mdio_write(tp, 0x15, 0x0092); + mdio_write(tp, 0x19, 0x3006); + mdio_write(tp, 0x15, 0x0093); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0094); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0095); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0096); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0097); + mdio_write(tp, 0x19, 0x4803); + mdio_write(tp, 0x15, 0x0098); + mdio_write(tp, 0x19, 0x7c03); + mdio_write(tp, 0x15, 0x0099); + mdio_write(tp, 0x19, 0x6c03); + mdio_write(tp, 0x15, 0x009a); + mdio_write(tp, 0x19, 0xa203); + mdio_write(tp, 0x15, 0x009b); + mdio_write(tp, 0x19, 0x64b1); + mdio_write(tp, 0x15, 0x009c); + mdio_write(tp, 0x19, 0x309e); + mdio_write(tp, 0x15, 0x009d); + mdio_write(tp, 0x19, 0x64b3); + mdio_write(tp, 0x15, 0x009e); + mdio_write(tp, 0x19, 0x4030); + mdio_write(tp, 0x15, 0x009f); + mdio_write(tp, 0x19, 0x440e); + mdio_write(tp, 0x15, 0x00a0); + mdio_write(tp, 0x19, 0x4020); + mdio_write(tp, 0x15, 0x00a1); + mdio_write(tp, 0x19, 0x4419); + mdio_write(tp, 0x15, 0x00a2); + mdio_write(tp, 0x19, 0x7801); + mdio_write(tp, 0x15, 0x00a3); + mdio_write(tp, 0x19, 0xc520); + mdio_write(tp, 0x15, 0x00a4); + mdio_write(tp, 0x19, 0x000b); + mdio_write(tp, 0x15, 0x00a5); + mdio_write(tp, 0x19, 0x4020); + mdio_write(tp, 0x15, 0x00a6); + mdio_write(tp, 0x19, 0x7800); + mdio_write(tp, 0x15, 0x00a7); + mdio_write(tp, 0x19, 0x58a4); + mdio_write(tp, 0x15, 0x00a8); + mdio_write(tp, 0x19, 0x63da); + mdio_write(tp, 0x15, 0x00a9); + mdio_write(tp, 0x19, 0x5cb0); + mdio_write(tp, 0x15, 0x00aa); + mdio_write(tp, 0x19, 0x7d00); + mdio_write(tp, 0x15, 0x00ab); + mdio_write(tp, 0x19, 0x72b0); + mdio_write(tp, 0x15, 0x00ac); + mdio_write(tp, 0x19, 0x7f00); + mdio_write(tp, 0x15, 0x00ad); + mdio_write(tp, 0x19, 0x70b0); + mdio_write(tp, 0x15, 0x00ae); + mdio_write(tp, 0x19, 0x30b8); + mdio_write(tp, 0x15, 0x00AF); + mdio_write(tp, 0x19, 0x4060); + mdio_write(tp, 0x15, 0x00B0); + mdio_write(tp, 0x19, 0x7800); + mdio_write(tp, 0x15, 0x00B1); + mdio_write(tp, 0x19, 0x7e00); + mdio_write(tp, 0x15, 0x00B2); + mdio_write(tp, 0x19, 0x72B0); + mdio_write(tp, 0x15, 0x00B3); + mdio_write(tp, 0x19, 0x7F00); + mdio_write(tp, 0x15, 0x00B4); + mdio_write(tp, 0x19, 0x73B0); + mdio_write(tp, 0x15, 0x00b5); + mdio_write(tp, 0x19, 0x58a0); + mdio_write(tp, 0x15, 0x00b6); + mdio_write(tp, 0x19, 0x63d2); + mdio_write(tp, 0x15, 0x00b7); + mdio_write(tp, 0x19, 0x5c00); + mdio_write(tp, 0x15, 0x00b8); + mdio_write(tp, 0x19, 0x5780); + mdio_write(tp, 0x15, 0x00b9); + mdio_write(tp, 0x19, 0xb60d); + mdio_write(tp, 0x15, 0x00ba); + mdio_write(tp, 0x19, 0x9bff); + mdio_write(tp, 0x15, 0x00bb); + mdio_write(tp, 0x19, 0x7c03); + mdio_write(tp, 0x15, 0x00bc); + mdio_write(tp, 0x19, 0x6001); + mdio_write(tp, 0x15, 0x00bd); + mdio_write(tp, 0x19, 0xc020); + mdio_write(tp, 0x15, 0x00be); + mdio_write(tp, 0x19, 0x002b); + mdio_write(tp, 0x15, 0x00bf); + mdio_write(tp, 0x19, 0xc137); + mdio_write(tp, 0x15, 0x00c0); + mdio_write(tp, 0x19, 0x0006); + mdio_write(tp, 0x15, 0x00c1); + mdio_write(tp, 0x19, 0x9af8); + mdio_write(tp, 0x15, 0x00c2); + mdio_write(tp, 0x19, 0x30c6); + mdio_write(tp, 0x15, 0x00c3); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x00c4); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x00c5); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x00c6); + mdio_write(tp, 0x19, 0x7d00); + mdio_write(tp, 0x15, 0x00c7); + mdio_write(tp, 0x19, 0x70b0); + mdio_write(tp, 0x15, 0x00c8); + mdio_write(tp, 0x19, 0x4400); + mdio_write(tp, 0x15, 0x00c9); + mdio_write(tp, 0x19, 0x4804); + mdio_write(tp, 0x15, 0x00ca); + mdio_write(tp, 0x19, 0x7c80); + mdio_write(tp, 0x15, 0x00cb); + mdio_write(tp, 0x19, 0x5c80); + mdio_write(tp, 0x15, 0x00cc); + mdio_write(tp, 0x19, 0x4010); + mdio_write(tp, 0x15, 0x00cd); + mdio_write(tp, 0x19, 0x4415); + mdio_write(tp, 0x15, 0x00ce); + mdio_write(tp, 0x19, 0x9b00); + mdio_write(tp, 0x15, 0x00cf); + mdio_write(tp, 0x19, 0x7f00); + mdio_write(tp, 0x15, 0x00d0); + mdio_write(tp, 0x19, 0x70b0); + mdio_write(tp, 0x15, 0x00d1); + mdio_write(tp, 0x19, 0x3177); + mdio_write(tp, 0x15, 0x00d2); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x00d3); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x00d4); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x00d5); + mdio_write(tp, 0x19, 0x4808); + mdio_write(tp, 0x15, 0x00d6); + mdio_write(tp, 0x19, 0x4007); + mdio_write(tp, 0x15, 0x00d7); + mdio_write(tp, 0x19, 0x4420); + mdio_write(tp, 0x15, 0x00d8); + mdio_write(tp, 0x19, 0x63d8); + mdio_write(tp, 0x15, 0x00d9); + mdio_write(tp, 0x19, 0xb608); + mdio_write(tp, 0x15, 0x00da); + mdio_write(tp, 0x19, 0xbcbd); + mdio_write(tp, 0x15, 0x00db); + mdio_write(tp, 0x19, 0xc60b); + mdio_write(tp, 0x15, 0x00dc); + mdio_write(tp, 0x19, 0x00fd); + mdio_write(tp, 0x15, 0x00dd); + mdio_write(tp, 0x19, 0x30e1); + mdio_write(tp, 0x15, 0x00de); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x00df); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x00e0); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x00e1); + mdio_write(tp, 0x19, 0x4809); + mdio_write(tp, 0x15, 0x00e2); + mdio_write(tp, 0x19, 0x7e40); + mdio_write(tp, 0x15, 0x00e3); + mdio_write(tp, 0x19, 0x5a40); + mdio_write(tp, 0x15, 0x00e4); + mdio_write(tp, 0x19, 0x305a); + mdio_write(tp, 0x15, 0x00e5); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x00e6); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x00e7); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x00e8); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x00e9); + mdio_write(tp, 0x19, 0x480a); + mdio_write(tp, 0x15, 0x00ea); + mdio_write(tp, 0x19, 0x5820); + mdio_write(tp, 0x15, 0x00eb); + mdio_write(tp, 0x19, 0x6c03); + mdio_write(tp, 0x15, 0x00ec); + mdio_write(tp, 0x19, 0xb60a); + mdio_write(tp, 0x15, 0x00ed); + mdio_write(tp, 0x19, 0xda07); + mdio_write(tp, 0x15, 0x00ee); + mdio_write(tp, 0x19, 0x0008); + mdio_write(tp, 0x15, 0x00ef); + mdio_write(tp, 0x19, 0xc60b); + mdio_write(tp, 0x15, 0x00f0); + mdio_write(tp, 0x19, 0x00fc); + mdio_write(tp, 0x15, 0x00f1); + mdio_write(tp, 0x19, 0x30f6); + mdio_write(tp, 0x15, 0x00f2); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x00f3); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x00f4); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x00f5); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x00f6); + mdio_write(tp, 0x19, 0x4408); + mdio_write(tp, 0x15, 0x00f7); + mdio_write(tp, 0x19, 0x480b); + mdio_write(tp, 0x15, 0x00f8); + mdio_write(tp, 0x19, 0x6f03); + mdio_write(tp, 0x15, 0x00f9); + mdio_write(tp, 0x19, 0x405f); + mdio_write(tp, 0x15, 0x00fa); + mdio_write(tp, 0x19, 0x4448); + mdio_write(tp, 0x15, 0x00fb); + mdio_write(tp, 0x19, 0x4020); + mdio_write(tp, 0x15, 0x00fc); + mdio_write(tp, 0x19, 0x4468); + mdio_write(tp, 0x15, 0x00fd); + mdio_write(tp, 0x19, 0x9c03); + mdio_write(tp, 0x15, 0x00fe); + mdio_write(tp, 0x19, 0x6f07); + mdio_write(tp, 0x15, 0x00ff); + mdio_write(tp, 0x19, 0x58a0); + mdio_write(tp, 0x15, 0x0100); + mdio_write(tp, 0x19, 0xd6d1); + mdio_write(tp, 0x15, 0x0101); + mdio_write(tp, 0x19, 0x0004); + mdio_write(tp, 0x15, 0x0102); + mdio_write(tp, 0x19, 0xc137); + mdio_write(tp, 0x15, 0x0103); + mdio_write(tp, 0x19, 0x0002); + mdio_write(tp, 0x15, 0x0104); + mdio_write(tp, 0x19, 0xa0e5); + mdio_write(tp, 0x15, 0x0105); + mdio_write(tp, 0x19, 0x9df8); + mdio_write(tp, 0x15, 0x0106); + mdio_write(tp, 0x19, 0x30c6); + mdio_write(tp, 0x15, 0x0107); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0108); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0109); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x010a); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x010b); + mdio_write(tp, 0x19, 0x4808); + mdio_write(tp, 0x15, 0x010c); + mdio_write(tp, 0x19, 0xc32d); + mdio_write(tp, 0x15, 0x010d); + mdio_write(tp, 0x19, 0x0003); + mdio_write(tp, 0x15, 0x010e); + mdio_write(tp, 0x19, 0xc8b3); + mdio_write(tp, 0x15, 0x010f); + mdio_write(tp, 0x19, 0x00fc); + mdio_write(tp, 0x15, 0x0110); + mdio_write(tp, 0x19, 0x4400); + mdio_write(tp, 0x15, 0x0111); + mdio_write(tp, 0x19, 0x3116); + mdio_write(tp, 0x15, 0x0112); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0113); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0114); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0115); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0116); + mdio_write(tp, 0x19, 0x4803); + mdio_write(tp, 0x15, 0x0117); + mdio_write(tp, 0x19, 0x7c03); + mdio_write(tp, 0x15, 0x0118); + mdio_write(tp, 0x19, 0x6c02); + mdio_write(tp, 0x15, 0x0119); + mdio_write(tp, 0x19, 0x7c04); + mdio_write(tp, 0x15, 0x011a); + mdio_write(tp, 0x19, 0x6000); + mdio_write(tp, 0x15, 0x011b); + mdio_write(tp, 0x19, 0x5cf7); + mdio_write(tp, 0x15, 0x011c); + mdio_write(tp, 0x19, 0x7c2a); + mdio_write(tp, 0x15, 0x011d); + mdio_write(tp, 0x19, 0x5800); + mdio_write(tp, 0x15, 0x011e); + mdio_write(tp, 0x19, 0x5400); + mdio_write(tp, 0x15, 0x011f); + mdio_write(tp, 0x19, 0x7c08); + mdio_write(tp, 0x15, 0x0120); + mdio_write(tp, 0x19, 0x74f0); + mdio_write(tp, 0x15, 0x0121); + mdio_write(tp, 0x19, 0x4019); + mdio_write(tp, 0x15, 0x0122); + mdio_write(tp, 0x19, 0x440d); + mdio_write(tp, 0x15, 0x0123); + mdio_write(tp, 0x19, 0xb6c1); + mdio_write(tp, 0x15, 0x0124); + mdio_write(tp, 0x19, 0xc05b); + mdio_write(tp, 0x15, 0x0125); + mdio_write(tp, 0x19, 0x00bf); + mdio_write(tp, 0x15, 0x0126); + mdio_write(tp, 0x19, 0xc025); + mdio_write(tp, 0x15, 0x0127); + mdio_write(tp, 0x19, 0x00bd); + mdio_write(tp, 0x15, 0x0128); + mdio_write(tp, 0x19, 0xc603); + mdio_write(tp, 0x15, 0x0129); + mdio_write(tp, 0x19, 0x00bb); + mdio_write(tp, 0x15, 0x012a); + mdio_write(tp, 0x19, 0x8805); + mdio_write(tp, 0x15, 0x012b); + mdio_write(tp, 0x19, 0x7801); + mdio_write(tp, 0x15, 0x012c); + mdio_write(tp, 0x19, 0x4001); + mdio_write(tp, 0x15, 0x012d); + mdio_write(tp, 0x19, 0x7800); + mdio_write(tp, 0x15, 0x012e); + mdio_write(tp, 0x19, 0xa3dd); + mdio_write(tp, 0x15, 0x012f); + mdio_write(tp, 0x19, 0x7c03); + mdio_write(tp, 0x15, 0x0130); + mdio_write(tp, 0x19, 0x6c03); + mdio_write(tp, 0x15, 0x0131); + mdio_write(tp, 0x19, 0x8407); + mdio_write(tp, 0x15, 0x0132); + mdio_write(tp, 0x19, 0x7c03); + mdio_write(tp, 0x15, 0x0133); + mdio_write(tp, 0x19, 0x6c02); + mdio_write(tp, 0x15, 0x0134); + mdio_write(tp, 0x19, 0xd9b8); + mdio_write(tp, 0x15, 0x0135); + mdio_write(tp, 0x19, 0x0003); + mdio_write(tp, 0x15, 0x0136); + mdio_write(tp, 0x19, 0xc240); + mdio_write(tp, 0x15, 0x0137); + mdio_write(tp, 0x19, 0x0015); + mdio_write(tp, 0x15, 0x0138); + mdio_write(tp, 0x19, 0x7c03); + mdio_write(tp, 0x15, 0x0139); + mdio_write(tp, 0x19, 0x6c02); + mdio_write(tp, 0x15, 0x013a); + mdio_write(tp, 0x19, 0x9ae9); + mdio_write(tp, 0x15, 0x013b); + mdio_write(tp, 0x19, 0x3140); + mdio_write(tp, 0x15, 0x013c); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x013d); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x013e); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x013f); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0140); + mdio_write(tp, 0x19, 0x4807); + mdio_write(tp, 0x15, 0x0141); + mdio_write(tp, 0x19, 0x4004); + mdio_write(tp, 0x15, 0x0142); + mdio_write(tp, 0x19, 0x4410); + mdio_write(tp, 0x15, 0x0143); + mdio_write(tp, 0x19, 0x7c0c); + mdio_write(tp, 0x15, 0x0144); + mdio_write(tp, 0x19, 0x600c); + mdio_write(tp, 0x15, 0x0145); + mdio_write(tp, 0x19, 0x9b00); + mdio_write(tp, 0x15, 0x0146); + mdio_write(tp, 0x19, 0xa68f); + mdio_write(tp, 0x15, 0x0147); + mdio_write(tp, 0x19, 0x3116); + mdio_write(tp, 0x15, 0x0148); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0149); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x014a); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x014b); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x014c); + mdio_write(tp, 0x19, 0x4804); + mdio_write(tp, 0x15, 0x014d); + mdio_write(tp, 0x19, 0x54c0); + mdio_write(tp, 0x15, 0x014e); + mdio_write(tp, 0x19, 0xb703); + mdio_write(tp, 0x15, 0x014f); + mdio_write(tp, 0x19, 0x5cff); + mdio_write(tp, 0x15, 0x0150); + mdio_write(tp, 0x19, 0x315f); + mdio_write(tp, 0x15, 0x0151); + mdio_write(tp, 0x19, 0x7c08); + mdio_write(tp, 0x15, 0x0152); + mdio_write(tp, 0x19, 0x74f8); + mdio_write(tp, 0x15, 0x0153); + mdio_write(tp, 0x19, 0x6421); + mdio_write(tp, 0x15, 0x0154); + mdio_write(tp, 0x19, 0x7c08); + mdio_write(tp, 0x15, 0x0155); + mdio_write(tp, 0x19, 0x6000); + mdio_write(tp, 0x15, 0x0156); + mdio_write(tp, 0x19, 0x4003); + mdio_write(tp, 0x15, 0x0157); + mdio_write(tp, 0x19, 0x4418); + mdio_write(tp, 0x15, 0x0158); + mdio_write(tp, 0x19, 0x9b00); + mdio_write(tp, 0x15, 0x0159); + mdio_write(tp, 0x19, 0x6461); + mdio_write(tp, 0x15, 0x015a); + mdio_write(tp, 0x19, 0x64e1); + mdio_write(tp, 0x15, 0x015b); + mdio_write(tp, 0x19, 0x7c20); + mdio_write(tp, 0x15, 0x015c); + mdio_write(tp, 0x19, 0x5820); + mdio_write(tp, 0x15, 0x015d); + mdio_write(tp, 0x19, 0x5ccf); + mdio_write(tp, 0x15, 0x015e); + mdio_write(tp, 0x19, 0x7050); + mdio_write(tp, 0x15, 0x015f); + mdio_write(tp, 0x19, 0xd9b8); + mdio_write(tp, 0x15, 0x0160); + mdio_write(tp, 0x19, 0x0008); + mdio_write(tp, 0x15, 0x0161); + mdio_write(tp, 0x19, 0xdab1); + mdio_write(tp, 0x15, 0x0162); + mdio_write(tp, 0x19, 0x0015); + mdio_write(tp, 0x15, 0x0163); + mdio_write(tp, 0x19, 0xc244); + mdio_write(tp, 0x15, 0x0164); + mdio_write(tp, 0x19, 0x0013); + mdio_write(tp, 0x15, 0x0165); + mdio_write(tp, 0x19, 0xc021); + mdio_write(tp, 0x15, 0x0166); + mdio_write(tp, 0x19, 0x00f9); + mdio_write(tp, 0x15, 0x0167); + mdio_write(tp, 0x19, 0x3177); + mdio_write(tp, 0x15, 0x0168); + mdio_write(tp, 0x19, 0x5cf7); + mdio_write(tp, 0x15, 0x0169); + mdio_write(tp, 0x19, 0x4010); + mdio_write(tp, 0x15, 0x016a); + mdio_write(tp, 0x19, 0x4428); + mdio_write(tp, 0x15, 0x016b); + mdio_write(tp, 0x19, 0x9c00); + mdio_write(tp, 0x15, 0x016c); + mdio_write(tp, 0x19, 0x7c08); + mdio_write(tp, 0x15, 0x016d); + mdio_write(tp, 0x19, 0x6008); + mdio_write(tp, 0x15, 0x016e); + mdio_write(tp, 0x19, 0x7c08); + mdio_write(tp, 0x15, 0x016f); + mdio_write(tp, 0x19, 0x74f0); + mdio_write(tp, 0x15, 0x0170); + mdio_write(tp, 0x19, 0x6461); + mdio_write(tp, 0x15, 0x0171); + mdio_write(tp, 0x19, 0x6421); + mdio_write(tp, 0x15, 0x0172); + mdio_write(tp, 0x19, 0x64a1); + mdio_write(tp, 0x15, 0x0173); + mdio_write(tp, 0x19, 0x3116); + mdio_write(tp, 0x15, 0x0174); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0175); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0176); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0177); + mdio_write(tp, 0x19, 0x4805); + mdio_write(tp, 0x15, 0x0178); + mdio_write(tp, 0x19, 0xa103); + mdio_write(tp, 0x15, 0x0179); + mdio_write(tp, 0x19, 0x7c02); + mdio_write(tp, 0x15, 0x017a); + mdio_write(tp, 0x19, 0x6002); + mdio_write(tp, 0x15, 0x017b); + mdio_write(tp, 0x19, 0x7e00); + mdio_write(tp, 0x15, 0x017c); + mdio_write(tp, 0x19, 0x5400); + mdio_write(tp, 0x15, 0x017d); + mdio_write(tp, 0x19, 0x7c6b); + mdio_write(tp, 0x15, 0x017e); + mdio_write(tp, 0x19, 0x5c63); + mdio_write(tp, 0x15, 0x017f); + mdio_write(tp, 0x19, 0x407d); + mdio_write(tp, 0x15, 0x0180); + mdio_write(tp, 0x19, 0xa602); + mdio_write(tp, 0x15, 0x0181); + mdio_write(tp, 0x19, 0x4001); + mdio_write(tp, 0x15, 0x0182); + mdio_write(tp, 0x19, 0x4420); + mdio_write(tp, 0x15, 0x0183); + mdio_write(tp, 0x19, 0x4020); + mdio_write(tp, 0x15, 0x0184); + mdio_write(tp, 0x19, 0x44a1); + mdio_write(tp, 0x15, 0x0185); + mdio_write(tp, 0x19, 0xd6e0); + mdio_write(tp, 0x15, 0x0186); + mdio_write(tp, 0x19, 0x0009); + mdio_write(tp, 0x15, 0x0187); + mdio_write(tp, 0x19, 0x9efe); + mdio_write(tp, 0x15, 0x0188); + mdio_write(tp, 0x19, 0x7c02); + mdio_write(tp, 0x15, 0x0189); + mdio_write(tp, 0x19, 0x6000); + mdio_write(tp, 0x15, 0x018a); + mdio_write(tp, 0x19, 0x9c00); + mdio_write(tp, 0x15, 0x018b); + mdio_write(tp, 0x19, 0x318f); + mdio_write(tp, 0x15, 0x018c); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x018d); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x018e); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x018f); + mdio_write(tp, 0x19, 0x4806); + mdio_write(tp, 0x15, 0x0190); + mdio_write(tp, 0x19, 0x7c10); + mdio_write(tp, 0x15, 0x0191); + mdio_write(tp, 0x19, 0x5c10); + mdio_write(tp, 0x15, 0x0192); + mdio_write(tp, 0x19, 0x40fa); + mdio_write(tp, 0x15, 0x0193); + mdio_write(tp, 0x19, 0xa602); + mdio_write(tp, 0x15, 0x0194); + mdio_write(tp, 0x19, 0x4010); + mdio_write(tp, 0x15, 0x0195); + mdio_write(tp, 0x19, 0x4440); + mdio_write(tp, 0x15, 0x0196); + mdio_write(tp, 0x19, 0x9d00); + mdio_write(tp, 0x15, 0x0197); + mdio_write(tp, 0x19, 0x7c80); + mdio_write(tp, 0x15, 0x0198); + mdio_write(tp, 0x19, 0x6400); + mdio_write(tp, 0x15, 0x0199); + mdio_write(tp, 0x19, 0x4003); + mdio_write(tp, 0x15, 0x019a); + mdio_write(tp, 0x19, 0x4540); + mdio_write(tp, 0x15, 0x019b); + mdio_write(tp, 0x19, 0x7c08); + mdio_write(tp, 0x15, 0x019c); + mdio_write(tp, 0x19, 0x6008); + mdio_write(tp, 0x15, 0x019d); + mdio_write(tp, 0x19, 0x9f00); + mdio_write(tp, 0x15, 0x019e); + mdio_write(tp, 0x19, 0x7c40); + mdio_write(tp, 0x15, 0x019f); + mdio_write(tp, 0x19, 0x6400); + mdio_write(tp, 0x15, 0x01a0); + mdio_write(tp, 0x19, 0x7c80); + mdio_write(tp, 0x15, 0x01a1); + mdio_write(tp, 0x19, 0x6480); + mdio_write(tp, 0x15, 0x01a2); + mdio_write(tp, 0x19, 0x3140); + mdio_write(tp, 0x15, 0x01a3); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x01a4); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x01a5); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x01a6); + mdio_write(tp, 0x19, 0x4400); + mdio_write(tp, 0x15, 0x01a7); + mdio_write(tp, 0x19, 0x7c0b); + mdio_write(tp, 0x15, 0x01a8); + mdio_write(tp, 0x19, 0x6c01); + mdio_write(tp, 0x15, 0x01a9); + mdio_write(tp, 0x19, 0x64a8); + mdio_write(tp, 0x15, 0x01aa); + mdio_write(tp, 0x19, 0x6800); + mdio_write(tp, 0x15, 0x01ab); + mdio_write(tp, 0x19, 0x5cf0); + mdio_write(tp, 0x15, 0x01ac); + mdio_write(tp, 0x19, 0x588f); + mdio_write(tp, 0x15, 0x01ad); + mdio_write(tp, 0x19, 0xb628); + mdio_write(tp, 0x15, 0x01ae); + mdio_write(tp, 0x19, 0xc053); + mdio_write(tp, 0x15, 0x01af); + mdio_write(tp, 0x19, 0x0026); + mdio_write(tp, 0x15, 0x01b0); + mdio_write(tp, 0x19, 0xc02d); + mdio_write(tp, 0x15, 0x01b1); + mdio_write(tp, 0x19, 0x0024); + mdio_write(tp, 0x15, 0x01b2); + mdio_write(tp, 0x19, 0xc603); + mdio_write(tp, 0x15, 0x01b3); + mdio_write(tp, 0x19, 0x0022); + mdio_write(tp, 0x15, 0x01b4); + mdio_write(tp, 0x19, 0x8cf9); + mdio_write(tp, 0x15, 0x01b5); + mdio_write(tp, 0x19, 0x31ba); + mdio_write(tp, 0x15, 0x01b6); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x01b7); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x01b8); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x01b9); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x01ba); + mdio_write(tp, 0x19, 0x4400); + mdio_write(tp, 0x15, 0x01bb); + mdio_write(tp, 0x19, 0x5420); + mdio_write(tp, 0x15, 0x01bc); + mdio_write(tp, 0x19, 0x4811); + mdio_write(tp, 0x15, 0x01bd); + mdio_write(tp, 0x19, 0x5000); + mdio_write(tp, 0x15, 0x01be); + mdio_write(tp, 0x19, 0x4801); + mdio_write(tp, 0x15, 0x01bf); + mdio_write(tp, 0x19, 0x6800); + mdio_write(tp, 0x15, 0x01c0); + mdio_write(tp, 0x19, 0x31f5); + mdio_write(tp, 0x15, 0x01c1); + mdio_write(tp, 0x19, 0xb614); + mdio_write(tp, 0x15, 0x01c2); + mdio_write(tp, 0x19, 0x8ce4); + mdio_write(tp, 0x15, 0x01c3); + mdio_write(tp, 0x19, 0xb30c); + mdio_write(tp, 0x15, 0x01c4); + mdio_write(tp, 0x19, 0x7c03); + mdio_write(tp, 0x15, 0x01c5); + mdio_write(tp, 0x19, 0x6c02); + mdio_write(tp, 0x15, 0x01c6); + mdio_write(tp, 0x19, 0x8206); + mdio_write(tp, 0x15, 0x01c7); + mdio_write(tp, 0x19, 0x7c03); + mdio_write(tp, 0x15, 0x01c8); + mdio_write(tp, 0x19, 0x6c00); + mdio_write(tp, 0x15, 0x01c9); + mdio_write(tp, 0x19, 0x7c04); + mdio_write(tp, 0x15, 0x01ca); + mdio_write(tp, 0x19, 0x7404); + mdio_write(tp, 0x15, 0x01cb); + mdio_write(tp, 0x19, 0x31c0); + mdio_write(tp, 0x15, 0x01cc); + mdio_write(tp, 0x19, 0x7c04); + mdio_write(tp, 0x15, 0x01cd); + mdio_write(tp, 0x19, 0x7400); + mdio_write(tp, 0x15, 0x01ce); + mdio_write(tp, 0x19, 0x31c0); + mdio_write(tp, 0x15, 0x01cf); + mdio_write(tp, 0x19, 0x8df1); + mdio_write(tp, 0x15, 0x01d0); + mdio_write(tp, 0x19, 0x3248); + mdio_write(tp, 0x15, 0x01d1); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x01d2); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x01d3); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x01d4); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x01d5); + mdio_write(tp, 0x19, 0x4400); + mdio_write(tp, 0x15, 0x01d6); + mdio_write(tp, 0x19, 0x7c03); + mdio_write(tp, 0x15, 0x01d7); + mdio_write(tp, 0x19, 0x6c03); + mdio_write(tp, 0x15, 0x01d8); + mdio_write(tp, 0x19, 0x7670); + mdio_write(tp, 0x15, 0x01d9); + mdio_write(tp, 0x19, 0x4023); + mdio_write(tp, 0x15, 0x01da); + mdio_write(tp, 0x19, 0x4500); + mdio_write(tp, 0x15, 0x01db); + mdio_write(tp, 0x19, 0x4069); + mdio_write(tp, 0x15, 0x01dc); + mdio_write(tp, 0x19, 0x4580); + mdio_write(tp, 0x15, 0x01dd); + mdio_write(tp, 0x19, 0x9f00); + mdio_write(tp, 0x15, 0x01de); + mdio_write(tp, 0x19, 0xcff5); + mdio_write(tp, 0x15, 0x01df); + mdio_write(tp, 0x19, 0x00ff); + mdio_write(tp, 0x15, 0x01e0); + mdio_write(tp, 0x19, 0x76f0); + mdio_write(tp, 0x15, 0x01e1); + mdio_write(tp, 0x19, 0x4400); + mdio_write(tp, 0x15, 0x01e2); + mdio_write(tp, 0x19, 0x4023); + mdio_write(tp, 0x15, 0x01e3); + mdio_write(tp, 0x19, 0x4500); + mdio_write(tp, 0x15, 0x01e4); + mdio_write(tp, 0x19, 0x4069); + mdio_write(tp, 0x15, 0x01e5); + mdio_write(tp, 0x19, 0x4580); + mdio_write(tp, 0x15, 0x01e6); + mdio_write(tp, 0x19, 0x9f00); + mdio_write(tp, 0x15, 0x01e7); + mdio_write(tp, 0x19, 0xd0f5); + mdio_write(tp, 0x15, 0x01e8); + mdio_write(tp, 0x19, 0x00ff); + mdio_write(tp, 0x15, 0x01e9); + mdio_write(tp, 0x19, 0x4400); + mdio_write(tp, 0x15, 0x01ea); + mdio_write(tp, 0x19, 0x7c03); + mdio_write(tp, 0x15, 0x01eb); + mdio_write(tp, 0x19, 0x6800); + mdio_write(tp, 0x15, 0x01ec); + mdio_write(tp, 0x19, 0x66a0); + mdio_write(tp, 0x15, 0x01ed); + mdio_write(tp, 0x19, 0x8300); + mdio_write(tp, 0x15, 0x01ee); + mdio_write(tp, 0x19, 0x74f0); + mdio_write(tp, 0x15, 0x01ef); + mdio_write(tp, 0x19, 0x3006); + mdio_write(tp, 0x15, 0x01f0); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x01f1); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x01f2); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x01f3); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x01f4); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x01f5); + mdio_write(tp, 0x19, 0x7c03); + mdio_write(tp, 0x15, 0x01f6); + mdio_write(tp, 0x19, 0x6c02); + mdio_write(tp, 0x15, 0x01f7); + mdio_write(tp, 0x19, 0x409d); + mdio_write(tp, 0x15, 0x01f8); + mdio_write(tp, 0x19, 0x7c87); + mdio_write(tp, 0x15, 0x01f9); + mdio_write(tp, 0x19, 0xae14); + mdio_write(tp, 0x15, 0x01fa); + mdio_write(tp, 0x19, 0x4400); + mdio_write(tp, 0x15, 0x01fb); + mdio_write(tp, 0x19, 0x7c40); + mdio_write(tp, 0x15, 0x01fc); + mdio_write(tp, 0x19, 0x6800); + mdio_write(tp, 0x15, 0x01fd); + mdio_write(tp, 0x19, 0x7801); + mdio_write(tp, 0x15, 0x01fe); + mdio_write(tp, 0x19, 0x980e); + mdio_write(tp, 0x15, 0x01ff); + mdio_write(tp, 0x19, 0x930c); + mdio_write(tp, 0x15, 0x0200); + mdio_write(tp, 0x19, 0x9206); + mdio_write(tp, 0x15, 0x0201); + mdio_write(tp, 0x19, 0x4002); + mdio_write(tp, 0x15, 0x0202); + mdio_write(tp, 0x19, 0x7800); + mdio_write(tp, 0x15, 0x0203); + mdio_write(tp, 0x19, 0x588f); + mdio_write(tp, 0x15, 0x0204); + mdio_write(tp, 0x19, 0x5520); + mdio_write(tp, 0x15, 0x0205); + mdio_write(tp, 0x19, 0x320c); + mdio_write(tp, 0x15, 0x0206); + mdio_write(tp, 0x19, 0x4000); + mdio_write(tp, 0x15, 0x0207); + mdio_write(tp, 0x19, 0x7800); + mdio_write(tp, 0x15, 0x0208); + mdio_write(tp, 0x19, 0x588d); + mdio_write(tp, 0x15, 0x0209); + mdio_write(tp, 0x19, 0x5500); + mdio_write(tp, 0x15, 0x020a); + mdio_write(tp, 0x19, 0x320c); + mdio_write(tp, 0x15, 0x020b); + mdio_write(tp, 0x19, 0x4002); + mdio_write(tp, 0x15, 0x020c); + mdio_write(tp, 0x19, 0x3220); + mdio_write(tp, 0x15, 0x020d); + mdio_write(tp, 0x19, 0x4480); + mdio_write(tp, 0x15, 0x020e); + mdio_write(tp, 0x19, 0x9e03); + mdio_write(tp, 0x15, 0x020f); + mdio_write(tp, 0x19, 0x7c40); + mdio_write(tp, 0x15, 0x0210); + mdio_write(tp, 0x19, 0x6840); + mdio_write(tp, 0x15, 0x0211); + mdio_write(tp, 0x19, 0x7801); + mdio_write(tp, 0x15, 0x0212); + mdio_write(tp, 0x19, 0x980e); + mdio_write(tp, 0x15, 0x0213); + mdio_write(tp, 0x19, 0x930c); + mdio_write(tp, 0x15, 0x0214); + mdio_write(tp, 0x19, 0x9206); + mdio_write(tp, 0x15, 0x0215); + mdio_write(tp, 0x19, 0x4000); + mdio_write(tp, 0x15, 0x0216); + mdio_write(tp, 0x19, 0x7800); + mdio_write(tp, 0x15, 0x0217); + mdio_write(tp, 0x19, 0x588f); + mdio_write(tp, 0x15, 0x0218); + mdio_write(tp, 0x19, 0x5520); + mdio_write(tp, 0x15, 0x0219); + mdio_write(tp, 0x19, 0x3220); + mdio_write(tp, 0x15, 0x021a); + mdio_write(tp, 0x19, 0x4002); + mdio_write(tp, 0x15, 0x021b); + mdio_write(tp, 0x19, 0x7800); + mdio_write(tp, 0x15, 0x021c); + mdio_write(tp, 0x19, 0x588d); + mdio_write(tp, 0x15, 0x021d); + mdio_write(tp, 0x19, 0x5540); + mdio_write(tp, 0x15, 0x021e); + mdio_write(tp, 0x19, 0x3220); + mdio_write(tp, 0x15, 0x021f); + mdio_write(tp, 0x19, 0x4000); + mdio_write(tp, 0x15, 0x0220); + mdio_write(tp, 0x19, 0x7800); + mdio_write(tp, 0x15, 0x0221); + mdio_write(tp, 0x19, 0x7c03); + mdio_write(tp, 0x15, 0x0222); + mdio_write(tp, 0x19, 0x6c00); + mdio_write(tp, 0x15, 0x0223); + mdio_write(tp, 0x19, 0x3231); + mdio_write(tp, 0x15, 0x0224); + mdio_write(tp, 0x19, 0xab06); + mdio_write(tp, 0x15, 0x0225); + mdio_write(tp, 0x19, 0xbf08); + mdio_write(tp, 0x15, 0x0226); + mdio_write(tp, 0x19, 0x4076); + mdio_write(tp, 0x15, 0x0227); + mdio_write(tp, 0x19, 0x7d07); + mdio_write(tp, 0x15, 0x0228); + mdio_write(tp, 0x19, 0x4502); + mdio_write(tp, 0x15, 0x0229); + mdio_write(tp, 0x19, 0x3231); + mdio_write(tp, 0x15, 0x022a); + mdio_write(tp, 0x19, 0x7d80); + mdio_write(tp, 0x15, 0x022b); + mdio_write(tp, 0x19, 0x5180); + mdio_write(tp, 0x15, 0x022c); + mdio_write(tp, 0x19, 0x322f); + mdio_write(tp, 0x15, 0x022d); + mdio_write(tp, 0x19, 0x7d80); + mdio_write(tp, 0x15, 0x022e); + mdio_write(tp, 0x19, 0x5000); + mdio_write(tp, 0x15, 0x022f); + mdio_write(tp, 0x19, 0x7d07); + mdio_write(tp, 0x15, 0x0230); + mdio_write(tp, 0x19, 0x4402); + mdio_write(tp, 0x15, 0x0231); + mdio_write(tp, 0x19, 0x7c03); + mdio_write(tp, 0x15, 0x0232); + mdio_write(tp, 0x19, 0x6c02); + mdio_write(tp, 0x15, 0x0233); + mdio_write(tp, 0x19, 0x7c03); + mdio_write(tp, 0x15, 0x0234); + mdio_write(tp, 0x19, 0xb309); + mdio_write(tp, 0x15, 0x0235); + mdio_write(tp, 0x19, 0xb204); + mdio_write(tp, 0x15, 0x0236); + mdio_write(tp, 0x19, 0xb105); + mdio_write(tp, 0x15, 0x0237); + mdio_write(tp, 0x19, 0x6c00); + mdio_write(tp, 0x15, 0x0238); + mdio_write(tp, 0x19, 0x31c1); + mdio_write(tp, 0x15, 0x0239); + mdio_write(tp, 0x19, 0x6c00); + mdio_write(tp, 0x15, 0x023a); + mdio_write(tp, 0x19, 0x3261); + mdio_write(tp, 0x15, 0x023b); + mdio_write(tp, 0x19, 0x6c00); + mdio_write(tp, 0x15, 0x023c); + mdio_write(tp, 0x19, 0x3250); + mdio_write(tp, 0x15, 0x023d); + mdio_write(tp, 0x19, 0xb203); + mdio_write(tp, 0x15, 0x023e); + mdio_write(tp, 0x19, 0x6c00); + mdio_write(tp, 0x15, 0x023f); + mdio_write(tp, 0x19, 0x327a); + mdio_write(tp, 0x15, 0x0240); + mdio_write(tp, 0x19, 0x6c00); + mdio_write(tp, 0x15, 0x0241); + mdio_write(tp, 0x19, 0x3293); + mdio_write(tp, 0x15, 0x0242); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0243); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0244); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0245); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0246); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0247); + mdio_write(tp, 0x19, 0x32a3); + mdio_write(tp, 0x15, 0x0248); + mdio_write(tp, 0x19, 0x5520); + mdio_write(tp, 0x15, 0x0249); + mdio_write(tp, 0x19, 0x403d); + mdio_write(tp, 0x15, 0x024a); + mdio_write(tp, 0x19, 0x440c); + mdio_write(tp, 0x15, 0x024b); + mdio_write(tp, 0x19, 0x4812); + mdio_write(tp, 0x15, 0x024c); + mdio_write(tp, 0x19, 0x5001); + mdio_write(tp, 0x15, 0x024d); + mdio_write(tp, 0x19, 0x4802); + mdio_write(tp, 0x15, 0x024e); + mdio_write(tp, 0x19, 0x6880); + mdio_write(tp, 0x15, 0x024f); + mdio_write(tp, 0x19, 0x31f5); + mdio_write(tp, 0x15, 0x0250); + mdio_write(tp, 0x19, 0xb685); + mdio_write(tp, 0x15, 0x0251); + mdio_write(tp, 0x19, 0x801c); + mdio_write(tp, 0x15, 0x0252); + mdio_write(tp, 0x19, 0xbaf5); + mdio_write(tp, 0x15, 0x0253); + mdio_write(tp, 0x19, 0xc07c); + mdio_write(tp, 0x15, 0x0254); + mdio_write(tp, 0x19, 0x00fb); + mdio_write(tp, 0x15, 0x0255); + mdio_write(tp, 0x19, 0x325a); + mdio_write(tp, 0x15, 0x0256); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0257); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0258); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0259); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x025a); + mdio_write(tp, 0x19, 0x481a); + mdio_write(tp, 0x15, 0x025b); + mdio_write(tp, 0x19, 0x5001); + mdio_write(tp, 0x15, 0x025c); + mdio_write(tp, 0x19, 0x401b); + mdio_write(tp, 0x15, 0x025d); + mdio_write(tp, 0x19, 0x480a); + mdio_write(tp, 0x15, 0x025e); + mdio_write(tp, 0x19, 0x4418); + mdio_write(tp, 0x15, 0x025f); + mdio_write(tp, 0x19, 0x6900); + mdio_write(tp, 0x15, 0x0260); + mdio_write(tp, 0x19, 0x31f5); + mdio_write(tp, 0x15, 0x0261); + mdio_write(tp, 0x19, 0xb64b); + mdio_write(tp, 0x15, 0x0262); + mdio_write(tp, 0x19, 0xdb00); + mdio_write(tp, 0x15, 0x0263); + mdio_write(tp, 0x19, 0x0048); + mdio_write(tp, 0x15, 0x0264); + mdio_write(tp, 0x19, 0xdb7d); + mdio_write(tp, 0x15, 0x0265); + mdio_write(tp, 0x19, 0x0002); + mdio_write(tp, 0x15, 0x0266); + mdio_write(tp, 0x19, 0xa0fa); + mdio_write(tp, 0x15, 0x0267); + mdio_write(tp, 0x19, 0x4408); + mdio_write(tp, 0x15, 0x0268); + mdio_write(tp, 0x19, 0x3248); + mdio_write(tp, 0x15, 0x0269); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x026a); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x026b); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x026c); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x026d); + mdio_write(tp, 0x19, 0xb806); + mdio_write(tp, 0x15, 0x026e); + mdio_write(tp, 0x19, 0x588d); + mdio_write(tp, 0x15, 0x026f); + mdio_write(tp, 0x19, 0x5500); + mdio_write(tp, 0x15, 0x0270); + mdio_write(tp, 0x19, 0x7801); + mdio_write(tp, 0x15, 0x0271); + mdio_write(tp, 0x19, 0x4002); + mdio_write(tp, 0x15, 0x0272); + mdio_write(tp, 0x19, 0x7800); + mdio_write(tp, 0x15, 0x0273); + mdio_write(tp, 0x19, 0x4814); + mdio_write(tp, 0x15, 0x0274); + mdio_write(tp, 0x19, 0x500b); + mdio_write(tp, 0x15, 0x0275); + mdio_write(tp, 0x19, 0x4804); + mdio_write(tp, 0x15, 0x0276); + mdio_write(tp, 0x19, 0x40c4); + mdio_write(tp, 0x15, 0x0277); + mdio_write(tp, 0x19, 0x4425); + mdio_write(tp, 0x15, 0x0278); + mdio_write(tp, 0x19, 0x6a00); + mdio_write(tp, 0x15, 0x0279); + mdio_write(tp, 0x19, 0x31f5); + mdio_write(tp, 0x15, 0x027a); + mdio_write(tp, 0x19, 0xb632); + mdio_write(tp, 0x15, 0x027b); + mdio_write(tp, 0x19, 0xdc03); + mdio_write(tp, 0x15, 0x027c); + mdio_write(tp, 0x19, 0x0027); + mdio_write(tp, 0x15, 0x027d); + mdio_write(tp, 0x19, 0x80fc); + mdio_write(tp, 0x15, 0x027e); + mdio_write(tp, 0x19, 0x3283); + mdio_write(tp, 0x15, 0x027f); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0280); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0281); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0282); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0283); + mdio_write(tp, 0x19, 0xb806); + mdio_write(tp, 0x15, 0x0284); + mdio_write(tp, 0x19, 0x588f); + mdio_write(tp, 0x15, 0x0285); + mdio_write(tp, 0x19, 0x5520); + mdio_write(tp, 0x15, 0x0286); + mdio_write(tp, 0x19, 0x7801); + mdio_write(tp, 0x15, 0x0287); + mdio_write(tp, 0x19, 0x4000); + mdio_write(tp, 0x15, 0x0288); + mdio_write(tp, 0x19, 0x7800); + mdio_write(tp, 0x15, 0x0289); + mdio_write(tp, 0x19, 0x4818); + mdio_write(tp, 0x15, 0x028a); + mdio_write(tp, 0x19, 0x5051); + mdio_write(tp, 0x15, 0x028b); + mdio_write(tp, 0x19, 0x4808); + mdio_write(tp, 0x15, 0x028c); + mdio_write(tp, 0x19, 0x4050); + mdio_write(tp, 0x15, 0x028d); + mdio_write(tp, 0x19, 0x4462); + mdio_write(tp, 0x15, 0x028e); + mdio_write(tp, 0x19, 0x40c4); + mdio_write(tp, 0x15, 0x028f); + mdio_write(tp, 0x19, 0x4473); + mdio_write(tp, 0x15, 0x0290); + mdio_write(tp, 0x19, 0x5041); + mdio_write(tp, 0x15, 0x0291); + mdio_write(tp, 0x19, 0x6b00); + mdio_write(tp, 0x15, 0x0292); + mdio_write(tp, 0x19, 0x31f5); + mdio_write(tp, 0x15, 0x0293); + mdio_write(tp, 0x19, 0xb619); + mdio_write(tp, 0x15, 0x0294); + mdio_write(tp, 0x19, 0x80d9); + mdio_write(tp, 0x15, 0x0295); + mdio_write(tp, 0x19, 0xbd06); + mdio_write(tp, 0x15, 0x0296); + mdio_write(tp, 0x19, 0xbb0d); + mdio_write(tp, 0x15, 0x0297); + mdio_write(tp, 0x19, 0xaf14); + mdio_write(tp, 0x15, 0x0298); + mdio_write(tp, 0x19, 0x8efa); + mdio_write(tp, 0x15, 0x0299); + mdio_write(tp, 0x19, 0x5049); + mdio_write(tp, 0x15, 0x029a); + mdio_write(tp, 0x19, 0x3248); + mdio_write(tp, 0x15, 0x029b); + mdio_write(tp, 0x19, 0x4c10); + mdio_write(tp, 0x15, 0x029c); + mdio_write(tp, 0x19, 0x44b0); + mdio_write(tp, 0x15, 0x029d); + mdio_write(tp, 0x19, 0x4c00); + mdio_write(tp, 0x15, 0x029e); + mdio_write(tp, 0x19, 0x3292); + mdio_write(tp, 0x15, 0x029f); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x02a0); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x02a1); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x02a2); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x02a3); + mdio_write(tp, 0x19, 0x481f); + mdio_write(tp, 0x15, 0x02a4); + mdio_write(tp, 0x19, 0x5005); + mdio_write(tp, 0x15, 0x02a5); + mdio_write(tp, 0x19, 0x480f); + mdio_write(tp, 0x15, 0x02a6); + mdio_write(tp, 0x19, 0xac00); + mdio_write(tp, 0x15, 0x02a7); + mdio_write(tp, 0x19, 0x31a6); + mdio_write(tp, 0x15, 0x02a8); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x02a9); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x02aa); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x02ab); + mdio_write(tp, 0x19, 0x31ba); + mdio_write(tp, 0x15, 0x02ac); + mdio_write(tp, 0x19, 0x31d5); + mdio_write(tp, 0x15, 0x02ad); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x02ae); + mdio_write(tp, 0x19, 0x5cf0); + mdio_write(tp, 0x15, 0x02af); + mdio_write(tp, 0x19, 0x588c); + mdio_write(tp, 0x15, 0x02b0); + mdio_write(tp, 0x19, 0x542f); + mdio_write(tp, 0x15, 0x02b1); + mdio_write(tp, 0x19, 0x7ffb); + mdio_write(tp, 0x15, 0x02b2); + mdio_write(tp, 0x19, 0x6ff8); + mdio_write(tp, 0x15, 0x02b3); + mdio_write(tp, 0x19, 0x64a4); + mdio_write(tp, 0x15, 0x02b4); + mdio_write(tp, 0x19, 0x64a0); + mdio_write(tp, 0x15, 0x02b5); + mdio_write(tp, 0x19, 0x6800); + mdio_write(tp, 0x15, 0x02b6); + mdio_write(tp, 0x19, 0x4400); + mdio_write(tp, 0x15, 0x02b7); + mdio_write(tp, 0x19, 0x4020); + mdio_write(tp, 0x15, 0x02b8); + mdio_write(tp, 0x19, 0x4480); + mdio_write(tp, 0x15, 0x02b9); + mdio_write(tp, 0x19, 0x9e00); + mdio_write(tp, 0x15, 0x02ba); + mdio_write(tp, 0x19, 0x4891); + mdio_write(tp, 0x15, 0x02bb); + mdio_write(tp, 0x19, 0x4cc0); + mdio_write(tp, 0x15, 0x02bc); + mdio_write(tp, 0x19, 0x4801); + mdio_write(tp, 0x15, 0x02bd); + mdio_write(tp, 0x19, 0xa609); + mdio_write(tp, 0x15, 0x02be); + mdio_write(tp, 0x19, 0xd64f); + mdio_write(tp, 0x15, 0x02bf); + mdio_write(tp, 0x19, 0x004e); + mdio_write(tp, 0x15, 0x02c0); + mdio_write(tp, 0x19, 0x87fe); + mdio_write(tp, 0x15, 0x02c1); + mdio_write(tp, 0x19, 0x32c6); + mdio_write(tp, 0x15, 0x02c2); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x02c3); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x02c4); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x02c5); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x02c6); + mdio_write(tp, 0x19, 0x48b2); + mdio_write(tp, 0x15, 0x02c7); + mdio_write(tp, 0x19, 0x4020); + mdio_write(tp, 0x15, 0x02c8); + mdio_write(tp, 0x19, 0x4822); + mdio_write(tp, 0x15, 0x02c9); + mdio_write(tp, 0x19, 0x4488); + mdio_write(tp, 0x15, 0x02ca); + mdio_write(tp, 0x19, 0xd64f); + mdio_write(tp, 0x15, 0x02cb); + mdio_write(tp, 0x19, 0x0042); + mdio_write(tp, 0x15, 0x02cc); + mdio_write(tp, 0x19, 0x8203); + mdio_write(tp, 0x15, 0x02cd); + mdio_write(tp, 0x19, 0x4cc8); + mdio_write(tp, 0x15, 0x02ce); + mdio_write(tp, 0x19, 0x32d0); + mdio_write(tp, 0x15, 0x02cf); + mdio_write(tp, 0x19, 0x4cc0); + mdio_write(tp, 0x15, 0x02d0); + mdio_write(tp, 0x19, 0xc4d4); + mdio_write(tp, 0x15, 0x02d1); + mdio_write(tp, 0x19, 0x00f9); + mdio_write(tp, 0x15, 0x02d2); + mdio_write(tp, 0x19, 0xa51a); + mdio_write(tp, 0x15, 0x02d3); + mdio_write(tp, 0x19, 0x32d9); + mdio_write(tp, 0x15, 0x02d4); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x02d5); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x02d6); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x02d7); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x02d8); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x02d9); + mdio_write(tp, 0x19, 0x48b3); + mdio_write(tp, 0x15, 0x02da); + mdio_write(tp, 0x19, 0x4020); + mdio_write(tp, 0x15, 0x02db); + mdio_write(tp, 0x19, 0x4823); + mdio_write(tp, 0x15, 0x02dc); + mdio_write(tp, 0x19, 0x4410); + mdio_write(tp, 0x15, 0x02dd); + mdio_write(tp, 0x19, 0xb630); + mdio_write(tp, 0x15, 0x02de); + mdio_write(tp, 0x19, 0x7dc8); + mdio_write(tp, 0x15, 0x02df); + mdio_write(tp, 0x19, 0x8203); + mdio_write(tp, 0x15, 0x02e0); + mdio_write(tp, 0x19, 0x4c48); + mdio_write(tp, 0x15, 0x02e1); + mdio_write(tp, 0x19, 0x32e3); + mdio_write(tp, 0x15, 0x02e2); + mdio_write(tp, 0x19, 0x4c40); + mdio_write(tp, 0x15, 0x02e3); + mdio_write(tp, 0x19, 0x9bfa); + mdio_write(tp, 0x15, 0x02e4); + mdio_write(tp, 0x19, 0x84ca); + mdio_write(tp, 0x15, 0x02e5); + mdio_write(tp, 0x19, 0x85f8); + mdio_write(tp, 0x15, 0x02e6); + mdio_write(tp, 0x19, 0x32ec); + mdio_write(tp, 0x15, 0x02e7); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x02e8); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x02e9); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x02ea); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x02eb); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x02ec); + mdio_write(tp, 0x19, 0x48d4); + mdio_write(tp, 0x15, 0x02ed); + mdio_write(tp, 0x19, 0x4020); + mdio_write(tp, 0x15, 0x02ee); + mdio_write(tp, 0x19, 0x4844); + mdio_write(tp, 0x15, 0x02ef); + mdio_write(tp, 0x19, 0x4420); + mdio_write(tp, 0x15, 0x02f0); + mdio_write(tp, 0x19, 0x6800); + mdio_write(tp, 0x15, 0x02f1); + mdio_write(tp, 0x19, 0x7dc0); + mdio_write(tp, 0x15, 0x02f2); + mdio_write(tp, 0x19, 0x4c40); + mdio_write(tp, 0x15, 0x02f3); + mdio_write(tp, 0x19, 0x7c0b); + mdio_write(tp, 0x15, 0x02f4); + mdio_write(tp, 0x19, 0x6c08); + mdio_write(tp, 0x15, 0x02f5); + mdio_write(tp, 0x19, 0x3311); + mdio_write(tp, 0x15, 0x02f6); + mdio_write(tp, 0x19, 0x9cfd); + mdio_write(tp, 0x15, 0x02f7); + mdio_write(tp, 0x19, 0xb616); + mdio_write(tp, 0x15, 0x02f8); + mdio_write(tp, 0x19, 0xc42b); + mdio_write(tp, 0x15, 0x02f9); + mdio_write(tp, 0x19, 0x00e0); + mdio_write(tp, 0x15, 0x02fa); + mdio_write(tp, 0x19, 0xc455); + mdio_write(tp, 0x15, 0x02fb); + mdio_write(tp, 0x19, 0x00b3); + mdio_write(tp, 0x15, 0x02fc); + mdio_write(tp, 0x19, 0xb20a); + mdio_write(tp, 0x15, 0x02fd); + mdio_write(tp, 0x19, 0x7c03); + mdio_write(tp, 0x15, 0x02fe); + mdio_write(tp, 0x19, 0x6c02); + mdio_write(tp, 0x15, 0x02ff); + mdio_write(tp, 0x19, 0x8204); + mdio_write(tp, 0x15, 0x0300); + mdio_write(tp, 0x19, 0x7c04); + mdio_write(tp, 0x15, 0x0301); + mdio_write(tp, 0x19, 0x7404); + mdio_write(tp, 0x15, 0x0302); + mdio_write(tp, 0x19, 0x32f3); + mdio_write(tp, 0x15, 0x0303); + mdio_write(tp, 0x19, 0x7c04); + mdio_write(tp, 0x15, 0x0304); + mdio_write(tp, 0x19, 0x7400); + mdio_write(tp, 0x15, 0x0305); + mdio_write(tp, 0x19, 0x32f3); + mdio_write(tp, 0x15, 0x0306); + mdio_write(tp, 0x19, 0xefed); + mdio_write(tp, 0x15, 0x0307); + mdio_write(tp, 0x19, 0x3342); + mdio_write(tp, 0x15, 0x0308); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0309); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x030a); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x030b); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x030c); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x030d); + mdio_write(tp, 0x19, 0x3006); + mdio_write(tp, 0x15, 0x030e); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x030f); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0310); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0311); + mdio_write(tp, 0x19, 0x7c08); + mdio_write(tp, 0x15, 0x0312); + mdio_write(tp, 0x19, 0xa207); + mdio_write(tp, 0x15, 0x0313); + mdio_write(tp, 0x19, 0x4c00); + mdio_write(tp, 0x15, 0x0314); + mdio_write(tp, 0x19, 0x3322); + mdio_write(tp, 0x15, 0x0315); + mdio_write(tp, 0x19, 0x4041); + mdio_write(tp, 0x15, 0x0316); + mdio_write(tp, 0x19, 0x7d07); + mdio_write(tp, 0x15, 0x0317); + mdio_write(tp, 0x19, 0x4502); + mdio_write(tp, 0x15, 0x0318); + mdio_write(tp, 0x19, 0x3322); + mdio_write(tp, 0x15, 0x0319); + mdio_write(tp, 0x19, 0x4c08); + mdio_write(tp, 0x15, 0x031a); + mdio_write(tp, 0x19, 0x3322); + mdio_write(tp, 0x15, 0x031b); + mdio_write(tp, 0x19, 0x7d80); + mdio_write(tp, 0x15, 0x031c); + mdio_write(tp, 0x19, 0x5180); + mdio_write(tp, 0x15, 0x031d); + mdio_write(tp, 0x19, 0x3320); + mdio_write(tp, 0x15, 0x031e); + mdio_write(tp, 0x19, 0x7d80); + mdio_write(tp, 0x15, 0x031f); + mdio_write(tp, 0x19, 0x5000); + mdio_write(tp, 0x15, 0x0320); + mdio_write(tp, 0x19, 0x7d07); + mdio_write(tp, 0x15, 0x0321); + mdio_write(tp, 0x19, 0x4402); + mdio_write(tp, 0x15, 0x0322); + mdio_write(tp, 0x19, 0x7c03); + mdio_write(tp, 0x15, 0x0323); + mdio_write(tp, 0x19, 0x6c02); + mdio_write(tp, 0x15, 0x0324); + mdio_write(tp, 0x19, 0x7c03); + mdio_write(tp, 0x15, 0x0325); + mdio_write(tp, 0x19, 0xb30c); + mdio_write(tp, 0x15, 0x0326); + mdio_write(tp, 0x19, 0xb206); + mdio_write(tp, 0x15, 0x0327); + mdio_write(tp, 0x19, 0xb103); + mdio_write(tp, 0x15, 0x0328); + mdio_write(tp, 0x19, 0x6c00); + mdio_write(tp, 0x15, 0x0329); + mdio_write(tp, 0x19, 0x32f6); + mdio_write(tp, 0x15, 0x032a); + mdio_write(tp, 0x19, 0x6c00); + mdio_write(tp, 0x15, 0x032b); + mdio_write(tp, 0x19, 0x3352); + mdio_write(tp, 0x15, 0x032c); + mdio_write(tp, 0x19, 0xb103); + mdio_write(tp, 0x15, 0x032d); + mdio_write(tp, 0x19, 0x6c00); + mdio_write(tp, 0x15, 0x032e); + mdio_write(tp, 0x19, 0x336a); + mdio_write(tp, 0x15, 0x032f); + mdio_write(tp, 0x19, 0x6c00); + mdio_write(tp, 0x15, 0x0330); + mdio_write(tp, 0x19, 0x3382); + mdio_write(tp, 0x15, 0x0331); + mdio_write(tp, 0x19, 0xb206); + mdio_write(tp, 0x15, 0x0332); + mdio_write(tp, 0x19, 0xb103); + mdio_write(tp, 0x15, 0x0333); + mdio_write(tp, 0x19, 0x6c00); + mdio_write(tp, 0x15, 0x0334); + mdio_write(tp, 0x19, 0x3395); + mdio_write(tp, 0x15, 0x0335); + mdio_write(tp, 0x19, 0x6c00); + mdio_write(tp, 0x15, 0x0336); + mdio_write(tp, 0x19, 0x33c6); + mdio_write(tp, 0x15, 0x0337); + mdio_write(tp, 0x19, 0xb103); + mdio_write(tp, 0x15, 0x0338); + mdio_write(tp, 0x19, 0x6c00); + mdio_write(tp, 0x15, 0x0339); + mdio_write(tp, 0x19, 0x33d7); + mdio_write(tp, 0x15, 0x033a); + mdio_write(tp, 0x19, 0x6c00); + mdio_write(tp, 0x15, 0x033b); + mdio_write(tp, 0x19, 0x33f2); + mdio_write(tp, 0x15, 0x033c); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x033d); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x033e); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x033f); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0340); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0341); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0342); + mdio_write(tp, 0x19, 0x49b5); + mdio_write(tp, 0x15, 0x0343); + mdio_write(tp, 0x19, 0x7d00); + mdio_write(tp, 0x15, 0x0344); + mdio_write(tp, 0x19, 0x4d00); + mdio_write(tp, 0x15, 0x0345); + mdio_write(tp, 0x19, 0x6880); + mdio_write(tp, 0x15, 0x0346); + mdio_write(tp, 0x19, 0x7c08); + mdio_write(tp, 0x15, 0x0347); + mdio_write(tp, 0x19, 0x6c08); + mdio_write(tp, 0x15, 0x0348); + mdio_write(tp, 0x19, 0x4925); + mdio_write(tp, 0x15, 0x0349); + mdio_write(tp, 0x19, 0x403b); + mdio_write(tp, 0x15, 0x034a); + mdio_write(tp, 0x19, 0xa602); + mdio_write(tp, 0x15, 0x034b); + mdio_write(tp, 0x19, 0x402f); + mdio_write(tp, 0x15, 0x034c); + mdio_write(tp, 0x19, 0x4484); + mdio_write(tp, 0x15, 0x034d); + mdio_write(tp, 0x19, 0x40c8); + mdio_write(tp, 0x15, 0x034e); + mdio_write(tp, 0x19, 0x44c4); + mdio_write(tp, 0x15, 0x034f); + mdio_write(tp, 0x19, 0xd64f); + mdio_write(tp, 0x15, 0x0350); + mdio_write(tp, 0x19, 0x00bd); + mdio_write(tp, 0x15, 0x0351); + mdio_write(tp, 0x19, 0x3311); + mdio_write(tp, 0x15, 0x0352); + mdio_write(tp, 0x19, 0xc8ed); + mdio_write(tp, 0x15, 0x0353); + mdio_write(tp, 0x19, 0x00fc); + mdio_write(tp, 0x15, 0x0354); + mdio_write(tp, 0x19, 0x8221); + mdio_write(tp, 0x15, 0x0355); + mdio_write(tp, 0x19, 0xd11d); + mdio_write(tp, 0x15, 0x0356); + mdio_write(tp, 0x19, 0x001f); + mdio_write(tp, 0x15, 0x0357); + mdio_write(tp, 0x19, 0xde18); + mdio_write(tp, 0x15, 0x0358); + mdio_write(tp, 0x19, 0x0008); + mdio_write(tp, 0x15, 0x0359); + mdio_write(tp, 0x19, 0x91f6); + mdio_write(tp, 0x15, 0x035a); + mdio_write(tp, 0x19, 0x3360); + mdio_write(tp, 0x15, 0x035b); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x035c); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x035d); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x035e); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x035f); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0360); + mdio_write(tp, 0x19, 0x4bb6); + mdio_write(tp, 0x15, 0x0361); + mdio_write(tp, 0x19, 0x4064); + mdio_write(tp, 0x15, 0x0362); + mdio_write(tp, 0x19, 0x4b26); + mdio_write(tp, 0x15, 0x0363); + mdio_write(tp, 0x19, 0x4410); + mdio_write(tp, 0x15, 0x0364); + mdio_write(tp, 0x19, 0x4006); + mdio_write(tp, 0x15, 0x0365); + mdio_write(tp, 0x19, 0x4490); + mdio_write(tp, 0x15, 0x0366); + mdio_write(tp, 0x19, 0x6900); + mdio_write(tp, 0x15, 0x0367); + mdio_write(tp, 0x19, 0xb6a6); + mdio_write(tp, 0x15, 0x0368); + mdio_write(tp, 0x19, 0x9e02); + mdio_write(tp, 0x15, 0x0369); + mdio_write(tp, 0x19, 0x3311); + mdio_write(tp, 0x15, 0x036a); + mdio_write(tp, 0x19, 0xd11d); + mdio_write(tp, 0x15, 0x036b); + mdio_write(tp, 0x19, 0x000a); + mdio_write(tp, 0x15, 0x036c); + mdio_write(tp, 0x19, 0xbb0f); + mdio_write(tp, 0x15, 0x036d); + mdio_write(tp, 0x19, 0x8102); + mdio_write(tp, 0x15, 0x036e); + mdio_write(tp, 0x19, 0x3371); + mdio_write(tp, 0x15, 0x036f); + mdio_write(tp, 0x19, 0xa21e); + mdio_write(tp, 0x15, 0x0370); + mdio_write(tp, 0x19, 0x33b6); + mdio_write(tp, 0x15, 0x0371); + mdio_write(tp, 0x19, 0x91f6); + mdio_write(tp, 0x15, 0x0372); + mdio_write(tp, 0x19, 0xc218); + mdio_write(tp, 0x15, 0x0373); + mdio_write(tp, 0x19, 0x00f4); + mdio_write(tp, 0x15, 0x0374); + mdio_write(tp, 0x19, 0x33b6); + mdio_write(tp, 0x15, 0x0375); + mdio_write(tp, 0x19, 0x32ec); + mdio_write(tp, 0x15, 0x0376); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0377); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0378); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x0379); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x037a); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x037b); + mdio_write(tp, 0x19, 0x4b97); + mdio_write(tp, 0x15, 0x037c); + mdio_write(tp, 0x19, 0x402b); + mdio_write(tp, 0x15, 0x037d); + mdio_write(tp, 0x19, 0x4b07); + mdio_write(tp, 0x15, 0x037e); + mdio_write(tp, 0x19, 0x4422); + mdio_write(tp, 0x15, 0x037f); + mdio_write(tp, 0x19, 0x6980); + mdio_write(tp, 0x15, 0x0380); + mdio_write(tp, 0x19, 0xb608); + mdio_write(tp, 0x15, 0x0381); + mdio_write(tp, 0x19, 0x3311); + mdio_write(tp, 0x15, 0x0382); + mdio_write(tp, 0x19, 0xbc05); + mdio_write(tp, 0x15, 0x0383); + mdio_write(tp, 0x19, 0xc21c); + mdio_write(tp, 0x15, 0x0384); + mdio_write(tp, 0x19, 0x0032); + mdio_write(tp, 0x15, 0x0385); + mdio_write(tp, 0x19, 0xa1fb); + mdio_write(tp, 0x15, 0x0386); + mdio_write(tp, 0x19, 0x338d); + mdio_write(tp, 0x15, 0x0387); + mdio_write(tp, 0x19, 0x32ae); + mdio_write(tp, 0x15, 0x0388); + mdio_write(tp, 0x19, 0x330d); + mdio_write(tp, 0x15, 0x0389); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x038a); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x038b); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x038c); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x038d); + mdio_write(tp, 0x19, 0x4b97); + mdio_write(tp, 0x15, 0x038e); + mdio_write(tp, 0x19, 0x6a08); + mdio_write(tp, 0x15, 0x038f); + mdio_write(tp, 0x19, 0x4b07); + mdio_write(tp, 0x15, 0x0390); + mdio_write(tp, 0x19, 0x40ac); + mdio_write(tp, 0x15, 0x0391); + mdio_write(tp, 0x19, 0x4445); + mdio_write(tp, 0x15, 0x0392); + mdio_write(tp, 0x19, 0x404e); + mdio_write(tp, 0x15, 0x0393); + mdio_write(tp, 0x19, 0x4461); + mdio_write(tp, 0x15, 0x0394); + mdio_write(tp, 0x19, 0x3311); + mdio_write(tp, 0x15, 0x0395); + mdio_write(tp, 0x19, 0x9c0a); + mdio_write(tp, 0x15, 0x0396); + mdio_write(tp, 0x19, 0x63da); + mdio_write(tp, 0x15, 0x0397); + mdio_write(tp, 0x19, 0x6f0c); + mdio_write(tp, 0x15, 0x0398); + mdio_write(tp, 0x19, 0x5440); + mdio_write(tp, 0x15, 0x0399); + mdio_write(tp, 0x19, 0x4b98); + mdio_write(tp, 0x15, 0x039a); + mdio_write(tp, 0x19, 0x7c40); + mdio_write(tp, 0x15, 0x039b); + mdio_write(tp, 0x19, 0x4c00); + mdio_write(tp, 0x15, 0x039c); + mdio_write(tp, 0x19, 0x4b08); + mdio_write(tp, 0x15, 0x039d); + mdio_write(tp, 0x19, 0x63d8); + mdio_write(tp, 0x15, 0x039e); + mdio_write(tp, 0x19, 0x33a5); + mdio_write(tp, 0x15, 0x039f); + mdio_write(tp, 0x19, 0xd64f); + mdio_write(tp, 0x15, 0x03a0); + mdio_write(tp, 0x19, 0x00e8); + mdio_write(tp, 0x15, 0x03a1); + mdio_write(tp, 0x19, 0x820e); + mdio_write(tp, 0x15, 0x03a2); + mdio_write(tp, 0x19, 0xa10d); + mdio_write(tp, 0x15, 0x03a3); + mdio_write(tp, 0x19, 0x9df1); + mdio_write(tp, 0x15, 0x03a4); + mdio_write(tp, 0x19, 0x33af); + mdio_write(tp, 0x15, 0x03a5); + mdio_write(tp, 0x19, 0xd64f); + mdio_write(tp, 0x15, 0x03a6); + mdio_write(tp, 0x19, 0x00f9); + mdio_write(tp, 0x15, 0x03a7); + mdio_write(tp, 0x19, 0xc017); + mdio_write(tp, 0x15, 0x03a8); + mdio_write(tp, 0x19, 0x0007); + mdio_write(tp, 0x15, 0x03a9); + mdio_write(tp, 0x19, 0x7c03); + mdio_write(tp, 0x15, 0x03aa); + mdio_write(tp, 0x19, 0x6c03); + mdio_write(tp, 0x15, 0x03ab); + mdio_write(tp, 0x19, 0xa104); + mdio_write(tp, 0x15, 0x03ac); + mdio_write(tp, 0x19, 0x7c03); + mdio_write(tp, 0x15, 0x03ad); + mdio_write(tp, 0x19, 0x6c00); + mdio_write(tp, 0x15, 0x03ae); + mdio_write(tp, 0x19, 0x9df7); + mdio_write(tp, 0x15, 0x03af); + mdio_write(tp, 0x19, 0x7c03); + mdio_write(tp, 0x15, 0x03b0); + mdio_write(tp, 0x19, 0x6c08); + mdio_write(tp, 0x15, 0x03b1); + mdio_write(tp, 0x19, 0x33b6); + mdio_write(tp, 0x15, 0x03b2); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03b3); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03b4); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03b5); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03b6); + mdio_write(tp, 0x19, 0x55af); + mdio_write(tp, 0x15, 0x03b7); + mdio_write(tp, 0x19, 0x7ff0); + mdio_write(tp, 0x15, 0x03b8); + mdio_write(tp, 0x19, 0x6ff0); + mdio_write(tp, 0x15, 0x03b9); + mdio_write(tp, 0x19, 0x4bb9); + mdio_write(tp, 0x15, 0x03ba); + mdio_write(tp, 0x19, 0x6a80); + mdio_write(tp, 0x15, 0x03bb); + mdio_write(tp, 0x19, 0x4b29); + mdio_write(tp, 0x15, 0x03bc); + mdio_write(tp, 0x19, 0x4041); + mdio_write(tp, 0x15, 0x03bd); + mdio_write(tp, 0x19, 0x440a); + mdio_write(tp, 0x15, 0x03be); + mdio_write(tp, 0x19, 0x4029); + mdio_write(tp, 0x15, 0x03bf); + mdio_write(tp, 0x19, 0x4418); + mdio_write(tp, 0x15, 0x03c0); + mdio_write(tp, 0x19, 0x4090); + mdio_write(tp, 0x15, 0x03c1); + mdio_write(tp, 0x19, 0x4438); + mdio_write(tp, 0x15, 0x03c2); + mdio_write(tp, 0x19, 0x40c4); + mdio_write(tp, 0x15, 0x03c3); + mdio_write(tp, 0x19, 0x447b); + mdio_write(tp, 0x15, 0x03c4); + mdio_write(tp, 0x19, 0xb6c4); + mdio_write(tp, 0x15, 0x03c5); + mdio_write(tp, 0x19, 0x3311); + mdio_write(tp, 0x15, 0x03c6); + mdio_write(tp, 0x19, 0x9bfe); + mdio_write(tp, 0x15, 0x03c7); + mdio_write(tp, 0x19, 0x33cc); + mdio_write(tp, 0x15, 0x03c8); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03c9); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03ca); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03cb); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03cc); + mdio_write(tp, 0x19, 0x542f); + mdio_write(tp, 0x15, 0x03cd); + mdio_write(tp, 0x19, 0x499a); + mdio_write(tp, 0x15, 0x03ce); + mdio_write(tp, 0x19, 0x7c40); + mdio_write(tp, 0x15, 0x03cf); + mdio_write(tp, 0x19, 0x4c40); + mdio_write(tp, 0x15, 0x03d0); + mdio_write(tp, 0x19, 0x490a); + mdio_write(tp, 0x15, 0x03d1); + mdio_write(tp, 0x19, 0x405e); + mdio_write(tp, 0x15, 0x03d2); + mdio_write(tp, 0x19, 0x44f8); + mdio_write(tp, 0x15, 0x03d3); + mdio_write(tp, 0x19, 0x6b00); + mdio_write(tp, 0x15, 0x03d4); + mdio_write(tp, 0x19, 0xd64f); + mdio_write(tp, 0x15, 0x03d5); + mdio_write(tp, 0x19, 0x0028); + mdio_write(tp, 0x15, 0x03d6); + mdio_write(tp, 0x19, 0x3311); + mdio_write(tp, 0x15, 0x03d7); + mdio_write(tp, 0x19, 0xbd27); + mdio_write(tp, 0x15, 0x03d8); + mdio_write(tp, 0x19, 0x9cfc); + mdio_write(tp, 0x15, 0x03d9); + mdio_write(tp, 0x19, 0xc639); + mdio_write(tp, 0x15, 0x03da); + mdio_write(tp, 0x19, 0x000f); + mdio_write(tp, 0x15, 0x03db); + mdio_write(tp, 0x19, 0x9e03); + mdio_write(tp, 0x15, 0x03dc); + mdio_write(tp, 0x19, 0x7c01); + mdio_write(tp, 0x15, 0x03dd); + mdio_write(tp, 0x19, 0x4c01); + mdio_write(tp, 0x15, 0x03de); + mdio_write(tp, 0x19, 0x9af6); + mdio_write(tp, 0x15, 0x03df); + mdio_write(tp, 0x19, 0x7c12); + mdio_write(tp, 0x15, 0x03e0); + mdio_write(tp, 0x19, 0x4c52); + mdio_write(tp, 0x15, 0x03e1); + mdio_write(tp, 0x19, 0x4470); + mdio_write(tp, 0x15, 0x03e2); + mdio_write(tp, 0x19, 0x7c12); + mdio_write(tp, 0x15, 0x03e3); + mdio_write(tp, 0x19, 0x4c40); + mdio_write(tp, 0x15, 0x03e4); + mdio_write(tp, 0x19, 0x33d4); + mdio_write(tp, 0x15, 0x03e5); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03e6); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03e7); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03e8); + mdio_write(tp, 0x19, 0x0000); + mdio_write(tp, 0x15, 0x03e9); + mdio_write(tp, 0x19, 0x49bb); + mdio_write(tp, 0x15, 0x03ea); + mdio_write(tp, 0x19, 0x4478); + mdio_write(tp, 0x15, 0x03eb); + mdio_write(tp, 0x19, 0x492b); + mdio_write(tp, 0x15, 0x03ec); + mdio_write(tp, 0x19, 0x6b80); + mdio_write(tp, 0x15, 0x03ed); + mdio_write(tp, 0x19, 0x7c01); + mdio_write(tp, 0x15, 0x03ee); + mdio_write(tp, 0x19, 0x4c00); + mdio_write(tp, 0x15, 0x03ef); + mdio_write(tp, 0x19, 0xd64f); + mdio_write(tp, 0x15, 0x03f0); + mdio_write(tp, 0x19, 0x000d); + mdio_write(tp, 0x15, 0x03f1); + mdio_write(tp, 0x19, 0x3311); + mdio_write(tp, 0x15, 0x03f2); + mdio_write(tp, 0x19, 0xbd0c); + mdio_write(tp, 0x15, 0x03f3); + mdio_write(tp, 0x19, 0xc428); + mdio_write(tp, 0x15, 0x03f4); + mdio_write(tp, 0x19, 0x0008); + mdio_write(tp, 0x15, 0x03f5); + mdio_write(tp, 0x19, 0x9afa); + mdio_write(tp, 0x15, 0x03f6); + mdio_write(tp, 0x19, 0x7c12); + mdio_write(tp, 0x15, 0x03f7); + mdio_write(tp, 0x19, 0x4c52); + mdio_write(tp, 0x15, 0x03f8); + mdio_write(tp, 0x19, 0x4470); + mdio_write(tp, 0x15, 0x03f9); + mdio_write(tp, 0x19, 0x7c12); + mdio_write(tp, 0x15, 0x03fa); + mdio_write(tp, 0x19, 0x4c40); + mdio_write(tp, 0x15, 0x03fb); + mdio_write(tp, 0x19, 0x33ef); + mdio_write(tp, 0x15, 0x03fc); + mdio_write(tp, 0x19, 0x3342); + mdio_write(tp, 0x15, 0x03fd); + mdio_write(tp, 0x19, 0x330d); + mdio_write(tp, 0x15, 0x03fe); + mdio_write(tp, 0x19, 0x32ae); + mdio_write(tp, 0x15, 0x0000); + mdio_write(tp, 0x16, 0x0306); + mdio_write(tp, 0x16, 0x0300); + mdio_write(tp, 0x1f, 0x0002); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x05, 0xfff6); + mdio_write(tp, 0x06, 0x0080); + mdio_write(tp, 0x05, 0x8000); + mdio_write(tp, 0x06, 0x0280); + mdio_write(tp, 0x06, 0x48f7); + mdio_write(tp, 0x06, 0x00e0); + mdio_write(tp, 0x06, 0xfff7); + mdio_write(tp, 0x06, 0xa080); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0xf602); + mdio_write(tp, 0x06, 0x0112); + mdio_write(tp, 0x06, 0x0201); + mdio_write(tp, 0x06, 0x1f02); + mdio_write(tp, 0x06, 0x012c); + mdio_write(tp, 0x06, 0x0201); + mdio_write(tp, 0x06, 0x3c02); + mdio_write(tp, 0x06, 0x0156); + mdio_write(tp, 0x06, 0x0201); + mdio_write(tp, 0x06, 0x6d02); + mdio_write(tp, 0x06, 0x809d); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x88e1); + mdio_write(tp, 0x06, 0x8b89); + mdio_write(tp, 0x06, 0x1e01); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x8a1e); + mdio_write(tp, 0x06, 0x01e1); + mdio_write(tp, 0x06, 0x8b8b); + mdio_write(tp, 0x06, 0x1e01); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x8c1e); + mdio_write(tp, 0x06, 0x01e1); + mdio_write(tp, 0x06, 0x8b8d); + mdio_write(tp, 0x06, 0x1e01); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x8e1e); + mdio_write(tp, 0x06, 0x01a0); + mdio_write(tp, 0x06, 0x00c7); + mdio_write(tp, 0x06, 0xaebb); + mdio_write(tp, 0x06, 0xd100); + mdio_write(tp, 0x06, 0xbf82); + mdio_write(tp, 0x06, 0xc702); + mdio_write(tp, 0x06, 0x320a); + mdio_write(tp, 0x06, 0xd105); + mdio_write(tp, 0x06, 0xbf82); + mdio_write(tp, 0x06, 0xcd02); + mdio_write(tp, 0x06, 0x320a); + mdio_write(tp, 0x06, 0xd100); + mdio_write(tp, 0x06, 0xbf82); + mdio_write(tp, 0x06, 0xca02); + mdio_write(tp, 0x06, 0x320a); + mdio_write(tp, 0x06, 0xd105); + mdio_write(tp, 0x06, 0xbf82); + mdio_write(tp, 0x06, 0xd002); + mdio_write(tp, 0x06, 0x320a); + mdio_write(tp, 0x06, 0xd481); + mdio_write(tp, 0x06, 0xc9e4); + mdio_write(tp, 0x06, 0x8b90); + mdio_write(tp, 0x06, 0xe58b); + mdio_write(tp, 0x06, 0x91d4); + mdio_write(tp, 0x06, 0x81b8); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x92e5); + mdio_write(tp, 0x06, 0x8b93); + mdio_write(tp, 0x06, 0xbf8b); + mdio_write(tp, 0x06, 0x88ec); + mdio_write(tp, 0x06, 0x0019); + mdio_write(tp, 0x06, 0xa98b); + mdio_write(tp, 0x06, 0x90f9); + mdio_write(tp, 0x06, 0xeeff); + mdio_write(tp, 0x06, 0xf600); + mdio_write(tp, 0x06, 0xeeff); + mdio_write(tp, 0x06, 0xf7fc); + mdio_write(tp, 0x06, 0xd100); + mdio_write(tp, 0x06, 0xbf82); + mdio_write(tp, 0x06, 0xc102); + mdio_write(tp, 0x06, 0x320a); + mdio_write(tp, 0x06, 0xd101); + mdio_write(tp, 0x06, 0xbf82); + mdio_write(tp, 0x06, 0xc402); + mdio_write(tp, 0x06, 0x320a); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x8ead); + mdio_write(tp, 0x06, 0x201a); + mdio_write(tp, 0x06, 0xf620); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x8e02); + mdio_write(tp, 0x06, 0x824b); + mdio_write(tp, 0x06, 0x0281); + mdio_write(tp, 0x06, 0x1902); + mdio_write(tp, 0x06, 0x2c9d); + mdio_write(tp, 0x06, 0x0203); + mdio_write(tp, 0x06, 0x9602); + mdio_write(tp, 0x06, 0x0473); + mdio_write(tp, 0x06, 0x022e); + mdio_write(tp, 0x06, 0x3902); + mdio_write(tp, 0x06, 0x044d); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x8ead); + mdio_write(tp, 0x06, 0x210b); + mdio_write(tp, 0x06, 0xf621); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x8e02); + mdio_write(tp, 0x06, 0x0416); + mdio_write(tp, 0x06, 0x021b); + mdio_write(tp, 0x06, 0xa4e0); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xad22); + mdio_write(tp, 0x06, 0x05f6); + mdio_write(tp, 0x06, 0x22e4); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x8ead); + mdio_write(tp, 0x06, 0x2305); + mdio_write(tp, 0x06, 0xf623); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x8ee0); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xad24); + mdio_write(tp, 0x06, 0x05f6); + mdio_write(tp, 0x06, 0x24e4); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x8ead); + mdio_write(tp, 0x06, 0x2505); + mdio_write(tp, 0x06, 0xf625); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x8ee0); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xad26); + mdio_write(tp, 0x06, 0x08f6); + mdio_write(tp, 0x06, 0x26e4); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0x0281); + mdio_write(tp, 0x06, 0xdae0); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xad27); + mdio_write(tp, 0x06, 0x05f6); + mdio_write(tp, 0x06, 0x27e4); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0x0203); + mdio_write(tp, 0x06, 0x5cfc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xfaef); + mdio_write(tp, 0x06, 0x69e0); + mdio_write(tp, 0x06, 0x8b85); + mdio_write(tp, 0x06, 0xad21); + mdio_write(tp, 0x06, 0x57e0); + mdio_write(tp, 0x06, 0xe022); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0x2358); + mdio_write(tp, 0x06, 0xc059); + mdio_write(tp, 0x06, 0x021e); + mdio_write(tp, 0x06, 0x01e1); + mdio_write(tp, 0x06, 0x8b3c); + mdio_write(tp, 0x06, 0x1f10); + mdio_write(tp, 0x06, 0x9e44); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x3cad); + mdio_write(tp, 0x06, 0x211d); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x84f7); + mdio_write(tp, 0x06, 0x29e5); + mdio_write(tp, 0x06, 0x8b84); + mdio_write(tp, 0x06, 0xac27); + mdio_write(tp, 0x06, 0x0dac); + mdio_write(tp, 0x06, 0x2605); + mdio_write(tp, 0x06, 0x0281); + mdio_write(tp, 0x06, 0x7fae); + mdio_write(tp, 0x06, 0x2b02); + mdio_write(tp, 0x06, 0x2c23); + mdio_write(tp, 0x06, 0xae26); + mdio_write(tp, 0x06, 0x022c); + mdio_write(tp, 0x06, 0x41ae); + mdio_write(tp, 0x06, 0x21e0); + mdio_write(tp, 0x06, 0x8b87); + mdio_write(tp, 0x06, 0xad22); + mdio_write(tp, 0x06, 0x18e0); + mdio_write(tp, 0x06, 0xfff7); + mdio_write(tp, 0x06, 0x58fc); + mdio_write(tp, 0x06, 0xe4ff); + mdio_write(tp, 0x06, 0xf7d1); + mdio_write(tp, 0x06, 0x00bf); + mdio_write(tp, 0x06, 0x2eee); + mdio_write(tp, 0x06, 0x0232); + mdio_write(tp, 0x06, 0x0ad1); + mdio_write(tp, 0x06, 0x00bf); + mdio_write(tp, 0x06, 0x82e8); + mdio_write(tp, 0x06, 0x0232); + mdio_write(tp, 0x06, 0x0a02); + mdio_write(tp, 0x06, 0x2bdf); + mdio_write(tp, 0x06, 0xef96); + mdio_write(tp, 0x06, 0xfefc); + mdio_write(tp, 0x06, 0x04d0); + mdio_write(tp, 0x06, 0x0202); + mdio_write(tp, 0x06, 0x1e97); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x87ad); + mdio_write(tp, 0x06, 0x2228); + mdio_write(tp, 0x06, 0xd100); + mdio_write(tp, 0x06, 0xbf82); + mdio_write(tp, 0x06, 0xd302); + mdio_write(tp, 0x06, 0x320a); + mdio_write(tp, 0x06, 0xd10c); + mdio_write(tp, 0x06, 0xbf82); + mdio_write(tp, 0x06, 0xd602); + mdio_write(tp, 0x06, 0x320a); + mdio_write(tp, 0x06, 0xd104); + mdio_write(tp, 0x06, 0xbf82); + mdio_write(tp, 0x06, 0xd902); + mdio_write(tp, 0x06, 0x320a); + mdio_write(tp, 0x06, 0xd101); + mdio_write(tp, 0x06, 0xbf82); + mdio_write(tp, 0x06, 0xe802); + mdio_write(tp, 0x06, 0x320a); + mdio_write(tp, 0x06, 0xe0ff); + mdio_write(tp, 0x06, 0xf768); + mdio_write(tp, 0x06, 0x03e4); + mdio_write(tp, 0x06, 0xfff7); + mdio_write(tp, 0x06, 0xd004); + mdio_write(tp, 0x06, 0x0228); + mdio_write(tp, 0x06, 0x7a04); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0xe234); + mdio_write(tp, 0x06, 0xe1e2); + mdio_write(tp, 0x06, 0x35f6); + mdio_write(tp, 0x06, 0x2be4); + mdio_write(tp, 0x06, 0xe234); + mdio_write(tp, 0x06, 0xe5e2); + mdio_write(tp, 0x06, 0x35fc); + mdio_write(tp, 0x06, 0x05f8); + mdio_write(tp, 0x06, 0xe0e2); + mdio_write(tp, 0x06, 0x34e1); + mdio_write(tp, 0x06, 0xe235); + mdio_write(tp, 0x06, 0xf72b); + mdio_write(tp, 0x06, 0xe4e2); + mdio_write(tp, 0x06, 0x34e5); + mdio_write(tp, 0x06, 0xe235); + mdio_write(tp, 0x06, 0xfc05); + mdio_write(tp, 0x06, 0xf8f9); + mdio_write(tp, 0x06, 0xfaef); + mdio_write(tp, 0x06, 0x69ac); + mdio_write(tp, 0x06, 0x1b4c); + mdio_write(tp, 0x06, 0xbf2e); + mdio_write(tp, 0x06, 0x3002); + mdio_write(tp, 0x06, 0x31dd); + mdio_write(tp, 0x06, 0xef01); + mdio_write(tp, 0x06, 0xe28a); + mdio_write(tp, 0x06, 0x76e4); + mdio_write(tp, 0x06, 0x8a76); + mdio_write(tp, 0x06, 0x1f12); + mdio_write(tp, 0x06, 0x9e3a); + mdio_write(tp, 0x06, 0xef12); + mdio_write(tp, 0x06, 0x5907); + mdio_write(tp, 0x06, 0x9f12); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0x8b40); + mdio_write(tp, 0x06, 0xf721); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x40d0); + mdio_write(tp, 0x06, 0x0302); + mdio_write(tp, 0x06, 0x287a); + mdio_write(tp, 0x06, 0x0282); + mdio_write(tp, 0x06, 0x34fc); + mdio_write(tp, 0x06, 0xa000); + mdio_write(tp, 0x06, 0x1002); + mdio_write(tp, 0x06, 0x2dc3); + mdio_write(tp, 0x06, 0x022e); + mdio_write(tp, 0x06, 0x21e0); + mdio_write(tp, 0x06, 0x8b40); + mdio_write(tp, 0x06, 0xf621); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x40ae); + mdio_write(tp, 0x06, 0x0fbf); + mdio_write(tp, 0x06, 0x3fa5); + mdio_write(tp, 0x06, 0x0231); + mdio_write(tp, 0x06, 0x6cbf); + mdio_write(tp, 0x06, 0x3fa2); + mdio_write(tp, 0x06, 0x0231); + mdio_write(tp, 0x06, 0x6c02); + mdio_write(tp, 0x06, 0x2dc3); + mdio_write(tp, 0x06, 0xef96); + mdio_write(tp, 0x06, 0xfefd); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0xe2f4); + mdio_write(tp, 0x06, 0xe1e2); + mdio_write(tp, 0x06, 0xf5e4); + mdio_write(tp, 0x06, 0x8a78); + mdio_write(tp, 0x06, 0xe58a); + mdio_write(tp, 0x06, 0x79ee); + mdio_write(tp, 0x06, 0xe2f4); + mdio_write(tp, 0x06, 0xd8ee); + mdio_write(tp, 0x06, 0xe2f5); + mdio_write(tp, 0x06, 0x20fc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xf9fa); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x87ad); + mdio_write(tp, 0x06, 0x2065); + mdio_write(tp, 0x06, 0xd200); + mdio_write(tp, 0x06, 0xbf2e); + mdio_write(tp, 0x06, 0xe802); + mdio_write(tp, 0x06, 0x31dd); + mdio_write(tp, 0x06, 0x1e21); + mdio_write(tp, 0x06, 0xbf82); + mdio_write(tp, 0x06, 0xdf02); + mdio_write(tp, 0x06, 0x31dd); + mdio_write(tp, 0x06, 0x0c11); + mdio_write(tp, 0x06, 0x1e21); + mdio_write(tp, 0x06, 0xbf82); + mdio_write(tp, 0x06, 0xe202); + mdio_write(tp, 0x06, 0x31dd); + mdio_write(tp, 0x06, 0x0c12); + mdio_write(tp, 0x06, 0x1e21); + mdio_write(tp, 0x06, 0xbf82); + mdio_write(tp, 0x06, 0xe502); + mdio_write(tp, 0x06, 0x31dd); + mdio_write(tp, 0x06, 0x0c13); + mdio_write(tp, 0x06, 0x1e21); + mdio_write(tp, 0x06, 0xbf1f); + mdio_write(tp, 0x06, 0x5302); + mdio_write(tp, 0x06, 0x31dd); + mdio_write(tp, 0x06, 0x0c14); + mdio_write(tp, 0x06, 0x1e21); + mdio_write(tp, 0x06, 0xbf82); + mdio_write(tp, 0x06, 0xeb02); + mdio_write(tp, 0x06, 0x31dd); + mdio_write(tp, 0x06, 0x0c16); + mdio_write(tp, 0x06, 0x1e21); + mdio_write(tp, 0x06, 0xe083); + mdio_write(tp, 0x06, 0xe01f); + mdio_write(tp, 0x06, 0x029e); + mdio_write(tp, 0x06, 0x22e6); + mdio_write(tp, 0x06, 0x83e0); + mdio_write(tp, 0x06, 0xad31); + mdio_write(tp, 0x06, 0x14ad); + mdio_write(tp, 0x06, 0x3011); + mdio_write(tp, 0x06, 0xef02); + mdio_write(tp, 0x06, 0x580c); + mdio_write(tp, 0x06, 0x9e07); + mdio_write(tp, 0x06, 0xad36); + mdio_write(tp, 0x06, 0x085a); + mdio_write(tp, 0x06, 0x309f); + mdio_write(tp, 0x06, 0x04d1); + mdio_write(tp, 0x06, 0x01ae); + mdio_write(tp, 0x06, 0x02d1); + mdio_write(tp, 0x06, 0x00bf); + mdio_write(tp, 0x06, 0x82dc); + mdio_write(tp, 0x06, 0x0232); + mdio_write(tp, 0x06, 0x0aef); + mdio_write(tp, 0x06, 0x96fe); + mdio_write(tp, 0x06, 0xfdfc); + mdio_write(tp, 0x06, 0x0400); + mdio_write(tp, 0x06, 0xe140); + mdio_write(tp, 0x06, 0x77e1); + mdio_write(tp, 0x06, 0x4010); + mdio_write(tp, 0x06, 0xe150); + mdio_write(tp, 0x06, 0x32e1); + mdio_write(tp, 0x06, 0x5030); + mdio_write(tp, 0x06, 0xe144); + mdio_write(tp, 0x06, 0x74e1); + mdio_write(tp, 0x06, 0x44bb); + mdio_write(tp, 0x06, 0xe2d2); + mdio_write(tp, 0x06, 0x40e0); + mdio_write(tp, 0x06, 0x2cfc); + mdio_write(tp, 0x06, 0xe2cc); + mdio_write(tp, 0x06, 0xcce2); + mdio_write(tp, 0x06, 0x00cc); + mdio_write(tp, 0x06, 0xe000); + mdio_write(tp, 0x06, 0x99e0); + mdio_write(tp, 0x06, 0x3688); + mdio_write(tp, 0x06, 0xe036); + mdio_write(tp, 0x06, 0x99e1); + mdio_write(tp, 0x06, 0x40dd); + mdio_write(tp, 0x06, 0xe022); + mdio_write(tp, 0x05, 0xe142); + gphy_val = mdio_read(tp, 0x06); + gphy_val |= BIT_0; + mdio_write(tp, 0x06, gphy_val); + mdio_write(tp, 0x05, 0xe140); + gphy_val = mdio_read(tp, 0x06); + gphy_val |= BIT_0; + mdio_write(tp, 0x06, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x1f, 0x0005); + for (i = 0; i < 200; i++) { + udelay(100); + gphy_val = mdio_read(tp, 0x00); + if (gphy_val & BIT_7) + break; + } + mdio_write(tp, 0x1f, 0x0004); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0023); + gphy_val = mdio_read(tp, 0x17); + gphy_val &= ~(BIT_0); + gphy_val |= BIT_2; + mdio_write(tp, 0x17, gphy_val); + mdio_write(tp, 0x1f, 0x0002); + mdio_write(tp, 0x1f, 0x0000); +} + +static void +rtl8168_set_phy_mcu_8168evl_2(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + struct pci_dev *pdev = tp->pci_dev; + unsigned int gphy_val,i; + + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x00, 0x1800); + gphy_val = mdio_read(tp, 0x15); + gphy_val &= ~(BIT_12); + mdio_write(tp, 0x15, gphy_val); + mdio_write(tp, 0x00, 0x4800); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x002f); + for (i = 0; i < 1000; i++) { + udelay(100); + gphy_val = mdio_read(tp, 0x1c); + if ((gphy_val & 0x0080) == 0x0080) + break; + } + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x00, 0x1800); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0023); + for (i = 0; i < 200; i++) { + udelay(100); + gphy_val = mdio_read(tp, 0x17); + if (!(gphy_val & 0x0001)) + break; + } + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x05, 0xfff6); + mdio_write(tp, 0x06, 0x0080); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0023); + mdio_write(tp, 0x16, 0x0306); + mdio_write(tp, 0x16, 0x0307); + mdio_write(tp, 0x15, 0x00AF); + mdio_write(tp, 0x19, 0x4060); + mdio_write(tp, 0x15, 0x00B0); + mdio_write(tp, 0x19, 0x7800); + mdio_write(tp, 0x15, 0x00B1); + mdio_write(tp, 0x19, 0x7e00); + mdio_write(tp, 0x15, 0x00B2); + mdio_write(tp, 0x19, 0x72B0); + mdio_write(tp, 0x15, 0x00B3); + mdio_write(tp, 0x19, 0x7F00); + mdio_write(tp, 0x15, 0x00B4); + mdio_write(tp, 0x19, 0x73B0); + mdio_write(tp, 0x15, 0x0101); + mdio_write(tp, 0x19, 0x0005); + mdio_write(tp, 0x15, 0x0103); + mdio_write(tp, 0x19, 0x0003); + mdio_write(tp, 0x15, 0x0105); + mdio_write(tp, 0x19, 0x30FD); + mdio_write(tp, 0x15, 0x0106); + mdio_write(tp, 0x19, 0x9DF7); + mdio_write(tp, 0x15, 0x0107); + mdio_write(tp, 0x19, 0x30C6); + mdio_write(tp, 0x15, 0x0098); + mdio_write(tp, 0x19, 0x7c0b); + mdio_write(tp, 0x15, 0x0099); + mdio_write(tp, 0x19, 0x6c0b); + mdio_write(tp, 0x15, 0x00eb); + mdio_write(tp, 0x19, 0x6c0b); + mdio_write(tp, 0x15, 0x00f8); + mdio_write(tp, 0x19, 0x6f0b); + mdio_write(tp, 0x15, 0x00fe); + mdio_write(tp, 0x19, 0x6f0f); + mdio_write(tp, 0x15, 0x00db); + mdio_write(tp, 0x19, 0x6f09); + mdio_write(tp, 0x15, 0x00dc); + mdio_write(tp, 0x19, 0xaefd); + mdio_write(tp, 0x15, 0x00dd); + mdio_write(tp, 0x19, 0x6f0b); + mdio_write(tp, 0x15, 0x00de); + mdio_write(tp, 0x19, 0xc60b); + mdio_write(tp, 0x15, 0x00df); + mdio_write(tp, 0x19, 0x00fa); + mdio_write(tp, 0x15, 0x00e0); + mdio_write(tp, 0x19, 0x30e1); + mdio_write(tp, 0x15, 0x020c); + mdio_write(tp, 0x19, 0x3224); + mdio_write(tp, 0x15, 0x020e); + mdio_write(tp, 0x19, 0x9813); + mdio_write(tp, 0x15, 0x020f); + mdio_write(tp, 0x19, 0x7801); + mdio_write(tp, 0x15, 0x0210); + mdio_write(tp, 0x19, 0x930f); + mdio_write(tp, 0x15, 0x0211); + mdio_write(tp, 0x19, 0x9206); + mdio_write(tp, 0x15, 0x0212); + mdio_write(tp, 0x19, 0x4002); + mdio_write(tp, 0x15, 0x0213); + mdio_write(tp, 0x19, 0x7800); + mdio_write(tp, 0x15, 0x0214); + mdio_write(tp, 0x19, 0x588f); + mdio_write(tp, 0x15, 0x0215); + mdio_write(tp, 0x19, 0x5520); + mdio_write(tp, 0x15, 0x0216); + mdio_write(tp, 0x19, 0x3224); + mdio_write(tp, 0x15, 0x0217); + mdio_write(tp, 0x19, 0x4002); + mdio_write(tp, 0x15, 0x0218); + mdio_write(tp, 0x19, 0x7800); + mdio_write(tp, 0x15, 0x0219); + mdio_write(tp, 0x19, 0x588d); + mdio_write(tp, 0x15, 0x021a); + mdio_write(tp, 0x19, 0x5540); + mdio_write(tp, 0x15, 0x021b); + mdio_write(tp, 0x19, 0x9e03); + mdio_write(tp, 0x15, 0x021c); + mdio_write(tp, 0x19, 0x7c40); + mdio_write(tp, 0x15, 0x021d); + mdio_write(tp, 0x19, 0x6840); + mdio_write(tp, 0x15, 0x021e); + mdio_write(tp, 0x19, 0x3224); + mdio_write(tp, 0x15, 0x021f); + mdio_write(tp, 0x19, 0x4002); + mdio_write(tp, 0x15, 0x0220); + mdio_write(tp, 0x19, 0x3224); + mdio_write(tp, 0x15, 0x0221); + mdio_write(tp, 0x19, 0x9e03); + mdio_write(tp, 0x15, 0x0222); + mdio_write(tp, 0x19, 0x7c40); + mdio_write(tp, 0x15, 0x0223); + mdio_write(tp, 0x19, 0x6840); + mdio_write(tp, 0x15, 0x0224); + mdio_write(tp, 0x19, 0x7800); + mdio_write(tp, 0x15, 0x0225); + mdio_write(tp, 0x19, 0x3231); + mdio_write(tp, 0x15, 0x0000); + mdio_write(tp, 0x16, 0x0306); + mdio_write(tp, 0x16, 0x0300); + mdio_write(tp, 0x1f, 0x0002); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x17, 0x2160); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0040); + mdio_write(tp, 0x18, 0x0004); + if (pdev->subsystem_vendor == 0x144d && + pdev->subsystem_device == 0xc0a6) { + mdio_write(tp, 0x18, 0x0724); + mdio_write(tp, 0x19, 0xfe00); + mdio_write(tp, 0x18, 0x0734); + mdio_write(tp, 0x19, 0xfd00); + mdio_write(tp, 0x18, 0x1824); + mdio_write(tp, 0x19, 0xfc00); + mdio_write(tp, 0x18, 0x1834); + mdio_write(tp, 0x19, 0xfd00); + } + mdio_write(tp, 0x18, 0x09d4); + mdio_write(tp, 0x19, 0x4000); + mdio_write(tp, 0x18, 0x09e4); + mdio_write(tp, 0x19, 0x0800); + mdio_write(tp, 0x18, 0x09f4); + mdio_write(tp, 0x19, 0xff00); + mdio_write(tp, 0x18, 0x0a04); + mdio_write(tp, 0x19, 0x4000); + mdio_write(tp, 0x18, 0x0a14); + mdio_write(tp, 0x19, 0x0c00); + mdio_write(tp, 0x18, 0x0a24); + mdio_write(tp, 0x19, 0xff00); + mdio_write(tp, 0x18, 0x0a74); + mdio_write(tp, 0x19, 0xf600); + mdio_write(tp, 0x18, 0x1a24); + mdio_write(tp, 0x19, 0x7d00); + mdio_write(tp, 0x18, 0x1a64); + mdio_write(tp, 0x19, 0x0500); + mdio_write(tp, 0x18, 0x1a74); + mdio_write(tp, 0x19, 0x9500); + mdio_write(tp, 0x18, 0x1a84); + mdio_write(tp, 0x19, 0x8000); + mdio_write(tp, 0x18, 0x1a94); + mdio_write(tp, 0x19, 0x7d00); + mdio_write(tp, 0x18, 0x1aa4); + mdio_write(tp, 0x19, 0x9600); + mdio_write(tp, 0x18, 0x1ac4); + mdio_write(tp, 0x19, 0x4000); + mdio_write(tp, 0x18, 0x1ad4); + mdio_write(tp, 0x19, 0x0800); + mdio_write(tp, 0x18, 0x1af4); + mdio_write(tp, 0x19, 0xc400); + mdio_write(tp, 0x18, 0x1b04); + mdio_write(tp, 0x19, 0x4000); + mdio_write(tp, 0x18, 0x1b14); + mdio_write(tp, 0x19, 0x0800); + mdio_write(tp, 0x18, 0x1b24); + mdio_write(tp, 0x19, 0xfd00); + mdio_write(tp, 0x18, 0x1b34); + mdio_write(tp, 0x19, 0x4000); + mdio_write(tp, 0x18, 0x1b44); + mdio_write(tp, 0x19, 0x0400); + mdio_write(tp, 0x18, 0x1b94); + mdio_write(tp, 0x19, 0xf100); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x17, 0x2100); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0040); + mdio_write(tp, 0x18, 0x0000); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x05, 0xfff6); + mdio_write(tp, 0x06, 0x0080); + mdio_write(tp, 0x05, 0x8000); + mdio_write(tp, 0x06, 0x0280); + mdio_write(tp, 0x06, 0x48f7); + mdio_write(tp, 0x06, 0x00e0); + mdio_write(tp, 0x06, 0xfff7); + mdio_write(tp, 0x06, 0xa080); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0xf602); + mdio_write(tp, 0x06, 0x0115); + mdio_write(tp, 0x06, 0x0201); + mdio_write(tp, 0x06, 0x2202); + mdio_write(tp, 0x06, 0x80a0); + mdio_write(tp, 0x06, 0x0201); + mdio_write(tp, 0x06, 0x3f02); + mdio_write(tp, 0x06, 0x0159); + mdio_write(tp, 0x06, 0x0280); + mdio_write(tp, 0x06, 0xbd02); + mdio_write(tp, 0x06, 0x80da); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x88e1); + mdio_write(tp, 0x06, 0x8b89); + mdio_write(tp, 0x06, 0x1e01); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x8a1e); + mdio_write(tp, 0x06, 0x01e1); + mdio_write(tp, 0x06, 0x8b8b); + mdio_write(tp, 0x06, 0x1e01); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x8c1e); + mdio_write(tp, 0x06, 0x01e1); + mdio_write(tp, 0x06, 0x8b8d); + mdio_write(tp, 0x06, 0x1e01); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x8e1e); + mdio_write(tp, 0x06, 0x01a0); + mdio_write(tp, 0x06, 0x00c7); + mdio_write(tp, 0x06, 0xaebb); + mdio_write(tp, 0x06, 0xd481); + mdio_write(tp, 0x06, 0xd2e4); + mdio_write(tp, 0x06, 0x8b92); + mdio_write(tp, 0x06, 0xe58b); + mdio_write(tp, 0x06, 0x93d1); + mdio_write(tp, 0x06, 0x03bf); + mdio_write(tp, 0x06, 0x859e); + mdio_write(tp, 0x06, 0x0237); + mdio_write(tp, 0x06, 0x23d1); + mdio_write(tp, 0x06, 0x02bf); + mdio_write(tp, 0x06, 0x85a1); + mdio_write(tp, 0x06, 0x0237); + mdio_write(tp, 0x06, 0x23ee); + mdio_write(tp, 0x06, 0x8608); + mdio_write(tp, 0x06, 0x03ee); + mdio_write(tp, 0x06, 0x860a); + mdio_write(tp, 0x06, 0x60ee); + mdio_write(tp, 0x06, 0x8610); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0x8611); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0x8abe); + mdio_write(tp, 0x06, 0x07ee); + mdio_write(tp, 0x06, 0x8abf); + mdio_write(tp, 0x06, 0x73ee); + mdio_write(tp, 0x06, 0x8a95); + mdio_write(tp, 0x06, 0x02bf); + mdio_write(tp, 0x06, 0x8b88); + mdio_write(tp, 0x06, 0xec00); + mdio_write(tp, 0x06, 0x19a9); + mdio_write(tp, 0x06, 0x8b90); + mdio_write(tp, 0x06, 0xf9ee); + mdio_write(tp, 0x06, 0xfff6); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0xfff7); + mdio_write(tp, 0x06, 0xfed1); + mdio_write(tp, 0x06, 0x00bf); + mdio_write(tp, 0x06, 0x8595); + mdio_write(tp, 0x06, 0x0237); + mdio_write(tp, 0x06, 0x23d1); + mdio_write(tp, 0x06, 0x01bf); + mdio_write(tp, 0x06, 0x8598); + mdio_write(tp, 0x06, 0x0237); + mdio_write(tp, 0x06, 0x2304); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0x8b8a); + mdio_write(tp, 0x06, 0xad20); + mdio_write(tp, 0x06, 0x14ee); + mdio_write(tp, 0x06, 0x8b8a); + mdio_write(tp, 0x06, 0x0002); + mdio_write(tp, 0x06, 0x1f9a); + mdio_write(tp, 0x06, 0xe0e4); + mdio_write(tp, 0x06, 0x26e1); + mdio_write(tp, 0x06, 0xe427); + mdio_write(tp, 0x06, 0xeee4); + mdio_write(tp, 0x06, 0x2623); + mdio_write(tp, 0x06, 0xe5e4); + mdio_write(tp, 0x06, 0x27fc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x8dad); + mdio_write(tp, 0x06, 0x2014); + mdio_write(tp, 0x06, 0xee8b); + mdio_write(tp, 0x06, 0x8d00); + mdio_write(tp, 0x06, 0xe08a); + mdio_write(tp, 0x06, 0x5a78); + mdio_write(tp, 0x06, 0x039e); + mdio_write(tp, 0x06, 0x0902); + mdio_write(tp, 0x06, 0x05db); + mdio_write(tp, 0x06, 0x0282); + mdio_write(tp, 0x06, 0x7b02); + mdio_write(tp, 0x06, 0x3231); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xad20); + mdio_write(tp, 0x06, 0x1df6); + mdio_write(tp, 0x06, 0x20e4); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0x0281); + mdio_write(tp, 0x06, 0x5c02); + mdio_write(tp, 0x06, 0x2bcb); + mdio_write(tp, 0x06, 0x022d); + mdio_write(tp, 0x06, 0x2902); + mdio_write(tp, 0x06, 0x03b4); + mdio_write(tp, 0x06, 0x0285); + mdio_write(tp, 0x06, 0x6402); + mdio_write(tp, 0x06, 0x2eca); + mdio_write(tp, 0x06, 0x0284); + mdio_write(tp, 0x06, 0xcd02); + mdio_write(tp, 0x06, 0x046f); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x8ead); + mdio_write(tp, 0x06, 0x210b); + mdio_write(tp, 0x06, 0xf621); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x8e02); + mdio_write(tp, 0x06, 0x8520); + mdio_write(tp, 0x06, 0x021b); + mdio_write(tp, 0x06, 0xe8e0); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xad22); + mdio_write(tp, 0x06, 0x05f6); + mdio_write(tp, 0x06, 0x22e4); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x8ead); + mdio_write(tp, 0x06, 0x2308); + mdio_write(tp, 0x06, 0xf623); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x8e02); + mdio_write(tp, 0x06, 0x311c); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x8ead); + mdio_write(tp, 0x06, 0x2405); + mdio_write(tp, 0x06, 0xf624); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x8ee0); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xad25); + mdio_write(tp, 0x06, 0x05f6); + mdio_write(tp, 0x06, 0x25e4); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x8ead); + mdio_write(tp, 0x06, 0x2608); + mdio_write(tp, 0x06, 0xf626); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x8e02); + mdio_write(tp, 0x06, 0x2df5); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x8ead); + mdio_write(tp, 0x06, 0x2705); + mdio_write(tp, 0x06, 0xf627); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x8e02); + mdio_write(tp, 0x06, 0x037a); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8f9); + mdio_write(tp, 0x06, 0xfaef); + mdio_write(tp, 0x06, 0x69e0); + mdio_write(tp, 0x06, 0x8b87); + mdio_write(tp, 0x06, 0xad20); + mdio_write(tp, 0x06, 0x65d2); + mdio_write(tp, 0x06, 0x00bf); + mdio_write(tp, 0x06, 0x2fe9); + mdio_write(tp, 0x06, 0x0236); + mdio_write(tp, 0x06, 0xf61e); + mdio_write(tp, 0x06, 0x21bf); + mdio_write(tp, 0x06, 0x2ff5); + mdio_write(tp, 0x06, 0x0236); + mdio_write(tp, 0x06, 0xf60c); + mdio_write(tp, 0x06, 0x111e); + mdio_write(tp, 0x06, 0x21bf); + mdio_write(tp, 0x06, 0x2ff8); + mdio_write(tp, 0x06, 0x0236); + mdio_write(tp, 0x06, 0xf60c); + mdio_write(tp, 0x06, 0x121e); + mdio_write(tp, 0x06, 0x21bf); + mdio_write(tp, 0x06, 0x2ffb); + mdio_write(tp, 0x06, 0x0236); + mdio_write(tp, 0x06, 0xf60c); + mdio_write(tp, 0x06, 0x131e); + mdio_write(tp, 0x06, 0x21bf); + mdio_write(tp, 0x06, 0x1f97); + mdio_write(tp, 0x06, 0x0236); + mdio_write(tp, 0x06, 0xf60c); + mdio_write(tp, 0x06, 0x141e); + mdio_write(tp, 0x06, 0x21bf); + mdio_write(tp, 0x06, 0x859b); + mdio_write(tp, 0x06, 0x0236); + mdio_write(tp, 0x06, 0xf60c); + mdio_write(tp, 0x06, 0x161e); + mdio_write(tp, 0x06, 0x21e0); + mdio_write(tp, 0x06, 0x8a8c); + mdio_write(tp, 0x06, 0x1f02); + mdio_write(tp, 0x06, 0x9e22); + mdio_write(tp, 0x06, 0xe68a); + mdio_write(tp, 0x06, 0x8cad); + mdio_write(tp, 0x06, 0x3114); + mdio_write(tp, 0x06, 0xad30); + mdio_write(tp, 0x06, 0x11ef); + mdio_write(tp, 0x06, 0x0258); + mdio_write(tp, 0x06, 0x0c9e); + mdio_write(tp, 0x06, 0x07ad); + mdio_write(tp, 0x06, 0x3608); + mdio_write(tp, 0x06, 0x5a30); + mdio_write(tp, 0x06, 0x9f04); + mdio_write(tp, 0x06, 0xd101); + mdio_write(tp, 0x06, 0xae02); + mdio_write(tp, 0x06, 0xd100); + mdio_write(tp, 0x06, 0xbf2f); + mdio_write(tp, 0x06, 0xf202); + mdio_write(tp, 0x06, 0x3723); + mdio_write(tp, 0x06, 0xef96); + mdio_write(tp, 0x06, 0xfefd); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8f9); + mdio_write(tp, 0x06, 0xface); + mdio_write(tp, 0x06, 0xfaef); + mdio_write(tp, 0x06, 0x69fa); + mdio_write(tp, 0x06, 0xd401); + mdio_write(tp, 0x06, 0x55b4); + mdio_write(tp, 0x06, 0xfebf); + mdio_write(tp, 0x06, 0x85a7); + mdio_write(tp, 0x06, 0x0236); + mdio_write(tp, 0x06, 0xf6ac); + mdio_write(tp, 0x06, 0x280b); + mdio_write(tp, 0x06, 0xbf85); + mdio_write(tp, 0x06, 0xa402); + mdio_write(tp, 0x06, 0x36f6); + mdio_write(tp, 0x06, 0xac28); + mdio_write(tp, 0x06, 0x49ae); + mdio_write(tp, 0x06, 0x64bf); + mdio_write(tp, 0x06, 0x85a4); + mdio_write(tp, 0x06, 0x0236); + mdio_write(tp, 0x06, 0xf6ac); + mdio_write(tp, 0x06, 0x285b); + mdio_write(tp, 0x06, 0xd000); + mdio_write(tp, 0x06, 0x0282); + mdio_write(tp, 0x06, 0x60ac); + mdio_write(tp, 0x06, 0x2105); + mdio_write(tp, 0x06, 0xac22); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0x4ebf); + mdio_write(tp, 0x06, 0xe0c4); + mdio_write(tp, 0x06, 0xbe86); + mdio_write(tp, 0x06, 0x14d2); + mdio_write(tp, 0x06, 0x04d8); + mdio_write(tp, 0x06, 0x19d9); + mdio_write(tp, 0x06, 0x1907); + mdio_write(tp, 0x06, 0xdc19); + mdio_write(tp, 0x06, 0xdd19); + mdio_write(tp, 0x06, 0x0789); + mdio_write(tp, 0x06, 0x89ef); + mdio_write(tp, 0x06, 0x645e); + mdio_write(tp, 0x06, 0x07ff); + mdio_write(tp, 0x06, 0x0d65); + mdio_write(tp, 0x06, 0x5cf8); + mdio_write(tp, 0x06, 0x001e); + mdio_write(tp, 0x06, 0x46dc); + mdio_write(tp, 0x06, 0x19dd); + mdio_write(tp, 0x06, 0x19b2); + mdio_write(tp, 0x06, 0xe2d4); + mdio_write(tp, 0x06, 0x0001); + mdio_write(tp, 0x06, 0xbf85); + mdio_write(tp, 0x06, 0xa402); + mdio_write(tp, 0x06, 0x3723); + mdio_write(tp, 0x06, 0xae1d); + mdio_write(tp, 0x06, 0xbee0); + mdio_write(tp, 0x06, 0xc4bf); + mdio_write(tp, 0x06, 0x8614); + mdio_write(tp, 0x06, 0xd204); + mdio_write(tp, 0x06, 0xd819); + mdio_write(tp, 0x06, 0xd919); + mdio_write(tp, 0x06, 0x07dc); + mdio_write(tp, 0x06, 0x19dd); + mdio_write(tp, 0x06, 0x1907); + mdio_write(tp, 0x06, 0xb2f4); + mdio_write(tp, 0x06, 0xd400); + mdio_write(tp, 0x06, 0x00bf); + mdio_write(tp, 0x06, 0x85a4); + mdio_write(tp, 0x06, 0x0237); + mdio_write(tp, 0x06, 0x23fe); + mdio_write(tp, 0x06, 0xef96); + mdio_write(tp, 0x06, 0xfec6); + mdio_write(tp, 0x06, 0xfefd); + mdio_write(tp, 0x06, 0xfc05); + mdio_write(tp, 0x06, 0xf9e2); + mdio_write(tp, 0x06, 0xe0ea); + mdio_write(tp, 0x06, 0xe3e0); + mdio_write(tp, 0x06, 0xeb5a); + mdio_write(tp, 0x06, 0x070c); + mdio_write(tp, 0x06, 0x031e); + mdio_write(tp, 0x06, 0x20e6); + mdio_write(tp, 0x06, 0xe0ea); + mdio_write(tp, 0x06, 0xe7e0); + mdio_write(tp, 0x06, 0xebe0); + mdio_write(tp, 0x06, 0xe0fc); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0xfdfd); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xf9e0); + mdio_write(tp, 0x06, 0x8b81); + mdio_write(tp, 0x06, 0xac26); + mdio_write(tp, 0x06, 0x1ae0); + mdio_write(tp, 0x06, 0x8b81); + mdio_write(tp, 0x06, 0xac21); + mdio_write(tp, 0x06, 0x14e0); + mdio_write(tp, 0x06, 0x8b85); + mdio_write(tp, 0x06, 0xac20); + mdio_write(tp, 0x06, 0x0ee0); + mdio_write(tp, 0x06, 0x8b85); + mdio_write(tp, 0x06, 0xac23); + mdio_write(tp, 0x06, 0x08e0); + mdio_write(tp, 0x06, 0x8b87); + mdio_write(tp, 0x06, 0xac24); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0x3802); + mdio_write(tp, 0x06, 0x1ab5); + mdio_write(tp, 0x06, 0xeee4); + mdio_write(tp, 0x06, 0x1c04); + mdio_write(tp, 0x06, 0xeee4); + mdio_write(tp, 0x06, 0x1d04); + mdio_write(tp, 0x06, 0xe2e0); + mdio_write(tp, 0x06, 0x7ce3); + mdio_write(tp, 0x06, 0xe07d); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x38e1); + mdio_write(tp, 0x06, 0xe039); + mdio_write(tp, 0x06, 0xad2e); + mdio_write(tp, 0x06, 0x1bad); + mdio_write(tp, 0x06, 0x390d); + mdio_write(tp, 0x06, 0xd101); + mdio_write(tp, 0x06, 0xbf21); + mdio_write(tp, 0x06, 0xd502); + mdio_write(tp, 0x06, 0x3723); + mdio_write(tp, 0x06, 0x0282); + mdio_write(tp, 0x06, 0xd8ae); + mdio_write(tp, 0x06, 0x0bac); + mdio_write(tp, 0x06, 0x3802); + mdio_write(tp, 0x06, 0xae06); + mdio_write(tp, 0x06, 0x0283); + mdio_write(tp, 0x06, 0x1802); + mdio_write(tp, 0x06, 0x8360); + mdio_write(tp, 0x06, 0x021a); + mdio_write(tp, 0x06, 0xc6fd); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8e1); + mdio_write(tp, 0x06, 0x8af4); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x81ad); + mdio_write(tp, 0x06, 0x2605); + mdio_write(tp, 0x06, 0x0222); + mdio_write(tp, 0x06, 0xa4f7); + mdio_write(tp, 0x06, 0x28e0); + mdio_write(tp, 0x06, 0x8b81); + mdio_write(tp, 0x06, 0xad21); + mdio_write(tp, 0x06, 0x0502); + mdio_write(tp, 0x06, 0x23a9); + mdio_write(tp, 0x06, 0xf729); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x85ad); + mdio_write(tp, 0x06, 0x2005); + mdio_write(tp, 0x06, 0x0214); + mdio_write(tp, 0x06, 0xabf7); + mdio_write(tp, 0x06, 0x2ae0); + mdio_write(tp, 0x06, 0x8b85); + mdio_write(tp, 0x06, 0xad23); + mdio_write(tp, 0x06, 0x0502); + mdio_write(tp, 0x06, 0x12e7); + mdio_write(tp, 0x06, 0xf72b); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x87ad); + mdio_write(tp, 0x06, 0x2405); + mdio_write(tp, 0x06, 0x0283); + mdio_write(tp, 0x06, 0xbcf7); + mdio_write(tp, 0x06, 0x2ce5); + mdio_write(tp, 0x06, 0x8af4); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0x8b81); + mdio_write(tp, 0x06, 0xad26); + mdio_write(tp, 0x06, 0x0302); + mdio_write(tp, 0x06, 0x21e5); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x81ad); + mdio_write(tp, 0x06, 0x2109); + mdio_write(tp, 0x06, 0xe08a); + mdio_write(tp, 0x06, 0xf4ac); + mdio_write(tp, 0x06, 0x2003); + mdio_write(tp, 0x06, 0x0223); + mdio_write(tp, 0x06, 0x98e0); + mdio_write(tp, 0x06, 0x8b85); + mdio_write(tp, 0x06, 0xad20); + mdio_write(tp, 0x06, 0x09e0); + mdio_write(tp, 0x06, 0x8af4); + mdio_write(tp, 0x06, 0xac21); + mdio_write(tp, 0x06, 0x0302); + mdio_write(tp, 0x06, 0x13fb); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x85ad); + mdio_write(tp, 0x06, 0x2309); + mdio_write(tp, 0x06, 0xe08a); + mdio_write(tp, 0x06, 0xf4ac); + mdio_write(tp, 0x06, 0x2203); + mdio_write(tp, 0x06, 0x0212); + mdio_write(tp, 0x06, 0xfae0); + mdio_write(tp, 0x06, 0x8b87); + mdio_write(tp, 0x06, 0xad24); + mdio_write(tp, 0x06, 0x09e0); + mdio_write(tp, 0x06, 0x8af4); + mdio_write(tp, 0x06, 0xac23); + mdio_write(tp, 0x06, 0x0302); + mdio_write(tp, 0x06, 0x83c1); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8e1); + mdio_write(tp, 0x06, 0x8af4); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x81ad); + mdio_write(tp, 0x06, 0x2608); + mdio_write(tp, 0x06, 0xe083); + mdio_write(tp, 0x06, 0xd2ad); + mdio_write(tp, 0x06, 0x2502); + mdio_write(tp, 0x06, 0xf628); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x81ad); + mdio_write(tp, 0x06, 0x210a); + mdio_write(tp, 0x06, 0xe084); + mdio_write(tp, 0x06, 0x0af6); + mdio_write(tp, 0x06, 0x27a0); + mdio_write(tp, 0x06, 0x0502); + mdio_write(tp, 0x06, 0xf629); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x85ad); + mdio_write(tp, 0x06, 0x2008); + mdio_write(tp, 0x06, 0xe08a); + mdio_write(tp, 0x06, 0xe8ad); + mdio_write(tp, 0x06, 0x2102); + mdio_write(tp, 0x06, 0xf62a); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x85ad); + mdio_write(tp, 0x06, 0x2308); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x20a0); + mdio_write(tp, 0x06, 0x0302); + mdio_write(tp, 0x06, 0xf62b); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x87ad); + mdio_write(tp, 0x06, 0x2408); + mdio_write(tp, 0x06, 0xe086); + mdio_write(tp, 0x06, 0x02a0); + mdio_write(tp, 0x06, 0x0302); + mdio_write(tp, 0x06, 0xf62c); + mdio_write(tp, 0x06, 0xe58a); + mdio_write(tp, 0x06, 0xf4a1); + mdio_write(tp, 0x06, 0x0008); + mdio_write(tp, 0x06, 0xd100); + mdio_write(tp, 0x06, 0xbf21); + mdio_write(tp, 0x06, 0xd502); + mdio_write(tp, 0x06, 0x3723); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xee86); + mdio_write(tp, 0x06, 0x0200); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x87ad); + mdio_write(tp, 0x06, 0x241e); + mdio_write(tp, 0x06, 0xe086); + mdio_write(tp, 0x06, 0x02a0); + mdio_write(tp, 0x06, 0x0005); + mdio_write(tp, 0x06, 0x0283); + mdio_write(tp, 0x06, 0xe8ae); + mdio_write(tp, 0x06, 0xf5a0); + mdio_write(tp, 0x06, 0x0105); + mdio_write(tp, 0x06, 0x0283); + mdio_write(tp, 0x06, 0xf8ae); + mdio_write(tp, 0x06, 0x0ba0); + mdio_write(tp, 0x06, 0x0205); + mdio_write(tp, 0x06, 0x0284); + mdio_write(tp, 0x06, 0x14ae); + mdio_write(tp, 0x06, 0x03a0); + mdio_write(tp, 0x06, 0x0300); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8fa); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0x0284); + mdio_write(tp, 0x06, 0x2bee); + mdio_write(tp, 0x06, 0x8602); + mdio_write(tp, 0x06, 0x01ef); + mdio_write(tp, 0x06, 0x96fe); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8ee); + mdio_write(tp, 0x06, 0x8609); + mdio_write(tp, 0x06, 0x0002); + mdio_write(tp, 0x06, 0x8461); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xae10); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0x8608); + mdio_write(tp, 0x06, 0xe186); + mdio_write(tp, 0x06, 0x091f); + mdio_write(tp, 0x06, 0x019e); + mdio_write(tp, 0x06, 0x0611); + mdio_write(tp, 0x06, 0xe586); + mdio_write(tp, 0x06, 0x09ae); + mdio_write(tp, 0x06, 0x04ee); + mdio_write(tp, 0x06, 0x8602); + mdio_write(tp, 0x06, 0x01fc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xf9fa); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0xfbbf); + mdio_write(tp, 0x06, 0x8604); + mdio_write(tp, 0x06, 0xef79); + mdio_write(tp, 0x06, 0xd200); + mdio_write(tp, 0x06, 0xd400); + mdio_write(tp, 0x06, 0x221e); + mdio_write(tp, 0x06, 0x02bf); + mdio_write(tp, 0x06, 0x2fec); + mdio_write(tp, 0x06, 0x0237); + mdio_write(tp, 0x06, 0x23bf); + mdio_write(tp, 0x06, 0x13f2); + mdio_write(tp, 0x06, 0x0236); + mdio_write(tp, 0x06, 0xf60d); + mdio_write(tp, 0x06, 0x4559); + mdio_write(tp, 0x06, 0x1fef); + mdio_write(tp, 0x06, 0x97dd); + mdio_write(tp, 0x06, 0xd308); + mdio_write(tp, 0x06, 0x1a93); + mdio_write(tp, 0x06, 0xdd12); + mdio_write(tp, 0x06, 0x17a2); + mdio_write(tp, 0x06, 0x04de); + mdio_write(tp, 0x06, 0xffef); + mdio_write(tp, 0x06, 0x96fe); + mdio_write(tp, 0x06, 0xfdfc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xf9fa); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0xfbee); + mdio_write(tp, 0x06, 0x8602); + mdio_write(tp, 0x06, 0x03d5); + mdio_write(tp, 0x06, 0x0080); + mdio_write(tp, 0x06, 0xbf86); + mdio_write(tp, 0x06, 0x04ef); + mdio_write(tp, 0x06, 0x79ef); + mdio_write(tp, 0x06, 0x45bf); + mdio_write(tp, 0x06, 0x2fec); + mdio_write(tp, 0x06, 0x0237); + mdio_write(tp, 0x06, 0x23bf); + mdio_write(tp, 0x06, 0x13f2); + mdio_write(tp, 0x06, 0x0236); + mdio_write(tp, 0x06, 0xf6ad); + mdio_write(tp, 0x06, 0x2702); + mdio_write(tp, 0x06, 0x78ff); + mdio_write(tp, 0x06, 0xe186); + mdio_write(tp, 0x06, 0x0a1b); + mdio_write(tp, 0x06, 0x01aa); + mdio_write(tp, 0x06, 0x2eef); + mdio_write(tp, 0x06, 0x97d9); + mdio_write(tp, 0x06, 0x7900); + mdio_write(tp, 0x06, 0x9e2b); + mdio_write(tp, 0x06, 0x81dd); + mdio_write(tp, 0x06, 0xbf85); + mdio_write(tp, 0x06, 0xad02); + mdio_write(tp, 0x06, 0x3723); + mdio_write(tp, 0x06, 0xd101); + mdio_write(tp, 0x06, 0xef02); + mdio_write(tp, 0x06, 0x100c); + mdio_write(tp, 0x06, 0x11b0); + mdio_write(tp, 0x06, 0xfc0d); + mdio_write(tp, 0x06, 0x11bf); + mdio_write(tp, 0x06, 0x85aa); + mdio_write(tp, 0x06, 0x0237); + mdio_write(tp, 0x06, 0x23d1); + mdio_write(tp, 0x06, 0x00bf); + mdio_write(tp, 0x06, 0x85aa); + mdio_write(tp, 0x06, 0x0237); + mdio_write(tp, 0x06, 0x23ee); + mdio_write(tp, 0x06, 0x8602); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0x0413); + mdio_write(tp, 0x06, 0xa38b); + mdio_write(tp, 0x06, 0xb4d3); + mdio_write(tp, 0x06, 0x8012); + mdio_write(tp, 0x06, 0x17a2); + mdio_write(tp, 0x06, 0x04ad); + mdio_write(tp, 0x06, 0xffef); + mdio_write(tp, 0x06, 0x96fe); + mdio_write(tp, 0x06, 0xfdfc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xf9e0); + mdio_write(tp, 0x06, 0x8b85); + mdio_write(tp, 0x06, 0xad25); + mdio_write(tp, 0x06, 0x48e0); + mdio_write(tp, 0x06, 0x8a96); + mdio_write(tp, 0x06, 0xe18a); + mdio_write(tp, 0x06, 0x977c); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x9e35); + mdio_write(tp, 0x06, 0xee8a); + mdio_write(tp, 0x06, 0x9600); + mdio_write(tp, 0x06, 0xee8a); + mdio_write(tp, 0x06, 0x9700); + mdio_write(tp, 0x06, 0xe08a); + mdio_write(tp, 0x06, 0xbee1); + mdio_write(tp, 0x06, 0x8abf); + mdio_write(tp, 0x06, 0xe286); + mdio_write(tp, 0x06, 0x10e3); + mdio_write(tp, 0x06, 0x8611); + mdio_write(tp, 0x06, 0x0236); + mdio_write(tp, 0x06, 0x1aad); + mdio_write(tp, 0x06, 0x2012); + mdio_write(tp, 0x06, 0xee8a); + mdio_write(tp, 0x06, 0x9603); + mdio_write(tp, 0x06, 0xee8a); + mdio_write(tp, 0x06, 0x97b7); + mdio_write(tp, 0x06, 0xee86); + mdio_write(tp, 0x06, 0x1000); + mdio_write(tp, 0x06, 0xee86); + mdio_write(tp, 0x06, 0x1100); + mdio_write(tp, 0x06, 0xae11); + mdio_write(tp, 0x06, 0x15e6); + mdio_write(tp, 0x06, 0x8610); + mdio_write(tp, 0x06, 0xe786); + mdio_write(tp, 0x06, 0x11ae); + mdio_write(tp, 0x06, 0x08ee); + mdio_write(tp, 0x06, 0x8610); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0x8611); + mdio_write(tp, 0x06, 0x00fd); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8fa); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x00e1); + mdio_write(tp, 0x06, 0xe001); + mdio_write(tp, 0x06, 0xad27); + mdio_write(tp, 0x06, 0x32e0); + mdio_write(tp, 0x06, 0x8b40); + mdio_write(tp, 0x06, 0xf720); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x40bf); + mdio_write(tp, 0x06, 0x31f5); + mdio_write(tp, 0x06, 0x0236); + mdio_write(tp, 0x06, 0xf6ad); + mdio_write(tp, 0x06, 0x2821); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x20e1); + mdio_write(tp, 0x06, 0xe021); + mdio_write(tp, 0x06, 0xad20); + mdio_write(tp, 0x06, 0x18e0); + mdio_write(tp, 0x06, 0x8b40); + mdio_write(tp, 0x06, 0xf620); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x40ee); + mdio_write(tp, 0x06, 0x8b3b); + mdio_write(tp, 0x06, 0xffe0); + mdio_write(tp, 0x06, 0x8a8a); + mdio_write(tp, 0x06, 0xe18a); + mdio_write(tp, 0x06, 0x8be4); + mdio_write(tp, 0x06, 0xe000); + mdio_write(tp, 0x06, 0xe5e0); + mdio_write(tp, 0x06, 0x01ef); + mdio_write(tp, 0x06, 0x96fe); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8fa); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x80ad); + mdio_write(tp, 0x06, 0x2722); + mdio_write(tp, 0x06, 0xbf44); + mdio_write(tp, 0x06, 0xfc02); + mdio_write(tp, 0x06, 0x36f6); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x441f); + mdio_write(tp, 0x06, 0x019e); + mdio_write(tp, 0x06, 0x15e5); + mdio_write(tp, 0x06, 0x8b44); + mdio_write(tp, 0x06, 0xad29); + mdio_write(tp, 0x06, 0x07ac); + mdio_write(tp, 0x06, 0x2804); + mdio_write(tp, 0x06, 0xd101); + mdio_write(tp, 0x06, 0xae02); + mdio_write(tp, 0x06, 0xd100); + mdio_write(tp, 0x06, 0xbf85); + mdio_write(tp, 0x06, 0xb002); + mdio_write(tp, 0x06, 0x3723); + mdio_write(tp, 0x06, 0xef96); + mdio_write(tp, 0x06, 0xfefc); + mdio_write(tp, 0x06, 0x0400); + mdio_write(tp, 0x06, 0xe140); + mdio_write(tp, 0x06, 0x77e1); + mdio_write(tp, 0x06, 0x40dd); + mdio_write(tp, 0x06, 0xe022); + mdio_write(tp, 0x06, 0x32e1); + mdio_write(tp, 0x06, 0x5074); + mdio_write(tp, 0x06, 0xe144); + mdio_write(tp, 0x06, 0xffe0); + mdio_write(tp, 0x06, 0xdaff); + mdio_write(tp, 0x06, 0xe0c0); + mdio_write(tp, 0x06, 0x52e0); + mdio_write(tp, 0x06, 0xeed9); + mdio_write(tp, 0x06, 0xe04c); + mdio_write(tp, 0x06, 0xbbe0); + mdio_write(tp, 0x06, 0x2a00); + mdio_write(tp, 0x05, 0xe142); + gphy_val = mdio_read(tp, 0x06); + gphy_val |= BIT_0; + mdio_write(tp, 0x06, gphy_val); + mdio_write(tp, 0x05, 0xe140); + gphy_val = mdio_read(tp, 0x06); + gphy_val |= BIT_0; + mdio_write(tp, 0x06, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x1f, 0x0005); + for (i = 0; i < 200; i++) { + udelay(100); + gphy_val = mdio_read(tp, 0x00); + if (gphy_val & BIT_7) + break; + } + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0042); + mdio_write(tp, 0x18, 0x2300); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0023); + if (tp->RequiredSecLanDonglePatch) { + gphy_val = mdio_read(tp, 0x17); + gphy_val &= ~BIT_2; + mdio_write(tp, 0x17, gphy_val); + } + + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x00, 0x9200); +} + +static void +rtl8168_set_phy_mcu_8168f_1(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + unsigned int gphy_val,i; + + mdio_write(tp,0x1f, 0x0000); + mdio_write(tp,0x00, 0x1800); + gphy_val = mdio_read(tp, 0x15); + gphy_val &= ~(BIT_12); + mdio_write(tp,0x15, gphy_val); + mdio_write(tp,0x00, 0x4800); + mdio_write(tp,0x1f, 0x0007); + mdio_write(tp,0x1e, 0x002f); + for (i = 0; i < 1000; i++) { + udelay(100); + gphy_val = mdio_read(tp, 0x1c); + if (gphy_val & 0x0080) + break; + } + mdio_write(tp,0x1f, 0x0000); + mdio_write(tp,0x00, 0x1800); + mdio_write(tp,0x1f, 0x0007); + mdio_write(tp,0x1e, 0x0023); + for (i = 0; i < 200; i++) { + udelay(100); + gphy_val = mdio_read(tp, 0x18); + if (!(gphy_val & 0x0001)) + break; + } + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x05, 0xfff6); + mdio_write(tp, 0x06, 0x0080); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0023); + mdio_write(tp, 0x16, 0x0306); + mdio_write(tp, 0x16, 0x0307); + mdio_write(tp, 0x15, 0x0194); + mdio_write(tp, 0x19, 0x407D); + mdio_write(tp, 0x15, 0x0098); + mdio_write(tp, 0x19, 0x7c0b); + mdio_write(tp, 0x15, 0x0099); + mdio_write(tp, 0x19, 0x6c0b); + mdio_write(tp, 0x15, 0x00eb); + mdio_write(tp, 0x19, 0x6c0b); + mdio_write(tp, 0x15, 0x00f8); + mdio_write(tp, 0x19, 0x6f0b); + mdio_write(tp, 0x15, 0x00fe); + mdio_write(tp, 0x19, 0x6f0f); + mdio_write(tp, 0x15, 0x00db); + mdio_write(tp, 0x19, 0x6f09); + mdio_write(tp, 0x15, 0x00dc); + mdio_write(tp, 0x19, 0xaefd); + mdio_write(tp, 0x15, 0x00dd); + mdio_write(tp, 0x19, 0x6f0b); + mdio_write(tp, 0x15, 0x00de); + mdio_write(tp, 0x19, 0xc60b); + mdio_write(tp, 0x15, 0x00df); + mdio_write(tp, 0x19, 0x00fa); + mdio_write(tp, 0x15, 0x00e0); + mdio_write(tp, 0x19, 0x30e1); + mdio_write(tp, 0x15, 0x020c); + mdio_write(tp, 0x19, 0x3224); + mdio_write(tp, 0x15, 0x020e); + mdio_write(tp, 0x19, 0x9813); + mdio_write(tp, 0x15, 0x020f); + mdio_write(tp, 0x19, 0x7801); + mdio_write(tp, 0x15, 0x0210); + mdio_write(tp, 0x19, 0x930f); + mdio_write(tp, 0x15, 0x0211); + mdio_write(tp, 0x19, 0x9206); + mdio_write(tp, 0x15, 0x0212); + mdio_write(tp, 0x19, 0x4002); + mdio_write(tp, 0x15, 0x0213); + mdio_write(tp, 0x19, 0x7800); + mdio_write(tp, 0x15, 0x0214); + mdio_write(tp, 0x19, 0x588f); + mdio_write(tp, 0x15, 0x0215); + mdio_write(tp, 0x19, 0x5520); + mdio_write(tp, 0x15, 0x0216); + mdio_write(tp, 0x19, 0x3224); + mdio_write(tp, 0x15, 0x0217); + mdio_write(tp, 0x19, 0x4002); + mdio_write(tp, 0x15, 0x0218); + mdio_write(tp, 0x19, 0x7800); + mdio_write(tp, 0x15, 0x0219); + mdio_write(tp, 0x19, 0x588d); + mdio_write(tp, 0x15, 0x021a); + mdio_write(tp, 0x19, 0x5540); + mdio_write(tp, 0x15, 0x021b); + mdio_write(tp, 0x19, 0x9e03); + mdio_write(tp, 0x15, 0x021c); + mdio_write(tp, 0x19, 0x7c40); + mdio_write(tp, 0x15, 0x021d); + mdio_write(tp, 0x19, 0x6840); + mdio_write(tp, 0x15, 0x021e); + mdio_write(tp, 0x19, 0x3224); + mdio_write(tp, 0x15, 0x021f); + mdio_write(tp, 0x19, 0x4002); + mdio_write(tp, 0x15, 0x0220); + mdio_write(tp, 0x19, 0x3224); + mdio_write(tp, 0x15, 0x0221); + mdio_write(tp, 0x19, 0x9e03); + mdio_write(tp, 0x15, 0x0222); + mdio_write(tp, 0x19, 0x7c40); + mdio_write(tp, 0x15, 0x0223); + mdio_write(tp, 0x19, 0x6840); + mdio_write(tp, 0x15, 0x0224); + mdio_write(tp, 0x19, 0x7800); + mdio_write(tp, 0x15, 0x0225); + mdio_write(tp, 0x19, 0x3231); + mdio_write(tp, 0x15, 0x0000); + mdio_write(tp, 0x16, 0x0306); + mdio_write(tp, 0x16, 0x0300); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x05, 0xfff6); + mdio_write(tp, 0x06, 0x0080); + mdio_write(tp, 0x05, 0x8000); + mdio_write(tp, 0x06, 0x0280); + mdio_write(tp, 0x06, 0x48f7); + mdio_write(tp, 0x06, 0x00e0); + mdio_write(tp, 0x06, 0xfff7); + mdio_write(tp, 0x06, 0xa080); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0xf602); + mdio_write(tp, 0x06, 0x0118); + mdio_write(tp, 0x06, 0x0201); + mdio_write(tp, 0x06, 0x2502); + mdio_write(tp, 0x06, 0x8090); + mdio_write(tp, 0x06, 0x0201); + mdio_write(tp, 0x06, 0x4202); + mdio_write(tp, 0x06, 0x015c); + mdio_write(tp, 0x06, 0x0280); + mdio_write(tp, 0x06, 0xad02); + mdio_write(tp, 0x06, 0x80ca); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x88e1); + mdio_write(tp, 0x06, 0x8b89); + mdio_write(tp, 0x06, 0x1e01); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x8a1e); + mdio_write(tp, 0x06, 0x01e1); + mdio_write(tp, 0x06, 0x8b8b); + mdio_write(tp, 0x06, 0x1e01); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x8c1e); + mdio_write(tp, 0x06, 0x01e1); + mdio_write(tp, 0x06, 0x8b8d); + mdio_write(tp, 0x06, 0x1e01); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x8e1e); + mdio_write(tp, 0x06, 0x01a0); + mdio_write(tp, 0x06, 0x00c7); + mdio_write(tp, 0x06, 0xaebb); + mdio_write(tp, 0x06, 0xd484); + mdio_write(tp, 0x06, 0x3ce4); + mdio_write(tp, 0x06, 0x8b92); + mdio_write(tp, 0x06, 0xe58b); + mdio_write(tp, 0x06, 0x93ee); + mdio_write(tp, 0x06, 0x8ac8); + mdio_write(tp, 0x06, 0x03ee); + mdio_write(tp, 0x06, 0x8aca); + mdio_write(tp, 0x06, 0x60ee); + mdio_write(tp, 0x06, 0x8ac0); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0x8ac1); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0x8abe); + mdio_write(tp, 0x06, 0x07ee); + mdio_write(tp, 0x06, 0x8abf); + mdio_write(tp, 0x06, 0x73ee); + mdio_write(tp, 0x06, 0x8a95); + mdio_write(tp, 0x06, 0x02bf); + mdio_write(tp, 0x06, 0x8b88); + mdio_write(tp, 0x06, 0xec00); + mdio_write(tp, 0x06, 0x19a9); + mdio_write(tp, 0x06, 0x8b90); + mdio_write(tp, 0x06, 0xf9ee); + mdio_write(tp, 0x06, 0xfff6); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0xfff7); + mdio_write(tp, 0x06, 0xfed1); + mdio_write(tp, 0x06, 0x00bf); + mdio_write(tp, 0x06, 0x85a4); + mdio_write(tp, 0x06, 0x0238); + mdio_write(tp, 0x06, 0x7dd1); + mdio_write(tp, 0x06, 0x01bf); + mdio_write(tp, 0x06, 0x85a7); + mdio_write(tp, 0x06, 0x0238); + mdio_write(tp, 0x06, 0x7d04); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0x8b8a); + mdio_write(tp, 0x06, 0xad20); + mdio_write(tp, 0x06, 0x14ee); + mdio_write(tp, 0x06, 0x8b8a); + mdio_write(tp, 0x06, 0x0002); + mdio_write(tp, 0x06, 0x204b); + mdio_write(tp, 0x06, 0xe0e4); + mdio_write(tp, 0x06, 0x26e1); + mdio_write(tp, 0x06, 0xe427); + mdio_write(tp, 0x06, 0xeee4); + mdio_write(tp, 0x06, 0x2623); + mdio_write(tp, 0x06, 0xe5e4); + mdio_write(tp, 0x06, 0x27fc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x8dad); + mdio_write(tp, 0x06, 0x2014); + mdio_write(tp, 0x06, 0xee8b); + mdio_write(tp, 0x06, 0x8d00); + mdio_write(tp, 0x06, 0xe08a); + mdio_write(tp, 0x06, 0x5a78); + mdio_write(tp, 0x06, 0x039e); + mdio_write(tp, 0x06, 0x0902); + mdio_write(tp, 0x06, 0x05e8); + mdio_write(tp, 0x06, 0x0281); + mdio_write(tp, 0x06, 0x4f02); + mdio_write(tp, 0x06, 0x326c); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xad20); + mdio_write(tp, 0x06, 0x1df6); + mdio_write(tp, 0x06, 0x20e4); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0x022f); + mdio_write(tp, 0x06, 0x0902); + mdio_write(tp, 0x06, 0x2ab0); + mdio_write(tp, 0x06, 0x0285); + mdio_write(tp, 0x06, 0x1602); + mdio_write(tp, 0x06, 0x03ba); + mdio_write(tp, 0x06, 0x0284); + mdio_write(tp, 0x06, 0xe502); + mdio_write(tp, 0x06, 0x2df1); + mdio_write(tp, 0x06, 0x0283); + mdio_write(tp, 0x06, 0x8302); + mdio_write(tp, 0x06, 0x0475); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x8ead); + mdio_write(tp, 0x06, 0x210b); + mdio_write(tp, 0x06, 0xf621); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x8e02); + mdio_write(tp, 0x06, 0x83f8); + mdio_write(tp, 0x06, 0x021c); + mdio_write(tp, 0x06, 0x99e0); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xad22); + mdio_write(tp, 0x06, 0x08f6); + mdio_write(tp, 0x06, 0x22e4); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0x0235); + mdio_write(tp, 0x06, 0x63e0); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xad23); + mdio_write(tp, 0x06, 0x08f6); + mdio_write(tp, 0x06, 0x23e4); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0x0231); + mdio_write(tp, 0x06, 0x57e0); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xad24); + mdio_write(tp, 0x06, 0x05f6); + mdio_write(tp, 0x06, 0x24e4); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x8ead); + mdio_write(tp, 0x06, 0x2505); + mdio_write(tp, 0x06, 0xf625); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x8ee0); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xad26); + mdio_write(tp, 0x06, 0x08f6); + mdio_write(tp, 0x06, 0x26e4); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0x022d); + mdio_write(tp, 0x06, 0x1ce0); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xad27); + mdio_write(tp, 0x06, 0x05f6); + mdio_write(tp, 0x06, 0x27e4); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0x0203); + mdio_write(tp, 0x06, 0x80fc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xf9e0); + mdio_write(tp, 0x06, 0x8b81); + mdio_write(tp, 0x06, 0xac26); + mdio_write(tp, 0x06, 0x1ae0); + mdio_write(tp, 0x06, 0x8b81); + mdio_write(tp, 0x06, 0xac21); + mdio_write(tp, 0x06, 0x14e0); + mdio_write(tp, 0x06, 0x8b85); + mdio_write(tp, 0x06, 0xac20); + mdio_write(tp, 0x06, 0x0ee0); + mdio_write(tp, 0x06, 0x8b85); + mdio_write(tp, 0x06, 0xac23); + mdio_write(tp, 0x06, 0x08e0); + mdio_write(tp, 0x06, 0x8b87); + mdio_write(tp, 0x06, 0xac24); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0x3802); + mdio_write(tp, 0x06, 0x1ac2); + mdio_write(tp, 0x06, 0xeee4); + mdio_write(tp, 0x06, 0x1c04); + mdio_write(tp, 0x06, 0xeee4); + mdio_write(tp, 0x06, 0x1d04); + mdio_write(tp, 0x06, 0xe2e0); + mdio_write(tp, 0x06, 0x7ce3); + mdio_write(tp, 0x06, 0xe07d); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x38e1); + mdio_write(tp, 0x06, 0xe039); + mdio_write(tp, 0x06, 0xad2e); + mdio_write(tp, 0x06, 0x1bad); + mdio_write(tp, 0x06, 0x390d); + mdio_write(tp, 0x06, 0xd101); + mdio_write(tp, 0x06, 0xbf22); + mdio_write(tp, 0x06, 0x7a02); + mdio_write(tp, 0x06, 0x387d); + mdio_write(tp, 0x06, 0x0281); + mdio_write(tp, 0x06, 0xacae); + mdio_write(tp, 0x06, 0x0bac); + mdio_write(tp, 0x06, 0x3802); + mdio_write(tp, 0x06, 0xae06); + mdio_write(tp, 0x06, 0x0281); + mdio_write(tp, 0x06, 0xe902); + mdio_write(tp, 0x06, 0x822e); + mdio_write(tp, 0x06, 0x021a); + mdio_write(tp, 0x06, 0xd3fd); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8e1); + mdio_write(tp, 0x06, 0x8af4); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x81ad); + mdio_write(tp, 0x06, 0x2602); + mdio_write(tp, 0x06, 0xf728); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x81ad); + mdio_write(tp, 0x06, 0x2105); + mdio_write(tp, 0x06, 0x0222); + mdio_write(tp, 0x06, 0x8ef7); + mdio_write(tp, 0x06, 0x29e0); + mdio_write(tp, 0x06, 0x8b85); + mdio_write(tp, 0x06, 0xad20); + mdio_write(tp, 0x06, 0x0502); + mdio_write(tp, 0x06, 0x14b8); + mdio_write(tp, 0x06, 0xf72a); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x85ad); + mdio_write(tp, 0x06, 0x2305); + mdio_write(tp, 0x06, 0x0212); + mdio_write(tp, 0x06, 0xf4f7); + mdio_write(tp, 0x06, 0x2be0); + mdio_write(tp, 0x06, 0x8b87); + mdio_write(tp, 0x06, 0xad24); + mdio_write(tp, 0x06, 0x0502); + mdio_write(tp, 0x06, 0x8284); + mdio_write(tp, 0x06, 0xf72c); + mdio_write(tp, 0x06, 0xe58a); + mdio_write(tp, 0x06, 0xf4fc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x81ad); + mdio_write(tp, 0x06, 0x2600); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x81ad); + mdio_write(tp, 0x06, 0x2109); + mdio_write(tp, 0x06, 0xe08a); + mdio_write(tp, 0x06, 0xf4ac); + mdio_write(tp, 0x06, 0x2003); + mdio_write(tp, 0x06, 0x0222); + mdio_write(tp, 0x06, 0x7de0); + mdio_write(tp, 0x06, 0x8b85); + mdio_write(tp, 0x06, 0xad20); + mdio_write(tp, 0x06, 0x09e0); + mdio_write(tp, 0x06, 0x8af4); + mdio_write(tp, 0x06, 0xac21); + mdio_write(tp, 0x06, 0x0302); + mdio_write(tp, 0x06, 0x1408); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x85ad); + mdio_write(tp, 0x06, 0x2309); + mdio_write(tp, 0x06, 0xe08a); + mdio_write(tp, 0x06, 0xf4ac); + mdio_write(tp, 0x06, 0x2203); + mdio_write(tp, 0x06, 0x0213); + mdio_write(tp, 0x06, 0x07e0); + mdio_write(tp, 0x06, 0x8b87); + mdio_write(tp, 0x06, 0xad24); + mdio_write(tp, 0x06, 0x09e0); + mdio_write(tp, 0x06, 0x8af4); + mdio_write(tp, 0x06, 0xac23); + mdio_write(tp, 0x06, 0x0302); + mdio_write(tp, 0x06, 0x8289); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8e1); + mdio_write(tp, 0x06, 0x8af4); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x81ad); + mdio_write(tp, 0x06, 0x2602); + mdio_write(tp, 0x06, 0xf628); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x81ad); + mdio_write(tp, 0x06, 0x210a); + mdio_write(tp, 0x06, 0xe083); + mdio_write(tp, 0x06, 0xecf6); + mdio_write(tp, 0x06, 0x27a0); + mdio_write(tp, 0x06, 0x0502); + mdio_write(tp, 0x06, 0xf629); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x85ad); + mdio_write(tp, 0x06, 0x2008); + mdio_write(tp, 0x06, 0xe08a); + mdio_write(tp, 0x06, 0xe8ad); + mdio_write(tp, 0x06, 0x2102); + mdio_write(tp, 0x06, 0xf62a); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x85ad); + mdio_write(tp, 0x06, 0x2308); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x20a0); + mdio_write(tp, 0x06, 0x0302); + mdio_write(tp, 0x06, 0xf62b); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x87ad); + mdio_write(tp, 0x06, 0x2408); + mdio_write(tp, 0x06, 0xe08a); + mdio_write(tp, 0x06, 0xc2a0); + mdio_write(tp, 0x06, 0x0302); + mdio_write(tp, 0x06, 0xf62c); + mdio_write(tp, 0x06, 0xe58a); + mdio_write(tp, 0x06, 0xf4a1); + mdio_write(tp, 0x06, 0x0008); + mdio_write(tp, 0x06, 0xd100); + mdio_write(tp, 0x06, 0xbf22); + mdio_write(tp, 0x06, 0x7a02); + mdio_write(tp, 0x06, 0x387d); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xee8a); + mdio_write(tp, 0x06, 0xc200); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x87ad); + mdio_write(tp, 0x06, 0x241e); + mdio_write(tp, 0x06, 0xe08a); + mdio_write(tp, 0x06, 0xc2a0); + mdio_write(tp, 0x06, 0x0005); + mdio_write(tp, 0x06, 0x0282); + mdio_write(tp, 0x06, 0xb0ae); + mdio_write(tp, 0x06, 0xf5a0); + mdio_write(tp, 0x06, 0x0105); + mdio_write(tp, 0x06, 0x0282); + mdio_write(tp, 0x06, 0xc0ae); + mdio_write(tp, 0x06, 0x0ba0); + mdio_write(tp, 0x06, 0x0205); + mdio_write(tp, 0x06, 0x0282); + mdio_write(tp, 0x06, 0xcaae); + mdio_write(tp, 0x06, 0x03a0); + mdio_write(tp, 0x06, 0x0300); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8fa); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0x0282); + mdio_write(tp, 0x06, 0xe1ee); + mdio_write(tp, 0x06, 0x8ac2); + mdio_write(tp, 0x06, 0x01ef); + mdio_write(tp, 0x06, 0x96fe); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8ee); + mdio_write(tp, 0x06, 0x8ac9); + mdio_write(tp, 0x06, 0x0002); + mdio_write(tp, 0x06, 0x8317); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0x8ac8); + mdio_write(tp, 0x06, 0xe18a); + mdio_write(tp, 0x06, 0xc91f); + mdio_write(tp, 0x06, 0x019e); + mdio_write(tp, 0x06, 0x0611); + mdio_write(tp, 0x06, 0xe58a); + mdio_write(tp, 0x06, 0xc9ae); + mdio_write(tp, 0x06, 0x04ee); + mdio_write(tp, 0x06, 0x8ac2); + mdio_write(tp, 0x06, 0x01fc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xf9fa); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0xfbbf); + mdio_write(tp, 0x06, 0x8ac4); + mdio_write(tp, 0x06, 0xef79); + mdio_write(tp, 0x06, 0xd200); + mdio_write(tp, 0x06, 0xd400); + mdio_write(tp, 0x06, 0x221e); + mdio_write(tp, 0x06, 0x02bf); + mdio_write(tp, 0x06, 0x3024); + mdio_write(tp, 0x06, 0x0238); + mdio_write(tp, 0x06, 0x7dbf); + mdio_write(tp, 0x06, 0x13ff); + mdio_write(tp, 0x06, 0x0238); + mdio_write(tp, 0x06, 0x500d); + mdio_write(tp, 0x06, 0x4559); + mdio_write(tp, 0x06, 0x1fef); + mdio_write(tp, 0x06, 0x97dd); + mdio_write(tp, 0x06, 0xd308); + mdio_write(tp, 0x06, 0x1a93); + mdio_write(tp, 0x06, 0xdd12); + mdio_write(tp, 0x06, 0x17a2); + mdio_write(tp, 0x06, 0x04de); + mdio_write(tp, 0x06, 0xffef); + mdio_write(tp, 0x06, 0x96fe); + mdio_write(tp, 0x06, 0xfdfc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xf9fa); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0xfbee); + mdio_write(tp, 0x06, 0x8ac2); + mdio_write(tp, 0x06, 0x03d5); + mdio_write(tp, 0x06, 0x0080); + mdio_write(tp, 0x06, 0xbf8a); + mdio_write(tp, 0x06, 0xc4ef); + mdio_write(tp, 0x06, 0x79ef); + mdio_write(tp, 0x06, 0x45bf); + mdio_write(tp, 0x06, 0x3024); + mdio_write(tp, 0x06, 0x0238); + mdio_write(tp, 0x06, 0x7dbf); + mdio_write(tp, 0x06, 0x13ff); + mdio_write(tp, 0x06, 0x0238); + mdio_write(tp, 0x06, 0x50ad); + mdio_write(tp, 0x06, 0x2702); + mdio_write(tp, 0x06, 0x78ff); + mdio_write(tp, 0x06, 0xe18a); + mdio_write(tp, 0x06, 0xca1b); + mdio_write(tp, 0x06, 0x01aa); + mdio_write(tp, 0x06, 0x2eef); + mdio_write(tp, 0x06, 0x97d9); + mdio_write(tp, 0x06, 0x7900); + mdio_write(tp, 0x06, 0x9e2b); + mdio_write(tp, 0x06, 0x81dd); + mdio_write(tp, 0x06, 0xbf85); + mdio_write(tp, 0x06, 0xad02); + mdio_write(tp, 0x06, 0x387d); + mdio_write(tp, 0x06, 0xd101); + mdio_write(tp, 0x06, 0xef02); + mdio_write(tp, 0x06, 0x100c); + mdio_write(tp, 0x06, 0x11b0); + mdio_write(tp, 0x06, 0xfc0d); + mdio_write(tp, 0x06, 0x11bf); + mdio_write(tp, 0x06, 0x85aa); + mdio_write(tp, 0x06, 0x0238); + mdio_write(tp, 0x06, 0x7dd1); + mdio_write(tp, 0x06, 0x00bf); + mdio_write(tp, 0x06, 0x85aa); + mdio_write(tp, 0x06, 0x0238); + mdio_write(tp, 0x06, 0x7dee); + mdio_write(tp, 0x06, 0x8ac2); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0x0413); + mdio_write(tp, 0x06, 0xa38b); + mdio_write(tp, 0x06, 0xb4d3); + mdio_write(tp, 0x06, 0x8012); + mdio_write(tp, 0x06, 0x17a2); + mdio_write(tp, 0x06, 0x04ad); + mdio_write(tp, 0x06, 0xffef); + mdio_write(tp, 0x06, 0x96fe); + mdio_write(tp, 0x06, 0xfdfc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xf9e0); + mdio_write(tp, 0x06, 0x8b85); + mdio_write(tp, 0x06, 0xad25); + mdio_write(tp, 0x06, 0x48e0); + mdio_write(tp, 0x06, 0x8a96); + mdio_write(tp, 0x06, 0xe18a); + mdio_write(tp, 0x06, 0x977c); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x9e35); + mdio_write(tp, 0x06, 0xee8a); + mdio_write(tp, 0x06, 0x9600); + mdio_write(tp, 0x06, 0xee8a); + mdio_write(tp, 0x06, 0x9700); + mdio_write(tp, 0x06, 0xe08a); + mdio_write(tp, 0x06, 0xbee1); + mdio_write(tp, 0x06, 0x8abf); + mdio_write(tp, 0x06, 0xe28a); + mdio_write(tp, 0x06, 0xc0e3); + mdio_write(tp, 0x06, 0x8ac1); + mdio_write(tp, 0x06, 0x0237); + mdio_write(tp, 0x06, 0x74ad); + mdio_write(tp, 0x06, 0x2012); + mdio_write(tp, 0x06, 0xee8a); + mdio_write(tp, 0x06, 0x9603); + mdio_write(tp, 0x06, 0xee8a); + mdio_write(tp, 0x06, 0x97b7); + mdio_write(tp, 0x06, 0xee8a); + mdio_write(tp, 0x06, 0xc000); + mdio_write(tp, 0x06, 0xee8a); + mdio_write(tp, 0x06, 0xc100); + mdio_write(tp, 0x06, 0xae11); + mdio_write(tp, 0x06, 0x15e6); + mdio_write(tp, 0x06, 0x8ac0); + mdio_write(tp, 0x06, 0xe78a); + mdio_write(tp, 0x06, 0xc1ae); + mdio_write(tp, 0x06, 0x08ee); + mdio_write(tp, 0x06, 0x8ac0); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0x8ac1); + mdio_write(tp, 0x06, 0x00fd); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xae20); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x06, 0xf8fa); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x00e1); + mdio_write(tp, 0x06, 0xe001); + mdio_write(tp, 0x06, 0xad27); + mdio_write(tp, 0x06, 0x32e0); + mdio_write(tp, 0x06, 0x8b40); + mdio_write(tp, 0x06, 0xf720); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x40bf); + mdio_write(tp, 0x06, 0x3230); + mdio_write(tp, 0x06, 0x0238); + mdio_write(tp, 0x06, 0x50ad); + mdio_write(tp, 0x06, 0x2821); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x20e1); + mdio_write(tp, 0x06, 0xe021); + mdio_write(tp, 0x06, 0xad20); + mdio_write(tp, 0x06, 0x18e0); + mdio_write(tp, 0x06, 0x8b40); + mdio_write(tp, 0x06, 0xf620); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x40ee); + mdio_write(tp, 0x06, 0x8b3b); + mdio_write(tp, 0x06, 0xffe0); + mdio_write(tp, 0x06, 0x8a8a); + mdio_write(tp, 0x06, 0xe18a); + mdio_write(tp, 0x06, 0x8be4); + mdio_write(tp, 0x06, 0xe000); + mdio_write(tp, 0x06, 0xe5e0); + mdio_write(tp, 0x06, 0x01ef); + mdio_write(tp, 0x06, 0x96fe); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8f9); + mdio_write(tp, 0x06, 0xface); + mdio_write(tp, 0x06, 0xfaef); + mdio_write(tp, 0x06, 0x69fa); + mdio_write(tp, 0x06, 0xd401); + mdio_write(tp, 0x06, 0x55b4); + mdio_write(tp, 0x06, 0xfebf); + mdio_write(tp, 0x06, 0x1c1e); + mdio_write(tp, 0x06, 0x0238); + mdio_write(tp, 0x06, 0x50ac); + mdio_write(tp, 0x06, 0x280b); + mdio_write(tp, 0x06, 0xbf1c); + mdio_write(tp, 0x06, 0x1b02); + mdio_write(tp, 0x06, 0x3850); + mdio_write(tp, 0x06, 0xac28); + mdio_write(tp, 0x06, 0x49ae); + mdio_write(tp, 0x06, 0x64bf); + mdio_write(tp, 0x06, 0x1c1b); + mdio_write(tp, 0x06, 0x0238); + mdio_write(tp, 0x06, 0x50ac); + mdio_write(tp, 0x06, 0x285b); + mdio_write(tp, 0x06, 0xd000); + mdio_write(tp, 0x06, 0x0284); + mdio_write(tp, 0x06, 0xcaac); + mdio_write(tp, 0x06, 0x2105); + mdio_write(tp, 0x06, 0xac22); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0x4ebf); + mdio_write(tp, 0x06, 0xe0c4); + mdio_write(tp, 0x06, 0xbe85); + mdio_write(tp, 0x06, 0xf6d2); + mdio_write(tp, 0x06, 0x04d8); + mdio_write(tp, 0x06, 0x19d9); + mdio_write(tp, 0x06, 0x1907); + mdio_write(tp, 0x06, 0xdc19); + mdio_write(tp, 0x06, 0xdd19); + mdio_write(tp, 0x06, 0x0789); + mdio_write(tp, 0x06, 0x89ef); + mdio_write(tp, 0x06, 0x645e); + mdio_write(tp, 0x06, 0x07ff); + mdio_write(tp, 0x06, 0x0d65); + mdio_write(tp, 0x06, 0x5cf8); + mdio_write(tp, 0x06, 0x001e); + mdio_write(tp, 0x06, 0x46dc); + mdio_write(tp, 0x06, 0x19dd); + mdio_write(tp, 0x06, 0x19b2); + mdio_write(tp, 0x06, 0xe2d4); + mdio_write(tp, 0x06, 0x0001); + mdio_write(tp, 0x06, 0xbf1c); + mdio_write(tp, 0x06, 0x1b02); + mdio_write(tp, 0x06, 0x387d); + mdio_write(tp, 0x06, 0xae1d); + mdio_write(tp, 0x06, 0xbee0); + mdio_write(tp, 0x06, 0xc4bf); + mdio_write(tp, 0x06, 0x85f6); + mdio_write(tp, 0x06, 0xd204); + mdio_write(tp, 0x06, 0xd819); + mdio_write(tp, 0x06, 0xd919); + mdio_write(tp, 0x06, 0x07dc); + mdio_write(tp, 0x06, 0x19dd); + mdio_write(tp, 0x06, 0x1907); + mdio_write(tp, 0x06, 0xb2f4); + mdio_write(tp, 0x06, 0xd400); + mdio_write(tp, 0x06, 0x00bf); + mdio_write(tp, 0x06, 0x1c1b); + mdio_write(tp, 0x06, 0x0238); + mdio_write(tp, 0x06, 0x7dfe); + mdio_write(tp, 0x06, 0xef96); + mdio_write(tp, 0x06, 0xfec6); + mdio_write(tp, 0x06, 0xfefd); + mdio_write(tp, 0x06, 0xfc05); + mdio_write(tp, 0x06, 0xf9e2); + mdio_write(tp, 0x06, 0xe0ea); + mdio_write(tp, 0x06, 0xe3e0); + mdio_write(tp, 0x06, 0xeb5a); + mdio_write(tp, 0x06, 0x070c); + mdio_write(tp, 0x06, 0x031e); + mdio_write(tp, 0x06, 0x20e6); + mdio_write(tp, 0x06, 0xe0ea); + mdio_write(tp, 0x06, 0xe7e0); + mdio_write(tp, 0x06, 0xebe0); + mdio_write(tp, 0x06, 0xe0fc); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0xfdfd); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xfaef); + mdio_write(tp, 0x06, 0x69e0); + mdio_write(tp, 0x06, 0x8b80); + mdio_write(tp, 0x06, 0xad27); + mdio_write(tp, 0x06, 0x22bf); + mdio_write(tp, 0x06, 0x4616); + mdio_write(tp, 0x06, 0x0238); + mdio_write(tp, 0x06, 0x50e0); + mdio_write(tp, 0x06, 0x8b44); + mdio_write(tp, 0x06, 0x1f01); + mdio_write(tp, 0x06, 0x9e15); + mdio_write(tp, 0x06, 0xe58b); + mdio_write(tp, 0x06, 0x44ad); + mdio_write(tp, 0x06, 0x2907); + mdio_write(tp, 0x06, 0xac28); + mdio_write(tp, 0x06, 0x04d1); + mdio_write(tp, 0x06, 0x01ae); + mdio_write(tp, 0x06, 0x02d1); + mdio_write(tp, 0x06, 0x00bf); + mdio_write(tp, 0x06, 0x85b0); + mdio_write(tp, 0x06, 0x0238); + mdio_write(tp, 0x06, 0x7def); + mdio_write(tp, 0x06, 0x96fe); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0x8b85); + mdio_write(tp, 0x06, 0xad26); + mdio_write(tp, 0x06, 0x30e0); + mdio_write(tp, 0x06, 0xe036); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0x37e1); + mdio_write(tp, 0x06, 0x8b3f); + mdio_write(tp, 0x06, 0x1f10); + mdio_write(tp, 0x06, 0x9e23); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x3fac); + mdio_write(tp, 0x06, 0x200b); + mdio_write(tp, 0x06, 0xac21); + mdio_write(tp, 0x06, 0x0dac); + mdio_write(tp, 0x06, 0x250f); + mdio_write(tp, 0x06, 0xac27); + mdio_write(tp, 0x06, 0x11ae); + mdio_write(tp, 0x06, 0x1202); + mdio_write(tp, 0x06, 0x2c47); + mdio_write(tp, 0x06, 0xae0d); + mdio_write(tp, 0x06, 0x0285); + mdio_write(tp, 0x06, 0x4fae); + mdio_write(tp, 0x06, 0x0802); + mdio_write(tp, 0x06, 0x2c69); + mdio_write(tp, 0x06, 0xae03); + mdio_write(tp, 0x06, 0x022c); + mdio_write(tp, 0x06, 0x7cfc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xfaef); + mdio_write(tp, 0x06, 0x6902); + mdio_write(tp, 0x06, 0x856c); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x14e1); + mdio_write(tp, 0x06, 0xe015); + mdio_write(tp, 0x06, 0xad26); + mdio_write(tp, 0x06, 0x08d1); + mdio_write(tp, 0x06, 0x1ebf); + mdio_write(tp, 0x06, 0x2cd9); + mdio_write(tp, 0x06, 0x0238); + mdio_write(tp, 0x06, 0x7def); + mdio_write(tp, 0x06, 0x96fe); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0x8b85); + mdio_write(tp, 0x06, 0xad27); + mdio_write(tp, 0x06, 0x2fd0); + mdio_write(tp, 0x06, 0x0b02); + mdio_write(tp, 0x06, 0x3682); + mdio_write(tp, 0x06, 0x5882); + mdio_write(tp, 0x06, 0x7882); + mdio_write(tp, 0x06, 0x9f24); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x32e1); + mdio_write(tp, 0x06, 0x8b33); + mdio_write(tp, 0x06, 0x1f10); + mdio_write(tp, 0x06, 0x9e1a); + mdio_write(tp, 0x06, 0x10e4); + mdio_write(tp, 0x06, 0x8b32); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x28e1); + mdio_write(tp, 0x06, 0xe029); + mdio_write(tp, 0x06, 0xf72c); + mdio_write(tp, 0x06, 0xe4e0); + mdio_write(tp, 0x06, 0x28e5); + mdio_write(tp, 0x06, 0xe029); + mdio_write(tp, 0x06, 0xf62c); + mdio_write(tp, 0x06, 0xe4e0); + mdio_write(tp, 0x06, 0x28e5); + mdio_write(tp, 0x06, 0xe029); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0x00e1); + mdio_write(tp, 0x06, 0x4077); + mdio_write(tp, 0x06, 0xe140); + mdio_write(tp, 0x06, 0x52e0); + mdio_write(tp, 0x06, 0xeed9); + mdio_write(tp, 0x06, 0xe04c); + mdio_write(tp, 0x06, 0xbbe0); + mdio_write(tp, 0x06, 0x2a00); + mdio_write(tp, 0x05, 0xe142); + gphy_val = mdio_read(tp, 0x06); + gphy_val |= BIT_0; + mdio_write(tp,0x06, gphy_val); + mdio_write(tp, 0x05, 0xe140); + gphy_val = mdio_read(tp, 0x06); + gphy_val |= BIT_0; + mdio_write(tp,0x06, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp,0x1f, 0x0005); + for (i = 0; i < 200; i++) { + udelay(100); + gphy_val = mdio_read(tp, 0x00); + if (gphy_val & BIT_7) + break; + } + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0023); + gphy_val = mdio_read(tp, 0x17); + gphy_val |= BIT_1; + if (tp->RequiredSecLanDonglePatch) + gphy_val &= ~BIT_2; + mdio_write(tp, 0x17, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + + mdio_write(tp, 0x1F, 0x0003); + mdio_write(tp, 0x09, 0xA20F); + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, 0x1f, 0x0003); + mdio_write(tp, 0x01, 0x328A); + mdio_write(tp, 0x1f, 0x0000); + + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x00, 0x9200); +} + +static void +rtl8168_set_phy_mcu_8168f_2(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + unsigned int gphy_val,i; + + mdio_write(tp,0x1f, 0x0000); + mdio_write(tp,0x00, 0x1800); + gphy_val = mdio_read(tp, 0x15); + gphy_val &= ~(BIT_12); + mdio_write(tp,0x15, gphy_val); + mdio_write(tp,0x00, 0x9800); + mdio_write(tp,0x1f, 0x0007); + mdio_write(tp,0x1e, 0x002f); + for (i = 0; i < 1000; i++) { + udelay(100); + gphy_val = mdio_read(tp, 0x1c); + if (gphy_val & 0x0080) + break; + } + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0023); + mdio_write(tp, 0x16, 0x0306); + mdio_write(tp, 0x16, 0x0307); + mdio_write(tp, 0x15, 0x0098); + mdio_write(tp, 0x19, 0x7c0b); + mdio_write(tp, 0x15, 0x0099); + mdio_write(tp, 0x19, 0x6c0b); + mdio_write(tp, 0x15, 0x00eb); + mdio_write(tp, 0x19, 0x6c0b); + mdio_write(tp, 0x15, 0x00f8); + mdio_write(tp, 0x19, 0x6f0b); + mdio_write(tp, 0x15, 0x00fe); + mdio_write(tp, 0x19, 0x6f0f); + mdio_write(tp, 0x15, 0x00db); + mdio_write(tp, 0x19, 0x6f09); + mdio_write(tp, 0x15, 0x00dc); + mdio_write(tp, 0x19, 0xaefd); + mdio_write(tp, 0x15, 0x00dd); + mdio_write(tp, 0x19, 0x6f0b); + mdio_write(tp, 0x15, 0x00de); + mdio_write(tp, 0x19, 0xc60b); + mdio_write(tp, 0x15, 0x00df); + mdio_write(tp, 0x19, 0x00fa); + mdio_write(tp, 0x15, 0x00e0); + mdio_write(tp, 0x19, 0x30e1); + mdio_write(tp, 0x15, 0x020c); + mdio_write(tp, 0x19, 0x3224); + mdio_write(tp, 0x15, 0x020e); + mdio_write(tp, 0x19, 0x9813); + mdio_write(tp, 0x15, 0x020f); + mdio_write(tp, 0x19, 0x7801); + mdio_write(tp, 0x15, 0x0210); + mdio_write(tp, 0x19, 0x930f); + mdio_write(tp, 0x15, 0x0211); + mdio_write(tp, 0x19, 0x9206); + mdio_write(tp, 0x15, 0x0212); + mdio_write(tp, 0x19, 0x4002); + mdio_write(tp, 0x15, 0x0213); + mdio_write(tp, 0x19, 0x7800); + mdio_write(tp, 0x15, 0x0214); + mdio_write(tp, 0x19, 0x588f); + mdio_write(tp, 0x15, 0x0215); + mdio_write(tp, 0x19, 0x5520); + mdio_write(tp, 0x15, 0x0216); + mdio_write(tp, 0x19, 0x3224); + mdio_write(tp, 0x15, 0x0217); + mdio_write(tp, 0x19, 0x4002); + mdio_write(tp, 0x15, 0x0218); + mdio_write(tp, 0x19, 0x7800); + mdio_write(tp, 0x15, 0x0219); + mdio_write(tp, 0x19, 0x588d); + mdio_write(tp, 0x15, 0x021a); + mdio_write(tp, 0x19, 0x5540); + mdio_write(tp, 0x15, 0x021b); + mdio_write(tp, 0x19, 0x9e03); + mdio_write(tp, 0x15, 0x021c); + mdio_write(tp, 0x19, 0x7c40); + mdio_write(tp, 0x15, 0x021d); + mdio_write(tp, 0x19, 0x6840); + mdio_write(tp, 0x15, 0x021e); + mdio_write(tp, 0x19, 0x3224); + mdio_write(tp, 0x15, 0x021f); + mdio_write(tp, 0x19, 0x4002); + mdio_write(tp, 0x15, 0x0220); + mdio_write(tp, 0x19, 0x3224); + mdio_write(tp, 0x15, 0x0221); + mdio_write(tp, 0x19, 0x9e03); + mdio_write(tp, 0x15, 0x0222); + mdio_write(tp, 0x19, 0x7c40); + mdio_write(tp, 0x15, 0x0223); + mdio_write(tp, 0x19, 0x6840); + mdio_write(tp, 0x15, 0x0224); + mdio_write(tp, 0x19, 0x7800); + mdio_write(tp, 0x15, 0x0225); + mdio_write(tp, 0x19, 0x3231); + mdio_write(tp, 0x15, 0x0000); + mdio_write(tp, 0x16, 0x0306); + mdio_write(tp, 0x16, 0x0300); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x05, 0xfff6); + mdio_write(tp, 0x06, 0x0080); + mdio_write(tp, 0x05, 0x8000); + mdio_write(tp, 0x06, 0x0280); + mdio_write(tp, 0x06, 0x48f7); + mdio_write(tp, 0x06, 0x00e0); + mdio_write(tp, 0x06, 0xfff7); + mdio_write(tp, 0x06, 0xa080); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0xf602); + mdio_write(tp, 0x06, 0x011b); + mdio_write(tp, 0x06, 0x0201); + mdio_write(tp, 0x06, 0x2802); + mdio_write(tp, 0x06, 0x0135); + mdio_write(tp, 0x06, 0x0201); + mdio_write(tp, 0x06, 0x4502); + mdio_write(tp, 0x06, 0x015f); + mdio_write(tp, 0x06, 0x0280); + mdio_write(tp, 0x06, 0x6b02); + mdio_write(tp, 0x06, 0x80e5); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x88e1); + mdio_write(tp, 0x06, 0x8b89); + mdio_write(tp, 0x06, 0x1e01); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x8a1e); + mdio_write(tp, 0x06, 0x01e1); + mdio_write(tp, 0x06, 0x8b8b); + mdio_write(tp, 0x06, 0x1e01); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x8c1e); + mdio_write(tp, 0x06, 0x01e1); + mdio_write(tp, 0x06, 0x8b8d); + mdio_write(tp, 0x06, 0x1e01); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x8e1e); + mdio_write(tp, 0x06, 0x01a0); + mdio_write(tp, 0x06, 0x00c7); + mdio_write(tp, 0x06, 0xaebb); + mdio_write(tp, 0x06, 0xbf8b); + mdio_write(tp, 0x06, 0x88ec); + mdio_write(tp, 0x06, 0x0019); + mdio_write(tp, 0x06, 0xa98b); + mdio_write(tp, 0x06, 0x90f9); + mdio_write(tp, 0x06, 0xeeff); + mdio_write(tp, 0x06, 0xf600); + mdio_write(tp, 0x06, 0xeeff); + mdio_write(tp, 0x06, 0xf7fe); + mdio_write(tp, 0x06, 0xd100); + mdio_write(tp, 0x06, 0xbf81); + mdio_write(tp, 0x06, 0x9802); + mdio_write(tp, 0x06, 0x39f3); + mdio_write(tp, 0x06, 0xd101); + mdio_write(tp, 0x06, 0xbf81); + mdio_write(tp, 0x06, 0x9b02); + mdio_write(tp, 0x06, 0x39f3); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x8dad); + mdio_write(tp, 0x06, 0x2014); + mdio_write(tp, 0x06, 0xee8b); + mdio_write(tp, 0x06, 0x8d00); + mdio_write(tp, 0x06, 0xe08a); + mdio_write(tp, 0x06, 0x5a78); + mdio_write(tp, 0x06, 0x039e); + mdio_write(tp, 0x06, 0x0902); + mdio_write(tp, 0x06, 0x05fc); + mdio_write(tp, 0x06, 0x0280); + mdio_write(tp, 0x06, 0x8802); + mdio_write(tp, 0x06, 0x32dd); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8f9); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x81ac); + mdio_write(tp, 0x06, 0x261a); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x81ac); + mdio_write(tp, 0x06, 0x2114); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x85ac); + mdio_write(tp, 0x06, 0x200e); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x85ac); + mdio_write(tp, 0x06, 0x2308); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x87ac); + mdio_write(tp, 0x06, 0x2402); + mdio_write(tp, 0x06, 0xae38); + mdio_write(tp, 0x06, 0x021a); + mdio_write(tp, 0x06, 0xd6ee); + mdio_write(tp, 0x06, 0xe41c); + mdio_write(tp, 0x06, 0x04ee); + mdio_write(tp, 0x06, 0xe41d); + mdio_write(tp, 0x06, 0x04e2); + mdio_write(tp, 0x06, 0xe07c); + mdio_write(tp, 0x06, 0xe3e0); + mdio_write(tp, 0x06, 0x7de0); + mdio_write(tp, 0x06, 0xe038); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0x39ad); + mdio_write(tp, 0x06, 0x2e1b); + mdio_write(tp, 0x06, 0xad39); + mdio_write(tp, 0x06, 0x0dd1); + mdio_write(tp, 0x06, 0x01bf); + mdio_write(tp, 0x06, 0x22c8); + mdio_write(tp, 0x06, 0x0239); + mdio_write(tp, 0x06, 0xf302); + mdio_write(tp, 0x06, 0x21f0); + mdio_write(tp, 0x06, 0xae0b); + mdio_write(tp, 0x06, 0xac38); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0x0602); + mdio_write(tp, 0x06, 0x222d); + mdio_write(tp, 0x06, 0x0222); + mdio_write(tp, 0x06, 0x7202); + mdio_write(tp, 0x06, 0x1ae7); + mdio_write(tp, 0x06, 0xfdfc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x8ead); + mdio_write(tp, 0x06, 0x201a); + mdio_write(tp, 0x06, 0xf620); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x8e02); + mdio_write(tp, 0x06, 0x2afe); + mdio_write(tp, 0x06, 0x022c); + mdio_write(tp, 0x06, 0x5c02); + mdio_write(tp, 0x06, 0x03c5); + mdio_write(tp, 0x06, 0x0281); + mdio_write(tp, 0x06, 0x6702); + mdio_write(tp, 0x06, 0x2e4f); + mdio_write(tp, 0x06, 0x0204); + mdio_write(tp, 0x06, 0x8902); + mdio_write(tp, 0x06, 0x2f7a); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x8ead); + mdio_write(tp, 0x06, 0x210b); + mdio_write(tp, 0x06, 0xf621); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x8e02); + mdio_write(tp, 0x06, 0x0445); + mdio_write(tp, 0x06, 0x021c); + mdio_write(tp, 0x06, 0xb8e0); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xad22); + mdio_write(tp, 0x06, 0x08f6); + mdio_write(tp, 0x06, 0x22e4); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0x0235); + mdio_write(tp, 0x06, 0xd4e0); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xad23); + mdio_write(tp, 0x06, 0x08f6); + mdio_write(tp, 0x06, 0x23e4); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0x0231); + mdio_write(tp, 0x06, 0xc8e0); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xad24); + mdio_write(tp, 0x06, 0x05f6); + mdio_write(tp, 0x06, 0x24e4); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x8ead); + mdio_write(tp, 0x06, 0x2505); + mdio_write(tp, 0x06, 0xf625); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x8ee0); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xad26); + mdio_write(tp, 0x06, 0x08f6); + mdio_write(tp, 0x06, 0x26e4); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0x022d); + mdio_write(tp, 0x06, 0x6ae0); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xad27); + mdio_write(tp, 0x06, 0x05f6); + mdio_write(tp, 0x06, 0x27e4); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0x0203); + mdio_write(tp, 0x06, 0x8bfc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xfaef); + mdio_write(tp, 0x06, 0x69e0); + mdio_write(tp, 0x06, 0x8b80); + mdio_write(tp, 0x06, 0xad27); + mdio_write(tp, 0x06, 0x22bf); + mdio_write(tp, 0x06, 0x479a); + mdio_write(tp, 0x06, 0x0239); + mdio_write(tp, 0x06, 0xc6e0); + mdio_write(tp, 0x06, 0x8b44); + mdio_write(tp, 0x06, 0x1f01); + mdio_write(tp, 0x06, 0x9e15); + mdio_write(tp, 0x06, 0xe58b); + mdio_write(tp, 0x06, 0x44ad); + mdio_write(tp, 0x06, 0x2907); + mdio_write(tp, 0x06, 0xac28); + mdio_write(tp, 0x06, 0x04d1); + mdio_write(tp, 0x06, 0x01ae); + mdio_write(tp, 0x06, 0x02d1); + mdio_write(tp, 0x06, 0x00bf); + mdio_write(tp, 0x06, 0x819e); + mdio_write(tp, 0x06, 0x0239); + mdio_write(tp, 0x06, 0xf3ef); + mdio_write(tp, 0x06, 0x96fe); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0x00e1); + mdio_write(tp, 0x06, 0x4077); + mdio_write(tp, 0x06, 0xe140); + mdio_write(tp, 0x06, 0xbbe0); + mdio_write(tp, 0x06, 0x2a00); + mdio_write(tp, 0x05, 0xe142); + gphy_val = mdio_read(tp, 0x06); + gphy_val |= BIT_0; + mdio_write(tp, 0x06, gphy_val); + mdio_write(tp, 0x05, 0xe140); + gphy_val = mdio_read(tp, 0x06); + gphy_val |= BIT_0; + mdio_write(tp, 0x06, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0023); + gphy_val = mdio_read(tp, 0x17); + gphy_val |= BIT_1; + if (tp->RequiredSecLanDonglePatch) + gphy_val &= ~BIT_2; + mdio_write(tp, 0x17, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x00, 0x9200); +} + +static void +rtl8168_set_phy_mcu_8411_1(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + unsigned int gphy_val,i; + + mdio_write(tp,0x1f, 0x0000); + mdio_write(tp,0x00, 0x1800); + gphy_val = mdio_read(tp, 0x15); + gphy_val &= ~(BIT_12); + mdio_write(tp,0x15, gphy_val); + mdio_write(tp,0x00, 0x4800); + mdio_write(tp,0x1f, 0x0007); + mdio_write(tp,0x1e, 0x002f); + for (i = 0; i < 1000; i++) { + udelay(100); + gphy_val = mdio_read(tp, 0x1c); + if (gphy_val & 0x0080) + break; + } + mdio_write(tp,0x1f, 0x0000); + mdio_write(tp,0x00, 0x1800); + mdio_write(tp,0x1f, 0x0007); + mdio_write(tp,0x1e, 0x0023); + for (i = 0; i < 200; i++) { + udelay(100); + gphy_val = mdio_read(tp, 0x18); + if (!(gphy_val & 0x0001)) + break; + } + mdio_write(tp,0x1f, 0x0005); + mdio_write(tp,0x05, 0xfff6); + mdio_write(tp,0x06, 0x0080); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x0023); + mdio_write(tp, 0x16, 0x0306); + mdio_write(tp, 0x16, 0x0307); + mdio_write(tp, 0x15, 0x0098); + mdio_write(tp, 0x19, 0x7c0b); + mdio_write(tp, 0x15, 0x0099); + mdio_write(tp, 0x19, 0x6c0b); + mdio_write(tp, 0x15, 0x00eb); + mdio_write(tp, 0x19, 0x6c0b); + mdio_write(tp, 0x15, 0x00f8); + mdio_write(tp, 0x19, 0x6f0b); + mdio_write(tp, 0x15, 0x00fe); + mdio_write(tp, 0x19, 0x6f0f); + mdio_write(tp, 0x15, 0x00db); + mdio_write(tp, 0x19, 0x6f09); + mdio_write(tp, 0x15, 0x00dc); + mdio_write(tp, 0x19, 0xaefd); + mdio_write(tp, 0x15, 0x00dd); + mdio_write(tp, 0x19, 0x6f0b); + mdio_write(tp, 0x15, 0x00de); + mdio_write(tp, 0x19, 0xc60b); + mdio_write(tp, 0x15, 0x00df); + mdio_write(tp, 0x19, 0x00fa); + mdio_write(tp, 0x15, 0x00e0); + mdio_write(tp, 0x19, 0x30e1); + mdio_write(tp, 0x15, 0x020c); + mdio_write(tp, 0x19, 0x3224); + mdio_write(tp, 0x15, 0x020e); + mdio_write(tp, 0x19, 0x9813); + mdio_write(tp, 0x15, 0x020f); + mdio_write(tp, 0x19, 0x7801); + mdio_write(tp, 0x15, 0x0210); + mdio_write(tp, 0x19, 0x930f); + mdio_write(tp, 0x15, 0x0211); + mdio_write(tp, 0x19, 0x9206); + mdio_write(tp, 0x15, 0x0212); + mdio_write(tp, 0x19, 0x4002); + mdio_write(tp, 0x15, 0x0213); + mdio_write(tp, 0x19, 0x7800); + mdio_write(tp, 0x15, 0x0214); + mdio_write(tp, 0x19, 0x588f); + mdio_write(tp, 0x15, 0x0215); + mdio_write(tp, 0x19, 0x5520); + mdio_write(tp, 0x15, 0x0216); + mdio_write(tp, 0x19, 0x3224); + mdio_write(tp, 0x15, 0x0217); + mdio_write(tp, 0x19, 0x4002); + mdio_write(tp, 0x15, 0x0218); + mdio_write(tp, 0x19, 0x7800); + mdio_write(tp, 0x15, 0x0219); + mdio_write(tp, 0x19, 0x588d); + mdio_write(tp, 0x15, 0x021a); + mdio_write(tp, 0x19, 0x5540); + mdio_write(tp, 0x15, 0x021b); + mdio_write(tp, 0x19, 0x9e03); + mdio_write(tp, 0x15, 0x021c); + mdio_write(tp, 0x19, 0x7c40); + mdio_write(tp, 0x15, 0x021d); + mdio_write(tp, 0x19, 0x6840); + mdio_write(tp, 0x15, 0x021e); + mdio_write(tp, 0x19, 0x3224); + mdio_write(tp, 0x15, 0x021f); + mdio_write(tp, 0x19, 0x4002); + mdio_write(tp, 0x15, 0x0220); + mdio_write(tp, 0x19, 0x3224); + mdio_write(tp, 0x15, 0x0221); + mdio_write(tp, 0x19, 0x9e03); + mdio_write(tp, 0x15, 0x0222); + mdio_write(tp, 0x19, 0x7c40); + mdio_write(tp, 0x15, 0x0223); + mdio_write(tp, 0x19, 0x6840); + mdio_write(tp, 0x15, 0x0224); + mdio_write(tp, 0x19, 0x7800); + mdio_write(tp, 0x15, 0x0225); + mdio_write(tp, 0x19, 0x3231); + mdio_write(tp, 0x15, 0x0000); + mdio_write(tp, 0x16, 0x0306); + mdio_write(tp, 0x16, 0x0300); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x05, 0xfff6); + mdio_write(tp, 0x06, 0x0080); + mdio_write(tp, 0x05, 0x8000); + mdio_write(tp, 0x06, 0x0280); + mdio_write(tp, 0x06, 0x48f7); + mdio_write(tp, 0x06, 0x00e0); + mdio_write(tp, 0x06, 0xfff7); + mdio_write(tp, 0x06, 0xa080); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0xf602); + mdio_write(tp, 0x06, 0x011e); + mdio_write(tp, 0x06, 0x0201); + mdio_write(tp, 0x06, 0x2b02); + mdio_write(tp, 0x06, 0x8077); + mdio_write(tp, 0x06, 0x0201); + mdio_write(tp, 0x06, 0x4802); + mdio_write(tp, 0x06, 0x0162); + mdio_write(tp, 0x06, 0x0280); + mdio_write(tp, 0x06, 0x9402); + mdio_write(tp, 0x06, 0x810e); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x88e1); + mdio_write(tp, 0x06, 0x8b89); + mdio_write(tp, 0x06, 0x1e01); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x8a1e); + mdio_write(tp, 0x06, 0x01e1); + mdio_write(tp, 0x06, 0x8b8b); + mdio_write(tp, 0x06, 0x1e01); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x8c1e); + mdio_write(tp, 0x06, 0x01e1); + mdio_write(tp, 0x06, 0x8b8d); + mdio_write(tp, 0x06, 0x1e01); + mdio_write(tp, 0x06, 0xe18b); + mdio_write(tp, 0x06, 0x8e1e); + mdio_write(tp, 0x06, 0x01a0); + mdio_write(tp, 0x06, 0x00c7); + mdio_write(tp, 0x06, 0xaebb); + mdio_write(tp, 0x06, 0xd481); + mdio_write(tp, 0x06, 0xd4e4); + mdio_write(tp, 0x06, 0x8b92); + mdio_write(tp, 0x06, 0xe58b); + mdio_write(tp, 0x06, 0x9302); + mdio_write(tp, 0x06, 0x2e5a); + mdio_write(tp, 0x06, 0xbf8b); + mdio_write(tp, 0x06, 0x88ec); + mdio_write(tp, 0x06, 0x0019); + mdio_write(tp, 0x06, 0xa98b); + mdio_write(tp, 0x06, 0x90f9); + mdio_write(tp, 0x06, 0xeeff); + mdio_write(tp, 0x06, 0xf600); + mdio_write(tp, 0x06, 0xeeff); + mdio_write(tp, 0x06, 0xf7fc); + mdio_write(tp, 0x06, 0xd100); + mdio_write(tp, 0x06, 0xbf83); + mdio_write(tp, 0x06, 0x3c02); + mdio_write(tp, 0x06, 0x3a21); + mdio_write(tp, 0x06, 0xd101); + mdio_write(tp, 0x06, 0xbf83); + mdio_write(tp, 0x06, 0x3f02); + mdio_write(tp, 0x06, 0x3a21); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x8aad); + mdio_write(tp, 0x06, 0x2014); + mdio_write(tp, 0x06, 0xee8b); + mdio_write(tp, 0x06, 0x8a00); + mdio_write(tp, 0x06, 0x0220); + mdio_write(tp, 0x06, 0x8be0); + mdio_write(tp, 0x06, 0xe426); + mdio_write(tp, 0x06, 0xe1e4); + mdio_write(tp, 0x06, 0x27ee); + mdio_write(tp, 0x06, 0xe426); + mdio_write(tp, 0x06, 0x23e5); + mdio_write(tp, 0x06, 0xe427); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0x8b8d); + mdio_write(tp, 0x06, 0xad20); + mdio_write(tp, 0x06, 0x14ee); + mdio_write(tp, 0x06, 0x8b8d); + mdio_write(tp, 0x06, 0x00e0); + mdio_write(tp, 0x06, 0x8a5a); + mdio_write(tp, 0x06, 0x7803); + mdio_write(tp, 0x06, 0x9e09); + mdio_write(tp, 0x06, 0x0206); + mdio_write(tp, 0x06, 0x2802); + mdio_write(tp, 0x06, 0x80b1); + mdio_write(tp, 0x06, 0x0232); + mdio_write(tp, 0x06, 0xfdfc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xf9e0); + mdio_write(tp, 0x06, 0x8b81); + mdio_write(tp, 0x06, 0xac26); + mdio_write(tp, 0x06, 0x1ae0); + mdio_write(tp, 0x06, 0x8b81); + mdio_write(tp, 0x06, 0xac21); + mdio_write(tp, 0x06, 0x14e0); + mdio_write(tp, 0x06, 0x8b85); + mdio_write(tp, 0x06, 0xac20); + mdio_write(tp, 0x06, 0x0ee0); + mdio_write(tp, 0x06, 0x8b85); + mdio_write(tp, 0x06, 0xac23); + mdio_write(tp, 0x06, 0x08e0); + mdio_write(tp, 0x06, 0x8b87); + mdio_write(tp, 0x06, 0xac24); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0x3802); + mdio_write(tp, 0x06, 0x1b02); + mdio_write(tp, 0x06, 0xeee4); + mdio_write(tp, 0x06, 0x1c04); + mdio_write(tp, 0x06, 0xeee4); + mdio_write(tp, 0x06, 0x1d04); + mdio_write(tp, 0x06, 0xe2e0); + mdio_write(tp, 0x06, 0x7ce3); + mdio_write(tp, 0x06, 0xe07d); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x38e1); + mdio_write(tp, 0x06, 0xe039); + mdio_write(tp, 0x06, 0xad2e); + mdio_write(tp, 0x06, 0x1bad); + mdio_write(tp, 0x06, 0x390d); + mdio_write(tp, 0x06, 0xd101); + mdio_write(tp, 0x06, 0xbf22); + mdio_write(tp, 0x06, 0xe802); + mdio_write(tp, 0x06, 0x3a21); + mdio_write(tp, 0x06, 0x0222); + mdio_write(tp, 0x06, 0x10ae); + mdio_write(tp, 0x06, 0x0bac); + mdio_write(tp, 0x06, 0x3802); + mdio_write(tp, 0x06, 0xae06); + mdio_write(tp, 0x06, 0x0222); + mdio_write(tp, 0x06, 0x4d02); + mdio_write(tp, 0x06, 0x2292); + mdio_write(tp, 0x06, 0x021b); + mdio_write(tp, 0x06, 0x13fd); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xad20); + mdio_write(tp, 0x06, 0x1af6); + mdio_write(tp, 0x06, 0x20e4); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0x022b); + mdio_write(tp, 0x06, 0x1e02); + mdio_write(tp, 0x06, 0x82ae); + mdio_write(tp, 0x06, 0x0203); + mdio_write(tp, 0x06, 0xc002); + mdio_write(tp, 0x06, 0x827d); + mdio_write(tp, 0x06, 0x022e); + mdio_write(tp, 0x06, 0x6f02); + mdio_write(tp, 0x06, 0x047b); + mdio_write(tp, 0x06, 0x022f); + mdio_write(tp, 0x06, 0x9ae0); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xad21); + mdio_write(tp, 0x06, 0x0bf6); + mdio_write(tp, 0x06, 0x21e4); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0x0281); + mdio_write(tp, 0x06, 0x9002); + mdio_write(tp, 0x06, 0x1cd9); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x8ead); + mdio_write(tp, 0x06, 0x2208); + mdio_write(tp, 0x06, 0xf622); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x8e02); + mdio_write(tp, 0x06, 0x35f4); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x8ead); + mdio_write(tp, 0x06, 0x2308); + mdio_write(tp, 0x06, 0xf623); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x8e02); + mdio_write(tp, 0x06, 0x31e8); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x8ead); + mdio_write(tp, 0x06, 0x2405); + mdio_write(tp, 0x06, 0xf624); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x8ee0); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xad25); + mdio_write(tp, 0x06, 0x05f6); + mdio_write(tp, 0x06, 0x25e4); + mdio_write(tp, 0x06, 0x8b8e); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x8ead); + mdio_write(tp, 0x06, 0x2608); + mdio_write(tp, 0x06, 0xf626); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x8e02); + mdio_write(tp, 0x06, 0x2d8a); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x8ead); + mdio_write(tp, 0x06, 0x2705); + mdio_write(tp, 0x06, 0xf627); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x8e02); + mdio_write(tp, 0x06, 0x0386); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8fa); + mdio_write(tp, 0x06, 0xef69); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x00e1); + mdio_write(tp, 0x06, 0xe001); + mdio_write(tp, 0x06, 0xad27); + mdio_write(tp, 0x06, 0x32e0); + mdio_write(tp, 0x06, 0x8b40); + mdio_write(tp, 0x06, 0xf720); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x40bf); + mdio_write(tp, 0x06, 0x32c1); + mdio_write(tp, 0x06, 0x0239); + mdio_write(tp, 0x06, 0xf4ad); + mdio_write(tp, 0x06, 0x2821); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x20e1); + mdio_write(tp, 0x06, 0xe021); + mdio_write(tp, 0x06, 0xad20); + mdio_write(tp, 0x06, 0x18e0); + mdio_write(tp, 0x06, 0x8b40); + mdio_write(tp, 0x06, 0xf620); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x40ee); + mdio_write(tp, 0x06, 0x8b3b); + mdio_write(tp, 0x06, 0xffe0); + mdio_write(tp, 0x06, 0x8a8a); + mdio_write(tp, 0x06, 0xe18a); + mdio_write(tp, 0x06, 0x8be4); + mdio_write(tp, 0x06, 0xe000); + mdio_write(tp, 0x06, 0xe5e0); + mdio_write(tp, 0x06, 0x01ef); + mdio_write(tp, 0x06, 0x96fe); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8f9); + mdio_write(tp, 0x06, 0xface); + mdio_write(tp, 0x06, 0xfaef); + mdio_write(tp, 0x06, 0x69fa); + mdio_write(tp, 0x06, 0xd401); + mdio_write(tp, 0x06, 0x55b4); + mdio_write(tp, 0x06, 0xfebf); + mdio_write(tp, 0x06, 0x1c5e); + mdio_write(tp, 0x06, 0x0239); + mdio_write(tp, 0x06, 0xf4ac); + mdio_write(tp, 0x06, 0x280b); + mdio_write(tp, 0x06, 0xbf1c); + mdio_write(tp, 0x06, 0x5b02); + mdio_write(tp, 0x06, 0x39f4); + mdio_write(tp, 0x06, 0xac28); + mdio_write(tp, 0x06, 0x49ae); + mdio_write(tp, 0x06, 0x64bf); + mdio_write(tp, 0x06, 0x1c5b); + mdio_write(tp, 0x06, 0x0239); + mdio_write(tp, 0x06, 0xf4ac); + mdio_write(tp, 0x06, 0x285b); + mdio_write(tp, 0x06, 0xd000); + mdio_write(tp, 0x06, 0x0282); + mdio_write(tp, 0x06, 0x62ac); + mdio_write(tp, 0x06, 0x2105); + mdio_write(tp, 0x06, 0xac22); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0x4ebf); + mdio_write(tp, 0x06, 0xe0c4); + mdio_write(tp, 0x06, 0xbe85); + mdio_write(tp, 0x06, 0xecd2); + mdio_write(tp, 0x06, 0x04d8); + mdio_write(tp, 0x06, 0x19d9); + mdio_write(tp, 0x06, 0x1907); + mdio_write(tp, 0x06, 0xdc19); + mdio_write(tp, 0x06, 0xdd19); + mdio_write(tp, 0x06, 0x0789); + mdio_write(tp, 0x06, 0x89ef); + mdio_write(tp, 0x06, 0x645e); + mdio_write(tp, 0x06, 0x07ff); + mdio_write(tp, 0x06, 0x0d65); + mdio_write(tp, 0x06, 0x5cf8); + mdio_write(tp, 0x06, 0x001e); + mdio_write(tp, 0x06, 0x46dc); + mdio_write(tp, 0x06, 0x19dd); + mdio_write(tp, 0x06, 0x19b2); + mdio_write(tp, 0x06, 0xe2d4); + mdio_write(tp, 0x06, 0x0001); + mdio_write(tp, 0x06, 0xbf1c); + mdio_write(tp, 0x06, 0x5b02); + mdio_write(tp, 0x06, 0x3a21); + mdio_write(tp, 0x06, 0xae1d); + mdio_write(tp, 0x06, 0xbee0); + mdio_write(tp, 0x06, 0xc4bf); + mdio_write(tp, 0x06, 0x85ec); + mdio_write(tp, 0x06, 0xd204); + mdio_write(tp, 0x06, 0xd819); + mdio_write(tp, 0x06, 0xd919); + mdio_write(tp, 0x06, 0x07dc); + mdio_write(tp, 0x06, 0x19dd); + mdio_write(tp, 0x06, 0x1907); + mdio_write(tp, 0x06, 0xb2f4); + mdio_write(tp, 0x06, 0xd400); + mdio_write(tp, 0x06, 0x00bf); + mdio_write(tp, 0x06, 0x1c5b); + mdio_write(tp, 0x06, 0x023a); + mdio_write(tp, 0x06, 0x21fe); + mdio_write(tp, 0x06, 0xef96); + mdio_write(tp, 0x06, 0xfec6); + mdio_write(tp, 0x06, 0xfefd); + mdio_write(tp, 0x06, 0xfc05); + mdio_write(tp, 0x06, 0xf9e2); + mdio_write(tp, 0x06, 0xe0ea); + mdio_write(tp, 0x06, 0xe3e0); + mdio_write(tp, 0x06, 0xeb5a); + mdio_write(tp, 0x06, 0x070c); + mdio_write(tp, 0x06, 0x031e); + mdio_write(tp, 0x06, 0x20e6); + mdio_write(tp, 0x06, 0xe0ea); + mdio_write(tp, 0x06, 0xe7e0); + mdio_write(tp, 0x06, 0xebe0); + mdio_write(tp, 0x06, 0xe0fc); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0xfdfd); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xfaef); + mdio_write(tp, 0x06, 0x69e0); + mdio_write(tp, 0x06, 0x8b80); + mdio_write(tp, 0x06, 0xad27); + mdio_write(tp, 0x06, 0x22bf); + mdio_write(tp, 0x06, 0x47ba); + mdio_write(tp, 0x06, 0x0239); + mdio_write(tp, 0x06, 0xf4e0); + mdio_write(tp, 0x06, 0x8b44); + mdio_write(tp, 0x06, 0x1f01); + mdio_write(tp, 0x06, 0x9e15); + mdio_write(tp, 0x06, 0xe58b); + mdio_write(tp, 0x06, 0x44ad); + mdio_write(tp, 0x06, 0x2907); + mdio_write(tp, 0x06, 0xac28); + mdio_write(tp, 0x06, 0x04d1); + mdio_write(tp, 0x06, 0x01ae); + mdio_write(tp, 0x06, 0x02d1); + mdio_write(tp, 0x06, 0x00bf); + mdio_write(tp, 0x06, 0x8342); + mdio_write(tp, 0x06, 0x023a); + mdio_write(tp, 0x06, 0x21ef); + mdio_write(tp, 0x06, 0x96fe); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0x8b85); + mdio_write(tp, 0x06, 0xad26); + mdio_write(tp, 0x06, 0x30e0); + mdio_write(tp, 0x06, 0xe036); + mdio_write(tp, 0x06, 0xe1e0); + mdio_write(tp, 0x06, 0x37e1); + mdio_write(tp, 0x06, 0x8b3f); + mdio_write(tp, 0x06, 0x1f10); + mdio_write(tp, 0x06, 0x9e23); + mdio_write(tp, 0x06, 0xe48b); + mdio_write(tp, 0x06, 0x3fac); + mdio_write(tp, 0x06, 0x200b); + mdio_write(tp, 0x06, 0xac21); + mdio_write(tp, 0x06, 0x0dac); + mdio_write(tp, 0x06, 0x250f); + mdio_write(tp, 0x06, 0xac27); + mdio_write(tp, 0x06, 0x11ae); + mdio_write(tp, 0x06, 0x1202); + mdio_write(tp, 0x06, 0x2cb5); + mdio_write(tp, 0x06, 0xae0d); + mdio_write(tp, 0x06, 0x0282); + mdio_write(tp, 0x06, 0xe7ae); + mdio_write(tp, 0x06, 0x0802); + mdio_write(tp, 0x06, 0x2cd7); + mdio_write(tp, 0x06, 0xae03); + mdio_write(tp, 0x06, 0x022c); + mdio_write(tp, 0x06, 0xeafc); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xfaef); + mdio_write(tp, 0x06, 0x6902); + mdio_write(tp, 0x06, 0x8304); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x14e1); + mdio_write(tp, 0x06, 0xe015); + mdio_write(tp, 0x06, 0xad26); + mdio_write(tp, 0x06, 0x08d1); + mdio_write(tp, 0x06, 0x1ebf); + mdio_write(tp, 0x06, 0x2d47); + mdio_write(tp, 0x06, 0x023a); + mdio_write(tp, 0x06, 0x21ef); + mdio_write(tp, 0x06, 0x96fe); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0x8b85); + mdio_write(tp, 0x06, 0xad27); + mdio_write(tp, 0x06, 0x2fd0); + mdio_write(tp, 0x06, 0x0b02); + mdio_write(tp, 0x06, 0x3826); + mdio_write(tp, 0x06, 0x5882); + mdio_write(tp, 0x06, 0x7882); + mdio_write(tp, 0x06, 0x9f24); + mdio_write(tp, 0x06, 0xe08b); + mdio_write(tp, 0x06, 0x32e1); + mdio_write(tp, 0x06, 0x8b33); + mdio_write(tp, 0x06, 0x1f10); + mdio_write(tp, 0x06, 0x9e1a); + mdio_write(tp, 0x06, 0x10e4); + mdio_write(tp, 0x06, 0x8b32); + mdio_write(tp, 0x06, 0xe0e0); + mdio_write(tp, 0x06, 0x28e1); + mdio_write(tp, 0x06, 0xe029); + mdio_write(tp, 0x06, 0xf72c); + mdio_write(tp, 0x06, 0xe4e0); + mdio_write(tp, 0x06, 0x28e5); + mdio_write(tp, 0x06, 0xe029); + mdio_write(tp, 0x06, 0xf62c); + mdio_write(tp, 0x06, 0xe4e0); + mdio_write(tp, 0x06, 0x28e5); + mdio_write(tp, 0x06, 0xe029); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0x00e1); + mdio_write(tp, 0x06, 0x4077); + mdio_write(tp, 0x06, 0xe140); + mdio_write(tp, 0x06, 0xbbe0); + mdio_write(tp, 0x06, 0x2a00); + mdio_write(tp, 0x05, 0xe142); + gphy_val = mdio_read(tp, 0x06); + gphy_val |= BIT_0; + mdio_write(tp,0x06, gphy_val); + mdio_write(tp, 0x05, 0xe140); + gphy_val = mdio_read(tp, 0x06); + gphy_val |= BIT_0; + mdio_write(tp,0x06, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp,0x1f, 0x0005); + for (i = 0; i < 200; i++) { + udelay(100); + gphy_val = mdio_read(tp, 0x00); + if (gphy_val & BIT_7) + break; + } + mdio_write(tp,0x1f, 0x0007); + mdio_write(tp,0x1e, 0x0023); + gphy_val = mdio_read(tp, 0x17); + gphy_val |= BIT_1; + if (tp->RequiredSecLanDonglePatch) + gphy_val &= ~BIT_2; + mdio_write(tp,0x17, gphy_val); + mdio_write(tp,0x1f, 0x0000); + + mdio_write(tp, 0x1F, 0x0003); + mdio_write(tp, 0x09, 0xA20F); + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, 0x1f, 0x0003); + mdio_write(tp, 0x01, 0x328A); + mdio_write(tp, 0x1f, 0x0000); + + mdio_write(tp,0x1f, 0x0000); + mdio_write(tp,0x00, 0x9200); +} + +static void +rtl8168_set_phy_mcu_8168g_1(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + unsigned int gphy_val,i; + + mdio_write(tp, 0x1f, 0x0B82); + gphy_val = mdio_read(tp, 0x10); + gphy_val |= BIT_4; + mdio_write(tp, 0x10, gphy_val); + mdio_write(tp, 0x1f, 0x0B80); + for (i = 0; i < 10; i++) { + if (mdio_read(tp, 0x10) & 0x0040) + break; + mdelay(10); + } + mdio_write(tp, 0x1f, 0x0A43); + mdio_write(tp, 0x13, 0x8146); + mdio_write(tp, 0x14, 0x2300); + mdio_write(tp, 0x13, 0xB820); + mdio_write(tp, 0x14, 0x0210); + + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0xB820); + mdio_write(tp, 0x14, 0x0290); + mdio_write(tp, 0x13, 0xA012); + mdio_write(tp, 0x14, 0x0000); + mdio_write(tp, 0x13, 0xA014); + mdio_write(tp, 0x14, 0x2c04); + mdio_write(tp, 0x14, 0x2c0c); + mdio_write(tp, 0x14, 0x2c6c); + mdio_write(tp, 0x14, 0x2d0d); + mdio_write(tp, 0x14, 0x31ce); + mdio_write(tp, 0x14, 0x506d); + mdio_write(tp, 0x14, 0xd708); + mdio_write(tp, 0x14, 0x3108); + mdio_write(tp, 0x14, 0x106d); + mdio_write(tp, 0x14, 0x1560); + mdio_write(tp, 0x14, 0x15a9); + mdio_write(tp, 0x14, 0x206e); + mdio_write(tp, 0x14, 0x175b); + mdio_write(tp, 0x14, 0x6062); + mdio_write(tp, 0x14, 0xd700); + mdio_write(tp, 0x14, 0x5fae); + mdio_write(tp, 0x14, 0xd708); + mdio_write(tp, 0x14, 0x3107); + mdio_write(tp, 0x14, 0x4c1e); + mdio_write(tp, 0x14, 0x4169); + mdio_write(tp, 0x14, 0x316a); + mdio_write(tp, 0x14, 0x0c19); + mdio_write(tp, 0x14, 0x31aa); + mdio_write(tp, 0x14, 0x0c19); + mdio_write(tp, 0x14, 0x2c1b); + mdio_write(tp, 0x14, 0x5e62); + mdio_write(tp, 0x14, 0x26b5); + mdio_write(tp, 0x14, 0x31ab); + mdio_write(tp, 0x14, 0x5c1e); + mdio_write(tp, 0x14, 0x2c0c); + mdio_write(tp, 0x14, 0xc040); + mdio_write(tp, 0x14, 0x8808); + mdio_write(tp, 0x14, 0xc520); + mdio_write(tp, 0x14, 0xc421); + mdio_write(tp, 0x14, 0xd05a); + mdio_write(tp, 0x14, 0xd19a); + mdio_write(tp, 0x14, 0xd709); + mdio_write(tp, 0x14, 0x608f); + mdio_write(tp, 0x14, 0xd06b); + mdio_write(tp, 0x14, 0xd18a); + mdio_write(tp, 0x14, 0x2c2c); + mdio_write(tp, 0x14, 0xd0be); + mdio_write(tp, 0x14, 0xd188); + mdio_write(tp, 0x14, 0x2c2c); + mdio_write(tp, 0x14, 0xd708); + mdio_write(tp, 0x14, 0x4072); + mdio_write(tp, 0x14, 0xc104); + mdio_write(tp, 0x14, 0x2c3e); + mdio_write(tp, 0x14, 0x4076); + mdio_write(tp, 0x14, 0xc110); + mdio_write(tp, 0x14, 0x2c3e); + mdio_write(tp, 0x14, 0x4071); + mdio_write(tp, 0x14, 0xc102); + mdio_write(tp, 0x14, 0x2c3e); + mdio_write(tp, 0x14, 0x4070); + mdio_write(tp, 0x14, 0xc101); + mdio_write(tp, 0x14, 0x2c3e); + mdio_write(tp, 0x14, 0x175b); + mdio_write(tp, 0x14, 0xd709); + mdio_write(tp, 0x14, 0x3390); + mdio_write(tp, 0x14, 0x5c39); + mdio_write(tp, 0x14, 0x2c4e); + mdio_write(tp, 0x14, 0x175b); + mdio_write(tp, 0x14, 0xd708); + mdio_write(tp, 0x14, 0x6193); + mdio_write(tp, 0x14, 0xd709); + mdio_write(tp, 0x14, 0x5f9d); + mdio_write(tp, 0x14, 0x408b); + mdio_write(tp, 0x14, 0xd71e); + mdio_write(tp, 0x14, 0x6042); + mdio_write(tp, 0x14, 0xb401); + mdio_write(tp, 0x14, 0x175b); + mdio_write(tp, 0x14, 0xd708); + mdio_write(tp, 0x14, 0x6073); + mdio_write(tp, 0x14, 0x5fbc); + mdio_write(tp, 0x14, 0x2c4d); + mdio_write(tp, 0x14, 0x26ed); + mdio_write(tp, 0x14, 0xb280); + mdio_write(tp, 0x14, 0xa841); + mdio_write(tp, 0x14, 0x9420); + mdio_write(tp, 0x14, 0x8710); + mdio_write(tp, 0x14, 0xd709); + mdio_write(tp, 0x14, 0x42ec); + mdio_write(tp, 0x14, 0x606d); + mdio_write(tp, 0x14, 0xd207); + mdio_write(tp, 0x14, 0x2c57); + mdio_write(tp, 0x14, 0xd203); + mdio_write(tp, 0x14, 0x33ff); + mdio_write(tp, 0x14, 0x563b); + mdio_write(tp, 0x14, 0x3275); + mdio_write(tp, 0x14, 0x7c5e); + mdio_write(tp, 0x14, 0xb240); + mdio_write(tp, 0x14, 0xb402); + mdio_write(tp, 0x14, 0x263b); + mdio_write(tp, 0x14, 0x6096); + mdio_write(tp, 0x14, 0xb240); + mdio_write(tp, 0x14, 0xb406); + mdio_write(tp, 0x14, 0x263b); + mdio_write(tp, 0x14, 0x31d7); + mdio_write(tp, 0x14, 0x7c67); + mdio_write(tp, 0x14, 0xb240); + mdio_write(tp, 0x14, 0xb40e); + mdio_write(tp, 0x14, 0x263b); + mdio_write(tp, 0x14, 0xb410); + mdio_write(tp, 0x14, 0x8802); + mdio_write(tp, 0x14, 0xb240); + mdio_write(tp, 0x14, 0x940e); + mdio_write(tp, 0x14, 0x263b); + mdio_write(tp, 0x14, 0xba04); + mdio_write(tp, 0x14, 0x1cd6); + mdio_write(tp, 0x14, 0xa902); + mdio_write(tp, 0x14, 0xd711); + mdio_write(tp, 0x14, 0x4045); + mdio_write(tp, 0x14, 0xa980); + mdio_write(tp, 0x14, 0x3003); + mdio_write(tp, 0x14, 0x59b1); + mdio_write(tp, 0x14, 0xa540); + mdio_write(tp, 0x14, 0xa601); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x4043); + mdio_write(tp, 0x14, 0xa910); + mdio_write(tp, 0x14, 0xd711); + mdio_write(tp, 0x14, 0x60a0); + mdio_write(tp, 0x14, 0xca33); + mdio_write(tp, 0x14, 0xcb33); + mdio_write(tp, 0x14, 0xa941); + mdio_write(tp, 0x14, 0x2c82); + mdio_write(tp, 0x14, 0xcaff); + mdio_write(tp, 0x14, 0xcbff); + mdio_write(tp, 0x14, 0xa921); + mdio_write(tp, 0x14, 0xce02); + mdio_write(tp, 0x14, 0xe070); + mdio_write(tp, 0x14, 0x0f10); + mdio_write(tp, 0x14, 0xaf01); + mdio_write(tp, 0x14, 0x8f01); + mdio_write(tp, 0x14, 0x1766); + mdio_write(tp, 0x14, 0x8e02); + mdio_write(tp, 0x14, 0x1787); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x609c); + mdio_write(tp, 0x14, 0xd71e); + mdio_write(tp, 0x14, 0x7fa4); + mdio_write(tp, 0x14, 0x2cd4); + mdio_write(tp, 0x14, 0x1ce9); + mdio_write(tp, 0x14, 0xce04); + mdio_write(tp, 0x14, 0xe070); + mdio_write(tp, 0x14, 0x0f20); + mdio_write(tp, 0x14, 0xaf01); + mdio_write(tp, 0x14, 0x8f01); + mdio_write(tp, 0x14, 0x1766); + mdio_write(tp, 0x14, 0x8e04); + mdio_write(tp, 0x14, 0x6044); + mdio_write(tp, 0x14, 0x2cd4); + mdio_write(tp, 0x14, 0xa520); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x4043); + mdio_write(tp, 0x14, 0x2cc1); + mdio_write(tp, 0x14, 0xe00f); + mdio_write(tp, 0x14, 0x0501); + mdio_write(tp, 0x14, 0x1cef); + mdio_write(tp, 0x14, 0xb801); + mdio_write(tp, 0x14, 0xd71e); + mdio_write(tp, 0x14, 0x4060); + mdio_write(tp, 0x14, 0x7fc4); + mdio_write(tp, 0x14, 0x2cd4); + mdio_write(tp, 0x14, 0x1cf5); + mdio_write(tp, 0x14, 0xe00f); + mdio_write(tp, 0x14, 0x0502); + mdio_write(tp, 0x14, 0x1cef); + mdio_write(tp, 0x14, 0xb802); + mdio_write(tp, 0x14, 0xd71e); + mdio_write(tp, 0x14, 0x4061); + mdio_write(tp, 0x14, 0x7fc4); + mdio_write(tp, 0x14, 0x2cd4); + mdio_write(tp, 0x14, 0x1cf5); + mdio_write(tp, 0x14, 0xe00f); + mdio_write(tp, 0x14, 0x0504); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x6099); + mdio_write(tp, 0x14, 0xd71e); + mdio_write(tp, 0x14, 0x7fa4); + mdio_write(tp, 0x14, 0x2cd4); + mdio_write(tp, 0x14, 0xc17f); + mdio_write(tp, 0x14, 0xc200); + mdio_write(tp, 0x14, 0xc43f); + mdio_write(tp, 0x14, 0xcc03); + mdio_write(tp, 0x14, 0xa701); + mdio_write(tp, 0x14, 0xa510); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x4018); + mdio_write(tp, 0x14, 0x9910); + mdio_write(tp, 0x14, 0x8510); + mdio_write(tp, 0x14, 0x2860); + mdio_write(tp, 0x14, 0xe00f); + mdio_write(tp, 0x14, 0x0504); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x6099); + mdio_write(tp, 0x14, 0xd71e); + mdio_write(tp, 0x14, 0x7fa4); + mdio_write(tp, 0x14, 0x2cd4); + mdio_write(tp, 0x14, 0xa608); + mdio_write(tp, 0x14, 0xc17d); + mdio_write(tp, 0x14, 0xc200); + mdio_write(tp, 0x14, 0xc43f); + mdio_write(tp, 0x14, 0xcc03); + mdio_write(tp, 0x14, 0xa701); + mdio_write(tp, 0x14, 0xa510); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x4018); + mdio_write(tp, 0x14, 0x9910); + mdio_write(tp, 0x14, 0x8510); + mdio_write(tp, 0x14, 0x2926); + mdio_write(tp, 0x14, 0x1792); + mdio_write(tp, 0x14, 0x27db); + mdio_write(tp, 0x14, 0xc000); + mdio_write(tp, 0x14, 0xc100); + mdio_write(tp, 0x14, 0xc200); + mdio_write(tp, 0x14, 0xc300); + mdio_write(tp, 0x14, 0xc400); + mdio_write(tp, 0x14, 0xc500); + mdio_write(tp, 0x14, 0xc600); + mdio_write(tp, 0x14, 0xc7c1); + mdio_write(tp, 0x14, 0xc800); + mdio_write(tp, 0x14, 0xcc00); + mdio_write(tp, 0x14, 0x0800); + mdio_write(tp, 0x14, 0xca0f); + mdio_write(tp, 0x14, 0xcbff); + mdio_write(tp, 0x14, 0xa901); + mdio_write(tp, 0x14, 0x8902); + mdio_write(tp, 0x14, 0xc900); + mdio_write(tp, 0x14, 0xca00); + mdio_write(tp, 0x14, 0xcb00); + mdio_write(tp, 0x14, 0x0800); + mdio_write(tp, 0x14, 0xb804); + mdio_write(tp, 0x14, 0x0800); + mdio_write(tp, 0x14, 0xd71e); + mdio_write(tp, 0x14, 0x6044); + mdio_write(tp, 0x14, 0x9804); + mdio_write(tp, 0x14, 0x0800); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x6099); + mdio_write(tp, 0x14, 0xd71e); + mdio_write(tp, 0x14, 0x7fa4); + mdio_write(tp, 0x14, 0x2cd4); + mdio_write(tp, 0x14, 0x0800); + mdio_write(tp, 0x14, 0xa510); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x6098); + mdio_write(tp, 0x14, 0xd71e); + mdio_write(tp, 0x14, 0x7fa4); + mdio_write(tp, 0x14, 0x2cd4); + mdio_write(tp, 0x14, 0x8510); + mdio_write(tp, 0x14, 0x0800); + mdio_write(tp, 0x14, 0xd711); + mdio_write(tp, 0x14, 0x3003); + mdio_write(tp, 0x14, 0x1d01); + mdio_write(tp, 0x14, 0x2d0b); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x60be); + mdio_write(tp, 0x14, 0xe060); + mdio_write(tp, 0x14, 0x0920); + mdio_write(tp, 0x14, 0x1cd6); + mdio_write(tp, 0x14, 0x2c89); + mdio_write(tp, 0x14, 0xd71e); + mdio_write(tp, 0x14, 0x3063); + mdio_write(tp, 0x14, 0x1948); + mdio_write(tp, 0x14, 0x288a); + mdio_write(tp, 0x14, 0x1cd6); + mdio_write(tp, 0x14, 0x29bd); + mdio_write(tp, 0x14, 0xa802); + mdio_write(tp, 0x14, 0xa303); + mdio_write(tp, 0x14, 0x843f); + mdio_write(tp, 0x14, 0x81ff); + mdio_write(tp, 0x14, 0x8208); + mdio_write(tp, 0x14, 0xa201); + mdio_write(tp, 0x14, 0xc001); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x30a0); + mdio_write(tp, 0x14, 0x0d1c); + mdio_write(tp, 0x14, 0x30a0); + mdio_write(tp, 0x14, 0x3d13); + mdio_write(tp, 0x14, 0xd71e); + mdio_write(tp, 0x14, 0x7f4c); + mdio_write(tp, 0x14, 0x2ab6); + mdio_write(tp, 0x14, 0xe003); + mdio_write(tp, 0x14, 0x0202); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x6090); + mdio_write(tp, 0x14, 0xd71e); + mdio_write(tp, 0x14, 0x7fac); + mdio_write(tp, 0x14, 0x2ab6); + mdio_write(tp, 0x14, 0xa20c); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x6091); + mdio_write(tp, 0x14, 0xd71e); + mdio_write(tp, 0x14, 0x7fac); + mdio_write(tp, 0x14, 0x2ab6); + mdio_write(tp, 0x14, 0x820e); + mdio_write(tp, 0x14, 0xa3e0); + mdio_write(tp, 0x14, 0xa520); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x609d); + mdio_write(tp, 0x14, 0xd71e); + mdio_write(tp, 0x14, 0x7fac); + mdio_write(tp, 0x14, 0x2ab6); + mdio_write(tp, 0x14, 0x8520); + mdio_write(tp, 0x14, 0x6703); + mdio_write(tp, 0x14, 0x2d34); + mdio_write(tp, 0x14, 0xa13e); + mdio_write(tp, 0x14, 0xc001); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x4000); + mdio_write(tp, 0x14, 0x6046); + mdio_write(tp, 0x14, 0x2d0d); + mdio_write(tp, 0x14, 0xa43f); + mdio_write(tp, 0x14, 0xa101); + mdio_write(tp, 0x14, 0xc020); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x3121); + mdio_write(tp, 0x14, 0x0d45); + mdio_write(tp, 0x14, 0x30c0); + mdio_write(tp, 0x14, 0x3d0d); + mdio_write(tp, 0x14, 0xd71e); + mdio_write(tp, 0x14, 0x7f4c); + mdio_write(tp, 0x14, 0x2ab6); + mdio_write(tp, 0x14, 0xa540); + mdio_write(tp, 0x14, 0xc001); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x4001); + mdio_write(tp, 0x14, 0xe00f); + mdio_write(tp, 0x14, 0x0501); + mdio_write(tp, 0x14, 0x1dac); + mdio_write(tp, 0x14, 0xc1c4); + mdio_write(tp, 0x14, 0xa268); + mdio_write(tp, 0x14, 0xa303); + mdio_write(tp, 0x14, 0x8420); + mdio_write(tp, 0x14, 0xe00f); + mdio_write(tp, 0x14, 0x0502); + mdio_write(tp, 0x14, 0x1dac); + mdio_write(tp, 0x14, 0xc002); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x4000); + mdio_write(tp, 0x14, 0x8208); + mdio_write(tp, 0x14, 0x8410); + mdio_write(tp, 0x14, 0xa121); + mdio_write(tp, 0x14, 0xc002); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x4000); + mdio_write(tp, 0x14, 0x8120); + mdio_write(tp, 0x14, 0x8180); + mdio_write(tp, 0x14, 0x1d97); + mdio_write(tp, 0x14, 0xa180); + mdio_write(tp, 0x14, 0xa13a); + mdio_write(tp, 0x14, 0x8240); + mdio_write(tp, 0x14, 0xa430); + mdio_write(tp, 0x14, 0xc010); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x30e1); + mdio_write(tp, 0x14, 0x0abc); + mdio_write(tp, 0x14, 0xd71e); + mdio_write(tp, 0x14, 0x7f8c); + mdio_write(tp, 0x14, 0x2ab6); + mdio_write(tp, 0x14, 0xa480); + mdio_write(tp, 0x14, 0xa230); + mdio_write(tp, 0x14, 0xa303); + mdio_write(tp, 0x14, 0xc001); + mdio_write(tp, 0x14, 0xd70c); + mdio_write(tp, 0x14, 0x4124); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x6120); + mdio_write(tp, 0x14, 0xd711); + mdio_write(tp, 0x14, 0x3128); + mdio_write(tp, 0x14, 0x3d76); + mdio_write(tp, 0x14, 0x2d70); + mdio_write(tp, 0x14, 0xa801); + mdio_write(tp, 0x14, 0x2d6c); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x4000); + mdio_write(tp, 0x14, 0xe018); + mdio_write(tp, 0x14, 0x0208); + mdio_write(tp, 0x14, 0xa1f8); + mdio_write(tp, 0x14, 0x8480); + mdio_write(tp, 0x14, 0xc004); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x4000); + mdio_write(tp, 0x14, 0x6046); + mdio_write(tp, 0x14, 0x2d0d); + mdio_write(tp, 0x14, 0xa43f); + mdio_write(tp, 0x14, 0xa105); + mdio_write(tp, 0x14, 0x8228); + mdio_write(tp, 0x14, 0xc004); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x4000); + mdio_write(tp, 0x14, 0x81bc); + mdio_write(tp, 0x14, 0xa220); + mdio_write(tp, 0x14, 0x1d97); + mdio_write(tp, 0x14, 0x8220); + mdio_write(tp, 0x14, 0xa1bc); + mdio_write(tp, 0x14, 0xc040); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x30e1); + mdio_write(tp, 0x14, 0x0abc); + mdio_write(tp, 0x14, 0x30e1); + mdio_write(tp, 0x14, 0x3d0d); + mdio_write(tp, 0x14, 0xd71e); + mdio_write(tp, 0x14, 0x7f4c); + mdio_write(tp, 0x14, 0x2ab6); + mdio_write(tp, 0x14, 0xa802); + mdio_write(tp, 0x14, 0xd70c); + mdio_write(tp, 0x14, 0x4244); + mdio_write(tp, 0x14, 0xa301); + mdio_write(tp, 0x14, 0xc004); + mdio_write(tp, 0x14, 0xd711); + mdio_write(tp, 0x14, 0x3128); + mdio_write(tp, 0x14, 0x3da5); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x5f80); + mdio_write(tp, 0x14, 0xd711); + mdio_write(tp, 0x14, 0x3109); + mdio_write(tp, 0x14, 0x3da7); + mdio_write(tp, 0x14, 0x2dab); + mdio_write(tp, 0x14, 0xa801); + mdio_write(tp, 0x14, 0x2d9a); + mdio_write(tp, 0x14, 0xa802); + mdio_write(tp, 0x14, 0xc004); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x4000); + mdio_write(tp, 0x14, 0x0800); + mdio_write(tp, 0x14, 0xa510); + mdio_write(tp, 0x14, 0xd710); + mdio_write(tp, 0x14, 0x609a); + mdio_write(tp, 0x14, 0xd71e); + mdio_write(tp, 0x14, 0x7fac); + mdio_write(tp, 0x14, 0x2ab6); + mdio_write(tp, 0x14, 0x8510); + mdio_write(tp, 0x14, 0x0800); + mdio_write(tp, 0x13, 0xA01A); + mdio_write(tp, 0x14, 0x0000); + mdio_write(tp, 0x13, 0xA006); + mdio_write(tp, 0x14, 0x0ad6); + mdio_write(tp, 0x13, 0xA004); + mdio_write(tp, 0x14, 0x07f5); + mdio_write(tp, 0x13, 0xA002); + mdio_write(tp, 0x14, 0x06a9); + mdio_write(tp, 0x13, 0xA000); + mdio_write(tp, 0x14, 0xf069); + mdio_write(tp, 0x13, 0xB820); + mdio_write(tp, 0x14, 0x0210); + + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x83a0); + mdio_write(tp, 0x14, 0xaf83); + mdio_write(tp, 0x14, 0xacaf); + mdio_write(tp, 0x14, 0x83b8); + mdio_write(tp, 0x14, 0xaf83); + mdio_write(tp, 0x14, 0xcdaf); + mdio_write(tp, 0x14, 0x83d3); + mdio_write(tp, 0x14, 0x0204); + mdio_write(tp, 0x14, 0x9a02); + mdio_write(tp, 0x14, 0x09a9); + mdio_write(tp, 0x14, 0x0284); + mdio_write(tp, 0x14, 0x61af); + mdio_write(tp, 0x14, 0x02fc); + mdio_write(tp, 0x14, 0xad20); + mdio_write(tp, 0x14, 0x0302); + mdio_write(tp, 0x14, 0x867c); + mdio_write(tp, 0x14, 0xad21); + mdio_write(tp, 0x14, 0x0302); + mdio_write(tp, 0x14, 0x85c9); + mdio_write(tp, 0x14, 0xad22); + mdio_write(tp, 0x14, 0x0302); + mdio_write(tp, 0x14, 0x1bc0); + mdio_write(tp, 0x14, 0xaf17); + mdio_write(tp, 0x14, 0xe302); + mdio_write(tp, 0x14, 0x8703); + mdio_write(tp, 0x14, 0xaf18); + mdio_write(tp, 0x14, 0x6201); + mdio_write(tp, 0x14, 0x06e0); + mdio_write(tp, 0x14, 0x8148); + mdio_write(tp, 0x14, 0xaf3c); + mdio_write(tp, 0x14, 0x69f8); + mdio_write(tp, 0x14, 0xf9fa); + mdio_write(tp, 0x14, 0xef69); + mdio_write(tp, 0x14, 0xee80); + mdio_write(tp, 0x14, 0x10f7); + mdio_write(tp, 0x14, 0xee80); + mdio_write(tp, 0x14, 0x131f); + mdio_write(tp, 0x14, 0xd104); + mdio_write(tp, 0x14, 0xbf87); + mdio_write(tp, 0x14, 0xf302); + mdio_write(tp, 0x14, 0x4259); + mdio_write(tp, 0x14, 0x0287); + mdio_write(tp, 0x14, 0x88bf); + mdio_write(tp, 0x14, 0x87cf); + mdio_write(tp, 0x14, 0xd7b8); + mdio_write(tp, 0x14, 0x22d0); + mdio_write(tp, 0x14, 0x0c02); + mdio_write(tp, 0x14, 0x4252); + mdio_write(tp, 0x14, 0xee80); + mdio_write(tp, 0x14, 0xcda0); + mdio_write(tp, 0x14, 0xee80); + mdio_write(tp, 0x14, 0xce8b); + mdio_write(tp, 0x14, 0xee80); + mdio_write(tp, 0x14, 0xd1f5); + mdio_write(tp, 0x14, 0xee80); + mdio_write(tp, 0x14, 0xd2a9); + mdio_write(tp, 0x14, 0xee80); + mdio_write(tp, 0x14, 0xd30a); + mdio_write(tp, 0x14, 0xee80); + mdio_write(tp, 0x14, 0xf010); + mdio_write(tp, 0x14, 0xee80); + mdio_write(tp, 0x14, 0xf38f); + mdio_write(tp, 0x14, 0xee81); + mdio_write(tp, 0x14, 0x011e); + mdio_write(tp, 0x14, 0xee81); + mdio_write(tp, 0x14, 0x0b4a); + mdio_write(tp, 0x14, 0xee81); + mdio_write(tp, 0x14, 0x0c7c); + mdio_write(tp, 0x14, 0xee81); + mdio_write(tp, 0x14, 0x127f); + mdio_write(tp, 0x14, 0xd100); + mdio_write(tp, 0x14, 0x0210); + mdio_write(tp, 0x14, 0xb5ee); + mdio_write(tp, 0x14, 0x8088); + mdio_write(tp, 0x14, 0xa4ee); + mdio_write(tp, 0x14, 0x8089); + mdio_write(tp, 0x14, 0x44ee); + mdio_write(tp, 0x14, 0x809a); + mdio_write(tp, 0x14, 0xa4ee); + mdio_write(tp, 0x14, 0x809b); + mdio_write(tp, 0x14, 0x44ee); + mdio_write(tp, 0x14, 0x809c); + mdio_write(tp, 0x14, 0xa7ee); + mdio_write(tp, 0x14, 0x80a5); + mdio_write(tp, 0x14, 0xa7d2); + mdio_write(tp, 0x14, 0x0002); + mdio_write(tp, 0x14, 0x0e66); + mdio_write(tp, 0x14, 0x0285); + mdio_write(tp, 0x14, 0xc0ee); + mdio_write(tp, 0x14, 0x87fc); + mdio_write(tp, 0x14, 0x00e0); + mdio_write(tp, 0x14, 0x8245); + mdio_write(tp, 0x14, 0xf622); + mdio_write(tp, 0x14, 0xe482); + mdio_write(tp, 0x14, 0x45ef); + mdio_write(tp, 0x14, 0x96fe); + mdio_write(tp, 0x14, 0xfdfc); + mdio_write(tp, 0x14, 0x0402); + mdio_write(tp, 0x14, 0x847a); + mdio_write(tp, 0x14, 0x0284); + mdio_write(tp, 0x14, 0xb302); + mdio_write(tp, 0x14, 0x0cab); + mdio_write(tp, 0x14, 0x020c); + mdio_write(tp, 0x14, 0xc402); + mdio_write(tp, 0x14, 0x0cef); + mdio_write(tp, 0x14, 0x020d); + mdio_write(tp, 0x14, 0x0802); + mdio_write(tp, 0x14, 0x0d33); + mdio_write(tp, 0x14, 0x020c); + mdio_write(tp, 0x14, 0x3d04); + mdio_write(tp, 0x14, 0xf8fa); + mdio_write(tp, 0x14, 0xef69); + mdio_write(tp, 0x14, 0xe182); + mdio_write(tp, 0x14, 0x2fac); + mdio_write(tp, 0x14, 0x291a); + mdio_write(tp, 0x14, 0xe082); + mdio_write(tp, 0x14, 0x24ac); + mdio_write(tp, 0x14, 0x2102); + mdio_write(tp, 0x14, 0xae22); + mdio_write(tp, 0x14, 0x0210); + mdio_write(tp, 0x14, 0x57f6); + mdio_write(tp, 0x14, 0x21e4); + mdio_write(tp, 0x14, 0x8224); + mdio_write(tp, 0x14, 0xd101); + mdio_write(tp, 0x14, 0xbf44); + mdio_write(tp, 0x14, 0xd202); + mdio_write(tp, 0x14, 0x4259); + mdio_write(tp, 0x14, 0xae10); + mdio_write(tp, 0x14, 0x0212); + mdio_write(tp, 0x14, 0x4cf6); + mdio_write(tp, 0x14, 0x29e5); + mdio_write(tp, 0x14, 0x822f); + mdio_write(tp, 0x14, 0xe082); + mdio_write(tp, 0x14, 0x24f6); + mdio_write(tp, 0x14, 0x21e4); + mdio_write(tp, 0x14, 0x8224); + mdio_write(tp, 0x14, 0xef96); + mdio_write(tp, 0x14, 0xfefc); + mdio_write(tp, 0x14, 0x04f8); + mdio_write(tp, 0x14, 0xe182); + mdio_write(tp, 0x14, 0x2fac); + mdio_write(tp, 0x14, 0x2a18); + mdio_write(tp, 0x14, 0xe082); + mdio_write(tp, 0x14, 0x24ac); + mdio_write(tp, 0x14, 0x2202); + mdio_write(tp, 0x14, 0xae26); + mdio_write(tp, 0x14, 0x0284); + mdio_write(tp, 0x14, 0xf802); + mdio_write(tp, 0x14, 0x8565); + mdio_write(tp, 0x14, 0xd101); + mdio_write(tp, 0x14, 0xbf44); + mdio_write(tp, 0x14, 0xd502); + mdio_write(tp, 0x14, 0x4259); + mdio_write(tp, 0x14, 0xae0e); + mdio_write(tp, 0x14, 0x0284); + mdio_write(tp, 0x14, 0xea02); + mdio_write(tp, 0x14, 0x85a9); + mdio_write(tp, 0x14, 0xe182); + mdio_write(tp, 0x14, 0x2ff6); + mdio_write(tp, 0x14, 0x2ae5); + mdio_write(tp, 0x14, 0x822f); + mdio_write(tp, 0x14, 0xe082); + mdio_write(tp, 0x14, 0x24f6); + mdio_write(tp, 0x14, 0x22e4); + mdio_write(tp, 0x14, 0x8224); + mdio_write(tp, 0x14, 0xfc04); + mdio_write(tp, 0x14, 0xf9e2); + mdio_write(tp, 0x14, 0x8011); + mdio_write(tp, 0x14, 0xad31); + mdio_write(tp, 0x14, 0x05d2); + mdio_write(tp, 0x14, 0x0002); + mdio_write(tp, 0x14, 0x0e66); + mdio_write(tp, 0x14, 0xfd04); + mdio_write(tp, 0x14, 0xf8f9); + mdio_write(tp, 0x14, 0xfaef); + mdio_write(tp, 0x14, 0x69e0); + mdio_write(tp, 0x14, 0x8011); + mdio_write(tp, 0x14, 0xad21); + mdio_write(tp, 0x14, 0x5cbf); + mdio_write(tp, 0x14, 0x43be); + mdio_write(tp, 0x14, 0x0242); + mdio_write(tp, 0x14, 0x97ac); + mdio_write(tp, 0x14, 0x281b); + mdio_write(tp, 0x14, 0xbf43); + mdio_write(tp, 0x14, 0xc102); + mdio_write(tp, 0x14, 0x4297); + mdio_write(tp, 0x14, 0xac28); + mdio_write(tp, 0x14, 0x12bf); + mdio_write(tp, 0x14, 0x43c7); + mdio_write(tp, 0x14, 0x0242); + mdio_write(tp, 0x14, 0x97ac); + mdio_write(tp, 0x14, 0x2804); + mdio_write(tp, 0x14, 0xd300); + mdio_write(tp, 0x14, 0xae07); + mdio_write(tp, 0x14, 0xd306); + mdio_write(tp, 0x14, 0xaf85); + mdio_write(tp, 0x14, 0x56d3); + mdio_write(tp, 0x14, 0x03e0); + mdio_write(tp, 0x14, 0x8011); + mdio_write(tp, 0x14, 0xad26); + mdio_write(tp, 0x14, 0x25bf); + mdio_write(tp, 0x14, 0x4559); + mdio_write(tp, 0x14, 0x0242); + mdio_write(tp, 0x14, 0x97e2); + mdio_write(tp, 0x14, 0x8073); + mdio_write(tp, 0x14, 0x0d21); + mdio_write(tp, 0x14, 0xf637); + mdio_write(tp, 0x14, 0x0d11); + mdio_write(tp, 0x14, 0xf62f); + mdio_write(tp, 0x14, 0x1b21); + mdio_write(tp, 0x14, 0xaa02); + mdio_write(tp, 0x14, 0xae10); + mdio_write(tp, 0x14, 0xe280); + mdio_write(tp, 0x14, 0x740d); + mdio_write(tp, 0x14, 0x21f6); + mdio_write(tp, 0x14, 0x371b); + mdio_write(tp, 0x14, 0x21aa); + mdio_write(tp, 0x14, 0x0313); + mdio_write(tp, 0x14, 0xae02); + mdio_write(tp, 0x14, 0x2b02); + mdio_write(tp, 0x14, 0x020e); + mdio_write(tp, 0x14, 0x5102); + mdio_write(tp, 0x14, 0x0e66); + mdio_write(tp, 0x14, 0x020f); + mdio_write(tp, 0x14, 0xa3ef); + mdio_write(tp, 0x14, 0x96fe); + mdio_write(tp, 0x14, 0xfdfc); + mdio_write(tp, 0x14, 0x04f8); + mdio_write(tp, 0x14, 0xf9fa); + mdio_write(tp, 0x14, 0xef69); + mdio_write(tp, 0x14, 0xe080); + mdio_write(tp, 0x14, 0x12ad); + mdio_write(tp, 0x14, 0x2733); + mdio_write(tp, 0x14, 0xbf43); + mdio_write(tp, 0x14, 0xbe02); + mdio_write(tp, 0x14, 0x4297); + mdio_write(tp, 0x14, 0xac28); + mdio_write(tp, 0x14, 0x09bf); + mdio_write(tp, 0x14, 0x43c1); + mdio_write(tp, 0x14, 0x0242); + mdio_write(tp, 0x14, 0x97ad); + mdio_write(tp, 0x14, 0x2821); + mdio_write(tp, 0x14, 0xbf45); + mdio_write(tp, 0x14, 0x5902); + mdio_write(tp, 0x14, 0x4297); + mdio_write(tp, 0x14, 0xe387); + mdio_write(tp, 0x14, 0xffd2); + mdio_write(tp, 0x14, 0x001b); + mdio_write(tp, 0x14, 0x45ac); + mdio_write(tp, 0x14, 0x2711); + mdio_write(tp, 0x14, 0xe187); + mdio_write(tp, 0x14, 0xfebf); + mdio_write(tp, 0x14, 0x87e4); + mdio_write(tp, 0x14, 0x0242); + mdio_write(tp, 0x14, 0x590d); + mdio_write(tp, 0x14, 0x11bf); + mdio_write(tp, 0x14, 0x87e7); + mdio_write(tp, 0x14, 0x0242); + mdio_write(tp, 0x14, 0x59ef); + mdio_write(tp, 0x14, 0x96fe); + mdio_write(tp, 0x14, 0xfdfc); + mdio_write(tp, 0x14, 0x04f8); + mdio_write(tp, 0x14, 0xfaef); + mdio_write(tp, 0x14, 0x69d1); + mdio_write(tp, 0x14, 0x00bf); + mdio_write(tp, 0x14, 0x87e4); + mdio_write(tp, 0x14, 0x0242); + mdio_write(tp, 0x14, 0x59bf); + mdio_write(tp, 0x14, 0x87e7); + mdio_write(tp, 0x14, 0x0242); + mdio_write(tp, 0x14, 0x59ef); + mdio_write(tp, 0x14, 0x96fe); + mdio_write(tp, 0x14, 0xfc04); + mdio_write(tp, 0x14, 0xee87); + mdio_write(tp, 0x14, 0xff46); + mdio_write(tp, 0x14, 0xee87); + mdio_write(tp, 0x14, 0xfe01); + mdio_write(tp, 0x14, 0x04f8); + mdio_write(tp, 0x14, 0xfaef); + mdio_write(tp, 0x14, 0x69e0); + mdio_write(tp, 0x14, 0x8241); + mdio_write(tp, 0x14, 0xa000); + mdio_write(tp, 0x14, 0x0502); + mdio_write(tp, 0x14, 0x85eb); + mdio_write(tp, 0x14, 0xae0e); + mdio_write(tp, 0x14, 0xa001); + mdio_write(tp, 0x14, 0x0502); + mdio_write(tp, 0x14, 0x1a5a); + mdio_write(tp, 0x14, 0xae06); + mdio_write(tp, 0x14, 0xa002); + mdio_write(tp, 0x14, 0x0302); + mdio_write(tp, 0x14, 0x1ae6); + mdio_write(tp, 0x14, 0xef96); + mdio_write(tp, 0x14, 0xfefc); + mdio_write(tp, 0x14, 0x04f8); + mdio_write(tp, 0x14, 0xf9fa); + mdio_write(tp, 0x14, 0xef69); + mdio_write(tp, 0x14, 0xe082); + mdio_write(tp, 0x14, 0x29f6); + mdio_write(tp, 0x14, 0x21e4); + mdio_write(tp, 0x14, 0x8229); + mdio_write(tp, 0x14, 0xe080); + mdio_write(tp, 0x14, 0x10ac); + mdio_write(tp, 0x14, 0x2202); + mdio_write(tp, 0x14, 0xae76); + mdio_write(tp, 0x14, 0xe082); + mdio_write(tp, 0x14, 0x27f7); + mdio_write(tp, 0x14, 0x21e4); + mdio_write(tp, 0x14, 0x8227); + mdio_write(tp, 0x14, 0xbf43); + mdio_write(tp, 0x14, 0x1302); + mdio_write(tp, 0x14, 0x4297); + mdio_write(tp, 0x14, 0xef21); + mdio_write(tp, 0x14, 0xbf43); + mdio_write(tp, 0x14, 0x1602); + mdio_write(tp, 0x14, 0x4297); + mdio_write(tp, 0x14, 0x0c11); + mdio_write(tp, 0x14, 0x1e21); + mdio_write(tp, 0x14, 0xbf43); + mdio_write(tp, 0x14, 0x1902); + mdio_write(tp, 0x14, 0x4297); + mdio_write(tp, 0x14, 0x0c12); + mdio_write(tp, 0x14, 0x1e21); + mdio_write(tp, 0x14, 0xe682); + mdio_write(tp, 0x14, 0x43a2); + mdio_write(tp, 0x14, 0x000a); + mdio_write(tp, 0x14, 0xe182); + mdio_write(tp, 0x14, 0x27f6); + mdio_write(tp, 0x14, 0x29e5); + mdio_write(tp, 0x14, 0x8227); + mdio_write(tp, 0x14, 0xae42); + mdio_write(tp, 0x14, 0xe082); + mdio_write(tp, 0x14, 0x44f7); + mdio_write(tp, 0x14, 0x21e4); + mdio_write(tp, 0x14, 0x8244); + mdio_write(tp, 0x14, 0x0246); + mdio_write(tp, 0x14, 0xaebf); + mdio_write(tp, 0x14, 0x4325); + mdio_write(tp, 0x14, 0x0242); + mdio_write(tp, 0x14, 0x97ef); + mdio_write(tp, 0x14, 0x21bf); + mdio_write(tp, 0x14, 0x431c); + mdio_write(tp, 0x14, 0x0242); + mdio_write(tp, 0x14, 0x970c); + mdio_write(tp, 0x14, 0x121e); + mdio_write(tp, 0x14, 0x21bf); + mdio_write(tp, 0x14, 0x431f); + mdio_write(tp, 0x14, 0x0242); + mdio_write(tp, 0x14, 0x970c); + mdio_write(tp, 0x14, 0x131e); + mdio_write(tp, 0x14, 0x21bf); + mdio_write(tp, 0x14, 0x4328); + mdio_write(tp, 0x14, 0x0242); + mdio_write(tp, 0x14, 0x970c); + mdio_write(tp, 0x14, 0x141e); + mdio_write(tp, 0x14, 0x21bf); + mdio_write(tp, 0x14, 0x44b1); + mdio_write(tp, 0x14, 0x0242); + mdio_write(tp, 0x14, 0x970c); + mdio_write(tp, 0x14, 0x161e); + mdio_write(tp, 0x14, 0x21e6); + mdio_write(tp, 0x14, 0x8242); + mdio_write(tp, 0x14, 0xee82); + mdio_write(tp, 0x14, 0x4101); + mdio_write(tp, 0x14, 0xef96); + mdio_write(tp, 0x14, 0xfefd); + mdio_write(tp, 0x14, 0xfc04); + mdio_write(tp, 0x14, 0xf8fa); + mdio_write(tp, 0x14, 0xef69); + mdio_write(tp, 0x14, 0xe082); + mdio_write(tp, 0x14, 0x46a0); + mdio_write(tp, 0x14, 0x0005); + mdio_write(tp, 0x14, 0x0286); + mdio_write(tp, 0x14, 0x96ae); + mdio_write(tp, 0x14, 0x06a0); + mdio_write(tp, 0x14, 0x0103); + mdio_write(tp, 0x14, 0x0219); + mdio_write(tp, 0x14, 0x19ef); + mdio_write(tp, 0x14, 0x96fe); + mdio_write(tp, 0x14, 0xfc04); + mdio_write(tp, 0x14, 0xf8fa); + mdio_write(tp, 0x14, 0xef69); + mdio_write(tp, 0x14, 0xe082); + mdio_write(tp, 0x14, 0x29f6); + mdio_write(tp, 0x14, 0x20e4); + mdio_write(tp, 0x14, 0x8229); + mdio_write(tp, 0x14, 0xe080); + mdio_write(tp, 0x14, 0x10ac); + mdio_write(tp, 0x14, 0x2102); + mdio_write(tp, 0x14, 0xae54); + mdio_write(tp, 0x14, 0xe082); + mdio_write(tp, 0x14, 0x27f7); + mdio_write(tp, 0x14, 0x20e4); + mdio_write(tp, 0x14, 0x8227); + mdio_write(tp, 0x14, 0xbf42); + mdio_write(tp, 0x14, 0xe602); + mdio_write(tp, 0x14, 0x4297); + mdio_write(tp, 0x14, 0xac28); + mdio_write(tp, 0x14, 0x22bf); + mdio_write(tp, 0x14, 0x430d); + mdio_write(tp, 0x14, 0x0242); + mdio_write(tp, 0x14, 0x97e5); + mdio_write(tp, 0x14, 0x8247); + mdio_write(tp, 0x14, 0xac28); + mdio_write(tp, 0x14, 0x20d1); + mdio_write(tp, 0x14, 0x03bf); + mdio_write(tp, 0x14, 0x4307); + mdio_write(tp, 0x14, 0x0242); + mdio_write(tp, 0x14, 0x59ee); + mdio_write(tp, 0x14, 0x8246); + mdio_write(tp, 0x14, 0x00e1); + mdio_write(tp, 0x14, 0x8227); + mdio_write(tp, 0x14, 0xf628); + mdio_write(tp, 0x14, 0xe582); + mdio_write(tp, 0x14, 0x27ae); + mdio_write(tp, 0x14, 0x21d1); + mdio_write(tp, 0x14, 0x04bf); + mdio_write(tp, 0x14, 0x4307); + mdio_write(tp, 0x14, 0x0242); + mdio_write(tp, 0x14, 0x59ae); + mdio_write(tp, 0x14, 0x08d1); + mdio_write(tp, 0x14, 0x05bf); + mdio_write(tp, 0x14, 0x4307); + mdio_write(tp, 0x14, 0x0242); + mdio_write(tp, 0x14, 0x59e0); + mdio_write(tp, 0x14, 0x8244); + mdio_write(tp, 0x14, 0xf720); + mdio_write(tp, 0x14, 0xe482); + mdio_write(tp, 0x14, 0x4402); + mdio_write(tp, 0x14, 0x46ae); + mdio_write(tp, 0x14, 0xee82); + mdio_write(tp, 0x14, 0x4601); + mdio_write(tp, 0x14, 0xef96); + mdio_write(tp, 0x14, 0xfefc); + mdio_write(tp, 0x14, 0x04f8); + mdio_write(tp, 0x14, 0xfaef); + mdio_write(tp, 0x14, 0x69e0); + mdio_write(tp, 0x14, 0x8013); + mdio_write(tp, 0x14, 0xad24); + mdio_write(tp, 0x14, 0x1cbf); + mdio_write(tp, 0x14, 0x87f0); + mdio_write(tp, 0x14, 0x0242); + mdio_write(tp, 0x14, 0x97ad); + mdio_write(tp, 0x14, 0x2813); + mdio_write(tp, 0x14, 0xe087); + mdio_write(tp, 0x14, 0xfca0); + mdio_write(tp, 0x14, 0x0005); + mdio_write(tp, 0x14, 0x0287); + mdio_write(tp, 0x14, 0x36ae); + mdio_write(tp, 0x14, 0x10a0); + mdio_write(tp, 0x14, 0x0105); + mdio_write(tp, 0x14, 0x0287); + mdio_write(tp, 0x14, 0x48ae); + mdio_write(tp, 0x14, 0x08e0); + mdio_write(tp, 0x14, 0x8230); + mdio_write(tp, 0x14, 0xf626); + mdio_write(tp, 0x14, 0xe482); + mdio_write(tp, 0x14, 0x30ef); + mdio_write(tp, 0x14, 0x96fe); + mdio_write(tp, 0x14, 0xfc04); + mdio_write(tp, 0x14, 0xf8e0); + mdio_write(tp, 0x14, 0x8245); + mdio_write(tp, 0x14, 0xf722); + mdio_write(tp, 0x14, 0xe482); + mdio_write(tp, 0x14, 0x4502); + mdio_write(tp, 0x14, 0x46ae); + mdio_write(tp, 0x14, 0xee87); + mdio_write(tp, 0x14, 0xfc01); + mdio_write(tp, 0x14, 0xfc04); + mdio_write(tp, 0x14, 0xf8fa); + mdio_write(tp, 0x14, 0xef69); + mdio_write(tp, 0x14, 0xfb02); + mdio_write(tp, 0x14, 0x46d3); + mdio_write(tp, 0x14, 0xad50); + mdio_write(tp, 0x14, 0x2fbf); + mdio_write(tp, 0x14, 0x87ed); + mdio_write(tp, 0x14, 0xd101); + mdio_write(tp, 0x14, 0x0242); + mdio_write(tp, 0x14, 0x59bf); + mdio_write(tp, 0x14, 0x87ed); + mdio_write(tp, 0x14, 0xd100); + mdio_write(tp, 0x14, 0x0242); + mdio_write(tp, 0x14, 0x59e0); + mdio_write(tp, 0x14, 0x8245); + mdio_write(tp, 0x14, 0xf622); + mdio_write(tp, 0x14, 0xe482); + mdio_write(tp, 0x14, 0x4502); + mdio_write(tp, 0x14, 0x46ae); + mdio_write(tp, 0x14, 0xd100); + mdio_write(tp, 0x14, 0xbf87); + mdio_write(tp, 0x14, 0xf002); + mdio_write(tp, 0x14, 0x4259); + mdio_write(tp, 0x14, 0xee87); + mdio_write(tp, 0x14, 0xfc00); + mdio_write(tp, 0x14, 0xe082); + mdio_write(tp, 0x14, 0x30f6); + mdio_write(tp, 0x14, 0x26e4); + mdio_write(tp, 0x14, 0x8230); + mdio_write(tp, 0x14, 0xffef); + mdio_write(tp, 0x14, 0x96fe); + mdio_write(tp, 0x14, 0xfc04); + mdio_write(tp, 0x14, 0xf8f9); + mdio_write(tp, 0x14, 0xface); + mdio_write(tp, 0x14, 0xfaef); + mdio_write(tp, 0x14, 0x69fb); + mdio_write(tp, 0x14, 0xbf87); + mdio_write(tp, 0x14, 0xb3d7); + mdio_write(tp, 0x14, 0x001c); + mdio_write(tp, 0x14, 0xd819); + mdio_write(tp, 0x14, 0xd919); + mdio_write(tp, 0x14, 0xda19); + mdio_write(tp, 0x14, 0xdb19); + mdio_write(tp, 0x14, 0x07ef); + mdio_write(tp, 0x14, 0x9502); + mdio_write(tp, 0x14, 0x4259); + mdio_write(tp, 0x14, 0x073f); + mdio_write(tp, 0x14, 0x0004); + mdio_write(tp, 0x14, 0x9fec); + mdio_write(tp, 0x14, 0xffef); + mdio_write(tp, 0x14, 0x96fe); + mdio_write(tp, 0x14, 0xc6fe); + mdio_write(tp, 0x14, 0xfdfc); + mdio_write(tp, 0x14, 0x0400); + mdio_write(tp, 0x14, 0x0145); + mdio_write(tp, 0x14, 0x7d00); + mdio_write(tp, 0x14, 0x0345); + mdio_write(tp, 0x14, 0x5c00); + mdio_write(tp, 0x14, 0x0143); + mdio_write(tp, 0x14, 0x4f00); + mdio_write(tp, 0x14, 0x0387); + mdio_write(tp, 0x14, 0xdb00); + mdio_write(tp, 0x14, 0x0987); + mdio_write(tp, 0x14, 0xde00); + mdio_write(tp, 0x14, 0x0987); + mdio_write(tp, 0x14, 0xe100); + mdio_write(tp, 0x14, 0x0087); + mdio_write(tp, 0x14, 0xeaa4); + mdio_write(tp, 0x14, 0x00b8); + mdio_write(tp, 0x14, 0x20c4); + mdio_write(tp, 0x14, 0x1600); + mdio_write(tp, 0x14, 0x000f); + mdio_write(tp, 0x14, 0xf800); + mdio_write(tp, 0x14, 0x7098); + mdio_write(tp, 0x14, 0xa58a); + mdio_write(tp, 0x14, 0xb6a8); + mdio_write(tp, 0x14, 0x3e50); + mdio_write(tp, 0x14, 0xa83e); + mdio_write(tp, 0x14, 0x33bc); + mdio_write(tp, 0x14, 0xc622); + mdio_write(tp, 0x14, 0xbcc6); + mdio_write(tp, 0x14, 0xaaa4); + mdio_write(tp, 0x14, 0x42ff); + mdio_write(tp, 0x14, 0xc408); + mdio_write(tp, 0x14, 0x00c4); + mdio_write(tp, 0x14, 0x16a8); + mdio_write(tp, 0x14, 0xbcc0); + mdio_write(tp, 0x13, 0xb818); + mdio_write(tp, 0x14, 0x02f3); + mdio_write(tp, 0x13, 0xb81a); + mdio_write(tp, 0x14, 0x17d1); + mdio_write(tp, 0x13, 0xb81c); + mdio_write(tp, 0x14, 0x185a); + mdio_write(tp, 0x13, 0xb81e); + mdio_write(tp, 0x14, 0x3c66); + mdio_write(tp, 0x13, 0xb820); + mdio_write(tp, 0x14, 0x021f); + mdio_write(tp, 0x13, 0xc416); + mdio_write(tp, 0x14, 0x0500); + mdio_write(tp, 0x13, 0xb82e); + mdio_write(tp, 0x14, 0xfffc); + + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x0000); + mdio_write(tp, 0x14, 0x0000); + mdio_write(tp, 0x1f, 0x0B82); + gphy_val = mdio_read(tp, 0x10); + gphy_val &= ~(BIT_9); + mdio_write(tp, 0x10, gphy_val); + mdio_write(tp, 0x1f, 0x0A43); + mdio_write(tp, 0x13, 0x8146); + mdio_write(tp, 0x14, 0x0000); + + mdio_write(tp, 0x1f, 0x0B82); + gphy_val = mdio_read(tp, 0x10); + gphy_val &= ~(BIT_4); + mdio_write(tp, 0x10, gphy_val); +} + +static void +rtl8168_set_phy_mcu_8168gu_2(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + unsigned int gphy_val,i; + + mdio_write(tp, 0x1f, 0x0B82); + gphy_val = mdio_read(tp, 0x10); + gphy_val |= BIT_4; + mdio_write(tp, 0x10, gphy_val); + mdio_write(tp, 0x1f, 0x0B80); + i = 0; + do { + gphy_val = mdio_read(tp, 0x10); + gphy_val &= 0x0040; + udelay(50); + udelay(50); + i++; + } while(gphy_val != 0x0040 && i <1000); + mdio_write(tp, 0x1f, 0x0A43); + mdio_write(tp, 0x13, 0x8146); + mdio_write(tp, 0x14, 0x0300); + mdio_write(tp, 0x13, 0xB82E); + mdio_write(tp, 0x14, 0x0001); + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0xb820); + mdio_write(tp, 0x14, 0x0290); + mdio_write(tp, 0x13, 0xa012); + mdio_write(tp, 0x14, 0x0000); + mdio_write(tp, 0x13, 0xa014); + mdio_write(tp, 0x14, 0x2c04); + mdio_write(tp, 0x14, 0x2c07); + mdio_write(tp, 0x14, 0x2c07); + mdio_write(tp, 0x14, 0x2c07); + mdio_write(tp, 0x14, 0xa304); + mdio_write(tp, 0x14, 0xa301); + mdio_write(tp, 0x14, 0x207e); + mdio_write(tp, 0x13, 0xa01a); + mdio_write(tp, 0x14, 0x0000); + mdio_write(tp, 0x13, 0xa006); + mdio_write(tp, 0x14, 0x0fff); + mdio_write(tp, 0x13, 0xa004); + mdio_write(tp, 0x14, 0x0fff); + mdio_write(tp, 0x13, 0xa002); + mdio_write(tp, 0x14, 0x0fff); + mdio_write(tp, 0x13, 0xa000); + mdio_write(tp, 0x14, 0x107c); + mdio_write(tp, 0x13, 0xb820); + mdio_write(tp, 0x14, 0x0210); + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x0000); + mdio_write(tp, 0x14, 0x0000); + mdio_write(tp, 0x1f, 0x0B82); + gphy_val = mdio_read(tp, 0x17); + gphy_val &= ~(BIT_0); + mdio_write(tp, 0x17, gphy_val); + mdio_write(tp, 0x1f, 0x0A43); + mdio_write(tp, 0x13, 0x8146); + mdio_write(tp, 0x14, 0x0000); + mdio_write(tp, 0x1f, 0x0B82); + gphy_val = mdio_read(tp, 0x10); + gphy_val &= ~(BIT_4); + mdio_write(tp, 0x10, gphy_val); +} + +static void +rtl8168_set_phy_mcu_8411b_1(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + unsigned int gphy_val,i; + + mdio_write(tp,0x1f, 0x0B82); + gphy_val = mdio_read(tp, 0x10); + gphy_val |= BIT_4; + mdio_write(tp,0x10, gphy_val); + + mdio_write(tp,0x1f, 0x0B80); + i = 0; + do { + gphy_val = mdio_read(tp, 0x10); + gphy_val &= 0x0040; + udelay(50); + udelay(50); + i++; + } while(gphy_val != 0x0040 && i <1000); + + mdio_write(tp,0x1f, 0x0A43); + mdio_write(tp,0x13, 0x8146); + mdio_write(tp,0x14, 0x0100); + mdio_write(tp,0x13, 0xB82E); + mdio_write(tp,0x14, 0x0001); + + + mdio_write(tp,0x1F, 0x0A43); + mdio_write(tp, 0x13, 0xb820); + mdio_write(tp, 0x14, 0x0290); + mdio_write(tp, 0x13, 0xa012); + mdio_write(tp, 0x14, 0x0000); + mdio_write(tp, 0x13, 0xa014); + mdio_write(tp, 0x14, 0x2c04); + mdio_write(tp, 0x14, 0x2c07); + mdio_write(tp, 0x14, 0x2c07); + mdio_write(tp, 0x14, 0x2c07); + mdio_write(tp, 0x14, 0xa304); + mdio_write(tp, 0x14, 0xa301); + mdio_write(tp, 0x14, 0x207e); + mdio_write(tp, 0x13, 0xa01a); + mdio_write(tp, 0x14, 0x0000); + mdio_write(tp, 0x13, 0xa006); + mdio_write(tp, 0x14, 0x0fff); + mdio_write(tp, 0x13, 0xa004); + mdio_write(tp, 0x14, 0x0fff); + mdio_write(tp, 0x13, 0xa002); + mdio_write(tp, 0x14, 0x0fff); + mdio_write(tp, 0x13, 0xa000); + mdio_write(tp, 0x14, 0x107c); + mdio_write(tp, 0x13, 0xb820); + mdio_write(tp, 0x14, 0x0210); + + + mdio_write(tp,0x1F, 0x0A43); + mdio_write(tp,0x13, 0x0000); + mdio_write(tp,0x14, 0x0000); + mdio_write(tp,0x1f, 0x0B82); + gphy_val = mdio_read(tp, 0x17); + gphy_val &= ~(BIT_0); + mdio_write(tp,0x17, gphy_val); + mdio_write(tp,0x1f, 0x0A43); + mdio_write(tp,0x13, 0x8146); + mdio_write(tp,0x14, 0x0000); + + + mdio_write(tp,0x1f, 0x0B82); + gphy_val = mdio_read(tp, 0x10); + gphy_val &= ~(BIT_4); + mdio_write(tp,0x10, gphy_val); +} + +static void +rtl8168_set_phy_mcu_8168h_1(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + unsigned int gphy_val,i; + + mdio_write(tp, 0x1f, 0x0B82); + gphy_val = mdio_read(tp, 0x10); + gphy_val |= BIT_4; + mdio_write(tp, 0x10, gphy_val); + + mdio_write(tp, 0x1f, 0x0B80); + i = 0; + do { + gphy_val = mdio_read(tp, 0x10); + gphy_val &= 0x0040; + udelay(50); + udelay(50); + i++; + } while(gphy_val != 0x0040 && i <1000); + + mdio_write(tp, 0x1f, 0x0A43); + mdio_write(tp, 0x13, 0x8028); + mdio_write(tp, 0x14, 0x6200); + mdio_write(tp, 0x13, 0xB82E); + mdio_write(tp, 0x14, 0x0001); + + + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0xB820); + mdio_write(tp, 0x14, 0x0290); + mdio_write(tp, 0x13, 0xA012); + mdio_write(tp, 0x14, 0x0000); + mdio_write(tp, 0x13, 0xA014); + mdio_write(tp, 0x14, 0x2c04); + mdio_write(tp, 0x14, 0x2c10); + mdio_write(tp, 0x14, 0x2c10); + mdio_write(tp, 0x14, 0x2c10); + mdio_write(tp, 0x14, 0xa210); + mdio_write(tp, 0x14, 0xa101); + mdio_write(tp, 0x14, 0xce10); + mdio_write(tp, 0x14, 0xe070); + mdio_write(tp, 0x14, 0x0f40); + mdio_write(tp, 0x14, 0xaf01); + mdio_write(tp, 0x14, 0x8f01); + mdio_write(tp, 0x14, 0x183e); + mdio_write(tp, 0x14, 0x8e10); + mdio_write(tp, 0x14, 0x8101); + mdio_write(tp, 0x14, 0x8210); + mdio_write(tp, 0x14, 0x28da); + mdio_write(tp, 0x13, 0xA01A); + mdio_write(tp, 0x14, 0x0000); + mdio_write(tp, 0x13, 0xA006); + mdio_write(tp, 0x14, 0x0017); + mdio_write(tp, 0x13, 0xA004); + mdio_write(tp, 0x14, 0x0015); + mdio_write(tp, 0x13, 0xA002); + mdio_write(tp, 0x14, 0x0013); + mdio_write(tp, 0x13, 0xA000); + mdio_write(tp, 0x14, 0x18d1); + mdio_write(tp, 0x13, 0xB820); + mdio_write(tp, 0x14, 0x0210); + + + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x0000); + mdio_write(tp, 0x14, 0x0000); + mdio_write(tp, 0x1f, 0x0B82); + gphy_val = mdio_read(tp, 0x17); + gphy_val &= ~(BIT_0); + mdio_write(tp, 0x17, gphy_val); + mdio_write(tp, 0x1f, 0x0A43); + mdio_write(tp, 0x13, 0x8028); + mdio_write(tp, 0x14, 0x0000); + + + mdio_write(tp, 0x1f, 0x0B82); + gphy_val = mdio_read(tp, 0x10); + gphy_val &= ~(BIT_4); + mdio_write(tp, 0x10, gphy_val); +} + +static void +rtl8168_set_phy_mcu_8168h_2(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + unsigned int gphy_val,i; + + mdio_write(tp, 0x1f, 0x0B82); + gphy_val = mdio_read(tp, 0x10); + gphy_val |= BIT_4; + mdio_write(tp, 0x10, gphy_val); + + mdio_write(tp, 0x1f, 0x0B80); + i = 0; + do { + gphy_val = mdio_read(tp, 0x10); + gphy_val &= 0x0040; + udelay(50); + udelay(50); + i++; + } while(gphy_val != 0x0040 && i <1000); + + mdio_write(tp, 0x1f, 0x0A43); + mdio_write(tp, 0x13, 0x8028); + mdio_write(tp, 0x14, 0x6201); + mdio_write(tp, 0x13, 0xB82E); + mdio_write(tp, 0x14, 0x0001); + + + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0xB820); + mdio_write(tp, 0x14, 0x0290); + mdio_write(tp, 0x13, 0xA012); + mdio_write(tp, 0x14, 0x0000); + mdio_write(tp, 0x13, 0xA014); + mdio_write(tp, 0x14, 0x2c04); + mdio_write(tp, 0x14, 0x2c09); + mdio_write(tp, 0x14, 0x2c09); + mdio_write(tp, 0x14, 0x2c09); + mdio_write(tp, 0x14, 0xad01); + mdio_write(tp, 0x14, 0xad01); + mdio_write(tp, 0x14, 0xad01); + mdio_write(tp, 0x14, 0xad01); + mdio_write(tp, 0x14, 0x236c); + mdio_write(tp, 0x13, 0xA01A); + mdio_write(tp, 0x14, 0x0000); + mdio_write(tp, 0x13, 0xA006); + mdio_write(tp, 0x14, 0x0fff); + mdio_write(tp, 0x13, 0xA004); + mdio_write(tp, 0x14, 0x0fff); + mdio_write(tp, 0x13, 0xA002); + mdio_write(tp, 0x14, 0x0fff); + mdio_write(tp, 0x13, 0xA000); + mdio_write(tp, 0x14, 0x136b); + mdio_write(tp, 0x13, 0xB820); + mdio_write(tp, 0x14, 0x0210); + + + mdio_write(tp,0x1F, 0x0A43); + mdio_write(tp,0x13, 0x0000); + mdio_write(tp,0x14, 0x0000); + mdio_write(tp,0x1f, 0x0B82); + gphy_val = mdio_read(tp, 0x17); + gphy_val &= ~(BIT_0); + mdio_write(tp,0x17, gphy_val); + mdio_write(tp,0x1f, 0x0A43); + mdio_write(tp,0x13, 0x8028); + mdio_write(tp,0x14, 0x0000); + + + mdio_write(tp, 0x1f, 0x0B82); + gphy_val = mdio_read(tp, 0x10); + gphy_val &= ~(BIT_4); + mdio_write(tp, 0x10, gphy_val); + + if (tp->RequiredSecLanDonglePatch) { + mdio_write(tp, 0x1F, 0x0A43); + gphy_val = mdio_read(tp, 0x11); + gphy_val &= ~BIT_6; + mdio_write(tp, 0x11, gphy_val); + } +} + +static void +rtl8168_init_hw_phy_mcu(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + + if (tp->NotWrRamCodeToMicroP == TRUE) return; + if (rtl8168_check_hw_phy_mcu_code_ver(dev)) return; + + if (FALSE == rtl8168_phy_ram_code_check(dev)) { + rtl8168_set_phy_ram_code_check_fail_flag(dev); + return; + } + + switch (tp->mcfg) { + case CFG_METHOD_14: + rtl8168_set_phy_mcu_8168e_1(dev); + break; + case CFG_METHOD_15: + rtl8168_set_phy_mcu_8168e_2(dev); + break; + case CFG_METHOD_16: + rtl8168_set_phy_mcu_8168evl_1(dev); + break; + case CFG_METHOD_17: + rtl8168_set_phy_mcu_8168evl_2(dev); + break; + case CFG_METHOD_18: + rtl8168_set_phy_mcu_8168f_1(dev); + break; + case CFG_METHOD_19: + rtl8168_set_phy_mcu_8168f_2(dev); + break; + case CFG_METHOD_20: + rtl8168_set_phy_mcu_8411_1(dev); + break; + case CFG_METHOD_21: + rtl8168_set_phy_mcu_8168g_1(dev); + break; + case CFG_METHOD_25: + rtl8168_set_phy_mcu_8168gu_2(dev); + break; + case CFG_METHOD_26: + rtl8168_set_phy_mcu_8411b_1(dev); + break; + case CFG_METHOD_29: + rtl8168_set_phy_mcu_8168h_1(dev); + break; + case CFG_METHOD_30: + rtl8168_set_phy_mcu_8168h_2(dev); + break; + } + + rtl8168_write_hw_phy_mcu_code_ver(dev); + + mdio_write(tp,0x1F, 0x0000); + + tp->HwHasWrRamCodeToMicroP = TRUE; +} + +static void +rtl8168_hw_phy_config(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + struct pci_dev *pdev = tp->pci_dev; + u16 gphy_val; + unsigned int i; + unsigned long flags; + + tp->phy_reset_enable(dev); + + spin_lock_irqsave(&tp->phy_lock, flags); + + rtl8168_init_hw_phy_mcu(dev); + + if (tp->mcfg == CFG_METHOD_1) { + mdio_write(tp, 0x1F, 0x0001); + mdio_write(tp, 0x0B, 0x94B0); + + mdio_write(tp, 0x1F, 0x0003); + mdio_write(tp, 0x12, 0x6096); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x0D, 0xF8A0); + } else if (tp->mcfg == CFG_METHOD_2) { + mdio_write(tp, 0x1F, 0x0001); + mdio_write(tp, 0x0B, 0x94B0); + + mdio_write(tp, 0x1F, 0x0003); + mdio_write(tp, 0x12, 0x6096); + + mdio_write(tp, 0x1F, 0x0000); + } else if (tp->mcfg == CFG_METHOD_3) { + mdio_write(tp, 0x1F, 0x0001); + mdio_write(tp, 0x0B, 0x94B0); + + mdio_write(tp, 0x1F, 0x0003); + mdio_write(tp, 0x12, 0x6096); + + mdio_write(tp, 0x1F, 0x0000); + } else if (tp->mcfg == CFG_METHOD_4) { + mdio_write(tp, 0x1F, 0x0001); + mdio_write(tp, 0x12, 0x2300); + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, 0x1F, 0x0003); + mdio_write(tp, 0x16, 0x000A); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0003); + mdio_write(tp, 0x12, 0xC096); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x00, 0x88DE); + mdio_write(tp, 0x01, 0x82B1); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x08, 0x9E30); + mdio_write(tp, 0x09, 0x01F0); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x0A, 0x5500); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x03, 0x7002); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x0C, 0x00C8); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, 0x14, mdio_read(tp, 0x14) | (1 << 5)); + mdio_write(tp, 0x0D, mdio_read(tp, 0x0D) & ~(1 << 5)); + } else if (tp->mcfg == CFG_METHOD_5) { + mdio_write(tp, 0x1F, 0x0001); + mdio_write(tp, 0x12, 0x2300); + mdio_write(tp, 0x1F, 0x0003); + mdio_write(tp, 0x16, 0x0F0A); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x00, 0x88DE); + mdio_write(tp, 0x01, 0x82B1); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x0C, 0x7EB8); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x06, 0x0761); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0001); + mdio_write(tp, 0x03, 0x802F); + mdio_write(tp, 0x02, 0x4F02); + mdio_write(tp, 0x01, 0x0409); + mdio_write(tp, 0x00, 0xF099); + mdio_write(tp, 0x04, 0x9800); + mdio_write(tp, 0x04, 0x9000); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, 0x16, mdio_read(tp, 0x16) | (1 << 0)); + + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, 0x14, mdio_read(tp, 0x14) | (1 << 5)); + mdio_write(tp, 0x0D, mdio_read(tp, 0x0D) & ~(1 << 5)); + + mdio_write(tp, 0x1F, 0x0001); + mdio_write(tp, 0x1D, 0x3D98); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0001); + mdio_write(tp, 0x17, 0x0CC0); + mdio_write(tp, 0x1F, 0x0000); + } else if (tp->mcfg == CFG_METHOD_6) { + mdio_write(tp, 0x1F, 0x0001); + mdio_write(tp, 0x12, 0x2300); + mdio_write(tp, 0x1F, 0x0003); + mdio_write(tp, 0x16, 0x0F0A); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x00, 0x88DE); + mdio_write(tp, 0x01, 0x82B1); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x0C, 0x7EB8); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x06, 0x5461); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x06, 0x5461); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, 0x16, mdio_read(tp, 0x16) | (1 << 0)); + + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, 0x14, mdio_read(tp, 0x14) | (1 << 5)); + mdio_write(tp, 0x0D, mdio_read(tp, 0x0D) & ~(1 << 5)); + + mdio_write(tp, 0x1F, 0x0001); + mdio_write(tp, 0x1D, 0x3D98); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1f, 0x0001); + mdio_write(tp, 0x17, 0x0CC0); + mdio_write(tp, 0x1F, 0x0000); + } else if (tp->mcfg == CFG_METHOD_7) { + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, 0x14, mdio_read(tp, 0x14) | (1 << 5)); + mdio_write(tp, 0x0D, mdio_read(tp, 0x0D) & ~(1 << 5)); + + mdio_write(tp, 0x1F, 0x0001); + mdio_write(tp, 0x1D, 0x3D98); + + mdio_write(tp, 0x1F, 0x0001); + mdio_write(tp, 0x14, 0xCAA3); + mdio_write(tp, 0x1C, 0x000A); + mdio_write(tp, 0x18, 0x65D0); + + mdio_write(tp, 0x1F, 0x0003); + mdio_write(tp, 0x17, 0xB580); + mdio_write(tp, 0x18, 0xFF54); + mdio_write(tp, 0x19, 0x3954); + + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x0D, 0x310C); + mdio_write(tp, 0x0E, 0x310C); + mdio_write(tp, 0x0F, 0x311C); + mdio_write(tp, 0x06, 0x0761); + + mdio_write(tp, 0x1F, 0x0003); + mdio_write(tp, 0x18, 0xFF55); + mdio_write(tp, 0x19, 0x3955); + mdio_write(tp, 0x18, 0xFF54); + mdio_write(tp, 0x19, 0x3954); + + mdio_write(tp, 0x1F, 0x0001); + mdio_write(tp, 0x17, 0x0CC0); + + mdio_write(tp, 0x1F, 0x0000); + } else if (tp->mcfg == CFG_METHOD_8) { + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, 0x14, mdio_read(tp, 0x14) | (1 << 5)); + mdio_write(tp, 0x0D, mdio_read(tp, 0x0D) & ~(1 << 5)); + + mdio_write(tp, 0x1F, 0x0001); + mdio_write(tp, 0x14, 0xCAA3); + mdio_write(tp, 0x1C, 0x000A); + mdio_write(tp, 0x18, 0x65D0); + + mdio_write(tp, 0x1F, 0x0003); + mdio_write(tp, 0x17, 0xB580); + mdio_write(tp, 0x18, 0xFF54); + mdio_write(tp, 0x19, 0x3954); + + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x0D, 0x310C); + mdio_write(tp, 0x0E, 0x310C); + mdio_write(tp, 0x0F, 0x311C); + mdio_write(tp, 0x06, 0x0761); + + mdio_write(tp, 0x1F, 0x0003); + mdio_write(tp, 0x18, 0xFF55); + mdio_write(tp, 0x19, 0x3955); + mdio_write(tp, 0x18, 0xFF54); + mdio_write(tp, 0x19, 0x3954); + + mdio_write(tp, 0x1F, 0x0001); + mdio_write(tp, 0x17, 0x0CC0); + + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, 0x16, mdio_read(tp, 0x16) | (1 << 0)); + + mdio_write(tp, 0x1F, 0x0000); + } else if (tp->mcfg == CFG_METHOD_9) { + mdio_write(tp, 0x1F, 0x0001); + mdio_write(tp, 0x06, 0x4064); + mdio_write(tp, 0x07, 0x2863); + mdio_write(tp, 0x08, 0x059C); + mdio_write(tp, 0x09, 0x26B4); + mdio_write(tp, 0x0A, 0x6A19); + mdio_write(tp, 0x0B, 0xDCC8); + mdio_write(tp, 0x10, 0xF06D); + mdio_write(tp, 0x14, 0x7F68); + mdio_write(tp, 0x18, 0x7FD9); + mdio_write(tp, 0x1C, 0xF0FF); + mdio_write(tp, 0x1D, 0x3D9C); + mdio_write(tp, 0x1F, 0x0003); + mdio_write(tp, 0x12, 0xF49F); + mdio_write(tp, 0x13, 0x070B); + mdio_write(tp, 0x1A, 0x05AD); + mdio_write(tp, 0x14, 0x94C0); + + mdio_write(tp, 0x1F, 0x0002); + gphy_val = mdio_read(tp, 0x0B) & 0xFF00; + gphy_val |= 0x10; + mdio_write(tp, 0x0B, gphy_val); + gphy_val = mdio_read(tp, 0x0C) & 0x00FF; + gphy_val |= 0xA200; + mdio_write(tp, 0x0C, gphy_val); + + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x06, 0x5561); + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8332); + mdio_write(tp, 0x06, 0x5561); + + if (rtl8168_efuse_read(tp, 0x01) == 0xb1) { + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x05, 0x669A); + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8330); + mdio_write(tp, 0x06, 0x669A); + + mdio_write(tp, 0x1F, 0x0002); + gphy_val = mdio_read(tp, 0x0D); + if ((gphy_val & 0x00FF) != 0x006C) { + gphy_val &= 0xFF00; + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x0D, gphy_val | 0x0065); + mdio_write(tp, 0x0D, gphy_val | 0x0066); + mdio_write(tp, 0x0D, gphy_val | 0x0067); + mdio_write(tp, 0x0D, gphy_val | 0x0068); + mdio_write(tp, 0x0D, gphy_val | 0x0069); + mdio_write(tp, 0x0D, gphy_val | 0x006A); + mdio_write(tp, 0x0D, gphy_val | 0x006B); + mdio_write(tp, 0x0D, gphy_val | 0x006C); + } + } else { + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x05, 0x6662); + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8330); + mdio_write(tp, 0x06, 0x6662); + } + + mdio_write(tp, 0x1F, 0x0002); + gphy_val = mdio_read(tp, 0x0D); + gphy_val |= BIT_9; + gphy_val |= BIT_8; + mdio_write(tp, 0x0D, gphy_val); + gphy_val = mdio_read(tp, 0x0F); + gphy_val |= BIT_4; + mdio_write(tp, 0x0F, gphy_val); + + mdio_write(tp, 0x1F, 0x0002); + gphy_val = mdio_read(tp, 0x02); + gphy_val &= ~BIT_10; + gphy_val &= ~BIT_9; + gphy_val |= BIT_8; + mdio_write(tp, 0x02, gphy_val); + gphy_val = mdio_read(tp, 0x03); + gphy_val &= ~BIT_15; + gphy_val &= ~BIT_14; + gphy_val &= ~BIT_13; + mdio_write(tp, 0x03, gphy_val); + + mdio_write(tp, 0x1F, 0x0001); + mdio_write(tp, 0x17, 0x0CC0); + + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x001B); + if (mdio_read(tp, 0x06) == 0xBF00) { + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x05, 0xfff6); + mdio_write(tp, 0x06, 0x0080); + mdio_write(tp, 0x05, 0x8000); + mdio_write(tp, 0x06, 0xf8f9); + mdio_write(tp, 0x06, 0xfaef); + mdio_write(tp, 0x06, 0x59ee); + mdio_write(tp, 0x06, 0xf8ea); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0xf8eb); + mdio_write(tp, 0x06, 0x00e0); + mdio_write(tp, 0x06, 0xf87c); + mdio_write(tp, 0x06, 0xe1f8); + mdio_write(tp, 0x06, 0x7d59); + mdio_write(tp, 0x06, 0x0fef); + mdio_write(tp, 0x06, 0x0139); + mdio_write(tp, 0x06, 0x029e); + mdio_write(tp, 0x06, 0x06ef); + mdio_write(tp, 0x06, 0x1039); + mdio_write(tp, 0x06, 0x089f); + mdio_write(tp, 0x06, 0x2aee); + mdio_write(tp, 0x06, 0xf8ea); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0xf8eb); + mdio_write(tp, 0x06, 0x01e0); + mdio_write(tp, 0x06, 0xf87c); + mdio_write(tp, 0x06, 0xe1f8); + mdio_write(tp, 0x06, 0x7d58); + mdio_write(tp, 0x06, 0x409e); + mdio_write(tp, 0x06, 0x0f39); + mdio_write(tp, 0x06, 0x46aa); + mdio_write(tp, 0x06, 0x0bbf); + mdio_write(tp, 0x06, 0x8290); + mdio_write(tp, 0x06, 0xd682); + mdio_write(tp, 0x06, 0x9802); + mdio_write(tp, 0x06, 0x014f); + mdio_write(tp, 0x06, 0xae09); + mdio_write(tp, 0x06, 0xbf82); + mdio_write(tp, 0x06, 0x98d6); + mdio_write(tp, 0x06, 0x82a0); + mdio_write(tp, 0x06, 0x0201); + mdio_write(tp, 0x06, 0x4fef); + mdio_write(tp, 0x06, 0x95fe); + mdio_write(tp, 0x06, 0xfdfc); + mdio_write(tp, 0x06, 0x05f8); + mdio_write(tp, 0x06, 0xf9fa); + mdio_write(tp, 0x06, 0xeef8); + mdio_write(tp, 0x06, 0xea00); + mdio_write(tp, 0x06, 0xeef8); + mdio_write(tp, 0x06, 0xeb00); + mdio_write(tp, 0x06, 0xe2f8); + mdio_write(tp, 0x06, 0x7ce3); + mdio_write(tp, 0x06, 0xf87d); + mdio_write(tp, 0x06, 0xa511); + mdio_write(tp, 0x06, 0x1112); + mdio_write(tp, 0x06, 0xd240); + mdio_write(tp, 0x06, 0xd644); + mdio_write(tp, 0x06, 0x4402); + mdio_write(tp, 0x06, 0x8217); + mdio_write(tp, 0x06, 0xd2a0); + mdio_write(tp, 0x06, 0xd6aa); + mdio_write(tp, 0x06, 0xaa02); + mdio_write(tp, 0x06, 0x8217); + mdio_write(tp, 0x06, 0xae0f); + mdio_write(tp, 0x06, 0xa544); + mdio_write(tp, 0x06, 0x4402); + mdio_write(tp, 0x06, 0xae4d); + mdio_write(tp, 0x06, 0xa5aa); + mdio_write(tp, 0x06, 0xaa02); + mdio_write(tp, 0x06, 0xae47); + mdio_write(tp, 0x06, 0xaf82); + mdio_write(tp, 0x06, 0x13ee); + mdio_write(tp, 0x06, 0x834e); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0x834d); + mdio_write(tp, 0x06, 0x0fee); + mdio_write(tp, 0x06, 0x834c); + mdio_write(tp, 0x06, 0x0fee); + mdio_write(tp, 0x06, 0x834f); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0x8351); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0x834a); + mdio_write(tp, 0x06, 0xffee); + mdio_write(tp, 0x06, 0x834b); + mdio_write(tp, 0x06, 0xffe0); + mdio_write(tp, 0x06, 0x8330); + mdio_write(tp, 0x06, 0xe183); + mdio_write(tp, 0x06, 0x3158); + mdio_write(tp, 0x06, 0xfee4); + mdio_write(tp, 0x06, 0xf88a); + mdio_write(tp, 0x06, 0xe5f8); + mdio_write(tp, 0x06, 0x8be0); + mdio_write(tp, 0x06, 0x8332); + mdio_write(tp, 0x06, 0xe183); + mdio_write(tp, 0x06, 0x3359); + mdio_write(tp, 0x06, 0x0fe2); + mdio_write(tp, 0x06, 0x834d); + mdio_write(tp, 0x06, 0x0c24); + mdio_write(tp, 0x06, 0x5af0); + mdio_write(tp, 0x06, 0x1e12); + mdio_write(tp, 0x06, 0xe4f8); + mdio_write(tp, 0x06, 0x8ce5); + mdio_write(tp, 0x06, 0xf88d); + mdio_write(tp, 0x06, 0xaf82); + mdio_write(tp, 0x06, 0x13e0); + mdio_write(tp, 0x06, 0x834f); + mdio_write(tp, 0x06, 0x10e4); + mdio_write(tp, 0x06, 0x834f); + mdio_write(tp, 0x06, 0xe083); + mdio_write(tp, 0x06, 0x4e78); + mdio_write(tp, 0x06, 0x009f); + mdio_write(tp, 0x06, 0x0ae0); + mdio_write(tp, 0x06, 0x834f); + mdio_write(tp, 0x06, 0xa010); + mdio_write(tp, 0x06, 0xa5ee); + mdio_write(tp, 0x06, 0x834e); + mdio_write(tp, 0x06, 0x01e0); + mdio_write(tp, 0x06, 0x834e); + mdio_write(tp, 0x06, 0x7805); + mdio_write(tp, 0x06, 0x9e9a); + mdio_write(tp, 0x06, 0xe083); + mdio_write(tp, 0x06, 0x4e78); + mdio_write(tp, 0x06, 0x049e); + mdio_write(tp, 0x06, 0x10e0); + mdio_write(tp, 0x06, 0x834e); + mdio_write(tp, 0x06, 0x7803); + mdio_write(tp, 0x06, 0x9e0f); + mdio_write(tp, 0x06, 0xe083); + mdio_write(tp, 0x06, 0x4e78); + mdio_write(tp, 0x06, 0x019e); + mdio_write(tp, 0x06, 0x05ae); + mdio_write(tp, 0x06, 0x0caf); + mdio_write(tp, 0x06, 0x81f8); + mdio_write(tp, 0x06, 0xaf81); + mdio_write(tp, 0x06, 0xa3af); + mdio_write(tp, 0x06, 0x81dc); + mdio_write(tp, 0x06, 0xaf82); + mdio_write(tp, 0x06, 0x13ee); + mdio_write(tp, 0x06, 0x8348); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0x8349); + mdio_write(tp, 0x06, 0x00e0); + mdio_write(tp, 0x06, 0x8351); + mdio_write(tp, 0x06, 0x10e4); + mdio_write(tp, 0x06, 0x8351); + mdio_write(tp, 0x06, 0x5801); + mdio_write(tp, 0x06, 0x9fea); + mdio_write(tp, 0x06, 0xd000); + mdio_write(tp, 0x06, 0xd180); + mdio_write(tp, 0x06, 0x1f66); + mdio_write(tp, 0x06, 0xe2f8); + mdio_write(tp, 0x06, 0xeae3); + mdio_write(tp, 0x06, 0xf8eb); + mdio_write(tp, 0x06, 0x5af8); + mdio_write(tp, 0x06, 0x1e20); + mdio_write(tp, 0x06, 0xe6f8); + mdio_write(tp, 0x06, 0xeae5); + mdio_write(tp, 0x06, 0xf8eb); + mdio_write(tp, 0x06, 0xd302); + mdio_write(tp, 0x06, 0xb3fe); + mdio_write(tp, 0x06, 0xe2f8); + mdio_write(tp, 0x06, 0x7cef); + mdio_write(tp, 0x06, 0x325b); + mdio_write(tp, 0x06, 0x80e3); + mdio_write(tp, 0x06, 0xf87d); + mdio_write(tp, 0x06, 0x9e03); + mdio_write(tp, 0x06, 0x7dff); + mdio_write(tp, 0x06, 0xff0d); + mdio_write(tp, 0x06, 0x581c); + mdio_write(tp, 0x06, 0x551a); + mdio_write(tp, 0x06, 0x6511); + mdio_write(tp, 0x06, 0xa190); + mdio_write(tp, 0x06, 0xd3e2); + mdio_write(tp, 0x06, 0x8348); + mdio_write(tp, 0x06, 0xe383); + mdio_write(tp, 0x06, 0x491b); + mdio_write(tp, 0x06, 0x56ab); + mdio_write(tp, 0x06, 0x08ef); + mdio_write(tp, 0x06, 0x56e6); + mdio_write(tp, 0x06, 0x8348); + mdio_write(tp, 0x06, 0xe783); + mdio_write(tp, 0x06, 0x4910); + mdio_write(tp, 0x06, 0xd180); + mdio_write(tp, 0x06, 0x1f66); + mdio_write(tp, 0x06, 0xa004); + mdio_write(tp, 0x06, 0xb9e2); + mdio_write(tp, 0x06, 0x8348); + mdio_write(tp, 0x06, 0xe383); + mdio_write(tp, 0x06, 0x49ef); + mdio_write(tp, 0x06, 0x65e2); + mdio_write(tp, 0x06, 0x834a); + mdio_write(tp, 0x06, 0xe383); + mdio_write(tp, 0x06, 0x4b1b); + mdio_write(tp, 0x06, 0x56aa); + mdio_write(tp, 0x06, 0x0eef); + mdio_write(tp, 0x06, 0x56e6); + mdio_write(tp, 0x06, 0x834a); + mdio_write(tp, 0x06, 0xe783); + mdio_write(tp, 0x06, 0x4be2); + mdio_write(tp, 0x06, 0x834d); + mdio_write(tp, 0x06, 0xe683); + mdio_write(tp, 0x06, 0x4ce0); + mdio_write(tp, 0x06, 0x834d); + mdio_write(tp, 0x06, 0xa000); + mdio_write(tp, 0x06, 0x0caf); + mdio_write(tp, 0x06, 0x81dc); + mdio_write(tp, 0x06, 0xe083); + mdio_write(tp, 0x06, 0x4d10); + mdio_write(tp, 0x06, 0xe483); + mdio_write(tp, 0x06, 0x4dae); + mdio_write(tp, 0x06, 0x0480); + mdio_write(tp, 0x06, 0xe483); + mdio_write(tp, 0x06, 0x4de0); + mdio_write(tp, 0x06, 0x834e); + mdio_write(tp, 0x06, 0x7803); + mdio_write(tp, 0x06, 0x9e0b); + mdio_write(tp, 0x06, 0xe083); + mdio_write(tp, 0x06, 0x4e78); + mdio_write(tp, 0x06, 0x049e); + mdio_write(tp, 0x06, 0x04ee); + mdio_write(tp, 0x06, 0x834e); + mdio_write(tp, 0x06, 0x02e0); + mdio_write(tp, 0x06, 0x8332); + mdio_write(tp, 0x06, 0xe183); + mdio_write(tp, 0x06, 0x3359); + mdio_write(tp, 0x06, 0x0fe2); + mdio_write(tp, 0x06, 0x834d); + mdio_write(tp, 0x06, 0x0c24); + mdio_write(tp, 0x06, 0x5af0); + mdio_write(tp, 0x06, 0x1e12); + mdio_write(tp, 0x06, 0xe4f8); + mdio_write(tp, 0x06, 0x8ce5); + mdio_write(tp, 0x06, 0xf88d); + mdio_write(tp, 0x06, 0xe083); + mdio_write(tp, 0x06, 0x30e1); + mdio_write(tp, 0x06, 0x8331); + mdio_write(tp, 0x06, 0x6801); + mdio_write(tp, 0x06, 0xe4f8); + mdio_write(tp, 0x06, 0x8ae5); + mdio_write(tp, 0x06, 0xf88b); + mdio_write(tp, 0x06, 0xae37); + mdio_write(tp, 0x06, 0xee83); + mdio_write(tp, 0x06, 0x4e03); + mdio_write(tp, 0x06, 0xe083); + mdio_write(tp, 0x06, 0x4ce1); + mdio_write(tp, 0x06, 0x834d); + mdio_write(tp, 0x06, 0x1b01); + mdio_write(tp, 0x06, 0x9e04); + mdio_write(tp, 0x06, 0xaaa1); + mdio_write(tp, 0x06, 0xaea8); + mdio_write(tp, 0x06, 0xee83); + mdio_write(tp, 0x06, 0x4e04); + mdio_write(tp, 0x06, 0xee83); + mdio_write(tp, 0x06, 0x4f00); + mdio_write(tp, 0x06, 0xaeab); + mdio_write(tp, 0x06, 0xe083); + mdio_write(tp, 0x06, 0x4f78); + mdio_write(tp, 0x06, 0x039f); + mdio_write(tp, 0x06, 0x14ee); + mdio_write(tp, 0x06, 0x834e); + mdio_write(tp, 0x06, 0x05d2); + mdio_write(tp, 0x06, 0x40d6); + mdio_write(tp, 0x06, 0x5554); + mdio_write(tp, 0x06, 0x0282); + mdio_write(tp, 0x06, 0x17d2); + mdio_write(tp, 0x06, 0xa0d6); + mdio_write(tp, 0x06, 0xba00); + mdio_write(tp, 0x06, 0x0282); + mdio_write(tp, 0x06, 0x17fe); + mdio_write(tp, 0x06, 0xfdfc); + mdio_write(tp, 0x06, 0x05f8); + mdio_write(tp, 0x06, 0xe0f8); + mdio_write(tp, 0x06, 0x60e1); + mdio_write(tp, 0x06, 0xf861); + mdio_write(tp, 0x06, 0x6802); + mdio_write(tp, 0x06, 0xe4f8); + mdio_write(tp, 0x06, 0x60e5); + mdio_write(tp, 0x06, 0xf861); + mdio_write(tp, 0x06, 0xe0f8); + mdio_write(tp, 0x06, 0x48e1); + mdio_write(tp, 0x06, 0xf849); + mdio_write(tp, 0x06, 0x580f); + mdio_write(tp, 0x06, 0x1e02); + mdio_write(tp, 0x06, 0xe4f8); + mdio_write(tp, 0x06, 0x48e5); + mdio_write(tp, 0x06, 0xf849); + mdio_write(tp, 0x06, 0xd000); + mdio_write(tp, 0x06, 0x0282); + mdio_write(tp, 0x06, 0x5bbf); + mdio_write(tp, 0x06, 0x8350); + mdio_write(tp, 0x06, 0xef46); + mdio_write(tp, 0x06, 0xdc19); + mdio_write(tp, 0x06, 0xddd0); + mdio_write(tp, 0x06, 0x0102); + mdio_write(tp, 0x06, 0x825b); + mdio_write(tp, 0x06, 0x0282); + mdio_write(tp, 0x06, 0x77e0); + mdio_write(tp, 0x06, 0xf860); + mdio_write(tp, 0x06, 0xe1f8); + mdio_write(tp, 0x06, 0x6158); + mdio_write(tp, 0x06, 0xfde4); + mdio_write(tp, 0x06, 0xf860); + mdio_write(tp, 0x06, 0xe5f8); + mdio_write(tp, 0x06, 0x61fc); + mdio_write(tp, 0x06, 0x04f9); + mdio_write(tp, 0x06, 0xfafb); + mdio_write(tp, 0x06, 0xc6bf); + mdio_write(tp, 0x06, 0xf840); + mdio_write(tp, 0x06, 0xbe83); + mdio_write(tp, 0x06, 0x50a0); + mdio_write(tp, 0x06, 0x0101); + mdio_write(tp, 0x06, 0x071b); + mdio_write(tp, 0x06, 0x89cf); + mdio_write(tp, 0x06, 0xd208); + mdio_write(tp, 0x06, 0xebdb); + mdio_write(tp, 0x06, 0x19b2); + mdio_write(tp, 0x06, 0xfbff); + mdio_write(tp, 0x06, 0xfefd); + mdio_write(tp, 0x06, 0x04f8); + mdio_write(tp, 0x06, 0xe0f8); + mdio_write(tp, 0x06, 0x48e1); + mdio_write(tp, 0x06, 0xf849); + mdio_write(tp, 0x06, 0x6808); + mdio_write(tp, 0x06, 0xe4f8); + mdio_write(tp, 0x06, 0x48e5); + mdio_write(tp, 0x06, 0xf849); + mdio_write(tp, 0x06, 0x58f7); + mdio_write(tp, 0x06, 0xe4f8); + mdio_write(tp, 0x06, 0x48e5); + mdio_write(tp, 0x06, 0xf849); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0x4d20); + mdio_write(tp, 0x06, 0x0002); + mdio_write(tp, 0x06, 0x4e22); + mdio_write(tp, 0x06, 0x0002); + mdio_write(tp, 0x06, 0x4ddf); + mdio_write(tp, 0x06, 0xff01); + mdio_write(tp, 0x06, 0x4edd); + mdio_write(tp, 0x06, 0xff01); + mdio_write(tp, 0x06, 0xf8fa); + mdio_write(tp, 0x06, 0xfbef); + mdio_write(tp, 0x06, 0x79bf); + mdio_write(tp, 0x06, 0xf822); + mdio_write(tp, 0x06, 0xd819); + mdio_write(tp, 0x06, 0xd958); + mdio_write(tp, 0x06, 0x849f); + mdio_write(tp, 0x06, 0x09bf); + mdio_write(tp, 0x06, 0x82be); + mdio_write(tp, 0x06, 0xd682); + mdio_write(tp, 0x06, 0xc602); + mdio_write(tp, 0x06, 0x014f); + mdio_write(tp, 0x06, 0xef97); + mdio_write(tp, 0x06, 0xfffe); + mdio_write(tp, 0x06, 0xfc05); + mdio_write(tp, 0x06, 0x17ff); + mdio_write(tp, 0x06, 0xfe01); + mdio_write(tp, 0x06, 0x1700); + mdio_write(tp, 0x06, 0x0102); + mdio_write(tp, 0x05, 0x83d8); + mdio_write(tp, 0x06, 0x8051); + mdio_write(tp, 0x05, 0x83d6); + mdio_write(tp, 0x06, 0x82a0); + mdio_write(tp, 0x05, 0x83d4); + mdio_write(tp, 0x06, 0x8000); + mdio_write(tp, 0x02, 0x2010); + mdio_write(tp, 0x03, 0xdc00); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x0b, 0x0600); + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x05, 0xfff6); + mdio_write(tp, 0x06, 0x00fc); + mdio_write(tp, 0x1f, 0x0000); + } + + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, 0x0D, 0xF880); + mdio_write(tp, 0x1F, 0x0000); + } else if (tp->mcfg == CFG_METHOD_10) { + mdio_write(tp, 0x1F, 0x0001); + mdio_write(tp, 0x06, 0x4064); + mdio_write(tp, 0x07, 0x2863); + mdio_write(tp, 0x08, 0x059C); + mdio_write(tp, 0x09, 0x26B4); + mdio_write(tp, 0x0A, 0x6A19); + mdio_write(tp, 0x0B, 0xDCC8); + mdio_write(tp, 0x10, 0xF06D); + mdio_write(tp, 0x14, 0x7F68); + mdio_write(tp, 0x18, 0x7FD9); + mdio_write(tp, 0x1C, 0xF0FF); + mdio_write(tp, 0x1D, 0x3D9C); + mdio_write(tp, 0x1F, 0x0003); + mdio_write(tp, 0x12, 0xF49F); + mdio_write(tp, 0x13, 0x070B); + mdio_write(tp, 0x1A, 0x05AD); + mdio_write(tp, 0x14, 0x94C0); + + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x06, 0x5561); + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8332); + mdio_write(tp, 0x06, 0x5561); + + if (rtl8168_efuse_read(tp, 0x01) == 0xb1) { + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x05, 0x669A); + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8330); + mdio_write(tp, 0x06, 0x669A); + + mdio_write(tp, 0x1F, 0x0002); + gphy_val = mdio_read(tp, 0x0D); + if ((gphy_val & 0x00FF) != 0x006C) { + gphy_val &= 0xFF00; + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x0D, gphy_val | 0x0065); + mdio_write(tp, 0x0D, gphy_val | 0x0066); + mdio_write(tp, 0x0D, gphy_val | 0x0067); + mdio_write(tp, 0x0D, gphy_val | 0x0068); + mdio_write(tp, 0x0D, gphy_val | 0x0069); + mdio_write(tp, 0x0D, gphy_val | 0x006A); + mdio_write(tp, 0x0D, gphy_val | 0x006B); + mdio_write(tp, 0x0D, gphy_val | 0x006C); + } + } else { + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x05, 0x2642); + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8330); + mdio_write(tp, 0x06, 0x2642); + } + + if (rtl8168_efuse_read(tp, 0x30) == 0x98) { + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, 0x11, mdio_read(tp, 0x11) & ~BIT_1); + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x01, mdio_read(tp, 0x01) | BIT_9); + } else if (rtl8168_efuse_read(tp, 0x30) == 0x90) { + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x01, mdio_read(tp, 0x01) & ~BIT_9); + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, 0x16, 0x5101); + } + + mdio_write(tp, 0x1F, 0x0002); + gphy_val = mdio_read(tp, 0x02); + gphy_val &= ~BIT_10; + gphy_val &= ~BIT_9; + gphy_val |= BIT_8; + mdio_write(tp, 0x02, gphy_val); + gphy_val = mdio_read(tp, 0x03); + gphy_val &= ~BIT_15; + gphy_val &= ~BIT_14; + gphy_val &= ~BIT_13; + mdio_write(tp, 0x03, gphy_val); + + mdio_write(tp, 0x1F, 0x0001); + mdio_write(tp, 0x17, 0x0CC0); + + mdio_write(tp, 0x1F, 0x0002); + gphy_val = mdio_read(tp, 0x0F); + gphy_val |= BIT_4; + gphy_val |= BIT_2; + gphy_val |= BIT_1; + gphy_val |= BIT_0; + mdio_write(tp, 0x0F, gphy_val); + + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x001B); + if (mdio_read(tp, 0x06) == 0xB300) { + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x05, 0xfff6); + mdio_write(tp, 0x06, 0x0080); + mdio_write(tp, 0x05, 0x8000); + mdio_write(tp, 0x06, 0xf8f9); + mdio_write(tp, 0x06, 0xfaee); + mdio_write(tp, 0x06, 0xf8ea); + mdio_write(tp, 0x06, 0x00ee); + mdio_write(tp, 0x06, 0xf8eb); + mdio_write(tp, 0x06, 0x00e2); + mdio_write(tp, 0x06, 0xf87c); + mdio_write(tp, 0x06, 0xe3f8); + mdio_write(tp, 0x06, 0x7da5); + mdio_write(tp, 0x06, 0x1111); + mdio_write(tp, 0x06, 0x12d2); + mdio_write(tp, 0x06, 0x40d6); + mdio_write(tp, 0x06, 0x4444); + mdio_write(tp, 0x06, 0x0281); + mdio_write(tp, 0x06, 0xc6d2); + mdio_write(tp, 0x06, 0xa0d6); + mdio_write(tp, 0x06, 0xaaaa); + mdio_write(tp, 0x06, 0x0281); + mdio_write(tp, 0x06, 0xc6ae); + mdio_write(tp, 0x06, 0x0fa5); + mdio_write(tp, 0x06, 0x4444); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0x4da5); + mdio_write(tp, 0x06, 0xaaaa); + mdio_write(tp, 0x06, 0x02ae); + mdio_write(tp, 0x06, 0x47af); + mdio_write(tp, 0x06, 0x81c2); + mdio_write(tp, 0x06, 0xee83); + mdio_write(tp, 0x06, 0x4e00); + mdio_write(tp, 0x06, 0xee83); + mdio_write(tp, 0x06, 0x4d0f); + mdio_write(tp, 0x06, 0xee83); + mdio_write(tp, 0x06, 0x4c0f); + mdio_write(tp, 0x06, 0xee83); + mdio_write(tp, 0x06, 0x4f00); + mdio_write(tp, 0x06, 0xee83); + mdio_write(tp, 0x06, 0x5100); + mdio_write(tp, 0x06, 0xee83); + mdio_write(tp, 0x06, 0x4aff); + mdio_write(tp, 0x06, 0xee83); + mdio_write(tp, 0x06, 0x4bff); + mdio_write(tp, 0x06, 0xe083); + mdio_write(tp, 0x06, 0x30e1); + mdio_write(tp, 0x06, 0x8331); + mdio_write(tp, 0x06, 0x58fe); + mdio_write(tp, 0x06, 0xe4f8); + mdio_write(tp, 0x06, 0x8ae5); + mdio_write(tp, 0x06, 0xf88b); + mdio_write(tp, 0x06, 0xe083); + mdio_write(tp, 0x06, 0x32e1); + mdio_write(tp, 0x06, 0x8333); + mdio_write(tp, 0x06, 0x590f); + mdio_write(tp, 0x06, 0xe283); + mdio_write(tp, 0x06, 0x4d0c); + mdio_write(tp, 0x06, 0x245a); + mdio_write(tp, 0x06, 0xf01e); + mdio_write(tp, 0x06, 0x12e4); + mdio_write(tp, 0x06, 0xf88c); + mdio_write(tp, 0x06, 0xe5f8); + mdio_write(tp, 0x06, 0x8daf); + mdio_write(tp, 0x06, 0x81c2); + mdio_write(tp, 0x06, 0xe083); + mdio_write(tp, 0x06, 0x4f10); + mdio_write(tp, 0x06, 0xe483); + mdio_write(tp, 0x06, 0x4fe0); + mdio_write(tp, 0x06, 0x834e); + mdio_write(tp, 0x06, 0x7800); + mdio_write(tp, 0x06, 0x9f0a); + mdio_write(tp, 0x06, 0xe083); + mdio_write(tp, 0x06, 0x4fa0); + mdio_write(tp, 0x06, 0x10a5); + mdio_write(tp, 0x06, 0xee83); + mdio_write(tp, 0x06, 0x4e01); + mdio_write(tp, 0x06, 0xe083); + mdio_write(tp, 0x06, 0x4e78); + mdio_write(tp, 0x06, 0x059e); + mdio_write(tp, 0x06, 0x9ae0); + mdio_write(tp, 0x06, 0x834e); + mdio_write(tp, 0x06, 0x7804); + mdio_write(tp, 0x06, 0x9e10); + mdio_write(tp, 0x06, 0xe083); + mdio_write(tp, 0x06, 0x4e78); + mdio_write(tp, 0x06, 0x039e); + mdio_write(tp, 0x06, 0x0fe0); + mdio_write(tp, 0x06, 0x834e); + mdio_write(tp, 0x06, 0x7801); + mdio_write(tp, 0x06, 0x9e05); + mdio_write(tp, 0x06, 0xae0c); + mdio_write(tp, 0x06, 0xaf81); + mdio_write(tp, 0x06, 0xa7af); + mdio_write(tp, 0x06, 0x8152); + mdio_write(tp, 0x06, 0xaf81); + mdio_write(tp, 0x06, 0x8baf); + mdio_write(tp, 0x06, 0x81c2); + mdio_write(tp, 0x06, 0xee83); + mdio_write(tp, 0x06, 0x4800); + mdio_write(tp, 0x06, 0xee83); + mdio_write(tp, 0x06, 0x4900); + mdio_write(tp, 0x06, 0xe083); + mdio_write(tp, 0x06, 0x5110); + mdio_write(tp, 0x06, 0xe483); + mdio_write(tp, 0x06, 0x5158); + mdio_write(tp, 0x06, 0x019f); + mdio_write(tp, 0x06, 0xead0); + mdio_write(tp, 0x06, 0x00d1); + mdio_write(tp, 0x06, 0x801f); + mdio_write(tp, 0x06, 0x66e2); + mdio_write(tp, 0x06, 0xf8ea); + mdio_write(tp, 0x06, 0xe3f8); + mdio_write(tp, 0x06, 0xeb5a); + mdio_write(tp, 0x06, 0xf81e); + mdio_write(tp, 0x06, 0x20e6); + mdio_write(tp, 0x06, 0xf8ea); + mdio_write(tp, 0x06, 0xe5f8); + mdio_write(tp, 0x06, 0xebd3); + mdio_write(tp, 0x06, 0x02b3); + mdio_write(tp, 0x06, 0xfee2); + mdio_write(tp, 0x06, 0xf87c); + mdio_write(tp, 0x06, 0xef32); + mdio_write(tp, 0x06, 0x5b80); + mdio_write(tp, 0x06, 0xe3f8); + mdio_write(tp, 0x06, 0x7d9e); + mdio_write(tp, 0x06, 0x037d); + mdio_write(tp, 0x06, 0xffff); + mdio_write(tp, 0x06, 0x0d58); + mdio_write(tp, 0x06, 0x1c55); + mdio_write(tp, 0x06, 0x1a65); + mdio_write(tp, 0x06, 0x11a1); + mdio_write(tp, 0x06, 0x90d3); + mdio_write(tp, 0x06, 0xe283); + mdio_write(tp, 0x06, 0x48e3); + mdio_write(tp, 0x06, 0x8349); + mdio_write(tp, 0x06, 0x1b56); + mdio_write(tp, 0x06, 0xab08); + mdio_write(tp, 0x06, 0xef56); + mdio_write(tp, 0x06, 0xe683); + mdio_write(tp, 0x06, 0x48e7); + mdio_write(tp, 0x06, 0x8349); + mdio_write(tp, 0x06, 0x10d1); + mdio_write(tp, 0x06, 0x801f); + mdio_write(tp, 0x06, 0x66a0); + mdio_write(tp, 0x06, 0x04b9); + mdio_write(tp, 0x06, 0xe283); + mdio_write(tp, 0x06, 0x48e3); + mdio_write(tp, 0x06, 0x8349); + mdio_write(tp, 0x06, 0xef65); + mdio_write(tp, 0x06, 0xe283); + mdio_write(tp, 0x06, 0x4ae3); + mdio_write(tp, 0x06, 0x834b); + mdio_write(tp, 0x06, 0x1b56); + mdio_write(tp, 0x06, 0xaa0e); + mdio_write(tp, 0x06, 0xef56); + mdio_write(tp, 0x06, 0xe683); + mdio_write(tp, 0x06, 0x4ae7); + mdio_write(tp, 0x06, 0x834b); + mdio_write(tp, 0x06, 0xe283); + mdio_write(tp, 0x06, 0x4de6); + mdio_write(tp, 0x06, 0x834c); + mdio_write(tp, 0x06, 0xe083); + mdio_write(tp, 0x06, 0x4da0); + mdio_write(tp, 0x06, 0x000c); + mdio_write(tp, 0x06, 0xaf81); + mdio_write(tp, 0x06, 0x8be0); + mdio_write(tp, 0x06, 0x834d); + mdio_write(tp, 0x06, 0x10e4); + mdio_write(tp, 0x06, 0x834d); + mdio_write(tp, 0x06, 0xae04); + mdio_write(tp, 0x06, 0x80e4); + mdio_write(tp, 0x06, 0x834d); + mdio_write(tp, 0x06, 0xe083); + mdio_write(tp, 0x06, 0x4e78); + mdio_write(tp, 0x06, 0x039e); + mdio_write(tp, 0x06, 0x0be0); + mdio_write(tp, 0x06, 0x834e); + mdio_write(tp, 0x06, 0x7804); + mdio_write(tp, 0x06, 0x9e04); + mdio_write(tp, 0x06, 0xee83); + mdio_write(tp, 0x06, 0x4e02); + mdio_write(tp, 0x06, 0xe083); + mdio_write(tp, 0x06, 0x32e1); + mdio_write(tp, 0x06, 0x8333); + mdio_write(tp, 0x06, 0x590f); + mdio_write(tp, 0x06, 0xe283); + mdio_write(tp, 0x06, 0x4d0c); + mdio_write(tp, 0x06, 0x245a); + mdio_write(tp, 0x06, 0xf01e); + mdio_write(tp, 0x06, 0x12e4); + mdio_write(tp, 0x06, 0xf88c); + mdio_write(tp, 0x06, 0xe5f8); + mdio_write(tp, 0x06, 0x8de0); + mdio_write(tp, 0x06, 0x8330); + mdio_write(tp, 0x06, 0xe183); + mdio_write(tp, 0x06, 0x3168); + mdio_write(tp, 0x06, 0x01e4); + mdio_write(tp, 0x06, 0xf88a); + mdio_write(tp, 0x06, 0xe5f8); + mdio_write(tp, 0x06, 0x8bae); + mdio_write(tp, 0x06, 0x37ee); + mdio_write(tp, 0x06, 0x834e); + mdio_write(tp, 0x06, 0x03e0); + mdio_write(tp, 0x06, 0x834c); + mdio_write(tp, 0x06, 0xe183); + mdio_write(tp, 0x06, 0x4d1b); + mdio_write(tp, 0x06, 0x019e); + mdio_write(tp, 0x06, 0x04aa); + mdio_write(tp, 0x06, 0xa1ae); + mdio_write(tp, 0x06, 0xa8ee); + mdio_write(tp, 0x06, 0x834e); + mdio_write(tp, 0x06, 0x04ee); + mdio_write(tp, 0x06, 0x834f); + mdio_write(tp, 0x06, 0x00ae); + mdio_write(tp, 0x06, 0xabe0); + mdio_write(tp, 0x06, 0x834f); + mdio_write(tp, 0x06, 0x7803); + mdio_write(tp, 0x06, 0x9f14); + mdio_write(tp, 0x06, 0xee83); + mdio_write(tp, 0x06, 0x4e05); + mdio_write(tp, 0x06, 0xd240); + mdio_write(tp, 0x06, 0xd655); + mdio_write(tp, 0x06, 0x5402); + mdio_write(tp, 0x06, 0x81c6); + mdio_write(tp, 0x06, 0xd2a0); + mdio_write(tp, 0x06, 0xd6ba); + mdio_write(tp, 0x06, 0x0002); + mdio_write(tp, 0x06, 0x81c6); + mdio_write(tp, 0x06, 0xfefd); + mdio_write(tp, 0x06, 0xfc05); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0xf860); + mdio_write(tp, 0x06, 0xe1f8); + mdio_write(tp, 0x06, 0x6168); + mdio_write(tp, 0x06, 0x02e4); + mdio_write(tp, 0x06, 0xf860); + mdio_write(tp, 0x06, 0xe5f8); + mdio_write(tp, 0x06, 0x61e0); + mdio_write(tp, 0x06, 0xf848); + mdio_write(tp, 0x06, 0xe1f8); + mdio_write(tp, 0x06, 0x4958); + mdio_write(tp, 0x06, 0x0f1e); + mdio_write(tp, 0x06, 0x02e4); + mdio_write(tp, 0x06, 0xf848); + mdio_write(tp, 0x06, 0xe5f8); + mdio_write(tp, 0x06, 0x49d0); + mdio_write(tp, 0x06, 0x0002); + mdio_write(tp, 0x06, 0x820a); + mdio_write(tp, 0x06, 0xbf83); + mdio_write(tp, 0x06, 0x50ef); + mdio_write(tp, 0x06, 0x46dc); + mdio_write(tp, 0x06, 0x19dd); + mdio_write(tp, 0x06, 0xd001); + mdio_write(tp, 0x06, 0x0282); + mdio_write(tp, 0x06, 0x0a02); + mdio_write(tp, 0x06, 0x8226); + mdio_write(tp, 0x06, 0xe0f8); + mdio_write(tp, 0x06, 0x60e1); + mdio_write(tp, 0x06, 0xf861); + mdio_write(tp, 0x06, 0x58fd); + mdio_write(tp, 0x06, 0xe4f8); + mdio_write(tp, 0x06, 0x60e5); + mdio_write(tp, 0x06, 0xf861); + mdio_write(tp, 0x06, 0xfc04); + mdio_write(tp, 0x06, 0xf9fa); + mdio_write(tp, 0x06, 0xfbc6); + mdio_write(tp, 0x06, 0xbff8); + mdio_write(tp, 0x06, 0x40be); + mdio_write(tp, 0x06, 0x8350); + mdio_write(tp, 0x06, 0xa001); + mdio_write(tp, 0x06, 0x0107); + mdio_write(tp, 0x06, 0x1b89); + mdio_write(tp, 0x06, 0xcfd2); + mdio_write(tp, 0x06, 0x08eb); + mdio_write(tp, 0x06, 0xdb19); + mdio_write(tp, 0x06, 0xb2fb); + mdio_write(tp, 0x06, 0xfffe); + mdio_write(tp, 0x06, 0xfd04); + mdio_write(tp, 0x06, 0xf8e0); + mdio_write(tp, 0x06, 0xf848); + mdio_write(tp, 0x06, 0xe1f8); + mdio_write(tp, 0x06, 0x4968); + mdio_write(tp, 0x06, 0x08e4); + mdio_write(tp, 0x06, 0xf848); + mdio_write(tp, 0x06, 0xe5f8); + mdio_write(tp, 0x06, 0x4958); + mdio_write(tp, 0x06, 0xf7e4); + mdio_write(tp, 0x06, 0xf848); + mdio_write(tp, 0x06, 0xe5f8); + mdio_write(tp, 0x06, 0x49fc); + mdio_write(tp, 0x06, 0x044d); + mdio_write(tp, 0x06, 0x2000); + mdio_write(tp, 0x06, 0x024e); + mdio_write(tp, 0x06, 0x2200); + mdio_write(tp, 0x06, 0x024d); + mdio_write(tp, 0x06, 0xdfff); + mdio_write(tp, 0x06, 0x014e); + mdio_write(tp, 0x06, 0xddff); + mdio_write(tp, 0x06, 0x01f8); + mdio_write(tp, 0x06, 0xfafb); + mdio_write(tp, 0x06, 0xef79); + mdio_write(tp, 0x06, 0xbff8); + mdio_write(tp, 0x06, 0x22d8); + mdio_write(tp, 0x06, 0x19d9); + mdio_write(tp, 0x06, 0x5884); + mdio_write(tp, 0x06, 0x9f09); + mdio_write(tp, 0x06, 0xbf82); + mdio_write(tp, 0x06, 0x6dd6); + mdio_write(tp, 0x06, 0x8275); + mdio_write(tp, 0x06, 0x0201); + mdio_write(tp, 0x06, 0x4fef); + mdio_write(tp, 0x06, 0x97ff); + mdio_write(tp, 0x06, 0xfefc); + mdio_write(tp, 0x06, 0x0517); + mdio_write(tp, 0x06, 0xfffe); + mdio_write(tp, 0x06, 0x0117); + mdio_write(tp, 0x06, 0x0001); + mdio_write(tp, 0x06, 0x0200); + mdio_write(tp, 0x05, 0x83d8); + mdio_write(tp, 0x06, 0x8000); + mdio_write(tp, 0x05, 0x83d6); + mdio_write(tp, 0x06, 0x824f); + mdio_write(tp, 0x02, 0x2010); + mdio_write(tp, 0x03, 0xdc00); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x0b, 0x0600); + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x05, 0xfff6); + mdio_write(tp, 0x06, 0x00fc); + mdio_write(tp, 0x1f, 0x0000); + } + + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, 0x0D, 0xF880); + mdio_write(tp, 0x1F, 0x0000); + } else if (tp->mcfg == CFG_METHOD_11) { + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x10, 0x0008); + mdio_write(tp, 0x0D, 0x006C); + + mdio_write(tp, 0x1F, 0x0001); + mdio_write(tp, 0x17, 0x0CC0); + + mdio_write(tp, 0x1F, 0x0001); + mdio_write(tp, 0x0B, 0xA4D8); + mdio_write(tp, 0x09, 0x281C); + mdio_write(tp, 0x07, 0x2883); + mdio_write(tp, 0x0A, 0x6B35); + mdio_write(tp, 0x1D, 0x3DA4); + mdio_write(tp, 0x1C, 0xEFFD); + mdio_write(tp, 0x14, 0x7F52); + mdio_write(tp, 0x18, 0x7FC6); + mdio_write(tp, 0x08, 0x0601); + mdio_write(tp, 0x06, 0x4063); + mdio_write(tp, 0x10, 0xF074); + mdio_write(tp, 0x1F, 0x0003); + mdio_write(tp, 0x13, 0x0789); + mdio_write(tp, 0x12, 0xF4BD); + mdio_write(tp, 0x1A, 0x04FD); + mdio_write(tp, 0x14, 0x84B0); + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, 0x00, 0x9200); + + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x01, 0x0340); + mdio_write(tp, 0x1F, 0x0001); + mdio_write(tp, 0x04, 0x4000); + mdio_write(tp, 0x03, 0x1D21); + mdio_write(tp, 0x02, 0x0C32); + mdio_write(tp, 0x01, 0x0200); + mdio_write(tp, 0x00, 0x5554); + mdio_write(tp, 0x04, 0x4800); + mdio_write(tp, 0x04, 0x4000); + mdio_write(tp, 0x04, 0xF000); + mdio_write(tp, 0x03, 0xDF01); + mdio_write(tp, 0x02, 0xDF20); + mdio_write(tp, 0x01, 0x101A); + mdio_write(tp, 0x00, 0xA0FF); + mdio_write(tp, 0x04, 0xF800); + mdio_write(tp, 0x04, 0xF000); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0007); + mdio_write(tp, 0x1E, 0x0023); + mdio_write(tp, 0x16, 0x0000); + mdio_write(tp, 0x1F, 0x0000); + + gphy_val = mdio_read(tp, 0x0D); + gphy_val |= BIT_5; + mdio_write(tp, 0x0D, gphy_val); + } else if (tp->mcfg == CFG_METHOD_12 || tp->mcfg == CFG_METHOD_13) { + mdio_write(tp, 0x1F, 0x0001); + mdio_write(tp, 0x17, 0x0CC0); + + mdio_write(tp, 0x1F, 0x0007); + mdio_write(tp, 0x1E, 0x002D); + mdio_write(tp, 0x18, 0x0040); + + mdio_write(tp, 0x1F, 0x0000); + gphy_val = mdio_read(tp, 0x0D); + gphy_val |= BIT_5; + mdio_write(tp, 0x0D, gphy_val); + + mdio_write(tp, 0x1F, 0x0002); + gphy_val = mdio_read(tp, 0x0C); + gphy_val |= BIT_10; + mdio_write(tp, 0x0C, gphy_val); + } else if (tp->mcfg == CFG_METHOD_14 || tp->mcfg == CFG_METHOD_15) { + mdio_write(tp, 0x1F, 0x0007); + mdio_write(tp, 0x1E, 0x0023); + gphy_val = mdio_read(tp, 0x17) | BIT_1; + if (tp->RequiredSecLanDonglePatch) + gphy_val &= ~(BIT_2); + else + gphy_val |= (BIT_2); + mdio_write(tp, 0x17, gphy_val); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x05, 0x8b80); + mdio_write(tp, 0x06, 0xc896); + mdio_write(tp, 0x1f, 0x0000); + + mdio_write(tp, 0x1F, 0x0001); + mdio_write(tp, 0x0B, 0x6C20); + mdio_write(tp, 0x07, 0x2872); + mdio_write(tp, 0x1C, 0xEFFF); + mdio_write(tp, 0x1F, 0x0003); + mdio_write(tp, 0x14, 0x6420); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0002); + gphy_val = mdio_read(tp, 0x08) & 0x00FF; + mdio_write(tp, 0x08, gphy_val | 0x8000); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0007); + mdio_write(tp, 0x1E, 0x002D); + gphy_val = mdio_read(tp, 0x18); + mdio_write(tp, 0x18, gphy_val | 0x0010); + mdio_write(tp, 0x1F, 0x0000); + gphy_val = mdio_read(tp, 0x14); + mdio_write(tp, 0x14, gphy_val | 0x8000); + + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x00, 0x080B); + mdio_write(tp, 0x0B, 0x09D7); + mdio_write(tp, 0x1F, 0x0000); + + if (aspm) { + if (tp->HwHasWrRamCodeToMicroP == TRUE) { + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x15, 0x1006); + } + } + + mdio_write(tp, 0x1F, 0x0003); + mdio_write(tp, 0x19, 0x7F46); + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8AD2); + mdio_write(tp, 0x06, 0x6810); + mdio_write(tp, 0x05, 0x8AD4); + mdio_write(tp, 0x06, 0x8002); + mdio_write(tp, 0x05, 0x8ADE); + mdio_write(tp, 0x06, 0x8025); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0007); + mdio_write(tp, 0x1E, 0x002F); + mdio_write(tp, 0x15, 0x1919); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0007); + mdio_write(tp, 0x1E, 0x002D); + gphy_val = mdio_read(tp, 0x18); + mdio_write(tp, 0x18, gphy_val | 0x0040); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B86); + gphy_val = mdio_read(tp, 0x06); + mdio_write(tp, 0x06, gphy_val | 0x0001); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0007); + mdio_write(tp, 0x1E, 0x00AC); + mdio_write(tp, 0x18, 0x0006); + mdio_write(tp, 0x1F, 0x0000); + } else if (tp->mcfg == CFG_METHOD_16) { + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B80); + gphy_val = mdio_read(tp, 0x06); + gphy_val |= BIT_2 | BIT_1; + mdio_write(tp, 0x06, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + + mdio_write(tp, 0x1f, 0x0004); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x002D); + gphy_val = mdio_read(tp, 0x18); + gphy_val |= BIT_4; + mdio_write(tp, 0x18, gphy_val); + mdio_write(tp, 0x1f, 0x0002); + mdio_write(tp, 0x1f, 0x0000); + gphy_val = mdio_read(tp, 0x14); + gphy_val |= BIT_15; + mdio_write(tp, 0x14, gphy_val); + + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, 0x15, 0x1006); + + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B86); + gphy_val = mdio_read(tp, 0x06); + gphy_val |= BIT_0; + mdio_write(tp, 0x06, gphy_val); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0001); + mdio_write(tp, 0x0B, 0x6C14); + mdio_write(tp, 0x14, 0x7F3D); + mdio_write(tp, 0x1C, 0xFAFE); + mdio_write(tp, 0x08, 0x07C5); + mdio_write(tp, 0x10, 0xF090); + mdio_write(tp, 0x1F, 0x0003); + mdio_write(tp, 0x14, 0x641A); + mdio_write(tp, 0x1A, 0x0606); + mdio_write(tp, 0x12, 0xF480); + mdio_write(tp, 0x13, 0x0747); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0004); + mdio_write(tp, 0x1F, 0x0007); + mdio_write(tp, 0x1E, 0x0078); + mdio_write(tp, 0x15, 0xA408); + mdio_write(tp, 0x17, 0x5100); + mdio_write(tp, 0x19, 0x0008); + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0003); + mdio_write(tp, 0x0D, 0x0207); + mdio_write(tp, 0x02, 0x5FD0); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0004); + mdio_write(tp, 0x1F, 0x0007); + mdio_write(tp, 0x1E, 0x00A1); + gphy_val = mdio_read(tp, 0x1A); + gphy_val &= ~BIT_2; + mdio_write(tp, 0x1A, gphy_val); + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0004); + mdio_write(tp, 0x1F, 0x0007); + mdio_write(tp, 0x1E, 0x002D); + gphy_val = mdio_read(tp, 0x16); + gphy_val |= BIT_5; + mdio_write(tp, 0x16, gphy_val); + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0004); + mdio_write(tp, 0x1F, 0x0007); + mdio_write(tp, 0x1E, 0x00AC); + mdio_write(tp, 0x18, 0x0006); + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0003); + mdio_write(tp, 0x09, 0xA20F); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B5B); + mdio_write(tp, 0x06, 0x9222); + mdio_write(tp, 0x05, 0x8B6D); + mdio_write(tp, 0x06, 0x8000); + mdio_write(tp, 0x05, 0x8B76); + mdio_write(tp, 0x06, 0x8000); + mdio_write(tp, 0x1F, 0x0000); + + if (pdev->subsystem_vendor == 0x1043 && + pdev->subsystem_device == 0x13F7) { + + static const u16 evl_phy_value[] = { + 0x8B56, 0x8B5F, 0x8B68, 0x8B71, + 0x8B7A, 0x8A7B, 0x8A7E, 0x8A81, + 0x8A84, 0x8A87 + }; + + mdio_write(tp, 0x1F, 0x0005); + for (i = 0; i < ARRAY_SIZE(evl_phy_value); i++) { + mdio_write(tp, 0x05, evl_phy_value[i]); + gphy_val = (0xAA << 8) | (mdio_read(tp, 0x06) & 0xFF); + mdio_write(tp, 0x06, gphy_val); + } + mdio_write(tp, 0x1F, 0x0007); + mdio_write(tp, 0x1E, 0x0078); + mdio_write(tp, 0x17, 0x51AA); + mdio_write(tp, 0x1F, 0x0000); + } + + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x05, 0x8B54); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_11); + mdio_write(tp, 0x05, 0x8B5D); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_11); + mdio_write(tp, 0x05, 0x8A7C); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_8); + mdio_write(tp, 0x05, 0x8A7F); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) | BIT_8); + mdio_write(tp, 0x05, 0x8A82); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_8); + mdio_write(tp, 0x05, 0x8A85); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_8); + mdio_write(tp, 0x05, 0x8A88); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_8); + mdio_write(tp, 0x1f, 0x0000); + + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B85); + gphy_val = mdio_read(tp, 0x06) | BIT_14 | BIT_15; + mdio_write(tp, 0x06, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + } else if (tp->mcfg == CFG_METHOD_17) { + if (pdev->subsystem_vendor == 0x144d && + pdev->subsystem_device == 0xc0a6) { + mdio_write(tp, 0x1F, 0x0001); + mdio_write(tp, 0x0e, 0x6b7f); + mdio_write(tp, 0x1f, 0x0000); + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B86); + gphy_val = mdio_read(tp, 0x06); + gphy_val |= BIT_4; + mdio_write(tp, 0x06, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + } else { + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B80); + gphy_val = mdio_read(tp, 0x06); + gphy_val |= BIT_2 | BIT_1; + mdio_write(tp, 0x06, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B86); + gphy_val = mdio_read(tp, 0x06); + gphy_val &= ~BIT_4; + mdio_write(tp, 0x06, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + } + + mdio_write(tp, 0x1f, 0x0004); + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x002D); + gphy_val = mdio_read(tp, 0x18); + gphy_val |= BIT_4; + mdio_write(tp, 0x18, gphy_val); + mdio_write(tp, 0x1f, 0x0002); + mdio_write(tp, 0x1f, 0x0000); + gphy_val = mdio_read(tp, 0x14); + gphy_val |= BIT_15; + mdio_write(tp, 0x14, gphy_val); + + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B86); + gphy_val = mdio_read(tp, 0x06); + gphy_val |= BIT_0; + mdio_write(tp, 0x06, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + + mdio_write(tp, 0x1F, 0x0004); + mdio_write(tp, 0x1F, 0x0007); + mdio_write(tp, 0x1E, 0x00AC); + mdio_write(tp, 0x18, 0x0006); + mdio_write(tp, 0x1F, 0x0002); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0003); + mdio_write(tp, 0x09, 0xA20F); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B85); + gphy_val = mdio_read(tp, 0x06) | BIT_14 | BIT_15; + mdio_write(tp, 0x06, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B5B); + mdio_write(tp, 0x06, 0x9222); + mdio_write(tp, 0x05, 0x8B6D); + mdio_write(tp, 0x06, 0x8000); + mdio_write(tp, 0x05, 0x8B76); + mdio_write(tp, 0x06, 0x8000); + mdio_write(tp, 0x1F, 0x0000); + + if (pdev->subsystem_vendor == 0x1043 && + pdev->subsystem_device == 0x13F7) { + + static const u16 evl_phy_value[] = { + 0x8B56, 0x8B5F, 0x8B68, 0x8B71, + 0x8B7A, 0x8A7B, 0x8A7E, 0x8A81, + 0x8A84, 0x8A87 + }; + + mdio_write(tp, 0x1F, 0x0005); + for (i = 0; i < ARRAY_SIZE(evl_phy_value); i++) { + mdio_write(tp, 0x05, evl_phy_value[i]); + gphy_val = (0xAA << 8) | (mdio_read(tp, 0x06) & 0xFF); + mdio_write(tp, 0x06, gphy_val); + } + mdio_write(tp, 0x1F, 0x0007); + mdio_write(tp, 0x1E, 0x0078); + mdio_write(tp, 0x17, 0x51AA); + mdio_write(tp, 0x1F, 0x0000); + } + + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x05, 0x8B54); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_11); + mdio_write(tp, 0x05, 0x8B5D); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_11); + mdio_write(tp, 0x05, 0x8A7C); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_8); + mdio_write(tp, 0x05, 0x8A7F); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) | BIT_8); + mdio_write(tp, 0x05, 0x8A82); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_8); + mdio_write(tp, 0x05, 0x8A85); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_8); + mdio_write(tp, 0x05, 0x8A88); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_8); + mdio_write(tp, 0x1f, 0x0000); + + if (aspm) { + if (tp->HwHasWrRamCodeToMicroP == TRUE) { + mdio_write(tp, 0x1f, 0x0000); + gphy_val = mdio_read(tp, 0x15); + gphy_val |= BIT_12; + mdio_write(tp, 0x15, gphy_val); + } + } + } else if (tp->mcfg == CFG_METHOD_18) { + if (tp->HwHasWrRamCodeToMicroP == TRUE) { + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8b80); + gphy_val = mdio_read(tp, 0x06); + gphy_val |= BIT_2 | BIT_1; + mdio_write(tp, 0x06, gphy_val); + mdio_write(tp, 0x1F, 0x0000); + } + + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x002D); + gphy_val = mdio_read(tp, 0x18); + gphy_val |= BIT_4; + mdio_write(tp, 0x18, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + gphy_val = mdio_read(tp, 0x14); + gphy_val |= BIT_15; + mdio_write(tp, 0x14, gphy_val); + + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B86); + gphy_val = mdio_read(tp, 0x06); + gphy_val |= BIT_0; + mdio_write(tp, 0x06, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B85); + gphy_val = mdio_read(tp, 0x06); + gphy_val |= BIT_14; + mdio_write(tp, 0x06, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + + mdio_write(tp, 0x1F, 0x0003); + mdio_write(tp, 0x09, 0xA20F); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B55); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x05, 0x8B5E); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x05, 0x8B67); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x05, 0x8B70); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, 0x1F, 0x0007); + mdio_write(tp, 0x1E, 0x0078); + mdio_write(tp, 0x17, 0x0000); + mdio_write(tp, 0x19, 0x00FB); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B79); + mdio_write(tp, 0x06, 0xAA00); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1f, 0x0003); + mdio_write(tp, 0x01, 0x328A); + mdio_write(tp, 0x1f, 0x0000); + + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x05, 0x8B54); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_11); + mdio_write(tp, 0x05, 0x8B5D); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_11); + mdio_write(tp, 0x05, 0x8A7C); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_8); + mdio_write(tp, 0x05, 0x8A7F); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) | BIT_8); + mdio_write(tp, 0x05, 0x8A82); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_8); + mdio_write(tp, 0x05, 0x8A85); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_8); + mdio_write(tp, 0x05, 0x8A88); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_8); + mdio_write(tp, 0x1f, 0x0000); + + if (tp->HwHasWrRamCodeToMicroP == TRUE) { + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x05, 0x8b85); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) | BIT_15); + mdio_write(tp, 0x1f, 0x0000); + } + + if (aspm) { + if (tp->HwHasWrRamCodeToMicroP == TRUE) { + mdio_write(tp, 0x1f, 0x0000); + gphy_val = mdio_read(tp, 0x15); + gphy_val |= BIT_12; + mdio_write(tp, 0x15, gphy_val); + } + } + } else if (tp->mcfg == CFG_METHOD_19) { + if (tp->HwHasWrRamCodeToMicroP == TRUE) { + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8b80); + gphy_val = mdio_read(tp, 0x06); + gphy_val |= BIT_2 | BIT_1; + mdio_write(tp, 0x06, gphy_val); + mdio_write(tp, 0x1F, 0x0000); + } + + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x002D); + gphy_val = mdio_read(tp, 0x18); + gphy_val |= BIT_4; + mdio_write(tp, 0x18, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + gphy_val = mdio_read(tp, 0x14); + gphy_val |= BIT_15; + mdio_write(tp, 0x14, gphy_val); + + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B86); + gphy_val = mdio_read(tp, 0x06); + gphy_val |= BIT_0; + mdio_write(tp, 0x06, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x05, 0x8B54); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_11); + mdio_write(tp, 0x05, 0x8B5D); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_11); + mdio_write(tp, 0x05, 0x8A7C); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_8); + mdio_write(tp, 0x05, 0x8A7F); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) | BIT_8); + mdio_write(tp, 0x05, 0x8A82); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_8); + mdio_write(tp, 0x05, 0x8A85); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_8); + mdio_write(tp, 0x05, 0x8A88); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_8); + mdio_write(tp, 0x1f, 0x0000); + + if (tp->HwHasWrRamCodeToMicroP == TRUE) { + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x05, 0x8b85); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) | BIT_15); + mdio_write(tp, 0x1f, 0x0000); + } + + if (aspm) { + if (tp->HwHasWrRamCodeToMicroP == TRUE) { + mdio_write(tp, 0x1f, 0x0000); + gphy_val = mdio_read(tp, 0x15); + gphy_val |= BIT_12; + mdio_write(tp, 0x15, gphy_val); + } + } + } else if (tp->mcfg == CFG_METHOD_20) { + + if (tp->HwHasWrRamCodeToMicroP == TRUE) { + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8b80); + gphy_val = mdio_read(tp, 0x06); + gphy_val |= BIT_2 | BIT_1; + mdio_write(tp, 0x06, gphy_val); + mdio_write(tp, 0x1F, 0x0000); + } + + mdio_write(tp, 0x1f, 0x0007); + mdio_write(tp, 0x1e, 0x002D); + gphy_val = mdio_read(tp, 0x18); + gphy_val |= BIT_4; + mdio_write(tp, 0x18, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + gphy_val = mdio_read(tp, 0x14); + gphy_val |= BIT_15; + mdio_write(tp, 0x14, gphy_val); + + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B86); + gphy_val = mdio_read(tp, 0x06); + gphy_val |= BIT_0; + mdio_write(tp, 0x06, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B85); + gphy_val = mdio_read(tp, 0x06); + gphy_val |= BIT_14; + mdio_write(tp, 0x06, gphy_val); + mdio_write(tp, 0x1f, 0x0000); + + mdio_write(tp, 0x1F, 0x0003); + mdio_write(tp, 0x09, 0xA20F); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B55); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x05, 0x8B5E); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x05, 0x8B67); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x05, 0x8B70); + mdio_write(tp, 0x06, 0x0000); + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, 0x1F, 0x0007); + mdio_write(tp, 0x1E, 0x0078); + mdio_write(tp, 0x17, 0x0000); + mdio_write(tp, 0x19, 0x00FB); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B79); + mdio_write(tp, 0x06, 0xAA00); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x05, 0x8B54); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_11); + mdio_write(tp, 0x05, 0x8B5D); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_11); + mdio_write(tp, 0x05, 0x8A7C); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_8); + mdio_write(tp, 0x05, 0x8A7F); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) | BIT_8); + mdio_write(tp, 0x05, 0x8A82); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_8); + mdio_write(tp, 0x05, 0x8A85); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_8); + mdio_write(tp, 0x05, 0x8A88); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) & ~BIT_8); + mdio_write(tp, 0x1f, 0x0000); + + if (tp->HwHasWrRamCodeToMicroP == TRUE) { + mdio_write(tp, 0x1f, 0x0005); + mdio_write(tp, 0x05, 0x8b85); + mdio_write(tp, 0x06, mdio_read(tp, 0x06) | BIT_15); + mdio_write(tp, 0x1f, 0x0000); + } + + if (aspm) { + if (tp->HwHasWrRamCodeToMicroP == TRUE) { + mdio_write(tp, 0x1f, 0x0000); + gphy_val = mdio_read(tp, 0x15); + gphy_val |= BIT_12; + mdio_write(tp, 0x15, gphy_val); + } + } + } else if (tp->mcfg == CFG_METHOD_21) { + mdio_write(tp, 0x1F, 0x0A46); + gphy_val = mdio_read(tp, 0x10); + mdio_write(tp, 0x1F, 0x0BCC); + if (gphy_val & BIT_8) + ClearEthPhyBit(tp, 0x12, BIT_15); + else + SetEthPhyBit(tp, 0x12, BIT_15); + mdio_write(tp, 0x1F, 0x0A46); + gphy_val = mdio_read(tp, 0x13); + mdio_write(tp, 0x1F, 0x0C41); + if (gphy_val & BIT_8) + SetEthPhyBit(tp, 0x15, BIT_1); + else + ClearEthPhyBit(tp, 0x15, BIT_1); + + mdio_write(tp, 0x1F, 0x0A44); + mdio_write(tp, 0x11, mdio_read(tp, 0x11) | BIT_2 | BIT_3); + + mdio_write(tp, 0x1F, 0x0BCC); + mdio_write(tp, 0x14, mdio_read(tp, 0x14) & ~BIT_8); + mdio_write(tp, 0x1F, 0x0A44); + mdio_write(tp, 0x11, mdio_read(tp, 0x11) | BIT_7); + mdio_write(tp, 0x11, mdio_read(tp, 0x11) | BIT_6); + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x8084); + mdio_write(tp, 0x14, mdio_read(tp, 0x14) & ~(BIT_14 | BIT_13)); + mdio_write(tp, 0x10, mdio_read(tp, 0x10) | BIT_12); + mdio_write(tp, 0x10, mdio_read(tp, 0x10) | BIT_1); + mdio_write(tp, 0x10, mdio_read(tp, 0x10) | BIT_0); + + mdio_write(tp, 0x1F, 0x0A4B); + mdio_write(tp, 0x11, mdio_read(tp, 0x11) | BIT_2); + + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x8012); + mdio_write(tp, 0x14, mdio_read(tp, 0x14) | BIT_15); + + mdio_write(tp, 0x1F, 0x0C42); + gphy_val = mdio_read(tp, 0x11); + gphy_val |= BIT_14; + gphy_val &= ~BIT_13; + mdio_write(tp, 0x11, gphy_val); + + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x809A); + mdio_write(tp, 0x14, 0x8022); + mdio_write(tp, 0x13, 0x80A0); + gphy_val = mdio_read(tp, 0x14) & 0x00FF; + gphy_val |= 0x1000; + mdio_write(tp, 0x14, gphy_val); + mdio_write(tp, 0x13, 0x8088); + mdio_write(tp, 0x14, 0x9222); + + if (aspm) { + if (tp->HwHasWrRamCodeToMicroP == TRUE) { + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x10, mdio_read(tp, 0x10) | BIT_2); + } + } + + mdio_write(tp, 0x1F, 0x0000); + } else if (tp->mcfg == CFG_METHOD_22) { + //do nothing + } else if (tp->mcfg == CFG_METHOD_23) { + mdio_write(tp, 0x1F, 0x0A44); + mdio_write(tp, 0x11, mdio_read(tp, 0x11) | (BIT_3 | BIT_2)); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0BCC); + mdio_write(tp, 0x14, mdio_read(tp, 0x14) & ~BIT_8); + mdio_write(tp, 0x1F, 0x0A44); + mdio_write(tp, 0x11, mdio_read(tp, 0x11) | BIT_7); + mdio_write(tp, 0x11, mdio_read(tp, 0x11) | BIT_6); + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x8084); + mdio_write(tp, 0x14, mdio_read(tp, 0x14) & ~(BIT_14 | BIT_13)); + mdio_write(tp, 0x10, mdio_read(tp, 0x10) | BIT_12); + mdio_write(tp, 0x10, mdio_read(tp, 0x10) | BIT_1); + mdio_write(tp, 0x10, mdio_read(tp, 0x10) | BIT_0); + + mdio_write(tp, 0x1F, 0x0A4B); + mdio_write(tp, 0x11, mdio_read(tp, 0x11) | BIT_2); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x8012); + mdio_write(tp, 0x14, mdio_read(tp, 0x14) | BIT_15); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0C42); + ClearAndSetEthPhyBit(tp, + 0x11, + BIT_13, + BIT_14 + ); + mdio_write(tp, 0x1F, 0x0000); + + if (aspm) { + if (tp->HwHasWrRamCodeToMicroP == TRUE) { + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x10, mdio_read(tp, 0x10) | BIT_2); + } + } + } else if (tp->mcfg == CFG_METHOD_24) { + mdio_write(tp, 0x1F, 0x0BCC); + mdio_write(tp, 0x14, mdio_read(tp, 0x14) & ~BIT_8); + mdio_write(tp, 0x1F, 0x0A44); + mdio_write(tp, 0x11, mdio_read(tp, 0x11) | BIT_7); + mdio_write(tp, 0x11, mdio_read(tp, 0x11) | BIT_6); + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x8084); + mdio_write(tp, 0x14, mdio_read(tp, 0x14) & ~(BIT_14 | BIT_13)); + mdio_write(tp, 0x10, mdio_read(tp, 0x10) | BIT_12); + mdio_write(tp, 0x10, mdio_read(tp, 0x10) | BIT_1); + mdio_write(tp, 0x10, mdio_read(tp, 0x10) | BIT_0); + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x8012); + mdio_write(tp, 0x14, mdio_read(tp, 0x14) | BIT_15); + + mdio_write(tp, 0x1F, 0x0C42); + gphy_val = mdio_read(tp, 0x11); + gphy_val |= BIT_14; + gphy_val &= ~BIT_13; + mdio_write(tp, 0x11, gphy_val); + + if (aspm) { + if (tp->HwHasWrRamCodeToMicroP == TRUE) { + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x10, mdio_read(tp, 0x10) | BIT_2); + } + } + } else if (tp->mcfg == CFG_METHOD_25 || tp->mcfg == CFG_METHOD_26) { + mdio_write(tp, 0x1F, 0x0BCC); + mdio_write(tp, 0x14, mdio_read(tp, 0x14) & ~BIT_8); + mdio_write(tp, 0x1F, 0x0A44); + mdio_write(tp, 0x11, mdio_read(tp, 0x11) | BIT_7); + mdio_write(tp, 0x11, mdio_read(tp, 0x11) | BIT_6); + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x8084); + mdio_write(tp, 0x14, mdio_read(tp, 0x14) & ~(BIT_14 | BIT_13)); + mdio_write(tp, 0x10, mdio_read(tp, 0x10) | BIT_12); + mdio_write(tp, 0x10, mdio_read(tp, 0x10) | BIT_1); + mdio_write(tp, 0x10, mdio_read(tp, 0x10) | BIT_0); + + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x8012); + mdio_write(tp, 0x14, mdio_read(tp, 0x14) | BIT_15); + + mdio_write(tp, 0x1F, 0x0BCE); + mdio_write(tp, 0x12, 0x8860); + + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x80F3); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x8B00); + mdio_write(tp, 0x13, 0x80F0); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x3A00); + mdio_write(tp, 0x13, 0x80EF); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x0500); + mdio_write(tp, 0x13, 0x80F6); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x6E00); + mdio_write(tp, 0x13, 0x80EC); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x6800); + mdio_write(tp, 0x13, 0x80ED); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x7C00); + mdio_write(tp, 0x13, 0x80F2); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0xF400); + mdio_write(tp, 0x13, 0x80F4); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x8500); + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x8110); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0xA800); + mdio_write(tp, 0x13, 0x810F); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x1D00); + mdio_write(tp, 0x13, 0x8111); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0xF500); + mdio_write(tp, 0x13, 0x8113); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x6100); + mdio_write(tp, 0x13, 0x8115); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x9200); + mdio_write(tp, 0x13, 0x810E); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x0400); + mdio_write(tp, 0x13, 0x810C); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x7C00); + mdio_write(tp, 0x13, 0x810B); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x5A00); + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x80D1); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0xFF00); + mdio_write(tp, 0x13, 0x80CD); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x9E00); + mdio_write(tp, 0x13, 0x80D3); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x0E00); + mdio_write(tp, 0x13, 0x80D5); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0xCA00); + mdio_write(tp, 0x13, 0x80D7); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x8400); + + if (aspm) { + if (tp->HwHasWrRamCodeToMicroP == TRUE) { + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x10, mdio_read(tp, 0x10) | BIT_2); + } + } + } else if (tp->mcfg == CFG_METHOD_27 || tp->mcfg == CFG_METHOD_28) { + mdio_write(tp, 0x1F, 0x0BCC); + mdio_write(tp, 0x14, mdio_read(tp, 0x14) & ~BIT_8); + mdio_write(tp, 0x1F, 0x0A44); + mdio_write(tp, 0x11, mdio_read(tp, 0x11) | BIT_7); + mdio_write(tp, 0x11, mdio_read(tp, 0x11) | BIT_6); + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x8084); + mdio_write(tp, 0x14, mdio_read(tp, 0x14) & ~(BIT_14 | BIT_13)); + mdio_write(tp, 0x10, mdio_read(tp, 0x10) | BIT_12); + mdio_write(tp, 0x10, mdio_read(tp, 0x10) | BIT_1); + mdio_write(tp, 0x10, mdio_read(tp, 0x10) | BIT_0); + + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x8012); + mdio_write(tp, 0x14, mdio_read(tp, 0x14) | BIT_15); + + mdio_write(tp, 0x1F, 0x0C42); + mdio_write(tp, 0x11, (mdio_read(tp, 0x11) & ~BIT_13) | BIT_14); + + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x80F3); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x8B00); + mdio_write(tp, 0x13, 0x80F0); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x3A00); + mdio_write(tp, 0x13, 0x80EF); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x0500); + mdio_write(tp, 0x13, 0x80F6); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x6E00); + mdio_write(tp, 0x13, 0x80EC); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x6800); + mdio_write(tp, 0x13, 0x80ED); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x7C00); + mdio_write(tp, 0x13, 0x80F2); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0xF400); + mdio_write(tp, 0x13, 0x80F4); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x8500); + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x8110); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0xA800); + mdio_write(tp, 0x13, 0x810F); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x1D00); + mdio_write(tp, 0x13, 0x8111); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0xF500); + mdio_write(tp, 0x13, 0x8113); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x6100); + mdio_write(tp, 0x13, 0x8115); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x9200); + mdio_write(tp, 0x13, 0x810E); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x0400); + mdio_write(tp, 0x13, 0x810C); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x7C00); + mdio_write(tp, 0x13, 0x810B); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x5A00); + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x80D1); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0xFF00); + mdio_write(tp, 0x13, 0x80CD); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x9E00); + mdio_write(tp, 0x13, 0x80D3); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x0E00); + mdio_write(tp, 0x13, 0x80D5); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0xCA00); + mdio_write(tp, 0x13, 0x80D7); + mdio_write(tp, 0x14, (mdio_read(tp, 0x14) & ~0xFF00) | 0x8400); + + if (aspm) { + if (tp->HwHasWrRamCodeToMicroP == TRUE) { + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x10, mdio_read(tp, 0x10) | BIT_2); + } + } + } else if (tp->mcfg == CFG_METHOD_29) { + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x809b); + ClearAndSetEthPhyBit( tp, + 0x14, + 0xF800 , + 0x8000 + ); + mdio_write(tp, 0x13, 0x80A2); + ClearAndSetEthPhyBit( tp, + 0x14, + 0xFF00 , + 0x8000 + ); + mdio_write(tp, 0x13, 0x80A4); + ClearAndSetEthPhyBit( tp, + 0x14, + 0xFF00 , + 0x8500 + ); + mdio_write(tp, 0x13, 0x809C); + ClearAndSetEthPhyBit( tp, + 0x14, + 0xFF00 , + 0xbd00 + ); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x80AD); + ClearAndSetEthPhyBit( tp, + 0x14, + 0xF800 , + 0x7000 + ); + mdio_write(tp, 0x13, 0x80B4); + ClearAndSetEthPhyBit( tp, + 0x14, + 0xFF00 , + 0x5000 + ); + mdio_write(tp, 0x13, 0x80AC); + ClearAndSetEthPhyBit( tp, + 0x14, + 0xFF00 , + 0x4000 + ); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x808E); + ClearAndSetEthPhyBit( tp, + 0x14, + 0xFF00 , + 0x1200 + ); + mdio_write(tp, 0x13, 0x8090); + ClearAndSetEthPhyBit( tp, + 0x14, + 0xFF00 , + 0xE500 + ); + mdio_write(tp, 0x13, 0x8092); + ClearAndSetEthPhyBit( tp, + 0x14, + 0xFF00 , + 0x9F00 + ); + mdio_write(tp, 0x1F, 0x0000); + + if (tp->HwHasWrRamCodeToMicroP) { + u16 dout_tapbin; + + dout_tapbin = 0x0000; + mdio_write( tp, 0x1F, 0x0A46 ); + gphy_val = mdio_read( tp, 0x13 ); + gphy_val &= (BIT_1|BIT_0); + gphy_val <<= 2; + dout_tapbin |= gphy_val; + + gphy_val = mdio_read( tp, 0x12 ); + gphy_val &= (BIT_15|BIT_14); + gphy_val >>= 14; + dout_tapbin |= gphy_val; + + dout_tapbin = ~( dout_tapbin^BIT_3 ); + dout_tapbin <<= 12; + dout_tapbin &= 0xF000; + + mdio_write( tp, 0x1F, 0x0A43 ); + + mdio_write( tp, 0x13, 0x827A ); + ClearAndSetEthPhyBit( tp, + 0x14, + BIT_15|BIT_14|BIT_13|BIT_12, + dout_tapbin + ); + + + mdio_write( tp, 0x13, 0x827B ); + ClearAndSetEthPhyBit( tp, + 0x14, + BIT_15|BIT_14|BIT_13|BIT_12, + dout_tapbin + ); + + + mdio_write( tp, 0x13, 0x827C ); + ClearAndSetEthPhyBit( tp, + 0x14, + BIT_15|BIT_14|BIT_13|BIT_12, + dout_tapbin + ); + + + mdio_write( tp, 0x13, 0x827D ); + ClearAndSetEthPhyBit( tp, + 0x14, + BIT_15|BIT_14|BIT_13|BIT_12, + dout_tapbin + ); + + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x8011); + SetEthPhyBit(tp, 0x14, BIT_11); + mdio_write(tp, 0x1F, 0x0A42); + SetEthPhyBit(tp, 0x16, BIT_1); + } + + mdio_write(tp, 0x1F, 0x0A44); + SetEthPhyBit( tp, 0x11, BIT_11 ); + mdio_write(tp, 0x1F, 0x0000); + + + mdio_write(tp, 0x1F, 0x0BCA); + ClearAndSetEthPhyBit( tp, + 0x17, + (BIT_13 | BIT_12) , + BIT_14 + ); + mdio_write(tp, 0x1F, 0x0000); + + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x803F); + ClearEthPhyBit( tp, 0x14, (BIT_13 | BIT_12)); + mdio_write(tp, 0x13, 0x8047); + ClearEthPhyBit( tp, 0x14, (BIT_13 | BIT_12)); + mdio_write(tp, 0x13, 0x804F); + ClearEthPhyBit( tp, 0x14, (BIT_13 | BIT_12)); + mdio_write(tp, 0x13, 0x8057); + ClearEthPhyBit( tp, 0x14, (BIT_13 | BIT_12)); + mdio_write(tp, 0x13, 0x805F); + ClearEthPhyBit( tp, 0x14, (BIT_13 | BIT_12)); + mdio_write(tp, 0x13, 0x8067 ); + ClearEthPhyBit( tp, 0x14, (BIT_13 | BIT_12)); + mdio_write(tp, 0x13, 0x806F ); + ClearEthPhyBit( tp, 0x14, (BIT_13 | BIT_12)); + mdio_write(tp, 0x1F, 0x0000); + + if (aspm) { + if (tp->HwHasWrRamCodeToMicroP == TRUE) { + mdio_write(tp, 0x1F, 0x0A43); + SetEthPhyBit( tp, 0x10, BIT_2 ); + mdio_write(tp, 0x1F, 0x0000); + } + } + } else if (tp->mcfg == CFG_METHOD_30) { + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x808A); + ClearAndSetEthPhyBit( tp, + 0x14, + BIT_5 | BIT_4 | BIT_3 | BIT_2 | BIT_1 | BIT_0, + 0x0A ); + + if (tp->HwHasWrRamCodeToMicroP) { + mdio_write(tp, 0x1F, 0x0A43); + mdio_write(tp, 0x13, 0x8011); + SetEthPhyBit(tp, 0x14, BIT_11); + mdio_write(tp, 0x1F, 0x0A42); + SetEthPhyBit(tp, 0x16, BIT_1); + } + + mdio_write(tp, 0x1F, 0x0A44); + SetEthPhyBit( tp, 0x11, BIT_11 ); + mdio_write(tp, 0x1F, 0x0000); + + if(tp->RequireAdcBiasPatch) { + mdio_write(tp, 0x1F, 0x0BCF); + mdio_write(tp, 0x16, tp->AdcBiasPatchIoffset); + mdio_write(tp, 0x1F, 0x0000); + } + + { + u16 rlen; + + mdio_write(tp, 0x1F, 0x0BCD); + gphy_val = mdio_read( tp, 0x16 ); + gphy_val &= 0x000F; + + if( gphy_val > 3 ) { + rlen = gphy_val - 3; + } else { + rlen = 0; + } + + gphy_val = rlen | (rlen<<4) | (rlen<<8) | (rlen<<12); + + mdio_write(tp, 0x1F, 0x0BCD); + mdio_write(tp, 0x17, gphy_val); + mdio_write(tp, 0x1F, 0x0000); + } + + if (aspm) { + if (tp->HwHasWrRamCodeToMicroP == TRUE) { + mdio_write(tp, 0x1F, 0x0A43); + SetEthPhyBit( tp, 0x10, BIT_2 ); + mdio_write(tp, 0x1F, 0x0000); + } + } + } + + //EthPhyPPSW + if (tp->mcfg == CFG_METHOD_21 || tp->mcfg == CFG_METHOD_22 || + tp->mcfg == CFG_METHOD_24 || tp->mcfg == CFG_METHOD_25 || + tp->mcfg == CFG_METHOD_26) { + //disable EthPhyPPSW + mdio_write(tp, 0x1F, 0x0BCD); + mdio_write(tp, 0x14, 0x5065); + mdio_write(tp, 0x14, 0xD065); + mdio_write(tp, 0x1F, 0x0BC8); + mdio_write(tp, 0x11, 0x5655); + mdio_write(tp, 0x1F, 0x0BCD); + mdio_write(tp, 0x14, 0x1065); + mdio_write(tp, 0x14, 0x9065); + mdio_write(tp, 0x14, 0x1065); + mdio_write(tp, 0x1F, 0x0000); + } else if (tp->mcfg == CFG_METHOD_29 || tp->mcfg == CFG_METHOD_30) { + //enable EthPhyPPSW + mdio_write(tp, 0x1F, 0x0A44); + SetEthPhyBit( tp, 0x11, BIT_7 ); + mdio_write(tp, 0x1F, 0x0000); + } + + /*ocp phy power saving*/ + if (tp->mcfg == CFG_METHOD_25 || tp->mcfg == CFG_METHOD_26 || + tp->mcfg == CFG_METHOD_27 || tp->mcfg == CFG_METHOD_28 || + tp->mcfg == CFG_METHOD_29 || tp->mcfg == CFG_METHOD_30) { + if (aspm) { + mdio_write_phy_ocp(tp, 0x0C41, 0x13, 0x0000); + mdio_write_phy_ocp(tp, 0x0C41, 0x13, 0x0050); + } + } + + mdio_write(tp, 0x1F, 0x0000); + + spin_unlock_irqrestore(&tp->phy_lock, flags); + + if (tp->HwHasWrRamCodeToMicroP == TRUE) { + if (eee_enable == 1) + rtl8168_enable_EEE(tp); + else + rtl8168_disable_EEE(tp); + } +} + +static inline void rtl8168_delete_esd_timer(struct net_device *dev, struct timer_list *timer) +{ + del_timer_sync(timer); +} + +static inline void rtl8168_request_esd_timer(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + struct timer_list *timer = &tp->esd_timer; + + init_timer(timer); + timer->expires = jiffies + RTL8168_ESD_TIMEOUT; + timer->data = (unsigned long)(dev); + timer->function = rtl8168_esd_timer; + add_timer(timer); +} + +static inline void rtl8168_delete_link_timer(struct net_device *dev, struct timer_list *timer) +{ + del_timer_sync(timer); +} + +static inline void rtl8168_request_link_timer(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + struct timer_list *timer = &tp->link_timer; + + init_timer(timer); + timer->expires = jiffies + RTL8168_LINK_TIMEOUT; + timer->data = (unsigned long)(dev); + timer->function = rtl8168_link_timer; + add_timer(timer); +} + +#ifdef CONFIG_NET_POLL_CONTROLLER +/* + * Polling 'interrupt' - used by things like netconsole to send skbs + * without having to re-enable interrupts. It's not called while + * the interrupt routine is executing. + */ +static void +rtl8168_netpoll(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + struct pci_dev *pdev = tp->pci_dev; + + disable_irq(pdev->irq); +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,19) + rtl8168_interrupt(pdev->irq, dev, NULL); +#else + rtl8168_interrupt(pdev->irq, dev); +#endif + enable_irq(pdev->irq); +} +#endif + +static void +rtl8168_get_bios_setting(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + + switch (tp->mcfg) { + case CFG_METHOD_9: + case CFG_METHOD_10: + case CFG_METHOD_11: + case CFG_METHOD_12: + case CFG_METHOD_13: + case CFG_METHOD_14: + case CFG_METHOD_15: + case CFG_METHOD_16: + case CFG_METHOD_17: + case CFG_METHOD_18: + case CFG_METHOD_19: + case CFG_METHOD_20: + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + tp->bios_setting = RTL_R32(0x8c); + break; + } +} + +static void +rtl8168_set_bios_setting(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + + switch (tp->mcfg) { + case CFG_METHOD_9: + case CFG_METHOD_10: + case CFG_METHOD_11: + case CFG_METHOD_12: + case CFG_METHOD_13: + case CFG_METHOD_14: + case CFG_METHOD_15: + case CFG_METHOD_16: + case CFG_METHOD_17: + case CFG_METHOD_18: + case CFG_METHOD_19: + case CFG_METHOD_20: + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + RTL_W32(0x8C, tp->bios_setting); + break; + } +} + +static void +rtl8168_init_software_variable(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + struct pci_dev *pdev = tp->pci_dev; + + rtl8168_get_bios_setting(dev); + + switch (tp->mcfg) { + case CFG_METHOD_11: + case CFG_METHOD_12: + case CFG_METHOD_13: + tp->HwSuppDashVer = 1; + break; + case CFG_METHOD_23: + case CFG_METHOD_27: + case CFG_METHOD_28: + tp->HwSuppDashVer = 2; + break; + default: + tp->HwSuppDashVer = 0; + break; + } + + switch (tp->mcfg) { + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + tp->HwSuppNowIsOobVer = 1; + break; + } + +#ifdef ENABLE_REALWOW_SUPPORT + get_realwow_hw_version(dev); +#endif //ENABLE_REALWOW_SUPPORT + + if (HW_DASH_SUPPORT_DASH(tp) && rtl8168_check_dash(tp)) + tp->DASH = 1; + else + tp->DASH = 0; + + switch (tp->mcfg) { + case CFG_METHOD_1: + tp->intr_mask = RxDescUnavail | RxFIFOOver | TxDescUnavail | TxOK | RxOK | SWInt; + tp->timer_intr_mask = PCSTimeout | RxFIFOOver; + break; + case CFG_METHOD_2: + case CFG_METHOD_3: + case CFG_METHOD_4: + tp->intr_mask = RxDescUnavail | TxDescUnavail | TxOK | RxOK | SWInt; + tp->timer_intr_mask = PCSTimeout; + break; + default: + tp->intr_mask = RxDescUnavail | TxOK | RxOK | SWInt; + tp->timer_intr_mask = PCSTimeout; + break; + } + +#ifdef ENABLE_DASH_SUPPORT + if(tp->DASH) { + if( HW_DASH_SUPPORT_TYPE_2( tp ) ) { + tp->timer_intr_mask |= ( ISRIMR_DASH_INTR_EN | ISRIMR_DASH_INTR_CMAC_RESET); + tp->intr_mask |= ( ISRIMR_DASH_INTR_EN | ISRIMR_DASH_INTR_CMAC_RESET); + } else { + tp->timer_intr_mask |= ( ISRIMR_DP_DASH_OK | ISRIMR_DP_HOST_OK | ISRIMR_DP_REQSYS_OK ); + tp->intr_mask |= ( ISRIMR_DP_DASH_OK | ISRIMR_DP_HOST_OK | ISRIMR_DP_REQSYS_OK ); + } + } +#endif + + tp->max_jumbo_frame_size = rtl_chip_info[tp->chipset].jumbo_frame_sz; + + if (aspm) { + switch (tp->mcfg) { + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + tp->org_pci_offset_99 = rtl8168_csi_fun0_read_byte(tp, 0x99); + tp->org_pci_offset_99 &= ~(BIT_5|BIT_6); + break; + } + switch (tp->mcfg) { + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + tp->org_pci_offset_180 = rtl8168_csi_fun0_read_byte(tp, 0x180); + break; + } + } + + pci_read_config_byte(pdev, 0x80, &tp->org_pci_offset_80); + pci_read_config_byte(pdev, 0x81, &tp->org_pci_offset_81); + + switch (tp->mcfg) { + case CFG_METHOD_16: + case CFG_METHOD_17: + case CFG_METHOD_18: + case CFG_METHOD_19: + case CFG_METHOD_20: + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + if ((tp->features & RTL_FEATURE_MSI) && (tp->org_pci_offset_80 & BIT_1)) + tp->use_timer_interrrupt = FALSE; + else + tp->use_timer_interrrupt = TRUE; + break; + default: + tp->use_timer_interrrupt = TRUE; + break; + } + + switch (tp->mcfg) { + case CFG_METHOD_1: + case CFG_METHOD_2: + case CFG_METHOD_3: + tp->ShortPacketSwChecksum = TRUE; + break; + case CFG_METHOD_16: + case CFG_METHOD_17: + tp->ShortPacketSwChecksum = TRUE; + tp->UseSwPaddingShortPkt = TRUE; + break; + } + + switch (tp->mcfg) { + case CFG_METHOD_30: { + u16 ioffset_p3, ioffset_p2, ioffset_p1, ioffset_p0; + u16 TmpUshort; + + mac_ocp_write( tp, 0xDD02, 0x807D); + TmpUshort = mac_ocp_read( tp, 0xDD02 ); + ioffset_p3 = ( (TmpUshort & BIT_7) >>7 ); + ioffset_p3 <<= 3; + TmpUshort = mac_ocp_read( tp, 0xDD00 ); + + ioffset_p3 |= ((TmpUshort & (BIT_15 | BIT_14 | BIT_13))>>13); + + ioffset_p2 = ((TmpUshort & (BIT_12|BIT_11|BIT_10|BIT_9))>>9); + ioffset_p1 = ((TmpUshort & (BIT_8|BIT_7|BIT_6|BIT_5))>>5); + + ioffset_p0 = ( (TmpUshort & BIT_4) >>4 ); + ioffset_p0 <<= 3; + ioffset_p0 |= (TmpUshort & (BIT_2| BIT_1 | BIT_0)); + + if((ioffset_p3 == 0x0F) && (ioffset_p2 == 0x0F) && (ioffset_p1 == 0x0F) && (ioffset_p0 == 0x0F)) { + tp->RequireAdcBiasPatch = FALSE; + } else { + tp->RequireAdcBiasPatch = TRUE; + tp->AdcBiasPatchIoffset = (ioffset_p3<<12)|(ioffset_p2<<8)|(ioffset_p1<<4)|(ioffset_p0); + } + } + break; + } + + switch (tp->mcfg) { + case CFG_METHOD_29: + case CFG_METHOD_30: { + u16 rg_saw_cnt; + + mdio_write(tp, 0x1F, 0x0C42); + rg_saw_cnt = mdio_read(tp, 0x13); + rg_saw_cnt &= ~(BIT_15|BIT_14); + mdio_write(tp, 0x1F, 0x0000); + + if ( rg_saw_cnt > 0) { + tp->SwrCnt1msIni = 16000000/rg_saw_cnt; + tp->SwrCnt1msIni &= 0x0FFF; + + tp->RequireAdjustUpsTxLinkPulseTiming = TRUE; + } + } + break; + } + + if (pdev->subsystem_vendor == 0x144d) { + if (pdev->subsystem_device == 0xc098 || + pdev->subsystem_device == 0xc0b1 || + pdev->subsystem_device == 0xc0b8) + hwoptimize |= HW_PATCH_SAMSUNG_LAN_DONGLE; + } + + if (hwoptimize & HW_PATCH_SAMSUNG_LAN_DONGLE) { + switch (tp->mcfg) { + case CFG_METHOD_14: + case CFG_METHOD_15: + case CFG_METHOD_16: + case CFG_METHOD_17: + case CFG_METHOD_18: + case CFG_METHOD_19: + case CFG_METHOD_20: + case CFG_METHOD_30: + tp->RequiredSecLanDonglePatch = TRUE; + break; + } + } + + switch (tp->mcfg) { + case CFG_METHOD_14: + case CFG_METHOD_15: + tp->sw_ram_code_ver = NIC_RAMCODE_VERSION_CFG_METHOD_14; + break; + case CFG_METHOD_16: + case CFG_METHOD_17: + tp->sw_ram_code_ver = NIC_RAMCODE_VERSION_CFG_METHOD_16; + break; + case CFG_METHOD_18: + case CFG_METHOD_19: + tp->sw_ram_code_ver = NIC_RAMCODE_VERSION_CFG_METHOD_18; + break; + case CFG_METHOD_20: + tp->sw_ram_code_ver = NIC_RAMCODE_VERSION_CFG_METHOD_20; + break; + case CFG_METHOD_21: + case CFG_METHOD_22: + tp->sw_ram_code_ver = NIC_RAMCODE_VERSION_CFG_METHOD_21; + break; + case CFG_METHOD_23: + case CFG_METHOD_27: + tp->sw_ram_code_ver = NIC_RAMCODE_VERSION_CFG_METHOD_23; + break; + case CFG_METHOD_24: + case CFG_METHOD_25: + tp->sw_ram_code_ver = NIC_RAMCODE_VERSION_CFG_METHOD_24; + break; + case CFG_METHOD_26: + tp->sw_ram_code_ver = NIC_RAMCODE_VERSION_CFG_METHOD_26; + break; + case CFG_METHOD_28: + tp->sw_ram_code_ver = NIC_RAMCODE_VERSION_CFG_METHOD_28; + break; + case CFG_METHOD_29: + case CFG_METHOD_30: + tp->sw_ram_code_ver = NIC_RAMCODE_VERSION_CFG_METHOD_29; + break; + } + + if (tp->HwIcVerUnknown) { + tp->NotWrRamCodeToMicroP = TRUE; + tp->NotWrMcuPatchCode = TRUE; + } + + rtl8168_get_hw_wol(dev); + + rtl8168_link_option((u8*)&autoneg, (u16*)&speed, (u8*)&duplex); + + tp->autoneg = autoneg; + tp->speed = speed; + tp->duplex = duplex; +} + +static void +rtl8168_release_board(struct pci_dev *pdev, + struct net_device *dev, + void __iomem *ioaddr) +{ + struct rtl8168_private *tp = netdev_priv(dev); + + rtl8168_set_bios_setting(dev); + rtl8168_rar_set(tp, tp->org_mac_addr); + tp->wol_enabled = WOL_DISABLED; + + if(!tp->DASH) + rtl8168_phy_power_down(dev); + +#ifdef ENABLE_DASH_SUPPORT + if(tp->DASH) + FreeAllocatedDashShareMemory(dev); +#endif + + iounmap(ioaddr); + pci_release_regions(pdev); + pci_disable_device(pdev); + free_netdev(dev); +} + +static int +rtl8168_get_mac_address(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + int i; + + + if (tp->mcfg == CFG_METHOD_18 || + tp->mcfg == CFG_METHOD_19 || + tp->mcfg == CFG_METHOD_20 || + tp->mcfg == CFG_METHOD_21 || + tp->mcfg == CFG_METHOD_22 || + tp->mcfg == CFG_METHOD_23 || + tp->mcfg == CFG_METHOD_24 || + tp->mcfg == CFG_METHOD_25 || + tp->mcfg == CFG_METHOD_26 || + tp->mcfg == CFG_METHOD_27 || + tp->mcfg == CFG_METHOD_28 || + tp->mcfg == CFG_METHOD_29 || + tp->mcfg == CFG_METHOD_30) { + u16 mac_addr[3]; + + *(u32*)&mac_addr[0] = rtl8168_eri_read(ioaddr, 0xE0, 4, ERIAR_ExGMAC); + *(u16*)&mac_addr[2] = rtl8168_eri_read(ioaddr, 0xE4, 2, ERIAR_ExGMAC); + + if (is_valid_ether_addr((u8*)mac_addr)) + rtl8168_rar_set(tp, (uint8_t*)mac_addr); + } else { + if (tp->eeprom_type != EEPROM_TYPE_NONE) { + u16 mac_addr[3]; + + /* Get MAC address from EEPROM */ + if (tp->mcfg == CFG_METHOD_16 || + tp->mcfg == CFG_METHOD_17 || + tp->mcfg == CFG_METHOD_18 || + tp->mcfg == CFG_METHOD_19 || + tp->mcfg == CFG_METHOD_20 || + tp->mcfg == CFG_METHOD_21 || + tp->mcfg == CFG_METHOD_22 || + tp->mcfg == CFG_METHOD_23 || + tp->mcfg == CFG_METHOD_24 || + tp->mcfg == CFG_METHOD_25 || + tp->mcfg == CFG_METHOD_26 || + tp->mcfg == CFG_METHOD_27 || + tp->mcfg == CFG_METHOD_28 || + tp->mcfg == CFG_METHOD_29 || + tp->mcfg == CFG_METHOD_30) { + mac_addr[0] = rtl_eeprom_read_sc(tp, 1); + mac_addr[1] = rtl_eeprom_read_sc(tp, 2); + mac_addr[2] = rtl_eeprom_read_sc(tp, 3); + } else { + mac_addr[0] = rtl_eeprom_read_sc(tp, 7); + mac_addr[1] = rtl_eeprom_read_sc(tp, 8); + mac_addr[2] = rtl_eeprom_read_sc(tp, 9); + } + + if (is_valid_ether_addr((u8*)mac_addr)) + rtl8168_rar_set(tp, (uint8_t*)mac_addr); + } + } + + for (i = 0; i < MAC_ADDR_LEN; i++) { + dev->dev_addr[i] = RTL_R8(MAC0 + i); + tp->org_mac_addr[i] = dev->dev_addr[i]; /* keep the original MAC address */ + } +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,13) + memcpy(dev->perm_addr, dev->dev_addr, dev->addr_len); +#endif +// memcpy(dev->dev_addr, dev->dev_addr, dev->addr_len); + + return 0; +} + +/** + * rtl8168_set_mac_address - Change the Ethernet Address of the NIC + * @dev: network interface device structure + * @p: pointer to an address structure + * + * Return 0 on success, negative on failure + **/ +static int +rtl8168_set_mac_address(struct net_device *dev, + void *p) +{ + struct rtl8168_private *tp = netdev_priv(dev); + struct sockaddr *addr = p; + unsigned long flags; + + if (!is_valid_ether_addr(addr->sa_data)) + return -EADDRNOTAVAIL; + + spin_lock_irqsave(&tp->lock, flags); + + memcpy(dev->dev_addr, addr->sa_data, dev->addr_len); + + rtl8168_rar_set(tp, dev->dev_addr); + + spin_unlock_irqrestore(&tp->lock, flags); + + return 0; +} + +/****************************************************************************** + * rtl8168_rar_set - Puts an ethernet address into a receive address register. + * + * tp - The private data structure for driver + * addr - Address to put into receive address register + *****************************************************************************/ +void +rtl8168_rar_set(struct rtl8168_private *tp, + uint8_t *addr) +{ + void __iomem *ioaddr = tp->mmio_addr; + uint32_t rar_low = 0; + uint32_t rar_high = 0; + + rar_low = ((uint32_t) addr[0] | + ((uint32_t) addr[1] << 8) | + ((uint32_t) addr[2] << 16) | + ((uint32_t) addr[3] << 24)); + + rar_high = ((uint32_t) addr[4] | + ((uint32_t) addr[5] << 8)); + + RTL_W8(Cfg9346, Cfg9346_Unlock); + RTL_W32(MAC0, rar_low); + RTL_W32(MAC4, rar_high); + + switch (tp->mcfg) { + case CFG_METHOD_14: + case CFG_METHOD_15: + RTL_W32(SecMAC0, rar_low); + RTL_W16(SecMAC4, (uint16_t)rar_high); + break; + } + + if (tp->mcfg == CFG_METHOD_17) { + rtl8168_eri_write(ioaddr, 0xf0, 4, rar_low << 16, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0xf4, 4, rar_low >> 16 | rar_high << 16, ERIAR_ExGMAC); + } + + RTL_W8(Cfg9346, Cfg9346_Lock); +} + +#ifdef ETHTOOL_OPS_COMPAT +static int ethtool_get_settings(struct net_device *dev, void *useraddr) +{ + struct ethtool_cmd cmd = { ETHTOOL_GSET }; + int err; + + if (!ethtool_ops->get_settings) + return -EOPNOTSUPP; + + err = ethtool_ops->get_settings(dev, &cmd); + if (err < 0) + return err; + + if (copy_to_user(useraddr, &cmd, sizeof(cmd))) + return -EFAULT; + return 0; +} + +static int ethtool_set_settings(struct net_device *dev, void *useraddr) +{ + struct ethtool_cmd cmd; + + if (!ethtool_ops->set_settings) + return -EOPNOTSUPP; + + if (copy_from_user(&cmd, useraddr, sizeof(cmd))) + return -EFAULT; + + return ethtool_ops->set_settings(dev, &cmd); +} + +static int ethtool_get_drvinfo(struct net_device *dev, void *useraddr) +{ + struct ethtool_drvinfo info; + struct ethtool_ops *ops = ethtool_ops; + + if (!ops->get_drvinfo) + return -EOPNOTSUPP; + + memset(&info, 0, sizeof(info)); + info.cmd = ETHTOOL_GDRVINFO; + ops->get_drvinfo(dev, &info); + + if (ops->self_test_count) + info.testinfo_len = ops->self_test_count(dev); + if (ops->get_stats_count) + info.n_stats = ops->get_stats_count(dev); + if (ops->get_regs_len) + info.regdump_len = ops->get_regs_len(dev); + if (ops->get_eeprom_len) + info.eedump_len = ops->get_eeprom_len(dev); + + if (copy_to_user(useraddr, &info, sizeof(info))) + return -EFAULT; + return 0; +} + +static int ethtool_get_regs(struct net_device *dev, char *useraddr) +{ + struct ethtool_regs regs; + struct ethtool_ops *ops = ethtool_ops; + void *regbuf; + int reglen, ret; + + if (!ops->get_regs || !ops->get_regs_len) + return -EOPNOTSUPP; + + if (copy_from_user(®s, useraddr, sizeof(regs))) + return -EFAULT; + + reglen = ops->get_regs_len(dev); + if (regs.len > reglen) + regs.len = reglen; + + regbuf = kmalloc(reglen, GFP_USER); + if (!regbuf) + return -ENOMEM; + + ops->get_regs(dev, ®s, regbuf); + + ret = -EFAULT; + if (copy_to_user(useraddr, ®s, sizeof(regs))) + goto out; + useraddr += offsetof(struct ethtool_regs, data); + if (copy_to_user(useraddr, regbuf, reglen)) + goto out; + ret = 0; + +out: + kfree(regbuf); + return ret; +} + +static int ethtool_get_wol(struct net_device *dev, char *useraddr) +{ + struct ethtool_wolinfo wol = { ETHTOOL_GWOL }; + + if (!ethtool_ops->get_wol) + return -EOPNOTSUPP; + + ethtool_ops->get_wol(dev, &wol); + + if (copy_to_user(useraddr, &wol, sizeof(wol))) + return -EFAULT; + return 0; +} + +static int ethtool_set_wol(struct net_device *dev, char *useraddr) +{ + struct ethtool_wolinfo wol; + + if (!ethtool_ops->set_wol) + return -EOPNOTSUPP; + + if (copy_from_user(&wol, useraddr, sizeof(wol))) + return -EFAULT; + + return ethtool_ops->set_wol(dev, &wol); +} + +static int ethtool_get_msglevel(struct net_device *dev, char *useraddr) +{ + struct ethtool_value edata = { ETHTOOL_GMSGLVL }; + + if (!ethtool_ops->get_msglevel) + return -EOPNOTSUPP; + + edata.data = ethtool_ops->get_msglevel(dev); + + if (copy_to_user(useraddr, &edata, sizeof(edata))) + return -EFAULT; + return 0; +} + +static int ethtool_set_msglevel(struct net_device *dev, char *useraddr) +{ + struct ethtool_value edata; + + if (!ethtool_ops->set_msglevel) + return -EOPNOTSUPP; + + if (copy_from_user(&edata, useraddr, sizeof(edata))) + return -EFAULT; + + ethtool_ops->set_msglevel(dev, edata.data); + return 0; +} + +static int ethtool_nway_reset(struct net_device *dev) +{ + if (!ethtool_ops->nway_reset) + return -EOPNOTSUPP; + + return ethtool_ops->nway_reset(dev); +} + +static int ethtool_get_link(struct net_device *dev, void *useraddr) +{ + struct ethtool_value edata = { ETHTOOL_GLINK }; + + if (!ethtool_ops->get_link) + return -EOPNOTSUPP; + + edata.data = ethtool_ops->get_link(dev); + + if (copy_to_user(useraddr, &edata, sizeof(edata))) + return -EFAULT; + return 0; +} + +static int ethtool_get_eeprom(struct net_device *dev, void *useraddr) +{ + struct ethtool_eeprom eeprom; + struct ethtool_ops *ops = ethtool_ops; + u8 *data; + int ret; + + if (!ops->get_eeprom || !ops->get_eeprom_len) + return -EOPNOTSUPP; + + if (copy_from_user(&eeprom, useraddr, sizeof(eeprom))) + return -EFAULT; + + /* Check for wrap and zero */ + if (eeprom.offset + eeprom.len <= eeprom.offset) + return -EINVAL; + + /* Check for exceeding total eeprom len */ + if (eeprom.offset + eeprom.len > ops->get_eeprom_len(dev)) + return -EINVAL; + + data = kmalloc(eeprom.len, GFP_USER); + if (!data) + return -ENOMEM; + + ret = -EFAULT; + if (copy_from_user(data, useraddr + sizeof(eeprom), eeprom.len)) + goto out; + + ret = ops->get_eeprom(dev, &eeprom, data); + if (ret) + goto out; + + ret = -EFAULT; + if (copy_to_user(useraddr, &eeprom, sizeof(eeprom))) + goto out; + if (copy_to_user(useraddr + sizeof(eeprom), data, eeprom.len)) + goto out; + ret = 0; + +out: + kfree(data); + return ret; +} + +static int ethtool_set_eeprom(struct net_device *dev, void *useraddr) +{ + struct ethtool_eeprom eeprom; + struct ethtool_ops *ops = ethtool_ops; + u8 *data; + int ret; + + if (!ops->set_eeprom || !ops->get_eeprom_len) + return -EOPNOTSUPP; + + if (copy_from_user(&eeprom, useraddr, sizeof(eeprom))) + return -EFAULT; + + /* Check for wrap and zero */ + if (eeprom.offset + eeprom.len <= eeprom.offset) + return -EINVAL; + + /* Check for exceeding total eeprom len */ + if (eeprom.offset + eeprom.len > ops->get_eeprom_len(dev)) + return -EINVAL; + + data = kmalloc(eeprom.len, GFP_USER); + if (!data) + return -ENOMEM; + + ret = -EFAULT; + if (copy_from_user(data, useraddr + sizeof(eeprom), eeprom.len)) + goto out; + + ret = ops->set_eeprom(dev, &eeprom, data); + if (ret) + goto out; + + if (copy_to_user(useraddr + sizeof(eeprom), data, eeprom.len)) + ret = -EFAULT; + +out: + kfree(data); + return ret; +} + +static int ethtool_get_coalesce(struct net_device *dev, void *useraddr) +{ + struct ethtool_coalesce coalesce = { ETHTOOL_GCOALESCE }; + + if (!ethtool_ops->get_coalesce) + return -EOPNOTSUPP; + + ethtool_ops->get_coalesce(dev, &coalesce); + + if (copy_to_user(useraddr, &coalesce, sizeof(coalesce))) + return -EFAULT; + return 0; +} + +static int ethtool_set_coalesce(struct net_device *dev, void *useraddr) +{ + struct ethtool_coalesce coalesce; + + if (!ethtool_ops->get_coalesce) + return -EOPNOTSUPP; + + if (copy_from_user(&coalesce, useraddr, sizeof(coalesce))) + return -EFAULT; + + return ethtool_ops->set_coalesce(dev, &coalesce); +} + +static int ethtool_get_ringparam(struct net_device *dev, void *useraddr) +{ + struct ethtool_ringparam ringparam = { ETHTOOL_GRINGPARAM }; + + if (!ethtool_ops->get_ringparam) + return -EOPNOTSUPP; + + ethtool_ops->get_ringparam(dev, &ringparam); + + if (copy_to_user(useraddr, &ringparam, sizeof(ringparam))) + return -EFAULT; + return 0; +} + +static int ethtool_set_ringparam(struct net_device *dev, void *useraddr) +{ + struct ethtool_ringparam ringparam; + + if (!ethtool_ops->get_ringparam) + return -EOPNOTSUPP; + + if (copy_from_user(&ringparam, useraddr, sizeof(ringparam))) + return -EFAULT; + + return ethtool_ops->set_ringparam(dev, &ringparam); +} + +static int ethtool_get_pauseparam(struct net_device *dev, void *useraddr) +{ + struct ethtool_pauseparam pauseparam = { ETHTOOL_GPAUSEPARAM }; + + if (!ethtool_ops->get_pauseparam) + return -EOPNOTSUPP; + + ethtool_ops->get_pauseparam(dev, &pauseparam); + + if (copy_to_user(useraddr, &pauseparam, sizeof(pauseparam))) + return -EFAULT; + return 0; +} + +static int ethtool_set_pauseparam(struct net_device *dev, void *useraddr) +{ + struct ethtool_pauseparam pauseparam; + + if (!ethtool_ops->get_pauseparam) + return -EOPNOTSUPP; + + if (copy_from_user(&pauseparam, useraddr, sizeof(pauseparam))) + return -EFAULT; + + return ethtool_ops->set_pauseparam(dev, &pauseparam); +} + +static int ethtool_get_rx_csum(struct net_device *dev, char *useraddr) +{ + struct ethtool_value edata = { ETHTOOL_GRXCSUM }; + + if (!ethtool_ops->get_rx_csum) + return -EOPNOTSUPP; + + edata.data = ethtool_ops->get_rx_csum(dev); + + if (copy_to_user(useraddr, &edata, sizeof(edata))) + return -EFAULT; + return 0; +} + +static int ethtool_set_rx_csum(struct net_device *dev, char *useraddr) +{ + struct ethtool_value edata; + + if (!ethtool_ops->set_rx_csum) + return -EOPNOTSUPP; + + if (copy_from_user(&edata, useraddr, sizeof(edata))) + return -EFAULT; + + ethtool_ops->set_rx_csum(dev, edata.data); + return 0; +} + +static int ethtool_get_tx_csum(struct net_device *dev, char *useraddr) +{ + struct ethtool_value edata = { ETHTOOL_GTXCSUM }; + + if (!ethtool_ops->get_tx_csum) + return -EOPNOTSUPP; + + edata.data = ethtool_ops->get_tx_csum(dev); + + if (copy_to_user(useraddr, &edata, sizeof(edata))) + return -EFAULT; + return 0; +} + +static int ethtool_set_tx_csum(struct net_device *dev, char *useraddr) +{ + struct ethtool_value edata; + + if (!ethtool_ops->set_tx_csum) + return -EOPNOTSUPP; + + if (copy_from_user(&edata, useraddr, sizeof(edata))) + return -EFAULT; + + return ethtool_ops->set_tx_csum(dev, edata.data); +} + +static int ethtool_get_sg(struct net_device *dev, char *useraddr) +{ + struct ethtool_value edata = { ETHTOOL_GSG }; + + if (!ethtool_ops->get_sg) + return -EOPNOTSUPP; + + edata.data = ethtool_ops->get_sg(dev); + + if (copy_to_user(useraddr, &edata, sizeof(edata))) + return -EFAULT; + return 0; +} + +static int ethtool_set_sg(struct net_device *dev, char *useraddr) +{ + struct ethtool_value edata; + + if (!ethtool_ops->set_sg) + return -EOPNOTSUPP; + + if (copy_from_user(&edata, useraddr, sizeof(edata))) + return -EFAULT; + + return ethtool_ops->set_sg(dev, edata.data); +} + +static int ethtool_get_tso(struct net_device *dev, char *useraddr) +{ + struct ethtool_value edata = { ETHTOOL_GTSO }; + + if (!ethtool_ops->get_tso) + return -EOPNOTSUPP; + + edata.data = ethtool_ops->get_tso(dev); + + if (copy_to_user(useraddr, &edata, sizeof(edata))) + return -EFAULT; + return 0; +} + +static int ethtool_set_tso(struct net_device *dev, char *useraddr) +{ + struct ethtool_value edata; + + if (!ethtool_ops->set_tso) + return -EOPNOTSUPP; + + if (copy_from_user(&edata, useraddr, sizeof(edata))) + return -EFAULT; + + return ethtool_ops->set_tso(dev, edata.data); +} + +static int ethtool_self_test(struct net_device *dev, char *useraddr) +{ + struct ethtool_test test; + struct ethtool_ops *ops = ethtool_ops; + u64 *data; + int ret; + + if (!ops->self_test || !ops->self_test_count) + return -EOPNOTSUPP; + + if (copy_from_user(&test, useraddr, sizeof(test))) + return -EFAULT; + + test.len = ops->self_test_count(dev); + data = kmalloc(test.len * sizeof(u64), GFP_USER); + if (!data) + return -ENOMEM; + + ops->self_test(dev, &test, data); + + ret = -EFAULT; + if (copy_to_user(useraddr, &test, sizeof(test))) + goto out; + useraddr += sizeof(test); + if (copy_to_user(useraddr, data, test.len * sizeof(u64))) + goto out; + ret = 0; + +out: + kfree(data); + return ret; +} + +static int ethtool_get_strings(struct net_device *dev, void *useraddr) +{ + struct ethtool_gstrings gstrings; + struct ethtool_ops *ops = ethtool_ops; + u8 *data; + int ret; + + if (!ops->get_strings) + return -EOPNOTSUPP; + + if (copy_from_user(&gstrings, useraddr, sizeof(gstrings))) + return -EFAULT; + + switch (gstrings.string_set) { + case ETH_SS_TEST: + if (!ops->self_test_count) + return -EOPNOTSUPP; + gstrings.len = ops->self_test_count(dev); + break; + case ETH_SS_STATS: + if (!ops->get_stats_count) + return -EOPNOTSUPP; + gstrings.len = ops->get_stats_count(dev); + break; + default: + return -EINVAL; + } + + data = kmalloc(gstrings.len * ETH_GSTRING_LEN, GFP_USER); + if (!data) + return -ENOMEM; + + ops->get_strings(dev, gstrings.string_set, data); + + ret = -EFAULT; + if (copy_to_user(useraddr, &gstrings, sizeof(gstrings))) + goto out; + useraddr += sizeof(gstrings); + if (copy_to_user(useraddr, data, gstrings.len * ETH_GSTRING_LEN)) + goto out; + ret = 0; + +out: + kfree(data); + return ret; +} + +static int ethtool_phys_id(struct net_device *dev, void *useraddr) +{ + struct ethtool_value id; + + if (!ethtool_ops->phys_id) + return -EOPNOTSUPP; + + if (copy_from_user(&id, useraddr, sizeof(id))) + return -EFAULT; + + return ethtool_ops->phys_id(dev, id.data); +} + +static int ethtool_get_stats(struct net_device *dev, void *useraddr) +{ + struct ethtool_stats stats; + struct ethtool_ops *ops = ethtool_ops; + u64 *data; + int ret; + + if (!ops->get_ethtool_stats || !ops->get_stats_count) + return -EOPNOTSUPP; + + if (copy_from_user(&stats, useraddr, sizeof(stats))) + return -EFAULT; + + stats.n_stats = ops->get_stats_count(dev); + data = kmalloc(stats.n_stats * sizeof(u64), GFP_USER); + if (!data) + return -ENOMEM; + + ops->get_ethtool_stats(dev, &stats, data); + + ret = -EFAULT; + if (copy_to_user(useraddr, &stats, sizeof(stats))) + goto out; + useraddr += sizeof(stats); + if (copy_to_user(useraddr, data, stats.n_stats * sizeof(u64))) + goto out; + ret = 0; + +out: + kfree(data); + return ret; +} + +static int ethtool_ioctl(struct ifreq *ifr) +{ + struct net_device *dev = __dev_get_by_name(ifr->ifr_name); + void *useraddr = (void *) ifr->ifr_data; + u32 ethcmd; + + /* + * XXX: This can be pushed down into the ethtool_* handlers that + * need it. Keep existing behaviour for the moment. + */ + if (!capable(CAP_NET_ADMIN)) + return -EPERM; + + if (!dev || !netif_device_present(dev)) + return -ENODEV; + + if (copy_from_user(ðcmd, useraddr, sizeof (ethcmd))) + return -EFAULT; + + switch (ethcmd) { + case ETHTOOL_GSET: + return ethtool_get_settings(dev, useraddr); + case ETHTOOL_SSET: + return ethtool_set_settings(dev, useraddr); + case ETHTOOL_GDRVINFO: + return ethtool_get_drvinfo(dev, useraddr); + case ETHTOOL_GREGS: + return ethtool_get_regs(dev, useraddr); + case ETHTOOL_GWOL: + return ethtool_get_wol(dev, useraddr); + case ETHTOOL_SWOL: + return ethtool_set_wol(dev, useraddr); + case ETHTOOL_GMSGLVL: + return ethtool_get_msglevel(dev, useraddr); + case ETHTOOL_SMSGLVL: + return ethtool_set_msglevel(dev, useraddr); + case ETHTOOL_NWAY_RST: + return ethtool_nway_reset(dev); + case ETHTOOL_GLINK: + return ethtool_get_link(dev, useraddr); + case ETHTOOL_GEEPROM: + return ethtool_get_eeprom(dev, useraddr); + case ETHTOOL_SEEPROM: + return ethtool_set_eeprom(dev, useraddr); + case ETHTOOL_GCOALESCE: + return ethtool_get_coalesce(dev, useraddr); + case ETHTOOL_SCOALESCE: + return ethtool_set_coalesce(dev, useraddr); + case ETHTOOL_GRINGPARAM: + return ethtool_get_ringparam(dev, useraddr); + case ETHTOOL_SRINGPARAM: + return ethtool_set_ringparam(dev, useraddr); + case ETHTOOL_GPAUSEPARAM: + return ethtool_get_pauseparam(dev, useraddr); + case ETHTOOL_SPAUSEPARAM: + return ethtool_set_pauseparam(dev, useraddr); + case ETHTOOL_GRXCSUM: + return ethtool_get_rx_csum(dev, useraddr); + case ETHTOOL_SRXCSUM: + return ethtool_set_rx_csum(dev, useraddr); + case ETHTOOL_GTXCSUM: + return ethtool_get_tx_csum(dev, useraddr); + case ETHTOOL_STXCSUM: + return ethtool_set_tx_csum(dev, useraddr); + case ETHTOOL_GSG: + return ethtool_get_sg(dev, useraddr); + case ETHTOOL_SSG: + return ethtool_set_sg(dev, useraddr); + case ETHTOOL_GTSO: + return ethtool_get_tso(dev, useraddr); + case ETHTOOL_STSO: + return ethtool_set_tso(dev, useraddr); + case ETHTOOL_TEST: + return ethtool_self_test(dev, useraddr); + case ETHTOOL_GSTRINGS: + return ethtool_get_strings(dev, useraddr); + case ETHTOOL_PHYS_ID: + return ethtool_phys_id(dev, useraddr); + case ETHTOOL_GSTATS: + return ethtool_get_stats(dev, useraddr); + default: + return -EOPNOTSUPP; + } + + return -EOPNOTSUPP; +} +#endif //ETHTOOL_OPS_COMPAT + +static int +rtl8168_do_ioctl(struct net_device *dev, + struct ifreq *ifr, + int cmd) +{ + struct rtl8168_private *tp = netdev_priv(dev); + struct mii_ioctl_data *data = if_mii(ifr); + int ret; + unsigned long flags; + + ret = 0; + switch (cmd) { + case SIOCGMIIPHY: + data->phy_id = 32; /* Internal PHY */ + break; + + case SIOCGMIIREG: + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0000); + data->val_out = mdio_read(tp, data->reg_num); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + + case SIOCSMIIREG: + if (!capable(CAP_NET_ADMIN)) + return -EPERM; + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0000); + mdio_write(tp, data->reg_num, data->val_in); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + +#ifdef ETHTOOL_OPS_COMPAT + case SIOCETHTOOL: + ret = ethtool_ioctl(ifr); + break; +#endif + case SIOCDEVPRIVATE_RTLASF: + if (!netif_running(dev)) { + ret = -ENODEV; + break; + } + + ret = rtl8168_asf_ioctl(dev, ifr); + break; + +#ifdef ENABLE_DASH_SUPPORT + case SIOCDEVPRIVATE_RTLDASH: + if (!netif_running(dev)) { + ret = -ENODEV; + break; + } + + ret = rtl8168_dash_ioctl(dev, ifr); + break; +#endif + +#ifdef ENABLE_REALWOW_SUPPORT + case SIOCDEVPRIVATE_RTLREALWOW: + if (!netif_running(dev)) { + ret = -ENODEV; + break; + } + + ret = rtl8168_realwow_ioctl(dev, ifr); + break; +#endif + + case SIOCRTLTOOL: + ret = rtltool_ioctl(tp, ifr); + break; + + default: + ret = -EOPNOTSUPP; + break; + } + + return ret; +} + +static void +rtl8168_phy_power_up(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + u32 csi_tmp; + unsigned long flags; + + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0000); + switch (tp->mcfg) { + case CFG_METHOD_1: + case CFG_METHOD_2: + case CFG_METHOD_3: + case CFG_METHOD_4: + case CFG_METHOD_5: + case CFG_METHOD_6: + case CFG_METHOD_7: + case CFG_METHOD_8: + case CFG_METHOD_9: + case CFG_METHOD_10: + case CFG_METHOD_11: + case CFG_METHOD_12: + case CFG_METHOD_13: + mdio_write(tp, 0x0E, 0x0000); + break; + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + csi_tmp = rtl8168_eri_read(ioaddr, 0x1AB, 1, ERIAR_ExGMAC); + csi_tmp |= ( BIT_2 | BIT_3 | BIT_4 | BIT_5 | BIT_6 | BIT_7 ); + rtl8168_eri_write(ioaddr, 0x1AB, 1, csi_tmp, ERIAR_ExGMAC); + break; + default: + break; + } + mdio_write(tp, MII_BMCR, BMCR_ANENABLE); + + //wait mdc/mdio ready + switch (tp->mcfg) { + case CFG_METHOD_23: + case CFG_METHOD_27: + case CFG_METHOD_28: + mdelay(10); + break; + } + + //wait ups resume (phy state 3) + switch (tp->mcfg) { + case CFG_METHOD_29: + case CFG_METHOD_30: + rtl8168_wait_phy_ups_resume(dev, 3); + break; + }; + spin_unlock_irqrestore(&tp->phy_lock, flags); +} + +static void +rtl8168_phy_power_down(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + u32 csi_tmp; + unsigned long flags; + + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0000); + switch (tp->mcfg) { + case CFG_METHOD_1: + case CFG_METHOD_2: + case CFG_METHOD_3: + case CFG_METHOD_4: + case CFG_METHOD_5: + case CFG_METHOD_6: + case CFG_METHOD_7: + case CFG_METHOD_8: + case CFG_METHOD_9: + case CFG_METHOD_10: + case CFG_METHOD_11: + case CFG_METHOD_12: + case CFG_METHOD_13: + mdio_write(tp, 0x0E, 0x0200); + mdio_write(tp, MII_BMCR, BMCR_PDOWN); + break; + case CFG_METHOD_14: + case CFG_METHOD_15: + case CFG_METHOD_29: + case CFG_METHOD_30: + mdio_write(tp, MII_BMCR, BMCR_ANENABLE | BMCR_PDOWN); + break; + case CFG_METHOD_21: + case CFG_METHOD_22: + mdio_write(tp, MII_BMCR, BMCR_ANENABLE | BMCR_PDOWN); + + csi_tmp = rtl8168_eri_read(ioaddr, 0x1AB, 1, ERIAR_ExGMAC); + csi_tmp &= ~( BIT_2 | BIT_3 | BIT_4 | BIT_5 | BIT_6 | BIT_7 ); + rtl8168_eri_write(ioaddr, 0x1AB, 1, csi_tmp, ERIAR_ExGMAC); + + RTL_W8(0xD0, RTL_R8(0xD0) & ~BIT_6); + break; + case CFG_METHOD_23: + case CFG_METHOD_24: + mdio_write(tp, MII_BMCR, BMCR_ANENABLE | BMCR_PDOWN); + + csi_tmp = rtl8168_eri_read(ioaddr, 0x1AB, 1, ERIAR_ExGMAC); + csi_tmp &= ~( BIT_2 | BIT_3 | BIT_4 | BIT_5 | BIT_6 | BIT_7 ); + rtl8168_eri_write(ioaddr, 0x1AB, 1, csi_tmp, ERIAR_ExGMAC); + break; + default: + mdio_write(tp, MII_BMCR, BMCR_PDOWN); + break; + } + spin_unlock_irqrestore(&tp->phy_lock, flags); +} + +static int __devinit +rtl8168_init_board(struct pci_dev *pdev, + struct net_device **dev_out, + void __iomem **ioaddr_out) +{ + void __iomem *ioaddr; + struct net_device *dev; + struct rtl8168_private *tp; + int rc = -ENOMEM, i, pm_cap; + + assert(ioaddr_out != NULL); + + /* dev zeroed in alloc_etherdev */ + dev = alloc_etherdev(sizeof (*tp)); + if (dev == NULL) { +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + if (netif_msg_drv(&debug)) + dev_err(&pdev->dev, "unable to alloc new ethernet\n"); +#endif //LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + goto err_out; + } + + SET_MODULE_OWNER(dev); + SET_NETDEV_DEV(dev, &pdev->dev); + tp = netdev_priv(dev); + tp->dev = dev; + tp->msg_enable = netif_msg_init(debug.msg_enable, R8168_MSG_DEFAULT); + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,26) + if (!aspm) + pci_disable_link_state(pdev, PCIE_LINK_STATE_L0S | PCIE_LINK_STATE_L1 | + PCIE_LINK_STATE_CLKPM); +#endif + + /* enable device (incl. PCI PM wakeup and hotplug setup) */ + rc = pci_enable_device(pdev); + if (rc < 0) { +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + if (netif_msg_probe(tp)) + dev_err(&pdev->dev, "enable failure\n"); +#endif //LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + goto err_out_free_dev; + } + + rc = pci_set_mwi(pdev); + if (rc < 0) + goto err_out_disable; + + /* save power state before pci_enable_device overwrites it */ + pm_cap = pci_find_capability(pdev, PCI_CAP_ID_PM); + if (pm_cap) { + u16 pwr_command; + + pci_read_config_word(pdev, pm_cap + PCI_PM_CTRL, &pwr_command); + } else { +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + if (netif_msg_probe(tp)) { + dev_err(&pdev->dev, "PowerManagement capability not found.\n"); + } +#else + printk("PowerManagement capability not found.\n"); +#endif //LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + + } + + /* make sure PCI base addr 1 is MMIO */ + if (!(pci_resource_flags(pdev, 2) & IORESOURCE_MEM)) { +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + if (netif_msg_probe(tp)) + dev_err(&pdev->dev, "region #1 not an MMIO resource, aborting\n"); +#endif //LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + rc = -ENODEV; + goto err_out_mwi; + } + /* check for weird/broken PCI region reporting */ + if (pci_resource_len(pdev, 2) < R8168_REGS_SIZE) { +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + if (netif_msg_probe(tp)) + dev_err(&pdev->dev, "Invalid PCI region size(s), aborting\n"); +#endif //LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + rc = -ENODEV; + goto err_out_mwi; + } + + rc = pci_request_regions(pdev, MODULENAME); + if (rc < 0) { +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + if (netif_msg_probe(tp)) + dev_err(&pdev->dev, "could not request regions.\n"); +#endif //LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + goto err_out_mwi; + } + + if ((sizeof(dma_addr_t) > 4) && + !pci_set_dma_mask(pdev, DMA_BIT_MASK(64))) { + dev->features |= NETIF_F_HIGHDMA; + } else { + rc = pci_set_dma_mask(pdev, DMA_BIT_MASK(32)); + if (rc < 0) { +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + if (netif_msg_probe(tp)) + dev_err(&pdev->dev, "DMA configuration failed.\n"); +#endif //LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + goto err_out_free_res; + } + } + + pci_set_master(pdev); + + /* ioremap MMIO region */ + ioaddr = ioremap(pci_resource_start(pdev, 2), R8168_REGS_SIZE); + if (ioaddr == NULL) { +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + if (netif_msg_probe(tp)) + dev_err(&pdev->dev, "cannot remap MMIO, aborting\n"); +#endif //LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + rc = -EIO; + goto err_out_free_res; + } + + /* Identify chip attached to board */ + rtl8168_get_mac_version(tp, ioaddr); + + rtl8168_print_mac_version(tp); + + for (i = ARRAY_SIZE(rtl_chip_info) - 1; i >= 0; i--) { + if (tp->mcfg == rtl_chip_info[i].mcfg) + break; + } + + if (i < 0) { + /* Unknown chip: assume array element #0, original RTL-8168 */ +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + if (netif_msg_probe(tp)) + dev_printk(KERN_DEBUG, &pdev->dev, "unknown chip version, assuming %s\n", rtl_chip_info[0].name); +#else + printk("Realtek unknown chip version, assuming %s\n", rtl_chip_info[0].name); +#endif //LINUX_VERSION_CODE < KERNEL_VERSION(2,6,0) + i++; + } + + tp->chipset = i; + + *ioaddr_out = ioaddr; + *dev_out = dev; +out: + return rc; + +err_out_free_res: + pci_release_regions(pdev); + +err_out_mwi: + pci_clear_mwi(pdev); + +err_out_disable: + pci_disable_device(pdev); + +err_out_free_dev: + free_netdev(dev); +err_out: + *ioaddr_out = NULL; + *dev_out = NULL; + goto out; +} + +#define PCI_DEVICE_SERIAL_NUMBER (0x0164) + +static void +rtl8168_esd_timer(unsigned long __opaque) +{ + struct net_device *dev = (struct net_device *)__opaque; + struct rtl8168_private *tp = netdev_priv(dev); + struct pci_dev *pdev = tp->pci_dev; + struct timer_list *timer = &tp->esd_timer; + unsigned long timeout = RTL8168_ESD_TIMEOUT; + unsigned long flags; + u8 cmd; + u16 io_base_l; + u16 mem_base_l; + u16 mem_base_h; + u8 ilr; + u16 resv_0x1c_h; + u16 resv_0x1c_l; + u16 resv_0x20_l; + u16 resv_0x20_h; + u16 resv_0x24_l; + u16 resv_0x24_h; + u16 resv_0x2c_h; + u16 resv_0x2c_l; + u32 pci_sn_l; + u32 pci_sn_h; + + spin_lock_irqsave(&tp->lock, flags); + + tp->esd_flag = 0; + + pci_read_config_byte(pdev, PCI_COMMAND, &cmd); + if (cmd != tp->pci_cfg_space.cmd) { + pci_write_config_byte(pdev, PCI_COMMAND, tp->pci_cfg_space.cmd); + tp->esd_flag |= BIT_0; + } + + pci_read_config_word(pdev, PCI_BASE_ADDRESS_0, &io_base_l); + if (io_base_l != tp->pci_cfg_space.io_base_l) { + pci_write_config_word(pdev, PCI_BASE_ADDRESS_0, tp->pci_cfg_space.io_base_l); + tp->esd_flag |= BIT_1; + } + + pci_read_config_word(pdev, PCI_BASE_ADDRESS_2, &mem_base_l); + if (mem_base_l != tp->pci_cfg_space.mem_base_l) { + pci_write_config_word(pdev, PCI_BASE_ADDRESS_2, tp->pci_cfg_space.mem_base_l); + tp->esd_flag |= BIT_2; + } + + pci_read_config_word(pdev, PCI_BASE_ADDRESS_2 + 2, &mem_base_h); + if (mem_base_h!= tp->pci_cfg_space.mem_base_h) { + pci_write_config_word(pdev, PCI_BASE_ADDRESS_2 + 2, tp->pci_cfg_space.mem_base_h); + tp->esd_flag |= BIT_3; + } + + pci_read_config_word(pdev, PCI_BASE_ADDRESS_3, &resv_0x1c_l); + if (resv_0x1c_l != tp->pci_cfg_space.resv_0x1c_l) { + pci_write_config_word(pdev, PCI_BASE_ADDRESS_3, tp->pci_cfg_space.resv_0x1c_l); + tp->esd_flag |= BIT_4; + } + + pci_read_config_word(pdev, PCI_BASE_ADDRESS_3 + 2, &resv_0x1c_h); + if (resv_0x1c_h != tp->pci_cfg_space.resv_0x1c_h) { + pci_write_config_word(pdev, PCI_BASE_ADDRESS_3 + 2, tp->pci_cfg_space.resv_0x1c_h); + tp->esd_flag |= BIT_5; + } + + pci_read_config_word(pdev, PCI_BASE_ADDRESS_4, &resv_0x20_l); + if (resv_0x20_l != tp->pci_cfg_space.resv_0x20_l) { + pci_write_config_word(pdev, PCI_BASE_ADDRESS_4, tp->pci_cfg_space.resv_0x20_l); + tp->esd_flag |= BIT_6; + } + + pci_read_config_word(pdev, PCI_BASE_ADDRESS_4 + 2, &resv_0x20_h); + if (resv_0x20_h != tp->pci_cfg_space.resv_0x20_h) { + pci_write_config_word(pdev, PCI_BASE_ADDRESS_4 + 2, tp->pci_cfg_space.resv_0x20_h); + tp->esd_flag |= BIT_7; + } + + pci_read_config_word(pdev, PCI_BASE_ADDRESS_5, &resv_0x24_l); + if (resv_0x24_l != tp->pci_cfg_space.resv_0x24_l) { + pci_write_config_word(pdev, PCI_BASE_ADDRESS_5, tp->pci_cfg_space.resv_0x24_l); + tp->esd_flag |= BIT_8; + } + + pci_read_config_word(pdev, PCI_BASE_ADDRESS_5 + 2, &resv_0x24_h); + if (resv_0x24_h != tp->pci_cfg_space.resv_0x24_h) { + pci_write_config_word(pdev, PCI_BASE_ADDRESS_5 + 2, tp->pci_cfg_space.resv_0x24_h); + tp->esd_flag |= BIT_9; + } + + pci_read_config_byte(pdev, PCI_INTERRUPT_LINE, &ilr); + if (ilr != tp->pci_cfg_space.ilr) { + pci_write_config_byte(pdev, PCI_INTERRUPT_LINE, tp->pci_cfg_space.ilr); + tp->esd_flag |= BIT_10; + } + + pci_read_config_word(pdev, PCI_SUBSYSTEM_VENDOR_ID, &resv_0x2c_l); + if (resv_0x2c_l != tp->pci_cfg_space.resv_0x2c_l) { + pci_write_config_word(pdev, PCI_SUBSYSTEM_VENDOR_ID, tp->pci_cfg_space.resv_0x2c_l); + tp->esd_flag |= BIT_11; + } + + pci_read_config_word(pdev, PCI_SUBSYSTEM_VENDOR_ID + 2, &resv_0x2c_h); + if (resv_0x2c_h != tp->pci_cfg_space.resv_0x2c_h) { + pci_write_config_word(pdev, PCI_SUBSYSTEM_VENDOR_ID + 2, tp->pci_cfg_space.resv_0x2c_h); + tp->esd_flag |= BIT_12; + } + + pci_sn_l = rtl8168_csi_read(tp, PCI_DEVICE_SERIAL_NUMBER); + if (pci_sn_l != tp->pci_cfg_space.pci_sn_l) { + rtl8168_csi_write(tp, PCI_DEVICE_SERIAL_NUMBER, tp->pci_cfg_space.pci_sn_l); + tp->esd_flag |= BIT_13; + } + + pci_sn_h = rtl8168_csi_read(tp, PCI_DEVICE_SERIAL_NUMBER + 4); + if (pci_sn_h != tp->pci_cfg_space.pci_sn_h) { + rtl8168_csi_write(tp, PCI_DEVICE_SERIAL_NUMBER + 4, tp->pci_cfg_space.pci_sn_h); + tp->esd_flag |= BIT_14; + } + + if (tp->esd_flag != 0) { + netif_stop_queue(dev); + netif_carrier_off(dev); + rtl8168_hw_reset(dev); + rtl8168_tx_clear(tp); + rtl8168_rx_clear(tp); + rtl8168_init_ring(dev); + rtl8168_hw_init(dev); + rtl8168_powerup_pll(dev); + rtl8168_hw_ephy_config(dev); + rtl8168_hw_phy_config(dev); + rtl8168_hw_config(dev); + rtl8168_set_speed(dev, tp->autoneg, tp->speed, tp->duplex); + tp->esd_flag = 0; + } + spin_unlock_irqrestore(&tp->lock, flags); + + mod_timer(timer, jiffies + timeout); +} + +static void +rtl8168_link_timer(unsigned long __opaque) +{ + struct net_device *dev = (struct net_device *)__opaque; + struct rtl8168_private *tp = netdev_priv(dev); + struct timer_list *timer = &tp->link_timer; + unsigned long flags; + + spin_lock_irqsave(&tp->lock, flags); + rtl8168_check_link_status(dev); + spin_unlock_irqrestore(&tp->lock, flags); + + mod_timer(timer, jiffies + RTL8168_LINK_TIMEOUT); +} + +/* Cfg9346_Unlock assumed. */ +static unsigned rtl8168_try_msi(struct pci_dev *pdev, struct rtl8168_private *tp) +{ + unsigned msi = 0; + +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,13) + if (pci_enable_msi(pdev)) + dev_info(&pdev->dev, "no MSI. Back to INTx.\n"); + else + msi |= RTL_FEATURE_MSI; +#endif + + switch (tp->mcfg) { + case CFG_METHOD_1: + case CFG_METHOD_2: + case CFG_METHOD_3: + case CFG_METHOD_4: + case CFG_METHOD_5: + case CFG_METHOD_6: + case CFG_METHOD_7: + case CFG_METHOD_8: + msi &= ~RTL_FEATURE_MSI; + break; + } + + return msi; +} + +static void rtl8168_disable_msi(struct pci_dev *pdev, struct rtl8168_private *tp) +{ + if (tp->features & RTL_FEATURE_MSI) { +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,13) + pci_disable_msi(pdev); +#endif + tp->features &= ~RTL_FEATURE_MSI; + } +} + +#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,29) +static const struct net_device_ops rtl8168_netdev_ops = { + .ndo_open = rtl8168_open, + .ndo_stop = rtl8168_close, + .ndo_get_stats = rtl8168_get_stats, + .ndo_start_xmit = rtl8168_start_xmit, + .ndo_tx_timeout = rtl8168_tx_timeout, + .ndo_change_mtu = rtl8168_change_mtu, + .ndo_set_mac_address = rtl8168_set_mac_address, + .ndo_do_ioctl = rtl8168_do_ioctl, +#if LINUX_VERSION_CODE < KERNEL_VERSION(3,1,0) + .ndo_set_multicast_list = rtl8168_set_rx_mode, +#else + .ndo_set_rx_mode = rtl8168_set_rx_mode, +#endif +#if LINUX_VERSION_CODE < KERNEL_VERSION(3,0,0) +#ifdef CONFIG_R8168_VLAN + .ndo_vlan_rx_register = rtl8168_vlan_rx_register, +#endif +#else + .ndo_fix_features = rtl8168_fix_features, + .ndo_set_features = rtl8168_set_features, +#endif +#ifdef CONFIG_NET_POLL_CONTROLLER + .ndo_poll_controller = rtl8168_netpoll, +#endif +}; +#endif + +static int __devinit +rtl8168_init_one(struct pci_dev *pdev, + const struct pci_device_id *ent) +{ + struct net_device *dev = NULL; + struct rtl8168_private *tp; + void __iomem *ioaddr = NULL; + static int board_idx = -1; + + int rc; + + assert(pdev != NULL); + assert(ent != NULL); + + board_idx++; + + if (netif_msg_drv(&debug)) + printk(KERN_INFO "%s Gigabit Ethernet driver %s loaded\n", + MODULENAME, RTL8168_VERSION); + + rc = rtl8168_init_board(pdev, &dev, &ioaddr); + if (rc) + return rc; + + tp = netdev_priv(dev); + assert(ioaddr != NULL); + + tp->mmio_addr = ioaddr; + tp->set_speed = rtl8168_set_speed_xmii; + tp->get_settings = rtl8168_gset_xmii; + tp->phy_reset_enable = rtl8168_xmii_reset_enable; + tp->phy_reset_pending = rtl8168_xmii_reset_pending; + tp->link_ok = rtl8168_xmii_link_ok; + + tp->features |= rtl8168_try_msi(pdev, tp); + + RTL_NET_DEVICE_OPS(rtl8168_netdev_ops); + + SET_ETHTOOL_OPS(dev, &rtl8168_ethtool_ops); + + dev->watchdog_timeo = RTL8168_TX_TIMEOUT; + dev->irq = pdev->irq; + dev->base_addr = (unsigned long) ioaddr; + +#ifdef CONFIG_R8168_NAPI + RTL_NAPI_CONFIG(dev, tp, rtl8168_poll, R8168_NAPI_WEIGHT); +#endif + +#ifdef CONFIG_R8168_VLAN + if (tp->mcfg != CFG_METHOD_DEFAULT) { + dev->features |= NETIF_F_HW_VLAN_TX | NETIF_F_HW_VLAN_RX; +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,22) + dev->vlan_rx_kill_vid = rtl8168_vlan_rx_kill_vid; +#endif //LINUX_VERSION_CODE < KERNEL_VERSION(2,6,22) + } +#endif + + tp->cp_cmd |= RTL_R16(CPlusCmd); + if (tp->mcfg != CFG_METHOD_DEFAULT) { + dev->features |= NETIF_F_IP_CSUM; +#if LINUX_VERSION_CODE < KERNEL_VERSION(3,0,0) + tp->cp_cmd |= RxChkSum; +#else + dev->features |= NETIF_F_RXCSUM | NETIF_F_SG; + dev->hw_features = NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_TSO | + NETIF_F_RXCSUM | NETIF_F_HW_VLAN_TX | NETIF_F_HW_VLAN_RX; + dev->vlan_features = NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_TSO | + NETIF_F_HIGHDMA; +#endif + } + + tp->pci_dev = pdev; + + spin_lock_init(&tp->lock); + + spin_lock_init(&tp->phy_lock); + + rtl8168_init_software_variable(dev); + +#ifdef ENABLE_DASH_SUPPORT + if(tp->DASH) + AllocateDashShareMemory(dev); +#endif + + rtl8168_exit_oob(dev); + + rtl8168_hw_init(dev); + + rtl8168_hw_reset(dev); + + /* Get production from EEPROM */ + if (((tp->mcfg == CFG_METHOD_21 || tp->mcfg == CFG_METHOD_22 || + tp->mcfg == CFG_METHOD_25 || tp->mcfg == CFG_METHOD_29 || + tp->mcfg == CFG_METHOD_30) && (mac_ocp_read(tp, 0xDC00) & BIT_3)) || + ((tp->mcfg == CFG_METHOD_26) && (mac_ocp_read(tp, 0xDC00) & BIT_4))) + tp->eeprom_type = EEPROM_TYPE_NONE; + else + rtl_eeprom_type(tp); + + if (tp->eeprom_type == EEPROM_TYPE_93C46 || tp->eeprom_type == EEPROM_TYPE_93C56) + rtl_set_eeprom_sel_low(ioaddr); + + rtl8168_get_mac_address(dev); + + pci_set_drvdata(pdev, dev); + + rc = register_netdev(dev); + if (rc) { +#ifdef CONFIG_R8168_NAPI + RTL_NAPI_DEL(tp); +#endif + rtl8168_release_board(pdev, dev, ioaddr); + return rc; + } + + printk(KERN_INFO "%s: This product is covered by one or more of the following patents: US6,570,884, US6,115,776, and US6,327,625.\n", MODULENAME); + + netif_carrier_off(dev); + + printk("%s", GPL_CLAIM); + + return 0; +} + +static void __devexit +rtl8168_remove_one(struct pci_dev *pdev) +{ + struct net_device *dev = pci_get_drvdata(pdev); + struct rtl8168_private *tp = netdev_priv(dev); + + assert(dev != NULL); + assert(tp != NULL); + +#ifdef CONFIG_R8168_NAPI + RTL_NAPI_DEL(tp); +#endif + + switch (tp->mcfg) { + case CFG_METHOD_11: + case CFG_METHOD_12: + case CFG_METHOD_13: + case CFG_METHOD_23: + case CFG_METHOD_27: + case CFG_METHOD_28: + if (tp->DASH) + rtl8168_driver_stop(tp); + break; + } + + unregister_netdev(dev); + rtl8168_disable_msi(pdev, tp); +#ifdef ENABLE_R8168_PROCFS + rtl8168_proc_remove(dev); +#endif + rtl8168_release_board(pdev, dev, tp->mmio_addr); + pci_set_drvdata(pdev, NULL); +} + +static void +rtl8168_set_rxbufsize(struct rtl8168_private *tp, + struct net_device *dev) +{ + unsigned int mtu = dev->mtu; + + tp->rx_buf_sz = (mtu > ETH_DATA_LEN) ? mtu + ETH_HLEN + 8 + 1 : RX_BUF_SIZE; +} + +static int rtl8168_open(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + struct pci_dev *pdev = tp->pci_dev; + int retval; + + retval = -ENOMEM; + +#ifdef ENABLE_R8168_PROCFS + rtl8168_proc_init(dev); +#endif + rtl8168_set_rxbufsize(tp, dev); + /* + * Rx and Tx descriptors needs 256 bytes alignment. + * pci_alloc_consistent provides more. + */ + tp->TxDescArray = pci_alloc_consistent(pdev, R8168_TX_RING_BYTES, + &tp->TxPhyAddr); + if (!tp->TxDescArray) + goto err_free_all_allocated_mem; + + tp->RxDescArray = pci_alloc_consistent(pdev, R8168_RX_RING_BYTES, + &tp->RxPhyAddr); + if (!tp->RxDescArray) + goto err_free_all_allocated_mem; + + tp->tally_vaddr = pci_alloc_consistent(pdev, sizeof(*tp->tally_vaddr), &tp->tally_paddr); + if (!tp->tally_vaddr) + goto err_free_all_allocated_mem; + + if (tp->UseSwPaddingShortPkt) { + tp->ShortPacketEmptyBuffer = pci_alloc_consistent(pdev, SHORT_PACKET_PADDING_BUF_SIZE, + &tp->ShortPacketEmptyBufferPhy); + if (!tp->ShortPacketEmptyBuffer) + goto err_free_all_allocated_mem; + + memset(tp->ShortPacketEmptyBuffer, 0x0, SHORT_PACKET_PADDING_BUF_SIZE); + } + + retval = rtl8168_init_ring(dev); + if (retval < 0) + goto err_free_all_allocated_mem; + + if (netif_msg_probe(tp)) { + printk(KERN_INFO "%s: 0x%lx, " + "%2.2x:%2.2x:%2.2x:%2.2x:%2.2x:%2.2x, " + "IRQ %d\n", + dev->name, + dev->base_addr, + dev->dev_addr[0], dev->dev_addr[1], + dev->dev_addr[2], dev->dev_addr[3], + dev->dev_addr[4], dev->dev_addr[5], dev->irq); + } + +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,20) + INIT_WORK(&tp->task, NULL, dev); +#else + INIT_DELAYED_WORK(&tp->task, NULL); +#endif + +#ifdef CONFIG_R8168_NAPI +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + RTL_NAPI_ENABLE(dev, &tp->napi); +#endif +#endif + + rtl8168_exit_oob(dev); + + rtl8168_tally_counter_clear(tp); + + rtl8168_hw_init(dev); + + rtl8168_hw_reset(dev); + + rtl8168_powerup_pll(dev); + + rtl8168_hw_ephy_config(dev); + + rtl8168_hw_phy_config(dev); + + rtl8168_hw_config(dev); + + rtl8168_dsm(dev, DSM_IF_UP); + + rtl8168_set_speed(dev, tp->autoneg, tp->speed, tp->duplex); + + retval = request_irq(dev->irq, rtl8168_interrupt, (tp->features & RTL_FEATURE_MSI) ? 0 : SA_SHIRQ, dev->name, dev); + if (retval<0) + goto err_free_all_allocated_mem; + + if (tp->esd_flag == 0) + rtl8168_request_esd_timer(dev); + + rtl8168_request_link_timer(dev); + +out: + + return retval; + +err_free_all_allocated_mem: + if (tp->tally_vaddr != NULL) { + pci_free_consistent(pdev, sizeof(*tp->tally_vaddr), tp->tally_vaddr, + tp->tally_paddr); + + tp->tally_vaddr = NULL; + } + + if (tp->RxDescArray != NULL) { + pci_free_consistent(pdev, R8168_RX_RING_BYTES, tp->RxDescArray, + tp->RxPhyAddr); + tp->RxDescArray = NULL; + } + + if (tp->TxDescArray != NULL) { + pci_free_consistent(pdev, R8168_TX_RING_BYTES, tp->TxDescArray, + tp->TxPhyAddr); + tp->TxDescArray = NULL; + } + + if (tp->ShortPacketEmptyBuffer != NULL) { + pci_free_consistent(pdev, ETH_ZLEN, tp->ShortPacketEmptyBuffer, + tp->ShortPacketEmptyBufferPhy); + tp->ShortPacketEmptyBuffer = NULL; + } + + goto out; +} + +static void +rtl8168_dsm(struct net_device *dev, int dev_state) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + + switch (dev_state) { + case DSM_MAC_INIT: + if ((tp->mcfg == CFG_METHOD_5) || (tp->mcfg == CFG_METHOD_6)) { + if (RTL_R8(MACDBG) & 0x80) + RTL_W8(GPIO, RTL_R8(GPIO) | GPIO_en); + else + RTL_W8(GPIO, RTL_R8(GPIO) & ~GPIO_en); + } + + break; + case DSM_NIC_GOTO_D3: + case DSM_IF_DOWN: + if ((tp->mcfg == CFG_METHOD_5) || (tp->mcfg == CFG_METHOD_6)) { + if (RTL_R8(MACDBG) & 0x80) + RTL_W8(GPIO, RTL_R8(GPIO) & ~GPIO_en); + } + break; + + case DSM_NIC_RESUME_D3: + case DSM_IF_UP: + if ((tp->mcfg == CFG_METHOD_5) || (tp->mcfg == CFG_METHOD_6)) { + if (RTL_R8(MACDBG) & 0x80) + RTL_W8(GPIO, RTL_R8(GPIO) | GPIO_en); + } + + break; + } + +} +static void +set_offset70F(struct rtl8168_private *tp, u8 setting) +{ + + u32 csi_tmp; + u32 temp = (u32)setting; + temp = temp << 24; + /*set PCI configuration space offset 0x70F to setting*/ + /*When the register offset of PCI configuration space larger than 0xff, use CSI to access it.*/ + + csi_tmp = rtl8168_csi_read(tp, 0x70c) & 0x00ffffff; + rtl8168_csi_write(tp, 0x70c, csi_tmp | temp); +} + +static void +set_offset79(struct rtl8168_private *tp, u8 setting) +{ + //Set PCI configuration space offset 0x79 to setting + + struct pci_dev *pdev = tp->pci_dev; + u8 device_control; + + pci_read_config_byte(pdev, 0x79, &device_control); + device_control &= ~0x70; + device_control |= setting; + pci_write_config_byte(pdev, 0x79, device_control); + +} + +static void +rtl8168_hw_set_rx_packet_filter(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + u32 mc_filter[2]; /* Multicast hash filter */ + int rx_mode; + u32 tmp = 0; + + if (dev->flags & IFF_PROMISC) { + /* Unconditionally log net taps. */ + if (netif_msg_link(tp)) + printk(KERN_NOTICE "%s: Promiscuous mode enabled.\n", + dev->name); + + rx_mode = + AcceptBroadcast | AcceptMulticast | AcceptMyPhys | + AcceptAllPhys; + mc_filter[1] = mc_filter[0] = 0xffffffff; + } else if ((netdev_mc_count(dev) > multicast_filter_limit) + || (dev->flags & IFF_ALLMULTI)) { + /* Too many to filter perfectly -- accept all multicasts. */ + rx_mode = AcceptBroadcast | AcceptMulticast | AcceptMyPhys; + mc_filter[1] = mc_filter[0] = 0xffffffff; + } else { +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,35) + struct dev_mc_list *mclist; + unsigned int i; + + rx_mode = AcceptBroadcast | AcceptMyPhys; + mc_filter[1] = mc_filter[0] = 0; + for (i = 0, mclist = dev->mc_list; mclist && i < dev->mc_count; + i++, mclist = mclist->next) { + int bit_nr = ether_crc(ETH_ALEN, mclist->dmi_addr) >> 26; + mc_filter[bit_nr >> 5] |= 1 << (bit_nr & 31); + rx_mode |= AcceptMulticast; + } +#else + struct netdev_hw_addr *ha; + + rx_mode = AcceptBroadcast | AcceptMyPhys; + mc_filter[1] = mc_filter[0] = 0; + netdev_for_each_mc_addr(ha, dev) { + int bit_nr = ether_crc(ETH_ALEN, ha->addr) >> 26; + mc_filter[bit_nr >> 5] |= 1 << (bit_nr & 31); + rx_mode |= AcceptMulticast; + } +#endif + } + + tmp = mc_filter[0]; + mc_filter[0] = swab32(mc_filter[1]); + mc_filter[1] = swab32(tmp); + + tp->rtl8168_rx_config = rtl_chip_info[tp->chipset].RCR_Cfg; + tmp = tp->rtl8168_rx_config | rx_mode | (RTL_R32(RxConfig) & rtl_chip_info[tp->chipset].RxConfigMask); + + RTL_W32(RxConfig, tmp); + RTL_W32(MAR0 + 0, mc_filter[0]); + RTL_W32(MAR0 + 4, mc_filter[1]); +} + +static void +rtl8168_set_rx_mode(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + unsigned long flags; + + spin_lock_irqsave(&tp->lock, flags); + + rtl8168_hw_set_rx_packet_filter(dev); + + spin_unlock_irqrestore(&tp->lock, flags); +} + +static void +rtl8168_hw_config(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + struct pci_dev *pdev = tp->pci_dev; + u8 device_control; + u16 mac_ocp_data; + u32 csi_tmp; + unsigned long flags; + + RTL_W32(RxConfig, (RX_DMA_BURST << RxCfgDMAShift)); + + rtl8168_hw_reset(dev); + + RTL_W8(Cfg9346, Cfg9346_Unlock); + switch (tp->mcfg) { + case CFG_METHOD_14: + case CFG_METHOD_15: + case CFG_METHOD_16: + case CFG_METHOD_17: + case CFG_METHOD_18: + case CFG_METHOD_19: + case CFG_METHOD_20: + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + RTL_W8(0xF1, RTL_R8(0xF1) & ~BIT_7); + RTL_W8(Config2, RTL_R8(Config2) & ~BIT_7); + RTL_W8(Config5, RTL_R8(Config5) & ~BIT_0); + break; + } + + //clear io_rdy_l23 + switch (tp->mcfg) { + case CFG_METHOD_20: + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + RTL_W8(Config3, RTL_R8(Config3) & ~BIT_1); + break; + } + + RTL_W8(MTPS, Reserved1_data); + + tp->cp_cmd |= INTT_1; + if (tp->use_timer_interrrupt) + tp->cp_cmd |= PktCntrDisable; + else + tp->cp_cmd &= ~PktCntrDisable; + + RTL_W16(IntrMitigate, 0x5f51); + + rtl8168_tally_counter_addr_fill(tp); + + rtl8168_desc_addr_fill(tp); + + /* Set DMA burst size and Interframe Gap Time */ + if (tp->mcfg == CFG_METHOD_1) + RTL_W32(TxConfig, (TX_DMA_BURST_512 << TxDMAShift) | + (InterFrameGap << TxInterFrameGapShift)); + else + RTL_W32(TxConfig, (TX_DMA_BURST_unlimited << TxDMAShift) | + (InterFrameGap << TxInterFrameGapShift)); + + if (tp->mcfg == CFG_METHOD_4) { + set_offset70F(tp, 0x27); + + RTL_W8(DBG_reg, (0x0E << 4) | Fix_Nak_1 | Fix_Nak_2); + + RTL_W8(Config3, RTL_R8(Config3) & ~Beacon_en); + + //disable clock request. + pci_write_config_byte(pdev, 0x81, 0x00); + + if (dev->mtu > ETH_DATA_LEN) { + RTL_W8(Config3, RTL_R8(Config3) | Jumbo_En0); + RTL_W8(Config4, RTL_R8(Config4) | Jumbo_En1); + + set_offset79(tp, 0x20); + + //tx checksum offload disable + dev->features &= ~NETIF_F_IP_CSUM; + + //rx checksum offload disable + } else { + RTL_W8(Config3, RTL_R8(Config3) & ~Jumbo_En0); + RTL_W8(Config4, RTL_R8(Config4) & ~Jumbo_En1); + + set_offset79(tp, 0x50); + + //tx checksum offload enable + dev->features |= NETIF_F_IP_CSUM; + } + + //rx checksum offload enable +#if LINUX_VERSION_CODE < KERNEL_VERSION(3,0,0) + tp->cp_cmd |= RxChkSum; +#else + dev->features |= NETIF_F_RXCSUM; +#endif + + tp->cp_cmd &= ~(EnableBist | Macdbgo_oe | Force_halfdup | + Force_rxflow_en | Force_txflow_en | Cxpl_dbg_sel | + ASF | PktCntrDisable | Macdbgo_sel); + } else if (tp->mcfg == CFG_METHOD_5) { + + set_offset70F(tp, 0x27); + + RTL_W8(Config3, RTL_R8(Config3) & ~Beacon_en); + + //disable clock request. + pci_write_config_byte(pdev, 0x81, 0x00); + + if (dev->mtu > ETH_DATA_LEN) { + RTL_W8(Config3, RTL_R8(Config3) | Jumbo_En0); + RTL_W8(Config4, RTL_R8(Config4) | Jumbo_En1); + + set_offset79(tp, 0x20); + + //tx checksum offload disable + dev->features &= ~NETIF_F_IP_CSUM; + } else { + RTL_W8(Config3, RTL_R8(Config3) & ~Jumbo_En0); + RTL_W8(Config4, RTL_R8(Config4) & ~Jumbo_En1); + + set_offset79(tp, 0x50); + + //tx checksum offload enable + dev->features |= NETIF_F_IP_CSUM; + } + + //rx checksum offload enable +#if LINUX_VERSION_CODE < KERNEL_VERSION(3,0,0) + tp->cp_cmd |= RxChkSum; +#else + dev->features |= NETIF_F_RXCSUM; +#endif + } else if (tp->mcfg == CFG_METHOD_6) { + set_offset70F(tp, 0x27); + + RTL_W8(Config3, RTL_R8(Config3) & ~Beacon_en); + + //disable clock request. + pci_write_config_byte(pdev, 0x81, 0x00); + + if (dev->mtu > ETH_DATA_LEN) { + RTL_W8(Config3, RTL_R8(Config3) | Jumbo_En0); + RTL_W8(Config4, RTL_R8(Config4) | Jumbo_En1); + + set_offset79(tp, 0x20); + + //tx checksum offload disable + dev->features &= ~NETIF_F_IP_CSUM; + } else { + RTL_W8(Config3, RTL_R8(Config3) & ~Jumbo_En0); + RTL_W8(Config4, RTL_R8(Config4) & ~Jumbo_En1); + + set_offset79(tp, 0x50); + + //tx checksum offload enable + dev->features |= NETIF_F_IP_CSUM; + } + + //rx checksum offload enable +#if LINUX_VERSION_CODE < KERNEL_VERSION(3,0,0) + tp->cp_cmd |= RxChkSum; +#else + dev->features |= NETIF_F_RXCSUM; +#endif + } else if (tp->mcfg == CFG_METHOD_7) { + set_offset70F(tp, 0x27); + + rtl8168_eri_write(ioaddr, 0x1EC, 1, 0x07, ERIAR_ASF); + + //disable clock request. + pci_write_config_byte(pdev, 0x81, 0x00); + + RTL_W8(Config3, RTL_R8(Config3) & ~Beacon_en); + + if (dev->mtu > ETH_DATA_LEN) { + RTL_W8(Config3, RTL_R8(Config3) | Jumbo_En0); + RTL_W8(Config4, RTL_R8(Config4) | Jumbo_En1); + + set_offset79(tp, 0x20); + + //tx checksum offload disable + dev->features &= ~NETIF_F_IP_CSUM; + } else { + RTL_W8(Config3, RTL_R8(Config3) & ~Jumbo_En0); + RTL_W8(Config4, RTL_R8(Config4) & ~Jumbo_En1); + + + set_offset79(tp, 0x50); + + //tx checksum offload enable + dev->features |= NETIF_F_IP_CSUM; + } + } else if (tp->mcfg == CFG_METHOD_8) { + + set_offset70F(tp, 0x27); + + rtl8168_eri_write(ioaddr, 0x1EC, 1, 0x07, ERIAR_ASF); + + //disable clock request. + pci_write_config_byte(pdev, 0x81, 0x00); + + RTL_W8(Config3, RTL_R8(Config3) & ~Beacon_en); + + RTL_W8(0xD1, 0x20); + + if (dev->mtu > ETH_DATA_LEN) { + RTL_W8(Config3, RTL_R8(Config3) | Jumbo_En0); + RTL_W8(Config4, RTL_R8(Config4) | Jumbo_En1); + + set_offset79(tp, 0x20); + + //tx checksum offload disable + dev->features &= ~NETIF_F_IP_CSUM; + } else { + RTL_W8(Config3, RTL_R8(Config3) & ~Jumbo_En0); + RTL_W8(Config4, RTL_R8(Config4) & ~Jumbo_En1); + + + set_offset79(tp, 0x50); + + //tx checksum offload enable + dev->features |= NETIF_F_IP_CSUM; + } + } else if (tp->mcfg == CFG_METHOD_9) { + set_offset70F(tp, 0x27); + + /* disable clock request. */ + pci_write_config_byte(pdev, 0x81, 0x00); + + RTL_W8(Config3, RTL_R8(Config3) & ~BIT_4); + RTL_W8(DBG_reg, RTL_R8(DBG_reg) | BIT_7 | BIT_1); + + if (dev->mtu > ETH_DATA_LEN) { + RTL_W8(Config3, RTL_R8(Config3) | Jumbo_En0); + RTL_W8(Config4, RTL_R8(Config4) | Jumbo_En1); + + set_offset79(tp, 0x20); + + /* tx checksum offload disable */ + dev->features &= ~NETIF_F_IP_CSUM; + } else { + RTL_W8(Config3, RTL_R8(Config3) & ~Jumbo_En0); + RTL_W8(Config4, RTL_R8(Config4) & ~Jumbo_En1); + + + set_offset79(tp, 0x50); + + /* tx checksum offload enable */ + dev->features |= NETIF_F_IP_CSUM; + } + + RTL_W8(TDFNR, 0x8); + + } else if (tp->mcfg == CFG_METHOD_10) { + set_offset70F(tp, 0x27); + + RTL_W8(DBG_reg, RTL_R8(DBG_reg) | BIT_7 | BIT_1); + + if (dev->mtu > ETH_DATA_LEN) { + RTL_W8(Config3, RTL_R8(Config3) | Jumbo_En0); + RTL_W8(Config4, RTL_R8(Config4) | Jumbo_En1); + + set_offset79(tp, 0x20); + + /* tx checksum offload disable */ + dev->features &= ~NETIF_F_IP_CSUM; + } else { + RTL_W8(Config3, RTL_R8(Config3) & ~Jumbo_En0); + RTL_W8(Config4, RTL_R8(Config4) & ~Jumbo_En1); + + set_offset79(tp, 0x50); + + /* tx checksum offload enable */ + dev->features |= NETIF_F_IP_CSUM; + } + + RTL_W8(TDFNR, 0x8); + + RTL_W8(Config1, RTL_R8(Config1) | 0x10); + + /* disable clock request. */ + pci_write_config_byte(pdev, 0x81, 0x00); + } else if (tp->mcfg == CFG_METHOD_11 || tp->mcfg == CFG_METHOD_13) { + set_offset70F(tp, 0x17); + set_offset79(tp, 0x50); + + if (dev->mtu > ETH_DATA_LEN) { + RTL_W8(Config3, RTL_R8(Config3) | Jumbo_En0); + + /* tx checksum offload disable */ + dev->features &= ~NETIF_F_IP_CSUM; + } else { + RTL_W8(Config3, RTL_R8(Config3) & ~Jumbo_En0); + + /* tx checksum offload enable */ + dev->features |= NETIF_F_IP_CSUM; + } + + pci_write_config_byte(pdev, 0x81, 0x00); + + RTL_W8(Config1, RTL_R8(Config1) | 0x10); + + } else if (tp->mcfg == CFG_METHOD_12) { + set_offset70F(tp, 0x17); + set_offset79(tp, 0x50); + + if (dev->mtu > ETH_DATA_LEN) { + RTL_W8(Config3, RTL_R8(Config3) | Jumbo_En0); + + /* tx checksum offload disable */ + dev->features &= ~NETIF_F_IP_CSUM; + } else { + RTL_W8(Config3, RTL_R8(Config3) & ~Jumbo_En0); + + /* tx checksum offload enable */ + dev->features |= NETIF_F_IP_CSUM; + } + + pci_write_config_byte(pdev, 0x81, 0x01); + + RTL_W8(Config1, RTL_R8(Config1) | 0x10); + + } else if (tp->mcfg == CFG_METHOD_14 || tp->mcfg == CFG_METHOD_15) { + + set_offset70F(tp, 0x27); + set_offset79(tp, 0x50); + + if (dev->mtu > ETH_DATA_LEN) { + RTL_W8(MTPS, 0x24); + RTL_W8(Config3, RTL_R8(Config3) | Jumbo_En0); + RTL_W8(Config4, RTL_R8(Config4) | 0x01); + + /* tx checksum offload disable */ + dev->features &= ~NETIF_F_IP_CSUM; + } else { + RTL_W8(Config3, RTL_R8(Config3) & ~Jumbo_En0); + RTL_W8(Config4, RTL_R8(Config4) & ~0x01); + + /* tx checksum offload enable */ + dev->features |= NETIF_F_IP_CSUM; + } + + RTL_W8(0xF3, RTL_R8(0xF3) | BIT_5); + RTL_W8(0xF3, RTL_R8(0xF3) & ~BIT_5); + + RTL_W8(0xD0, RTL_R8(0xD0) | BIT_7 | BIT_6); + + RTL_W8(0xD1, RTL_R8(0xD1) | BIT_2 | BIT_3); + + RTL_W8(0xF1, RTL_R8(0xF1) | BIT_6 | BIT_5 | BIT_4 | BIT_2 | BIT_1); + + RTL_W8(TDFNR, 0x8); + + if (aspm) + RTL_W8(0xF1, RTL_R8(0xF1) | BIT_7); + + RTL_W8(Config5, RTL_R8(Config5) & ~BIT_3); + + RTL_W8(Config3, RTL_R8(Config3) & ~Beacon_en); + + RTL_W8(Config1, RTL_R8(Config1) & ~0x10); + } else if (tp->mcfg == CFG_METHOD_16 || tp->mcfg == CFG_METHOD_17) { + set_offset70F(tp, 0x17); + set_offset79(tp, 0x50); + + csi_tmp = rtl8168_eri_read(ioaddr, 0xD5, 1, ERIAR_ExGMAC) | BIT_3 | BIT_2; + rtl8168_eri_write(ioaddr, 0xD5, 1, csi_tmp, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0xC0, 2, 0x0000, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0xB8, 4, 0x00000000, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0xC8, 4, 0x00100002, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0xE8, 4, 0x00100006, ERIAR_ExGMAC); + csi_tmp = rtl8168_eri_read(ioaddr, 0x1D0, 4, ERIAR_ExGMAC); + csi_tmp |= BIT_1; + rtl8168_eri_write(ioaddr, 0x1D0, 1, csi_tmp, ERIAR_ExGMAC); + + csi_tmp = rtl8168_eri_read(ioaddr, 0xDC, 1, ERIAR_ExGMAC); + csi_tmp &= ~BIT_0; + rtl8168_eri_write(ioaddr, 0xDC, 1, csi_tmp, ERIAR_ExGMAC); + csi_tmp |= BIT_0; + rtl8168_eri_write(ioaddr, 0xDC, 1, csi_tmp, ERIAR_ExGMAC); + + RTL_W32(TxConfig, RTL_R32(TxConfig) | BIT_7); + RTL_W8(0xD3, RTL_R8(0xD3) & ~BIT_7); + RTL_W8(0x1B, RTL_R8(0x1B) & ~0x07); + + if (tp->mcfg == CFG_METHOD_16) { + RTL_W32(0xB0, 0xEE480010); + RTL_W8(0x1A, RTL_R8(0x1A) & ~(BIT_2|BIT_3)); + rtl8168_eri_write(ioaddr, 0x1DC, 1, 0x64, ERIAR_ExGMAC); + } else { + csi_tmp = rtl8168_eri_read(ioaddr, 0x1B0, 4, ERIAR_ExGMAC); + csi_tmp |= BIT_4; + rtl8168_eri_write(ioaddr, 0x1B0, 1, csi_tmp, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0xCC, 4, 0x00000050, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0xD0, 4, 0x07ff0060, ERIAR_ExGMAC); + } + + RTL_W8(TDFNR, 0x8); + + RTL_W8(Config2, RTL_R8(Config2) & ~PMSTS_En); + + RTL_W8(0xD0, RTL_R8(0xD0) | BIT_6); + RTL_W8(0xF2, RTL_R8(0xF2) | BIT_6); + + if (dev->mtu > ETH_DATA_LEN) { + RTL_W8(MTPS, 0x27); + + /* tx checksum offload disable */ + dev->features &= ~NETIF_F_IP_CSUM; + } else { + /* tx checksum offload enable */ + dev->features |= NETIF_F_IP_CSUM; + } + + /* disable clock request. */ + pci_write_config_byte(pdev, 0x81, 0x00); + + } else if (tp->mcfg == CFG_METHOD_18 || tp->mcfg == CFG_METHOD_19) { + set_offset70F(tp, 0x17); + set_offset79(tp, 0x50); + + rtl8168_eri_write(ioaddr, 0xC8, 4, 0x00100002, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0xE8, 4, 0x00100006, ERIAR_ExGMAC); + RTL_W32(TxConfig, RTL_R32(TxConfig) | BIT_7); + RTL_W8(0xD3, RTL_R8(0xD3) & ~BIT_7); + csi_tmp = rtl8168_eri_read(ioaddr, 0xDC, 1, ERIAR_ExGMAC); + csi_tmp &= ~BIT_0; + rtl8168_eri_write(ioaddr, 0xDC, 1, csi_tmp, ERIAR_ExGMAC); + csi_tmp |= BIT_0; + rtl8168_eri_write(ioaddr, 0xDC, 1, csi_tmp, ERIAR_ExGMAC); + + if (aspm) + RTL_W8(0xF1, RTL_R8(0xF1) | BIT_7); + + if (dev->mtu > ETH_DATA_LEN) { + RTL_W8(MTPS, 0x27); + + /* tx checksum offload disable */ + dev->features &= ~NETIF_F_IP_CSUM; + } else { + /* tx checksum offload enable */ + dev->features |= NETIF_F_IP_CSUM; + } + + RTL_W8(TDFNR, 0x8); + + RTL_W8(0xD0, RTL_R8(0xD0) | BIT_6); + RTL_W8(0xF2, RTL_R8(0xF2) | BIT_6); + + rtl8168_eri_write(ioaddr, 0xC0, 2, 0x0000, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0xB8, 4, 0x00000000, ERIAR_ExGMAC); + csi_tmp = rtl8168_eri_read(ioaddr, 0xD5, 1, ERIAR_ExGMAC); + csi_tmp |= BIT_3 | BIT_2; + rtl8168_eri_write(ioaddr, 0xD5, 1, csi_tmp, ERIAR_ExGMAC); + RTL_W8(0x1B,RTL_R8(0x1B) & ~0x07); + + csi_tmp = rtl8168_eri_read(ioaddr, 0x1B0, 1, ERIAR_ExGMAC); + csi_tmp |= BIT_4; + rtl8168_eri_write(ioaddr, 0x1B0, 1, csi_tmp, ERIAR_ExGMAC); + csi_tmp = rtl8168_eri_read(ioaddr, 0x1d0, 1, ERIAR_ExGMAC); + csi_tmp |= BIT_4 | BIT_1; + rtl8168_eri_write(ioaddr, 0x1d0, 1, csi_tmp, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0xCC, 4, 0x00000050, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0xd0, 4, 0x00000060, ERIAR_ExGMAC); + } else if (tp->mcfg == CFG_METHOD_20) { + set_offset70F(tp, 0x17); + set_offset79(tp, 0x50); + + rtl8168_eri_write(ioaddr, 0xC8, 4, 0x00100002, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0xE8, 4, 0x00100006, ERIAR_ExGMAC); + RTL_W32(TxConfig, RTL_R32(TxConfig) | BIT_7); + RTL_W8(0xD3, RTL_R8(0xD3) & ~BIT_7); + csi_tmp = rtl8168_eri_read(ioaddr, 0xDC, 1, ERIAR_ExGMAC); + csi_tmp &= ~BIT_0; + rtl8168_eri_write(ioaddr, 0xDC, 1, csi_tmp, ERIAR_ExGMAC); + csi_tmp |= BIT_0; + rtl8168_eri_write(ioaddr, 0xDC, 1, csi_tmp, ERIAR_ExGMAC); + + if (aspm) + RTL_W8(0xF1, RTL_R8(0xF1) | BIT_7); + + if (dev->mtu > ETH_DATA_LEN) { + RTL_W8(MTPS, 0x27); + + /* tx checksum offload disable */ + dev->features &= ~NETIF_F_IP_CSUM; + } else { + /* tx checksum offload enable */ + dev->features |= NETIF_F_IP_CSUM; + } + + RTL_W8(TDFNR, 0x8); + + RTL_W8(0xD0, RTL_R8(0xD0) | BIT_6); + RTL_W8(0xF2, RTL_R8(0xF2) | BIT_6); + rtl8168_eri_write(ioaddr, 0xC0, 2, 0x0000, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0xB8, 4, 0x00000000, ERIAR_ExGMAC); + csi_tmp = rtl8168_eri_read(ioaddr, 0xD5, 1, ERIAR_ExGMAC); + csi_tmp |= BIT_3 | BIT_2; + rtl8168_eri_write(ioaddr, 0xD5, 1, csi_tmp, ERIAR_ExGMAC); + + csi_tmp = rtl8168_eri_read(ioaddr, 0x1B0, 1, ERIAR_ExGMAC); + csi_tmp |= BIT_4; + rtl8168_eri_write(ioaddr, 0x1B0, 1, csi_tmp, ERIAR_ExGMAC); + csi_tmp = rtl8168_eri_read(ioaddr, 0x1d0, 1, ERIAR_ExGMAC); + csi_tmp |= BIT_4 | BIT_1; + rtl8168_eri_write(ioaddr, 0x1d0, 1, csi_tmp, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0xCC, 4, 0x00000050, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0xd0, 4, 0x00000060, ERIAR_ExGMAC); + } else if (tp->mcfg == CFG_METHOD_21 || tp->mcfg == CFG_METHOD_22 || + tp->mcfg == CFG_METHOD_24 || tp->mcfg == CFG_METHOD_25 || + tp->mcfg == CFG_METHOD_26 || tp->mcfg == CFG_METHOD_29 || + tp->mcfg == CFG_METHOD_30) { + set_offset70F(tp, 0x17); + set_offset79(tp, 0x50); + + rtl8168_eri_write(ioaddr, 0xC8, 4, 0x00080002, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0xCC, 1, 0x38, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0xD0, 1, 0x48, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0xE8, 4, 0x00100006, ERIAR_ExGMAC); + + RTL_W32(TxConfig, RTL_R32(TxConfig) | BIT_7); + + csi_tmp = rtl8168_eri_read(ioaddr, 0xDC, 1, ERIAR_ExGMAC); + csi_tmp &= ~BIT_0; + rtl8168_eri_write(ioaddr, 0xDC, 1, csi_tmp, ERIAR_ExGMAC); + csi_tmp |= BIT_0; + rtl8168_eri_write(ioaddr, 0xDC, 1, csi_tmp, ERIAR_ExGMAC); + + if (tp->mcfg == CFG_METHOD_26) { + mac_ocp_data = mac_ocp_read(tp, 0xD3C0); + mac_ocp_data &= ~(BIT_11 | BIT_10 | BIT_9 | BIT_8 | BIT_7 | BIT_6 | BIT_5 | BIT_4 | BIT_3 | BIT_2 | BIT_1 | BIT_0); + mac_ocp_data |= 0x03A9; + mac_ocp_write(tp, 0xD3C0, mac_ocp_data); + mac_ocp_data = mac_ocp_read(tp, 0xD3C2); + mac_ocp_data &= ~(BIT_7 | BIT_6 | BIT_5 | BIT_4 | BIT_3 | BIT_2 | BIT_1 | BIT_0); + mac_ocp_write(tp, 0xD3C2, mac_ocp_data); + mac_ocp_data = mac_ocp_read(tp, 0xD3C4); + mac_ocp_data |= BIT_0; + mac_ocp_write(tp, 0xD3C4, mac_ocp_data); + } else if (tp->mcfg == CFG_METHOD_29 || tp->mcfg == CFG_METHOD_30) { + + if(tp->RequireAdjustUpsTxLinkPulseTiming) { + mac_ocp_data = mac_ocp_read(tp, 0xD412); + mac_ocp_data &= ~(0x0FFF); + mac_ocp_data |= tp->SwrCnt1msIni ; + mac_ocp_write(tp, 0xD412, mac_ocp_data); + } + + mac_ocp_data = mac_ocp_read(tp, 0xE056); + mac_ocp_data &= ~(BIT_7 | BIT_6 | BIT_5 | BIT_4); + mac_ocp_data |= (BIT_6 | BIT_5 | BIT_4); + mac_ocp_write(tp, 0xE056, mac_ocp_data); + + mac_ocp_data = mac_ocp_read(tp, 0xE052); + mac_ocp_data &= ~( BIT_14 | BIT_13); + mac_ocp_data |= BIT_15; + mac_ocp_data |= BIT_3; + mac_ocp_write(tp, 0xE052, mac_ocp_data); + + mac_ocp_data = mac_ocp_read(tp, 0xD420); + mac_ocp_data &= ~(BIT_11 | BIT_10 | BIT_9 | BIT_8 | BIT_7 | BIT_6 | BIT_5 | BIT_4 | BIT_3 | BIT_2 | BIT_1 | BIT_0); + mac_ocp_data |= 0x47F; + mac_ocp_write(tp, 0xD420, mac_ocp_data); + + mac_ocp_data = mac_ocp_read(tp, 0xE0D6); + mac_ocp_data &= ~(BIT_8 | BIT_7 | BIT_6 | BIT_5 | BIT_4 | BIT_3 | BIT_2 | BIT_1 | BIT_0); + mac_ocp_data |= 0x17F; + mac_ocp_write(tp, 0xE0D6, mac_ocp_data); + } + + RTL_W8(Config3, RTL_R8(Config3) & ~Beacon_en); + + RTL_W8(0x1B, RTL_R8(0x1B) & ~0x07); + + RTL_W8(TDFNR, 0x4); + + RTL_W8(Config2, RTL_R8(Config2) & ~PMSTS_En); + + if (aspm) + RTL_W8(0xF1, RTL_R8(0xF1) | BIT_7); + + if (dev->mtu > ETH_DATA_LEN) { + RTL_W8(MTPS, 0x27); + + /* tx checksum offload disable */ + dev->features &= ~NETIF_F_IP_CSUM; + } else { + /* tx checksum offload enable */ + dev->features |= NETIF_F_IP_CSUM; + } + + RTL_W8(0xD0, RTL_R8(0xD0) | BIT_6); + RTL_W8(0xF2, RTL_R8(0xF2) | BIT_6); + + RTL_W8(0xD0, RTL_R8(0xD0) | BIT_7); + + rtl8168_eri_write(ioaddr, 0xC0, 2, 0x0000, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0xB8, 4, 0x00000000, ERIAR_ExGMAC); + + rtl8168_eri_write(ioaddr, 0x5F0, 2, 0x4F87, ERIAR_ExGMAC); + + if (tp->mcfg == CFG_METHOD_29 || tp->mcfg == CFG_METHOD_30) { + csi_tmp = rtl8168_eri_read(ioaddr, 0xD4, 4, ERIAR_ExGMAC); + csi_tmp |= (BIT_8 | BIT_9 | BIT_10 | BIT_11 | BIT_12); + rtl8168_eri_write(ioaddr, 0xD4, 4, csi_tmp, ERIAR_ExGMAC); + + csi_tmp = rtl8168_eri_read(ioaddr, 0xDC, 4, ERIAR_ExGMAC); + csi_tmp |= (BIT_2 | BIT_3 | BIT_4); + rtl8168_eri_write(ioaddr, 0xDC, 4, csi_tmp, ERIAR_ExGMAC); + } else { + csi_tmp = rtl8168_eri_read(ioaddr, 0xD4, 4, ERIAR_ExGMAC); + csi_tmp |= (BIT_7 | BIT_8 | BIT_9 | BIT_10 | BIT_11 | BIT_12); + rtl8168_eri_write(ioaddr, 0xD4, 4, csi_tmp, ERIAR_ExGMAC); + } + + if (tp->mcfg == CFG_METHOD_21 || tp->mcfg == CFG_METHOD_22 || + tp->mcfg == CFG_METHOD_24 || tp->mcfg == CFG_METHOD_25) { + mac_ocp_write(tp, 0xC140, 0xFFFF); + } else if (tp->mcfg == CFG_METHOD_29 || tp->mcfg == CFG_METHOD_30) { + mac_ocp_write(tp, 0xC140, 0xFFFF); + mac_ocp_write(tp, 0xC142, 0xFFFF); + } + + csi_tmp = rtl8168_eri_read(ioaddr, 0x1B0, 4, ERIAR_ExGMAC); + csi_tmp &= ~BIT_12; + rtl8168_eri_write(ioaddr, 0x1B0, 4, csi_tmp, ERIAR_ExGMAC); + + if (tp->mcfg == CFG_METHOD_29 || tp->mcfg == CFG_METHOD_30) { + csi_tmp = rtl8168_eri_read(ioaddr, 0x2FC, 1, ERIAR_ExGMAC); + csi_tmp &= ~(BIT_2); + rtl8168_eri_write(ioaddr, 0x2FC, 1, csi_tmp, ERIAR_ExGMAC); + } else { + csi_tmp = rtl8168_eri_read(ioaddr, 0x2FC, 1, ERIAR_ExGMAC); + csi_tmp &= ~(BIT_0 | BIT_1 | BIT_2); + csi_tmp |= BIT_0; + rtl8168_eri_write(ioaddr, 0x2FC, 1, csi_tmp, ERIAR_ExGMAC); + } + + csi_tmp = rtl8168_eri_read(ioaddr, 0x1D0, 1, ERIAR_ExGMAC); + csi_tmp |= BIT_1; + rtl8168_eri_write(ioaddr, 0x1D0, 1, csi_tmp, ERIAR_ExGMAC); + } else if (tp->mcfg == CFG_METHOD_23 || tp->mcfg == CFG_METHOD_27 || + tp->mcfg == CFG_METHOD_28) { + set_offset70F(tp, 0x17); + set_offset79(tp, 0x50); + + rtl8168_eri_write(ioaddr, 0xC8, 4, 0x00080002, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0xCC, 1, 0x2F, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0xD0, 1, 0x5F, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0xE8, 4, 0x00100006, ERIAR_ExGMAC); + + RTL_W32(TxConfig, RTL_R32(TxConfig) | BIT_7); + + csi_tmp = rtl8168_eri_read(ioaddr, 0xDC, 1, ERIAR_ExGMAC); + csi_tmp &= ~BIT_0; + rtl8168_eri_write(ioaddr, 0xDC, 1, csi_tmp, ERIAR_ExGMAC); + csi_tmp |= BIT_0; + rtl8168_eri_write(ioaddr, 0xDC, 1, csi_tmp, ERIAR_ExGMAC); + + RTL_W8(Config3, RTL_R8(Config3) & ~Beacon_en); + + RTL_W8(0xD0, RTL_R8(0xD0) | BIT_6); + RTL_W8(0xF2, RTL_R8(0xF2) | BIT_6); + + RTL_W8(0xD0, RTL_R8(0xD0) | BIT_7); + + rtl8168_eri_write(ioaddr, 0xC0, 2, 0x0000, ERIAR_ExGMAC); + rtl8168_eri_write(ioaddr, 0xB8, 4, 0x00000000, ERIAR_ExGMAC); + RTL_W8(0x1B, RTL_R8(0x1B) & ~0x07); + + RTL_W8(TDFNR, 0x4); + + if (aspm) + RTL_W8(0xF1, RTL_R8(0xF1) | BIT_7); + + csi_tmp = rtl8168_eri_read(ioaddr, 0x1B0, 4, ERIAR_ExGMAC); + csi_tmp &= ~BIT_12; + rtl8168_eri_write(ioaddr, 0x1B0, 4, csi_tmp, ERIAR_ExGMAC); + + csi_tmp = rtl8168_eri_read(ioaddr, 0x2FC, 1, ERIAR_ExGMAC); + csi_tmp &= ~(BIT_0 | BIT_1 | BIT_2); + csi_tmp |= BIT_0; + rtl8168_eri_write(ioaddr, 0x2FC, 1, csi_tmp, ERIAR_ExGMAC); + + csi_tmp = rtl8168_eri_read(ioaddr, 0x1D0, 1, ERIAR_ExGMAC); + csi_tmp |= BIT_1; + rtl8168_eri_write(ioaddr, 0x1D0, 1, csi_tmp, ERIAR_ExGMAC); + + if (dev->mtu > ETH_DATA_LEN) { + RTL_W8(MTPS, 0x27); + + /* tx checksum offload disable */ + dev->features &= ~NETIF_F_IP_CSUM; + } else { + /* tx checksum offload enable */ + dev->features |= NETIF_F_IP_CSUM; + } + + if (tp->mcfg == CFG_METHOD_27 || tp->mcfg == CFG_METHOD_28) { + OOB_mutex_lock(tp); + rtl8168_eri_write(ioaddr, 0x5F0, 2, 0x4F87, ERIAR_ExGMAC); + OOB_mutex_unlock(tp); + } + + csi_tmp = rtl8168_eri_read(ioaddr, 0xD4, 4, ERIAR_ExGMAC); + csi_tmp |= ( BIT_7 | BIT_8 | BIT_9 | BIT_10 | BIT_11 | BIT_12 ); + rtl8168_eri_write(ioaddr, 0xD4, 4, csi_tmp, ERIAR_ExGMAC); + + mac_ocp_write(tp, 0xC140, 0xFFFF); + mac_ocp_write(tp, 0xC142, 0xFFFF); + + if (tp->mcfg == CFG_METHOD_28) { + mac_ocp_data = mac_ocp_read(tp, 0xD3E2); + mac_ocp_data &= 0xF000; + mac_ocp_data |= 0x3A9; + mac_ocp_write(tp, 0xD3E2, mac_ocp_data); + + mac_ocp_data = mac_ocp_read(tp, 0xD3E4); + mac_ocp_data &= 0xFF00; + mac_ocp_write(tp, 0xD3E4, mac_ocp_data); + + mac_ocp_data = mac_ocp_read(tp, 0xE860); + mac_ocp_data |= BIT_7; + mac_ocp_write(tp, 0xE860, mac_ocp_data); + } + } else if (tp->mcfg == CFG_METHOD_1) { + RTL_W8(Config3, RTL_R8(Config3) & ~Beacon_en); + + if (dev->mtu > ETH_DATA_LEN) { + pci_read_config_byte(pdev, 0x69, &device_control); + device_control &= ~0x70; + device_control |= 0x28; + pci_write_config_byte(pdev, 0x69, device_control); + } else { + pci_read_config_byte(pdev, 0x69, &device_control); + device_control &= ~0x70; + device_control |= 0x58; + pci_write_config_byte(pdev, 0x69, device_control); + } + } else if (tp->mcfg == CFG_METHOD_2) { + RTL_W8(Config3, RTL_R8(Config3) & ~Beacon_en); + + if (dev->mtu > ETH_DATA_LEN) { + pci_read_config_byte(pdev, 0x69, &device_control); + device_control &= ~0x70; + device_control |= 0x28; + pci_write_config_byte(pdev, 0x69, device_control); + + RTL_W8(Config4, RTL_R8(Config4) | (1 << 0)); + } else { + pci_read_config_byte(pdev, 0x69, &device_control); + device_control &= ~0x70; + device_control |= 0x58; + pci_write_config_byte(pdev, 0x69, device_control); + + RTL_W8(Config4, RTL_R8(Config4) & ~(1 << 0)); + } + } else if (tp->mcfg == CFG_METHOD_3) { + RTL_W8(Config3, RTL_R8(Config3) & ~Beacon_en); + + if (dev->mtu > ETH_DATA_LEN) { + pci_read_config_byte(pdev, 0x69, &device_control); + device_control &= ~0x70; + device_control |= 0x28; + pci_write_config_byte(pdev, 0x69, device_control); + + RTL_W8(Config4, RTL_R8(Config4) | (1 << 0)); + } else { + pci_read_config_byte(pdev, 0x69, &device_control); + device_control &= ~0x70; + device_control |= 0x58; + pci_write_config_byte(pdev, 0x69, device_control); + + RTL_W8(Config4, RTL_R8(Config4) & ~(1 << 0)); + } + } else if (tp->mcfg == CFG_METHOD_DEFAULT) { + dev->features &= ~NETIF_F_IP_CSUM; + } + + if ((tp->mcfg == CFG_METHOD_1) || (tp->mcfg == CFG_METHOD_2) || (tp->mcfg == CFG_METHOD_3)) { + /* csum offload command for RTL8168B/8111B */ + tp->tx_tcp_csum_cmd = TxIPCS | TxTCPCS; + tp->tx_udp_csum_cmd = TxIPCS | TxUDPCS; + tp->tx_ip_csum_cmd = TxIPCS; + } else { + /* csum offload command for RTL8168C/8111C and RTL8168CP/8111CP */ + tp->tx_tcp_csum_cmd = TxIPCS_C | TxTCPCS_C; + tp->tx_udp_csum_cmd = TxIPCS_C | TxUDPCS_C; + tp->tx_ip_csum_cmd = TxIPCS_C; + } + + + //other hw parameters + if (tp->mcfg == CFG_METHOD_21 || tp->mcfg == CFG_METHOD_22 || + tp->mcfg == CFG_METHOD_23 || tp->mcfg == CFG_METHOD_24 || + tp->mcfg == CFG_METHOD_25 || tp->mcfg == CFG_METHOD_26 || + tp->mcfg == CFG_METHOD_27 || tp->mcfg == CFG_METHOD_28) + rtl8168_eri_write(ioaddr, 0x2F8, 2, 0x1D8F, ERIAR_ExGMAC); + + if (tp->bios_setting & BIT_28) { + if (tp->mcfg == CFG_METHOD_18 || tp->mcfg == CFG_METHOD_19 || + tp->mcfg == CFG_METHOD_20) { + u32 gphy_val; + + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_write(tp, 0x1F, 0x0007); + mdio_write(tp, 0x1E, 0x002C); + gphy_val = mdio_read(tp, 0x16); + gphy_val |= BIT_10; + mdio_write(tp, 0x16, gphy_val); + mdio_write(tp, 0x1F, 0x0005); + mdio_write(tp, 0x05, 0x8B80); + gphy_val = mdio_read(tp, 0x06); + gphy_val |= BIT_7; + mdio_write(tp, 0x06, gphy_val); + mdio_write(tp, 0x1F, 0x0000); + spin_unlock_irqrestore(&tp->phy_lock, flags); + } + } + + rtl8168_hw_clear_timer_int(dev); + + switch (tp->mcfg) { + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + if (aspm) { + rtl8168_init_pci_offset_99(tp); + } + break; + } + switch (tp->mcfg) { + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + if (aspm) { + rtl8168_init_pci_offset_180(tp); + } + break; + } + + tp->cp_cmd &= ~(EnableBist | Macdbgo_oe | Force_halfdup | + Force_rxflow_en | Force_txflow_en | Cxpl_dbg_sel | + ASF | Macdbgo_sel); + +#if LINUX_VERSION_CODE < KERNEL_VERSION(3,0,0) + RTL_W16(CPlusCmd, tp->cp_cmd); +#else + rtl8168_hw_set_features(dev, dev->features); +#endif + + switch (tp->mcfg) { + case CFG_METHOD_16: + case CFG_METHOD_17: + case CFG_METHOD_18: + case CFG_METHOD_19: + case CFG_METHOD_20: + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: { + int timeout; + for (timeout = 0; timeout < 10; timeout++) { + if ((rtl8168_eri_read(ioaddr, 0x1AE, 2, ERIAR_ExGMAC) & BIT_13)==0) + break; + mdelay(1); + } + } + break; + } + + RTL_W16(RxMaxSize, tp->rx_buf_sz); + + rtl8168_disable_rxdvgate(dev); + + if (tp->mcfg == CFG_METHOD_11 || tp->mcfg == CFG_METHOD_12) + rtl8168_mac_loopback_test(tp); + + if (!tp->pci_cfg_is_read) { + pci_read_config_byte(pdev, PCI_COMMAND, &tp->pci_cfg_space.cmd); + pci_read_config_word(pdev, PCI_BASE_ADDRESS_0, &tp->pci_cfg_space.io_base_l); + pci_read_config_word(pdev, PCI_BASE_ADDRESS_0 + 2, &tp->pci_cfg_space.io_base_h); + pci_read_config_word(pdev, PCI_BASE_ADDRESS_2, &tp->pci_cfg_space.mem_base_l); + pci_read_config_word(pdev, PCI_BASE_ADDRESS_2 + 2, &tp->pci_cfg_space.mem_base_h); + pci_read_config_word(pdev, PCI_BASE_ADDRESS_3, &tp->pci_cfg_space.resv_0x1c_l); + pci_read_config_word(pdev, PCI_BASE_ADDRESS_3 + 2, &tp->pci_cfg_space.resv_0x1c_h); + pci_read_config_byte(pdev, PCI_INTERRUPT_LINE, &tp->pci_cfg_space.ilr); + pci_read_config_word(pdev, PCI_BASE_ADDRESS_4, &tp->pci_cfg_space.resv_0x20_l); + pci_read_config_word(pdev, PCI_BASE_ADDRESS_4 + 2, &tp->pci_cfg_space.resv_0x20_h); + pci_read_config_word(pdev, PCI_BASE_ADDRESS_5, &tp->pci_cfg_space.resv_0x24_l); + pci_read_config_word(pdev, PCI_BASE_ADDRESS_5 + 2, &tp->pci_cfg_space.resv_0x24_h); + pci_read_config_word(pdev, PCI_SUBSYSTEM_VENDOR_ID, &tp->pci_cfg_space.resv_0x2c_l); + pci_read_config_word(pdev, PCI_SUBSYSTEM_VENDOR_ID + 2, &tp->pci_cfg_space.resv_0x2c_h); + tp->pci_cfg_space.pci_sn_l = rtl8168_csi_read(tp, PCI_DEVICE_SERIAL_NUMBER); + tp->pci_cfg_space.pci_sn_h = rtl8168_csi_read(tp, PCI_DEVICE_SERIAL_NUMBER + 4); + + tp->pci_cfg_is_read = 1; + } + + rtl8168_dsm(dev, DSM_MAC_INIT); + + /* Set Rx packet filter */ + rtl8168_hw_set_rx_packet_filter(dev); + +#ifdef ENABLE_DASH_SUPPORT + if (tp->DASH) + NICChkTypeEnableDashInterrupt(tp); +#endif + + switch (tp->mcfg) { + case CFG_METHOD_14: + case CFG_METHOD_15: + case CFG_METHOD_16: + case CFG_METHOD_17: + case CFG_METHOD_18: + case CFG_METHOD_19: + case CFG_METHOD_20: + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + if (aspm) { + RTL_W8(Config5, RTL_R8(Config5) | BIT_0); + RTL_W8(Config2, RTL_R8(Config2) | BIT_7); + } else { + RTL_W8(Config2, RTL_R8(Config2) & ~BIT_7); + RTL_W8(Config5, RTL_R8(Config5) & ~BIT_0); + } + break; + } + + RTL_W8(Cfg9346, Cfg9346_Lock); + + udelay(10); +} + +static void +rtl8168_hw_start(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + + rtl8168_hw_config(dev); + + RTL_W8(ChipCmd, CmdTxEnb | CmdRxEnb); + + rtl8168_enable_hw_interrupt(tp, ioaddr); +} + + +static int +rtl8168_change_mtu(struct net_device *dev, + int new_mtu) +{ + struct rtl8168_private *tp = netdev_priv(dev); + int max_mtu; + int ret = 0; + unsigned long flags; + + if (tp->mcfg == CFG_METHOD_DEFAULT) + max_mtu = ETH_DATA_LEN; + else + max_mtu = tp->max_jumbo_frame_size - ETH_HLEN - 8; + + if (new_mtu < ETH_ZLEN) + return -EINVAL; + else if (new_mtu > max_mtu) + new_mtu = max_mtu; + + if (!netif_running(dev)) + goto out; + + rtl8168_down(dev); + + spin_lock_irqsave(&tp->lock, flags); + + dev->mtu = new_mtu; + + rtl8168_set_rxbufsize(tp, dev); + + ret = rtl8168_init_ring(dev); + + if (ret < 0) { + spin_unlock_irqrestore(&tp->lock, flags); + goto out; + } + +#ifdef CONFIG_R8168_NAPI +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + RTL_NAPI_ENABLE(dev, &tp->napi); +#endif +#endif//CONFIG_R8168_NAPI + + netif_stop_queue(dev); + netif_carrier_off(dev); + rtl8168_hw_config(dev); + spin_unlock_irqrestore(&tp->lock, flags); + rtl8168_set_speed(dev, tp->autoneg, tp->speed, tp->duplex); + + mod_timer(&tp->esd_timer, jiffies + RTL8168_ESD_TIMEOUT); + mod_timer(&tp->link_timer, jiffies + RTL8168_LINK_TIMEOUT); + +out: + return ret; +} + +static inline void +rtl8168_make_unusable_by_asic(struct RxDesc *desc) +{ + desc->addr = 0x0badbadbadbadbadull; + desc->opts1 &= ~cpu_to_le32(DescOwn | RsvdMask); +} + +static void +rtl8168_free_rx_skb(struct rtl8168_private *tp, + struct sk_buff **sk_buff, + struct RxDesc *desc) +{ + struct pci_dev *pdev = tp->pci_dev; + + pci_unmap_single(pdev, le64_to_cpu(desc->addr), tp->rx_buf_sz, + PCI_DMA_FROMDEVICE); + dev_kfree_skb(*sk_buff); + *sk_buff = NULL; + rtl8168_make_unusable_by_asic(desc); +} + +static inline void +rtl8168_mark_to_asic(struct RxDesc *desc, + u32 rx_buf_sz) +{ + u32 eor = le32_to_cpu(desc->opts1) & RingEnd; + + desc->opts1 = cpu_to_le32(DescOwn | eor | rx_buf_sz); +} + +static inline void +rtl8168_map_to_asic(struct RxDesc *desc, + dma_addr_t mapping, + u32 rx_buf_sz) +{ + desc->addr = cpu_to_le64(mapping); + wmb(); + rtl8168_mark_to_asic(desc, rx_buf_sz); +} + +static int +rtl8168_alloc_rx_skb(struct pci_dev *pdev, + struct sk_buff **sk_buff, + struct RxDesc *desc, + int rx_buf_sz) +{ + struct sk_buff *skb; + dma_addr_t mapping; + int ret = 0; + + skb = dev_alloc_skb(rx_buf_sz + RTK_RX_ALIGN); + if (!skb) + goto err_out; + + skb_reserve(skb, RTK_RX_ALIGN); + *sk_buff = skb; + + mapping = pci_map_single(pdev, skb->data, rx_buf_sz, + PCI_DMA_FROMDEVICE); + + rtl8168_map_to_asic(desc, mapping, rx_buf_sz); + +out: + return ret; + +err_out: + ret = -ENOMEM; + rtl8168_make_unusable_by_asic(desc); + goto out; +} + +static void +rtl8168_rx_clear(struct rtl8168_private *tp) +{ + int i; + + for (i = 0; i < NUM_RX_DESC; i++) { + if (tp->Rx_skbuff[i]) + rtl8168_free_rx_skb(tp, tp->Rx_skbuff + i, + tp->RxDescArray + i); + } +} + +static u32 +rtl8168_rx_fill(struct rtl8168_private *tp, + struct net_device *dev, + u32 start, + u32 end) +{ + u32 cur; + + for (cur = start; end - cur > 0; cur++) { + int ret, i = cur % NUM_RX_DESC; + + if (tp->Rx_skbuff[i]) + continue; + + ret = rtl8168_alloc_rx_skb(tp->pci_dev, tp->Rx_skbuff + i, + tp->RxDescArray + i, tp->rx_buf_sz); + if (ret < 0) + break; + } + return cur - start; +} + +static inline void +rtl8168_mark_as_last_descriptor(struct RxDesc *desc) +{ + desc->opts1 |= cpu_to_le32(RingEnd); +} + +static void +rtl8168_desc_addr_fill(struct rtl8168_private *tp) +{ + void __iomem *ioaddr = tp->mmio_addr; + + if (!tp->TxPhyAddr || !tp->RxPhyAddr) + return; + + RTL_W32(TxDescStartAddrLow, ((u64) tp->TxPhyAddr & DMA_BIT_MASK(32))); + RTL_W32(TxDescStartAddrHigh, ((u64) tp->TxPhyAddr >> 32)); + RTL_W32(RxDescAddrLow, ((u64) tp->RxPhyAddr & DMA_BIT_MASK(32))); + RTL_W32(RxDescAddrHigh, ((u64) tp->RxPhyAddr >> 32)); +} + +static void +rtl8168_tx_desc_init(struct rtl8168_private *tp) +{ + int i = 0; + + memset(tp->TxDescArray, 0x0, NUM_TX_DESC * sizeof(struct TxDesc)); + + for (i = 0; i < NUM_TX_DESC; i++) { + if (i == (NUM_TX_DESC - 1)) + tp->TxDescArray[i].opts1 = cpu_to_le32(RingEnd); + } +} + +static void +rtl8168_rx_desc_offset0_init(struct rtl8168_private *tp, int own) +{ + int i = 0; + int ownbit = 0; + + if (own) + ownbit = DescOwn; + + for (i = 0; i < NUM_RX_DESC; i++) { + if (i == (NUM_RX_DESC - 1)) + tp->RxDescArray[i].opts1 = cpu_to_le32((ownbit | RingEnd) | (unsigned long)tp->rx_buf_sz); + else + tp->RxDescArray[i].opts1 = cpu_to_le32(ownbit | (unsigned long)tp->rx_buf_sz); + } +} + +static void +rtl8168_rx_desc_init(struct rtl8168_private *tp) +{ + memset(tp->RxDescArray, 0x0, NUM_RX_DESC * sizeof(struct RxDesc)); +} + +static int +rtl8168_init_ring(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + + rtl8168_init_ring_indexes(tp); + + memset(tp->tx_skb, 0x0, NUM_TX_DESC * sizeof(struct ring_info)); + memset(tp->Rx_skbuff, 0x0, NUM_RX_DESC * sizeof(struct sk_buff *)); + + rtl8168_tx_desc_init(tp); + rtl8168_rx_desc_init(tp); + + if (rtl8168_rx_fill(tp, dev, 0, NUM_RX_DESC) != NUM_RX_DESC) + goto err_out; + + rtl8168_mark_as_last_descriptor(tp->RxDescArray + NUM_RX_DESC - 1); + + return 0; + +err_out: + rtl8168_rx_clear(tp); + return -ENOMEM; +} + +static void +rtl8168_unmap_tx_skb(struct pci_dev *pdev, + struct ring_info *tx_skb, + struct TxDesc *desc) +{ + unsigned int len = tx_skb->len; + + pci_unmap_single(pdev, le64_to_cpu(desc->addr), len, PCI_DMA_TODEVICE); + desc->opts1 = 0x00; + desc->opts2 = 0x00; + desc->addr = 0x00; + tx_skb->len = 0; +} + +static void +rtl8168_tx_clear(struct rtl8168_private *tp) +{ + unsigned int i; +#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,22) + struct net_device *dev = tp->dev; +#endif + + for (i = tp->dirty_tx; i < tp->dirty_tx + NUM_TX_DESC; i++) { + unsigned int entry = i % NUM_TX_DESC; + struct ring_info *tx_skb = tp->tx_skb + entry; + unsigned int len = tx_skb->len; + + if (len) { + struct sk_buff *skb = tx_skb->skb; + + rtl8168_unmap_tx_skb(tp->pci_dev, tx_skb, + tp->TxDescArray + entry); + if (skb) { + dev_kfree_skb(skb); + tx_skb->skb = NULL; + } + RTLDEV->stats.tx_dropped++; + } + } + tp->cur_tx = tp->dirty_tx = 0; +} + +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,20) +static void rtl8168_schedule_work(struct net_device *dev, void (*task)(void *)) +{ +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + struct rtl8168_private *tp = netdev_priv(dev); + + INIT_WORK(&tp->task, task, dev); + schedule_delayed_work(&tp->task, 4); +#endif //LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) +} + +static void rtl8168_cancel_schedule_work(struct net_device *dev) +{ +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + struct rtl8168_private *tp = netdev_priv(dev); + + cancel_work_sync(&tp->task); +#endif //LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) +} + +#else +static void rtl8168_schedule_work(struct net_device *dev, work_func_t task) +{ + struct rtl8168_private *tp = netdev_priv(dev); + + INIT_DELAYED_WORK(&tp->task, task); + schedule_delayed_work(&tp->task, 4); +} + +static void rtl8168_cancel_schedule_work(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + + cancel_delayed_work_sync(&tp->task); +} +#endif + +static void +rtl8168_wait_for_quiescence(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + + synchronize_irq(dev->irq); + + /* Wait for any pending NAPI task to complete */ +#ifdef CONFIG_R8168_NAPI +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + RTL_NAPI_DISABLE(dev, &tp->napi); +#endif +#endif//CONFIG_R8168_NAPI + + rtl8168_irq_mask_and_ack(tp, ioaddr); + +#ifdef CONFIG_R8168_NAPI +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + RTL_NAPI_ENABLE(dev, &tp->napi); +#endif +#endif//CONFIG_R8168_NAPI +} + +#if 0 +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,20) +static void rtl8168_reinit_task(void *_data) +#else +static void rtl8168_reinit_task(struct work_struct *work) +#endif +{ +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,20) + struct net_device *dev = _data; +#else + struct rtl8168_private *tp = + container_of(work, struct rtl8168_private, task.work); + struct net_device *dev = tp->dev; +#endif + int ret; + + if (netif_running(dev)) { + rtl8168_wait_for_quiescence(dev); + rtl8168_close(dev); + } + + ret = rtl8168_open(dev); + if (unlikely(ret < 0)) { + if (net_ratelimit()) { + struct rtl8168_private *tp = netdev_priv(dev); + + if (netif_msg_drv(tp)) { + printk(PFX KERN_ERR + "%s: reinit failure (status = %d)." + " Rescheduling.\n", dev->name, ret); + } + } + rtl8168_schedule_work(dev, rtl8168_reinit_task); + } +} +#endif + +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,20) +static void rtl8168_reset_task(void *_data) +{ + struct net_device *dev = _data; + struct rtl8168_private *tp = netdev_priv(dev); +#else +static void rtl8168_reset_task(struct work_struct *work) +{ + struct rtl8168_private *tp = + container_of(work, struct rtl8168_private, task.work); + struct net_device *dev = tp->dev; +#endif + unsigned long flags; + + if (!netif_running(dev)) + return; + + rtl8168_wait_for_quiescence(dev); + + rtl8168_rx_interrupt(dev, tp, tp->mmio_addr, ~(u32)0); + + spin_lock_irqsave(&tp->lock, flags); + + rtl8168_tx_clear(tp); + + if (tp->dirty_rx == tp->cur_rx) { + rtl8168_rx_clear(tp); + rtl8168_init_ring(dev); + rtl8168_set_speed(dev, tp->autoneg, tp->speed, tp->duplex); + spin_unlock_irqrestore(&tp->lock, flags); + } else { + spin_unlock_irqrestore(&tp->lock, flags); + if (net_ratelimit()) { + struct rtl8168_private *tp = netdev_priv(dev); + + if (netif_msg_intr(tp)) { + printk(PFX KERN_EMERG + "%s: Rx buffers shortage\n", dev->name); + } + } + rtl8168_schedule_work(dev, rtl8168_reset_task); + } +} + +static void +rtl8168_tx_timeout(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + unsigned long flags; + + spin_lock_irqsave(&tp->lock, flags); + netif_stop_queue(dev); + netif_carrier_off(dev); + rtl8168_hw_reset(dev); + spin_unlock_irqrestore(&tp->lock, flags); + + /* Let's wait a bit while any (async) irq lands on */ + rtl8168_schedule_work(dev, rtl8168_reset_task); +} + +static int +rtl8168_xmit_frags(struct rtl8168_private *tp, + struct sk_buff *skb, + u32 opts1, + u32 opts2) +{ + struct skb_shared_info *info = skb_shinfo(skb); + unsigned int cur_frag, entry; + struct TxDesc *txd = NULL; + + entry = tp->cur_tx; + for (cur_frag = 0; cur_frag < info->nr_frags; cur_frag++) { + skb_frag_t *frag = info->frags + cur_frag; + dma_addr_t mapping; + u32 status, len; + void *addr; + + entry = (entry + 1) % NUM_TX_DESC; + + txd = tp->TxDescArray + entry; +#if LINUX_VERSION_CODE < KERNEL_VERSION(3,2,0) + len = frag->size; + addr = ((void *) page_address(frag->page)) + frag->page_offset; +#else + len = skb_frag_size(frag); + addr = skb_frag_address(frag); +#endif + mapping = pci_map_single(tp->pci_dev, addr, len, PCI_DMA_TODEVICE); + + /* anti gcc 2.95.3 bugware (sic) */ + status = opts1 | len | (RingEnd * !((entry + 1) % NUM_TX_DESC)); + + txd->addr = cpu_to_le64(mapping); + + tp->tx_skb[entry].len = len; + + txd->opts1 = cpu_to_le32(status); + txd->opts2 = cpu_to_le32(opts2); + } + + if (cur_frag) { + tp->tx_skb[entry].skb = skb; + wmb(); + txd->opts1 |= cpu_to_le32(LastFrag); + } + + return cur_frag; +} + +static inline u32 +rtl8168_tx_csum(struct sk_buff *skb, + struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,22) + const struct iphdr *ip = skb->nh.iph; +#else + const struct iphdr *ip = ip_hdr(skb); +#endif + u32 csum_cmd = 0; + + if (skb->ip_summed == CHECKSUM_PARTIAL) { + if (ip->protocol == IPPROTO_TCP) + csum_cmd = tp->tx_tcp_csum_cmd; + else if (ip->protocol == IPPROTO_UDP) + csum_cmd = tp->tx_udp_csum_cmd; + else if (ip->protocol == IPPROTO_IP) + csum_cmd = tp->tx_ip_csum_cmd; +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + else + WARN_ON(1); /* we need a WARN() */ +#endif + } + + if (tp->ShortPacketSwChecksum && skb->len < 60) { + if (csum_cmd != 0) { +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,10) && LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,7) + skb_checksum_help(&skb, 0); +#elif LINUX_VERSION_CODE < KERNEL_VERSION(2,6,19) && LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,10) + skb_checksum_help(skb, 0); +#else + skb_checksum_help(skb); +#endif + csum_cmd = 0; + } + } + + return csum_cmd; +} + +static void +rtl8168_sw_padding_short_pkt(struct rtl8168_private *tp, + struct sk_buff *skb, + u32 opts1, + u32 opts2) +{ + unsigned int entry; + dma_addr_t mapping; + u32 status, len; + void *addr; + struct TxDesc *txd = NULL; + + if (skb->len >= ETH_ZLEN) return; + + entry = tp->cur_tx; + do { + entry = (entry + 1) % NUM_TX_DESC; + + txd = tp->TxDescArray + entry; + len = ETH_ZLEN - skb->len; + addr = tp->ShortPacketEmptyBuffer; + mapping = pci_map_single(tp->pci_dev, addr, len, PCI_DMA_TODEVICE); + + status = opts1 | len | (RingEnd * !((entry + 1) % NUM_TX_DESC)); + + txd->addr = cpu_to_le64(mapping); + + txd->opts1 = cpu_to_le32(status); + txd->opts2 = cpu_to_le32(opts2); + + wmb(); + txd->opts1 |= cpu_to_le32(LastFrag); + } while(FALSE); +} + + +static int +rtl8168_start_xmit(struct sk_buff *skb, + struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + unsigned int frags, entry; + struct TxDesc *txd; + void __iomem *ioaddr = tp->mmio_addr; + dma_addr_t mapping; + u32 len; + u32 opts1; + u32 opts2; + int ret = NETDEV_TX_OK; + unsigned long flags, large_send; + + spin_lock_irqsave(&tp->lock, flags); + + if (unlikely(TX_BUFFS_AVAIL(tp) < skb_shinfo(skb)->nr_frags)) { + if (netif_msg_drv(tp)) { + printk(KERN_ERR + "%s: BUG! Tx Ring full when queue awake!\n", + dev->name); + } + goto err_stop; + } + + entry = tp->cur_tx % NUM_TX_DESC; + txd = tp->TxDescArray + entry; + + if (unlikely(le32_to_cpu(txd->opts1) & DescOwn)) + goto err_stop; + + opts1 = DescOwn; + opts2 = rtl8168_tx_vlan_tag(tp, skb); + + large_send = 0; +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + if (dev->features & NETIF_F_TSO) { +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,18) + u32 mss = skb_shinfo(skb)->tso_size; +#else + u32 mss = skb_shinfo(skb)->gso_size; +#endif //LINUX_VERSION_CODE < KERNEL_VERSION(2,6,18) + + /* TCP Segmentation Offload (or TCP Large Send) */ + if (mss) { + if ((tp->mcfg == CFG_METHOD_1) || + (tp->mcfg == CFG_METHOD_2) || + (tp->mcfg == CFG_METHOD_3)) { + opts1 |= LargeSend | ((mss & MSSMask) << 16); + } else if ((tp->mcfg == CFG_METHOD_11) || + (tp->mcfg == CFG_METHOD_12) || + (tp->mcfg == CFG_METHOD_13)) { + opts2 |= LargeSend_DP | ((mss & MSSMask) << 18); + } else { + opts1 |= LargeSend; + opts2 |= (mss & MSSMask) << 18; + } + large_send = 1; + } + } +#endif //LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + + if (large_send == 0) { + if (dev->features & NETIF_F_IP_CSUM) { + if ((tp->mcfg == CFG_METHOD_1) || (tp->mcfg == CFG_METHOD_2) || (tp->mcfg == CFG_METHOD_3)) + opts1 |= rtl8168_tx_csum(skb, dev); + else + opts2 |= rtl8168_tx_csum(skb, dev); + } + } + + frags = rtl8168_xmit_frags(tp, skb, opts1, opts2); + if (frags) { + len = skb_headlen(skb); + opts1 |= FirstFrag; + } else { + len = skb->len; + + tp->tx_skb[entry].skb = skb; + + if (tp->UseSwPaddingShortPkt && len < 60) { + rtl8168_sw_padding_short_pkt(tp, skb, opts1, opts2); + opts1 |= FirstFrag; + frags++; + } else { + opts1 |= FirstFrag | LastFrag; + } + } + + opts1 |= len | (RingEnd * !((entry + 1) % NUM_TX_DESC)); + mapping = pci_map_single(tp->pci_dev, skb->data, len, PCI_DMA_TODEVICE); + tp->tx_skb[entry].len = len; + txd->addr = cpu_to_le64(mapping); + txd->opts2 = cpu_to_le32(opts2); + txd->opts1 = cpu_to_le32(opts1&~DescOwn); + wmb(); + txd->opts1 = cpu_to_le32(opts1); + + dev->trans_start = jiffies; + + tp->cur_tx += frags + 1; + + wmb(); + + RTL_W8(TxPoll, NPQ); /* set polling bit */ + + if (TX_BUFFS_AVAIL(tp) < MAX_SKB_FRAGS) { + netif_stop_queue(dev); + smp_rmb(); + if (TX_BUFFS_AVAIL(tp) >= MAX_SKB_FRAGS) + netif_wake_queue(dev); + } + + spin_unlock_irqrestore(&tp->lock, flags); + +out: + return ret; +err_stop: + netif_stop_queue(dev); + ret = NETDEV_TX_BUSY; + RTLDEV->stats.tx_dropped++; + + spin_unlock_irqrestore(&tp->lock, flags); + goto out; +} + +static void +rtl8168_tx_interrupt(struct net_device *dev, + struct rtl8168_private *tp, + void __iomem *ioaddr) +{ + unsigned int dirty_tx, tx_left; + + assert(dev != NULL); + assert(tp != NULL); + assert(ioaddr != NULL); + + dirty_tx = tp->dirty_tx; + smp_rmb(); + tx_left = tp->cur_tx - dirty_tx; + + while (tx_left > 0) { + unsigned int entry = dirty_tx % NUM_TX_DESC; + struct ring_info *tx_skb = tp->tx_skb + entry; + u32 len = tx_skb->len; + u32 status; + + rmb(); + status = le32_to_cpu(tp->TxDescArray[entry].opts1); + if (status & DescOwn) + break; + + RTLDEV->stats.tx_bytes += len; + RTLDEV->stats.tx_packets++; + + rtl8168_unmap_tx_skb(tp->pci_dev, + tx_skb, + tp->TxDescArray + entry); + + if (tx_skb->skb!=NULL) { + dev_kfree_skb_irq(tx_skb->skb); + tx_skb->skb = NULL; + } + dirty_tx++; + tx_left--; + } + + if (tp->dirty_tx != dirty_tx) { + tp->dirty_tx = dirty_tx; + smp_wmb(); + if (netif_queue_stopped(dev) && + (TX_BUFFS_AVAIL(tp) >= MAX_SKB_FRAGS)) { + netif_wake_queue(dev); + } + smp_rmb(); + if (tp->cur_tx != dirty_tx) + RTL_W8(TxPoll, NPQ); + } +} + +static inline int +rtl8168_fragmented_frame(u32 status) +{ + return (status & (FirstFrag | LastFrag)) != (FirstFrag | LastFrag); +} + +static inline void +rtl8168_rx_csum(struct rtl8168_private *tp, + struct sk_buff *skb, + struct RxDesc *desc) +{ + u32 opts1 = le32_to_cpu(desc->opts1); + u32 opts2 = le32_to_cpu(desc->opts2); + u32 status = opts1 & RxProtoMask; + + if ((tp->mcfg == CFG_METHOD_1) || + (tp->mcfg == CFG_METHOD_2) || + (tp->mcfg == CFG_METHOD_3)) { + /* rx csum offload for RTL8168B/8111B */ + if (((status == RxProtoTCP) && !(opts1 & RxTCPF)) || + ((status == RxProtoUDP) && !(opts1 & RxUDPF)) || + ((status == RxProtoIP) && !(opts1 & RxIPF))) + skb->ip_summed = CHECKSUM_UNNECESSARY; + else + skb->ip_summed = CHECKSUM_NONE; + } else { + /* rx csum offload for RTL8168C/8111C and RTL8168CP/8111CP */ + if (((status == RxTCPT) && !(opts1 & RxTCPF)) || + ((status == RxUDPT) && !(opts1 & RxUDPF)) || + ((status == 0) && (opts2 & RxV4F) && !(opts1 & RxIPF))) + skb->ip_summed = CHECKSUM_UNNECESSARY; + else + skb->ip_summed = CHECKSUM_NONE; + } +} + +static inline int +rtl8168_try_rx_copy(struct sk_buff **sk_buff, + int pkt_size, + struct RxDesc *desc, + int rx_buf_sz) +{ + int ret = -1; + + if (pkt_size < rx_copybreak) { + struct sk_buff *skb; + + skb = dev_alloc_skb(pkt_size + RTK_RX_ALIGN); + if (skb) { + u8 *data; + + data = sk_buff[0]->data; + skb_reserve(skb, RTK_RX_ALIGN); +#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,4,37) + prefetch(data - RTK_RX_ALIGN); +#endif + eth_copy_and_sum(skb, data, pkt_size, 0); + *sk_buff = skb; + rtl8168_mark_to_asic(desc, rx_buf_sz); + ret = 0; + } + } + return ret; +} + +static inline void +rtl8168_rx_skb(struct rtl8168_private *tp, + struct sk_buff *skb) +{ +#ifdef CONFIG_R8168_NAPI +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,29) + netif_receive_skb(skb); +#else + napi_gro_receive(&tp->napi, skb); +#endif +#else + netif_rx(skb); +#endif +} + +static int +rtl8168_rx_interrupt(struct net_device *dev, + struct rtl8168_private *tp, + void __iomem *ioaddr, u32 budget) +{ + unsigned int cur_rx, rx_left; + unsigned int delta, count = 0; + unsigned int entry; + struct RxDesc *desc; + u32 status; + u32 rx_quota = RTL_RX_QUOTA(dev, budget); + + assert(dev != NULL); + assert(tp != NULL); + assert(ioaddr != NULL); + + if ((tp->RxDescArray == NULL) || (tp->Rx_skbuff == NULL)) + goto rx_out; + + cur_rx = tp->cur_rx; + entry = cur_rx % NUM_RX_DESC; + desc = tp->RxDescArray + entry; + rx_left = NUM_RX_DESC + tp->dirty_rx - cur_rx; + rx_left = rtl8168_rx_quota(rx_left, (u32)rx_quota); + + for (; rx_left > 0; rx_left--) { + rmb(); + status = le32_to_cpu(desc->opts1); + if (status & DescOwn) + break; + if (unlikely(status & RxRES)) { + if (netif_msg_rx_err(tp)) { + printk(KERN_INFO + "%s: Rx ERROR. status = %08x\n", + dev->name, status); + } + + RTLDEV->stats.rx_errors++; + + if (status & (RxRWT | RxRUNT)) + RTLDEV->stats.rx_length_errors++; + if (status & RxCRC) + RTLDEV->stats.rx_crc_errors++; + rtl8168_mark_to_asic(desc, tp->rx_buf_sz); + } else { + struct sk_buff *skb = tp->Rx_skbuff[entry]; + int pkt_size = (status & 0x00003FFF) - 4; + void (*pci_action)(struct pci_dev *, dma_addr_t, + size_t, int) = pci_dma_sync_single_for_device; + + /* + * The driver does not support incoming fragmented + * frames. They are seen as a symptom of over-mtu + * sized frames. + */ + if (unlikely(rtl8168_fragmented_frame(status))) { + RTLDEV->stats.rx_dropped++; + RTLDEV->stats.rx_length_errors++; + rtl8168_mark_to_asic(desc, tp->rx_buf_sz); + continue; + } + + if (tp->cp_cmd & RxChkSum) + rtl8168_rx_csum(tp, skb, desc); + + pci_dma_sync_single_for_cpu(tp->pci_dev, + le64_to_cpu(desc->addr), tp->rx_buf_sz, + PCI_DMA_FROMDEVICE); + + if (rtl8168_try_rx_copy(&skb, pkt_size, desc, + tp->rx_buf_sz)) { + pci_action = pci_unmap_single; + tp->Rx_skbuff[entry] = NULL; + } + + pci_action(tp->pci_dev, le64_to_cpu(desc->addr), + tp->rx_buf_sz, PCI_DMA_FROMDEVICE); + + skb->dev = dev; + skb_put(skb, pkt_size); + skb->protocol = eth_type_trans(skb, dev); + + if (rtl8168_rx_vlan_skb(tp, desc, skb) < 0) + rtl8168_rx_skb(tp, skb); + + dev->last_rx = jiffies; + RTLDEV->stats.rx_bytes += pkt_size; + RTLDEV->stats.rx_packets++; + } + + cur_rx++; + entry = cur_rx % NUM_RX_DESC; + desc = tp->RxDescArray + entry; +#if LINUX_VERSION_CODE >= KERNEL_VERSION(2,4,37) + prefetch(desc); +#endif + } + + count = cur_rx - tp->cur_rx; + tp->cur_rx = cur_rx; + + delta = rtl8168_rx_fill(tp, dev, tp->dirty_rx, tp->cur_rx); + if (!delta && count && netif_msg_intr(tp)) + printk(KERN_INFO "%s: no Rx buffer allocated\n", dev->name); + tp->dirty_rx += delta; + + /* + * FIXME: until there is periodic timer to try and refill the ring, + * a temporary shortage may definitely kill the Rx process. + * - disable the asic to try and avoid an overflow and kick it again + * after refill ? + * - how do others driver handle this condition (Uh oh...). + */ + if ((tp->dirty_rx + NUM_RX_DESC == tp->cur_rx) && netif_msg_intr(tp)) + printk(KERN_EMERG "%s: Rx buffers exhausted\n", dev->name); + +rx_out: + return count; +} + +/* + *The interrupt handler does all of the Rx thread work and cleans up after + *the Tx thread. + */ +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,19) +static irqreturn_t rtl8168_interrupt(int irq, void *dev_instance, struct pt_regs *regs) +#else +static irqreturn_t rtl8168_interrupt(int irq, void *dev_instance) +#endif +{ + struct net_device *dev = (struct net_device *) dev_instance; + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + int status; + int handled = 0; + + do { + status = RTL_R16(IntrStatus); + + if(!(tp->features & RTL_FEATURE_MSI)) { + /* hotplug/major error/no more work/shared irq */ + if ((status == 0xFFFF) || !status) + break; + + if (!(status & (tp->intr_mask | tp->timer_intr_mask))) + break; + + if (unlikely(!netif_running(dev))) { + break; + } + } + + handled = 1; + + rtl8168_disable_hw_interrupt(tp, ioaddr); + + switch (tp->mcfg) { + case CFG_METHOD_9: + case CFG_METHOD_10: + case CFG_METHOD_11: + case CFG_METHOD_12: + case CFG_METHOD_13: + case CFG_METHOD_14: + case CFG_METHOD_15: + case CFG_METHOD_16: + case CFG_METHOD_17: + case CFG_METHOD_18: + case CFG_METHOD_19: + case CFG_METHOD_20: + case CFG_METHOD_21: + case CFG_METHOD_22: + case CFG_METHOD_23: + case CFG_METHOD_24: + case CFG_METHOD_25: + case CFG_METHOD_26: + case CFG_METHOD_27: + case CFG_METHOD_28: + case CFG_METHOD_29: + case CFG_METHOD_30: + /* RX_OVERFLOW RE-START mechanism now HW handles it automatically*/ + RTL_W16(IntrStatus, status&~RxFIFOOver); + break; + default: + RTL_W16(IntrStatus, status); + break; + } + + //Work around for rx fifo overflow + if (unlikely(status & RxFIFOOver)) { + if (tp->mcfg == CFG_METHOD_1) { + netif_stop_queue(dev); + udelay(300); + rtl8168_hw_reset(dev); + rtl8168_tx_clear(tp); + rtl8168_rx_clear(tp); + rtl8168_init_ring(dev); + rtl8168_hw_start(dev); + netif_wake_queue(dev); + } + } + +#ifdef ENABLE_DASH_SUPPORT + if ( tp->DASH ) { + if( HW_DASH_SUPPORT_TYPE_2( tp ) ) { + u8 DashIntType2Status; + + DashIntType2Status = RTL_R8(IBISR0); + if (DashIntType2Status & ISRIMR_DASH_TYPE2_ROK) { + tp->RcvFwDashOkEvt = TRUE; + } + if (DashIntType2Status & ISRIMR_DASH_TYPE2_TOK) { + tp->SendFwHostOkEvt = TRUE; + } + if(DashIntType2Status & ISRIMR_DASH_TYPE2_RX_DISABLE_IDLE) { + tp->DashFwDisableRx = TRUE; + } + + RTL_W8(IBISR0, DashIntType2Status); + + //hau_dbg + //printk("status = %X DashIntType2Status = %X.\n", status, DashIntType2Status); + } else { + if (IntrStatus & ISRIMR_DP_REQSYS_OK) { + tp->RcvFwReqSysOkEvt = TRUE; + } + if (IntrStatus & ISRIMR_DP_DASH_OK) { + tp->RcvFwDashOkEvt = TRUE; + } + if (IntrStatus & ISRIMR_DP_HOST_OK) { + tp->SendFwHostOkEvt = TRUE; + } + } + } +#endif + +#ifdef CONFIG_R8168_NAPI + if (status & tp->intr_mask || tp->keep_intr_cnt > 0) { + if (tp->keep_intr_cnt > 0) tp->keep_intr_cnt--; + + if (likely(RTL_NETIF_RX_SCHEDULE_PREP(dev, &tp->napi))) + __RTL_NETIF_RX_SCHEDULE(dev, &tp->napi); + else if (netif_msg_intr(tp)) + printk(KERN_INFO "%s: interrupt %04x in poll\n", + dev->name, status); + } else { + tp->keep_intr_cnt = RTK_KEEP_INTERRUPT_COUNT; + rtl8168_switch_to_hw_interrupt(tp, ioaddr); + } +#else + if (status & tp->intr_mask || tp->keep_intr_cnt > 0) { + if (tp->keep_intr_cnt > 0) tp->keep_intr_cnt--; + + rtl8168_rx_interrupt(dev, tp, tp->mmio_addr, ~(u32)0); + rtl8168_tx_interrupt(dev, tp, ioaddr); + +#ifdef ENABLE_DASH_SUPPORT + if ( tp->DASH ) { + struct net_device *dev = tp->dev; + + HandleDashInterrupt(dev); + } +#endif + + rtl8168_switch_to_timer_interrupt(tp, ioaddr); + } else { + tp->keep_intr_cnt = RTK_KEEP_INTERRUPT_COUNT; + rtl8168_switch_to_hw_interrupt(tp, ioaddr); + } +#endif + + } while (false); + + return IRQ_RETVAL(handled); +} + +#ifdef CONFIG_R8168_NAPI +static int rtl8168_poll(napi_ptr napi, napi_budget budget) +{ + struct rtl8168_private *tp = RTL_GET_PRIV(napi, struct rtl8168_private); + void __iomem *ioaddr = tp->mmio_addr; + RTL_GET_NETDEV(tp) + unsigned int work_to_do = RTL_NAPI_QUOTA(budget, dev); + unsigned int work_done; + unsigned long flags; + + work_done = rtl8168_rx_interrupt(dev, tp, ioaddr, (u32) budget); + + spin_lock_irqsave(&tp->lock, flags); + rtl8168_tx_interrupt(dev, tp, ioaddr); + spin_unlock_irqrestore(&tp->lock, flags); + + RTL_NAPI_QUOTA_UPDATE(dev, work_done, budget); + + if (work_done < work_to_do) { +#ifdef ENABLE_DASH_SUPPORT + if ( tp->DASH ) { + struct net_device *dev = tp->dev; + + spin_lock_irqsave(&tp->lock, flags); + HandleDashInterrupt(dev); + spin_unlock_irqrestore(&tp->lock, flags); + } +#endif + + RTL_NETIF_RX_COMPLETE(dev, napi); + /* + * 20040426: the barrier is not strictly required but the + * behavior of the irq handler could be less predictable + * without it. Btw, the lack of flush for the posted pci + * write is safe - FR + */ + smp_wmb(); + + rtl8168_switch_to_timer_interrupt(tp, ioaddr); + } + + return RTL_NAPI_RETURN_VALUE; +} +#endif//CONFIG_R8168_NAPI + +static void rtl8168_sleep_rx_enable(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + void __iomem *ioaddr = tp->mmio_addr; + + if ((tp->mcfg == CFG_METHOD_1) || (tp->mcfg == CFG_METHOD_2)) { + RTL_W8(ChipCmd, CmdReset); + rtl8168_rx_desc_offset0_init(tp, 0); + RTL_W8(ChipCmd, CmdRxEnb); + } else if (tp->mcfg == CFG_METHOD_14 || tp->mcfg == CFG_METHOD_15) { + rtl8168_ephy_write(ioaddr, 0x19, 0xFF64); + RTL_W32(RxConfig, RTL_R32(RxConfig) | AcceptBroadcast | AcceptMulticast | AcceptMyPhys); + } +} + +static void rtl8168_down(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + unsigned long flags; + + rtl8168_delete_esd_timer(dev, &tp->esd_timer); + + rtl8168_delete_link_timer(dev, &tp->link_timer); + +#ifdef CONFIG_R8168_NAPI +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,23) + napi_disable(&tp->napi); +#endif +#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2,6,23)) && (LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0)) + netif_poll_disable(dev); +#endif +#endif + + netif_stop_queue(dev); + +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,11) + /* Give a racing hard_start_xmit a few cycles to complete. */ + synchronize_sched(); /* FIXME: should this be synchronize_irq()? */ +#endif + + spin_lock_irqsave(&tp->lock, flags); + + netif_carrier_off(dev); + + rtl8168_dsm(dev, DSM_IF_DOWN); + + rtl8168_hw_reset(dev); + + spin_unlock_irqrestore(&tp->lock, flags); + + synchronize_irq(dev->irq); + + spin_lock_irqsave(&tp->lock, flags); + + rtl8168_tx_clear(tp); + + rtl8168_rx_clear(tp); + + rtl8168_sleep_rx_enable(dev); + + spin_unlock_irqrestore(&tp->lock, flags); +} + +static int rtl8168_close(struct net_device *dev) +{ + struct rtl8168_private *tp = netdev_priv(dev); + struct pci_dev *pdev = tp->pci_dev; + + if (tp->TxDescArray!=NULL && tp->RxDescArray!=NULL) { + rtl8168_cancel_schedule_work(dev); + + rtl8168_down(dev); + + rtl8168_hw_d3_para(dev); + + rtl8168_powerdown_pll(dev); + + free_irq(dev->irq, dev); + + pci_free_consistent(pdev, R8168_RX_RING_BYTES, tp->RxDescArray, + tp->RxPhyAddr); + pci_free_consistent(pdev, R8168_TX_RING_BYTES, tp->TxDescArray, + tp->TxPhyAddr); + tp->TxDescArray = NULL; + tp->RxDescArray = NULL; + + if (tp->tally_vaddr != NULL) { + pci_free_consistent(pdev, sizeof(*tp->tally_vaddr), tp->tally_vaddr, tp->tally_paddr); + tp->tally_vaddr = NULL; + } + + if (tp->ShortPacketEmptyBuffer != NULL) { + pci_free_consistent(pdev, SHORT_PACKET_PADDING_BUF_SIZE, tp->ShortPacketEmptyBuffer, + tp->ShortPacketEmptyBufferPhy); + tp->ShortPacketEmptyBuffer = NULL; + } + } + + return 0; +} + +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,11) +static void rtl8168_shutdown(struct pci_dev *pdev) +{ + struct net_device *dev = pci_get_drvdata(pdev); + struct rtl8168_private *tp = netdev_priv(dev); + + switch (tp->mcfg) { + case CFG_METHOD_11: + case CFG_METHOD_12: + case CFG_METHOD_13: + case CFG_METHOD_23: + case CFG_METHOD_27: + case CFG_METHOD_28: + if (tp->DASH) + rtl8168_driver_stop(tp); + break; + } + + rtl8168_set_bios_setting(dev); + rtl8168_rar_set(tp, tp->org_mac_addr); + +#ifdef ENABLE_REALWOW_SUPPORT + set_realwow_d3_para(dev); +#endif + + if (s5wol == 0) + tp->wol_enabled = WOL_DISABLED; + + rtl8168_close(dev); + rtl8168_disable_msi(pdev, tp); +} +#endif + +/** + * rtl8168_get_stats - Get rtl8168 read/write statistics + * @dev: The Ethernet Device to get statistics for + * + * Get TX/RX statistics for rtl8168 + */ +static struct +net_device_stats *rtl8168_get_stats(struct net_device *dev) +{ +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,22) + struct rtl8168_private *tp = netdev_priv(dev); +#endif + if (netif_running(dev)) { +// spin_lock_irqsave(&tp->lock, flags); +// spin_unlock_irqrestore(&tp->lock, flags); + } + + return &RTLDEV->stats; +} + +#ifdef CONFIG_PM + +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,11) +static int +rtl8168_suspend(struct pci_dev *pdev, u32 state) +#else +static int +rtl8168_suspend(struct pci_dev *pdev, pm_message_t state) +#endif +{ + struct net_device *dev = pci_get_drvdata(pdev); + struct rtl8168_private *tp = netdev_priv(dev); +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,10) + u32 pci_pm_state = pci_choose_state(pdev, state); +#endif + unsigned long flags; + + if (!netif_running(dev)) + goto out; + + rtl8168_cancel_schedule_work(dev); + + rtl8168_delete_esd_timer(dev, &tp->esd_timer); + + rtl8168_delete_link_timer(dev, &tp->link_timer); + + netif_stop_queue(dev); + + netif_carrier_off(dev); + + rtl8168_dsm(dev, DSM_NIC_GOTO_D3); + + netif_device_detach(dev); + + spin_lock_irqsave(&tp->lock, flags); + + rtl8168_hw_reset(dev); + + rtl8168_sleep_rx_enable(dev); + + rtl8168_hw_d3_para(dev); + +#ifdef ENABLE_REALWOW_SUPPORT + set_realwow_d3_para(dev); +#endif + + rtl8168_powerdown_pll(dev); + + spin_unlock_irqrestore(&tp->lock, flags); + + switch (tp->mcfg) { + case CFG_METHOD_11: + case CFG_METHOD_12: + case CFG_METHOD_13: + case CFG_METHOD_23: + case CFG_METHOD_27: + case CFG_METHOD_28: + if (tp->DASH) + rtl8168_driver_stop(tp); + break; + } + +out: + +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,10) + pci_save_state(pdev, &pci_pm_state); +#else + pci_save_state(pdev); +#endif + pci_enable_wake(pdev, pci_choose_state(pdev, state), tp->wol_enabled); +// pci_set_power_state(pdev, pci_choose_state(pdev, state)); + + return 0; +} + +static int +rtl8168_resume(struct pci_dev *pdev) +{ + struct net_device *dev = pci_get_drvdata(pdev); + struct rtl8168_private *tp = netdev_priv(dev); +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,10) + u32 pci_pm_state = PCI_D0; +#endif + + pci_set_power_state(pdev, PCI_D0); +#if LINUX_VERSION_CODE < KERNEL_VERSION(2,6,10) + pci_restore_state(pdev, &pci_pm_state); +#else + pci_restore_state(pdev); +#endif + pci_enable_wake(pdev, PCI_D0, 0); + + /* restore last modified mac address */ + rtl8168_rar_set(tp, dev->dev_addr); + + if (!netif_running(dev)) + goto out; + + rtl8168_exit_oob(dev); + + rtl8168_dsm(dev, DSM_NIC_RESUME_D3); + + rtl8168_hw_init(dev); + + rtl8168_powerup_pll(dev); + + rtl8168_hw_ephy_config(dev); + + rtl8168_hw_phy_config(dev); + + rtl8168_schedule_work(dev, rtl8168_reset_task); + + netif_device_attach(dev); + + mod_timer(&tp->esd_timer, jiffies + RTL8168_ESD_TIMEOUT); + mod_timer(&tp->link_timer, jiffies + RTL8168_LINK_TIMEOUT); +out: + return 0; +} + +#endif /* CONFIG_PM */ + +static struct pci_driver rtl8168_pci_driver = { + .name = MODULENAME, + .id_table = rtl8168_pci_tbl, + .probe = rtl8168_init_one, + .remove = __devexit_p(rtl8168_remove_one), +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,11) + .shutdown = rtl8168_shutdown, +#endif +#ifdef CONFIG_PM + .suspend = rtl8168_suspend, + .resume = rtl8168_resume, +#endif +}; + +static int __init +rtl8168_init_module(void) +{ +#ifdef ENABLE_R8168_PROCFS + rtl8168_proc_module_init(); +#endif +#if LINUX_VERSION_CODE > KERNEL_VERSION(2,6,0) + return pci_register_driver(&rtl8168_pci_driver); +#else + return pci_module_init(&rtl8168_pci_driver); +#endif +} + +static void __exit +rtl8168_cleanup_module(void) +{ + pci_unregister_driver(&rtl8168_pci_driver); +#ifdef ENABLE_R8168_PROCFS + if (rtl8168_proc) { +#if LINUX_VERSION_CODE >= KERNEL_VERSION(3,10,0) + remove_proc_subtree(MODULENAME, init_net.proc_net); +#else + remove_proc_entry(MODULENAME, init_net.proc_net); +#endif + rtl8168_proc = NULL; + } +#endif +} + +module_init(rtl8168_init_module); +module_exit(rtl8168_cleanup_module); diff --git a/drivers/net/ethernet/realtek/r8168_realwow.h b/drivers/net/ethernet/realtek/r8168_realwow.h new file mode 100755 index 0000000..9f050fe --- /dev/null +++ b/drivers/net/ethernet/realtek/r8168_realwow.h @@ -0,0 +1,117 @@ +/* +################################################################################ +# +# r8168 is the Linux device driver released for Realtek Gigabit Ethernet +# controllers with PCI-Express interface. +# +# Copyright(c) 2015 Realtek Semiconductor Corp. All rights reserved. +# +# This program is free software; you can redistribute it and/or modify it +# under the terms of the GNU General Public License as published by the Free +# Software Foundation; either version 2 of the License, or (at your option) +# any later version. +# +# This program is distributed in the hope that it will be useful, but WITHOUT +# ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or +# FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for +# more details. +# +# You should have received a copy of the GNU General Public License along with +# this program; if not, see . +# +# Author: +# Realtek NIC software team +# No. 2, Innovation Road II, Hsinchu Science Park, Hsinchu 300, Taiwan +# +################################################################################ +*/ + +/************************************************************************************ + * This product is covered by one or more of the following patents: + * US6,570,884, US6,115,776, and US6,327,625. + ***********************************************************************************/ + +#ifndef _LINUX_R8168_REALWOW_H +#define _LINUX_R8168_REALWOW_H + +#define SIOCDEVPRIVATE_RTLREALWOW SIOCDEVPRIVATE+3 + +#define MAX_RealWoW_KCP_SIZE (100) +#define MAX_RealWoW_Payload (64) + +#define KA_TX_PACKET_SIZE (100) +#define KA_WAKEUP_PATTERN_SIZE (120) + +//HwSuppKeepAliveOffloadVer +#define HW_SUPPORT_KCP_OFFLOAD(_M) ((_M)->HwSuppKCPOffloadVer > 0) + +enum rtl_realwow_cmd { + + RTL_REALWOW_SET_KCP_DISABLE=0, + RTL_REALWOW_SET_KCP_INFO, + RTL_REALWOW_SET_KCP_CONTENT, + + RTL_REALWOW_SET_KCP_ACKPKTINFO, + RTL_REALWOW_SET_KCP_WPINFO, + RTL_REALWOW_SET_KCPDHCP_TIMEOUT, + + RTLT_REALWOW_COMMAND_INVALID +}; + +struct rtl_realwow_ioctl_struct { + __u32 cmd; + __u32 offset; + __u32 len; + union { + __u32 data; + void *data_buffer; + }; +}; + +typedef struct _MP_KCPInfo { + u8 DIPv4[4]; + u8 MacID[6]; + u16 UdpPort[2]; + u8 PKTLEN[2]; + + u16 ackLostCnt; + u8 KCP_WakePattern[MAX_RealWoW_Payload]; + u8 KCP_AckPacket[MAX_RealWoW_Payload]; + u32 KCP_interval; + u8 KCP_WakePattern_Len; + u8 KCP_AckPacket_Len; + u8 KCP_TxPacket[2][KA_TX_PACKET_SIZE]; +} MP_KCP_INFO, *PMP_KCP_INFO; + +typedef struct _KCPInfo { + u32 nId; // = id + u8 DIPv4[4]; + u8 MacID[6]; + u16 UdpPort; + u16 PKTLEN; +} KCPInfo, *PKCPInfo; + +typedef struct _KCPContent { + u32 id; // = id + u32 mSec; // = msec + u32 size; // =size + u8 bPacket[MAX_RealWoW_KCP_SIZE]; // put packet here +} KCPContent, *PKCPContent; + +typedef struct _RealWoWAckPktInfo { + u16 ackLostCnt; + u16 patterntSize; + u8 pattern[MAX_RealWoW_Payload]; +} RealWoWAckPktInfo,*PRealWoWAckPktInfo; + +typedef struct _RealWoWWPInfo { + u16 patterntSize; + u8 pattern[MAX_RealWoW_Payload]; +} RealWoWWPInfo,*PRealWoWWPInfo; + +int rtl8168_realwow_ioctl(struct net_device *dev, struct ifreq *ifr); +void realwow_hw_init(struct net_device *dev); +void get_realwow_hw_version(struct net_device *dev); +void set_realwow_d3_para(struct net_device *dev); + +#endif /* _LINUX_R8168_REALWOW_H */ \ No newline at end of file diff --git a/drivers/net/ethernet/realtek/rtl_eeprom.c b/drivers/net/ethernet/realtek/rtl_eeprom.c new file mode 100755 index 0000000..de0e008 --- /dev/null +++ b/drivers/net/ethernet/realtek/rtl_eeprom.c @@ -0,0 +1,291 @@ +/* +################################################################################ +# +# r8168 is the Linux device driver released for Realtek Gigabit Ethernet +# controllers with PCI-Express interface. +# +# Copyright(c) 2015 Realtek Semiconductor Corp. All rights reserved. +# +# This program is free software; you can redistribute it and/or modify it +# under the terms of the GNU General Public License as published by the Free +# Software Foundation; either version 2 of the License, or (at your option) +# any later version. +# +# This program is distributed in the hope that it will be useful, but WITHOUT +# ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or +# FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for +# more details. +# +# You should have received a copy of the GNU General Public License along with +# this program; if not, see . +# +# Author: +# Realtek NIC software team +# No. 2, Innovation Road II, Hsinchu Science Park, Hsinchu 300, Taiwan +# +################################################################################ +*/ + +/************************************************************************************ + * This product is covered by one or more of the following patents: + * US6,570,884, US6,115,776, and US6,327,625. + ***********************************************************************************/ + +#include +#include +#include +#include +#include +#include + +#include + +#include "r8168.h" +#include "rtl_eeprom.h" + +//------------------------------------------------------------------- +//rtl_eeprom_type(): +// tell the eeprom type +//return value: +// 0: the eeprom type is 93C46 +// 1: the eeprom type is 93C56 or 93C66 +//------------------------------------------------------------------- +void rtl_eeprom_type(struct rtl8168_private *tp) +{ + void __iomem *ioaddr=tp->mmio_addr; + u16 magic = 0; + + if (tp->mcfg == CFG_METHOD_DEFAULT) + goto out_no_eeprom; + + if(RTL_R8(0xD2)&0x04) { + //not support + //tp->eeprom_type = EEPROM_TWSI; + //tp->eeprom_len = 256; + goto out_no_eeprom; + } else if(RTL_R32(RxConfig) & RxCfg_9356SEL) { + tp->eeprom_type = EEPROM_TYPE_93C56; + tp->eeprom_len = 256; + } else { + tp->eeprom_type = EEPROM_TYPE_93C46; + tp->eeprom_len = 128; + } + + magic = rtl_eeprom_read_sc(tp, 0); + +out_no_eeprom: + if ((magic != 0x8129) && (magic != 0x8128)) { + tp->eeprom_type = EEPROM_TYPE_NONE; + tp->eeprom_len = 0; + } +} + +void rtl_eeprom_cleanup(void __iomem *ioaddr) +{ + u8 x; + + x = RTL_R8(Cfg9346); + x &= ~(Cfg9346_EEDI | Cfg9346_EECS); + + RTL_W8(Cfg9346, x); + + rtl_raise_clock(&x, ioaddr); + rtl_lower_clock(&x, ioaddr); +} + +int rtl_eeprom_cmd_done(void __iomem *ioaddr) +{ + u8 x; + int i; + + rtl_stand_by(ioaddr); + + for (i = 0; i < 50000; i++) { + x = RTL_R8(Cfg9346); + + if (x & Cfg9346_EEDO) { + udelay(RTL_CLOCK_RATE * 2 * 3); + return 0; + } + udelay(1); + } + + return -1; +} + +//------------------------------------------------------------------- +//rtl_eeprom_read_sc(): +// read one word from eeprom +//------------------------------------------------------------------- +u16 rtl_eeprom_read_sc(struct rtl8168_private *tp, u16 reg) +{ + void __iomem *ioaddr=tp->mmio_addr; + int addr_sz = 6; + u8 x; + u16 data; + + if(tp->eeprom_type == EEPROM_TYPE_NONE) { + return -1; + } + + if (tp->eeprom_type==EEPROM_TYPE_93C46) + addr_sz = 6; + else if (tp->eeprom_type==EEPROM_TYPE_93C56) + addr_sz = 8; + + x = Cfg9346_EEM1 | Cfg9346_EECS; + RTL_W8(Cfg9346, x); + + rtl_shift_out_bits(RTL_EEPROM_READ_OPCODE, 3, ioaddr); + rtl_shift_out_bits(reg, addr_sz, ioaddr); + + data = rtl_shift_in_bits(ioaddr); + + rtl_eeprom_cleanup(ioaddr); + + RTL_W8(Cfg9346, 0); + + return data; +} + +//------------------------------------------------------------------- +//rtl_eeprom_write_sc(): +// write one word to a specific address in the eeprom +//------------------------------------------------------------------- +void rtl_eeprom_write_sc(struct rtl8168_private *tp, u16 reg, u16 data) +{ + void __iomem *ioaddr=tp->mmio_addr; + u8 x; + int addr_sz = 6; + int w_dummy_addr = 4; + + if(tp->eeprom_type == EEPROM_TYPE_NONE) { + return ; + } + + if (tp->eeprom_type==EEPROM_TYPE_93C46) { + addr_sz = 6; + w_dummy_addr = 4; + } else if (tp->eeprom_type==EEPROM_TYPE_93C56) { + addr_sz = 8; + w_dummy_addr = 6; + } + + x = Cfg9346_EEM1 | Cfg9346_EECS; + RTL_W8(Cfg9346, x); + + rtl_shift_out_bits(RTL_EEPROM_EWEN_OPCODE, 5, ioaddr); + rtl_shift_out_bits(reg, w_dummy_addr, ioaddr); + rtl_stand_by(ioaddr); + + rtl_shift_out_bits(RTL_EEPROM_ERASE_OPCODE, 3, ioaddr); + rtl_shift_out_bits(reg, addr_sz, ioaddr); + if (rtl_eeprom_cmd_done(ioaddr) < 0) { + return; + } + rtl_stand_by(ioaddr); + + rtl_shift_out_bits(RTL_EEPROM_WRITE_OPCODE, 3, ioaddr); + rtl_shift_out_bits(reg, addr_sz, ioaddr); + rtl_shift_out_bits(data, 16, ioaddr); + if (rtl_eeprom_cmd_done(ioaddr) < 0) { + return; + } + rtl_stand_by(ioaddr); + + rtl_shift_out_bits(RTL_EEPROM_EWDS_OPCODE, 5, ioaddr); + rtl_shift_out_bits(reg, w_dummy_addr, ioaddr); + + rtl_eeprom_cleanup(ioaddr); + RTL_W8(Cfg9346, 0); +} + +void rtl_raise_clock(u8 *x, void __iomem *ioaddr) +{ + *x = *x | Cfg9346_EESK; + RTL_W8(Cfg9346, *x); + udelay(RTL_CLOCK_RATE); +} + +void rtl_lower_clock(u8 *x, void __iomem *ioaddr) +{ + + *x = *x & ~Cfg9346_EESK; + RTL_W8(Cfg9346, *x); + udelay(RTL_CLOCK_RATE); +} + +void rtl_shift_out_bits(int data, int count, void __iomem *ioaddr) +{ + u8 x; + int mask; + + mask = 0x01 << (count - 1); + x = RTL_R8(Cfg9346); + x &= ~(Cfg9346_EEDI | Cfg9346_EEDO); + + do { + if (data & mask) + x |= Cfg9346_EEDI; + else + x &= ~Cfg9346_EEDI; + + RTL_W8(Cfg9346, x); + udelay(RTL_CLOCK_RATE); + rtl_raise_clock(&x, ioaddr); + rtl_lower_clock(&x, ioaddr); + mask = mask >> 1; + } while(mask); + + x &= ~Cfg9346_EEDI; + RTL_W8(Cfg9346, x); +} + +u16 rtl_shift_in_bits(void __iomem *ioaddr) +{ + u8 x; + u16 d, i; + + x = RTL_R8(Cfg9346); + x &= ~(Cfg9346_EEDI | Cfg9346_EEDO); + + d = 0; + + for (i = 0; i < 16; i++) { + d = d << 1; + rtl_raise_clock(&x, ioaddr); + + x = RTL_R8(Cfg9346); + x &= ~Cfg9346_EEDI; + + if (x & Cfg9346_EEDO) + d |= 1; + + rtl_lower_clock(&x, ioaddr); + } + + return d; +} + +void rtl_stand_by(void __iomem *ioaddr) +{ + u8 x; + + x = RTL_R8(Cfg9346); + x &= ~(Cfg9346_EECS | Cfg9346_EESK); + RTL_W8(Cfg9346, x); + udelay(RTL_CLOCK_RATE); + + x |= Cfg9346_EECS; + RTL_W8(Cfg9346, x); +} + +void rtl_set_eeprom_sel_low(void __iomem *ioaddr) +{ + RTL_W8(Cfg9346, Cfg9346_EEM1); + RTL_W8(Cfg9346, Cfg9346_EEM1 | Cfg9346_EESK); + + udelay(20); + + RTL_W8(Cfg9346, Cfg9346_EEM1); +} diff --git a/drivers/net/ethernet/realtek/rtl_eeprom.h b/drivers/net/ethernet/realtek/rtl_eeprom.h new file mode 100755 index 0000000..fd6ffbd --- /dev/null +++ b/drivers/net/ethernet/realtek/rtl_eeprom.h @@ -0,0 +1,55 @@ +/* +################################################################################ +# +# r8168 is the Linux device driver released for Realtek Gigabit Ethernet +# controllers with PCI-Express interface. +# +# Copyright(c) 2015 Realtek Semiconductor Corp. All rights reserved. +# +# This program is free software; you can redistribute it and/or modify it +# under the terms of the GNU General Public License as published by the Free +# Software Foundation; either version 2 of the License, or (at your option) +# any later version. +# +# This program is distributed in the hope that it will be useful, but WITHOUT +# ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or +# FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for +# more details. +# +# You should have received a copy of the GNU General Public License along with +# this program; if not, see . +# +# Author: +# Realtek NIC software team +# No. 2, Innovation Road II, Hsinchu Science Park, Hsinchu 300, Taiwan +# +################################################################################ +*/ + +/************************************************************************************ + * This product is covered by one or more of the following patents: + * US6,570,884, US6,115,776, and US6,327,625. + ***********************************************************************************/ + +//EEPROM opcodes +#define RTL_EEPROM_READ_OPCODE 06 +#define RTL_EEPROM_WRITE_OPCODE 05 +#define RTL_EEPROM_ERASE_OPCODE 07 +#define RTL_EEPROM_EWEN_OPCODE 19 +#define RTL_EEPROM_EWDS_OPCODE 16 + +#define RTL_CLOCK_RATE 3 + +void rtl_eeprom_type(struct rtl8168_private *tp); +void rtl_eeprom_cleanup(void __iomem *ioaddr); +u16 rtl_eeprom_read_sc(struct rtl8168_private *tp, u16 reg); +void rtl_eeprom_write_sc(struct rtl8168_private *tp, u16 reg, u16 data); +void rtl_shift_out_bits(int data, int count, void __iomem *ioaddr); +u16 rtl_shift_in_bits(void __iomem *ioaddr); +void rtl_raise_clock(u8 *x, void __iomem *ioaddr); +void rtl_lower_clock(u8 *x, void __iomem *ioaddr); +void rtl_stand_by(void __iomem *ioaddr); +void rtl_set_eeprom_sel_low(void __iomem *ioaddr); + + + diff --git a/drivers/net/ethernet/realtek/rtltool.c b/drivers/net/ethernet/realtek/rtltool.c new file mode 100755 index 0000000..d84fc4a --- /dev/null +++ b/drivers/net/ethernet/realtek/rtltool.c @@ -0,0 +1,304 @@ +#include +#include +#include +#include +#include +#include +#include +#include "r8168.h" +#include "rtl_eeprom.h" +#include "rtltool.h" + +int rtltool_ioctl(struct rtl8168_private *tp, struct ifreq *ifr) +{ + struct rtltool_cmd my_cmd; + unsigned long flags, flags2; + int ret; + + if (copy_from_user(&my_cmd, ifr->ifr_data, sizeof(my_cmd))) + return -EFAULT; + + ret = 0; + switch (my_cmd.cmd) { + case RTLTOOL_READ_MAC: + if (!capable(CAP_NET_ADMIN)) + return -EPERM; + + if (my_cmd.len==1) + my_cmd.data = readb(tp->mmio_addr+my_cmd.offset); + else if (my_cmd.len==2) + my_cmd.data = readw(tp->mmio_addr+(my_cmd.offset&~1)); + else if (my_cmd.len==4) + my_cmd.data = readl(tp->mmio_addr+(my_cmd.offset&~3)); + else { + ret = -EOPNOTSUPP; + break; + } + + if (copy_to_user(ifr->ifr_data, &my_cmd, sizeof(my_cmd))) { + ret = -EFAULT; + break; + } + break; + + case RTLTOOL_WRITE_MAC: + if (!capable(CAP_NET_ADMIN)) + return -EPERM; + + if (my_cmd.len==1) + writeb(my_cmd.data, tp->mmio_addr+my_cmd.offset); + else if (my_cmd.len==2) + writew(my_cmd.data, tp->mmio_addr+(my_cmd.offset&~1)); + else if (my_cmd.len==4) + writel(my_cmd.data, tp->mmio_addr+(my_cmd.offset&~3)); + else { + ret = -EOPNOTSUPP; + break; + } + + break; + + case RTLTOOL_READ_PHY: + if (!capable(CAP_NET_ADMIN)) + return -EPERM; + + spin_lock_irqsave(&tp->phy_lock, flags); + my_cmd.data = mdio_read(tp, my_cmd.offset); + spin_unlock_irqrestore(&tp->phy_lock, flags); + + if (copy_to_user(ifr->ifr_data, &my_cmd, sizeof(my_cmd))) { + ret = -EFAULT; + break; + } + + break; + + case RTLTOOL_WRITE_PHY: + if (!capable(CAP_NET_ADMIN)) + return -EPERM; + + spin_lock_irqsave(&tp->phy_lock, flags); + mdio_prot_write(tp, my_cmd.offset, my_cmd.data); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + + case RTLTOOL_READ_EPHY: + if (!capable(CAP_NET_ADMIN)) + return -EPERM; + + spin_lock_irqsave(&tp->phy_lock, flags); + my_cmd.data = rtl8168_ephy_read(tp->mmio_addr, my_cmd.offset); + spin_unlock_irqrestore(&tp->phy_lock, flags); + + if (copy_to_user(ifr->ifr_data, &my_cmd, sizeof(my_cmd))) { + ret = -EFAULT; + break; + } + + break; + + case RTLTOOL_WRITE_EPHY: + if (!capable(CAP_NET_ADMIN)) + return -EPERM; + + spin_lock_irqsave(&tp->phy_lock, flags); + rtl8168_ephy_write(tp->mmio_addr, my_cmd.offset, my_cmd.data); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + + case RTLTOOL_READ_ERI: + my_cmd.data = 0; + if (my_cmd.len==1 || my_cmd.len==2 || my_cmd.len==4) { + spin_lock_irqsave(&tp->phy_lock, flags); + my_cmd.data = rtl8168_eri_read(tp->mmio_addr, my_cmd.offset, my_cmd.len, ERIAR_ExGMAC); + spin_unlock_irqrestore(&tp->phy_lock, flags); + } else { + ret = -EOPNOTSUPP; + break; + } + + if (copy_to_user(ifr->ifr_data, &my_cmd, sizeof(my_cmd))) { + ret = -EFAULT; + break; + } + + break; + + case RTLTOOL_WRITE_ERI: + if (!capable(CAP_NET_ADMIN)) + return -EPERM; + + if (!capable(CAP_NET_ADMIN)) + return -EPERM; + + if (my_cmd.len==1 || my_cmd.len==2 || my_cmd.len==4) { + spin_lock_irqsave(&tp->phy_lock, flags); + rtl8168_eri_write(tp->mmio_addr, my_cmd.offset, my_cmd.len, my_cmd.data, ERIAR_ExGMAC); + spin_unlock_irqrestore(&tp->phy_lock, flags); + } else { + ret = -EOPNOTSUPP; + break; + } + break; + + case RTLTOOL_READ_PCI: + if (!capable(CAP_NET_ADMIN)) + return -EPERM; + + my_cmd.data = 0; + if (my_cmd.len==1) + pci_read_config_byte(tp->pci_dev, my_cmd.offset, + (u8 *)&my_cmd.data); + else if (my_cmd.len==2) + pci_read_config_word(tp->pci_dev, my_cmd.offset, + (u16 *)&my_cmd.data); + else if (my_cmd.len==4) + pci_read_config_dword(tp->pci_dev, my_cmd.offset, + &my_cmd.data); + else { + ret = -EOPNOTSUPP; + break; + } + + if (copy_to_user(ifr->ifr_data, &my_cmd, sizeof(my_cmd))) { + ret = -EFAULT; + break; + } + break; + + case RTLTOOL_WRITE_PCI: + if (!capable(CAP_NET_ADMIN)) + return -EPERM; + + if (my_cmd.len==1) + pci_write_config_byte(tp->pci_dev, my_cmd.offset, + my_cmd.data); + else if (my_cmd.len==2) + pci_write_config_word(tp->pci_dev, my_cmd.offset, + my_cmd.data); + else if (my_cmd.len==4) + pci_write_config_dword(tp->pci_dev, my_cmd.offset, + my_cmd.data); + else { + ret = -EOPNOTSUPP; + break; + } + + break; + + case RTLTOOL_READ_EEPROM: + if (!capable(CAP_NET_ADMIN)) + return -EPERM; + + spin_lock_irqsave(&tp->phy_lock, flags); + my_cmd.data = rtl_eeprom_read_sc(tp, my_cmd.offset); + spin_unlock_irqrestore(&tp->phy_lock, flags); + + if (copy_to_user(ifr->ifr_data, &my_cmd, sizeof(my_cmd))) { + ret = -EFAULT; + break; + } + + break; + + case RTLTOOL_WRITE_EEPROM: + if (!capable(CAP_NET_ADMIN)) + return -EPERM; + + spin_lock_irqsave(&tp->phy_lock, flags); + rtl_eeprom_write_sc(tp, my_cmd.offset, my_cmd.data); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + + case RTL_READ_OOB_MAC: + if (!capable(CAP_NET_ADMIN)) + return -EPERM; + + spin_lock_irqsave(&tp->phy_lock, flags); + OOB_mutex_lock(tp); + my_cmd.data = OCP_read(tp, my_cmd.offset, 4); + OOB_mutex_unlock(tp); + spin_unlock_irqrestore(&tp->phy_lock, flags); + + if (copy_to_user(ifr->ifr_data, &my_cmd, sizeof(my_cmd))) { + ret = -EFAULT; + break; + } + break; + + case RTL_WRITE_OOB_MAC: + if (!capable(CAP_NET_ADMIN)) + return -EPERM; + + if (my_cmd.len == 0 || my_cmd.len > 4) + return -EOPNOTSUPP; + + spin_lock_irqsave(&tp->phy_lock, flags); + OOB_mutex_lock(tp); + OCP_write(tp, my_cmd.offset, my_cmd.len, my_cmd.data); + OOB_mutex_unlock(tp); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + + case RTL_ENABLE_PCI_DIAG: + if (!capable(CAP_NET_ADMIN)) + return -EPERM; + + spin_lock_irqsave(&tp->lock, flags); + spin_lock_irqsave(&tp->phy_lock, flags2); + tp->rtk_enable_diag = 1; + spin_unlock_irqrestore(&tp->phy_lock, flags2); + spin_unlock_irqrestore(&tp->lock, flags); + + dprintk("enable rtk diag\n"); + break; + + case RTL_DISABLE_PCI_DIAG: + if (!capable(CAP_NET_ADMIN)) + return -EPERM; + + spin_lock_irqsave(&tp->lock, flags); + spin_lock_irqsave(&tp->phy_lock, flags2); + tp->rtk_enable_diag = 0; + spin_unlock_irqrestore(&tp->phy_lock, flags2); + spin_unlock_irqrestore(&tp->lock, flags); + + dprintk("disable rtk diag\n"); + break; + + case RTL_READ_MAC_OCP: + if (!capable(CAP_NET_ADMIN)) + return -EPERM; + + if (my_cmd.offset % 2) + return -EOPNOTSUPP; + + spin_lock_irqsave(&tp->phy_lock, flags); + my_cmd.data = mac_ocp_read(tp, my_cmd.offset); + spin_unlock_irqrestore(&tp->phy_lock, flags); + + if (copy_to_user(ifr->ifr_data, &my_cmd, sizeof(my_cmd))) { + ret = -EFAULT; + break; + } + break; + + case RTL_WRITE_MAC_OCP: + if (!capable(CAP_NET_ADMIN)) + return -EPERM; + + if ((my_cmd.offset % 2) || (my_cmd.len != 2)) + return -EOPNOTSUPP; + + spin_lock_irqsave(&tp->phy_lock, flags); + mac_ocp_write(tp, my_cmd.offset, (u16)my_cmd.data); + spin_unlock_irqrestore(&tp->phy_lock, flags); + break; + + default: + ret = -EOPNOTSUPP; + break; + } + + return ret; +} diff --git a/drivers/net/ethernet/realtek/rtltool.h b/drivers/net/ethernet/realtek/rtltool.h new file mode 100755 index 0000000..4cbe128 --- /dev/null +++ b/drivers/net/ethernet/realtek/rtltool.h @@ -0,0 +1,49 @@ +#ifndef _LINUX_RTLTOOL_H +#define _LINUX_RTLTOOL_H + +#define SIOCRTLTOOL SIOCDEVPRIVATE+1 + +enum rtl_cmd { + RTLTOOL_READ_MAC=0, + RTLTOOL_WRITE_MAC, + RTLTOOL_READ_PHY, + RTLTOOL_WRITE_PHY, + RTLTOOL_READ_EPHY, + RTLTOOL_WRITE_EPHY, + RTLTOOL_READ_ERI, + RTLTOOL_WRITE_ERI, + RTLTOOL_READ_PCI, + RTLTOOL_WRITE_PCI, + RTLTOOL_READ_EEPROM, + RTLTOOL_WRITE_EEPROM, + + RTL_READ_OOB_MAC, + RTL_WRITE_OOB_MAC, + + RTL_ENABLE_PCI_DIAG, + RTL_DISABLE_PCI_DIAG, + + RTL_READ_MAC_OCP, + RTL_WRITE_MAC_OCP, + + RTLTOOL_INVALID +}; + +struct rtltool_cmd { + __u32 cmd; + __u32 offset; + __u32 len; + __u32 data; +}; + +enum mode_access { + MODE_NONE=0, + MODE_READ, + MODE_WRITE +}; + +#ifdef __KERNEL__ +int rtltool_ioctl(struct rtl8168_private *tp, struct ifreq *ifr); +#endif + +#endif /* _LINUX_RTLTOOL_H */ -- 1.9.1