blob: 19f3074a0a689e5b7d26fb0d8c3f6d570425e4f2 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
Francois Romieu07d3f512007-02-21 22:40:46 +01002 * r8169.c: RealTek 8169/8168/8101 ethernet driver.
3 *
4 * Copyright (c) 2002 ShuChen <shuchen@realtek.com.tw>
5 * Copyright (c) 2003 - 2007 Francois Romieu <romieu@fr.zoreil.com>
6 * Copyright (c) a lot of people too. Please respect their work.
7 *
8 * See MAINTAINERS file for support contact information.
Linus Torvalds1da177e2005-04-16 15:20:36 -07009 */
10
11#include <linux/module.h>
12#include <linux/moduleparam.h>
13#include <linux/pci.h>
14#include <linux/netdevice.h>
15#include <linux/etherdevice.h>
16#include <linux/delay.h>
17#include <linux/ethtool.h>
18#include <linux/mii.h>
19#include <linux/if_vlan.h>
20#include <linux/crc32.h>
21#include <linux/in.h>
22#include <linux/ip.h>
23#include <linux/tcp.h>
Alexey Dobriyana6b7a402011-06-06 10:43:46 +000024#include <linux/interrupt.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070025#include <linux/dma-mapping.h>
Rafael J. Wysockie1759442010-03-14 14:33:51 +000026#include <linux/pm_runtime.h>
françois romieubca03d52011-01-03 15:07:31 +000027#include <linux/firmware.h>
Stanislaw Gruszkaba04c7c2011-02-22 02:00:11 +000028#include <linux/pci-aspm.h>
Paul Gortmaker70c71602011-05-22 16:47:17 -040029#include <linux/prefetch.h>
hayeswange9746042014-07-11 16:25:58 +080030#include <linux/ipv6.h>
31#include <net/ip6_checksum.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070032
33#include <asm/io.h>
34#include <asm/irq.h>
35
Francois Romieu865c6522008-05-11 14:51:00 +020036#define RTL8169_VERSION "2.3LK-NAPI"
Linus Torvalds1da177e2005-04-16 15:20:36 -070037#define MODULENAME "r8169"
38#define PFX MODULENAME ": "
39
françois romieubca03d52011-01-03 15:07:31 +000040#define FIRMWARE_8168D_1 "rtl_nic/rtl8168d-1.fw"
41#define FIRMWARE_8168D_2 "rtl_nic/rtl8168d-2.fw"
hayeswang01dc7fe2011-03-21 01:50:28 +000042#define FIRMWARE_8168E_1 "rtl_nic/rtl8168e-1.fw"
43#define FIRMWARE_8168E_2 "rtl_nic/rtl8168e-2.fw"
Hayes Wang70090422011-07-06 15:58:06 +080044#define FIRMWARE_8168E_3 "rtl_nic/rtl8168e-3.fw"
Hayes Wangc2218922011-09-06 16:55:18 +080045#define FIRMWARE_8168F_1 "rtl_nic/rtl8168f-1.fw"
46#define FIRMWARE_8168F_2 "rtl_nic/rtl8168f-2.fw"
Hayes Wang5a5e4442011-02-22 17:26:21 +080047#define FIRMWARE_8105E_1 "rtl_nic/rtl8105e-1.fw"
Hayes Wang7e18dca2012-03-30 14:33:02 +080048#define FIRMWARE_8402_1 "rtl_nic/rtl8402-1.fw"
Hayes Wangb3d7b2f2012-03-30 14:48:06 +080049#define FIRMWARE_8411_1 "rtl_nic/rtl8411-1.fw"
hayeswang45dd95c2013-07-08 17:09:01 +080050#define FIRMWARE_8411_2 "rtl_nic/rtl8411-2.fw"
Hayes Wang5598bfe2012-07-02 17:23:21 +080051#define FIRMWARE_8106E_1 "rtl_nic/rtl8106e-1.fw"
hayeswang58152cd2013-04-01 22:23:42 +000052#define FIRMWARE_8106E_2 "rtl_nic/rtl8106e-2.fw"
hayeswangbeb330a2013-04-01 22:23:39 +000053#define FIRMWARE_8168G_2 "rtl_nic/rtl8168g-2.fw"
hayeswang57538c42013-04-01 22:23:40 +000054#define FIRMWARE_8168G_3 "rtl_nic/rtl8168g-3.fw"
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +080055#define FIRMWARE_8168H_1 "rtl_nic/rtl8168h-1.fw"
56#define FIRMWARE_8168H_2 "rtl_nic/rtl8168h-2.fw"
57#define FIRMWARE_8107E_1 "rtl_nic/rtl8107e-1.fw"
58#define FIRMWARE_8107E_2 "rtl_nic/rtl8107e-2.fw"
françois romieubca03d52011-01-03 15:07:31 +000059
Linus Torvalds1da177e2005-04-16 15:20:36 -070060#ifdef RTL8169_DEBUG
61#define assert(expr) \
Francois Romieu5b0384f2006-08-16 16:00:01 +020062 if (!(expr)) { \
63 printk( "Assertion failed! %s,%s,%s,line=%d\n", \
Harvey Harrisonb39d66a2008-08-20 16:52:04 -070064 #expr,__FILE__,__func__,__LINE__); \
Francois Romieu5b0384f2006-08-16 16:00:01 +020065 }
Joe Perches06fa7352007-10-18 21:15:00 +020066#define dprintk(fmt, args...) \
67 do { printk(KERN_DEBUG PFX fmt, ## args); } while (0)
Linus Torvalds1da177e2005-04-16 15:20:36 -070068#else
69#define assert(expr) do {} while (0)
70#define dprintk(fmt, args...) do {} while (0)
71#endif /* RTL8169_DEBUG */
72
Stephen Hemmingerb57b7e52005-05-27 21:11:52 +020073#define R8169_MSG_DEFAULT \
Francois Romieuf0e837d92005-09-30 16:54:02 -070074 (NETIF_MSG_DRV | NETIF_MSG_PROBE | NETIF_MSG_IFUP | NETIF_MSG_IFDOWN)
Stephen Hemmingerb57b7e52005-05-27 21:11:52 +020075
Julien Ducourthial477206a2012-05-09 00:00:06 +020076#define TX_SLOTS_AVAIL(tp) \
77 (tp->dirty_tx + NUM_TX_DESC - tp->cur_tx)
78
79/* A skbuff with nr_frags needs nr_frags+1 entries in the tx queue */
80#define TX_FRAGS_READY_FOR(tp,nr_frags) \
81 (TX_SLOTS_AVAIL(tp) >= (nr_frags + 1))
Linus Torvalds1da177e2005-04-16 15:20:36 -070082
Linus Torvalds1da177e2005-04-16 15:20:36 -070083/* Maximum number of multicast addresses to filter (vs. Rx-all-multicast).
84 The RTL chips use a 64 element hash table based on the Ethernet CRC. */
Arjan van de Venf71e1302006-03-03 21:33:57 -050085static const int multicast_filter_limit = 32;
Linus Torvalds1da177e2005-04-16 15:20:36 -070086
Francois Romieu9c14cea2008-07-05 00:21:15 +020087#define MAX_READ_REQUEST_SHIFT 12
Michal Schmidtaee77e42012-09-09 13:55:26 +000088#define TX_DMA_BURST 7 /* Maximum PCI burst, '7' is unlimited */
Linus Torvalds1da177e2005-04-16 15:20:36 -070089#define InterFrameGap 0x03 /* 3 means InterFrameGap = the shortest one */
90
91#define R8169_REGS_SIZE 256
92#define R8169_NAPI_WEIGHT 64
93#define NUM_TX_DESC 64 /* Number of Tx descriptor registers */
Timo Teräs9fba0812013-01-15 21:01:24 +000094#define NUM_RX_DESC 256U /* Number of Rx descriptor registers */
Linus Torvalds1da177e2005-04-16 15:20:36 -070095#define R8169_TX_RING_BYTES (NUM_TX_DESC * sizeof(struct TxDesc))
96#define R8169_RX_RING_BYTES (NUM_RX_DESC * sizeof(struct RxDesc))
97
98#define RTL8169_TX_TIMEOUT (6*HZ)
99#define RTL8169_PHY_TIMEOUT (10*HZ)
100
101/* write/read MMIO register */
102#define RTL_W8(reg, val8) writeb ((val8), ioaddr + (reg))
103#define RTL_W16(reg, val16) writew ((val16), ioaddr + (reg))
104#define RTL_W32(reg, val32) writel ((val32), ioaddr + (reg))
105#define RTL_R8(reg) readb (ioaddr + (reg))
106#define RTL_R16(reg) readw (ioaddr + (reg))
Junchang Wang06f555f2010-05-30 02:26:07 +0000107#define RTL_R32(reg) readl (ioaddr + (reg))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700108
109enum mac_version {
Francois Romieu85bffe62011-04-27 08:22:39 +0200110 RTL_GIGA_MAC_VER_01 = 0,
111 RTL_GIGA_MAC_VER_02,
112 RTL_GIGA_MAC_VER_03,
113 RTL_GIGA_MAC_VER_04,
114 RTL_GIGA_MAC_VER_05,
115 RTL_GIGA_MAC_VER_06,
116 RTL_GIGA_MAC_VER_07,
117 RTL_GIGA_MAC_VER_08,
118 RTL_GIGA_MAC_VER_09,
119 RTL_GIGA_MAC_VER_10,
120 RTL_GIGA_MAC_VER_11,
121 RTL_GIGA_MAC_VER_12,
122 RTL_GIGA_MAC_VER_13,
123 RTL_GIGA_MAC_VER_14,
124 RTL_GIGA_MAC_VER_15,
125 RTL_GIGA_MAC_VER_16,
126 RTL_GIGA_MAC_VER_17,
127 RTL_GIGA_MAC_VER_18,
128 RTL_GIGA_MAC_VER_19,
129 RTL_GIGA_MAC_VER_20,
130 RTL_GIGA_MAC_VER_21,
131 RTL_GIGA_MAC_VER_22,
132 RTL_GIGA_MAC_VER_23,
133 RTL_GIGA_MAC_VER_24,
134 RTL_GIGA_MAC_VER_25,
135 RTL_GIGA_MAC_VER_26,
136 RTL_GIGA_MAC_VER_27,
137 RTL_GIGA_MAC_VER_28,
138 RTL_GIGA_MAC_VER_29,
139 RTL_GIGA_MAC_VER_30,
140 RTL_GIGA_MAC_VER_31,
141 RTL_GIGA_MAC_VER_32,
142 RTL_GIGA_MAC_VER_33,
Hayes Wang70090422011-07-06 15:58:06 +0800143 RTL_GIGA_MAC_VER_34,
Hayes Wangc2218922011-09-06 16:55:18 +0800144 RTL_GIGA_MAC_VER_35,
145 RTL_GIGA_MAC_VER_36,
Hayes Wang7e18dca2012-03-30 14:33:02 +0800146 RTL_GIGA_MAC_VER_37,
Hayes Wangb3d7b2f2012-03-30 14:48:06 +0800147 RTL_GIGA_MAC_VER_38,
Hayes Wang5598bfe2012-07-02 17:23:21 +0800148 RTL_GIGA_MAC_VER_39,
Hayes Wangc5583862012-07-02 17:23:22 +0800149 RTL_GIGA_MAC_VER_40,
150 RTL_GIGA_MAC_VER_41,
hayeswang57538c42013-04-01 22:23:40 +0000151 RTL_GIGA_MAC_VER_42,
hayeswang58152cd2013-04-01 22:23:42 +0000152 RTL_GIGA_MAC_VER_43,
hayeswang45dd95c2013-07-08 17:09:01 +0800153 RTL_GIGA_MAC_VER_44,
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +0800154 RTL_GIGA_MAC_VER_45,
155 RTL_GIGA_MAC_VER_46,
156 RTL_GIGA_MAC_VER_47,
157 RTL_GIGA_MAC_VER_48,
Chun-Hao Lin935e2212014-10-07 15:10:41 +0800158 RTL_GIGA_MAC_VER_49,
159 RTL_GIGA_MAC_VER_50,
160 RTL_GIGA_MAC_VER_51,
Francois Romieu85bffe62011-04-27 08:22:39 +0200161 RTL_GIGA_MAC_NONE = 0xff,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700162};
163
Francois Romieu2b7b4312011-04-18 22:53:24 -0700164enum rtl_tx_desc_version {
165 RTL_TD_0 = 0,
166 RTL_TD_1 = 1,
167};
168
Francois Romieud58d46b2011-05-03 16:38:29 +0200169#define JUMBO_1K ETH_DATA_LEN
170#define JUMBO_4K (4*1024 - ETH_HLEN - 2)
171#define JUMBO_6K (6*1024 - ETH_HLEN - 2)
172#define JUMBO_7K (7*1024 - ETH_HLEN - 2)
173#define JUMBO_9K (9*1024 - ETH_HLEN - 2)
174
175#define _R(NAME,TD,FW,SZ,B) { \
176 .name = NAME, \
177 .txd_version = TD, \
178 .fw_name = FW, \
179 .jumbo_max = SZ, \
180 .jumbo_tx_csum = B \
181}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700182
Jesper Juhl3c6bee12006-01-09 20:54:01 -0800183static const struct {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700184 const char *name;
Francois Romieu2b7b4312011-04-18 22:53:24 -0700185 enum rtl_tx_desc_version txd_version;
Francois Romieu85bffe62011-04-27 08:22:39 +0200186 const char *fw_name;
Francois Romieud58d46b2011-05-03 16:38:29 +0200187 u16 jumbo_max;
188 bool jumbo_tx_csum;
Francois Romieu85bffe62011-04-27 08:22:39 +0200189} rtl_chip_infos[] = {
190 /* PCI devices. */
191 [RTL_GIGA_MAC_VER_01] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200192 _R("RTL8169", RTL_TD_0, NULL, JUMBO_7K, true),
Francois Romieu85bffe62011-04-27 08:22:39 +0200193 [RTL_GIGA_MAC_VER_02] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200194 _R("RTL8169s", RTL_TD_0, NULL, JUMBO_7K, true),
Francois Romieu85bffe62011-04-27 08:22:39 +0200195 [RTL_GIGA_MAC_VER_03] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200196 _R("RTL8110s", RTL_TD_0, NULL, JUMBO_7K, true),
Francois Romieu85bffe62011-04-27 08:22:39 +0200197 [RTL_GIGA_MAC_VER_04] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200198 _R("RTL8169sb/8110sb", RTL_TD_0, NULL, JUMBO_7K, true),
Francois Romieu85bffe62011-04-27 08:22:39 +0200199 [RTL_GIGA_MAC_VER_05] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200200 _R("RTL8169sc/8110sc", RTL_TD_0, NULL, JUMBO_7K, true),
Francois Romieu85bffe62011-04-27 08:22:39 +0200201 [RTL_GIGA_MAC_VER_06] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200202 _R("RTL8169sc/8110sc", RTL_TD_0, NULL, JUMBO_7K, true),
Francois Romieu85bffe62011-04-27 08:22:39 +0200203 /* PCI-E devices. */
204 [RTL_GIGA_MAC_VER_07] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200205 _R("RTL8102e", RTL_TD_1, NULL, JUMBO_1K, true),
Francois Romieu85bffe62011-04-27 08:22:39 +0200206 [RTL_GIGA_MAC_VER_08] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200207 _R("RTL8102e", RTL_TD_1, NULL, JUMBO_1K, true),
Francois Romieu85bffe62011-04-27 08:22:39 +0200208 [RTL_GIGA_MAC_VER_09] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200209 _R("RTL8102e", RTL_TD_1, NULL, JUMBO_1K, true),
Francois Romieu85bffe62011-04-27 08:22:39 +0200210 [RTL_GIGA_MAC_VER_10] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200211 _R("RTL8101e", RTL_TD_0, NULL, JUMBO_1K, true),
Francois Romieu85bffe62011-04-27 08:22:39 +0200212 [RTL_GIGA_MAC_VER_11] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200213 _R("RTL8168b/8111b", RTL_TD_0, NULL, JUMBO_4K, false),
Francois Romieu85bffe62011-04-27 08:22:39 +0200214 [RTL_GIGA_MAC_VER_12] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200215 _R("RTL8168b/8111b", RTL_TD_0, NULL, JUMBO_4K, false),
Francois Romieu85bffe62011-04-27 08:22:39 +0200216 [RTL_GIGA_MAC_VER_13] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200217 _R("RTL8101e", RTL_TD_0, NULL, JUMBO_1K, true),
Francois Romieu85bffe62011-04-27 08:22:39 +0200218 [RTL_GIGA_MAC_VER_14] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200219 _R("RTL8100e", RTL_TD_0, NULL, JUMBO_1K, true),
Francois Romieu85bffe62011-04-27 08:22:39 +0200220 [RTL_GIGA_MAC_VER_15] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200221 _R("RTL8100e", RTL_TD_0, NULL, JUMBO_1K, true),
Francois Romieu85bffe62011-04-27 08:22:39 +0200222 [RTL_GIGA_MAC_VER_16] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200223 _R("RTL8101e", RTL_TD_0, NULL, JUMBO_1K, true),
Francois Romieu85bffe62011-04-27 08:22:39 +0200224 [RTL_GIGA_MAC_VER_17] =
hayeswangf75761b2014-03-11 15:11:59 +0800225 _R("RTL8168b/8111b", RTL_TD_0, NULL, JUMBO_4K, false),
Francois Romieu85bffe62011-04-27 08:22:39 +0200226 [RTL_GIGA_MAC_VER_18] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200227 _R("RTL8168cp/8111cp", RTL_TD_1, NULL, JUMBO_6K, false),
Francois Romieu85bffe62011-04-27 08:22:39 +0200228 [RTL_GIGA_MAC_VER_19] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200229 _R("RTL8168c/8111c", RTL_TD_1, NULL, JUMBO_6K, false),
Francois Romieu85bffe62011-04-27 08:22:39 +0200230 [RTL_GIGA_MAC_VER_20] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200231 _R("RTL8168c/8111c", RTL_TD_1, NULL, JUMBO_6K, false),
Francois Romieu85bffe62011-04-27 08:22:39 +0200232 [RTL_GIGA_MAC_VER_21] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200233 _R("RTL8168c/8111c", RTL_TD_1, NULL, JUMBO_6K, false),
Francois Romieu85bffe62011-04-27 08:22:39 +0200234 [RTL_GIGA_MAC_VER_22] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200235 _R("RTL8168c/8111c", RTL_TD_1, NULL, JUMBO_6K, false),
Francois Romieu85bffe62011-04-27 08:22:39 +0200236 [RTL_GIGA_MAC_VER_23] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200237 _R("RTL8168cp/8111cp", RTL_TD_1, NULL, JUMBO_6K, false),
Francois Romieu85bffe62011-04-27 08:22:39 +0200238 [RTL_GIGA_MAC_VER_24] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200239 _R("RTL8168cp/8111cp", RTL_TD_1, NULL, JUMBO_6K, false),
Francois Romieu85bffe62011-04-27 08:22:39 +0200240 [RTL_GIGA_MAC_VER_25] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200241 _R("RTL8168d/8111d", RTL_TD_1, FIRMWARE_8168D_1,
242 JUMBO_9K, false),
Francois Romieu85bffe62011-04-27 08:22:39 +0200243 [RTL_GIGA_MAC_VER_26] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200244 _R("RTL8168d/8111d", RTL_TD_1, FIRMWARE_8168D_2,
245 JUMBO_9K, false),
Francois Romieu85bffe62011-04-27 08:22:39 +0200246 [RTL_GIGA_MAC_VER_27] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200247 _R("RTL8168dp/8111dp", RTL_TD_1, NULL, JUMBO_9K, false),
Francois Romieu85bffe62011-04-27 08:22:39 +0200248 [RTL_GIGA_MAC_VER_28] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200249 _R("RTL8168dp/8111dp", RTL_TD_1, NULL, JUMBO_9K, false),
Francois Romieu85bffe62011-04-27 08:22:39 +0200250 [RTL_GIGA_MAC_VER_29] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200251 _R("RTL8105e", RTL_TD_1, FIRMWARE_8105E_1,
252 JUMBO_1K, true),
Francois Romieu85bffe62011-04-27 08:22:39 +0200253 [RTL_GIGA_MAC_VER_30] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200254 _R("RTL8105e", RTL_TD_1, FIRMWARE_8105E_1,
255 JUMBO_1K, true),
Francois Romieu85bffe62011-04-27 08:22:39 +0200256 [RTL_GIGA_MAC_VER_31] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200257 _R("RTL8168dp/8111dp", RTL_TD_1, NULL, JUMBO_9K, false),
Francois Romieu85bffe62011-04-27 08:22:39 +0200258 [RTL_GIGA_MAC_VER_32] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200259 _R("RTL8168e/8111e", RTL_TD_1, FIRMWARE_8168E_1,
260 JUMBO_9K, false),
Francois Romieu85bffe62011-04-27 08:22:39 +0200261 [RTL_GIGA_MAC_VER_33] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200262 _R("RTL8168e/8111e", RTL_TD_1, FIRMWARE_8168E_2,
263 JUMBO_9K, false),
Hayes Wang70090422011-07-06 15:58:06 +0800264 [RTL_GIGA_MAC_VER_34] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200265 _R("RTL8168evl/8111evl",RTL_TD_1, FIRMWARE_8168E_3,
266 JUMBO_9K, false),
Hayes Wangc2218922011-09-06 16:55:18 +0800267 [RTL_GIGA_MAC_VER_35] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200268 _R("RTL8168f/8111f", RTL_TD_1, FIRMWARE_8168F_1,
269 JUMBO_9K, false),
Hayes Wangc2218922011-09-06 16:55:18 +0800270 [RTL_GIGA_MAC_VER_36] =
Francois Romieud58d46b2011-05-03 16:38:29 +0200271 _R("RTL8168f/8111f", RTL_TD_1, FIRMWARE_8168F_2,
272 JUMBO_9K, false),
Hayes Wang7e18dca2012-03-30 14:33:02 +0800273 [RTL_GIGA_MAC_VER_37] =
274 _R("RTL8402", RTL_TD_1, FIRMWARE_8402_1,
275 JUMBO_1K, true),
Hayes Wangb3d7b2f2012-03-30 14:48:06 +0800276 [RTL_GIGA_MAC_VER_38] =
277 _R("RTL8411", RTL_TD_1, FIRMWARE_8411_1,
278 JUMBO_9K, false),
Hayes Wang5598bfe2012-07-02 17:23:21 +0800279 [RTL_GIGA_MAC_VER_39] =
280 _R("RTL8106e", RTL_TD_1, FIRMWARE_8106E_1,
281 JUMBO_1K, true),
Hayes Wangc5583862012-07-02 17:23:22 +0800282 [RTL_GIGA_MAC_VER_40] =
hayeswangbeb330a2013-04-01 22:23:39 +0000283 _R("RTL8168g/8111g", RTL_TD_1, FIRMWARE_8168G_2,
Hayes Wangc5583862012-07-02 17:23:22 +0800284 JUMBO_9K, false),
285 [RTL_GIGA_MAC_VER_41] =
286 _R("RTL8168g/8111g", RTL_TD_1, NULL, JUMBO_9K, false),
hayeswang57538c42013-04-01 22:23:40 +0000287 [RTL_GIGA_MAC_VER_42] =
288 _R("RTL8168g/8111g", RTL_TD_1, FIRMWARE_8168G_3,
289 JUMBO_9K, false),
hayeswang58152cd2013-04-01 22:23:42 +0000290 [RTL_GIGA_MAC_VER_43] =
291 _R("RTL8106e", RTL_TD_1, FIRMWARE_8106E_2,
292 JUMBO_1K, true),
hayeswang45dd95c2013-07-08 17:09:01 +0800293 [RTL_GIGA_MAC_VER_44] =
294 _R("RTL8411", RTL_TD_1, FIRMWARE_8411_2,
295 JUMBO_9K, false),
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +0800296 [RTL_GIGA_MAC_VER_45] =
297 _R("RTL8168h/8111h", RTL_TD_1, FIRMWARE_8168H_1,
298 JUMBO_9K, false),
299 [RTL_GIGA_MAC_VER_46] =
300 _R("RTL8168h/8111h", RTL_TD_1, FIRMWARE_8168H_2,
301 JUMBO_9K, false),
302 [RTL_GIGA_MAC_VER_47] =
303 _R("RTL8107e", RTL_TD_1, FIRMWARE_8107E_1,
304 JUMBO_1K, false),
305 [RTL_GIGA_MAC_VER_48] =
306 _R("RTL8107e", RTL_TD_1, FIRMWARE_8107E_2,
307 JUMBO_1K, false),
Chun-Hao Lin935e2212014-10-07 15:10:41 +0800308 [RTL_GIGA_MAC_VER_49] =
309 _R("RTL8168ep/8111ep", RTL_TD_1, NULL,
310 JUMBO_9K, false),
311 [RTL_GIGA_MAC_VER_50] =
312 _R("RTL8168ep/8111ep", RTL_TD_1, NULL,
313 JUMBO_9K, false),
314 [RTL_GIGA_MAC_VER_51] =
315 _R("RTL8168ep/8111ep", RTL_TD_1, NULL,
316 JUMBO_9K, false),
Linus Torvalds1da177e2005-04-16 15:20:36 -0700317};
318#undef _R
319
Francois Romieubcf0bf92006-07-26 23:14:13 +0200320enum cfg_version {
321 RTL_CFG_0 = 0x00,
322 RTL_CFG_1,
323 RTL_CFG_2
324};
325
Benoit Taine9baa3c32014-08-08 15:56:03 +0200326static const struct pci_device_id rtl8169_pci_tbl[] = {
Francois Romieubcf0bf92006-07-26 23:14:13 +0200327 { PCI_DEVICE(PCI_VENDOR_ID_REALTEK, 0x8129), 0, 0, RTL_CFG_0 },
Francois Romieud2eed8c2006-08-31 22:01:07 +0200328 { PCI_DEVICE(PCI_VENDOR_ID_REALTEK, 0x8136), 0, 0, RTL_CFG_2 },
Chun-Hao Lin610c9082016-12-27 16:29:43 +0800329 { PCI_DEVICE(PCI_VENDOR_ID_REALTEK, 0x8161), 0, 0, RTL_CFG_1 },
Francois Romieud81bf552006-09-20 21:31:20 +0200330 { PCI_DEVICE(PCI_VENDOR_ID_REALTEK, 0x8167), 0, 0, RTL_CFG_0 },
Francois Romieu07ce4062007-02-23 23:36:39 +0100331 { PCI_DEVICE(PCI_VENDOR_ID_REALTEK, 0x8168), 0, 0, RTL_CFG_1 },
Francois Romieubcf0bf92006-07-26 23:14:13 +0200332 { PCI_DEVICE(PCI_VENDOR_ID_REALTEK, 0x8169), 0, 0, RTL_CFG_0 },
Francois Romieu2a35cfa2012-08-31 23:06:17 +0200333 { PCI_VENDOR_ID_DLINK, 0x4300,
334 PCI_VENDOR_ID_DLINK, 0x4b10, 0, 0, RTL_CFG_1 },
Francois Romieubcf0bf92006-07-26 23:14:13 +0200335 { PCI_DEVICE(PCI_VENDOR_ID_DLINK, 0x4300), 0, 0, RTL_CFG_0 },
Lennart Sorensen93a3aa22011-07-28 13:18:11 +0000336 { PCI_DEVICE(PCI_VENDOR_ID_DLINK, 0x4302), 0, 0, RTL_CFG_0 },
Francois Romieubc1660b2007-10-12 23:58:09 +0200337 { PCI_DEVICE(PCI_VENDOR_ID_AT, 0xc107), 0, 0, RTL_CFG_0 },
Francois Romieubcf0bf92006-07-26 23:14:13 +0200338 { PCI_DEVICE(0x16ec, 0x0116), 0, 0, RTL_CFG_0 },
339 { PCI_VENDOR_ID_LINKSYS, 0x1032,
340 PCI_ANY_ID, 0x0024, 0, 0, RTL_CFG_0 },
Ciaran McCreesh11d2e282007-11-01 22:48:15 +0100341 { 0x0001, 0x8168,
342 PCI_ANY_ID, 0x2410, 0, 0, RTL_CFG_2 },
Linus Torvalds1da177e2005-04-16 15:20:36 -0700343 {0,},
344};
345
346MODULE_DEVICE_TABLE(pci, rtl8169_pci_tbl);
347
Eric Dumazet6f0333b2010-10-11 11:17:47 +0000348static int rx_buf_sz = 16383;
Ard Biesheuvel27896c82016-05-14 22:40:15 +0200349static int use_dac = -1;
Stephen Hemmingerb57b7e52005-05-27 21:11:52 +0200350static struct {
351 u32 msg_enable;
352} debug = { -1 };
Linus Torvalds1da177e2005-04-16 15:20:36 -0700353
Francois Romieu07d3f512007-02-21 22:40:46 +0100354enum rtl_registers {
355 MAC0 = 0, /* Ethernet hardware address. */
Francois Romieu773d2022007-01-31 23:47:43 +0100356 MAC4 = 4,
Francois Romieu07d3f512007-02-21 22:40:46 +0100357 MAR0 = 8, /* Multicast filter. */
358 CounterAddrLow = 0x10,
359 CounterAddrHigh = 0x14,
360 TxDescStartAddrLow = 0x20,
361 TxDescStartAddrHigh = 0x24,
362 TxHDescStartAddrLow = 0x28,
363 TxHDescStartAddrHigh = 0x2c,
364 FLASH = 0x30,
365 ERSR = 0x36,
366 ChipCmd = 0x37,
367 TxPoll = 0x38,
368 IntrMask = 0x3c,
369 IntrStatus = 0x3e,
Francois Romieu2b7b4312011-04-18 22:53:24 -0700370
Hayes Wang4f6b00e52011-07-06 15:58:02 +0800371 TxConfig = 0x40,
372#define TXCFG_AUTO_FIFO (1 << 7) /* 8111e-vl */
373#define TXCFG_EMPTY (1 << 11) /* 8111e-vl */
374
375 RxConfig = 0x44,
376#define RX128_INT_EN (1 << 15) /* 8111c and later */
377#define RX_MULTI_EN (1 << 14) /* 8111c only */
378#define RXCFG_FIFO_SHIFT 13
379 /* No threshold before first PCI xfer */
380#define RX_FIFO_THRESH (7 << RXCFG_FIFO_SHIFT)
hayeswangbeb330a2013-04-01 22:23:39 +0000381#define RX_EARLY_OFF (1 << 11)
Hayes Wang4f6b00e52011-07-06 15:58:02 +0800382#define RXCFG_DMA_SHIFT 8
383 /* Unlimited maximum PCI burst. */
384#define RX_DMA_BURST (7 << RXCFG_DMA_SHIFT)
Francois Romieu2b7b4312011-04-18 22:53:24 -0700385
Francois Romieu07d3f512007-02-21 22:40:46 +0100386 RxMissed = 0x4c,
387 Cfg9346 = 0x50,
388 Config0 = 0x51,
389 Config1 = 0x52,
390 Config2 = 0x53,
Francois Romieud387b422012-04-17 11:12:01 +0200391#define PME_SIGNAL (1 << 5) /* 8168c and later */
392
Francois Romieu07d3f512007-02-21 22:40:46 +0100393 Config3 = 0x54,
394 Config4 = 0x55,
395 Config5 = 0x56,
396 MultiIntr = 0x5c,
397 PHYAR = 0x60,
Francois Romieu07d3f512007-02-21 22:40:46 +0100398 PHYstatus = 0x6c,
399 RxMaxSize = 0xda,
400 CPlusCmd = 0xe0,
401 IntrMitigate = 0xe2,
Francois Romieu50970832017-10-27 13:24:49 +0300402
403#define RTL_COALESCE_MASK 0x0f
404#define RTL_COALESCE_SHIFT 4
405#define RTL_COALESCE_T_MAX (RTL_COALESCE_MASK)
406#define RTL_COALESCE_FRAME_MAX (RTL_COALESCE_MASK << 2)
407
Francois Romieu07d3f512007-02-21 22:40:46 +0100408 RxDescAddrLow = 0xe4,
409 RxDescAddrHigh = 0xe8,
françois romieuf0298f82011-01-03 15:07:42 +0000410 EarlyTxThres = 0xec, /* 8169. Unit of 32 bytes. */
411
412#define NoEarlyTx 0x3f /* Max value : no early transmit. */
413
414 MaxTxPacketSize = 0xec, /* 8101/8168. Unit of 128 bytes. */
415
416#define TxPacketMax (8064 >> 7)
Hayes Wang3090bd92011-09-06 16:55:15 +0800417#define EarlySize 0x27
françois romieuf0298f82011-01-03 15:07:42 +0000418
Francois Romieu07d3f512007-02-21 22:40:46 +0100419 FuncEvent = 0xf0,
420 FuncEventMask = 0xf4,
421 FuncPresetState = 0xf8,
Chun-Hao Lin935e2212014-10-07 15:10:41 +0800422 IBCR0 = 0xf8,
423 IBCR2 = 0xf9,
424 IBIMR0 = 0xfa,
425 IBISR0 = 0xfb,
Francois Romieu07d3f512007-02-21 22:40:46 +0100426 FuncForceEvent = 0xfc,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700427};
428
Francois Romieuf162a5d2008-06-01 22:37:49 +0200429enum rtl8110_registers {
430 TBICSR = 0x64,
431 TBI_ANAR = 0x68,
432 TBI_LPAR = 0x6a,
433};
434
435enum rtl8168_8101_registers {
436 CSIDR = 0x64,
437 CSIAR = 0x68,
438#define CSIAR_FLAG 0x80000000
439#define CSIAR_WRITE_CMD 0x80000000
440#define CSIAR_BYTE_ENABLE 0x0f
441#define CSIAR_BYTE_ENABLE_SHIFT 12
442#define CSIAR_ADDR_MASK 0x0fff
Hayes Wang7e18dca2012-03-30 14:33:02 +0800443#define CSIAR_FUNC_CARD 0x00000000
444#define CSIAR_FUNC_SDIO 0x00010000
445#define CSIAR_FUNC_NIC 0x00020000
hayeswang45dd95c2013-07-08 17:09:01 +0800446#define CSIAR_FUNC_NIC2 0x00010000
françois romieu065c27c2011-01-03 15:08:12 +0000447 PMCH = 0x6f,
Francois Romieuf162a5d2008-06-01 22:37:49 +0200448 EPHYAR = 0x80,
449#define EPHYAR_FLAG 0x80000000
450#define EPHYAR_WRITE_CMD 0x80000000
451#define EPHYAR_REG_MASK 0x1f
452#define EPHYAR_REG_SHIFT 16
453#define EPHYAR_DATA_MASK 0xffff
Hayes Wang5a5e4442011-02-22 17:26:21 +0800454 DLLPR = 0xd0,
Hayes Wang4f6b00e52011-07-06 15:58:02 +0800455#define PFM_EN (1 << 6)
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +0800456#define TX_10M_PS_EN (1 << 7)
Francois Romieuf162a5d2008-06-01 22:37:49 +0200457 DBG_REG = 0xd1,
458#define FIX_NAK_1 (1 << 4)
459#define FIX_NAK_2 (1 << 3)
Hayes Wang5a5e4442011-02-22 17:26:21 +0800460 TWSI = 0xd2,
461 MCU = 0xd3,
Hayes Wang4f6b00e52011-07-06 15:58:02 +0800462#define NOW_IS_OOB (1 << 7)
Hayes Wangc5583862012-07-02 17:23:22 +0800463#define TX_EMPTY (1 << 5)
464#define RX_EMPTY (1 << 4)
465#define RXTX_EMPTY (TX_EMPTY | RX_EMPTY)
Hayes Wang5a5e4442011-02-22 17:26:21 +0800466#define EN_NDP (1 << 3)
467#define EN_OOB_RESET (1 << 2)
Hayes Wangc5583862012-07-02 17:23:22 +0800468#define LINK_LIST_RDY (1 << 1)
françois romieudaf9df62009-10-07 12:44:20 +0000469 EFUSEAR = 0xdc,
470#define EFUSEAR_FLAG 0x80000000
471#define EFUSEAR_WRITE_CMD 0x80000000
472#define EFUSEAR_READ_CMD 0x00000000
473#define EFUSEAR_REG_MASK 0x03ff
474#define EFUSEAR_REG_SHIFT 8
475#define EFUSEAR_DATA_MASK 0xff
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +0800476 MISC_1 = 0xf2,
477#define PFM_D3COLD_EN (1 << 6)
Francois Romieuf162a5d2008-06-01 22:37:49 +0200478};
479
françois romieuc0e45c12011-01-03 15:08:04 +0000480enum rtl8168_registers {
Hayes Wang4f6b00e52011-07-06 15:58:02 +0800481 LED_FREQ = 0x1a,
482 EEE_LED = 0x1b,
françois romieub646d902011-01-03 15:08:21 +0000483 ERIDR = 0x70,
484 ERIAR = 0x74,
485#define ERIAR_FLAG 0x80000000
486#define ERIAR_WRITE_CMD 0x80000000
487#define ERIAR_READ_CMD 0x00000000
488#define ERIAR_ADDR_BYTE_ALIGN 4
françois romieub646d902011-01-03 15:08:21 +0000489#define ERIAR_TYPE_SHIFT 16
Hayes Wang4f6b00e52011-07-06 15:58:02 +0800490#define ERIAR_EXGMAC (0x00 << ERIAR_TYPE_SHIFT)
491#define ERIAR_MSIX (0x01 << ERIAR_TYPE_SHIFT)
492#define ERIAR_ASF (0x02 << ERIAR_TYPE_SHIFT)
Chun-Hao Lin935e2212014-10-07 15:10:41 +0800493#define ERIAR_OOB (0x02 << ERIAR_TYPE_SHIFT)
Hayes Wang4f6b00e52011-07-06 15:58:02 +0800494#define ERIAR_MASK_SHIFT 12
495#define ERIAR_MASK_0001 (0x1 << ERIAR_MASK_SHIFT)
496#define ERIAR_MASK_0011 (0x3 << ERIAR_MASK_SHIFT)
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +0800497#define ERIAR_MASK_0100 (0x4 << ERIAR_MASK_SHIFT)
Hayes Wangc5583862012-07-02 17:23:22 +0800498#define ERIAR_MASK_0101 (0x5 << ERIAR_MASK_SHIFT)
Hayes Wang4f6b00e52011-07-06 15:58:02 +0800499#define ERIAR_MASK_1111 (0xf << ERIAR_MASK_SHIFT)
françois romieuc0e45c12011-01-03 15:08:04 +0000500 EPHY_RXER_NUM = 0x7c,
501 OCPDR = 0xb0, /* OCP GPHY access */
502#define OCPDR_WRITE_CMD 0x80000000
503#define OCPDR_READ_CMD 0x00000000
504#define OCPDR_REG_MASK 0x7f
505#define OCPDR_GPHY_REG_SHIFT 16
506#define OCPDR_DATA_MASK 0xffff
507 OCPAR = 0xb4,
508#define OCPAR_FLAG 0x80000000
509#define OCPAR_GPHY_WRITE_CMD 0x8000f060
510#define OCPAR_GPHY_READ_CMD 0x0000f060
Hayes Wangc5583862012-07-02 17:23:22 +0800511 GPHY_OCP = 0xb8,
hayeswang01dc7fe2011-03-21 01:50:28 +0000512 RDSAR1 = 0xd0, /* 8168c only. Undocumented on 8168dp */
513 MISC = 0xf0, /* 8168e only. */
Francois Romieucecb5fd2011-04-01 10:21:07 +0200514#define TXPLA_RST (1 << 29)
Hayes Wang5598bfe2012-07-02 17:23:21 +0800515#define DISABLE_LAN_EN (1 << 23) /* Enable GPIO pin */
Hayes Wang4f6b00e52011-07-06 15:58:02 +0800516#define PWM_EN (1 << 22)
Hayes Wangc5583862012-07-02 17:23:22 +0800517#define RXDV_GATED_EN (1 << 19)
Hayes Wang5598bfe2012-07-02 17:23:21 +0800518#define EARLY_TALLY_EN (1 << 16)
françois romieuc0e45c12011-01-03 15:08:04 +0000519};
520
Francois Romieu07d3f512007-02-21 22:40:46 +0100521enum rtl_register_content {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700522 /* InterruptStatusBits */
Francois Romieu07d3f512007-02-21 22:40:46 +0100523 SYSErr = 0x8000,
524 PCSTimeout = 0x4000,
525 SWInt = 0x0100,
526 TxDescUnavail = 0x0080,
527 RxFIFOOver = 0x0040,
528 LinkChg = 0x0020,
529 RxOverflow = 0x0010,
530 TxErr = 0x0008,
531 TxOK = 0x0004,
532 RxErr = 0x0002,
533 RxOK = 0x0001,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700534
535 /* RxStatusDesc */
David S. Miller8decf862011-09-22 03:23:13 -0400536 RxBOVF = (1 << 24),
Francois Romieu9dccf612006-05-14 12:31:17 +0200537 RxFOVF = (1 << 23),
538 RxRWT = (1 << 22),
539 RxRES = (1 << 21),
540 RxRUNT = (1 << 20),
541 RxCRC = (1 << 19),
Linus Torvalds1da177e2005-04-16 15:20:36 -0700542
543 /* ChipCmdBits */
Hayes Wang4f6b00e52011-07-06 15:58:02 +0800544 StopReq = 0x80,
Francois Romieu07d3f512007-02-21 22:40:46 +0100545 CmdReset = 0x10,
546 CmdRxEnb = 0x08,
547 CmdTxEnb = 0x04,
548 RxBufEmpty = 0x01,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700549
Francois Romieu275391a2007-02-23 23:50:28 +0100550 /* TXPoll register p.5 */
551 HPQ = 0x80, /* Poll cmd on the high prio queue */
552 NPQ = 0x40, /* Poll cmd on the low prio queue */
553 FSWInt = 0x01, /* Forced software interrupt */
554
Linus Torvalds1da177e2005-04-16 15:20:36 -0700555 /* Cfg9346Bits */
Francois Romieu07d3f512007-02-21 22:40:46 +0100556 Cfg9346_Lock = 0x00,
557 Cfg9346_Unlock = 0xc0,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700558
559 /* rx_mode_bits */
Francois Romieu07d3f512007-02-21 22:40:46 +0100560 AcceptErr = 0x20,
561 AcceptRunt = 0x10,
562 AcceptBroadcast = 0x08,
563 AcceptMulticast = 0x04,
564 AcceptMyPhys = 0x02,
565 AcceptAllPhys = 0x01,
Francois Romieu1687b562011-07-19 17:21:29 +0200566#define RX_CONFIG_ACCEPT_MASK 0x3f
Linus Torvalds1da177e2005-04-16 15:20:36 -0700567
Linus Torvalds1da177e2005-04-16 15:20:36 -0700568 /* TxConfigBits */
569 TxInterFrameGapShift = 24,
570 TxDMAShift = 8, /* DMA burst value (0-7) is shift this many bits */
571
Francois Romieu5d06a992006-02-23 00:47:58 +0100572 /* Config1 register p.24 */
Francois Romieuf162a5d2008-06-01 22:37:49 +0200573 LEDS1 = (1 << 7),
574 LEDS0 = (1 << 6),
Francois Romieuf162a5d2008-06-01 22:37:49 +0200575 Speed_down = (1 << 4),
576 MEMMAP = (1 << 3),
577 IOMAP = (1 << 2),
578 VPD = (1 << 1),
Francois Romieu5d06a992006-02-23 00:47:58 +0100579 PMEnable = (1 << 0), /* Power Management Enable */
580
Francois Romieu6dccd162007-02-13 23:38:05 +0100581 /* Config2 register p. 25 */
hayeswang57538c42013-04-01 22:23:40 +0000582 ClkReqEn = (1 << 7), /* Clock Request Enable */
françois romieu2ca6cf02011-12-15 08:37:43 +0000583 MSIEnable = (1 << 5), /* 8169 only. Reserved in the 8168. */
Francois Romieu6dccd162007-02-13 23:38:05 +0100584 PCI_Clock_66MHz = 0x01,
585 PCI_Clock_33MHz = 0x00,
586
Francois Romieu61a4dcc2006-02-23 00:55:25 +0100587 /* Config3 register p.25 */
588 MagicPacket = (1 << 5), /* Wake up when receives a Magic Packet */
589 LinkUp = (1 << 4), /* Wake up when the cable connection is re-established */
Francois Romieud58d46b2011-05-03 16:38:29 +0200590 Jumbo_En0 = (1 << 2), /* 8168 only. Reserved in the 8168b */
hayeswangb51ecea2014-07-09 14:52:51 +0800591 Rdy_to_L23 = (1 << 1), /* L23 Enable */
Francois Romieuf162a5d2008-06-01 22:37:49 +0200592 Beacon_en = (1 << 0), /* 8168 only. Reserved in the 8168b */
Francois Romieu61a4dcc2006-02-23 00:55:25 +0100593
Francois Romieud58d46b2011-05-03 16:38:29 +0200594 /* Config4 register */
595 Jumbo_En1 = (1 << 1), /* 8168 only. Reserved in the 8168b */
596
Francois Romieu5d06a992006-02-23 00:47:58 +0100597 /* Config5 register p.27 */
Francois Romieu61a4dcc2006-02-23 00:55:25 +0100598 BWF = (1 << 6), /* Accept Broadcast wakeup frame */
599 MWF = (1 << 5), /* Accept Multicast wakeup frame */
600 UWF = (1 << 4), /* Accept Unicast wakeup frame */
Francois Romieucecb5fd2011-04-01 10:21:07 +0200601 Spi_en = (1 << 3),
Francois Romieu61a4dcc2006-02-23 00:55:25 +0100602 LanWake = (1 << 1), /* LanWake enable/disable */
Francois Romieu5d06a992006-02-23 00:47:58 +0100603 PMEStatus = (1 << 0), /* PME status can be reset by PCI RST# */
hayeswang57538c42013-04-01 22:23:40 +0000604 ASPM_en = (1 << 0), /* ASPM enable */
Francois Romieu5d06a992006-02-23 00:47:58 +0100605
Linus Torvalds1da177e2005-04-16 15:20:36 -0700606 /* TBICSR p.28 */
607 TBIReset = 0x80000000,
608 TBILoopback = 0x40000000,
609 TBINwEnable = 0x20000000,
610 TBINwRestart = 0x10000000,
611 TBILinkOk = 0x02000000,
612 TBINwComplete = 0x01000000,
613
614 /* CPlusCmd p.31 */
Francois Romieuf162a5d2008-06-01 22:37:49 +0200615 EnableBist = (1 << 15), // 8168 8101
616 Mac_dbgo_oe = (1 << 14), // 8168 8101
617 Normal_mode = (1 << 13), // unused
618 Force_half_dup = (1 << 12), // 8168 8101
619 Force_rxflow_en = (1 << 11), // 8168 8101
620 Force_txflow_en = (1 << 10), // 8168 8101
621 Cxpl_dbg_sel = (1 << 9), // 8168 8101
622 ASF = (1 << 8), // 8168 8101
623 PktCntrDisable = (1 << 7), // 8168 8101
624 Mac_dbgo_sel = 0x001c, // 8168
Linus Torvalds1da177e2005-04-16 15:20:36 -0700625 RxVlan = (1 << 6),
626 RxChkSum = (1 << 5),
627 PCIDAC = (1 << 4),
628 PCIMulRW = (1 << 3),
Francois Romieu0e485152007-02-20 00:00:26 +0100629 INTT_0 = 0x0000, // 8168
630 INTT_1 = 0x0001, // 8168
631 INTT_2 = 0x0002, // 8168
632 INTT_3 = 0x0003, // 8168
Linus Torvalds1da177e2005-04-16 15:20:36 -0700633
634 /* rtl8169_PHYstatus */
Francois Romieu07d3f512007-02-21 22:40:46 +0100635 TBI_Enable = 0x80,
636 TxFlowCtrl = 0x40,
637 RxFlowCtrl = 0x20,
638 _1000bpsF = 0x10,
639 _100bps = 0x08,
640 _10bps = 0x04,
641 LinkStatus = 0x02,
642 FullDup = 0x01,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700643
Linus Torvalds1da177e2005-04-16 15:20:36 -0700644 /* _TBICSRBit */
Francois Romieu07d3f512007-02-21 22:40:46 +0100645 TBILinkOK = 0x02000000,
Stephen Hemmingerd4a3a0f2005-05-27 21:11:56 +0200646
Corinna Vinschen6e85d5a2015-08-24 12:52:39 +0200647 /* ResetCounterCommand */
648 CounterReset = 0x1,
649
Stephen Hemmingerd4a3a0f2005-05-27 21:11:56 +0200650 /* DumpCounterCommand */
Francois Romieu07d3f512007-02-21 22:40:46 +0100651 CounterDump = 0x8,
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +0800652
653 /* magic enable v2 */
654 MagicPacket_v2 = (1 << 16), /* Wake up when receives a Magic Packet */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700655};
656
Francois Romieu2b7b4312011-04-18 22:53:24 -0700657enum rtl_desc_bit {
658 /* First doubleword. */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700659 DescOwn = (1 << 31), /* Descriptor is owned by NIC */
660 RingEnd = (1 << 30), /* End of descriptor ring */
661 FirstFrag = (1 << 29), /* First segment of a packet */
662 LastFrag = (1 << 28), /* Final segment of a packet */
Francois Romieu2b7b4312011-04-18 22:53:24 -0700663};
Linus Torvalds1da177e2005-04-16 15:20:36 -0700664
Francois Romieu2b7b4312011-04-18 22:53:24 -0700665/* Generic case. */
666enum rtl_tx_desc_bit {
667 /* First doubleword. */
668 TD_LSO = (1 << 27), /* Large Send Offload */
669#define TD_MSS_MAX 0x07ffu /* MSS value */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700670
Francois Romieu2b7b4312011-04-18 22:53:24 -0700671 /* Second doubleword. */
672 TxVlanTag = (1 << 17), /* Add VLAN tag */
673};
674
675/* 8169, 8168b and 810x except 8102e. */
676enum rtl_tx_desc_bit_0 {
677 /* First doubleword. */
678#define TD0_MSS_SHIFT 16 /* MSS position (11 bits) */
679 TD0_TCP_CS = (1 << 16), /* Calculate TCP/IP checksum */
680 TD0_UDP_CS = (1 << 17), /* Calculate UDP/IP checksum */
681 TD0_IP_CS = (1 << 18), /* Calculate IP checksum */
682};
683
684/* 8102e, 8168c and beyond. */
685enum rtl_tx_desc_bit_1 {
hayeswangbdfa4ed2014-07-11 16:25:57 +0800686 /* First doubleword. */
687 TD1_GTSENV4 = (1 << 26), /* Giant Send for IPv4 */
hayeswange9746042014-07-11 16:25:58 +0800688 TD1_GTSENV6 = (1 << 25), /* Giant Send for IPv6 */
hayeswangbdfa4ed2014-07-11 16:25:57 +0800689#define GTTCPHO_SHIFT 18
hayeswange9746042014-07-11 16:25:58 +0800690#define GTTCPHO_MAX 0x7fU
hayeswangbdfa4ed2014-07-11 16:25:57 +0800691
Francois Romieu2b7b4312011-04-18 22:53:24 -0700692 /* Second doubleword. */
hayeswange9746042014-07-11 16:25:58 +0800693#define TCPHO_SHIFT 18
694#define TCPHO_MAX 0x3ffU
Francois Romieu2b7b4312011-04-18 22:53:24 -0700695#define TD1_MSS_SHIFT 18 /* MSS position (11 bits) */
hayeswange9746042014-07-11 16:25:58 +0800696 TD1_IPv6_CS = (1 << 28), /* Calculate IPv6 checksum */
697 TD1_IPv4_CS = (1 << 29), /* Calculate IPv4 checksum */
Francois Romieu2b7b4312011-04-18 22:53:24 -0700698 TD1_TCP_CS = (1 << 30), /* Calculate TCP/IP checksum */
699 TD1_UDP_CS = (1 << 31), /* Calculate UDP/IP checksum */
700};
701
Francois Romieu2b7b4312011-04-18 22:53:24 -0700702enum rtl_rx_desc_bit {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700703 /* Rx private */
704 PID1 = (1 << 18), /* Protocol ID bit 1/2 */
Zhu Yanjun9b600472017-01-05 02:54:27 -0500705 PID0 = (1 << 17), /* Protocol ID bit 0/2 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700706
707#define RxProtoUDP (PID1)
708#define RxProtoTCP (PID0)
709#define RxProtoIP (PID1 | PID0)
710#define RxProtoMask RxProtoIP
711
712 IPFail = (1 << 16), /* IP checksum failed */
713 UDPFail = (1 << 15), /* UDP/IP checksum failed */
714 TCPFail = (1 << 14), /* TCP/IP checksum failed */
715 RxVlanTag = (1 << 16), /* VLAN tag available */
716};
717
718#define RsvdMask 0x3fffc000
719
720struct TxDesc {
Rolf Eike Beer6cccd6e2007-05-21 22:11:04 +0200721 __le32 opts1;
722 __le32 opts2;
723 __le64 addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700724};
725
726struct RxDesc {
Rolf Eike Beer6cccd6e2007-05-21 22:11:04 +0200727 __le32 opts1;
728 __le32 opts2;
729 __le64 addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700730};
731
732struct ring_info {
733 struct sk_buff *skb;
734 u32 len;
735 u8 __pad[sizeof(void *) - sizeof(u32)];
736};
737
Francois Romieuf23e7fd2007-10-04 22:36:14 +0200738enum features {
Francois Romieuccdffb92008-07-26 14:26:06 +0200739 RTL_FEATURE_WOL = (1 << 0),
740 RTL_FEATURE_MSI = (1 << 1),
741 RTL_FEATURE_GMII = (1 << 2),
Francois Romieuf23e7fd2007-10-04 22:36:14 +0200742};
743
Ivan Vecera355423d2009-02-06 21:49:57 -0800744struct rtl8169_counters {
745 __le64 tx_packets;
746 __le64 rx_packets;
747 __le64 tx_errors;
748 __le32 rx_errors;
749 __le16 rx_missed;
750 __le16 align_errors;
751 __le32 tx_one_collision;
752 __le32 tx_multi_collision;
753 __le64 rx_unicast;
754 __le64 rx_broadcast;
755 __le32 rx_multicast;
756 __le16 tx_aborted;
757 __le16 tx_underun;
758};
759
Corinna Vinschen6e85d5a2015-08-24 12:52:39 +0200760struct rtl8169_tc_offsets {
761 bool inited;
762 __le64 tx_errors;
763 __le32 tx_multi_collision;
Corinna Vinschen6e85d5a2015-08-24 12:52:39 +0200764 __le16 tx_aborted;
765};
766
Francois Romieuda78dbf2012-01-26 14:18:23 +0100767enum rtl_flag {
Francois Romieu6c4a70c2012-01-31 10:56:44 +0100768 RTL_FLAG_TASK_ENABLED,
Francois Romieuda78dbf2012-01-26 14:18:23 +0100769 RTL_FLAG_TASK_SLOW_PENDING,
770 RTL_FLAG_TASK_RESET_PENDING,
771 RTL_FLAG_TASK_PHY_PENDING,
772 RTL_FLAG_MAX
773};
774
Junchang Wang8027aa22012-03-04 23:30:32 +0100775struct rtl8169_stats {
776 u64 packets;
777 u64 bytes;
778 struct u64_stats_sync syncp;
779};
780
Linus Torvalds1da177e2005-04-16 15:20:36 -0700781struct rtl8169_private {
782 void __iomem *mmio_addr; /* memory map physical address */
Francois Romieucecb5fd2011-04-01 10:21:07 +0200783 struct pci_dev *pci_dev;
David Howellsc4028952006-11-22 14:57:56 +0000784 struct net_device *dev;
Stephen Hemmingerbea33482007-10-03 16:41:36 -0700785 struct napi_struct napi;
Stephen Hemmingerb57b7e52005-05-27 21:11:52 +0200786 u32 msg_enable;
Francois Romieu2b7b4312011-04-18 22:53:24 -0700787 u16 txd_version;
788 u16 mac_version;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700789 u32 cur_rx; /* Index into the Rx descriptor buffer of next Rx pkt. */
790 u32 cur_tx; /* Index into the Tx descriptor buffer of next Rx pkt. */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700791 u32 dirty_tx;
Junchang Wang8027aa22012-03-04 23:30:32 +0100792 struct rtl8169_stats rx_stats;
793 struct rtl8169_stats tx_stats;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700794 struct TxDesc *TxDescArray; /* 256-aligned Tx descriptor ring */
795 struct RxDesc *RxDescArray; /* 256-aligned Rx descriptor ring */
796 dma_addr_t TxPhyAddr;
797 dma_addr_t RxPhyAddr;
Eric Dumazet6f0333b2010-10-11 11:17:47 +0000798 void *Rx_databuff[NUM_RX_DESC]; /* Rx data buffers */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700799 struct ring_info tx_skb[NUM_TX_DESC]; /* Tx data buffers */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700800 struct timer_list timer;
801 u16 cp_cmd;
Francois Romieuda78dbf2012-01-26 14:18:23 +0100802
803 u16 event_slow;
Francois Romieu50970832017-10-27 13:24:49 +0300804 const struct rtl_coalesce_info *coalesce_info;
françois romieuc0e45c12011-01-03 15:08:04 +0000805
806 struct mdio_ops {
Francois Romieu24192212012-07-06 20:19:42 +0200807 void (*write)(struct rtl8169_private *, int, int);
808 int (*read)(struct rtl8169_private *, int);
françois romieuc0e45c12011-01-03 15:08:04 +0000809 } mdio_ops;
810
françois romieu065c27c2011-01-03 15:08:12 +0000811 struct pll_power_ops {
812 void (*down)(struct rtl8169_private *);
813 void (*up)(struct rtl8169_private *);
814 } pll_power_ops;
815
Francois Romieud58d46b2011-05-03 16:38:29 +0200816 struct jumbo_ops {
817 void (*enable)(struct rtl8169_private *);
818 void (*disable)(struct rtl8169_private *);
819 } jumbo_ops;
820
Hayes Wangbeb1fe12012-03-30 14:33:01 +0800821 struct csi_ops {
Francois Romieu52989f02012-07-06 13:37:00 +0200822 void (*write)(struct rtl8169_private *, int, int);
823 u32 (*read)(struct rtl8169_private *, int);
Hayes Wangbeb1fe12012-03-30 14:33:01 +0800824 } csi_ops;
825
Oliver Neukum54405cd2011-01-06 21:55:13 +0100826 int (*set_speed)(struct net_device *, u8 aneg, u16 sp, u8 dpx, u32 adv);
Philippe Reynes6fa1ba62017-02-23 22:34:43 +0100827 int (*get_link_ksettings)(struct net_device *,
828 struct ethtool_link_ksettings *);
françois romieu4da19632011-01-03 15:07:55 +0000829 void (*phy_reset_enable)(struct rtl8169_private *tp);
Francois Romieu07ce4062007-02-23 23:36:39 +0100830 void (*hw_start)(struct net_device *);
françois romieu4da19632011-01-03 15:07:55 +0000831 unsigned int (*phy_reset_pending)(struct rtl8169_private *tp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700832 unsigned int (*link_ok)(void __iomem *);
Francois Romieu8b4ab282008-11-19 22:05:25 -0800833 int (*do_ioctl)(struct rtl8169_private *tp, struct mii_ioctl_data *data, int cmd);
hayeswang5888d3f2014-07-11 16:25:56 +0800834 bool (*tso_csum)(struct rtl8169_private *, struct sk_buff *, u32 *);
Francois Romieu4422bcd2012-01-26 11:23:32 +0100835
836 struct {
Francois Romieuda78dbf2012-01-26 14:18:23 +0100837 DECLARE_BITMAP(flags, RTL_FLAG_MAX);
838 struct mutex mutex;
Francois Romieu4422bcd2012-01-26 11:23:32 +0100839 struct work_struct work;
840 } wk;
841
Francois Romieuf23e7fd2007-10-04 22:36:14 +0200842 unsigned features;
Francois Romieuccdffb92008-07-26 14:26:06 +0200843
844 struct mii_if_info mii;
Corinna Vinschen42020322015-09-10 10:47:35 +0200845 dma_addr_t counters_phys_addr;
846 struct rtl8169_counters *counters;
Corinna Vinschen6e85d5a2015-08-24 12:52:39 +0200847 struct rtl8169_tc_offsets tc_offset;
Rafael J. Wysockie1759442010-03-14 14:33:51 +0000848 u32 saved_wolopts;
David S. Miller8decf862011-09-22 03:23:13 -0400849 u32 opts1_mask;
françois romieuf1e02ed2011-01-13 13:07:53 +0000850
Francois Romieub6ffd972011-06-17 17:00:05 +0200851 struct rtl_fw {
852 const struct firmware *fw;
Francois Romieu1c361ef2011-06-17 17:16:24 +0200853
854#define RTL_VER_SIZE 32
855
856 char version[RTL_VER_SIZE];
857
858 struct rtl_fw_phy_action {
859 __le32 *code;
860 size_t size;
861 } phy_action;
Francois Romieub6ffd972011-06-17 17:00:05 +0200862 } *rtl_fw;
Phil Carmody497888c2011-07-14 15:07:13 +0300863#define RTL_FIRMWARE_UNKNOWN ERR_PTR(-EAGAIN)
Hayes Wangc5583862012-07-02 17:23:22 +0800864
865 u32 ocp_base;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700866};
867
Ralf Baechle979b6c12005-06-13 14:30:40 -0700868MODULE_AUTHOR("Realtek and the Linux r8169 crew <netdev@vger.kernel.org>");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700869MODULE_DESCRIPTION("RealTek RTL-8169 Gigabit Ethernet driver");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700870module_param(use_dac, int, 0);
David S. Miller4300e8c2010-03-26 10:23:30 -0700871MODULE_PARM_DESC(use_dac, "Enable PCI DAC. Unsafe on 32 bit PCI slot.");
Stephen Hemmingerb57b7e52005-05-27 21:11:52 +0200872module_param_named(debug, debug.msg_enable, int, 0);
873MODULE_PARM_DESC(debug, "Debug verbosity level (0=none, ..., 16=all)");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700874MODULE_LICENSE("GPL");
875MODULE_VERSION(RTL8169_VERSION);
françois romieubca03d52011-01-03 15:07:31 +0000876MODULE_FIRMWARE(FIRMWARE_8168D_1);
877MODULE_FIRMWARE(FIRMWARE_8168D_2);
hayeswang01dc7fe2011-03-21 01:50:28 +0000878MODULE_FIRMWARE(FIRMWARE_8168E_1);
879MODULE_FIRMWARE(FIRMWARE_8168E_2);
David S. Miller8decf862011-09-22 03:23:13 -0400880MODULE_FIRMWARE(FIRMWARE_8168E_3);
Hayes Wang5a5e4442011-02-22 17:26:21 +0800881MODULE_FIRMWARE(FIRMWARE_8105E_1);
Hayes Wangc2218922011-09-06 16:55:18 +0800882MODULE_FIRMWARE(FIRMWARE_8168F_1);
883MODULE_FIRMWARE(FIRMWARE_8168F_2);
Hayes Wang7e18dca2012-03-30 14:33:02 +0800884MODULE_FIRMWARE(FIRMWARE_8402_1);
Hayes Wangb3d7b2f2012-03-30 14:48:06 +0800885MODULE_FIRMWARE(FIRMWARE_8411_1);
hayeswang45dd95c2013-07-08 17:09:01 +0800886MODULE_FIRMWARE(FIRMWARE_8411_2);
Hayes Wang5598bfe2012-07-02 17:23:21 +0800887MODULE_FIRMWARE(FIRMWARE_8106E_1);
hayeswang58152cd2013-04-01 22:23:42 +0000888MODULE_FIRMWARE(FIRMWARE_8106E_2);
hayeswangbeb330a2013-04-01 22:23:39 +0000889MODULE_FIRMWARE(FIRMWARE_8168G_2);
hayeswang57538c42013-04-01 22:23:40 +0000890MODULE_FIRMWARE(FIRMWARE_8168G_3);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +0800891MODULE_FIRMWARE(FIRMWARE_8168H_1);
892MODULE_FIRMWARE(FIRMWARE_8168H_2);
Francois Romieua3bf5c42014-08-26 22:40:38 +0200893MODULE_FIRMWARE(FIRMWARE_8107E_1);
894MODULE_FIRMWARE(FIRMWARE_8107E_2);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700895
Francois Romieuda78dbf2012-01-26 14:18:23 +0100896static void rtl_lock_work(struct rtl8169_private *tp)
897{
898 mutex_lock(&tp->wk.mutex);
899}
900
901static void rtl_unlock_work(struct rtl8169_private *tp)
902{
903 mutex_unlock(&tp->wk.mutex);
904}
905
Francois Romieud58d46b2011-05-03 16:38:29 +0200906static void rtl_tx_performance_tweak(struct pci_dev *pdev, u16 force)
907{
Jiang Liu7d7903b2012-07-24 17:20:16 +0800908 pcie_capability_clear_and_set_word(pdev, PCI_EXP_DEVCTL,
909 PCI_EXP_DEVCTL_READRQ, force);
Francois Romieud58d46b2011-05-03 16:38:29 +0200910}
911
Francois Romieuffc46952012-07-06 14:19:23 +0200912struct rtl_cond {
913 bool (*check)(struct rtl8169_private *);
914 const char *msg;
915};
916
917static void rtl_udelay(unsigned int d)
918{
919 udelay(d);
920}
921
922static bool rtl_loop_wait(struct rtl8169_private *tp, const struct rtl_cond *c,
923 void (*delay)(unsigned int), unsigned int d, int n,
924 bool high)
925{
926 int i;
927
928 for (i = 0; i < n; i++) {
929 delay(d);
930 if (c->check(tp) == high)
931 return true;
932 }
Francois Romieu82e316e2012-07-11 23:39:51 +0200933 netif_err(tp, drv, tp->dev, "%s == %d (loop: %d, delay: %d).\n",
934 c->msg, !high, n, d);
Francois Romieuffc46952012-07-06 14:19:23 +0200935 return false;
936}
937
938static bool rtl_udelay_loop_wait_high(struct rtl8169_private *tp,
939 const struct rtl_cond *c,
940 unsigned int d, int n)
941{
942 return rtl_loop_wait(tp, c, rtl_udelay, d, n, true);
943}
944
945static bool rtl_udelay_loop_wait_low(struct rtl8169_private *tp,
946 const struct rtl_cond *c,
947 unsigned int d, int n)
948{
949 return rtl_loop_wait(tp, c, rtl_udelay, d, n, false);
950}
951
952static bool rtl_msleep_loop_wait_high(struct rtl8169_private *tp,
953 const struct rtl_cond *c,
954 unsigned int d, int n)
955{
956 return rtl_loop_wait(tp, c, msleep, d, n, true);
957}
958
959static bool rtl_msleep_loop_wait_low(struct rtl8169_private *tp,
960 const struct rtl_cond *c,
961 unsigned int d, int n)
962{
963 return rtl_loop_wait(tp, c, msleep, d, n, false);
964}
965
966#define DECLARE_RTL_COND(name) \
967static bool name ## _check(struct rtl8169_private *); \
968 \
969static const struct rtl_cond name = { \
970 .check = name ## _check, \
971 .msg = #name \
972}; \
973 \
974static bool name ## _check(struct rtl8169_private *tp)
975
Hayes Wangc5583862012-07-02 17:23:22 +0800976static bool rtl_ocp_reg_failure(struct rtl8169_private *tp, u32 reg)
977{
978 if (reg & 0xffff0001) {
979 netif_err(tp, drv, tp->dev, "Invalid ocp reg %x!\n", reg);
980 return true;
981 }
982 return false;
983}
984
985DECLARE_RTL_COND(rtl_ocp_gphy_cond)
986{
987 void __iomem *ioaddr = tp->mmio_addr;
988
989 return RTL_R32(GPHY_OCP) & OCPAR_FLAG;
990}
991
992static void r8168_phy_ocp_write(struct rtl8169_private *tp, u32 reg, u32 data)
993{
994 void __iomem *ioaddr = tp->mmio_addr;
995
996 if (rtl_ocp_reg_failure(tp, reg))
997 return;
998
999 RTL_W32(GPHY_OCP, OCPAR_FLAG | (reg << 15) | data);
1000
1001 rtl_udelay_loop_wait_low(tp, &rtl_ocp_gphy_cond, 25, 10);
1002}
1003
1004static u16 r8168_phy_ocp_read(struct rtl8169_private *tp, u32 reg)
1005{
1006 void __iomem *ioaddr = tp->mmio_addr;
1007
1008 if (rtl_ocp_reg_failure(tp, reg))
1009 return 0;
1010
1011 RTL_W32(GPHY_OCP, reg << 15);
1012
1013 return rtl_udelay_loop_wait_high(tp, &rtl_ocp_gphy_cond, 25, 10) ?
1014 (RTL_R32(GPHY_OCP) & 0xffff) : ~0;
1015}
1016
Hayes Wangc5583862012-07-02 17:23:22 +08001017static void r8168_mac_ocp_write(struct rtl8169_private *tp, u32 reg, u32 data)
1018{
1019 void __iomem *ioaddr = tp->mmio_addr;
1020
1021 if (rtl_ocp_reg_failure(tp, reg))
1022 return;
1023
1024 RTL_W32(OCPDR, OCPAR_FLAG | (reg << 15) | data);
Hayes Wangc5583862012-07-02 17:23:22 +08001025}
1026
1027static u16 r8168_mac_ocp_read(struct rtl8169_private *tp, u32 reg)
1028{
1029 void __iomem *ioaddr = tp->mmio_addr;
1030
1031 if (rtl_ocp_reg_failure(tp, reg))
1032 return 0;
1033
1034 RTL_W32(OCPDR, reg << 15);
1035
Hayes Wang3a83ad12012-07-11 20:31:56 +08001036 return RTL_R32(OCPDR);
Hayes Wangc5583862012-07-02 17:23:22 +08001037}
1038
1039#define OCP_STD_PHY_BASE 0xa400
1040
1041static void r8168g_mdio_write(struct rtl8169_private *tp, int reg, int value)
1042{
1043 if (reg == 0x1f) {
1044 tp->ocp_base = value ? value << 4 : OCP_STD_PHY_BASE;
1045 return;
1046 }
1047
1048 if (tp->ocp_base != OCP_STD_PHY_BASE)
1049 reg -= 0x10;
1050
1051 r8168_phy_ocp_write(tp, tp->ocp_base + reg * 2, value);
1052}
1053
1054static int r8168g_mdio_read(struct rtl8169_private *tp, int reg)
1055{
1056 if (tp->ocp_base != OCP_STD_PHY_BASE)
1057 reg -= 0x10;
1058
1059 return r8168_phy_ocp_read(tp, tp->ocp_base + reg * 2);
1060}
1061
hayeswangeee37862013-04-01 22:23:38 +00001062static void mac_mcu_write(struct rtl8169_private *tp, int reg, int value)
1063{
1064 if (reg == 0x1f) {
1065 tp->ocp_base = value << 4;
1066 return;
1067 }
1068
1069 r8168_mac_ocp_write(tp, tp->ocp_base + reg, value);
1070}
1071
1072static int mac_mcu_read(struct rtl8169_private *tp, int reg)
1073{
1074 return r8168_mac_ocp_read(tp, tp->ocp_base + reg);
1075}
1076
Francois Romieuffc46952012-07-06 14:19:23 +02001077DECLARE_RTL_COND(rtl_phyar_cond)
1078{
1079 void __iomem *ioaddr = tp->mmio_addr;
1080
1081 return RTL_R32(PHYAR) & 0x80000000;
1082}
1083
Francois Romieu24192212012-07-06 20:19:42 +02001084static void r8169_mdio_write(struct rtl8169_private *tp, int reg, int value)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001085{
Francois Romieu24192212012-07-06 20:19:42 +02001086 void __iomem *ioaddr = tp->mmio_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001087
Francois Romieu24192212012-07-06 20:19:42 +02001088 RTL_W32(PHYAR, 0x80000000 | (reg & 0x1f) << 16 | (value & 0xffff));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001089
Francois Romieuffc46952012-07-06 14:19:23 +02001090 rtl_udelay_loop_wait_low(tp, &rtl_phyar_cond, 25, 20);
Timo Teräs024a07b2010-06-06 15:38:47 -07001091 /*
Timo Teräs81a95f02010-06-09 17:31:48 -07001092 * According to hardware specs a 20us delay is required after write
1093 * complete indication, but before sending next command.
Timo Teräs024a07b2010-06-06 15:38:47 -07001094 */
Timo Teräs81a95f02010-06-09 17:31:48 -07001095 udelay(20);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001096}
1097
Francois Romieu24192212012-07-06 20:19:42 +02001098static int r8169_mdio_read(struct rtl8169_private *tp, int reg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001099{
Francois Romieu24192212012-07-06 20:19:42 +02001100 void __iomem *ioaddr = tp->mmio_addr;
Francois Romieuffc46952012-07-06 14:19:23 +02001101 int value;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001102
Francois Romieu24192212012-07-06 20:19:42 +02001103 RTL_W32(PHYAR, 0x0 | (reg & 0x1f) << 16);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001104
Francois Romieuffc46952012-07-06 14:19:23 +02001105 value = rtl_udelay_loop_wait_high(tp, &rtl_phyar_cond, 25, 20) ?
1106 RTL_R32(PHYAR) & 0xffff : ~0;
1107
Timo Teräs81a95f02010-06-09 17:31:48 -07001108 /*
1109 * According to hardware specs a 20us delay is required after read
1110 * complete indication, but before sending next command.
1111 */
1112 udelay(20);
1113
Linus Torvalds1da177e2005-04-16 15:20:36 -07001114 return value;
1115}
1116
Chun-Hao Lin935e2212014-10-07 15:10:41 +08001117DECLARE_RTL_COND(rtl_ocpar_cond)
1118{
1119 void __iomem *ioaddr = tp->mmio_addr;
1120
1121 return RTL_R32(OCPAR) & OCPAR_FLAG;
1122}
1123
Francois Romieu24192212012-07-06 20:19:42 +02001124static void r8168dp_1_mdio_access(struct rtl8169_private *tp, int reg, u32 data)
françois romieuc0e45c12011-01-03 15:08:04 +00001125{
Francois Romieu24192212012-07-06 20:19:42 +02001126 void __iomem *ioaddr = tp->mmio_addr;
françois romieuc0e45c12011-01-03 15:08:04 +00001127
Francois Romieu24192212012-07-06 20:19:42 +02001128 RTL_W32(OCPDR, data | ((reg & OCPDR_REG_MASK) << OCPDR_GPHY_REG_SHIFT));
françois romieuc0e45c12011-01-03 15:08:04 +00001129 RTL_W32(OCPAR, OCPAR_GPHY_WRITE_CMD);
1130 RTL_W32(EPHY_RXER_NUM, 0);
1131
Francois Romieuffc46952012-07-06 14:19:23 +02001132 rtl_udelay_loop_wait_low(tp, &rtl_ocpar_cond, 1000, 100);
françois romieuc0e45c12011-01-03 15:08:04 +00001133}
1134
Francois Romieu24192212012-07-06 20:19:42 +02001135static void r8168dp_1_mdio_write(struct rtl8169_private *tp, int reg, int value)
françois romieuc0e45c12011-01-03 15:08:04 +00001136{
Francois Romieu24192212012-07-06 20:19:42 +02001137 r8168dp_1_mdio_access(tp, reg,
1138 OCPDR_WRITE_CMD | (value & OCPDR_DATA_MASK));
françois romieuc0e45c12011-01-03 15:08:04 +00001139}
1140
Francois Romieu24192212012-07-06 20:19:42 +02001141static int r8168dp_1_mdio_read(struct rtl8169_private *tp, int reg)
françois romieuc0e45c12011-01-03 15:08:04 +00001142{
Francois Romieu24192212012-07-06 20:19:42 +02001143 void __iomem *ioaddr = tp->mmio_addr;
françois romieuc0e45c12011-01-03 15:08:04 +00001144
Francois Romieu24192212012-07-06 20:19:42 +02001145 r8168dp_1_mdio_access(tp, reg, OCPDR_READ_CMD);
françois romieuc0e45c12011-01-03 15:08:04 +00001146
1147 mdelay(1);
1148 RTL_W32(OCPAR, OCPAR_GPHY_READ_CMD);
1149 RTL_W32(EPHY_RXER_NUM, 0);
1150
Francois Romieuffc46952012-07-06 14:19:23 +02001151 return rtl_udelay_loop_wait_high(tp, &rtl_ocpar_cond, 1000, 100) ?
1152 RTL_R32(OCPDR) & OCPDR_DATA_MASK : ~0;
françois romieuc0e45c12011-01-03 15:08:04 +00001153}
1154
françois romieue6de30d2011-01-03 15:08:37 +00001155#define R8168DP_1_MDIO_ACCESS_BIT 0x00020000
1156
1157static void r8168dp_2_mdio_start(void __iomem *ioaddr)
1158{
1159 RTL_W32(0xd0, RTL_R32(0xd0) & ~R8168DP_1_MDIO_ACCESS_BIT);
1160}
1161
1162static void r8168dp_2_mdio_stop(void __iomem *ioaddr)
1163{
1164 RTL_W32(0xd0, RTL_R32(0xd0) | R8168DP_1_MDIO_ACCESS_BIT);
1165}
1166
Francois Romieu24192212012-07-06 20:19:42 +02001167static void r8168dp_2_mdio_write(struct rtl8169_private *tp, int reg, int value)
françois romieue6de30d2011-01-03 15:08:37 +00001168{
Francois Romieu24192212012-07-06 20:19:42 +02001169 void __iomem *ioaddr = tp->mmio_addr;
1170
françois romieue6de30d2011-01-03 15:08:37 +00001171 r8168dp_2_mdio_start(ioaddr);
1172
Francois Romieu24192212012-07-06 20:19:42 +02001173 r8169_mdio_write(tp, reg, value);
françois romieue6de30d2011-01-03 15:08:37 +00001174
1175 r8168dp_2_mdio_stop(ioaddr);
1176}
1177
Francois Romieu24192212012-07-06 20:19:42 +02001178static int r8168dp_2_mdio_read(struct rtl8169_private *tp, int reg)
françois romieue6de30d2011-01-03 15:08:37 +00001179{
Francois Romieu24192212012-07-06 20:19:42 +02001180 void __iomem *ioaddr = tp->mmio_addr;
françois romieue6de30d2011-01-03 15:08:37 +00001181 int value;
1182
1183 r8168dp_2_mdio_start(ioaddr);
1184
Francois Romieu24192212012-07-06 20:19:42 +02001185 value = r8169_mdio_read(tp, reg);
françois romieue6de30d2011-01-03 15:08:37 +00001186
1187 r8168dp_2_mdio_stop(ioaddr);
1188
1189 return value;
1190}
1191
françois romieu4da19632011-01-03 15:07:55 +00001192static void rtl_writephy(struct rtl8169_private *tp, int location, u32 val)
Francois Romieudacf8152008-08-02 20:44:13 +02001193{
Francois Romieu24192212012-07-06 20:19:42 +02001194 tp->mdio_ops.write(tp, location, val);
Francois Romieudacf8152008-08-02 20:44:13 +02001195}
1196
françois romieu4da19632011-01-03 15:07:55 +00001197static int rtl_readphy(struct rtl8169_private *tp, int location)
1198{
Francois Romieu24192212012-07-06 20:19:42 +02001199 return tp->mdio_ops.read(tp, location);
françois romieu4da19632011-01-03 15:07:55 +00001200}
1201
1202static void rtl_patchphy(struct rtl8169_private *tp, int reg_addr, int value)
1203{
1204 rtl_writephy(tp, reg_addr, rtl_readphy(tp, reg_addr) | value);
1205}
1206
Chun-Hao Lin76564422014-10-01 23:17:17 +08001207static void rtl_w0w1_phy(struct rtl8169_private *tp, int reg_addr, int p, int m)
françois romieudaf9df62009-10-07 12:44:20 +00001208{
1209 int val;
1210
françois romieu4da19632011-01-03 15:07:55 +00001211 val = rtl_readphy(tp, reg_addr);
Chun-Hao Lin76564422014-10-01 23:17:17 +08001212 rtl_writephy(tp, reg_addr, (val & ~m) | p);
françois romieudaf9df62009-10-07 12:44:20 +00001213}
1214
Francois Romieuccdffb92008-07-26 14:26:06 +02001215static void rtl_mdio_write(struct net_device *dev, int phy_id, int location,
1216 int val)
1217{
1218 struct rtl8169_private *tp = netdev_priv(dev);
Francois Romieuccdffb92008-07-26 14:26:06 +02001219
françois romieu4da19632011-01-03 15:07:55 +00001220 rtl_writephy(tp, location, val);
Francois Romieuccdffb92008-07-26 14:26:06 +02001221}
1222
1223static int rtl_mdio_read(struct net_device *dev, int phy_id, int location)
1224{
1225 struct rtl8169_private *tp = netdev_priv(dev);
Francois Romieuccdffb92008-07-26 14:26:06 +02001226
françois romieu4da19632011-01-03 15:07:55 +00001227 return rtl_readphy(tp, location);
Francois Romieuccdffb92008-07-26 14:26:06 +02001228}
1229
Francois Romieuffc46952012-07-06 14:19:23 +02001230DECLARE_RTL_COND(rtl_ephyar_cond)
1231{
1232 void __iomem *ioaddr = tp->mmio_addr;
1233
1234 return RTL_R32(EPHYAR) & EPHYAR_FLAG;
1235}
1236
Francois Romieufdf6fc02012-07-06 22:40:38 +02001237static void rtl_ephy_write(struct rtl8169_private *tp, int reg_addr, int value)
Francois Romieudacf8152008-08-02 20:44:13 +02001238{
Francois Romieufdf6fc02012-07-06 22:40:38 +02001239 void __iomem *ioaddr = tp->mmio_addr;
Francois Romieudacf8152008-08-02 20:44:13 +02001240
1241 RTL_W32(EPHYAR, EPHYAR_WRITE_CMD | (value & EPHYAR_DATA_MASK) |
1242 (reg_addr & EPHYAR_REG_MASK) << EPHYAR_REG_SHIFT);
1243
Francois Romieuffc46952012-07-06 14:19:23 +02001244 rtl_udelay_loop_wait_low(tp, &rtl_ephyar_cond, 10, 100);
1245
1246 udelay(10);
Francois Romieudacf8152008-08-02 20:44:13 +02001247}
1248
Francois Romieufdf6fc02012-07-06 22:40:38 +02001249static u16 rtl_ephy_read(struct rtl8169_private *tp, int reg_addr)
Francois Romieudacf8152008-08-02 20:44:13 +02001250{
Francois Romieufdf6fc02012-07-06 22:40:38 +02001251 void __iomem *ioaddr = tp->mmio_addr;
Francois Romieudacf8152008-08-02 20:44:13 +02001252
1253 RTL_W32(EPHYAR, (reg_addr & EPHYAR_REG_MASK) << EPHYAR_REG_SHIFT);
1254
Francois Romieuffc46952012-07-06 14:19:23 +02001255 return rtl_udelay_loop_wait_high(tp, &rtl_ephyar_cond, 10, 100) ?
1256 RTL_R32(EPHYAR) & EPHYAR_DATA_MASK : ~0;
Francois Romieudacf8152008-08-02 20:44:13 +02001257}
1258
Chun-Hao Lin935e2212014-10-07 15:10:41 +08001259DECLARE_RTL_COND(rtl_eriar_cond)
1260{
1261 void __iomem *ioaddr = tp->mmio_addr;
1262
1263 return RTL_R32(ERIAR) & ERIAR_FLAG;
1264}
1265
Francois Romieufdf6fc02012-07-06 22:40:38 +02001266static void rtl_eri_write(struct rtl8169_private *tp, int addr, u32 mask,
1267 u32 val, int type)
Hayes Wang133ac402011-07-06 15:58:05 +08001268{
Francois Romieufdf6fc02012-07-06 22:40:38 +02001269 void __iomem *ioaddr = tp->mmio_addr;
Hayes Wang133ac402011-07-06 15:58:05 +08001270
1271 BUG_ON((addr & 3) || (mask == 0));
1272 RTL_W32(ERIDR, val);
1273 RTL_W32(ERIAR, ERIAR_WRITE_CMD | type | mask | addr);
1274
Francois Romieuffc46952012-07-06 14:19:23 +02001275 rtl_udelay_loop_wait_low(tp, &rtl_eriar_cond, 100, 100);
Hayes Wang133ac402011-07-06 15:58:05 +08001276}
1277
Francois Romieufdf6fc02012-07-06 22:40:38 +02001278static u32 rtl_eri_read(struct rtl8169_private *tp, int addr, int type)
Hayes Wang133ac402011-07-06 15:58:05 +08001279{
Francois Romieufdf6fc02012-07-06 22:40:38 +02001280 void __iomem *ioaddr = tp->mmio_addr;
Hayes Wang133ac402011-07-06 15:58:05 +08001281
1282 RTL_W32(ERIAR, ERIAR_READ_CMD | type | ERIAR_MASK_1111 | addr);
1283
Francois Romieuffc46952012-07-06 14:19:23 +02001284 return rtl_udelay_loop_wait_high(tp, &rtl_eriar_cond, 100, 100) ?
1285 RTL_R32(ERIDR) : ~0;
Hayes Wang133ac402011-07-06 15:58:05 +08001286}
1287
Chun-Hao Lin706123d2014-10-01 23:17:18 +08001288static void rtl_w0w1_eri(struct rtl8169_private *tp, int addr, u32 mask, u32 p,
Francois Romieufdf6fc02012-07-06 22:40:38 +02001289 u32 m, int type)
Hayes Wang133ac402011-07-06 15:58:05 +08001290{
1291 u32 val;
1292
Francois Romieufdf6fc02012-07-06 22:40:38 +02001293 val = rtl_eri_read(tp, addr, type);
1294 rtl_eri_write(tp, addr, mask, (val & ~m) | p, type);
Hayes Wang133ac402011-07-06 15:58:05 +08001295}
1296
Chun-Hao Lin935e2212014-10-07 15:10:41 +08001297static u32 r8168dp_ocp_read(struct rtl8169_private *tp, u8 mask, u16 reg)
1298{
1299 void __iomem *ioaddr = tp->mmio_addr;
1300
1301 RTL_W32(OCPAR, ((u32)mask & 0x0f) << 12 | (reg & 0x0fff));
1302 return rtl_udelay_loop_wait_high(tp, &rtl_ocpar_cond, 100, 20) ?
1303 RTL_R32(OCPDR) : ~0;
1304}
1305
1306static u32 r8168ep_ocp_read(struct rtl8169_private *tp, u8 mask, u16 reg)
1307{
1308 return rtl_eri_read(tp, reg, ERIAR_OOB);
1309}
1310
1311static u32 ocp_read(struct rtl8169_private *tp, u8 mask, u16 reg)
1312{
1313 switch (tp->mac_version) {
1314 case RTL_GIGA_MAC_VER_27:
1315 case RTL_GIGA_MAC_VER_28:
1316 case RTL_GIGA_MAC_VER_31:
1317 return r8168dp_ocp_read(tp, mask, reg);
1318 case RTL_GIGA_MAC_VER_49:
1319 case RTL_GIGA_MAC_VER_50:
1320 case RTL_GIGA_MAC_VER_51:
1321 return r8168ep_ocp_read(tp, mask, reg);
1322 default:
1323 BUG();
1324 return ~0;
1325 }
1326}
1327
1328static void r8168dp_ocp_write(struct rtl8169_private *tp, u8 mask, u16 reg,
1329 u32 data)
1330{
1331 void __iomem *ioaddr = tp->mmio_addr;
1332
1333 RTL_W32(OCPDR, data);
1334 RTL_W32(OCPAR, OCPAR_FLAG | ((u32)mask & 0x0f) << 12 | (reg & 0x0fff));
1335 rtl_udelay_loop_wait_low(tp, &rtl_ocpar_cond, 100, 20);
1336}
1337
1338static void r8168ep_ocp_write(struct rtl8169_private *tp, u8 mask, u16 reg,
1339 u32 data)
1340{
1341 rtl_eri_write(tp, reg, ((u32)mask & 0x0f) << ERIAR_MASK_SHIFT,
1342 data, ERIAR_OOB);
1343}
1344
1345static void ocp_write(struct rtl8169_private *tp, u8 mask, u16 reg, u32 data)
1346{
1347 switch (tp->mac_version) {
1348 case RTL_GIGA_MAC_VER_27:
1349 case RTL_GIGA_MAC_VER_28:
1350 case RTL_GIGA_MAC_VER_31:
1351 r8168dp_ocp_write(tp, mask, reg, data);
1352 break;
1353 case RTL_GIGA_MAC_VER_49:
1354 case RTL_GIGA_MAC_VER_50:
1355 case RTL_GIGA_MAC_VER_51:
1356 r8168ep_ocp_write(tp, mask, reg, data);
1357 break;
1358 default:
1359 BUG();
1360 break;
1361 }
1362}
1363
Chun-Hao Lin2a9b4d92014-10-01 23:17:20 +08001364static void rtl8168_oob_notify(struct rtl8169_private *tp, u8 cmd)
1365{
1366 rtl_eri_write(tp, 0xe8, ERIAR_MASK_0001, cmd, ERIAR_EXGMAC);
1367
1368 ocp_write(tp, 0x1, 0x30, 0x00000001);
1369}
1370
1371#define OOB_CMD_RESET 0x00
1372#define OOB_CMD_DRIVER_START 0x05
1373#define OOB_CMD_DRIVER_STOP 0x06
1374
1375static u16 rtl8168_get_ocp_reg(struct rtl8169_private *tp)
1376{
1377 return (tp->mac_version == RTL_GIGA_MAC_VER_31) ? 0xb8 : 0x10;
1378}
1379
1380DECLARE_RTL_COND(rtl_ocp_read_cond)
1381{
1382 u16 reg;
1383
1384 reg = rtl8168_get_ocp_reg(tp);
1385
1386 return ocp_read(tp, 0x0f, reg) & 0x00000800;
1387}
1388
Chun-Hao Lin935e2212014-10-07 15:10:41 +08001389DECLARE_RTL_COND(rtl_ep_ocp_read_cond)
1390{
1391 return ocp_read(tp, 0x0f, 0x124) & 0x00000001;
1392}
1393
1394DECLARE_RTL_COND(rtl_ocp_tx_cond)
1395{
1396 void __iomem *ioaddr = tp->mmio_addr;
1397
1398 return RTL_R8(IBISR0) & 0x02;
1399}
1400
Chun-Hao Lin003609d2014-12-02 16:48:31 +08001401static void rtl8168ep_stop_cmac(struct rtl8169_private *tp)
1402{
1403 void __iomem *ioaddr = tp->mmio_addr;
1404
1405 RTL_W8(IBCR2, RTL_R8(IBCR2) & ~0x01);
1406 rtl_msleep_loop_wait_low(tp, &rtl_ocp_tx_cond, 50, 2000);
1407 RTL_W8(IBISR0, RTL_R8(IBISR0) | 0x20);
1408 RTL_W8(IBCR0, RTL_R8(IBCR0) & ~0x01);
1409}
1410
Chun-Hao Lin935e2212014-10-07 15:10:41 +08001411static void rtl8168dp_driver_start(struct rtl8169_private *tp)
Chun-Hao Lin2a9b4d92014-10-01 23:17:20 +08001412{
1413 rtl8168_oob_notify(tp, OOB_CMD_DRIVER_START);
Chun-Hao Lin2a9b4d92014-10-01 23:17:20 +08001414 rtl_msleep_loop_wait_high(tp, &rtl_ocp_read_cond, 10, 10);
1415}
1416
Chun-Hao Lin935e2212014-10-07 15:10:41 +08001417static void rtl8168ep_driver_start(struct rtl8169_private *tp)
1418{
1419 ocp_write(tp, 0x01, 0x180, OOB_CMD_DRIVER_START);
1420 ocp_write(tp, 0x01, 0x30, ocp_read(tp, 0x01, 0x30) | 0x01);
1421 rtl_msleep_loop_wait_high(tp, &rtl_ep_ocp_read_cond, 10, 10);
1422}
1423
1424static void rtl8168_driver_start(struct rtl8169_private *tp)
1425{
1426 switch (tp->mac_version) {
1427 case RTL_GIGA_MAC_VER_27:
1428 case RTL_GIGA_MAC_VER_28:
1429 case RTL_GIGA_MAC_VER_31:
1430 rtl8168dp_driver_start(tp);
1431 break;
1432 case RTL_GIGA_MAC_VER_49:
1433 case RTL_GIGA_MAC_VER_50:
1434 case RTL_GIGA_MAC_VER_51:
1435 rtl8168ep_driver_start(tp);
1436 break;
1437 default:
1438 BUG();
1439 break;
1440 }
1441}
1442
1443static void rtl8168dp_driver_stop(struct rtl8169_private *tp)
1444{
1445 rtl8168_oob_notify(tp, OOB_CMD_DRIVER_STOP);
1446 rtl_msleep_loop_wait_low(tp, &rtl_ocp_read_cond, 10, 10);
1447}
1448
1449static void rtl8168ep_driver_stop(struct rtl8169_private *tp)
1450{
Chun-Hao Lin003609d2014-12-02 16:48:31 +08001451 rtl8168ep_stop_cmac(tp);
Chun-Hao Lin935e2212014-10-07 15:10:41 +08001452 ocp_write(tp, 0x01, 0x180, OOB_CMD_DRIVER_STOP);
1453 ocp_write(tp, 0x01, 0x30, ocp_read(tp, 0x01, 0x30) | 0x01);
1454 rtl_msleep_loop_wait_low(tp, &rtl_ep_ocp_read_cond, 10, 10);
1455}
1456
Chun-Hao Lin2a9b4d92014-10-01 23:17:20 +08001457static void rtl8168_driver_stop(struct rtl8169_private *tp)
1458{
Chun-Hao Lin935e2212014-10-07 15:10:41 +08001459 switch (tp->mac_version) {
1460 case RTL_GIGA_MAC_VER_27:
1461 case RTL_GIGA_MAC_VER_28:
1462 case RTL_GIGA_MAC_VER_31:
1463 rtl8168dp_driver_stop(tp);
1464 break;
1465 case RTL_GIGA_MAC_VER_49:
1466 case RTL_GIGA_MAC_VER_50:
1467 case RTL_GIGA_MAC_VER_51:
1468 rtl8168ep_driver_stop(tp);
1469 break;
1470 default:
1471 BUG();
1472 break;
1473 }
Chun-Hao Lin2a9b4d92014-10-01 23:17:20 +08001474}
1475
Chun-Hao Lin935e2212014-10-07 15:10:41 +08001476static int r8168dp_check_dash(struct rtl8169_private *tp)
Chun-Hao Lin2a9b4d92014-10-01 23:17:20 +08001477{
1478 u16 reg = rtl8168_get_ocp_reg(tp);
1479
1480 return (ocp_read(tp, 0x0f, reg) & 0x00008000) ? 1 : 0;
1481}
1482
Chun-Hao Lin935e2212014-10-07 15:10:41 +08001483static int r8168ep_check_dash(struct rtl8169_private *tp)
1484{
1485 return (ocp_read(tp, 0x0f, 0x128) & 0x00000001) ? 1 : 0;
1486}
1487
1488static int r8168_check_dash(struct rtl8169_private *tp)
1489{
1490 switch (tp->mac_version) {
1491 case RTL_GIGA_MAC_VER_27:
1492 case RTL_GIGA_MAC_VER_28:
1493 case RTL_GIGA_MAC_VER_31:
1494 return r8168dp_check_dash(tp);
1495 case RTL_GIGA_MAC_VER_49:
1496 case RTL_GIGA_MAC_VER_50:
1497 case RTL_GIGA_MAC_VER_51:
1498 return r8168ep_check_dash(tp);
1499 default:
1500 return 0;
1501 }
1502}
1503
françois romieuc28aa382011-08-02 03:53:43 +00001504struct exgmac_reg {
1505 u16 addr;
1506 u16 mask;
1507 u32 val;
1508};
1509
Francois Romieufdf6fc02012-07-06 22:40:38 +02001510static void rtl_write_exgmac_batch(struct rtl8169_private *tp,
françois romieuc28aa382011-08-02 03:53:43 +00001511 const struct exgmac_reg *r, int len)
1512{
1513 while (len-- > 0) {
Francois Romieufdf6fc02012-07-06 22:40:38 +02001514 rtl_eri_write(tp, r->addr, r->mask, r->val, ERIAR_EXGMAC);
françois romieuc28aa382011-08-02 03:53:43 +00001515 r++;
1516 }
1517}
1518
Francois Romieuffc46952012-07-06 14:19:23 +02001519DECLARE_RTL_COND(rtl_efusear_cond)
1520{
1521 void __iomem *ioaddr = tp->mmio_addr;
1522
1523 return RTL_R32(EFUSEAR) & EFUSEAR_FLAG;
1524}
1525
Francois Romieufdf6fc02012-07-06 22:40:38 +02001526static u8 rtl8168d_efuse_read(struct rtl8169_private *tp, int reg_addr)
françois romieudaf9df62009-10-07 12:44:20 +00001527{
Francois Romieufdf6fc02012-07-06 22:40:38 +02001528 void __iomem *ioaddr = tp->mmio_addr;
françois romieudaf9df62009-10-07 12:44:20 +00001529
1530 RTL_W32(EFUSEAR, (reg_addr & EFUSEAR_REG_MASK) << EFUSEAR_REG_SHIFT);
1531
Francois Romieuffc46952012-07-06 14:19:23 +02001532 return rtl_udelay_loop_wait_high(tp, &rtl_efusear_cond, 100, 300) ?
1533 RTL_R32(EFUSEAR) & EFUSEAR_DATA_MASK : ~0;
françois romieudaf9df62009-10-07 12:44:20 +00001534}
1535
Francois Romieu9085cdfa2012-01-26 12:59:08 +01001536static u16 rtl_get_events(struct rtl8169_private *tp)
1537{
1538 void __iomem *ioaddr = tp->mmio_addr;
1539
1540 return RTL_R16(IntrStatus);
1541}
1542
1543static void rtl_ack_events(struct rtl8169_private *tp, u16 bits)
1544{
1545 void __iomem *ioaddr = tp->mmio_addr;
1546
1547 RTL_W16(IntrStatus, bits);
1548 mmiowb();
1549}
1550
1551static void rtl_irq_disable(struct rtl8169_private *tp)
1552{
1553 void __iomem *ioaddr = tp->mmio_addr;
1554
1555 RTL_W16(IntrMask, 0);
1556 mmiowb();
1557}
1558
Francois Romieu3e990ff2012-01-26 12:50:01 +01001559static void rtl_irq_enable(struct rtl8169_private *tp, u16 bits)
1560{
1561 void __iomem *ioaddr = tp->mmio_addr;
1562
1563 RTL_W16(IntrMask, bits);
1564}
1565
Francois Romieuda78dbf2012-01-26 14:18:23 +01001566#define RTL_EVENT_NAPI_RX (RxOK | RxErr)
1567#define RTL_EVENT_NAPI_TX (TxOK | TxErr)
1568#define RTL_EVENT_NAPI (RTL_EVENT_NAPI_RX | RTL_EVENT_NAPI_TX)
1569
1570static void rtl_irq_enable_all(struct rtl8169_private *tp)
1571{
1572 rtl_irq_enable(tp, RTL_EVENT_NAPI | tp->event_slow);
1573}
1574
françois romieu811fd302011-12-04 20:30:45 +00001575static void rtl8169_irq_mask_and_ack(struct rtl8169_private *tp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001576{
françois romieu811fd302011-12-04 20:30:45 +00001577 void __iomem *ioaddr = tp->mmio_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001578
Francois Romieu9085cdfa2012-01-26 12:59:08 +01001579 rtl_irq_disable(tp);
Francois Romieuda78dbf2012-01-26 14:18:23 +01001580 rtl_ack_events(tp, RTL_EVENT_NAPI | tp->event_slow);
françois romieu811fd302011-12-04 20:30:45 +00001581 RTL_R8(ChipCmd);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001582}
1583
françois romieu4da19632011-01-03 15:07:55 +00001584static unsigned int rtl8169_tbi_reset_pending(struct rtl8169_private *tp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001585{
françois romieu4da19632011-01-03 15:07:55 +00001586 void __iomem *ioaddr = tp->mmio_addr;
1587
Linus Torvalds1da177e2005-04-16 15:20:36 -07001588 return RTL_R32(TBICSR) & TBIReset;
1589}
1590
françois romieu4da19632011-01-03 15:07:55 +00001591static unsigned int rtl8169_xmii_reset_pending(struct rtl8169_private *tp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001592{
françois romieu4da19632011-01-03 15:07:55 +00001593 return rtl_readphy(tp, MII_BMCR) & BMCR_RESET;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001594}
1595
1596static unsigned int rtl8169_tbi_link_ok(void __iomem *ioaddr)
1597{
1598 return RTL_R32(TBICSR) & TBILinkOk;
1599}
1600
1601static unsigned int rtl8169_xmii_link_ok(void __iomem *ioaddr)
1602{
1603 return RTL_R8(PHYstatus) & LinkStatus;
1604}
1605
françois romieu4da19632011-01-03 15:07:55 +00001606static void rtl8169_tbi_reset_enable(struct rtl8169_private *tp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001607{
françois romieu4da19632011-01-03 15:07:55 +00001608 void __iomem *ioaddr = tp->mmio_addr;
1609
Linus Torvalds1da177e2005-04-16 15:20:36 -07001610 RTL_W32(TBICSR, RTL_R32(TBICSR) | TBIReset);
1611}
1612
françois romieu4da19632011-01-03 15:07:55 +00001613static void rtl8169_xmii_reset_enable(struct rtl8169_private *tp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001614{
1615 unsigned int val;
1616
françois romieu4da19632011-01-03 15:07:55 +00001617 val = rtl_readphy(tp, MII_BMCR) | BMCR_RESET;
1618 rtl_writephy(tp, MII_BMCR, val & 0xffff);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001619}
1620
Hayes Wang70090422011-07-06 15:58:06 +08001621static void rtl_link_chg_patch(struct rtl8169_private *tp)
1622{
1623 void __iomem *ioaddr = tp->mmio_addr;
1624 struct net_device *dev = tp->dev;
1625
1626 if (!netif_running(dev))
1627 return;
1628
Hayes Wangb3d7b2f2012-03-30 14:48:06 +08001629 if (tp->mac_version == RTL_GIGA_MAC_VER_34 ||
1630 tp->mac_version == RTL_GIGA_MAC_VER_38) {
Hayes Wang70090422011-07-06 15:58:06 +08001631 if (RTL_R8(PHYstatus) & _1000bpsF) {
Francois Romieufdf6fc02012-07-06 22:40:38 +02001632 rtl_eri_write(tp, 0x1bc, ERIAR_MASK_1111, 0x00000011,
1633 ERIAR_EXGMAC);
1634 rtl_eri_write(tp, 0x1dc, ERIAR_MASK_1111, 0x00000005,
1635 ERIAR_EXGMAC);
Hayes Wang70090422011-07-06 15:58:06 +08001636 } else if (RTL_R8(PHYstatus) & _100bps) {
Francois Romieufdf6fc02012-07-06 22:40:38 +02001637 rtl_eri_write(tp, 0x1bc, ERIAR_MASK_1111, 0x0000001f,
1638 ERIAR_EXGMAC);
1639 rtl_eri_write(tp, 0x1dc, ERIAR_MASK_1111, 0x00000005,
1640 ERIAR_EXGMAC);
Hayes Wang70090422011-07-06 15:58:06 +08001641 } else {
Francois Romieufdf6fc02012-07-06 22:40:38 +02001642 rtl_eri_write(tp, 0x1bc, ERIAR_MASK_1111, 0x0000001f,
1643 ERIAR_EXGMAC);
1644 rtl_eri_write(tp, 0x1dc, ERIAR_MASK_1111, 0x0000003f,
1645 ERIAR_EXGMAC);
Hayes Wang70090422011-07-06 15:58:06 +08001646 }
1647 /* Reset packet filter */
Chun-Hao Lin706123d2014-10-01 23:17:18 +08001648 rtl_w0w1_eri(tp, 0xdc, ERIAR_MASK_0001, 0x00, 0x01,
Hayes Wang70090422011-07-06 15:58:06 +08001649 ERIAR_EXGMAC);
Chun-Hao Lin706123d2014-10-01 23:17:18 +08001650 rtl_w0w1_eri(tp, 0xdc, ERIAR_MASK_0001, 0x01, 0x00,
Hayes Wang70090422011-07-06 15:58:06 +08001651 ERIAR_EXGMAC);
Hayes Wangc2218922011-09-06 16:55:18 +08001652 } else if (tp->mac_version == RTL_GIGA_MAC_VER_35 ||
1653 tp->mac_version == RTL_GIGA_MAC_VER_36) {
1654 if (RTL_R8(PHYstatus) & _1000bpsF) {
Francois Romieufdf6fc02012-07-06 22:40:38 +02001655 rtl_eri_write(tp, 0x1bc, ERIAR_MASK_1111, 0x00000011,
1656 ERIAR_EXGMAC);
1657 rtl_eri_write(tp, 0x1dc, ERIAR_MASK_1111, 0x00000005,
1658 ERIAR_EXGMAC);
Hayes Wangc2218922011-09-06 16:55:18 +08001659 } else {
Francois Romieufdf6fc02012-07-06 22:40:38 +02001660 rtl_eri_write(tp, 0x1bc, ERIAR_MASK_1111, 0x0000001f,
1661 ERIAR_EXGMAC);
1662 rtl_eri_write(tp, 0x1dc, ERIAR_MASK_1111, 0x0000003f,
1663 ERIAR_EXGMAC);
Hayes Wangc2218922011-09-06 16:55:18 +08001664 }
Hayes Wang7e18dca2012-03-30 14:33:02 +08001665 } else if (tp->mac_version == RTL_GIGA_MAC_VER_37) {
1666 if (RTL_R8(PHYstatus) & _10bps) {
Francois Romieufdf6fc02012-07-06 22:40:38 +02001667 rtl_eri_write(tp, 0x1d0, ERIAR_MASK_0011, 0x4d02,
1668 ERIAR_EXGMAC);
1669 rtl_eri_write(tp, 0x1dc, ERIAR_MASK_0011, 0x0060,
1670 ERIAR_EXGMAC);
Hayes Wang7e18dca2012-03-30 14:33:02 +08001671 } else {
Francois Romieufdf6fc02012-07-06 22:40:38 +02001672 rtl_eri_write(tp, 0x1d0, ERIAR_MASK_0011, 0x0000,
1673 ERIAR_EXGMAC);
Hayes Wang7e18dca2012-03-30 14:33:02 +08001674 }
Hayes Wang70090422011-07-06 15:58:06 +08001675 }
1676}
1677
Rafael J. Wysockie4fbce72010-12-08 15:32:14 +00001678static void __rtl8169_check_link_status(struct net_device *dev,
Francois Romieucecb5fd2011-04-01 10:21:07 +02001679 struct rtl8169_private *tp,
1680 void __iomem *ioaddr, bool pm)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001681{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001682 if (tp->link_ok(ioaddr)) {
Hayes Wang70090422011-07-06 15:58:06 +08001683 rtl_link_chg_patch(tp);
Rafael J. Wysockie1759442010-03-14 14:33:51 +00001684 /* This is to cancel a scheduled suspend if there's one. */
Rafael J. Wysockie4fbce72010-12-08 15:32:14 +00001685 if (pm)
1686 pm_request_resume(&tp->pci_dev->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001687 netif_carrier_on(dev);
Francois Romieu1519e572011-02-03 12:02:36 +01001688 if (net_ratelimit())
1689 netif_info(tp, ifup, dev, "link up\n");
Stephen Hemmingerb57b7e52005-05-27 21:11:52 +02001690 } else {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001691 netif_carrier_off(dev);
Joe Perchesbf82c182010-02-09 11:49:50 +00001692 netif_info(tp, ifdown, dev, "link down\n");
Rafael J. Wysockie4fbce72010-12-08 15:32:14 +00001693 if (pm)
hayeswang10953db2011-11-07 20:44:37 +00001694 pm_schedule_suspend(&tp->pci_dev->dev, 5000);
Stephen Hemmingerb57b7e52005-05-27 21:11:52 +02001695 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001696}
1697
Rafael J. Wysockie4fbce72010-12-08 15:32:14 +00001698static void rtl8169_check_link_status(struct net_device *dev,
1699 struct rtl8169_private *tp,
1700 void __iomem *ioaddr)
1701{
1702 __rtl8169_check_link_status(dev, tp, ioaddr, false);
1703}
1704
Rafael J. Wysockie1759442010-03-14 14:33:51 +00001705#define WAKE_ANY (WAKE_PHY | WAKE_MAGIC | WAKE_UCAST | WAKE_BCAST | WAKE_MCAST)
1706
1707static u32 __rtl8169_get_wol(struct rtl8169_private *tp)
1708{
1709 void __iomem *ioaddr = tp->mmio_addr;
1710 u8 options;
1711 u32 wolopts = 0;
1712
1713 options = RTL_R8(Config1);
1714 if (!(options & PMEnable))
1715 return 0;
1716
1717 options = RTL_R8(Config3);
1718 if (options & LinkUp)
1719 wolopts |= WAKE_PHY;
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08001720 switch (tp->mac_version) {
Chun-Hao Linac85bcd2014-10-01 23:17:16 +08001721 case RTL_GIGA_MAC_VER_34:
1722 case RTL_GIGA_MAC_VER_35:
1723 case RTL_GIGA_MAC_VER_36:
1724 case RTL_GIGA_MAC_VER_37:
1725 case RTL_GIGA_MAC_VER_38:
1726 case RTL_GIGA_MAC_VER_40:
1727 case RTL_GIGA_MAC_VER_41:
1728 case RTL_GIGA_MAC_VER_42:
1729 case RTL_GIGA_MAC_VER_43:
1730 case RTL_GIGA_MAC_VER_44:
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08001731 case RTL_GIGA_MAC_VER_45:
1732 case RTL_GIGA_MAC_VER_46:
Chun-Hao Linac85bcd2014-10-01 23:17:16 +08001733 case RTL_GIGA_MAC_VER_47:
1734 case RTL_GIGA_MAC_VER_48:
Chun-Hao Lin935e2212014-10-07 15:10:41 +08001735 case RTL_GIGA_MAC_VER_49:
1736 case RTL_GIGA_MAC_VER_50:
1737 case RTL_GIGA_MAC_VER_51:
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08001738 if (rtl_eri_read(tp, 0xdc, ERIAR_EXGMAC) & MagicPacket_v2)
1739 wolopts |= WAKE_MAGIC;
1740 break;
1741 default:
1742 if (options & MagicPacket)
1743 wolopts |= WAKE_MAGIC;
1744 break;
1745 }
Rafael J. Wysockie1759442010-03-14 14:33:51 +00001746
1747 options = RTL_R8(Config5);
1748 if (options & UWF)
1749 wolopts |= WAKE_UCAST;
1750 if (options & BWF)
1751 wolopts |= WAKE_BCAST;
1752 if (options & MWF)
1753 wolopts |= WAKE_MCAST;
1754
1755 return wolopts;
1756}
1757
Francois Romieu61a4dcc2006-02-23 00:55:25 +01001758static void rtl8169_get_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
1759{
1760 struct rtl8169_private *tp = netdev_priv(dev);
Chun-Hao Lin5fa80a32016-07-29 16:37:54 +08001761 struct device *d = &tp->pci_dev->dev;
1762
1763 pm_runtime_get_noresume(d);
Francois Romieu61a4dcc2006-02-23 00:55:25 +01001764
Francois Romieuda78dbf2012-01-26 14:18:23 +01001765 rtl_lock_work(tp);
Francois Romieu61a4dcc2006-02-23 00:55:25 +01001766
Rafael J. Wysockie1759442010-03-14 14:33:51 +00001767 wol->supported = WAKE_ANY;
Chun-Hao Lin5fa80a32016-07-29 16:37:54 +08001768 if (pm_runtime_active(d))
1769 wol->wolopts = __rtl8169_get_wol(tp);
1770 else
1771 wol->wolopts = tp->saved_wolopts;
Francois Romieu61a4dcc2006-02-23 00:55:25 +01001772
Francois Romieuda78dbf2012-01-26 14:18:23 +01001773 rtl_unlock_work(tp);
Chun-Hao Lin5fa80a32016-07-29 16:37:54 +08001774
1775 pm_runtime_put_noidle(d);
Francois Romieu61a4dcc2006-02-23 00:55:25 +01001776}
1777
Rafael J. Wysockie1759442010-03-14 14:33:51 +00001778static void __rtl8169_set_wol(struct rtl8169_private *tp, u32 wolopts)
Francois Romieu61a4dcc2006-02-23 00:55:25 +01001779{
Francois Romieu61a4dcc2006-02-23 00:55:25 +01001780 void __iomem *ioaddr = tp->mmio_addr;
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08001781 unsigned int i, tmp;
Alexey Dobriyan350f7592009-11-25 15:54:21 -08001782 static const struct {
Francois Romieu61a4dcc2006-02-23 00:55:25 +01001783 u32 opt;
1784 u16 reg;
1785 u8 mask;
1786 } cfg[] = {
Francois Romieu61a4dcc2006-02-23 00:55:25 +01001787 { WAKE_PHY, Config3, LinkUp },
Francois Romieu61a4dcc2006-02-23 00:55:25 +01001788 { WAKE_UCAST, Config5, UWF },
1789 { WAKE_BCAST, Config5, BWF },
1790 { WAKE_MCAST, Config5, MWF },
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08001791 { WAKE_ANY, Config5, LanWake },
1792 { WAKE_MAGIC, Config3, MagicPacket }
Francois Romieu61a4dcc2006-02-23 00:55:25 +01001793 };
Francois Romieu851e6022012-04-17 11:10:11 +02001794 u8 options;
Francois Romieu61a4dcc2006-02-23 00:55:25 +01001795
Francois Romieu61a4dcc2006-02-23 00:55:25 +01001796 RTL_W8(Cfg9346, Cfg9346_Unlock);
1797
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08001798 switch (tp->mac_version) {
Chun-Hao Linac85bcd2014-10-01 23:17:16 +08001799 case RTL_GIGA_MAC_VER_34:
1800 case RTL_GIGA_MAC_VER_35:
1801 case RTL_GIGA_MAC_VER_36:
1802 case RTL_GIGA_MAC_VER_37:
1803 case RTL_GIGA_MAC_VER_38:
1804 case RTL_GIGA_MAC_VER_40:
1805 case RTL_GIGA_MAC_VER_41:
1806 case RTL_GIGA_MAC_VER_42:
1807 case RTL_GIGA_MAC_VER_43:
1808 case RTL_GIGA_MAC_VER_44:
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08001809 case RTL_GIGA_MAC_VER_45:
1810 case RTL_GIGA_MAC_VER_46:
Chun-Hao Linac85bcd2014-10-01 23:17:16 +08001811 case RTL_GIGA_MAC_VER_47:
1812 case RTL_GIGA_MAC_VER_48:
Chun-Hao Lin935e2212014-10-07 15:10:41 +08001813 case RTL_GIGA_MAC_VER_49:
1814 case RTL_GIGA_MAC_VER_50:
1815 case RTL_GIGA_MAC_VER_51:
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08001816 tmp = ARRAY_SIZE(cfg) - 1;
1817 if (wolopts & WAKE_MAGIC)
Chun-Hao Lin706123d2014-10-01 23:17:18 +08001818 rtl_w0w1_eri(tp,
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08001819 0x0dc,
1820 ERIAR_MASK_0100,
1821 MagicPacket_v2,
1822 0x0000,
1823 ERIAR_EXGMAC);
1824 else
Chun-Hao Lin706123d2014-10-01 23:17:18 +08001825 rtl_w0w1_eri(tp,
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08001826 0x0dc,
1827 ERIAR_MASK_0100,
1828 0x0000,
1829 MagicPacket_v2,
1830 ERIAR_EXGMAC);
1831 break;
1832 default:
1833 tmp = ARRAY_SIZE(cfg);
1834 break;
1835 }
1836
1837 for (i = 0; i < tmp; i++) {
Francois Romieu851e6022012-04-17 11:10:11 +02001838 options = RTL_R8(cfg[i].reg) & ~cfg[i].mask;
Rafael J. Wysockie1759442010-03-14 14:33:51 +00001839 if (wolopts & cfg[i].opt)
Francois Romieu61a4dcc2006-02-23 00:55:25 +01001840 options |= cfg[i].mask;
1841 RTL_W8(cfg[i].reg, options);
1842 }
1843
Francois Romieu851e6022012-04-17 11:10:11 +02001844 switch (tp->mac_version) {
1845 case RTL_GIGA_MAC_VER_01 ... RTL_GIGA_MAC_VER_17:
1846 options = RTL_R8(Config1) & ~PMEnable;
1847 if (wolopts)
1848 options |= PMEnable;
1849 RTL_W8(Config1, options);
1850 break;
1851 default:
Francois Romieud387b422012-04-17 11:12:01 +02001852 options = RTL_R8(Config2) & ~PME_SIGNAL;
1853 if (wolopts)
1854 options |= PME_SIGNAL;
1855 RTL_W8(Config2, options);
Francois Romieu851e6022012-04-17 11:10:11 +02001856 break;
1857 }
1858
Francois Romieu61a4dcc2006-02-23 00:55:25 +01001859 RTL_W8(Cfg9346, Cfg9346_Lock);
Rafael J. Wysockie1759442010-03-14 14:33:51 +00001860}
1861
1862static int rtl8169_set_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
1863{
1864 struct rtl8169_private *tp = netdev_priv(dev);
Chun-Hao Lin5fa80a32016-07-29 16:37:54 +08001865 struct device *d = &tp->pci_dev->dev;
1866
1867 pm_runtime_get_noresume(d);
Rafael J. Wysockie1759442010-03-14 14:33:51 +00001868
Francois Romieuda78dbf2012-01-26 14:18:23 +01001869 rtl_lock_work(tp);
Francois Romieu61a4dcc2006-02-23 00:55:25 +01001870
Francois Romieuf23e7fd2007-10-04 22:36:14 +02001871 if (wol->wolopts)
1872 tp->features |= RTL_FEATURE_WOL;
1873 else
1874 tp->features &= ~RTL_FEATURE_WOL;
Chun-Hao Lin5fa80a32016-07-29 16:37:54 +08001875 if (pm_runtime_active(d))
1876 __rtl8169_set_wol(tp, wol->wolopts);
1877 else
1878 tp->saved_wolopts = wol->wolopts;
Francois Romieuda78dbf2012-01-26 14:18:23 +01001879
1880 rtl_unlock_work(tp);
Francois Romieu61a4dcc2006-02-23 00:55:25 +01001881
françois romieuea809072010-11-08 13:23:58 +00001882 device_set_wakeup_enable(&tp->pci_dev->dev, wol->wolopts);
1883
Chun-Hao Lin5fa80a32016-07-29 16:37:54 +08001884 pm_runtime_put_noidle(d);
1885
Francois Romieu61a4dcc2006-02-23 00:55:25 +01001886 return 0;
1887}
1888
Francois Romieu31bd2042011-04-26 18:58:59 +02001889static const char *rtl_lookup_firmware_name(struct rtl8169_private *tp)
1890{
Francois Romieu85bffe62011-04-27 08:22:39 +02001891 return rtl_chip_infos[tp->mac_version].fw_name;
Francois Romieu31bd2042011-04-26 18:58:59 +02001892}
1893
Linus Torvalds1da177e2005-04-16 15:20:36 -07001894static void rtl8169_get_drvinfo(struct net_device *dev,
1895 struct ethtool_drvinfo *info)
1896{
1897 struct rtl8169_private *tp = netdev_priv(dev);
Francois Romieub6ffd972011-06-17 17:00:05 +02001898 struct rtl_fw *rtl_fw = tp->rtl_fw;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001899
Rick Jones68aad782011-11-07 13:29:27 +00001900 strlcpy(info->driver, MODULENAME, sizeof(info->driver));
1901 strlcpy(info->version, RTL8169_VERSION, sizeof(info->version));
1902 strlcpy(info->bus_info, pci_name(tp->pci_dev), sizeof(info->bus_info));
Francois Romieu1c361ef2011-06-17 17:16:24 +02001903 BUILD_BUG_ON(sizeof(info->fw_version) < sizeof(rtl_fw->version));
Rick Jones8ac72d12011-11-22 14:06:26 +00001904 if (!IS_ERR_OR_NULL(rtl_fw))
1905 strlcpy(info->fw_version, rtl_fw->version,
1906 sizeof(info->fw_version));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001907}
1908
1909static int rtl8169_get_regs_len(struct net_device *dev)
1910{
1911 return R8169_REGS_SIZE;
1912}
1913
1914static int rtl8169_set_speed_tbi(struct net_device *dev,
Oliver Neukum54405cd2011-01-06 21:55:13 +01001915 u8 autoneg, u16 speed, u8 duplex, u32 ignored)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001916{
1917 struct rtl8169_private *tp = netdev_priv(dev);
1918 void __iomem *ioaddr = tp->mmio_addr;
1919 int ret = 0;
1920 u32 reg;
1921
1922 reg = RTL_R32(TBICSR);
1923 if ((autoneg == AUTONEG_DISABLE) && (speed == SPEED_1000) &&
1924 (duplex == DUPLEX_FULL)) {
1925 RTL_W32(TBICSR, reg & ~(TBINwEnable | TBINwRestart));
1926 } else if (autoneg == AUTONEG_ENABLE)
1927 RTL_W32(TBICSR, reg | TBINwEnable | TBINwRestart);
1928 else {
Joe Perchesbf82c182010-02-09 11:49:50 +00001929 netif_warn(tp, link, dev,
1930 "incorrect speed setting refused in TBI mode\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07001931 ret = -EOPNOTSUPP;
1932 }
1933
1934 return ret;
1935}
1936
1937static int rtl8169_set_speed_xmii(struct net_device *dev,
Oliver Neukum54405cd2011-01-06 21:55:13 +01001938 u8 autoneg, u16 speed, u8 duplex, u32 adv)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001939{
1940 struct rtl8169_private *tp = netdev_priv(dev);
françois romieu3577aa12009-05-19 10:46:48 +00001941 int giga_ctrl, bmcr;
Oliver Neukum54405cd2011-01-06 21:55:13 +01001942 int rc = -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001943
Hayes Wang716b50a2011-02-22 17:26:18 +08001944 rtl_writephy(tp, 0x1f, 0x0000);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001945
1946 if (autoneg == AUTONEG_ENABLE) {
françois romieu3577aa12009-05-19 10:46:48 +00001947 int auto_nego;
1948
françois romieu4da19632011-01-03 15:07:55 +00001949 auto_nego = rtl_readphy(tp, MII_ADVERTISE);
Oliver Neukum54405cd2011-01-06 21:55:13 +01001950 auto_nego &= ~(ADVERTISE_10HALF | ADVERTISE_10FULL |
1951 ADVERTISE_100HALF | ADVERTISE_100FULL);
1952
1953 if (adv & ADVERTISED_10baseT_Half)
1954 auto_nego |= ADVERTISE_10HALF;
1955 if (adv & ADVERTISED_10baseT_Full)
1956 auto_nego |= ADVERTISE_10FULL;
1957 if (adv & ADVERTISED_100baseT_Half)
1958 auto_nego |= ADVERTISE_100HALF;
1959 if (adv & ADVERTISED_100baseT_Full)
1960 auto_nego |= ADVERTISE_100FULL;
1961
françois romieu3577aa12009-05-19 10:46:48 +00001962 auto_nego |= ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM;
1963
françois romieu4da19632011-01-03 15:07:55 +00001964 giga_ctrl = rtl_readphy(tp, MII_CTRL1000);
françois romieu3577aa12009-05-19 10:46:48 +00001965 giga_ctrl &= ~(ADVERTISE_1000FULL | ADVERTISE_1000HALF);
1966
1967 /* The 8100e/8101e/8102e do Fast Ethernet only. */
Francois Romieu826e6cb2011-03-11 20:30:24 +01001968 if (tp->mii.supports_gmii) {
Oliver Neukum54405cd2011-01-06 21:55:13 +01001969 if (adv & ADVERTISED_1000baseT_Half)
1970 giga_ctrl |= ADVERTISE_1000HALF;
1971 if (adv & ADVERTISED_1000baseT_Full)
1972 giga_ctrl |= ADVERTISE_1000FULL;
1973 } else if (adv & (ADVERTISED_1000baseT_Half |
1974 ADVERTISED_1000baseT_Full)) {
Joe Perchesbf82c182010-02-09 11:49:50 +00001975 netif_info(tp, link, dev,
1976 "PHY does not support 1000Mbps\n");
Oliver Neukum54405cd2011-01-06 21:55:13 +01001977 goto out;
Francois Romieubcf0bf92006-07-26 23:14:13 +02001978 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001979
françois romieu3577aa12009-05-19 10:46:48 +00001980 bmcr = BMCR_ANENABLE | BMCR_ANRESTART;
Francois Romieu623a1592006-05-14 12:42:14 +02001981
françois romieu4da19632011-01-03 15:07:55 +00001982 rtl_writephy(tp, MII_ADVERTISE, auto_nego);
1983 rtl_writephy(tp, MII_CTRL1000, giga_ctrl);
françois romieu3577aa12009-05-19 10:46:48 +00001984 } else {
françois romieu3577aa12009-05-19 10:46:48 +00001985 if (speed == SPEED_10)
1986 bmcr = 0;
1987 else if (speed == SPEED_100)
1988 bmcr = BMCR_SPEED100;
1989 else
Oliver Neukum54405cd2011-01-06 21:55:13 +01001990 goto out;
françois romieu3577aa12009-05-19 10:46:48 +00001991
1992 if (duplex == DUPLEX_FULL)
1993 bmcr |= BMCR_FULLDPLX;
Roger So2584fbc2007-07-31 23:52:42 +02001994 }
1995
françois romieu4da19632011-01-03 15:07:55 +00001996 rtl_writephy(tp, MII_BMCR, bmcr);
françois romieu3577aa12009-05-19 10:46:48 +00001997
Francois Romieucecb5fd2011-04-01 10:21:07 +02001998 if (tp->mac_version == RTL_GIGA_MAC_VER_02 ||
1999 tp->mac_version == RTL_GIGA_MAC_VER_03) {
françois romieu3577aa12009-05-19 10:46:48 +00002000 if ((speed == SPEED_100) && (autoneg != AUTONEG_ENABLE)) {
françois romieu4da19632011-01-03 15:07:55 +00002001 rtl_writephy(tp, 0x17, 0x2138);
2002 rtl_writephy(tp, 0x0e, 0x0260);
françois romieu3577aa12009-05-19 10:46:48 +00002003 } else {
françois romieu4da19632011-01-03 15:07:55 +00002004 rtl_writephy(tp, 0x17, 0x2108);
2005 rtl_writephy(tp, 0x0e, 0x0000);
françois romieu3577aa12009-05-19 10:46:48 +00002006 }
2007 }
2008
Oliver Neukum54405cd2011-01-06 21:55:13 +01002009 rc = 0;
2010out:
2011 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002012}
2013
2014static int rtl8169_set_speed(struct net_device *dev,
Oliver Neukum54405cd2011-01-06 21:55:13 +01002015 u8 autoneg, u16 speed, u8 duplex, u32 advertising)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002016{
2017 struct rtl8169_private *tp = netdev_priv(dev);
2018 int ret;
2019
Oliver Neukum54405cd2011-01-06 21:55:13 +01002020 ret = tp->set_speed(dev, autoneg, speed, duplex, advertising);
Francois Romieu4876cc12011-03-11 21:07:11 +01002021 if (ret < 0)
2022 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002023
Francois Romieu4876cc12011-03-11 21:07:11 +01002024 if (netif_running(dev) && (autoneg == AUTONEG_ENABLE) &&
Chun-Hao Linc4556972016-03-11 14:21:14 +08002025 (advertising & ADVERTISED_1000baseT_Full) &&
2026 !pci_is_pcie(tp->pci_dev)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002027 mod_timer(&tp->timer, jiffies + RTL8169_PHY_TIMEOUT);
Francois Romieu4876cc12011-03-11 21:07:11 +01002028 }
2029out:
Linus Torvalds1da177e2005-04-16 15:20:36 -07002030 return ret;
2031}
2032
2033static int rtl8169_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
2034{
2035 struct rtl8169_private *tp = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002036 int ret;
2037
Francois Romieu4876cc12011-03-11 21:07:11 +01002038 del_timer_sync(&tp->timer);
2039
Francois Romieuda78dbf2012-01-26 14:18:23 +01002040 rtl_lock_work(tp);
Francois Romieucecb5fd2011-04-01 10:21:07 +02002041 ret = rtl8169_set_speed(dev, cmd->autoneg, ethtool_cmd_speed(cmd),
David Decotigny25db0332011-04-27 18:32:39 +00002042 cmd->duplex, cmd->advertising);
Francois Romieuda78dbf2012-01-26 14:18:23 +01002043 rtl_unlock_work(tp);
Francois Romieu5b0384f2006-08-16 16:00:01 +02002044
Linus Torvalds1da177e2005-04-16 15:20:36 -07002045 return ret;
2046}
2047
Michał Mirosławc8f44af2011-11-15 15:29:55 +00002048static netdev_features_t rtl8169_fix_features(struct net_device *dev,
2049 netdev_features_t features)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002050{
Francois Romieud58d46b2011-05-03 16:38:29 +02002051 struct rtl8169_private *tp = netdev_priv(dev);
2052
Francois Romieu2b7b4312011-04-18 22:53:24 -07002053 if (dev->mtu > TD_MSS_MAX)
Michał Mirosław350fb322011-04-08 06:35:56 +00002054 features &= ~NETIF_F_ALL_TSO;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002055
Francois Romieud58d46b2011-05-03 16:38:29 +02002056 if (dev->mtu > JUMBO_1K &&
2057 !rtl_chip_infos[tp->mac_version].jumbo_tx_csum)
2058 features &= ~NETIF_F_IP_CSUM;
2059
Michał Mirosław350fb322011-04-08 06:35:56 +00002060 return features;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002061}
2062
Francois Romieuda78dbf2012-01-26 14:18:23 +01002063static void __rtl8169_set_features(struct net_device *dev,
2064 netdev_features_t features)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002065{
2066 struct rtl8169_private *tp = netdev_priv(dev);
Francois Romieuda78dbf2012-01-26 14:18:23 +01002067 void __iomem *ioaddr = tp->mmio_addr;
hayeswang929a0312014-09-16 11:40:47 +08002068 u32 rx_config;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002069
hayeswang929a0312014-09-16 11:40:47 +08002070 rx_config = RTL_R32(RxConfig);
2071 if (features & NETIF_F_RXALL)
2072 rx_config |= (AcceptErr | AcceptRunt);
2073 else
2074 rx_config &= ~(AcceptErr | AcceptRunt);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002075
hayeswang929a0312014-09-16 11:40:47 +08002076 RTL_W32(RxConfig, rx_config);
Michał Mirosław350fb322011-04-08 06:35:56 +00002077
hayeswang929a0312014-09-16 11:40:47 +08002078 if (features & NETIF_F_RXCSUM)
2079 tp->cp_cmd |= RxChkSum;
2080 else
2081 tp->cp_cmd &= ~RxChkSum;
Ben Greear6bbe0212012-02-10 15:04:33 +00002082
hayeswang929a0312014-09-16 11:40:47 +08002083 if (features & NETIF_F_HW_VLAN_CTAG_RX)
2084 tp->cp_cmd |= RxVlan;
2085 else
2086 tp->cp_cmd &= ~RxVlan;
2087
2088 tp->cp_cmd |= RTL_R16(CPlusCmd) & ~(RxVlan | RxChkSum);
2089
2090 RTL_W16(CPlusCmd, tp->cp_cmd);
2091 RTL_R16(CPlusCmd);
Francois Romieuda78dbf2012-01-26 14:18:23 +01002092}
Linus Torvalds1da177e2005-04-16 15:20:36 -07002093
Francois Romieuda78dbf2012-01-26 14:18:23 +01002094static int rtl8169_set_features(struct net_device *dev,
2095 netdev_features_t features)
2096{
2097 struct rtl8169_private *tp = netdev_priv(dev);
2098
hayeswang929a0312014-09-16 11:40:47 +08002099 features &= NETIF_F_RXALL | NETIF_F_RXCSUM | NETIF_F_HW_VLAN_CTAG_RX;
2100
Francois Romieuda78dbf2012-01-26 14:18:23 +01002101 rtl_lock_work(tp);
Dan Carpenter85911d72014-09-19 13:40:25 +03002102 if (features ^ dev->features)
hayeswang929a0312014-09-16 11:40:47 +08002103 __rtl8169_set_features(dev, features);
Francois Romieuda78dbf2012-01-26 14:18:23 +01002104 rtl_unlock_work(tp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002105
2106 return 0;
2107}
2108
Francois Romieuda78dbf2012-01-26 14:18:23 +01002109
Kirill Smelkov810f4892012-11-10 21:11:02 +04002110static inline u32 rtl8169_tx_vlan_tag(struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002111{
Jiri Pirkodf8a39d2015-01-13 17:13:44 +01002112 return (skb_vlan_tag_present(skb)) ?
2113 TxVlanTag | swab16(skb_vlan_tag_get(skb)) : 0x00;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002114}
2115
Francois Romieu7a8fc772011-03-01 17:18:33 +01002116static void rtl8169_rx_vlan_tag(struct RxDesc *desc, struct sk_buff *skb)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002117{
2118 u32 opts2 = le32_to_cpu(desc->opts2);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002119
Francois Romieu7a8fc772011-03-01 17:18:33 +01002120 if (opts2 & RxVlanTag)
Patrick McHardy86a9bad2013-04-19 02:04:30 +00002121 __vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), swab16(opts2 & 0xffff));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002122}
2123
Philippe Reynes6fa1ba62017-02-23 22:34:43 +01002124static int rtl8169_get_link_ksettings_tbi(struct net_device *dev,
2125 struct ethtool_link_ksettings *cmd)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002126{
2127 struct rtl8169_private *tp = netdev_priv(dev);
2128 void __iomem *ioaddr = tp->mmio_addr;
2129 u32 status;
Philippe Reynes6fa1ba62017-02-23 22:34:43 +01002130 u32 supported, advertising;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002131
Philippe Reynes6fa1ba62017-02-23 22:34:43 +01002132 supported =
Linus Torvalds1da177e2005-04-16 15:20:36 -07002133 SUPPORTED_1000baseT_Full | SUPPORTED_Autoneg | SUPPORTED_FIBRE;
Philippe Reynes6fa1ba62017-02-23 22:34:43 +01002134 cmd->base.port = PORT_FIBRE;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002135
2136 status = RTL_R32(TBICSR);
Philippe Reynes6fa1ba62017-02-23 22:34:43 +01002137 advertising = (status & TBINwEnable) ? ADVERTISED_Autoneg : 0;
2138 cmd->base.autoneg = !!(status & TBINwEnable);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002139
Philippe Reynes6fa1ba62017-02-23 22:34:43 +01002140 cmd->base.speed = SPEED_1000;
2141 cmd->base.duplex = DUPLEX_FULL; /* Always set */
2142
2143 ethtool_convert_legacy_u32_to_link_mode(cmd->link_modes.supported,
2144 supported);
2145 ethtool_convert_legacy_u32_to_link_mode(cmd->link_modes.advertising,
2146 advertising);
Francois Romieuccdffb92008-07-26 14:26:06 +02002147
2148 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002149}
2150
Philippe Reynes6fa1ba62017-02-23 22:34:43 +01002151static int rtl8169_get_link_ksettings_xmii(struct net_device *dev,
2152 struct ethtool_link_ksettings *cmd)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002153{
2154 struct rtl8169_private *tp = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002155
yuval.shaia@oracle.com82c01a82017-06-04 20:22:00 +03002156 mii_ethtool_get_link_ksettings(&tp->mii, cmd);
2157
2158 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002159}
2160
Philippe Reynes6fa1ba62017-02-23 22:34:43 +01002161static int rtl8169_get_link_ksettings(struct net_device *dev,
2162 struct ethtool_link_ksettings *cmd)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002163{
2164 struct rtl8169_private *tp = netdev_priv(dev);
Francois Romieuccdffb92008-07-26 14:26:06 +02002165 int rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002166
Francois Romieuda78dbf2012-01-26 14:18:23 +01002167 rtl_lock_work(tp);
Philippe Reynes6fa1ba62017-02-23 22:34:43 +01002168 rc = tp->get_link_ksettings(dev, cmd);
Francois Romieuda78dbf2012-01-26 14:18:23 +01002169 rtl_unlock_work(tp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002170
Francois Romieuccdffb92008-07-26 14:26:06 +02002171 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002172}
2173
2174static void rtl8169_get_regs(struct net_device *dev, struct ethtool_regs *regs,
2175 void *p)
2176{
Francois Romieu5b0384f2006-08-16 16:00:01 +02002177 struct rtl8169_private *tp = netdev_priv(dev);
Peter Wu15edae92013-08-21 23:17:11 +02002178 u32 __iomem *data = tp->mmio_addr;
2179 u32 *dw = p;
2180 int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002181
Francois Romieuda78dbf2012-01-26 14:18:23 +01002182 rtl_lock_work(tp);
Peter Wu15edae92013-08-21 23:17:11 +02002183 for (i = 0; i < R8169_REGS_SIZE; i += 4)
2184 memcpy_fromio(dw++, data++, 4);
Francois Romieuda78dbf2012-01-26 14:18:23 +01002185 rtl_unlock_work(tp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002186}
2187
Stephen Hemmingerb57b7e52005-05-27 21:11:52 +02002188static u32 rtl8169_get_msglevel(struct net_device *dev)
2189{
2190 struct rtl8169_private *tp = netdev_priv(dev);
2191
2192 return tp->msg_enable;
2193}
2194
2195static void rtl8169_set_msglevel(struct net_device *dev, u32 value)
2196{
2197 struct rtl8169_private *tp = netdev_priv(dev);
2198
2199 tp->msg_enable = value;
2200}
2201
Stephen Hemmingerd4a3a0f2005-05-27 21:11:56 +02002202static const char rtl8169_gstrings[][ETH_GSTRING_LEN] = {
2203 "tx_packets",
2204 "rx_packets",
2205 "tx_errors",
2206 "rx_errors",
2207 "rx_missed",
2208 "align_errors",
2209 "tx_single_collisions",
2210 "tx_multi_collisions",
2211 "unicast",
2212 "broadcast",
2213 "multicast",
2214 "tx_aborted",
2215 "tx_underrun",
2216};
2217
Jeff Garzikb9f2c042007-10-03 18:07:32 -07002218static int rtl8169_get_sset_count(struct net_device *dev, int sset)
Stephen Hemmingerd4a3a0f2005-05-27 21:11:56 +02002219{
Jeff Garzikb9f2c042007-10-03 18:07:32 -07002220 switch (sset) {
2221 case ETH_SS_STATS:
2222 return ARRAY_SIZE(rtl8169_gstrings);
2223 default:
2224 return -EOPNOTSUPP;
2225 }
Stephen Hemmingerd4a3a0f2005-05-27 21:11:56 +02002226}
2227
Corinna Vinschen42020322015-09-10 10:47:35 +02002228DECLARE_RTL_COND(rtl_counters_cond)
Corinna Vinschen6e85d5a2015-08-24 12:52:39 +02002229{
Corinna Vinschen6e85d5a2015-08-24 12:52:39 +02002230 void __iomem *ioaddr = tp->mmio_addr;
Corinna Vinschen6e85d5a2015-08-24 12:52:39 +02002231
Corinna Vinschen42020322015-09-10 10:47:35 +02002232 return RTL_R32(CounterAddrLow) & (CounterReset | CounterDump);
Corinna Vinschen6e85d5a2015-08-24 12:52:39 +02002233}
2234
Corinna Vinschen42020322015-09-10 10:47:35 +02002235static bool rtl8169_do_counters(struct net_device *dev, u32 counter_cmd)
Corinna Vinschen6e85d5a2015-08-24 12:52:39 +02002236{
2237 struct rtl8169_private *tp = netdev_priv(dev);
2238 void __iomem *ioaddr = tp->mmio_addr;
Corinna Vinschen42020322015-09-10 10:47:35 +02002239 dma_addr_t paddr = tp->counters_phys_addr;
2240 u32 cmd;
2241 bool ret;
2242
2243 RTL_W32(CounterAddrHigh, (u64)paddr >> 32);
2244 cmd = (u64)paddr & DMA_BIT_MASK(32);
2245 RTL_W32(CounterAddrLow, cmd);
2246 RTL_W32(CounterAddrLow, cmd | counter_cmd);
2247
2248 ret = rtl_udelay_loop_wait_low(tp, &rtl_counters_cond, 10, 1000);
Corinna Vinschen6e85d5a2015-08-24 12:52:39 +02002249
2250 RTL_W32(CounterAddrLow, 0);
2251 RTL_W32(CounterAddrHigh, 0);
2252
Corinna Vinschen42020322015-09-10 10:47:35 +02002253 return ret;
Corinna Vinschen6e85d5a2015-08-24 12:52:39 +02002254}
2255
2256static bool rtl8169_reset_counters(struct net_device *dev)
2257{
2258 struct rtl8169_private *tp = netdev_priv(dev);
Corinna Vinschen6e85d5a2015-08-24 12:52:39 +02002259
2260 /*
2261 * Versions prior to RTL_GIGA_MAC_VER_19 don't support resetting the
2262 * tally counters.
2263 */
2264 if (tp->mac_version < RTL_GIGA_MAC_VER_19)
2265 return true;
2266
Corinna Vinschen42020322015-09-10 10:47:35 +02002267 return rtl8169_do_counters(dev, CounterReset);
Francois Romieuffc46952012-07-06 14:19:23 +02002268}
2269
Corinna Vinschen6e85d5a2015-08-24 12:52:39 +02002270static bool rtl8169_update_counters(struct net_device *dev)
Stephen Hemmingerd4a3a0f2005-05-27 21:11:56 +02002271{
2272 struct rtl8169_private *tp = netdev_priv(dev);
2273 void __iomem *ioaddr = tp->mmio_addr;
Stephen Hemmingerd4a3a0f2005-05-27 21:11:56 +02002274
Ivan Vecera355423d2009-02-06 21:49:57 -08002275 /*
2276 * Some chips are unable to dump tally counters when the receiver
2277 * is disabled.
2278 */
2279 if ((RTL_R8(ChipCmd) & CmdRxEnb) == 0)
Corinna Vinschen6e85d5a2015-08-24 12:52:39 +02002280 return true;
Stephen Hemmingerd4a3a0f2005-05-27 21:11:56 +02002281
Corinna Vinschen42020322015-09-10 10:47:35 +02002282 return rtl8169_do_counters(dev, CounterDump);
Corinna Vinschen6e85d5a2015-08-24 12:52:39 +02002283}
2284
2285static bool rtl8169_init_counter_offsets(struct net_device *dev)
2286{
2287 struct rtl8169_private *tp = netdev_priv(dev);
Corinna Vinschen42020322015-09-10 10:47:35 +02002288 struct rtl8169_counters *counters = tp->counters;
Corinna Vinschen6e85d5a2015-08-24 12:52:39 +02002289 bool ret = false;
2290
2291 /*
2292 * rtl8169_init_counter_offsets is called from rtl_open. On chip
2293 * versions prior to RTL_GIGA_MAC_VER_19 the tally counters are only
2294 * reset by a power cycle, while the counter values collected by the
2295 * driver are reset at every driver unload/load cycle.
2296 *
2297 * To make sure the HW values returned by @get_stats64 match the SW
2298 * values, we collect the initial values at first open(*) and use them
2299 * as offsets to normalize the values returned by @get_stats64.
2300 *
2301 * (*) We can't call rtl8169_init_counter_offsets from rtl_init_one
2302 * for the reason stated in rtl8169_update_counters; CmdRxEnb is only
2303 * set at open time by rtl_hw_start.
2304 */
2305
2306 if (tp->tc_offset.inited)
2307 return true;
2308
2309 /* If both, reset and update fail, propagate to caller. */
2310 if (rtl8169_reset_counters(dev))
2311 ret = true;
2312
2313 if (rtl8169_update_counters(dev))
2314 ret = true;
2315
Corinna Vinschen42020322015-09-10 10:47:35 +02002316 tp->tc_offset.tx_errors = counters->tx_errors;
2317 tp->tc_offset.tx_multi_collision = counters->tx_multi_collision;
2318 tp->tc_offset.tx_aborted = counters->tx_aborted;
Corinna Vinschen6e85d5a2015-08-24 12:52:39 +02002319 tp->tc_offset.inited = true;
2320
2321 return ret;
Stephen Hemmingerd4a3a0f2005-05-27 21:11:56 +02002322}
2323
Ivan Vecera355423d2009-02-06 21:49:57 -08002324static void rtl8169_get_ethtool_stats(struct net_device *dev,
2325 struct ethtool_stats *stats, u64 *data)
2326{
2327 struct rtl8169_private *tp = netdev_priv(dev);
Chun-Hao Line0636232016-07-29 16:37:55 +08002328 struct device *d = &tp->pci_dev->dev;
Corinna Vinschen42020322015-09-10 10:47:35 +02002329 struct rtl8169_counters *counters = tp->counters;
Ivan Vecera355423d2009-02-06 21:49:57 -08002330
2331 ASSERT_RTNL();
2332
Chun-Hao Line0636232016-07-29 16:37:55 +08002333 pm_runtime_get_noresume(d);
2334
2335 if (pm_runtime_active(d))
2336 rtl8169_update_counters(dev);
2337
2338 pm_runtime_put_noidle(d);
Ivan Vecera355423d2009-02-06 21:49:57 -08002339
Corinna Vinschen42020322015-09-10 10:47:35 +02002340 data[0] = le64_to_cpu(counters->tx_packets);
2341 data[1] = le64_to_cpu(counters->rx_packets);
2342 data[2] = le64_to_cpu(counters->tx_errors);
2343 data[3] = le32_to_cpu(counters->rx_errors);
2344 data[4] = le16_to_cpu(counters->rx_missed);
2345 data[5] = le16_to_cpu(counters->align_errors);
2346 data[6] = le32_to_cpu(counters->tx_one_collision);
2347 data[7] = le32_to_cpu(counters->tx_multi_collision);
2348 data[8] = le64_to_cpu(counters->rx_unicast);
2349 data[9] = le64_to_cpu(counters->rx_broadcast);
2350 data[10] = le32_to_cpu(counters->rx_multicast);
2351 data[11] = le16_to_cpu(counters->tx_aborted);
2352 data[12] = le16_to_cpu(counters->tx_underun);
Ivan Vecera355423d2009-02-06 21:49:57 -08002353}
2354
Stephen Hemmingerd4a3a0f2005-05-27 21:11:56 +02002355static void rtl8169_get_strings(struct net_device *dev, u32 stringset, u8 *data)
2356{
2357 switch(stringset) {
2358 case ETH_SS_STATS:
2359 memcpy(data, *rtl8169_gstrings, sizeof(rtl8169_gstrings));
2360 break;
2361 }
2362}
2363
Florian Fainellif0903ea2016-12-03 12:01:19 -08002364static int rtl8169_nway_reset(struct net_device *dev)
2365{
2366 struct rtl8169_private *tp = netdev_priv(dev);
2367
2368 return mii_nway_restart(&tp->mii);
2369}
2370
Francois Romieu50970832017-10-27 13:24:49 +03002371/*
2372 * Interrupt coalescing
2373 *
2374 * > 1 - the availability of the IntrMitigate (0xe2) register through the
2375 * > 8169, 8168 and 810x line of chipsets
2376 *
2377 * 8169, 8168, and 8136(810x) serial chipsets support it.
2378 *
2379 * > 2 - the Tx timer unit at gigabit speed
2380 *
2381 * The unit of the timer depends on both the speed and the setting of CPlusCmd
2382 * (0xe0) bit 1 and bit 0.
2383 *
2384 * For 8169
2385 * bit[1:0] \ speed 1000M 100M 10M
2386 * 0 0 320ns 2.56us 40.96us
2387 * 0 1 2.56us 20.48us 327.7us
2388 * 1 0 5.12us 40.96us 655.4us
2389 * 1 1 10.24us 81.92us 1.31ms
2390 *
2391 * For the other
2392 * bit[1:0] \ speed 1000M 100M 10M
2393 * 0 0 5us 2.56us 40.96us
2394 * 0 1 40us 20.48us 327.7us
2395 * 1 0 80us 40.96us 655.4us
2396 * 1 1 160us 81.92us 1.31ms
2397 */
2398
2399/* rx/tx scale factors for one particular CPlusCmd[0:1] value */
2400struct rtl_coalesce_scale {
2401 /* Rx / Tx */
2402 u32 nsecs[2];
2403};
2404
2405/* rx/tx scale factors for all CPlusCmd[0:1] cases */
2406struct rtl_coalesce_info {
2407 u32 speed;
2408 struct rtl_coalesce_scale scalev[4]; /* each CPlusCmd[0:1] case */
2409};
2410
2411/* produce (r,t) pairs with each being in series of *1, *8, *8*2, *8*2*2 */
2412#define rxtx_x1822(r, t) { \
2413 {{(r), (t)}}, \
2414 {{(r)*8, (t)*8}}, \
2415 {{(r)*8*2, (t)*8*2}}, \
2416 {{(r)*8*2*2, (t)*8*2*2}}, \
2417}
2418static const struct rtl_coalesce_info rtl_coalesce_info_8169[] = {
2419 /* speed delays: rx00 tx00 */
2420 { SPEED_10, rxtx_x1822(40960, 40960) },
2421 { SPEED_100, rxtx_x1822( 2560, 2560) },
2422 { SPEED_1000, rxtx_x1822( 320, 320) },
2423 { 0 },
2424};
2425
2426static const struct rtl_coalesce_info rtl_coalesce_info_8168_8136[] = {
2427 /* speed delays: rx00 tx00 */
2428 { SPEED_10, rxtx_x1822(40960, 40960) },
2429 { SPEED_100, rxtx_x1822( 2560, 2560) },
2430 { SPEED_1000, rxtx_x1822( 5000, 5000) },
2431 { 0 },
2432};
2433#undef rxtx_x1822
2434
2435/* get rx/tx scale vector corresponding to current speed */
2436static const struct rtl_coalesce_info *rtl_coalesce_info(struct net_device *dev)
2437{
2438 struct rtl8169_private *tp = netdev_priv(dev);
2439 struct ethtool_link_ksettings ecmd;
2440 const struct rtl_coalesce_info *ci;
2441 int rc;
2442
2443 rc = rtl8169_get_link_ksettings(dev, &ecmd);
2444 if (rc < 0)
2445 return ERR_PTR(rc);
2446
2447 for (ci = tp->coalesce_info; ci->speed != 0; ci++) {
2448 if (ecmd.base.speed == ci->speed) {
2449 return ci;
2450 }
2451 }
2452
2453 return ERR_PTR(-ELNRNG);
2454}
2455
2456static int rtl_get_coalesce(struct net_device *dev, struct ethtool_coalesce *ec)
2457{
2458 struct rtl8169_private *tp = netdev_priv(dev);
2459 void __iomem *ioaddr = tp->mmio_addr;
2460 const struct rtl_coalesce_info *ci;
2461 const struct rtl_coalesce_scale *scale;
2462 struct {
2463 u32 *max_frames;
2464 u32 *usecs;
2465 } coal_settings [] = {
2466 { &ec->rx_max_coalesced_frames, &ec->rx_coalesce_usecs },
2467 { &ec->tx_max_coalesced_frames, &ec->tx_coalesce_usecs }
2468 }, *p = coal_settings;
2469 int i;
2470 u16 w;
2471
2472 memset(ec, 0, sizeof(*ec));
2473
2474 /* get rx/tx scale corresponding to current speed and CPlusCmd[0:1] */
2475 ci = rtl_coalesce_info(dev);
2476 if (IS_ERR(ci))
2477 return PTR_ERR(ci);
2478
2479 scale = &ci->scalev[RTL_R16(CPlusCmd) & 3];
2480
2481 /* read IntrMitigate and adjust according to scale */
2482 for (w = RTL_R16(IntrMitigate); w; w >>= RTL_COALESCE_SHIFT, p++) {
2483 *p->max_frames = (w & RTL_COALESCE_MASK) << 2;
2484 w >>= RTL_COALESCE_SHIFT;
2485 *p->usecs = w & RTL_COALESCE_MASK;
2486 }
2487
2488 for (i = 0; i < 2; i++) {
2489 p = coal_settings + i;
2490 *p->usecs = (*p->usecs * scale->nsecs[i]) / 1000;
2491
2492 /*
2493 * ethtool_coalesce says it is illegal to set both usecs and
2494 * max_frames to 0.
2495 */
2496 if (!*p->usecs && !*p->max_frames)
2497 *p->max_frames = 1;
2498 }
2499
2500 return 0;
2501}
2502
2503/* choose appropriate scale factor and CPlusCmd[0:1] for (speed, nsec) */
2504static const struct rtl_coalesce_scale *rtl_coalesce_choose_scale(
2505 struct net_device *dev, u32 nsec, u16 *cp01)
2506{
2507 const struct rtl_coalesce_info *ci;
2508 u16 i;
2509
2510 ci = rtl_coalesce_info(dev);
2511 if (IS_ERR(ci))
2512 return ERR_CAST(ci);
2513
2514 for (i = 0; i < 4; i++) {
2515 u32 rxtx_maxscale = max(ci->scalev[i].nsecs[0],
2516 ci->scalev[i].nsecs[1]);
2517 if (nsec <= rxtx_maxscale * RTL_COALESCE_T_MAX) {
2518 *cp01 = i;
2519 return &ci->scalev[i];
2520 }
2521 }
2522
2523 return ERR_PTR(-EINVAL);
2524}
2525
2526static int rtl_set_coalesce(struct net_device *dev, struct ethtool_coalesce *ec)
2527{
2528 struct rtl8169_private *tp = netdev_priv(dev);
2529 void __iomem *ioaddr = tp->mmio_addr;
2530 const struct rtl_coalesce_scale *scale;
2531 struct {
2532 u32 frames;
2533 u32 usecs;
2534 } coal_settings [] = {
2535 { ec->rx_max_coalesced_frames, ec->rx_coalesce_usecs },
2536 { ec->tx_max_coalesced_frames, ec->tx_coalesce_usecs }
2537 }, *p = coal_settings;
2538 u16 w = 0, cp01;
2539 int i;
2540
2541 scale = rtl_coalesce_choose_scale(dev,
2542 max(p[0].usecs, p[1].usecs) * 1000, &cp01);
2543 if (IS_ERR(scale))
2544 return PTR_ERR(scale);
2545
2546 for (i = 0; i < 2; i++, p++) {
2547 u32 units;
2548
2549 /*
2550 * accept max_frames=1 we returned in rtl_get_coalesce.
2551 * accept it not only when usecs=0 because of e.g. the following scenario:
2552 *
2553 * - both rx_usecs=0 & rx_frames=0 in hardware (no delay on RX)
2554 * - rtl_get_coalesce returns rx_usecs=0, rx_frames=1
2555 * - then user does `ethtool -C eth0 rx-usecs 100`
2556 *
2557 * since ethtool sends to kernel whole ethtool_coalesce
2558 * settings, if we do not handle rx_usecs=!0, rx_frames=1
2559 * we'll reject it below in `frames % 4 != 0`.
2560 */
2561 if (p->frames == 1) {
2562 p->frames = 0;
2563 }
2564
2565 units = p->usecs * 1000 / scale->nsecs[i];
2566 if (p->frames > RTL_COALESCE_FRAME_MAX || p->frames % 4)
2567 return -EINVAL;
2568
2569 w <<= RTL_COALESCE_SHIFT;
2570 w |= units;
2571 w <<= RTL_COALESCE_SHIFT;
2572 w |= p->frames >> 2;
2573 }
2574
2575 rtl_lock_work(tp);
2576
2577 RTL_W16(IntrMitigate, swab16(w));
2578
2579 tp->cp_cmd = (tp->cp_cmd & ~3) | cp01;
2580 RTL_W16(CPlusCmd, tp->cp_cmd);
2581 RTL_R16(CPlusCmd);
2582
2583 rtl_unlock_work(tp);
2584
2585 return 0;
2586}
2587
Jeff Garzik7282d492006-09-13 14:30:00 -04002588static const struct ethtool_ops rtl8169_ethtool_ops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002589 .get_drvinfo = rtl8169_get_drvinfo,
2590 .get_regs_len = rtl8169_get_regs_len,
2591 .get_link = ethtool_op_get_link,
Francois Romieu50970832017-10-27 13:24:49 +03002592 .get_coalesce = rtl_get_coalesce,
2593 .set_coalesce = rtl_set_coalesce,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002594 .set_settings = rtl8169_set_settings,
Stephen Hemmingerb57b7e52005-05-27 21:11:52 +02002595 .get_msglevel = rtl8169_get_msglevel,
2596 .set_msglevel = rtl8169_set_msglevel,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002597 .get_regs = rtl8169_get_regs,
Francois Romieu61a4dcc2006-02-23 00:55:25 +01002598 .get_wol = rtl8169_get_wol,
2599 .set_wol = rtl8169_set_wol,
Stephen Hemmingerd4a3a0f2005-05-27 21:11:56 +02002600 .get_strings = rtl8169_get_strings,
Jeff Garzikb9f2c042007-10-03 18:07:32 -07002601 .get_sset_count = rtl8169_get_sset_count,
Stephen Hemmingerd4a3a0f2005-05-27 21:11:56 +02002602 .get_ethtool_stats = rtl8169_get_ethtool_stats,
Richard Cochrane1593bb2012-04-03 22:59:35 +00002603 .get_ts_info = ethtool_op_get_ts_info,
Florian Fainellif0903ea2016-12-03 12:01:19 -08002604 .nway_reset = rtl8169_nway_reset,
Philippe Reynes6fa1ba62017-02-23 22:34:43 +01002605 .get_link_ksettings = rtl8169_get_link_ksettings,
Linus Torvalds1da177e2005-04-16 15:20:36 -07002606};
2607
Francois Romieu07d3f512007-02-21 22:40:46 +01002608static void rtl8169_get_mac_version(struct rtl8169_private *tp,
Francois Romieu5d320a22011-05-08 17:47:36 +02002609 struct net_device *dev, u8 default_version)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002610{
Francois Romieu5d320a22011-05-08 17:47:36 +02002611 void __iomem *ioaddr = tp->mmio_addr;
Francois Romieu0e485152007-02-20 00:00:26 +01002612 /*
2613 * The driver currently handles the 8168Bf and the 8168Be identically
2614 * but they can be identified more specifically through the test below
2615 * if needed:
2616 *
2617 * (RTL_R32(TxConfig) & 0x700000) == 0x500000 ? 8168Bf : 8168Be
Francois Romieu01272152007-02-20 22:58:51 +01002618 *
2619 * Same thing for the 8101Eb and the 8101Ec:
2620 *
2621 * (RTL_R32(TxConfig) & 0x700000) == 0x200000 ? 8101Eb : 8101Ec
Francois Romieu0e485152007-02-20 00:00:26 +01002622 */
Francois Romieu37441002011-06-17 22:58:54 +02002623 static const struct rtl_mac_info {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002624 u32 mask;
Francois Romieue3cf0cc2007-08-17 14:55:46 +02002625 u32 val;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002626 int mac_version;
2627 } mac_info[] = {
Chun-Hao Lin935e2212014-10-07 15:10:41 +08002628 /* 8168EP family. */
2629 { 0x7cf00000, 0x50200000, RTL_GIGA_MAC_VER_51 },
2630 { 0x7cf00000, 0x50100000, RTL_GIGA_MAC_VER_50 },
2631 { 0x7cf00000, 0x50000000, RTL_GIGA_MAC_VER_49 },
2632
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08002633 /* 8168H family. */
2634 { 0x7cf00000, 0x54100000, RTL_GIGA_MAC_VER_46 },
2635 { 0x7cf00000, 0x54000000, RTL_GIGA_MAC_VER_45 },
2636
Hayes Wangc5583862012-07-02 17:23:22 +08002637 /* 8168G family. */
hayeswang45dd95c2013-07-08 17:09:01 +08002638 { 0x7cf00000, 0x5c800000, RTL_GIGA_MAC_VER_44 },
hayeswang57538c42013-04-01 22:23:40 +00002639 { 0x7cf00000, 0x50900000, RTL_GIGA_MAC_VER_42 },
Hayes Wangc5583862012-07-02 17:23:22 +08002640 { 0x7cf00000, 0x4c100000, RTL_GIGA_MAC_VER_41 },
2641 { 0x7cf00000, 0x4c000000, RTL_GIGA_MAC_VER_40 },
2642
Hayes Wangc2218922011-09-06 16:55:18 +08002643 /* 8168F family. */
Hayes Wangb3d7b2f2012-03-30 14:48:06 +08002644 { 0x7c800000, 0x48800000, RTL_GIGA_MAC_VER_38 },
Hayes Wangc2218922011-09-06 16:55:18 +08002645 { 0x7cf00000, 0x48100000, RTL_GIGA_MAC_VER_36 },
2646 { 0x7cf00000, 0x48000000, RTL_GIGA_MAC_VER_35 },
2647
hayeswang01dc7fe2011-03-21 01:50:28 +00002648 /* 8168E family. */
Hayes Wang70090422011-07-06 15:58:06 +08002649 { 0x7c800000, 0x2c800000, RTL_GIGA_MAC_VER_34 },
hayeswang01dc7fe2011-03-21 01:50:28 +00002650 { 0x7cf00000, 0x2c200000, RTL_GIGA_MAC_VER_33 },
2651 { 0x7cf00000, 0x2c100000, RTL_GIGA_MAC_VER_32 },
2652 { 0x7c800000, 0x2c000000, RTL_GIGA_MAC_VER_33 },
2653
Francois Romieu5b538df2008-07-20 16:22:45 +02002654 /* 8168D family. */
françois romieudaf9df62009-10-07 12:44:20 +00002655 { 0x7cf00000, 0x28300000, RTL_GIGA_MAC_VER_26 },
2656 { 0x7cf00000, 0x28100000, RTL_GIGA_MAC_VER_25 },
françois romieudaf9df62009-10-07 12:44:20 +00002657 { 0x7c800000, 0x28000000, RTL_GIGA_MAC_VER_26 },
Francois Romieu5b538df2008-07-20 16:22:45 +02002658
françois romieue6de30d2011-01-03 15:08:37 +00002659 /* 8168DP family. */
2660 { 0x7cf00000, 0x28800000, RTL_GIGA_MAC_VER_27 },
2661 { 0x7cf00000, 0x28a00000, RTL_GIGA_MAC_VER_28 },
hayeswang4804b3b2011-03-21 01:50:29 +00002662 { 0x7cf00000, 0x28b00000, RTL_GIGA_MAC_VER_31 },
françois romieue6de30d2011-01-03 15:08:37 +00002663
Francois Romieuef808d52008-06-29 13:10:54 +02002664 /* 8168C family. */
Francois Romieu17c99292010-07-11 17:10:09 -07002665 { 0x7cf00000, 0x3cb00000, RTL_GIGA_MAC_VER_24 },
Francois Romieuef3386f2008-06-29 12:24:30 +02002666 { 0x7cf00000, 0x3c900000, RTL_GIGA_MAC_VER_23 },
Francois Romieuef808d52008-06-29 13:10:54 +02002667 { 0x7cf00000, 0x3c800000, RTL_GIGA_MAC_VER_18 },
Francois Romieu7f3e3d32008-07-20 18:53:20 +02002668 { 0x7c800000, 0x3c800000, RTL_GIGA_MAC_VER_24 },
Francois Romieue3cf0cc2007-08-17 14:55:46 +02002669 { 0x7cf00000, 0x3c000000, RTL_GIGA_MAC_VER_19 },
2670 { 0x7cf00000, 0x3c200000, RTL_GIGA_MAC_VER_20 },
Francois Romieu197ff762008-06-28 13:16:02 +02002671 { 0x7cf00000, 0x3c300000, RTL_GIGA_MAC_VER_21 },
Francois Romieu6fb07052008-06-29 11:54:28 +02002672 { 0x7cf00000, 0x3c400000, RTL_GIGA_MAC_VER_22 },
Francois Romieuef808d52008-06-29 13:10:54 +02002673 { 0x7c800000, 0x3c000000, RTL_GIGA_MAC_VER_22 },
Francois Romieue3cf0cc2007-08-17 14:55:46 +02002674
2675 /* 8168B family. */
2676 { 0x7cf00000, 0x38000000, RTL_GIGA_MAC_VER_12 },
2677 { 0x7cf00000, 0x38500000, RTL_GIGA_MAC_VER_17 },
2678 { 0x7c800000, 0x38000000, RTL_GIGA_MAC_VER_17 },
2679 { 0x7c800000, 0x30000000, RTL_GIGA_MAC_VER_11 },
2680
2681 /* 8101 family. */
Hayes Wang5598bfe2012-07-02 17:23:21 +08002682 { 0x7cf00000, 0x44900000, RTL_GIGA_MAC_VER_39 },
2683 { 0x7c800000, 0x44800000, RTL_GIGA_MAC_VER_39 },
Hayes Wang7e18dca2012-03-30 14:33:02 +08002684 { 0x7c800000, 0x44000000, RTL_GIGA_MAC_VER_37 },
hayeswang36a0e6c2011-03-21 01:50:30 +00002685 { 0x7cf00000, 0x40b00000, RTL_GIGA_MAC_VER_30 },
Hayes Wang5a5e4442011-02-22 17:26:21 +08002686 { 0x7cf00000, 0x40a00000, RTL_GIGA_MAC_VER_30 },
2687 { 0x7cf00000, 0x40900000, RTL_GIGA_MAC_VER_29 },
2688 { 0x7c800000, 0x40800000, RTL_GIGA_MAC_VER_30 },
Francois Romieu2857ffb2008-08-02 21:08:49 +02002689 { 0x7cf00000, 0x34a00000, RTL_GIGA_MAC_VER_09 },
2690 { 0x7cf00000, 0x24a00000, RTL_GIGA_MAC_VER_09 },
2691 { 0x7cf00000, 0x34900000, RTL_GIGA_MAC_VER_08 },
2692 { 0x7cf00000, 0x24900000, RTL_GIGA_MAC_VER_08 },
2693 { 0x7cf00000, 0x34800000, RTL_GIGA_MAC_VER_07 },
2694 { 0x7cf00000, 0x24800000, RTL_GIGA_MAC_VER_07 },
Francois Romieue3cf0cc2007-08-17 14:55:46 +02002695 { 0x7cf00000, 0x34000000, RTL_GIGA_MAC_VER_13 },
Francois Romieu2857ffb2008-08-02 21:08:49 +02002696 { 0x7cf00000, 0x34300000, RTL_GIGA_MAC_VER_10 },
Francois Romieue3cf0cc2007-08-17 14:55:46 +02002697 { 0x7cf00000, 0x34200000, RTL_GIGA_MAC_VER_16 },
Francois Romieu2857ffb2008-08-02 21:08:49 +02002698 { 0x7c800000, 0x34800000, RTL_GIGA_MAC_VER_09 },
2699 { 0x7c800000, 0x24800000, RTL_GIGA_MAC_VER_09 },
Francois Romieue3cf0cc2007-08-17 14:55:46 +02002700 { 0x7c800000, 0x34000000, RTL_GIGA_MAC_VER_16 },
2701 /* FIXME: where did these entries come from ? -- FR */
2702 { 0xfc800000, 0x38800000, RTL_GIGA_MAC_VER_15 },
2703 { 0xfc800000, 0x30800000, RTL_GIGA_MAC_VER_14 },
2704
2705 /* 8110 family. */
2706 { 0xfc800000, 0x98000000, RTL_GIGA_MAC_VER_06 },
2707 { 0xfc800000, 0x18000000, RTL_GIGA_MAC_VER_05 },
2708 { 0xfc800000, 0x10000000, RTL_GIGA_MAC_VER_04 },
2709 { 0xfc800000, 0x04000000, RTL_GIGA_MAC_VER_03 },
2710 { 0xfc800000, 0x00800000, RTL_GIGA_MAC_VER_02 },
2711 { 0xfc800000, 0x00000000, RTL_GIGA_MAC_VER_01 },
2712
Jean Delvaref21b75e2009-05-26 20:54:48 -07002713 /* Catch-all */
2714 { 0x00000000, 0x00000000, RTL_GIGA_MAC_NONE }
Francois Romieu37441002011-06-17 22:58:54 +02002715 };
2716 const struct rtl_mac_info *p = mac_info;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002717 u32 reg;
2718
Francois Romieue3cf0cc2007-08-17 14:55:46 +02002719 reg = RTL_R32(TxConfig);
2720 while ((reg & p->mask) != p->val)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002721 p++;
2722 tp->mac_version = p->mac_version;
Francois Romieu5d320a22011-05-08 17:47:36 +02002723
2724 if (tp->mac_version == RTL_GIGA_MAC_NONE) {
2725 netif_notice(tp, probe, dev,
2726 "unknown MAC, using family default\n");
2727 tp->mac_version = default_version;
hayeswang58152cd2013-04-01 22:23:42 +00002728 } else if (tp->mac_version == RTL_GIGA_MAC_VER_42) {
2729 tp->mac_version = tp->mii.supports_gmii ?
2730 RTL_GIGA_MAC_VER_42 :
2731 RTL_GIGA_MAC_VER_43;
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08002732 } else if (tp->mac_version == RTL_GIGA_MAC_VER_45) {
2733 tp->mac_version = tp->mii.supports_gmii ?
2734 RTL_GIGA_MAC_VER_45 :
2735 RTL_GIGA_MAC_VER_47;
2736 } else if (tp->mac_version == RTL_GIGA_MAC_VER_46) {
2737 tp->mac_version = tp->mii.supports_gmii ?
2738 RTL_GIGA_MAC_VER_46 :
2739 RTL_GIGA_MAC_VER_48;
Francois Romieu5d320a22011-05-08 17:47:36 +02002740 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002741}
2742
2743static void rtl8169_print_mac_version(struct rtl8169_private *tp)
2744{
Francois Romieubcf0bf92006-07-26 23:14:13 +02002745 dprintk("mac_version = 0x%02x\n", tp->mac_version);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002746}
2747
Francois Romieu867763c2007-08-17 18:21:58 +02002748struct phy_reg {
2749 u16 reg;
2750 u16 val;
2751};
2752
françois romieu4da19632011-01-03 15:07:55 +00002753static void rtl_writephy_batch(struct rtl8169_private *tp,
2754 const struct phy_reg *regs, int len)
Francois Romieu867763c2007-08-17 18:21:58 +02002755{
2756 while (len-- > 0) {
françois romieu4da19632011-01-03 15:07:55 +00002757 rtl_writephy(tp, regs->reg, regs->val);
Francois Romieu867763c2007-08-17 18:21:58 +02002758 regs++;
2759 }
2760}
2761
françois romieubca03d52011-01-03 15:07:31 +00002762#define PHY_READ 0x00000000
2763#define PHY_DATA_OR 0x10000000
2764#define PHY_DATA_AND 0x20000000
2765#define PHY_BJMPN 0x30000000
hayeswangeee37862013-04-01 22:23:38 +00002766#define PHY_MDIO_CHG 0x40000000
françois romieubca03d52011-01-03 15:07:31 +00002767#define PHY_CLEAR_READCOUNT 0x70000000
2768#define PHY_WRITE 0x80000000
2769#define PHY_READCOUNT_EQ_SKIP 0x90000000
2770#define PHY_COMP_EQ_SKIPN 0xa0000000
2771#define PHY_COMP_NEQ_SKIPN 0xb0000000
2772#define PHY_WRITE_PREVIOUS 0xc0000000
2773#define PHY_SKIPN 0xd0000000
2774#define PHY_DELAY_MS 0xe0000000
françois romieubca03d52011-01-03 15:07:31 +00002775
Hayes Wang960aee62011-06-18 11:37:48 +02002776struct fw_info {
2777 u32 magic;
2778 char version[RTL_VER_SIZE];
2779 __le32 fw_start;
2780 __le32 fw_len;
2781 u8 chksum;
2782} __packed;
2783
Francois Romieu1c361ef2011-06-17 17:16:24 +02002784#define FW_OPCODE_SIZE sizeof(typeof(*((struct rtl_fw_phy_action *)0)->code))
2785
2786static bool rtl_fw_format_ok(struct rtl8169_private *tp, struct rtl_fw *rtl_fw)
françois romieubca03d52011-01-03 15:07:31 +00002787{
Francois Romieub6ffd972011-06-17 17:00:05 +02002788 const struct firmware *fw = rtl_fw->fw;
Hayes Wang960aee62011-06-18 11:37:48 +02002789 struct fw_info *fw_info = (struct fw_info *)fw->data;
Francois Romieu1c361ef2011-06-17 17:16:24 +02002790 struct rtl_fw_phy_action *pa = &rtl_fw->phy_action;
2791 char *version = rtl_fw->version;
2792 bool rc = false;
françois romieubca03d52011-01-03 15:07:31 +00002793
Francois Romieu1c361ef2011-06-17 17:16:24 +02002794 if (fw->size < FW_OPCODE_SIZE)
2795 goto out;
Hayes Wang960aee62011-06-18 11:37:48 +02002796
2797 if (!fw_info->magic) {
2798 size_t i, size, start;
2799 u8 checksum = 0;
2800
2801 if (fw->size < sizeof(*fw_info))
2802 goto out;
2803
2804 for (i = 0; i < fw->size; i++)
2805 checksum += fw->data[i];
2806 if (checksum != 0)
2807 goto out;
2808
2809 start = le32_to_cpu(fw_info->fw_start);
2810 if (start > fw->size)
2811 goto out;
2812
2813 size = le32_to_cpu(fw_info->fw_len);
2814 if (size > (fw->size - start) / FW_OPCODE_SIZE)
2815 goto out;
2816
2817 memcpy(version, fw_info->version, RTL_VER_SIZE);
2818
2819 pa->code = (__le32 *)(fw->data + start);
2820 pa->size = size;
2821 } else {
Francois Romieu1c361ef2011-06-17 17:16:24 +02002822 if (fw->size % FW_OPCODE_SIZE)
2823 goto out;
2824
2825 strlcpy(version, rtl_lookup_firmware_name(tp), RTL_VER_SIZE);
2826
2827 pa->code = (__le32 *)fw->data;
2828 pa->size = fw->size / FW_OPCODE_SIZE;
2829 }
2830 version[RTL_VER_SIZE - 1] = 0;
2831
2832 rc = true;
2833out:
2834 return rc;
2835}
2836
Francois Romieufd112f22011-06-18 00:10:29 +02002837static bool rtl_fw_data_ok(struct rtl8169_private *tp, struct net_device *dev,
2838 struct rtl_fw_phy_action *pa)
Francois Romieu1c361ef2011-06-17 17:16:24 +02002839{
Francois Romieufd112f22011-06-18 00:10:29 +02002840 bool rc = false;
Francois Romieu1c361ef2011-06-17 17:16:24 +02002841 size_t index;
2842
Francois Romieu1c361ef2011-06-17 17:16:24 +02002843 for (index = 0; index < pa->size; index++) {
2844 u32 action = le32_to_cpu(pa->code[index]);
hayeswang42b82dc2011-01-10 02:07:25 +00002845 u32 regno = (action & 0x0fff0000) >> 16;
françois romieubca03d52011-01-03 15:07:31 +00002846
hayeswang42b82dc2011-01-10 02:07:25 +00002847 switch(action & 0xf0000000) {
2848 case PHY_READ:
2849 case PHY_DATA_OR:
2850 case PHY_DATA_AND:
hayeswangeee37862013-04-01 22:23:38 +00002851 case PHY_MDIO_CHG:
hayeswang42b82dc2011-01-10 02:07:25 +00002852 case PHY_CLEAR_READCOUNT:
2853 case PHY_WRITE:
2854 case PHY_WRITE_PREVIOUS:
2855 case PHY_DELAY_MS:
françois romieubca03d52011-01-03 15:07:31 +00002856 break;
2857
hayeswang42b82dc2011-01-10 02:07:25 +00002858 case PHY_BJMPN:
2859 if (regno > index) {
Francois Romieufd112f22011-06-18 00:10:29 +02002860 netif_err(tp, ifup, tp->dev,
Francois Romieucecb5fd2011-04-01 10:21:07 +02002861 "Out of range of firmware\n");
Francois Romieufd112f22011-06-18 00:10:29 +02002862 goto out;
hayeswang42b82dc2011-01-10 02:07:25 +00002863 }
2864 break;
2865 case PHY_READCOUNT_EQ_SKIP:
Francois Romieu1c361ef2011-06-17 17:16:24 +02002866 if (index + 2 >= pa->size) {
Francois Romieufd112f22011-06-18 00:10:29 +02002867 netif_err(tp, ifup, tp->dev,
Francois Romieucecb5fd2011-04-01 10:21:07 +02002868 "Out of range of firmware\n");
Francois Romieufd112f22011-06-18 00:10:29 +02002869 goto out;
hayeswang42b82dc2011-01-10 02:07:25 +00002870 }
2871 break;
2872 case PHY_COMP_EQ_SKIPN:
2873 case PHY_COMP_NEQ_SKIPN:
2874 case PHY_SKIPN:
Francois Romieu1c361ef2011-06-17 17:16:24 +02002875 if (index + 1 + regno >= pa->size) {
Francois Romieufd112f22011-06-18 00:10:29 +02002876 netif_err(tp, ifup, tp->dev,
Francois Romieucecb5fd2011-04-01 10:21:07 +02002877 "Out of range of firmware\n");
Francois Romieufd112f22011-06-18 00:10:29 +02002878 goto out;
hayeswang42b82dc2011-01-10 02:07:25 +00002879 }
2880 break;
2881
hayeswang42b82dc2011-01-10 02:07:25 +00002882 default:
Francois Romieufd112f22011-06-18 00:10:29 +02002883 netif_err(tp, ifup, tp->dev,
hayeswang42b82dc2011-01-10 02:07:25 +00002884 "Invalid action 0x%08x\n", action);
Francois Romieufd112f22011-06-18 00:10:29 +02002885 goto out;
françois romieubca03d52011-01-03 15:07:31 +00002886 }
2887 }
Francois Romieufd112f22011-06-18 00:10:29 +02002888 rc = true;
2889out:
2890 return rc;
2891}
françois romieubca03d52011-01-03 15:07:31 +00002892
Francois Romieufd112f22011-06-18 00:10:29 +02002893static int rtl_check_firmware(struct rtl8169_private *tp, struct rtl_fw *rtl_fw)
2894{
2895 struct net_device *dev = tp->dev;
2896 int rc = -EINVAL;
2897
2898 if (!rtl_fw_format_ok(tp, rtl_fw)) {
Yannick Guerrini5c2d2b12015-02-24 13:03:51 +01002899 netif_err(tp, ifup, dev, "invalid firmware\n");
Francois Romieufd112f22011-06-18 00:10:29 +02002900 goto out;
2901 }
2902
2903 if (rtl_fw_data_ok(tp, dev, &rtl_fw->phy_action))
2904 rc = 0;
2905out:
2906 return rc;
2907}
2908
2909static void rtl_phy_write_fw(struct rtl8169_private *tp, struct rtl_fw *rtl_fw)
2910{
2911 struct rtl_fw_phy_action *pa = &rtl_fw->phy_action;
hayeswangeee37862013-04-01 22:23:38 +00002912 struct mdio_ops org, *ops = &tp->mdio_ops;
Francois Romieufd112f22011-06-18 00:10:29 +02002913 u32 predata, count;
2914 size_t index;
2915
2916 predata = count = 0;
hayeswangeee37862013-04-01 22:23:38 +00002917 org.write = ops->write;
2918 org.read = ops->read;
hayeswang42b82dc2011-01-10 02:07:25 +00002919
Francois Romieu1c361ef2011-06-17 17:16:24 +02002920 for (index = 0; index < pa->size; ) {
2921 u32 action = le32_to_cpu(pa->code[index]);
françois romieubca03d52011-01-03 15:07:31 +00002922 u32 data = action & 0x0000ffff;
hayeswang42b82dc2011-01-10 02:07:25 +00002923 u32 regno = (action & 0x0fff0000) >> 16;
2924
2925 if (!action)
2926 break;
françois romieubca03d52011-01-03 15:07:31 +00002927
2928 switch(action & 0xf0000000) {
hayeswang42b82dc2011-01-10 02:07:25 +00002929 case PHY_READ:
2930 predata = rtl_readphy(tp, regno);
2931 count++;
2932 index++;
françois romieubca03d52011-01-03 15:07:31 +00002933 break;
hayeswang42b82dc2011-01-10 02:07:25 +00002934 case PHY_DATA_OR:
2935 predata |= data;
2936 index++;
2937 break;
2938 case PHY_DATA_AND:
2939 predata &= data;
2940 index++;
2941 break;
2942 case PHY_BJMPN:
2943 index -= regno;
2944 break;
hayeswangeee37862013-04-01 22:23:38 +00002945 case PHY_MDIO_CHG:
2946 if (data == 0) {
2947 ops->write = org.write;
2948 ops->read = org.read;
2949 } else if (data == 1) {
2950 ops->write = mac_mcu_write;
2951 ops->read = mac_mcu_read;
2952 }
2953
hayeswang42b82dc2011-01-10 02:07:25 +00002954 index++;
2955 break;
2956 case PHY_CLEAR_READCOUNT:
2957 count = 0;
2958 index++;
2959 break;
2960 case PHY_WRITE:
2961 rtl_writephy(tp, regno, data);
2962 index++;
2963 break;
2964 case PHY_READCOUNT_EQ_SKIP:
Francois Romieucecb5fd2011-04-01 10:21:07 +02002965 index += (count == data) ? 2 : 1;
hayeswang42b82dc2011-01-10 02:07:25 +00002966 break;
2967 case PHY_COMP_EQ_SKIPN:
2968 if (predata == data)
2969 index += regno;
2970 index++;
2971 break;
2972 case PHY_COMP_NEQ_SKIPN:
2973 if (predata != data)
2974 index += regno;
2975 index++;
2976 break;
2977 case PHY_WRITE_PREVIOUS:
2978 rtl_writephy(tp, regno, predata);
2979 index++;
2980 break;
2981 case PHY_SKIPN:
2982 index += regno + 1;
2983 break;
2984 case PHY_DELAY_MS:
2985 mdelay(data);
2986 index++;
2987 break;
2988
françois romieubca03d52011-01-03 15:07:31 +00002989 default:
2990 BUG();
2991 }
2992 }
hayeswangeee37862013-04-01 22:23:38 +00002993
2994 ops->write = org.write;
2995 ops->read = org.read;
françois romieubca03d52011-01-03 15:07:31 +00002996}
2997
françois romieuf1e02ed2011-01-13 13:07:53 +00002998static void rtl_release_firmware(struct rtl8169_private *tp)
2999{
Francois Romieub6ffd972011-06-17 17:00:05 +02003000 if (!IS_ERR_OR_NULL(tp->rtl_fw)) {
3001 release_firmware(tp->rtl_fw->fw);
3002 kfree(tp->rtl_fw);
3003 }
3004 tp->rtl_fw = RTL_FIRMWARE_UNKNOWN;
françois romieuf1e02ed2011-01-13 13:07:53 +00003005}
3006
François Romieu953a12c2011-04-24 17:38:48 +02003007static void rtl_apply_firmware(struct rtl8169_private *tp)
françois romieuf1e02ed2011-01-13 13:07:53 +00003008{
Francois Romieub6ffd972011-06-17 17:00:05 +02003009 struct rtl_fw *rtl_fw = tp->rtl_fw;
françois romieuf1e02ed2011-01-13 13:07:53 +00003010
3011 /* TODO: release firmware once rtl_phy_write_fw signals failures. */
Francois Romieueef63cc2013-02-08 23:43:20 +01003012 if (!IS_ERR_OR_NULL(rtl_fw))
Francois Romieub6ffd972011-06-17 17:00:05 +02003013 rtl_phy_write_fw(tp, rtl_fw);
François Romieu953a12c2011-04-24 17:38:48 +02003014}
3015
3016static void rtl_apply_firmware_cond(struct rtl8169_private *tp, u8 reg, u16 val)
3017{
3018 if (rtl_readphy(tp, reg) != val)
3019 netif_warn(tp, hw, tp->dev, "chipset not ready for firmware\n");
3020 else
3021 rtl_apply_firmware(tp);
françois romieuf1e02ed2011-01-13 13:07:53 +00003022}
3023
françois romieu4da19632011-01-03 15:07:55 +00003024static void rtl8169s_hw_phy_config(struct rtl8169_private *tp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07003025{
Alexey Dobriyan350f7592009-11-25 15:54:21 -08003026 static const struct phy_reg phy_reg_init[] = {
françois romieu0b9b5712009-08-10 19:44:56 +00003027 { 0x1f, 0x0001 },
3028 { 0x06, 0x006e },
3029 { 0x08, 0x0708 },
3030 { 0x15, 0x4000 },
3031 { 0x18, 0x65c7 },
Linus Torvalds1da177e2005-04-16 15:20:36 -07003032
françois romieu0b9b5712009-08-10 19:44:56 +00003033 { 0x1f, 0x0001 },
3034 { 0x03, 0x00a1 },
3035 { 0x02, 0x0008 },
3036 { 0x01, 0x0120 },
3037 { 0x00, 0x1000 },
3038 { 0x04, 0x0800 },
3039 { 0x04, 0x0000 },
Linus Torvalds1da177e2005-04-16 15:20:36 -07003040
françois romieu0b9b5712009-08-10 19:44:56 +00003041 { 0x03, 0xff41 },
3042 { 0x02, 0xdf60 },
3043 { 0x01, 0x0140 },
3044 { 0x00, 0x0077 },
3045 { 0x04, 0x7800 },
3046 { 0x04, 0x7000 },
Linus Torvalds1da177e2005-04-16 15:20:36 -07003047
françois romieu0b9b5712009-08-10 19:44:56 +00003048 { 0x03, 0x802f },
3049 { 0x02, 0x4f02 },
3050 { 0x01, 0x0409 },
3051 { 0x00, 0xf0f9 },
3052 { 0x04, 0x9800 },
3053 { 0x04, 0x9000 },
3054
3055 { 0x03, 0xdf01 },
3056 { 0x02, 0xdf20 },
3057 { 0x01, 0xff95 },
3058 { 0x00, 0xba00 },
3059 { 0x04, 0xa800 },
3060 { 0x04, 0xa000 },
3061
3062 { 0x03, 0xff41 },
3063 { 0x02, 0xdf20 },
3064 { 0x01, 0x0140 },
3065 { 0x00, 0x00bb },
3066 { 0x04, 0xb800 },
3067 { 0x04, 0xb000 },
3068
3069 { 0x03, 0xdf41 },
3070 { 0x02, 0xdc60 },
3071 { 0x01, 0x6340 },
3072 { 0x00, 0x007d },
3073 { 0x04, 0xd800 },
3074 { 0x04, 0xd000 },
3075
3076 { 0x03, 0xdf01 },
3077 { 0x02, 0xdf20 },
3078 { 0x01, 0x100a },
3079 { 0x00, 0xa0ff },
3080 { 0x04, 0xf800 },
3081 { 0x04, 0xf000 },
3082
3083 { 0x1f, 0x0000 },
3084 { 0x0b, 0x0000 },
3085 { 0x00, 0x9200 }
3086 };
3087
françois romieu4da19632011-01-03 15:07:55 +00003088 rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
Linus Torvalds1da177e2005-04-16 15:20:36 -07003089}
3090
françois romieu4da19632011-01-03 15:07:55 +00003091static void rtl8169sb_hw_phy_config(struct rtl8169_private *tp)
Francois Romieu5615d9f2007-08-17 17:50:46 +02003092{
Alexey Dobriyan350f7592009-11-25 15:54:21 -08003093 static const struct phy_reg phy_reg_init[] = {
Francois Romieua441d7b2007-08-17 18:26:35 +02003094 { 0x1f, 0x0002 },
3095 { 0x01, 0x90d0 },
3096 { 0x1f, 0x0000 }
3097 };
3098
françois romieu4da19632011-01-03 15:07:55 +00003099 rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
Francois Romieu5615d9f2007-08-17 17:50:46 +02003100}
3101
françois romieu4da19632011-01-03 15:07:55 +00003102static void rtl8169scd_hw_phy_config_quirk(struct rtl8169_private *tp)
françois romieu2e9558562009-08-10 19:44:19 +00003103{
3104 struct pci_dev *pdev = tp->pci_dev;
françois romieu2e9558562009-08-10 19:44:19 +00003105
Sergei Shtylyovccbae552011-07-22 05:37:24 +00003106 if ((pdev->subsystem_vendor != PCI_VENDOR_ID_GIGABYTE) ||
3107 (pdev->subsystem_device != 0xe000))
françois romieu2e9558562009-08-10 19:44:19 +00003108 return;
3109
françois romieu4da19632011-01-03 15:07:55 +00003110 rtl_writephy(tp, 0x1f, 0x0001);
3111 rtl_writephy(tp, 0x10, 0xf01b);
3112 rtl_writephy(tp, 0x1f, 0x0000);
françois romieu2e9558562009-08-10 19:44:19 +00003113}
3114
françois romieu4da19632011-01-03 15:07:55 +00003115static void rtl8169scd_hw_phy_config(struct rtl8169_private *tp)
françois romieu2e9558562009-08-10 19:44:19 +00003116{
Alexey Dobriyan350f7592009-11-25 15:54:21 -08003117 static const struct phy_reg phy_reg_init[] = {
françois romieu2e9558562009-08-10 19:44:19 +00003118 { 0x1f, 0x0001 },
3119 { 0x04, 0x0000 },
3120 { 0x03, 0x00a1 },
3121 { 0x02, 0x0008 },
3122 { 0x01, 0x0120 },
3123 { 0x00, 0x1000 },
3124 { 0x04, 0x0800 },
3125 { 0x04, 0x9000 },
3126 { 0x03, 0x802f },
3127 { 0x02, 0x4f02 },
3128 { 0x01, 0x0409 },
3129 { 0x00, 0xf099 },
3130 { 0x04, 0x9800 },
3131 { 0x04, 0xa000 },
3132 { 0x03, 0xdf01 },
3133 { 0x02, 0xdf20 },
3134 { 0x01, 0xff95 },
3135 { 0x00, 0xba00 },
3136 { 0x04, 0xa800 },
3137 { 0x04, 0xf000 },
3138 { 0x03, 0xdf01 },
3139 { 0x02, 0xdf20 },
3140 { 0x01, 0x101a },
3141 { 0x00, 0xa0ff },
3142 { 0x04, 0xf800 },
3143 { 0x04, 0x0000 },
3144 { 0x1f, 0x0000 },
3145
3146 { 0x1f, 0x0001 },
3147 { 0x10, 0xf41b },
3148 { 0x14, 0xfb54 },
3149 { 0x18, 0xf5c7 },
3150 { 0x1f, 0x0000 },
3151
3152 { 0x1f, 0x0001 },
3153 { 0x17, 0x0cc0 },
3154 { 0x1f, 0x0000 }
3155 };
3156
françois romieu4da19632011-01-03 15:07:55 +00003157 rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
françois romieu2e9558562009-08-10 19:44:19 +00003158
françois romieu4da19632011-01-03 15:07:55 +00003159 rtl8169scd_hw_phy_config_quirk(tp);
françois romieu2e9558562009-08-10 19:44:19 +00003160}
3161
françois romieu4da19632011-01-03 15:07:55 +00003162static void rtl8169sce_hw_phy_config(struct rtl8169_private *tp)
françois romieu8c7006a2009-08-10 19:43:29 +00003163{
Alexey Dobriyan350f7592009-11-25 15:54:21 -08003164 static const struct phy_reg phy_reg_init[] = {
françois romieu8c7006a2009-08-10 19:43:29 +00003165 { 0x1f, 0x0001 },
3166 { 0x04, 0x0000 },
3167 { 0x03, 0x00a1 },
3168 { 0x02, 0x0008 },
3169 { 0x01, 0x0120 },
3170 { 0x00, 0x1000 },
3171 { 0x04, 0x0800 },
3172 { 0x04, 0x9000 },
3173 { 0x03, 0x802f },
3174 { 0x02, 0x4f02 },
3175 { 0x01, 0x0409 },
3176 { 0x00, 0xf099 },
3177 { 0x04, 0x9800 },
3178 { 0x04, 0xa000 },
3179 { 0x03, 0xdf01 },
3180 { 0x02, 0xdf20 },
3181 { 0x01, 0xff95 },
3182 { 0x00, 0xba00 },
3183 { 0x04, 0xa800 },
3184 { 0x04, 0xf000 },
3185 { 0x03, 0xdf01 },
3186 { 0x02, 0xdf20 },
3187 { 0x01, 0x101a },
3188 { 0x00, 0xa0ff },
3189 { 0x04, 0xf800 },
3190 { 0x04, 0x0000 },
3191 { 0x1f, 0x0000 },
3192
3193 { 0x1f, 0x0001 },
3194 { 0x0b, 0x8480 },
3195 { 0x1f, 0x0000 },
3196
3197 { 0x1f, 0x0001 },
3198 { 0x18, 0x67c7 },
3199 { 0x04, 0x2000 },
3200 { 0x03, 0x002f },
3201 { 0x02, 0x4360 },
3202 { 0x01, 0x0109 },
3203 { 0x00, 0x3022 },
3204 { 0x04, 0x2800 },
3205 { 0x1f, 0x0000 },
3206
3207 { 0x1f, 0x0001 },
3208 { 0x17, 0x0cc0 },
3209 { 0x1f, 0x0000 }
3210 };
3211
françois romieu4da19632011-01-03 15:07:55 +00003212 rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
françois romieu8c7006a2009-08-10 19:43:29 +00003213}
3214
françois romieu4da19632011-01-03 15:07:55 +00003215static void rtl8168bb_hw_phy_config(struct rtl8169_private *tp)
Francois Romieu236b8082008-05-30 16:11:48 +02003216{
Alexey Dobriyan350f7592009-11-25 15:54:21 -08003217 static const struct phy_reg phy_reg_init[] = {
Francois Romieu236b8082008-05-30 16:11:48 +02003218 { 0x10, 0xf41b },
3219 { 0x1f, 0x0000 }
3220 };
3221
françois romieu4da19632011-01-03 15:07:55 +00003222 rtl_writephy(tp, 0x1f, 0x0001);
3223 rtl_patchphy(tp, 0x16, 1 << 0);
Francois Romieu236b8082008-05-30 16:11:48 +02003224
françois romieu4da19632011-01-03 15:07:55 +00003225 rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
Francois Romieu236b8082008-05-30 16:11:48 +02003226}
3227
françois romieu4da19632011-01-03 15:07:55 +00003228static void rtl8168bef_hw_phy_config(struct rtl8169_private *tp)
Francois Romieu236b8082008-05-30 16:11:48 +02003229{
Alexey Dobriyan350f7592009-11-25 15:54:21 -08003230 static const struct phy_reg phy_reg_init[] = {
Francois Romieu236b8082008-05-30 16:11:48 +02003231 { 0x1f, 0x0001 },
3232 { 0x10, 0xf41b },
3233 { 0x1f, 0x0000 }
3234 };
3235
françois romieu4da19632011-01-03 15:07:55 +00003236 rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
Francois Romieu236b8082008-05-30 16:11:48 +02003237}
3238
françois romieu4da19632011-01-03 15:07:55 +00003239static void rtl8168cp_1_hw_phy_config(struct rtl8169_private *tp)
Francois Romieu867763c2007-08-17 18:21:58 +02003240{
Alexey Dobriyan350f7592009-11-25 15:54:21 -08003241 static const struct phy_reg phy_reg_init[] = {
Francois Romieu867763c2007-08-17 18:21:58 +02003242 { 0x1f, 0x0000 },
3243 { 0x1d, 0x0f00 },
3244 { 0x1f, 0x0002 },
3245 { 0x0c, 0x1ec8 },
3246 { 0x1f, 0x0000 }
3247 };
3248
françois romieu4da19632011-01-03 15:07:55 +00003249 rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
Francois Romieu867763c2007-08-17 18:21:58 +02003250}
3251
françois romieu4da19632011-01-03 15:07:55 +00003252static void rtl8168cp_2_hw_phy_config(struct rtl8169_private *tp)
Francois Romieuef3386f2008-06-29 12:24:30 +02003253{
Alexey Dobriyan350f7592009-11-25 15:54:21 -08003254 static const struct phy_reg phy_reg_init[] = {
Francois Romieuef3386f2008-06-29 12:24:30 +02003255 { 0x1f, 0x0001 },
3256 { 0x1d, 0x3d98 },
3257 { 0x1f, 0x0000 }
3258 };
3259
françois romieu4da19632011-01-03 15:07:55 +00003260 rtl_writephy(tp, 0x1f, 0x0000);
3261 rtl_patchphy(tp, 0x14, 1 << 5);
3262 rtl_patchphy(tp, 0x0d, 1 << 5);
Francois Romieuef3386f2008-06-29 12:24:30 +02003263
françois romieu4da19632011-01-03 15:07:55 +00003264 rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
Francois Romieuef3386f2008-06-29 12:24:30 +02003265}
3266
françois romieu4da19632011-01-03 15:07:55 +00003267static void rtl8168c_1_hw_phy_config(struct rtl8169_private *tp)
Francois Romieu867763c2007-08-17 18:21:58 +02003268{
Alexey Dobriyan350f7592009-11-25 15:54:21 -08003269 static const struct phy_reg phy_reg_init[] = {
Francois Romieua3f80672007-10-18 14:35:11 +02003270 { 0x1f, 0x0001 },
3271 { 0x12, 0x2300 },
Francois Romieu867763c2007-08-17 18:21:58 +02003272 { 0x1f, 0x0002 },
3273 { 0x00, 0x88d4 },
3274 { 0x01, 0x82b1 },
3275 { 0x03, 0x7002 },
3276 { 0x08, 0x9e30 },
3277 { 0x09, 0x01f0 },
3278 { 0x0a, 0x5500 },
3279 { 0x0c, 0x00c8 },
3280 { 0x1f, 0x0003 },
3281 { 0x12, 0xc096 },
3282 { 0x16, 0x000a },
Francois Romieuf50d4272008-05-30 16:07:07 +02003283 { 0x1f, 0x0000 },
3284 { 0x1f, 0x0000 },
3285 { 0x09, 0x2000 },
3286 { 0x09, 0x0000 }
Francois Romieu867763c2007-08-17 18:21:58 +02003287 };
3288
françois romieu4da19632011-01-03 15:07:55 +00003289 rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
Francois Romieuf50d4272008-05-30 16:07:07 +02003290
françois romieu4da19632011-01-03 15:07:55 +00003291 rtl_patchphy(tp, 0x14, 1 << 5);
3292 rtl_patchphy(tp, 0x0d, 1 << 5);
3293 rtl_writephy(tp, 0x1f, 0x0000);
Francois Romieu867763c2007-08-17 18:21:58 +02003294}
3295
françois romieu4da19632011-01-03 15:07:55 +00003296static void rtl8168c_2_hw_phy_config(struct rtl8169_private *tp)
Francois Romieu7da97ec2007-10-18 15:20:43 +02003297{
Alexey Dobriyan350f7592009-11-25 15:54:21 -08003298 static const struct phy_reg phy_reg_init[] = {
Francois Romieuf50d4272008-05-30 16:07:07 +02003299 { 0x1f, 0x0001 },
Francois Romieu7da97ec2007-10-18 15:20:43 +02003300 { 0x12, 0x2300 },
Francois Romieuf50d4272008-05-30 16:07:07 +02003301 { 0x03, 0x802f },
3302 { 0x02, 0x4f02 },
3303 { 0x01, 0x0409 },
3304 { 0x00, 0xf099 },
3305 { 0x04, 0x9800 },
3306 { 0x04, 0x9000 },
3307 { 0x1d, 0x3d98 },
Francois Romieu7da97ec2007-10-18 15:20:43 +02003308 { 0x1f, 0x0002 },
3309 { 0x0c, 0x7eb8 },
Francois Romieuf50d4272008-05-30 16:07:07 +02003310 { 0x06, 0x0761 },
3311 { 0x1f, 0x0003 },
3312 { 0x16, 0x0f0a },
Francois Romieu7da97ec2007-10-18 15:20:43 +02003313 { 0x1f, 0x0000 }
3314 };
3315
françois romieu4da19632011-01-03 15:07:55 +00003316 rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
Francois Romieuf50d4272008-05-30 16:07:07 +02003317
françois romieu4da19632011-01-03 15:07:55 +00003318 rtl_patchphy(tp, 0x16, 1 << 0);
3319 rtl_patchphy(tp, 0x14, 1 << 5);
3320 rtl_patchphy(tp, 0x0d, 1 << 5);
3321 rtl_writephy(tp, 0x1f, 0x0000);
Francois Romieu7da97ec2007-10-18 15:20:43 +02003322}
3323
françois romieu4da19632011-01-03 15:07:55 +00003324static void rtl8168c_3_hw_phy_config(struct rtl8169_private *tp)
Francois Romieu197ff762008-06-28 13:16:02 +02003325{
Alexey Dobriyan350f7592009-11-25 15:54:21 -08003326 static const struct phy_reg phy_reg_init[] = {
Francois Romieu197ff762008-06-28 13:16:02 +02003327 { 0x1f, 0x0001 },
3328 { 0x12, 0x2300 },
3329 { 0x1d, 0x3d98 },
3330 { 0x1f, 0x0002 },
3331 { 0x0c, 0x7eb8 },
3332 { 0x06, 0x5461 },
3333 { 0x1f, 0x0003 },
3334 { 0x16, 0x0f0a },
3335 { 0x1f, 0x0000 }
3336 };
3337
françois romieu4da19632011-01-03 15:07:55 +00003338 rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
Francois Romieu197ff762008-06-28 13:16:02 +02003339
françois romieu4da19632011-01-03 15:07:55 +00003340 rtl_patchphy(tp, 0x16, 1 << 0);
3341 rtl_patchphy(tp, 0x14, 1 << 5);
3342 rtl_patchphy(tp, 0x0d, 1 << 5);
3343 rtl_writephy(tp, 0x1f, 0x0000);
Francois Romieu197ff762008-06-28 13:16:02 +02003344}
3345
françois romieu4da19632011-01-03 15:07:55 +00003346static void rtl8168c_4_hw_phy_config(struct rtl8169_private *tp)
Francois Romieu6fb07052008-06-29 11:54:28 +02003347{
françois romieu4da19632011-01-03 15:07:55 +00003348 rtl8168c_3_hw_phy_config(tp);
Francois Romieu6fb07052008-06-29 11:54:28 +02003349}
3350
françois romieubca03d52011-01-03 15:07:31 +00003351static void rtl8168d_1_hw_phy_config(struct rtl8169_private *tp)
Francois Romieu5b538df2008-07-20 16:22:45 +02003352{
Alexey Dobriyan350f7592009-11-25 15:54:21 -08003353 static const struct phy_reg phy_reg_init_0[] = {
françois romieubca03d52011-01-03 15:07:31 +00003354 /* Channel Estimation */
Francois Romieu5b538df2008-07-20 16:22:45 +02003355 { 0x1f, 0x0001 },
françois romieudaf9df62009-10-07 12:44:20 +00003356 { 0x06, 0x4064 },
3357 { 0x07, 0x2863 },
3358 { 0x08, 0x059c },
3359 { 0x09, 0x26b4 },
3360 { 0x0a, 0x6a19 },
3361 { 0x0b, 0xdcc8 },
3362 { 0x10, 0xf06d },
3363 { 0x14, 0x7f68 },
3364 { 0x18, 0x7fd9 },
3365 { 0x1c, 0xf0ff },
3366 { 0x1d, 0x3d9c },
Francois Romieu5b538df2008-07-20 16:22:45 +02003367 { 0x1f, 0x0003 },
françois romieudaf9df62009-10-07 12:44:20 +00003368 { 0x12, 0xf49f },
3369 { 0x13, 0x070b },
3370 { 0x1a, 0x05ad },
françois romieubca03d52011-01-03 15:07:31 +00003371 { 0x14, 0x94c0 },
3372
3373 /*
3374 * Tx Error Issue
Francois Romieucecb5fd2011-04-01 10:21:07 +02003375 * Enhance line driver power
françois romieubca03d52011-01-03 15:07:31 +00003376 */
Francois Romieu5b538df2008-07-20 16:22:45 +02003377 { 0x1f, 0x0002 },
françois romieudaf9df62009-10-07 12:44:20 +00003378 { 0x06, 0x5561 },
Francois Romieu5b538df2008-07-20 16:22:45 +02003379 { 0x1f, 0x0005 },
françois romieudaf9df62009-10-07 12:44:20 +00003380 { 0x05, 0x8332 },
françois romieubca03d52011-01-03 15:07:31 +00003381 { 0x06, 0x5561 },
3382
3383 /*
3384 * Can not link to 1Gbps with bad cable
3385 * Decrease SNR threshold form 21.07dB to 19.04dB
3386 */
3387 { 0x1f, 0x0001 },
3388 { 0x17, 0x0cc0 },
françois romieudaf9df62009-10-07 12:44:20 +00003389
3390 { 0x1f, 0x0000 },
françois romieubca03d52011-01-03 15:07:31 +00003391 { 0x0d, 0xf880 }
Francois Romieu5b538df2008-07-20 16:22:45 +02003392 };
3393
françois romieu4da19632011-01-03 15:07:55 +00003394 rtl_writephy_batch(tp, phy_reg_init_0, ARRAY_SIZE(phy_reg_init_0));
Francois Romieu5b538df2008-07-20 16:22:45 +02003395
françois romieubca03d52011-01-03 15:07:31 +00003396 /*
3397 * Rx Error Issue
3398 * Fine Tune Switching regulator parameter
3399 */
françois romieu4da19632011-01-03 15:07:55 +00003400 rtl_writephy(tp, 0x1f, 0x0002);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003401 rtl_w0w1_phy(tp, 0x0b, 0x0010, 0x00ef);
3402 rtl_w0w1_phy(tp, 0x0c, 0xa200, 0x5d00);
françois romieudaf9df62009-10-07 12:44:20 +00003403
Francois Romieufdf6fc02012-07-06 22:40:38 +02003404 if (rtl8168d_efuse_read(tp, 0x01) == 0xb1) {
Alexey Dobriyan350f7592009-11-25 15:54:21 -08003405 static const struct phy_reg phy_reg_init[] = {
françois romieudaf9df62009-10-07 12:44:20 +00003406 { 0x1f, 0x0002 },
3407 { 0x05, 0x669a },
Francois Romieu5b538df2008-07-20 16:22:45 +02003408 { 0x1f, 0x0005 },
françois romieudaf9df62009-10-07 12:44:20 +00003409 { 0x05, 0x8330 },
3410 { 0x06, 0x669a },
3411 { 0x1f, 0x0002 }
3412 };
3413 int val;
3414
françois romieu4da19632011-01-03 15:07:55 +00003415 rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
françois romieudaf9df62009-10-07 12:44:20 +00003416
françois romieu4da19632011-01-03 15:07:55 +00003417 val = rtl_readphy(tp, 0x0d);
françois romieudaf9df62009-10-07 12:44:20 +00003418
3419 if ((val & 0x00ff) != 0x006c) {
Alexey Dobriyan350f7592009-11-25 15:54:21 -08003420 static const u32 set[] = {
françois romieudaf9df62009-10-07 12:44:20 +00003421 0x0065, 0x0066, 0x0067, 0x0068,
3422 0x0069, 0x006a, 0x006b, 0x006c
3423 };
3424 int i;
3425
françois romieu4da19632011-01-03 15:07:55 +00003426 rtl_writephy(tp, 0x1f, 0x0002);
françois romieudaf9df62009-10-07 12:44:20 +00003427
3428 val &= 0xff00;
3429 for (i = 0; i < ARRAY_SIZE(set); i++)
françois romieu4da19632011-01-03 15:07:55 +00003430 rtl_writephy(tp, 0x0d, val | set[i]);
françois romieudaf9df62009-10-07 12:44:20 +00003431 }
3432 } else {
Alexey Dobriyan350f7592009-11-25 15:54:21 -08003433 static const struct phy_reg phy_reg_init[] = {
françois romieudaf9df62009-10-07 12:44:20 +00003434 { 0x1f, 0x0002 },
3435 { 0x05, 0x6662 },
Francois Romieu5b538df2008-07-20 16:22:45 +02003436 { 0x1f, 0x0005 },
françois romieudaf9df62009-10-07 12:44:20 +00003437 { 0x05, 0x8330 },
3438 { 0x06, 0x6662 }
Francois Romieu5b538df2008-07-20 16:22:45 +02003439 };
3440
françois romieu4da19632011-01-03 15:07:55 +00003441 rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
Francois Romieu5b538df2008-07-20 16:22:45 +02003442 }
3443
françois romieubca03d52011-01-03 15:07:31 +00003444 /* RSET couple improve */
françois romieu4da19632011-01-03 15:07:55 +00003445 rtl_writephy(tp, 0x1f, 0x0002);
3446 rtl_patchphy(tp, 0x0d, 0x0300);
3447 rtl_patchphy(tp, 0x0f, 0x0010);
françois romieudaf9df62009-10-07 12:44:20 +00003448
françois romieubca03d52011-01-03 15:07:31 +00003449 /* Fine tune PLL performance */
françois romieu4da19632011-01-03 15:07:55 +00003450 rtl_writephy(tp, 0x1f, 0x0002);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003451 rtl_w0w1_phy(tp, 0x02, 0x0100, 0x0600);
3452 rtl_w0w1_phy(tp, 0x03, 0x0000, 0xe000);
françois romieudaf9df62009-10-07 12:44:20 +00003453
françois romieu4da19632011-01-03 15:07:55 +00003454 rtl_writephy(tp, 0x1f, 0x0005);
3455 rtl_writephy(tp, 0x05, 0x001b);
François Romieu953a12c2011-04-24 17:38:48 +02003456
3457 rtl_apply_firmware_cond(tp, MII_EXPANSION, 0xbf00);
françois romieubca03d52011-01-03 15:07:31 +00003458
françois romieu4da19632011-01-03 15:07:55 +00003459 rtl_writephy(tp, 0x1f, 0x0000);
françois romieudaf9df62009-10-07 12:44:20 +00003460}
3461
françois romieubca03d52011-01-03 15:07:31 +00003462static void rtl8168d_2_hw_phy_config(struct rtl8169_private *tp)
françois romieudaf9df62009-10-07 12:44:20 +00003463{
Alexey Dobriyan350f7592009-11-25 15:54:21 -08003464 static const struct phy_reg phy_reg_init_0[] = {
françois romieubca03d52011-01-03 15:07:31 +00003465 /* Channel Estimation */
françois romieudaf9df62009-10-07 12:44:20 +00003466 { 0x1f, 0x0001 },
3467 { 0x06, 0x4064 },
3468 { 0x07, 0x2863 },
3469 { 0x08, 0x059c },
3470 { 0x09, 0x26b4 },
3471 { 0x0a, 0x6a19 },
3472 { 0x0b, 0xdcc8 },
3473 { 0x10, 0xf06d },
3474 { 0x14, 0x7f68 },
3475 { 0x18, 0x7fd9 },
3476 { 0x1c, 0xf0ff },
3477 { 0x1d, 0x3d9c },
3478 { 0x1f, 0x0003 },
3479 { 0x12, 0xf49f },
3480 { 0x13, 0x070b },
3481 { 0x1a, 0x05ad },
3482 { 0x14, 0x94c0 },
3483
françois romieubca03d52011-01-03 15:07:31 +00003484 /*
3485 * Tx Error Issue
Francois Romieucecb5fd2011-04-01 10:21:07 +02003486 * Enhance line driver power
françois romieubca03d52011-01-03 15:07:31 +00003487 */
françois romieudaf9df62009-10-07 12:44:20 +00003488 { 0x1f, 0x0002 },
3489 { 0x06, 0x5561 },
3490 { 0x1f, 0x0005 },
3491 { 0x05, 0x8332 },
françois romieubca03d52011-01-03 15:07:31 +00003492 { 0x06, 0x5561 },
3493
3494 /*
3495 * Can not link to 1Gbps with bad cable
3496 * Decrease SNR threshold form 21.07dB to 19.04dB
3497 */
3498 { 0x1f, 0x0001 },
3499 { 0x17, 0x0cc0 },
françois romieudaf9df62009-10-07 12:44:20 +00003500
3501 { 0x1f, 0x0000 },
françois romieubca03d52011-01-03 15:07:31 +00003502 { 0x0d, 0xf880 }
françois romieudaf9df62009-10-07 12:44:20 +00003503 };
3504
françois romieu4da19632011-01-03 15:07:55 +00003505 rtl_writephy_batch(tp, phy_reg_init_0, ARRAY_SIZE(phy_reg_init_0));
françois romieudaf9df62009-10-07 12:44:20 +00003506
Francois Romieufdf6fc02012-07-06 22:40:38 +02003507 if (rtl8168d_efuse_read(tp, 0x01) == 0xb1) {
Alexey Dobriyan350f7592009-11-25 15:54:21 -08003508 static const struct phy_reg phy_reg_init[] = {
françois romieudaf9df62009-10-07 12:44:20 +00003509 { 0x1f, 0x0002 },
3510 { 0x05, 0x669a },
3511 { 0x1f, 0x0005 },
3512 { 0x05, 0x8330 },
3513 { 0x06, 0x669a },
3514
3515 { 0x1f, 0x0002 }
3516 };
3517 int val;
3518
françois romieu4da19632011-01-03 15:07:55 +00003519 rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
françois romieudaf9df62009-10-07 12:44:20 +00003520
françois romieu4da19632011-01-03 15:07:55 +00003521 val = rtl_readphy(tp, 0x0d);
françois romieudaf9df62009-10-07 12:44:20 +00003522 if ((val & 0x00ff) != 0x006c) {
Joe Perchesb6bc7652010-12-21 02:16:08 -08003523 static const u32 set[] = {
françois romieudaf9df62009-10-07 12:44:20 +00003524 0x0065, 0x0066, 0x0067, 0x0068,
3525 0x0069, 0x006a, 0x006b, 0x006c
3526 };
3527 int i;
3528
françois romieu4da19632011-01-03 15:07:55 +00003529 rtl_writephy(tp, 0x1f, 0x0002);
françois romieudaf9df62009-10-07 12:44:20 +00003530
3531 val &= 0xff00;
3532 for (i = 0; i < ARRAY_SIZE(set); i++)
françois romieu4da19632011-01-03 15:07:55 +00003533 rtl_writephy(tp, 0x0d, val | set[i]);
françois romieudaf9df62009-10-07 12:44:20 +00003534 }
3535 } else {
Alexey Dobriyan350f7592009-11-25 15:54:21 -08003536 static const struct phy_reg phy_reg_init[] = {
françois romieudaf9df62009-10-07 12:44:20 +00003537 { 0x1f, 0x0002 },
3538 { 0x05, 0x2642 },
3539 { 0x1f, 0x0005 },
3540 { 0x05, 0x8330 },
3541 { 0x06, 0x2642 }
3542 };
3543
françois romieu4da19632011-01-03 15:07:55 +00003544 rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
françois romieudaf9df62009-10-07 12:44:20 +00003545 }
3546
françois romieubca03d52011-01-03 15:07:31 +00003547 /* Fine tune PLL performance */
françois romieu4da19632011-01-03 15:07:55 +00003548 rtl_writephy(tp, 0x1f, 0x0002);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003549 rtl_w0w1_phy(tp, 0x02, 0x0100, 0x0600);
3550 rtl_w0w1_phy(tp, 0x03, 0x0000, 0xe000);
françois romieudaf9df62009-10-07 12:44:20 +00003551
françois romieubca03d52011-01-03 15:07:31 +00003552 /* Switching regulator Slew rate */
françois romieu4da19632011-01-03 15:07:55 +00003553 rtl_writephy(tp, 0x1f, 0x0002);
3554 rtl_patchphy(tp, 0x0f, 0x0017);
françois romieudaf9df62009-10-07 12:44:20 +00003555
françois romieu4da19632011-01-03 15:07:55 +00003556 rtl_writephy(tp, 0x1f, 0x0005);
3557 rtl_writephy(tp, 0x05, 0x001b);
François Romieu953a12c2011-04-24 17:38:48 +02003558
3559 rtl_apply_firmware_cond(tp, MII_EXPANSION, 0xb300);
françois romieubca03d52011-01-03 15:07:31 +00003560
françois romieu4da19632011-01-03 15:07:55 +00003561 rtl_writephy(tp, 0x1f, 0x0000);
françois romieudaf9df62009-10-07 12:44:20 +00003562}
3563
françois romieu4da19632011-01-03 15:07:55 +00003564static void rtl8168d_3_hw_phy_config(struct rtl8169_private *tp)
françois romieudaf9df62009-10-07 12:44:20 +00003565{
Alexey Dobriyan350f7592009-11-25 15:54:21 -08003566 static const struct phy_reg phy_reg_init[] = {
françois romieudaf9df62009-10-07 12:44:20 +00003567 { 0x1f, 0x0002 },
3568 { 0x10, 0x0008 },
3569 { 0x0d, 0x006c },
3570
3571 { 0x1f, 0x0000 },
3572 { 0x0d, 0xf880 },
3573
3574 { 0x1f, 0x0001 },
3575 { 0x17, 0x0cc0 },
3576
3577 { 0x1f, 0x0001 },
3578 { 0x0b, 0xa4d8 },
3579 { 0x09, 0x281c },
3580 { 0x07, 0x2883 },
3581 { 0x0a, 0x6b35 },
3582 { 0x1d, 0x3da4 },
3583 { 0x1c, 0xeffd },
3584 { 0x14, 0x7f52 },
3585 { 0x18, 0x7fc6 },
3586 { 0x08, 0x0601 },
3587 { 0x06, 0x4063 },
3588 { 0x10, 0xf074 },
3589 { 0x1f, 0x0003 },
3590 { 0x13, 0x0789 },
3591 { 0x12, 0xf4bd },
3592 { 0x1a, 0x04fd },
3593 { 0x14, 0x84b0 },
3594 { 0x1f, 0x0000 },
3595 { 0x00, 0x9200 },
3596
3597 { 0x1f, 0x0005 },
3598 { 0x01, 0x0340 },
3599 { 0x1f, 0x0001 },
3600 { 0x04, 0x4000 },
3601 { 0x03, 0x1d21 },
3602 { 0x02, 0x0c32 },
3603 { 0x01, 0x0200 },
3604 { 0x00, 0x5554 },
3605 { 0x04, 0x4800 },
3606 { 0x04, 0x4000 },
3607 { 0x04, 0xf000 },
3608 { 0x03, 0xdf01 },
3609 { 0x02, 0xdf20 },
3610 { 0x01, 0x101a },
3611 { 0x00, 0xa0ff },
3612 { 0x04, 0xf800 },
3613 { 0x04, 0xf000 },
3614 { 0x1f, 0x0000 },
3615
3616 { 0x1f, 0x0007 },
3617 { 0x1e, 0x0023 },
3618 { 0x16, 0x0000 },
3619 { 0x1f, 0x0000 }
3620 };
3621
françois romieu4da19632011-01-03 15:07:55 +00003622 rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
Francois Romieu5b538df2008-07-20 16:22:45 +02003623}
3624
françois romieue6de30d2011-01-03 15:08:37 +00003625static void rtl8168d_4_hw_phy_config(struct rtl8169_private *tp)
3626{
3627 static const struct phy_reg phy_reg_init[] = {
3628 { 0x1f, 0x0001 },
3629 { 0x17, 0x0cc0 },
3630
3631 { 0x1f, 0x0007 },
3632 { 0x1e, 0x002d },
3633 { 0x18, 0x0040 },
3634 { 0x1f, 0x0000 }
3635 };
3636
3637 rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
3638 rtl_patchphy(tp, 0x0d, 1 << 5);
3639}
3640
Hayes Wang70090422011-07-06 15:58:06 +08003641static void rtl8168e_1_hw_phy_config(struct rtl8169_private *tp)
hayeswang01dc7fe2011-03-21 01:50:28 +00003642{
3643 static const struct phy_reg phy_reg_init[] = {
3644 /* Enable Delay cap */
3645 { 0x1f, 0x0005 },
3646 { 0x05, 0x8b80 },
3647 { 0x06, 0xc896 },
3648 { 0x1f, 0x0000 },
3649
3650 /* Channel estimation fine tune */
3651 { 0x1f, 0x0001 },
3652 { 0x0b, 0x6c20 },
3653 { 0x07, 0x2872 },
3654 { 0x1c, 0xefff },
3655 { 0x1f, 0x0003 },
3656 { 0x14, 0x6420 },
3657 { 0x1f, 0x0000 },
3658
3659 /* Update PFM & 10M TX idle timer */
3660 { 0x1f, 0x0007 },
3661 { 0x1e, 0x002f },
3662 { 0x15, 0x1919 },
3663 { 0x1f, 0x0000 },
3664
3665 { 0x1f, 0x0007 },
3666 { 0x1e, 0x00ac },
3667 { 0x18, 0x0006 },
3668 { 0x1f, 0x0000 }
3669 };
3670
Francois Romieu15ecd032011-04-27 13:52:22 -07003671 rtl_apply_firmware(tp);
3672
hayeswang01dc7fe2011-03-21 01:50:28 +00003673 rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
3674
3675 /* DCO enable for 10M IDLE Power */
3676 rtl_writephy(tp, 0x1f, 0x0007);
3677 rtl_writephy(tp, 0x1e, 0x0023);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003678 rtl_w0w1_phy(tp, 0x17, 0x0006, 0x0000);
hayeswang01dc7fe2011-03-21 01:50:28 +00003679 rtl_writephy(tp, 0x1f, 0x0000);
3680
3681 /* For impedance matching */
3682 rtl_writephy(tp, 0x1f, 0x0002);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003683 rtl_w0w1_phy(tp, 0x08, 0x8000, 0x7f00);
Francois Romieucecb5fd2011-04-01 10:21:07 +02003684 rtl_writephy(tp, 0x1f, 0x0000);
hayeswang01dc7fe2011-03-21 01:50:28 +00003685
3686 /* PHY auto speed down */
3687 rtl_writephy(tp, 0x1f, 0x0007);
3688 rtl_writephy(tp, 0x1e, 0x002d);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003689 rtl_w0w1_phy(tp, 0x18, 0x0050, 0x0000);
hayeswang01dc7fe2011-03-21 01:50:28 +00003690 rtl_writephy(tp, 0x1f, 0x0000);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003691 rtl_w0w1_phy(tp, 0x14, 0x8000, 0x0000);
hayeswang01dc7fe2011-03-21 01:50:28 +00003692
3693 rtl_writephy(tp, 0x1f, 0x0005);
3694 rtl_writephy(tp, 0x05, 0x8b86);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003695 rtl_w0w1_phy(tp, 0x06, 0x0001, 0x0000);
hayeswang01dc7fe2011-03-21 01:50:28 +00003696 rtl_writephy(tp, 0x1f, 0x0000);
3697
3698 rtl_writephy(tp, 0x1f, 0x0005);
3699 rtl_writephy(tp, 0x05, 0x8b85);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003700 rtl_w0w1_phy(tp, 0x06, 0x0000, 0x2000);
hayeswang01dc7fe2011-03-21 01:50:28 +00003701 rtl_writephy(tp, 0x1f, 0x0007);
3702 rtl_writephy(tp, 0x1e, 0x0020);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003703 rtl_w0w1_phy(tp, 0x15, 0x0000, 0x1100);
hayeswang01dc7fe2011-03-21 01:50:28 +00003704 rtl_writephy(tp, 0x1f, 0x0006);
3705 rtl_writephy(tp, 0x00, 0x5a00);
3706 rtl_writephy(tp, 0x1f, 0x0000);
3707 rtl_writephy(tp, 0x0d, 0x0007);
3708 rtl_writephy(tp, 0x0e, 0x003c);
3709 rtl_writephy(tp, 0x0d, 0x4007);
3710 rtl_writephy(tp, 0x0e, 0x0000);
3711 rtl_writephy(tp, 0x0d, 0x0000);
3712}
3713
françois romieu9ecb9aa2012-12-07 11:20:21 +00003714static void rtl_rar_exgmac_set(struct rtl8169_private *tp, u8 *addr)
3715{
3716 const u16 w[] = {
3717 addr[0] | (addr[1] << 8),
3718 addr[2] | (addr[3] << 8),
3719 addr[4] | (addr[5] << 8)
3720 };
3721 const struct exgmac_reg e[] = {
3722 { .addr = 0xe0, ERIAR_MASK_1111, .val = w[0] | (w[1] << 16) },
3723 { .addr = 0xe4, ERIAR_MASK_1111, .val = w[2] },
3724 { .addr = 0xf0, ERIAR_MASK_1111, .val = w[0] << 16 },
3725 { .addr = 0xf4, ERIAR_MASK_1111, .val = w[1] | (w[2] << 16) }
3726 };
3727
3728 rtl_write_exgmac_batch(tp, e, ARRAY_SIZE(e));
3729}
3730
Hayes Wang70090422011-07-06 15:58:06 +08003731static void rtl8168e_2_hw_phy_config(struct rtl8169_private *tp)
3732{
3733 static const struct phy_reg phy_reg_init[] = {
3734 /* Enable Delay cap */
3735 { 0x1f, 0x0004 },
3736 { 0x1f, 0x0007 },
3737 { 0x1e, 0x00ac },
3738 { 0x18, 0x0006 },
3739 { 0x1f, 0x0002 },
3740 { 0x1f, 0x0000 },
3741 { 0x1f, 0x0000 },
3742
3743 /* Channel estimation fine tune */
3744 { 0x1f, 0x0003 },
3745 { 0x09, 0xa20f },
3746 { 0x1f, 0x0000 },
3747 { 0x1f, 0x0000 },
3748
3749 /* Green Setting */
3750 { 0x1f, 0x0005 },
3751 { 0x05, 0x8b5b },
3752 { 0x06, 0x9222 },
3753 { 0x05, 0x8b6d },
3754 { 0x06, 0x8000 },
3755 { 0x05, 0x8b76 },
3756 { 0x06, 0x8000 },
3757 { 0x1f, 0x0000 }
3758 };
3759
3760 rtl_apply_firmware(tp);
3761
3762 rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
3763
3764 /* For 4-corner performance improve */
3765 rtl_writephy(tp, 0x1f, 0x0005);
3766 rtl_writephy(tp, 0x05, 0x8b80);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003767 rtl_w0w1_phy(tp, 0x17, 0x0006, 0x0000);
Hayes Wang70090422011-07-06 15:58:06 +08003768 rtl_writephy(tp, 0x1f, 0x0000);
3769
3770 /* PHY auto speed down */
3771 rtl_writephy(tp, 0x1f, 0x0004);
3772 rtl_writephy(tp, 0x1f, 0x0007);
3773 rtl_writephy(tp, 0x1e, 0x002d);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003774 rtl_w0w1_phy(tp, 0x18, 0x0010, 0x0000);
Hayes Wang70090422011-07-06 15:58:06 +08003775 rtl_writephy(tp, 0x1f, 0x0002);
3776 rtl_writephy(tp, 0x1f, 0x0000);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003777 rtl_w0w1_phy(tp, 0x14, 0x8000, 0x0000);
Hayes Wang70090422011-07-06 15:58:06 +08003778
3779 /* improve 10M EEE waveform */
3780 rtl_writephy(tp, 0x1f, 0x0005);
3781 rtl_writephy(tp, 0x05, 0x8b86);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003782 rtl_w0w1_phy(tp, 0x06, 0x0001, 0x0000);
Hayes Wang70090422011-07-06 15:58:06 +08003783 rtl_writephy(tp, 0x1f, 0x0000);
3784
3785 /* Improve 2-pair detection performance */
3786 rtl_writephy(tp, 0x1f, 0x0005);
3787 rtl_writephy(tp, 0x05, 0x8b85);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003788 rtl_w0w1_phy(tp, 0x06, 0x4000, 0x0000);
Hayes Wang70090422011-07-06 15:58:06 +08003789 rtl_writephy(tp, 0x1f, 0x0000);
3790
3791 /* EEE setting */
Heiner Kallweit1814d6a2017-11-19 11:09:58 +01003792 rtl_w0w1_eri(tp, 0x1b0, ERIAR_MASK_1111, 0x0003, 0x0000, ERIAR_EXGMAC);
Hayes Wang70090422011-07-06 15:58:06 +08003793 rtl_writephy(tp, 0x1f, 0x0005);
3794 rtl_writephy(tp, 0x05, 0x8b85);
Heiner Kallweit1814d6a2017-11-19 11:09:58 +01003795 rtl_w0w1_phy(tp, 0x06, 0x2000, 0x0000);
Hayes Wang70090422011-07-06 15:58:06 +08003796 rtl_writephy(tp, 0x1f, 0x0004);
3797 rtl_writephy(tp, 0x1f, 0x0007);
3798 rtl_writephy(tp, 0x1e, 0x0020);
Heiner Kallweit1814d6a2017-11-19 11:09:58 +01003799 rtl_w0w1_phy(tp, 0x15, 0x0100, 0x0000);
Hayes Wang70090422011-07-06 15:58:06 +08003800 rtl_writephy(tp, 0x1f, 0x0002);
3801 rtl_writephy(tp, 0x1f, 0x0000);
3802 rtl_writephy(tp, 0x0d, 0x0007);
3803 rtl_writephy(tp, 0x0e, 0x003c);
3804 rtl_writephy(tp, 0x0d, 0x4007);
Heiner Kallweit1814d6a2017-11-19 11:09:58 +01003805 rtl_writephy(tp, 0x0e, 0x0006);
Hayes Wang70090422011-07-06 15:58:06 +08003806 rtl_writephy(tp, 0x0d, 0x0000);
3807
3808 /* Green feature */
3809 rtl_writephy(tp, 0x1f, 0x0003);
Heiner Kallweit1814d6a2017-11-19 11:09:58 +01003810 rtl_w0w1_phy(tp, 0x19, 0x0001, 0x0000);
3811 rtl_w0w1_phy(tp, 0x10, 0x0400, 0x0000);
Hayes Wang70090422011-07-06 15:58:06 +08003812 rtl_writephy(tp, 0x1f, 0x0000);
hayeswange0c07552012-10-23 20:24:03 +00003813
françois romieu9ecb9aa2012-12-07 11:20:21 +00003814 /* Broken BIOS workaround: feed GigaMAC registers with MAC address. */
3815 rtl_rar_exgmac_set(tp, tp->dev->dev_addr);
Hayes Wang70090422011-07-06 15:58:06 +08003816}
3817
Hayes Wang5f886e02012-03-30 14:33:03 +08003818static void rtl8168f_hw_phy_config(struct rtl8169_private *tp)
3819{
3820 /* For 4-corner performance improve */
3821 rtl_writephy(tp, 0x1f, 0x0005);
3822 rtl_writephy(tp, 0x05, 0x8b80);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003823 rtl_w0w1_phy(tp, 0x06, 0x0006, 0x0000);
Hayes Wang5f886e02012-03-30 14:33:03 +08003824 rtl_writephy(tp, 0x1f, 0x0000);
3825
3826 /* PHY auto speed down */
3827 rtl_writephy(tp, 0x1f, 0x0007);
3828 rtl_writephy(tp, 0x1e, 0x002d);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003829 rtl_w0w1_phy(tp, 0x18, 0x0010, 0x0000);
Hayes Wang5f886e02012-03-30 14:33:03 +08003830 rtl_writephy(tp, 0x1f, 0x0000);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003831 rtl_w0w1_phy(tp, 0x14, 0x8000, 0x0000);
Hayes Wang5f886e02012-03-30 14:33:03 +08003832
3833 /* Improve 10M EEE waveform */
3834 rtl_writephy(tp, 0x1f, 0x0005);
3835 rtl_writephy(tp, 0x05, 0x8b86);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003836 rtl_w0w1_phy(tp, 0x06, 0x0001, 0x0000);
Hayes Wang5f886e02012-03-30 14:33:03 +08003837 rtl_writephy(tp, 0x1f, 0x0000);
3838}
3839
Hayes Wangc2218922011-09-06 16:55:18 +08003840static void rtl8168f_1_hw_phy_config(struct rtl8169_private *tp)
3841{
3842 static const struct phy_reg phy_reg_init[] = {
3843 /* Channel estimation fine tune */
3844 { 0x1f, 0x0003 },
3845 { 0x09, 0xa20f },
3846 { 0x1f, 0x0000 },
3847
3848 /* Modify green table for giga & fnet */
3849 { 0x1f, 0x0005 },
3850 { 0x05, 0x8b55 },
3851 { 0x06, 0x0000 },
3852 { 0x05, 0x8b5e },
3853 { 0x06, 0x0000 },
3854 { 0x05, 0x8b67 },
3855 { 0x06, 0x0000 },
3856 { 0x05, 0x8b70 },
3857 { 0x06, 0x0000 },
3858 { 0x1f, 0x0000 },
3859 { 0x1f, 0x0007 },
3860 { 0x1e, 0x0078 },
3861 { 0x17, 0x0000 },
3862 { 0x19, 0x00fb },
3863 { 0x1f, 0x0000 },
3864
3865 /* Modify green table for 10M */
3866 { 0x1f, 0x0005 },
3867 { 0x05, 0x8b79 },
3868 { 0x06, 0xaa00 },
3869 { 0x1f, 0x0000 },
3870
3871 /* Disable hiimpedance detection (RTCT) */
3872 { 0x1f, 0x0003 },
3873 { 0x01, 0x328a },
3874 { 0x1f, 0x0000 }
3875 };
3876
3877 rtl_apply_firmware(tp);
3878
3879 rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
3880
Hayes Wang5f886e02012-03-30 14:33:03 +08003881 rtl8168f_hw_phy_config(tp);
Hayes Wangc2218922011-09-06 16:55:18 +08003882
3883 /* Improve 2-pair detection performance */
3884 rtl_writephy(tp, 0x1f, 0x0005);
3885 rtl_writephy(tp, 0x05, 0x8b85);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003886 rtl_w0w1_phy(tp, 0x06, 0x4000, 0x0000);
Hayes Wangc2218922011-09-06 16:55:18 +08003887 rtl_writephy(tp, 0x1f, 0x0000);
3888}
3889
3890static void rtl8168f_2_hw_phy_config(struct rtl8169_private *tp)
3891{
3892 rtl_apply_firmware(tp);
3893
Hayes Wang5f886e02012-03-30 14:33:03 +08003894 rtl8168f_hw_phy_config(tp);
Hayes Wangc2218922011-09-06 16:55:18 +08003895}
3896
Hayes Wangb3d7b2f2012-03-30 14:48:06 +08003897static void rtl8411_hw_phy_config(struct rtl8169_private *tp)
3898{
Hayes Wangb3d7b2f2012-03-30 14:48:06 +08003899 static const struct phy_reg phy_reg_init[] = {
3900 /* Channel estimation fine tune */
3901 { 0x1f, 0x0003 },
3902 { 0x09, 0xa20f },
3903 { 0x1f, 0x0000 },
3904
3905 /* Modify green table for giga & fnet */
3906 { 0x1f, 0x0005 },
3907 { 0x05, 0x8b55 },
3908 { 0x06, 0x0000 },
3909 { 0x05, 0x8b5e },
3910 { 0x06, 0x0000 },
3911 { 0x05, 0x8b67 },
3912 { 0x06, 0x0000 },
3913 { 0x05, 0x8b70 },
3914 { 0x06, 0x0000 },
3915 { 0x1f, 0x0000 },
3916 { 0x1f, 0x0007 },
3917 { 0x1e, 0x0078 },
3918 { 0x17, 0x0000 },
3919 { 0x19, 0x00aa },
3920 { 0x1f, 0x0000 },
3921
3922 /* Modify green table for 10M */
3923 { 0x1f, 0x0005 },
3924 { 0x05, 0x8b79 },
3925 { 0x06, 0xaa00 },
3926 { 0x1f, 0x0000 },
3927
3928 /* Disable hiimpedance detection (RTCT) */
3929 { 0x1f, 0x0003 },
3930 { 0x01, 0x328a },
3931 { 0x1f, 0x0000 }
3932 };
3933
3934
3935 rtl_apply_firmware(tp);
3936
3937 rtl8168f_hw_phy_config(tp);
3938
3939 /* Improve 2-pair detection performance */
3940 rtl_writephy(tp, 0x1f, 0x0005);
3941 rtl_writephy(tp, 0x05, 0x8b85);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003942 rtl_w0w1_phy(tp, 0x06, 0x4000, 0x0000);
Hayes Wangb3d7b2f2012-03-30 14:48:06 +08003943 rtl_writephy(tp, 0x1f, 0x0000);
3944
3945 rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
3946
3947 /* Modify green table for giga */
3948 rtl_writephy(tp, 0x1f, 0x0005);
3949 rtl_writephy(tp, 0x05, 0x8b54);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003950 rtl_w0w1_phy(tp, 0x06, 0x0000, 0x0800);
Hayes Wangb3d7b2f2012-03-30 14:48:06 +08003951 rtl_writephy(tp, 0x05, 0x8b5d);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003952 rtl_w0w1_phy(tp, 0x06, 0x0000, 0x0800);
Hayes Wangb3d7b2f2012-03-30 14:48:06 +08003953 rtl_writephy(tp, 0x05, 0x8a7c);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003954 rtl_w0w1_phy(tp, 0x06, 0x0000, 0x0100);
Hayes Wangb3d7b2f2012-03-30 14:48:06 +08003955 rtl_writephy(tp, 0x05, 0x8a7f);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003956 rtl_w0w1_phy(tp, 0x06, 0x0100, 0x0000);
Hayes Wangb3d7b2f2012-03-30 14:48:06 +08003957 rtl_writephy(tp, 0x05, 0x8a82);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003958 rtl_w0w1_phy(tp, 0x06, 0x0000, 0x0100);
Hayes Wangb3d7b2f2012-03-30 14:48:06 +08003959 rtl_writephy(tp, 0x05, 0x8a85);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003960 rtl_w0w1_phy(tp, 0x06, 0x0000, 0x0100);
Hayes Wangb3d7b2f2012-03-30 14:48:06 +08003961 rtl_writephy(tp, 0x05, 0x8a88);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003962 rtl_w0w1_phy(tp, 0x06, 0x0000, 0x0100);
Hayes Wangb3d7b2f2012-03-30 14:48:06 +08003963 rtl_writephy(tp, 0x1f, 0x0000);
3964
3965 /* uc same-seed solution */
3966 rtl_writephy(tp, 0x1f, 0x0005);
3967 rtl_writephy(tp, 0x05, 0x8b85);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003968 rtl_w0w1_phy(tp, 0x06, 0x8000, 0x0000);
Hayes Wangb3d7b2f2012-03-30 14:48:06 +08003969 rtl_writephy(tp, 0x1f, 0x0000);
3970
3971 /* eee setting */
Chun-Hao Lin706123d2014-10-01 23:17:18 +08003972 rtl_w0w1_eri(tp, 0x1b0, ERIAR_MASK_0001, 0x00, 0x03, ERIAR_EXGMAC);
Hayes Wangb3d7b2f2012-03-30 14:48:06 +08003973 rtl_writephy(tp, 0x1f, 0x0005);
3974 rtl_writephy(tp, 0x05, 0x8b85);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003975 rtl_w0w1_phy(tp, 0x06, 0x0000, 0x2000);
Hayes Wangb3d7b2f2012-03-30 14:48:06 +08003976 rtl_writephy(tp, 0x1f, 0x0004);
3977 rtl_writephy(tp, 0x1f, 0x0007);
3978 rtl_writephy(tp, 0x1e, 0x0020);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003979 rtl_w0w1_phy(tp, 0x15, 0x0000, 0x0100);
Hayes Wangb3d7b2f2012-03-30 14:48:06 +08003980 rtl_writephy(tp, 0x1f, 0x0000);
3981 rtl_writephy(tp, 0x0d, 0x0007);
3982 rtl_writephy(tp, 0x0e, 0x003c);
3983 rtl_writephy(tp, 0x0d, 0x4007);
3984 rtl_writephy(tp, 0x0e, 0x0000);
3985 rtl_writephy(tp, 0x0d, 0x0000);
3986
3987 /* Green feature */
3988 rtl_writephy(tp, 0x1f, 0x0003);
Chun-Hao Lin76564422014-10-01 23:17:17 +08003989 rtl_w0w1_phy(tp, 0x19, 0x0000, 0x0001);
3990 rtl_w0w1_phy(tp, 0x10, 0x0000, 0x0400);
Hayes Wangb3d7b2f2012-03-30 14:48:06 +08003991 rtl_writephy(tp, 0x1f, 0x0000);
3992}
3993
Hayes Wangc5583862012-07-02 17:23:22 +08003994static void rtl8168g_1_hw_phy_config(struct rtl8169_private *tp)
3995{
Hayes Wangc5583862012-07-02 17:23:22 +08003996 rtl_apply_firmware(tp);
3997
hayeswang41f44d12013-04-01 22:23:36 +00003998 rtl_writephy(tp, 0x1f, 0x0a46);
3999 if (rtl_readphy(tp, 0x10) & 0x0100) {
4000 rtl_writephy(tp, 0x1f, 0x0bcc);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004001 rtl_w0w1_phy(tp, 0x12, 0x0000, 0x8000);
hayeswang41f44d12013-04-01 22:23:36 +00004002 } else {
4003 rtl_writephy(tp, 0x1f, 0x0bcc);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004004 rtl_w0w1_phy(tp, 0x12, 0x8000, 0x0000);
hayeswang41f44d12013-04-01 22:23:36 +00004005 }
Hayes Wangc5583862012-07-02 17:23:22 +08004006
hayeswang41f44d12013-04-01 22:23:36 +00004007 rtl_writephy(tp, 0x1f, 0x0a46);
4008 if (rtl_readphy(tp, 0x13) & 0x0100) {
4009 rtl_writephy(tp, 0x1f, 0x0c41);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004010 rtl_w0w1_phy(tp, 0x15, 0x0002, 0x0000);
hayeswang41f44d12013-04-01 22:23:36 +00004011 } else {
hayeswangfe7524c2013-04-01 22:23:37 +00004012 rtl_writephy(tp, 0x1f, 0x0c41);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004013 rtl_w0w1_phy(tp, 0x15, 0x0000, 0x0002);
hayeswang41f44d12013-04-01 22:23:36 +00004014 }
Hayes Wangc5583862012-07-02 17:23:22 +08004015
hayeswang41f44d12013-04-01 22:23:36 +00004016 /* Enable PHY auto speed down */
4017 rtl_writephy(tp, 0x1f, 0x0a44);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004018 rtl_w0w1_phy(tp, 0x11, 0x000c, 0x0000);
Hayes Wangc5583862012-07-02 17:23:22 +08004019
hayeswangfe7524c2013-04-01 22:23:37 +00004020 rtl_writephy(tp, 0x1f, 0x0bcc);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004021 rtl_w0w1_phy(tp, 0x14, 0x0100, 0x0000);
hayeswangfe7524c2013-04-01 22:23:37 +00004022 rtl_writephy(tp, 0x1f, 0x0a44);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004023 rtl_w0w1_phy(tp, 0x11, 0x00c0, 0x0000);
hayeswangfe7524c2013-04-01 22:23:37 +00004024 rtl_writephy(tp, 0x1f, 0x0a43);
4025 rtl_writephy(tp, 0x13, 0x8084);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004026 rtl_w0w1_phy(tp, 0x14, 0x0000, 0x6000);
4027 rtl_w0w1_phy(tp, 0x10, 0x1003, 0x0000);
hayeswangfe7524c2013-04-01 22:23:37 +00004028
hayeswang41f44d12013-04-01 22:23:36 +00004029 /* EEE auto-fallback function */
4030 rtl_writephy(tp, 0x1f, 0x0a4b);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004031 rtl_w0w1_phy(tp, 0x11, 0x0004, 0x0000);
Hayes Wangc5583862012-07-02 17:23:22 +08004032
hayeswang41f44d12013-04-01 22:23:36 +00004033 /* Enable UC LPF tune function */
4034 rtl_writephy(tp, 0x1f, 0x0a43);
4035 rtl_writephy(tp, 0x13, 0x8012);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004036 rtl_w0w1_phy(tp, 0x14, 0x8000, 0x0000);
hayeswang41f44d12013-04-01 22:23:36 +00004037
4038 rtl_writephy(tp, 0x1f, 0x0c42);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004039 rtl_w0w1_phy(tp, 0x11, 0x4000, 0x2000);
hayeswang41f44d12013-04-01 22:23:36 +00004040
hayeswangfe7524c2013-04-01 22:23:37 +00004041 /* Improve SWR Efficiency */
4042 rtl_writephy(tp, 0x1f, 0x0bcd);
4043 rtl_writephy(tp, 0x14, 0x5065);
4044 rtl_writephy(tp, 0x14, 0xd065);
4045 rtl_writephy(tp, 0x1f, 0x0bc8);
4046 rtl_writephy(tp, 0x11, 0x5655);
4047 rtl_writephy(tp, 0x1f, 0x0bcd);
4048 rtl_writephy(tp, 0x14, 0x1065);
4049 rtl_writephy(tp, 0x14, 0x9065);
4050 rtl_writephy(tp, 0x14, 0x1065);
4051
David Chang1bac1072013-11-27 15:48:36 +08004052 /* Check ALDPS bit, disable it if enabled */
4053 rtl_writephy(tp, 0x1f, 0x0a43);
4054 if (rtl_readphy(tp, 0x10) & 0x0004)
Chun-Hao Lin76564422014-10-01 23:17:17 +08004055 rtl_w0w1_phy(tp, 0x10, 0x0000, 0x0004);
David Chang1bac1072013-11-27 15:48:36 +08004056
hayeswang41f44d12013-04-01 22:23:36 +00004057 rtl_writephy(tp, 0x1f, 0x0000);
Hayes Wangc5583862012-07-02 17:23:22 +08004058}
4059
hayeswang57538c42013-04-01 22:23:40 +00004060static void rtl8168g_2_hw_phy_config(struct rtl8169_private *tp)
4061{
4062 rtl_apply_firmware(tp);
4063}
4064
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004065static void rtl8168h_1_hw_phy_config(struct rtl8169_private *tp)
4066{
4067 u16 dout_tapbin;
4068 u32 data;
4069
4070 rtl_apply_firmware(tp);
4071
4072 /* CHN EST parameters adjust - giga master */
4073 rtl_writephy(tp, 0x1f, 0x0a43);
4074 rtl_writephy(tp, 0x13, 0x809b);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004075 rtl_w0w1_phy(tp, 0x14, 0x8000, 0xf800);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004076 rtl_writephy(tp, 0x13, 0x80a2);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004077 rtl_w0w1_phy(tp, 0x14, 0x8000, 0xff00);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004078 rtl_writephy(tp, 0x13, 0x80a4);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004079 rtl_w0w1_phy(tp, 0x14, 0x8500, 0xff00);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004080 rtl_writephy(tp, 0x13, 0x809c);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004081 rtl_w0w1_phy(tp, 0x14, 0xbd00, 0xff00);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004082 rtl_writephy(tp, 0x1f, 0x0000);
4083
4084 /* CHN EST parameters adjust - giga slave */
4085 rtl_writephy(tp, 0x1f, 0x0a43);
4086 rtl_writephy(tp, 0x13, 0x80ad);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004087 rtl_w0w1_phy(tp, 0x14, 0x7000, 0xf800);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004088 rtl_writephy(tp, 0x13, 0x80b4);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004089 rtl_w0w1_phy(tp, 0x14, 0x5000, 0xff00);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004090 rtl_writephy(tp, 0x13, 0x80ac);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004091 rtl_w0w1_phy(tp, 0x14, 0x4000, 0xff00);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004092 rtl_writephy(tp, 0x1f, 0x0000);
4093
4094 /* CHN EST parameters adjust - fnet */
4095 rtl_writephy(tp, 0x1f, 0x0a43);
4096 rtl_writephy(tp, 0x13, 0x808e);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004097 rtl_w0w1_phy(tp, 0x14, 0x1200, 0xff00);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004098 rtl_writephy(tp, 0x13, 0x8090);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004099 rtl_w0w1_phy(tp, 0x14, 0xe500, 0xff00);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004100 rtl_writephy(tp, 0x13, 0x8092);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004101 rtl_w0w1_phy(tp, 0x14, 0x9f00, 0xff00);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004102 rtl_writephy(tp, 0x1f, 0x0000);
4103
4104 /* enable R-tune & PGA-retune function */
4105 dout_tapbin = 0;
4106 rtl_writephy(tp, 0x1f, 0x0a46);
4107 data = rtl_readphy(tp, 0x13);
4108 data &= 3;
4109 data <<= 2;
4110 dout_tapbin |= data;
4111 data = rtl_readphy(tp, 0x12);
4112 data &= 0xc000;
4113 data >>= 14;
4114 dout_tapbin |= data;
4115 dout_tapbin = ~(dout_tapbin^0x08);
4116 dout_tapbin <<= 12;
4117 dout_tapbin &= 0xf000;
4118 rtl_writephy(tp, 0x1f, 0x0a43);
4119 rtl_writephy(tp, 0x13, 0x827a);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004120 rtl_w0w1_phy(tp, 0x14, dout_tapbin, 0xf000);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004121 rtl_writephy(tp, 0x13, 0x827b);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004122 rtl_w0w1_phy(tp, 0x14, dout_tapbin, 0xf000);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004123 rtl_writephy(tp, 0x13, 0x827c);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004124 rtl_w0w1_phy(tp, 0x14, dout_tapbin, 0xf000);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004125 rtl_writephy(tp, 0x13, 0x827d);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004126 rtl_w0w1_phy(tp, 0x14, dout_tapbin, 0xf000);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004127
4128 rtl_writephy(tp, 0x1f, 0x0a43);
4129 rtl_writephy(tp, 0x13, 0x0811);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004130 rtl_w0w1_phy(tp, 0x14, 0x0800, 0x0000);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004131 rtl_writephy(tp, 0x1f, 0x0a42);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004132 rtl_w0w1_phy(tp, 0x16, 0x0002, 0x0000);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004133 rtl_writephy(tp, 0x1f, 0x0000);
4134
4135 /* enable GPHY 10M */
4136 rtl_writephy(tp, 0x1f, 0x0a44);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004137 rtl_w0w1_phy(tp, 0x11, 0x0800, 0x0000);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004138 rtl_writephy(tp, 0x1f, 0x0000);
4139
4140 /* SAR ADC performance */
4141 rtl_writephy(tp, 0x1f, 0x0bca);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004142 rtl_w0w1_phy(tp, 0x17, 0x4000, 0x3000);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004143 rtl_writephy(tp, 0x1f, 0x0000);
4144
4145 rtl_writephy(tp, 0x1f, 0x0a43);
4146 rtl_writephy(tp, 0x13, 0x803f);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004147 rtl_w0w1_phy(tp, 0x14, 0x0000, 0x3000);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004148 rtl_writephy(tp, 0x13, 0x8047);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004149 rtl_w0w1_phy(tp, 0x14, 0x0000, 0x3000);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004150 rtl_writephy(tp, 0x13, 0x804f);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004151 rtl_w0w1_phy(tp, 0x14, 0x0000, 0x3000);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004152 rtl_writephy(tp, 0x13, 0x8057);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004153 rtl_w0w1_phy(tp, 0x14, 0x0000, 0x3000);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004154 rtl_writephy(tp, 0x13, 0x805f);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004155 rtl_w0w1_phy(tp, 0x14, 0x0000, 0x3000);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004156 rtl_writephy(tp, 0x13, 0x8067);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004157 rtl_w0w1_phy(tp, 0x14, 0x0000, 0x3000);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004158 rtl_writephy(tp, 0x13, 0x806f);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004159 rtl_w0w1_phy(tp, 0x14, 0x0000, 0x3000);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004160 rtl_writephy(tp, 0x1f, 0x0000);
4161
4162 /* disable phy pfm mode */
4163 rtl_writephy(tp, 0x1f, 0x0a44);
Chun-Hao Linc832c35f2015-12-29 22:13:38 +08004164 rtl_w0w1_phy(tp, 0x11, 0x0000, 0x0080);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004165 rtl_writephy(tp, 0x1f, 0x0000);
4166
4167 /* Check ALDPS bit, disable it if enabled */
4168 rtl_writephy(tp, 0x1f, 0x0a43);
4169 if (rtl_readphy(tp, 0x10) & 0x0004)
Chun-Hao Lin76564422014-10-01 23:17:17 +08004170 rtl_w0w1_phy(tp, 0x10, 0x0000, 0x0004);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004171
4172 rtl_writephy(tp, 0x1f, 0x0000);
4173}
4174
4175static void rtl8168h_2_hw_phy_config(struct rtl8169_private *tp)
4176{
4177 u16 ioffset_p3, ioffset_p2, ioffset_p1, ioffset_p0;
4178 u16 rlen;
4179 u32 data;
4180
4181 rtl_apply_firmware(tp);
4182
4183 /* CHIN EST parameter update */
4184 rtl_writephy(tp, 0x1f, 0x0a43);
4185 rtl_writephy(tp, 0x13, 0x808a);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004186 rtl_w0w1_phy(tp, 0x14, 0x000a, 0x003f);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004187 rtl_writephy(tp, 0x1f, 0x0000);
4188
4189 /* enable R-tune & PGA-retune function */
4190 rtl_writephy(tp, 0x1f, 0x0a43);
4191 rtl_writephy(tp, 0x13, 0x0811);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004192 rtl_w0w1_phy(tp, 0x14, 0x0800, 0x0000);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004193 rtl_writephy(tp, 0x1f, 0x0a42);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004194 rtl_w0w1_phy(tp, 0x16, 0x0002, 0x0000);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004195 rtl_writephy(tp, 0x1f, 0x0000);
4196
4197 /* enable GPHY 10M */
4198 rtl_writephy(tp, 0x1f, 0x0a44);
Chun-Hao Lin76564422014-10-01 23:17:17 +08004199 rtl_w0w1_phy(tp, 0x11, 0x0800, 0x0000);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004200 rtl_writephy(tp, 0x1f, 0x0000);
4201
4202 r8168_mac_ocp_write(tp, 0xdd02, 0x807d);
4203 data = r8168_mac_ocp_read(tp, 0xdd02);
4204 ioffset_p3 = ((data & 0x80)>>7);
4205 ioffset_p3 <<= 3;
4206
4207 data = r8168_mac_ocp_read(tp, 0xdd00);
4208 ioffset_p3 |= ((data & (0xe000))>>13);
4209 ioffset_p2 = ((data & (0x1e00))>>9);
4210 ioffset_p1 = ((data & (0x01e0))>>5);
4211 ioffset_p0 = ((data & 0x0010)>>4);
4212 ioffset_p0 <<= 3;
4213 ioffset_p0 |= (data & (0x07));
4214 data = (ioffset_p3<<12)|(ioffset_p2<<8)|(ioffset_p1<<4)|(ioffset_p0);
4215
Chun-Hao Lin05b96872014-10-01 23:17:12 +08004216 if ((ioffset_p3 != 0x0f) || (ioffset_p2 != 0x0f) ||
Chun-Hao Line2e27882015-12-24 21:15:26 +08004217 (ioffset_p1 != 0x0f) || (ioffset_p0 != 0x0f)) {
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004218 rtl_writephy(tp, 0x1f, 0x0bcf);
4219 rtl_writephy(tp, 0x16, data);
4220 rtl_writephy(tp, 0x1f, 0x0000);
4221 }
4222
4223 /* Modify rlen (TX LPF corner frequency) level */
4224 rtl_writephy(tp, 0x1f, 0x0bcd);
4225 data = rtl_readphy(tp, 0x16);
4226 data &= 0x000f;
4227 rlen = 0;
4228 if (data > 3)
4229 rlen = data - 3;
4230 data = rlen | (rlen<<4) | (rlen<<8) | (rlen<<12);
4231 rtl_writephy(tp, 0x17, data);
4232 rtl_writephy(tp, 0x1f, 0x0bcd);
4233 rtl_writephy(tp, 0x1f, 0x0000);
4234
4235 /* disable phy pfm mode */
4236 rtl_writephy(tp, 0x1f, 0x0a44);
Chun-Hao Linc832c35f2015-12-29 22:13:38 +08004237 rtl_w0w1_phy(tp, 0x11, 0x0000, 0x0080);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004238 rtl_writephy(tp, 0x1f, 0x0000);
4239
4240 /* Check ALDPS bit, disable it if enabled */
4241 rtl_writephy(tp, 0x1f, 0x0a43);
4242 if (rtl_readphy(tp, 0x10) & 0x0004)
Chun-Hao Lin76564422014-10-01 23:17:17 +08004243 rtl_w0w1_phy(tp, 0x10, 0x0000, 0x0004);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004244
4245 rtl_writephy(tp, 0x1f, 0x0000);
4246}
4247
Chun-Hao Lin935e2212014-10-07 15:10:41 +08004248static void rtl8168ep_1_hw_phy_config(struct rtl8169_private *tp)
4249{
4250 /* Enable PHY auto speed down */
4251 rtl_writephy(tp, 0x1f, 0x0a44);
4252 rtl_w0w1_phy(tp, 0x11, 0x000c, 0x0000);
4253 rtl_writephy(tp, 0x1f, 0x0000);
4254
4255 /* patch 10M & ALDPS */
4256 rtl_writephy(tp, 0x1f, 0x0bcc);
4257 rtl_w0w1_phy(tp, 0x14, 0x0000, 0x0100);
4258 rtl_writephy(tp, 0x1f, 0x0a44);
4259 rtl_w0w1_phy(tp, 0x11, 0x00c0, 0x0000);
4260 rtl_writephy(tp, 0x1f, 0x0a43);
4261 rtl_writephy(tp, 0x13, 0x8084);
4262 rtl_w0w1_phy(tp, 0x14, 0x0000, 0x6000);
4263 rtl_w0w1_phy(tp, 0x10, 0x1003, 0x0000);
4264 rtl_writephy(tp, 0x1f, 0x0000);
4265
4266 /* Enable EEE auto-fallback function */
4267 rtl_writephy(tp, 0x1f, 0x0a4b);
4268 rtl_w0w1_phy(tp, 0x11, 0x0004, 0x0000);
4269 rtl_writephy(tp, 0x1f, 0x0000);
4270
4271 /* Enable UC LPF tune function */
4272 rtl_writephy(tp, 0x1f, 0x0a43);
4273 rtl_writephy(tp, 0x13, 0x8012);
4274 rtl_w0w1_phy(tp, 0x14, 0x8000, 0x0000);
4275 rtl_writephy(tp, 0x1f, 0x0000);
4276
4277 /* set rg_sel_sdm_rate */
4278 rtl_writephy(tp, 0x1f, 0x0c42);
4279 rtl_w0w1_phy(tp, 0x11, 0x4000, 0x2000);
4280 rtl_writephy(tp, 0x1f, 0x0000);
4281
4282 /* Check ALDPS bit, disable it if enabled */
4283 rtl_writephy(tp, 0x1f, 0x0a43);
4284 if (rtl_readphy(tp, 0x10) & 0x0004)
4285 rtl_w0w1_phy(tp, 0x10, 0x0000, 0x0004);
4286
4287 rtl_writephy(tp, 0x1f, 0x0000);
4288}
4289
4290static void rtl8168ep_2_hw_phy_config(struct rtl8169_private *tp)
4291{
4292 /* patch 10M & ALDPS */
4293 rtl_writephy(tp, 0x1f, 0x0bcc);
4294 rtl_w0w1_phy(tp, 0x14, 0x0000, 0x0100);
4295 rtl_writephy(tp, 0x1f, 0x0a44);
4296 rtl_w0w1_phy(tp, 0x11, 0x00c0, 0x0000);
4297 rtl_writephy(tp, 0x1f, 0x0a43);
4298 rtl_writephy(tp, 0x13, 0x8084);
4299 rtl_w0w1_phy(tp, 0x14, 0x0000, 0x6000);
4300 rtl_w0w1_phy(tp, 0x10, 0x1003, 0x0000);
4301 rtl_writephy(tp, 0x1f, 0x0000);
4302
4303 /* Enable UC LPF tune function */
4304 rtl_writephy(tp, 0x1f, 0x0a43);
4305 rtl_writephy(tp, 0x13, 0x8012);
4306 rtl_w0w1_phy(tp, 0x14, 0x8000, 0x0000);
4307 rtl_writephy(tp, 0x1f, 0x0000);
4308
4309 /* Set rg_sel_sdm_rate */
4310 rtl_writephy(tp, 0x1f, 0x0c42);
4311 rtl_w0w1_phy(tp, 0x11, 0x4000, 0x2000);
4312 rtl_writephy(tp, 0x1f, 0x0000);
4313
4314 /* Channel estimation parameters */
4315 rtl_writephy(tp, 0x1f, 0x0a43);
4316 rtl_writephy(tp, 0x13, 0x80f3);
4317 rtl_w0w1_phy(tp, 0x14, 0x8b00, ~0x8bff);
4318 rtl_writephy(tp, 0x13, 0x80f0);
4319 rtl_w0w1_phy(tp, 0x14, 0x3a00, ~0x3aff);
4320 rtl_writephy(tp, 0x13, 0x80ef);
4321 rtl_w0w1_phy(tp, 0x14, 0x0500, ~0x05ff);
4322 rtl_writephy(tp, 0x13, 0x80f6);
4323 rtl_w0w1_phy(tp, 0x14, 0x6e00, ~0x6eff);
4324 rtl_writephy(tp, 0x13, 0x80ec);
4325 rtl_w0w1_phy(tp, 0x14, 0x6800, ~0x68ff);
4326 rtl_writephy(tp, 0x13, 0x80ed);
4327 rtl_w0w1_phy(tp, 0x14, 0x7c00, ~0x7cff);
4328 rtl_writephy(tp, 0x13, 0x80f2);
4329 rtl_w0w1_phy(tp, 0x14, 0xf400, ~0xf4ff);
4330 rtl_writephy(tp, 0x13, 0x80f4);
4331 rtl_w0w1_phy(tp, 0x14, 0x8500, ~0x85ff);
4332 rtl_writephy(tp, 0x1f, 0x0a43);
4333 rtl_writephy(tp, 0x13, 0x8110);
4334 rtl_w0w1_phy(tp, 0x14, 0xa800, ~0xa8ff);
4335 rtl_writephy(tp, 0x13, 0x810f);
4336 rtl_w0w1_phy(tp, 0x14, 0x1d00, ~0x1dff);
4337 rtl_writephy(tp, 0x13, 0x8111);
4338 rtl_w0w1_phy(tp, 0x14, 0xf500, ~0xf5ff);
4339 rtl_writephy(tp, 0x13, 0x8113);
4340 rtl_w0w1_phy(tp, 0x14, 0x6100, ~0x61ff);
4341 rtl_writephy(tp, 0x13, 0x8115);
4342 rtl_w0w1_phy(tp, 0x14, 0x9200, ~0x92ff);
4343 rtl_writephy(tp, 0x13, 0x810e);
4344 rtl_w0w1_phy(tp, 0x14, 0x0400, ~0x04ff);
4345 rtl_writephy(tp, 0x13, 0x810c);
4346 rtl_w0w1_phy(tp, 0x14, 0x7c00, ~0x7cff);
4347 rtl_writephy(tp, 0x13, 0x810b);
4348 rtl_w0w1_phy(tp, 0x14, 0x5a00, ~0x5aff);
4349 rtl_writephy(tp, 0x1f, 0x0a43);
4350 rtl_writephy(tp, 0x13, 0x80d1);
4351 rtl_w0w1_phy(tp, 0x14, 0xff00, ~0xffff);
4352 rtl_writephy(tp, 0x13, 0x80cd);
4353 rtl_w0w1_phy(tp, 0x14, 0x9e00, ~0x9eff);
4354 rtl_writephy(tp, 0x13, 0x80d3);
4355 rtl_w0w1_phy(tp, 0x14, 0x0e00, ~0x0eff);
4356 rtl_writephy(tp, 0x13, 0x80d5);
4357 rtl_w0w1_phy(tp, 0x14, 0xca00, ~0xcaff);
4358 rtl_writephy(tp, 0x13, 0x80d7);
4359 rtl_w0w1_phy(tp, 0x14, 0x8400, ~0x84ff);
4360
4361 /* Force PWM-mode */
4362 rtl_writephy(tp, 0x1f, 0x0bcd);
4363 rtl_writephy(tp, 0x14, 0x5065);
4364 rtl_writephy(tp, 0x14, 0xd065);
4365 rtl_writephy(tp, 0x1f, 0x0bc8);
4366 rtl_writephy(tp, 0x12, 0x00ed);
4367 rtl_writephy(tp, 0x1f, 0x0bcd);
4368 rtl_writephy(tp, 0x14, 0x1065);
4369 rtl_writephy(tp, 0x14, 0x9065);
4370 rtl_writephy(tp, 0x14, 0x1065);
4371 rtl_writephy(tp, 0x1f, 0x0000);
4372
4373 /* Check ALDPS bit, disable it if enabled */
4374 rtl_writephy(tp, 0x1f, 0x0a43);
4375 if (rtl_readphy(tp, 0x10) & 0x0004)
4376 rtl_w0w1_phy(tp, 0x10, 0x0000, 0x0004);
4377
4378 rtl_writephy(tp, 0x1f, 0x0000);
4379}
4380
françois romieu4da19632011-01-03 15:07:55 +00004381static void rtl8102e_hw_phy_config(struct rtl8169_private *tp)
Francois Romieu2857ffb2008-08-02 21:08:49 +02004382{
Alexey Dobriyan350f7592009-11-25 15:54:21 -08004383 static const struct phy_reg phy_reg_init[] = {
Francois Romieu2857ffb2008-08-02 21:08:49 +02004384 { 0x1f, 0x0003 },
4385 { 0x08, 0x441d },
4386 { 0x01, 0x9100 },
4387 { 0x1f, 0x0000 }
4388 };
4389
françois romieu4da19632011-01-03 15:07:55 +00004390 rtl_writephy(tp, 0x1f, 0x0000);
4391 rtl_patchphy(tp, 0x11, 1 << 12);
4392 rtl_patchphy(tp, 0x19, 1 << 13);
4393 rtl_patchphy(tp, 0x10, 1 << 15);
Francois Romieu2857ffb2008-08-02 21:08:49 +02004394
françois romieu4da19632011-01-03 15:07:55 +00004395 rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
Francois Romieu2857ffb2008-08-02 21:08:49 +02004396}
4397
Hayes Wang5a5e4442011-02-22 17:26:21 +08004398static void rtl8105e_hw_phy_config(struct rtl8169_private *tp)
4399{
4400 static const struct phy_reg phy_reg_init[] = {
4401 { 0x1f, 0x0005 },
4402 { 0x1a, 0x0000 },
4403 { 0x1f, 0x0000 },
4404
4405 { 0x1f, 0x0004 },
4406 { 0x1c, 0x0000 },
4407 { 0x1f, 0x0000 },
4408
4409 { 0x1f, 0x0001 },
4410 { 0x15, 0x7701 },
4411 { 0x1f, 0x0000 }
4412 };
4413
4414 /* Disable ALDPS before ram code */
Francois Romieueef63cc2013-02-08 23:43:20 +01004415 rtl_writephy(tp, 0x1f, 0x0000);
4416 rtl_writephy(tp, 0x18, 0x0310);
4417 msleep(100);
Hayes Wang5a5e4442011-02-22 17:26:21 +08004418
François Romieu953a12c2011-04-24 17:38:48 +02004419 rtl_apply_firmware(tp);
Hayes Wang5a5e4442011-02-22 17:26:21 +08004420
4421 rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
4422}
4423
Hayes Wang7e18dca2012-03-30 14:33:02 +08004424static void rtl8402_hw_phy_config(struct rtl8169_private *tp)
4425{
Hayes Wang7e18dca2012-03-30 14:33:02 +08004426 /* Disable ALDPS before setting firmware */
Francois Romieueef63cc2013-02-08 23:43:20 +01004427 rtl_writephy(tp, 0x1f, 0x0000);
4428 rtl_writephy(tp, 0x18, 0x0310);
4429 msleep(20);
Hayes Wang7e18dca2012-03-30 14:33:02 +08004430
4431 rtl_apply_firmware(tp);
4432
4433 /* EEE setting */
Francois Romieufdf6fc02012-07-06 22:40:38 +02004434 rtl_eri_write(tp, 0x1b0, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);
Hayes Wang7e18dca2012-03-30 14:33:02 +08004435 rtl_writephy(tp, 0x1f, 0x0004);
4436 rtl_writephy(tp, 0x10, 0x401f);
4437 rtl_writephy(tp, 0x19, 0x7030);
4438 rtl_writephy(tp, 0x1f, 0x0000);
4439}
4440
Hayes Wang5598bfe2012-07-02 17:23:21 +08004441static void rtl8106e_hw_phy_config(struct rtl8169_private *tp)
4442{
Hayes Wang5598bfe2012-07-02 17:23:21 +08004443 static const struct phy_reg phy_reg_init[] = {
4444 { 0x1f, 0x0004 },
4445 { 0x10, 0xc07f },
4446 { 0x19, 0x7030 },
4447 { 0x1f, 0x0000 }
4448 };
4449
4450 /* Disable ALDPS before ram code */
Francois Romieueef63cc2013-02-08 23:43:20 +01004451 rtl_writephy(tp, 0x1f, 0x0000);
4452 rtl_writephy(tp, 0x18, 0x0310);
4453 msleep(100);
Hayes Wang5598bfe2012-07-02 17:23:21 +08004454
4455 rtl_apply_firmware(tp);
4456
Francois Romieufdf6fc02012-07-06 22:40:38 +02004457 rtl_eri_write(tp, 0x1b0, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);
Hayes Wang5598bfe2012-07-02 17:23:21 +08004458 rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
4459
Francois Romieufdf6fc02012-07-06 22:40:38 +02004460 rtl_eri_write(tp, 0x1d0, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);
Hayes Wang5598bfe2012-07-02 17:23:21 +08004461}
4462
Francois Romieu5615d9f2007-08-17 17:50:46 +02004463static void rtl_hw_phy_config(struct net_device *dev)
4464{
4465 struct rtl8169_private *tp = netdev_priv(dev);
Francois Romieu5615d9f2007-08-17 17:50:46 +02004466
4467 rtl8169_print_mac_version(tp);
4468
4469 switch (tp->mac_version) {
4470 case RTL_GIGA_MAC_VER_01:
4471 break;
4472 case RTL_GIGA_MAC_VER_02:
4473 case RTL_GIGA_MAC_VER_03:
françois romieu4da19632011-01-03 15:07:55 +00004474 rtl8169s_hw_phy_config(tp);
Francois Romieu5615d9f2007-08-17 17:50:46 +02004475 break;
4476 case RTL_GIGA_MAC_VER_04:
françois romieu4da19632011-01-03 15:07:55 +00004477 rtl8169sb_hw_phy_config(tp);
Francois Romieu5615d9f2007-08-17 17:50:46 +02004478 break;
françois romieu2e9558562009-08-10 19:44:19 +00004479 case RTL_GIGA_MAC_VER_05:
françois romieu4da19632011-01-03 15:07:55 +00004480 rtl8169scd_hw_phy_config(tp);
françois romieu2e9558562009-08-10 19:44:19 +00004481 break;
françois romieu8c7006a2009-08-10 19:43:29 +00004482 case RTL_GIGA_MAC_VER_06:
françois romieu4da19632011-01-03 15:07:55 +00004483 rtl8169sce_hw_phy_config(tp);
françois romieu8c7006a2009-08-10 19:43:29 +00004484 break;
Francois Romieu2857ffb2008-08-02 21:08:49 +02004485 case RTL_GIGA_MAC_VER_07:
4486 case RTL_GIGA_MAC_VER_08:
4487 case RTL_GIGA_MAC_VER_09:
françois romieu4da19632011-01-03 15:07:55 +00004488 rtl8102e_hw_phy_config(tp);
Francois Romieu2857ffb2008-08-02 21:08:49 +02004489 break;
Francois Romieu236b8082008-05-30 16:11:48 +02004490 case RTL_GIGA_MAC_VER_11:
françois romieu4da19632011-01-03 15:07:55 +00004491 rtl8168bb_hw_phy_config(tp);
Francois Romieu236b8082008-05-30 16:11:48 +02004492 break;
4493 case RTL_GIGA_MAC_VER_12:
françois romieu4da19632011-01-03 15:07:55 +00004494 rtl8168bef_hw_phy_config(tp);
Francois Romieu236b8082008-05-30 16:11:48 +02004495 break;
4496 case RTL_GIGA_MAC_VER_17:
françois romieu4da19632011-01-03 15:07:55 +00004497 rtl8168bef_hw_phy_config(tp);
Francois Romieu236b8082008-05-30 16:11:48 +02004498 break;
Francois Romieu867763c2007-08-17 18:21:58 +02004499 case RTL_GIGA_MAC_VER_18:
françois romieu4da19632011-01-03 15:07:55 +00004500 rtl8168cp_1_hw_phy_config(tp);
Francois Romieu867763c2007-08-17 18:21:58 +02004501 break;
4502 case RTL_GIGA_MAC_VER_19:
françois romieu4da19632011-01-03 15:07:55 +00004503 rtl8168c_1_hw_phy_config(tp);
Francois Romieu867763c2007-08-17 18:21:58 +02004504 break;
Francois Romieu7da97ec2007-10-18 15:20:43 +02004505 case RTL_GIGA_MAC_VER_20:
françois romieu4da19632011-01-03 15:07:55 +00004506 rtl8168c_2_hw_phy_config(tp);
Francois Romieu7da97ec2007-10-18 15:20:43 +02004507 break;
Francois Romieu197ff762008-06-28 13:16:02 +02004508 case RTL_GIGA_MAC_VER_21:
françois romieu4da19632011-01-03 15:07:55 +00004509 rtl8168c_3_hw_phy_config(tp);
Francois Romieu197ff762008-06-28 13:16:02 +02004510 break;
Francois Romieu6fb07052008-06-29 11:54:28 +02004511 case RTL_GIGA_MAC_VER_22:
françois romieu4da19632011-01-03 15:07:55 +00004512 rtl8168c_4_hw_phy_config(tp);
Francois Romieu6fb07052008-06-29 11:54:28 +02004513 break;
Francois Romieuef3386f2008-06-29 12:24:30 +02004514 case RTL_GIGA_MAC_VER_23:
Francois Romieu7f3e3d32008-07-20 18:53:20 +02004515 case RTL_GIGA_MAC_VER_24:
françois romieu4da19632011-01-03 15:07:55 +00004516 rtl8168cp_2_hw_phy_config(tp);
Francois Romieuef3386f2008-06-29 12:24:30 +02004517 break;
Francois Romieu5b538df2008-07-20 16:22:45 +02004518 case RTL_GIGA_MAC_VER_25:
françois romieubca03d52011-01-03 15:07:31 +00004519 rtl8168d_1_hw_phy_config(tp);
françois romieudaf9df62009-10-07 12:44:20 +00004520 break;
4521 case RTL_GIGA_MAC_VER_26:
françois romieubca03d52011-01-03 15:07:31 +00004522 rtl8168d_2_hw_phy_config(tp);
françois romieudaf9df62009-10-07 12:44:20 +00004523 break;
4524 case RTL_GIGA_MAC_VER_27:
françois romieu4da19632011-01-03 15:07:55 +00004525 rtl8168d_3_hw_phy_config(tp);
Francois Romieu5b538df2008-07-20 16:22:45 +02004526 break;
françois romieue6de30d2011-01-03 15:08:37 +00004527 case RTL_GIGA_MAC_VER_28:
4528 rtl8168d_4_hw_phy_config(tp);
4529 break;
Hayes Wang5a5e4442011-02-22 17:26:21 +08004530 case RTL_GIGA_MAC_VER_29:
4531 case RTL_GIGA_MAC_VER_30:
4532 rtl8105e_hw_phy_config(tp);
4533 break;
Francois Romieucecb5fd2011-04-01 10:21:07 +02004534 case RTL_GIGA_MAC_VER_31:
4535 /* None. */
4536 break;
hayeswang01dc7fe2011-03-21 01:50:28 +00004537 case RTL_GIGA_MAC_VER_32:
hayeswang01dc7fe2011-03-21 01:50:28 +00004538 case RTL_GIGA_MAC_VER_33:
Hayes Wang70090422011-07-06 15:58:06 +08004539 rtl8168e_1_hw_phy_config(tp);
4540 break;
4541 case RTL_GIGA_MAC_VER_34:
4542 rtl8168e_2_hw_phy_config(tp);
hayeswang01dc7fe2011-03-21 01:50:28 +00004543 break;
Hayes Wangc2218922011-09-06 16:55:18 +08004544 case RTL_GIGA_MAC_VER_35:
4545 rtl8168f_1_hw_phy_config(tp);
4546 break;
4547 case RTL_GIGA_MAC_VER_36:
4548 rtl8168f_2_hw_phy_config(tp);
4549 break;
Francois Romieuef3386f2008-06-29 12:24:30 +02004550
Hayes Wang7e18dca2012-03-30 14:33:02 +08004551 case RTL_GIGA_MAC_VER_37:
4552 rtl8402_hw_phy_config(tp);
4553 break;
4554
Hayes Wangb3d7b2f2012-03-30 14:48:06 +08004555 case RTL_GIGA_MAC_VER_38:
4556 rtl8411_hw_phy_config(tp);
4557 break;
4558
Hayes Wang5598bfe2012-07-02 17:23:21 +08004559 case RTL_GIGA_MAC_VER_39:
4560 rtl8106e_hw_phy_config(tp);
4561 break;
4562
Hayes Wangc5583862012-07-02 17:23:22 +08004563 case RTL_GIGA_MAC_VER_40:
4564 rtl8168g_1_hw_phy_config(tp);
4565 break;
hayeswang57538c42013-04-01 22:23:40 +00004566 case RTL_GIGA_MAC_VER_42:
hayeswang58152cd2013-04-01 22:23:42 +00004567 case RTL_GIGA_MAC_VER_43:
hayeswang45dd95c2013-07-08 17:09:01 +08004568 case RTL_GIGA_MAC_VER_44:
hayeswang57538c42013-04-01 22:23:40 +00004569 rtl8168g_2_hw_phy_config(tp);
4570 break;
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004571 case RTL_GIGA_MAC_VER_45:
4572 case RTL_GIGA_MAC_VER_47:
4573 rtl8168h_1_hw_phy_config(tp);
4574 break;
4575 case RTL_GIGA_MAC_VER_46:
4576 case RTL_GIGA_MAC_VER_48:
4577 rtl8168h_2_hw_phy_config(tp);
4578 break;
Hayes Wangc5583862012-07-02 17:23:22 +08004579
Chun-Hao Lin935e2212014-10-07 15:10:41 +08004580 case RTL_GIGA_MAC_VER_49:
4581 rtl8168ep_1_hw_phy_config(tp);
4582 break;
4583 case RTL_GIGA_MAC_VER_50:
4584 case RTL_GIGA_MAC_VER_51:
4585 rtl8168ep_2_hw_phy_config(tp);
4586 break;
4587
Hayes Wangc5583862012-07-02 17:23:22 +08004588 case RTL_GIGA_MAC_VER_41:
Francois Romieu5615d9f2007-08-17 17:50:46 +02004589 default:
4590 break;
4591 }
4592}
4593
Francois Romieuda78dbf2012-01-26 14:18:23 +01004594static void rtl_phy_work(struct rtl8169_private *tp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004595{
Linus Torvalds1da177e2005-04-16 15:20:36 -07004596 struct timer_list *timer = &tp->timer;
4597 void __iomem *ioaddr = tp->mmio_addr;
4598 unsigned long timeout = RTL8169_PHY_TIMEOUT;
4599
Francois Romieubcf0bf92006-07-26 23:14:13 +02004600 assert(tp->mac_version > RTL_GIGA_MAC_VER_01);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004601
françois romieu4da19632011-01-03 15:07:55 +00004602 if (tp->phy_reset_pending(tp)) {
Francois Romieu5b0384f2006-08-16 16:00:01 +02004603 /*
Linus Torvalds1da177e2005-04-16 15:20:36 -07004604 * A busy loop could burn quite a few cycles on nowadays CPU.
4605 * Let's delay the execution of the timer for a few ticks.
4606 */
4607 timeout = HZ/10;
4608 goto out_mod_timer;
4609 }
4610
4611 if (tp->link_ok(ioaddr))
Francois Romieuda78dbf2012-01-26 14:18:23 +01004612 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07004613
Lekensteyn9bb8eeb2013-08-02 10:36:55 +02004614 netif_dbg(tp, link, tp->dev, "PHY reset until link up\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07004615
françois romieu4da19632011-01-03 15:07:55 +00004616 tp->phy_reset_enable(tp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004617
4618out_mod_timer:
4619 mod_timer(timer, jiffies + timeout);
Francois Romieuda78dbf2012-01-26 14:18:23 +01004620}
4621
4622static void rtl_schedule_task(struct rtl8169_private *tp, enum rtl_flag flag)
4623{
Francois Romieuda78dbf2012-01-26 14:18:23 +01004624 if (!test_and_set_bit(flag, tp->wk.flags))
4625 schedule_work(&tp->wk.work);
Francois Romieuda78dbf2012-01-26 14:18:23 +01004626}
4627
Kees Cook9de36cc2017-10-25 03:53:12 -07004628static void rtl8169_phy_timer(struct timer_list *t)
Francois Romieuda78dbf2012-01-26 14:18:23 +01004629{
Kees Cook9de36cc2017-10-25 03:53:12 -07004630 struct rtl8169_private *tp = from_timer(tp, t, timer);
Francois Romieuda78dbf2012-01-26 14:18:23 +01004631
Francois Romieu98ddf982012-01-31 10:47:34 +01004632 rtl_schedule_task(tp, RTL_FLAG_TASK_PHY_PENDING);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004633}
4634
Linus Torvalds1da177e2005-04-16 15:20:36 -07004635static void rtl8169_release_board(struct pci_dev *pdev, struct net_device *dev,
4636 void __iomem *ioaddr)
4637{
4638 iounmap(ioaddr);
4639 pci_release_regions(pdev);
françois romieu87aeec72010-04-26 11:42:06 +00004640 pci_clear_mwi(pdev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07004641 pci_disable_device(pdev);
4642 free_netdev(dev);
4643}
4644
Francois Romieuffc46952012-07-06 14:19:23 +02004645DECLARE_RTL_COND(rtl_phy_reset_cond)
4646{
4647 return tp->phy_reset_pending(tp);
4648}
4649
Francois Romieubf793292006-11-01 00:53:05 +01004650static void rtl8169_phy_reset(struct net_device *dev,
4651 struct rtl8169_private *tp)
4652{
françois romieu4da19632011-01-03 15:07:55 +00004653 tp->phy_reset_enable(tp);
Francois Romieuffc46952012-07-06 14:19:23 +02004654 rtl_msleep_loop_wait_low(tp, &rtl_phy_reset_cond, 1, 100);
Francois Romieubf793292006-11-01 00:53:05 +01004655}
4656
David S. Miller8decf862011-09-22 03:23:13 -04004657static bool rtl_tbi_enabled(struct rtl8169_private *tp)
4658{
4659 void __iomem *ioaddr = tp->mmio_addr;
4660
4661 return (tp->mac_version == RTL_GIGA_MAC_VER_01) &&
4662 (RTL_R8(PHYstatus) & TBI_Enable);
4663}
4664
Francois Romieu4ff96fa2006-07-26 22:05:06 +02004665static void rtl8169_init_phy(struct net_device *dev, struct rtl8169_private *tp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07004666{
Francois Romieu4ff96fa2006-07-26 22:05:06 +02004667 void __iomem *ioaddr = tp->mmio_addr;
Francois Romieu4ff96fa2006-07-26 22:05:06 +02004668
Francois Romieu5615d9f2007-08-17 17:50:46 +02004669 rtl_hw_phy_config(dev);
Francois Romieu4ff96fa2006-07-26 22:05:06 +02004670
Marcus Sundberg773328942008-07-10 21:28:08 +02004671 if (tp->mac_version <= RTL_GIGA_MAC_VER_06) {
4672 dprintk("Set MAC Reg C+CR Offset 0x82h = 0x01h\n");
4673 RTL_W8(0x82, 0x01);
4674 }
Francois Romieu4ff96fa2006-07-26 22:05:06 +02004675
Francois Romieu6dccd162007-02-13 23:38:05 +01004676 pci_write_config_byte(tp->pci_dev, PCI_LATENCY_TIMER, 0x40);
4677
4678 if (tp->mac_version <= RTL_GIGA_MAC_VER_06)
4679 pci_write_config_byte(tp->pci_dev, PCI_CACHE_LINE_SIZE, 0x08);
Francois Romieu4ff96fa2006-07-26 22:05:06 +02004680
Francois Romieubcf0bf92006-07-26 23:14:13 +02004681 if (tp->mac_version == RTL_GIGA_MAC_VER_02) {
Francois Romieu4ff96fa2006-07-26 22:05:06 +02004682 dprintk("Set MAC Reg C+CR Offset 0x82h = 0x01h\n");
4683 RTL_W8(0x82, 0x01);
4684 dprintk("Set PHY Reg 0x0bh = 0x00h\n");
françois romieu4da19632011-01-03 15:07:55 +00004685 rtl_writephy(tp, 0x0b, 0x0000); //w 0x0b 15 0 0
Francois Romieu4ff96fa2006-07-26 22:05:06 +02004686 }
4687
Francois Romieubf793292006-11-01 00:53:05 +01004688 rtl8169_phy_reset(dev, tp);
4689
Oliver Neukum54405cd2011-01-06 21:55:13 +01004690 rtl8169_set_speed(dev, AUTONEG_ENABLE, SPEED_1000, DUPLEX_FULL,
Francois Romieucecb5fd2011-04-01 10:21:07 +02004691 ADVERTISED_10baseT_Half | ADVERTISED_10baseT_Full |
4692 ADVERTISED_100baseT_Half | ADVERTISED_100baseT_Full |
4693 (tp->mii.supports_gmii ?
4694 ADVERTISED_1000baseT_Half |
4695 ADVERTISED_1000baseT_Full : 0));
Francois Romieu4ff96fa2006-07-26 22:05:06 +02004696
David S. Miller8decf862011-09-22 03:23:13 -04004697 if (rtl_tbi_enabled(tp))
Joe Perchesbf82c182010-02-09 11:49:50 +00004698 netif_info(tp, link, dev, "TBI auto-negotiating\n");
Francois Romieu4ff96fa2006-07-26 22:05:06 +02004699}
4700
Francois Romieu773d2022007-01-31 23:47:43 +01004701static void rtl_rar_set(struct rtl8169_private *tp, u8 *addr)
4702{
4703 void __iomem *ioaddr = tp->mmio_addr;
Francois Romieu773d2022007-01-31 23:47:43 +01004704
Francois Romieuda78dbf2012-01-26 14:18:23 +01004705 rtl_lock_work(tp);
Francois Romieu773d2022007-01-31 23:47:43 +01004706
4707 RTL_W8(Cfg9346, Cfg9346_Unlock);
françois romieu908ba2bf2010-04-26 11:42:58 +00004708
françois romieu9ecb9aa2012-12-07 11:20:21 +00004709 RTL_W32(MAC4, addr[4] | addr[5] << 8);
françois romieu908ba2bf2010-04-26 11:42:58 +00004710 RTL_R32(MAC4);
4711
françois romieu9ecb9aa2012-12-07 11:20:21 +00004712 RTL_W32(MAC0, addr[0] | addr[1] << 8 | addr[2] << 16 | addr[3] << 24);
françois romieu908ba2bf2010-04-26 11:42:58 +00004713 RTL_R32(MAC0);
4714
françois romieu9ecb9aa2012-12-07 11:20:21 +00004715 if (tp->mac_version == RTL_GIGA_MAC_VER_34)
4716 rtl_rar_exgmac_set(tp, addr);
françois romieuc28aa382011-08-02 03:53:43 +00004717
Francois Romieu773d2022007-01-31 23:47:43 +01004718 RTL_W8(Cfg9346, Cfg9346_Lock);
4719
Francois Romieuda78dbf2012-01-26 14:18:23 +01004720 rtl_unlock_work(tp);
Francois Romieu773d2022007-01-31 23:47:43 +01004721}
4722
4723static int rtl_set_mac_address(struct net_device *dev, void *p)
4724{
4725 struct rtl8169_private *tp = netdev_priv(dev);
Chun-Hao Linf51d4a12016-07-29 16:37:56 +08004726 struct device *d = &tp->pci_dev->dev;
Francois Romieu773d2022007-01-31 23:47:43 +01004727 struct sockaddr *addr = p;
4728
4729 if (!is_valid_ether_addr(addr->sa_data))
4730 return -EADDRNOTAVAIL;
4731
4732 memcpy(dev->dev_addr, addr->sa_data, dev->addr_len);
4733
Chun-Hao Linf51d4a12016-07-29 16:37:56 +08004734 pm_runtime_get_noresume(d);
4735
4736 if (pm_runtime_active(d))
4737 rtl_rar_set(tp, dev->dev_addr);
4738
4739 pm_runtime_put_noidle(d);
Francois Romieu773d2022007-01-31 23:47:43 +01004740
4741 return 0;
4742}
4743
Francois Romieu5f787a12006-08-17 13:02:36 +02004744static int rtl8169_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
4745{
4746 struct rtl8169_private *tp = netdev_priv(dev);
4747 struct mii_ioctl_data *data = if_mii(ifr);
4748
Francois Romieu8b4ab282008-11-19 22:05:25 -08004749 return netif_running(dev) ? tp->do_ioctl(tp, data, cmd) : -ENODEV;
4750}
Francois Romieu5f787a12006-08-17 13:02:36 +02004751
Francois Romieucecb5fd2011-04-01 10:21:07 +02004752static int rtl_xmii_ioctl(struct rtl8169_private *tp,
4753 struct mii_ioctl_data *data, int cmd)
Francois Romieu8b4ab282008-11-19 22:05:25 -08004754{
Francois Romieu5f787a12006-08-17 13:02:36 +02004755 switch (cmd) {
4756 case SIOCGMIIPHY:
4757 data->phy_id = 32; /* Internal PHY */
4758 return 0;
4759
4760 case SIOCGMIIREG:
françois romieu4da19632011-01-03 15:07:55 +00004761 data->val_out = rtl_readphy(tp, data->reg_num & 0x1f);
Francois Romieu5f787a12006-08-17 13:02:36 +02004762 return 0;
4763
4764 case SIOCSMIIREG:
françois romieu4da19632011-01-03 15:07:55 +00004765 rtl_writephy(tp, data->reg_num & 0x1f, data->val_in);
Francois Romieu5f787a12006-08-17 13:02:36 +02004766 return 0;
4767 }
4768 return -EOPNOTSUPP;
4769}
4770
Francois Romieu8b4ab282008-11-19 22:05:25 -08004771static int rtl_tbi_ioctl(struct rtl8169_private *tp, struct mii_ioctl_data *data, int cmd)
4772{
4773 return -EOPNOTSUPP;
4774}
4775
Francois Romieufbac58f2007-10-04 22:51:38 +02004776static void rtl_disable_msi(struct pci_dev *pdev, struct rtl8169_private *tp)
4777{
4778 if (tp->features & RTL_FEATURE_MSI) {
4779 pci_disable_msi(pdev);
4780 tp->features &= ~RTL_FEATURE_MSI;
4781 }
4782}
4783
Bill Pembertonbaf63292012-12-03 09:23:28 -05004784static void rtl_init_mdio_ops(struct rtl8169_private *tp)
françois romieuc0e45c12011-01-03 15:08:04 +00004785{
4786 struct mdio_ops *ops = &tp->mdio_ops;
4787
4788 switch (tp->mac_version) {
4789 case RTL_GIGA_MAC_VER_27:
4790 ops->write = r8168dp_1_mdio_write;
4791 ops->read = r8168dp_1_mdio_read;
4792 break;
françois romieue6de30d2011-01-03 15:08:37 +00004793 case RTL_GIGA_MAC_VER_28:
hayeswang4804b3b2011-03-21 01:50:29 +00004794 case RTL_GIGA_MAC_VER_31:
françois romieue6de30d2011-01-03 15:08:37 +00004795 ops->write = r8168dp_2_mdio_write;
4796 ops->read = r8168dp_2_mdio_read;
4797 break;
Hayes Wangc5583862012-07-02 17:23:22 +08004798 case RTL_GIGA_MAC_VER_40:
4799 case RTL_GIGA_MAC_VER_41:
hayeswang57538c42013-04-01 22:23:40 +00004800 case RTL_GIGA_MAC_VER_42:
hayeswang58152cd2013-04-01 22:23:42 +00004801 case RTL_GIGA_MAC_VER_43:
hayeswang45dd95c2013-07-08 17:09:01 +08004802 case RTL_GIGA_MAC_VER_44:
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004803 case RTL_GIGA_MAC_VER_45:
4804 case RTL_GIGA_MAC_VER_46:
4805 case RTL_GIGA_MAC_VER_47:
4806 case RTL_GIGA_MAC_VER_48:
Chun-Hao Lin935e2212014-10-07 15:10:41 +08004807 case RTL_GIGA_MAC_VER_49:
4808 case RTL_GIGA_MAC_VER_50:
4809 case RTL_GIGA_MAC_VER_51:
Hayes Wangc5583862012-07-02 17:23:22 +08004810 ops->write = r8168g_mdio_write;
4811 ops->read = r8168g_mdio_read;
4812 break;
françois romieuc0e45c12011-01-03 15:08:04 +00004813 default:
4814 ops->write = r8169_mdio_write;
4815 ops->read = r8169_mdio_read;
4816 break;
4817 }
4818}
4819
hayeswange2409d82013-03-31 17:02:04 +00004820static void rtl_speed_down(struct rtl8169_private *tp)
4821{
4822 u32 adv;
4823 int lpa;
4824
4825 rtl_writephy(tp, 0x1f, 0x0000);
4826 lpa = rtl_readphy(tp, MII_LPA);
4827
4828 if (lpa & (LPA_10HALF | LPA_10FULL))
4829 adv = ADVERTISED_10baseT_Half | ADVERTISED_10baseT_Full;
4830 else if (lpa & (LPA_100HALF | LPA_100FULL))
4831 adv = ADVERTISED_10baseT_Half | ADVERTISED_10baseT_Full |
4832 ADVERTISED_100baseT_Half | ADVERTISED_100baseT_Full;
4833 else
4834 adv = ADVERTISED_10baseT_Half | ADVERTISED_10baseT_Full |
4835 ADVERTISED_100baseT_Half | ADVERTISED_100baseT_Full |
4836 (tp->mii.supports_gmii ?
4837 ADVERTISED_1000baseT_Half |
4838 ADVERTISED_1000baseT_Full : 0);
4839
4840 rtl8169_set_speed(tp->dev, AUTONEG_ENABLE, SPEED_1000, DUPLEX_FULL,
4841 adv);
4842}
4843
David S. Miller1805b2f2011-10-24 18:18:09 -04004844static void rtl_wol_suspend_quirk(struct rtl8169_private *tp)
4845{
4846 void __iomem *ioaddr = tp->mmio_addr;
4847
4848 switch (tp->mac_version) {
Cyril Bruleboisb00e69d2012-10-31 14:00:46 +00004849 case RTL_GIGA_MAC_VER_25:
4850 case RTL_GIGA_MAC_VER_26:
David S. Miller1805b2f2011-10-24 18:18:09 -04004851 case RTL_GIGA_MAC_VER_29:
4852 case RTL_GIGA_MAC_VER_30:
4853 case RTL_GIGA_MAC_VER_32:
4854 case RTL_GIGA_MAC_VER_33:
4855 case RTL_GIGA_MAC_VER_34:
Hayes Wang7e18dca2012-03-30 14:33:02 +08004856 case RTL_GIGA_MAC_VER_37:
Hayes Wangb3d7b2f2012-03-30 14:48:06 +08004857 case RTL_GIGA_MAC_VER_38:
Hayes Wang5598bfe2012-07-02 17:23:21 +08004858 case RTL_GIGA_MAC_VER_39:
Hayes Wangc5583862012-07-02 17:23:22 +08004859 case RTL_GIGA_MAC_VER_40:
4860 case RTL_GIGA_MAC_VER_41:
hayeswang57538c42013-04-01 22:23:40 +00004861 case RTL_GIGA_MAC_VER_42:
hayeswang58152cd2013-04-01 22:23:42 +00004862 case RTL_GIGA_MAC_VER_43:
hayeswang45dd95c2013-07-08 17:09:01 +08004863 case RTL_GIGA_MAC_VER_44:
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004864 case RTL_GIGA_MAC_VER_45:
4865 case RTL_GIGA_MAC_VER_46:
4866 case RTL_GIGA_MAC_VER_47:
4867 case RTL_GIGA_MAC_VER_48:
Chun-Hao Lin935e2212014-10-07 15:10:41 +08004868 case RTL_GIGA_MAC_VER_49:
4869 case RTL_GIGA_MAC_VER_50:
4870 case RTL_GIGA_MAC_VER_51:
David S. Miller1805b2f2011-10-24 18:18:09 -04004871 RTL_W32(RxConfig, RTL_R32(RxConfig) |
4872 AcceptBroadcast | AcceptMulticast | AcceptMyPhys);
4873 break;
4874 default:
4875 break;
4876 }
4877}
4878
4879static bool rtl_wol_pll_power_down(struct rtl8169_private *tp)
4880{
4881 if (!(__rtl8169_get_wol(tp) & WAKE_ANY))
4882 return false;
4883
hayeswange2409d82013-03-31 17:02:04 +00004884 rtl_speed_down(tp);
David S. Miller1805b2f2011-10-24 18:18:09 -04004885 rtl_wol_suspend_quirk(tp);
4886
4887 return true;
4888}
4889
françois romieu065c27c2011-01-03 15:08:12 +00004890static void r810x_phy_power_down(struct rtl8169_private *tp)
4891{
4892 rtl_writephy(tp, 0x1f, 0x0000);
4893 rtl_writephy(tp, MII_BMCR, BMCR_PDOWN);
4894}
4895
4896static void r810x_phy_power_up(struct rtl8169_private *tp)
4897{
4898 rtl_writephy(tp, 0x1f, 0x0000);
4899 rtl_writephy(tp, MII_BMCR, BMCR_ANENABLE);
4900}
4901
4902static void r810x_pll_power_down(struct rtl8169_private *tp)
4903{
Hayes Wang00042992012-03-30 14:33:00 +08004904 void __iomem *ioaddr = tp->mmio_addr;
4905
David S. Miller1805b2f2011-10-24 18:18:09 -04004906 if (rtl_wol_pll_power_down(tp))
françois romieu065c27c2011-01-03 15:08:12 +00004907 return;
françois romieu065c27c2011-01-03 15:08:12 +00004908
4909 r810x_phy_power_down(tp);
Hayes Wang00042992012-03-30 14:33:00 +08004910
4911 switch (tp->mac_version) {
4912 case RTL_GIGA_MAC_VER_07:
4913 case RTL_GIGA_MAC_VER_08:
4914 case RTL_GIGA_MAC_VER_09:
4915 case RTL_GIGA_MAC_VER_10:
4916 case RTL_GIGA_MAC_VER_13:
4917 case RTL_GIGA_MAC_VER_16:
4918 break;
4919 default:
4920 RTL_W8(PMCH, RTL_R8(PMCH) & ~0x80);
4921 break;
4922 }
françois romieu065c27c2011-01-03 15:08:12 +00004923}
4924
4925static void r810x_pll_power_up(struct rtl8169_private *tp)
4926{
Hayes Wang00042992012-03-30 14:33:00 +08004927 void __iomem *ioaddr = tp->mmio_addr;
4928
françois romieu065c27c2011-01-03 15:08:12 +00004929 r810x_phy_power_up(tp);
Hayes Wang00042992012-03-30 14:33:00 +08004930
4931 switch (tp->mac_version) {
4932 case RTL_GIGA_MAC_VER_07:
4933 case RTL_GIGA_MAC_VER_08:
4934 case RTL_GIGA_MAC_VER_09:
4935 case RTL_GIGA_MAC_VER_10:
4936 case RTL_GIGA_MAC_VER_13:
4937 case RTL_GIGA_MAC_VER_16:
4938 break;
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004939 case RTL_GIGA_MAC_VER_47:
4940 case RTL_GIGA_MAC_VER_48:
Chun-Hao Lin05b96872014-10-01 23:17:12 +08004941 RTL_W8(PMCH, RTL_R8(PMCH) | 0xc0);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08004942 break;
Hayes Wang00042992012-03-30 14:33:00 +08004943 default:
4944 RTL_W8(PMCH, RTL_R8(PMCH) | 0x80);
4945 break;
4946 }
françois romieu065c27c2011-01-03 15:08:12 +00004947}
4948
4949static void r8168_phy_power_up(struct rtl8169_private *tp)
4950{
4951 rtl_writephy(tp, 0x1f, 0x0000);
hayeswang01dc7fe2011-03-21 01:50:28 +00004952 switch (tp->mac_version) {
4953 case RTL_GIGA_MAC_VER_11:
4954 case RTL_GIGA_MAC_VER_12:
4955 case RTL_GIGA_MAC_VER_17:
4956 case RTL_GIGA_MAC_VER_18:
4957 case RTL_GIGA_MAC_VER_19:
4958 case RTL_GIGA_MAC_VER_20:
4959 case RTL_GIGA_MAC_VER_21:
4960 case RTL_GIGA_MAC_VER_22:
4961 case RTL_GIGA_MAC_VER_23:
4962 case RTL_GIGA_MAC_VER_24:
4963 case RTL_GIGA_MAC_VER_25:
4964 case RTL_GIGA_MAC_VER_26:
4965 case RTL_GIGA_MAC_VER_27:
4966 case RTL_GIGA_MAC_VER_28:
4967 case RTL_GIGA_MAC_VER_31:
4968 rtl_writephy(tp, 0x0e, 0x0000);
4969 break;
4970 default:
4971 break;
4972 }
françois romieu065c27c2011-01-03 15:08:12 +00004973 rtl_writephy(tp, MII_BMCR, BMCR_ANENABLE);
4974}
4975
4976static void r8168_phy_power_down(struct rtl8169_private *tp)
4977{
4978 rtl_writephy(tp, 0x1f, 0x0000);
hayeswang01dc7fe2011-03-21 01:50:28 +00004979 switch (tp->mac_version) {
4980 case RTL_GIGA_MAC_VER_32:
4981 case RTL_GIGA_MAC_VER_33:
hayeswangbeb330a2013-04-01 22:23:39 +00004982 case RTL_GIGA_MAC_VER_40:
4983 case RTL_GIGA_MAC_VER_41:
hayeswang01dc7fe2011-03-21 01:50:28 +00004984 rtl_writephy(tp, MII_BMCR, BMCR_ANENABLE | BMCR_PDOWN);
4985 break;
4986
4987 case RTL_GIGA_MAC_VER_11:
4988 case RTL_GIGA_MAC_VER_12:
4989 case RTL_GIGA_MAC_VER_17:
4990 case RTL_GIGA_MAC_VER_18:
4991 case RTL_GIGA_MAC_VER_19:
4992 case RTL_GIGA_MAC_VER_20:
4993 case RTL_GIGA_MAC_VER_21:
4994 case RTL_GIGA_MAC_VER_22:
4995 case RTL_GIGA_MAC_VER_23:
4996 case RTL_GIGA_MAC_VER_24:
4997 case RTL_GIGA_MAC_VER_25:
4998 case RTL_GIGA_MAC_VER_26:
4999 case RTL_GIGA_MAC_VER_27:
5000 case RTL_GIGA_MAC_VER_28:
5001 case RTL_GIGA_MAC_VER_31:
5002 rtl_writephy(tp, 0x0e, 0x0200);
5003 default:
5004 rtl_writephy(tp, MII_BMCR, BMCR_PDOWN);
5005 break;
5006 }
françois romieu065c27c2011-01-03 15:08:12 +00005007}
5008
5009static void r8168_pll_power_down(struct rtl8169_private *tp)
5010{
5011 void __iomem *ioaddr = tp->mmio_addr;
5012
Francois Romieucecb5fd2011-04-01 10:21:07 +02005013 if ((tp->mac_version == RTL_GIGA_MAC_VER_27 ||
5014 tp->mac_version == RTL_GIGA_MAC_VER_28 ||
Chun-Hao Lin935e2212014-10-07 15:10:41 +08005015 tp->mac_version == RTL_GIGA_MAC_VER_31 ||
5016 tp->mac_version == RTL_GIGA_MAC_VER_49 ||
5017 tp->mac_version == RTL_GIGA_MAC_VER_50 ||
5018 tp->mac_version == RTL_GIGA_MAC_VER_51) &&
Chun-Hao Lin2f8c0402014-10-01 23:17:19 +08005019 r8168_check_dash(tp)) {
françois romieu065c27c2011-01-03 15:08:12 +00005020 return;
Hayes Wang5d2e1952011-02-22 17:26:22 +08005021 }
françois romieu065c27c2011-01-03 15:08:12 +00005022
Francois Romieucecb5fd2011-04-01 10:21:07 +02005023 if ((tp->mac_version == RTL_GIGA_MAC_VER_23 ||
5024 tp->mac_version == RTL_GIGA_MAC_VER_24) &&
françois romieu065c27c2011-01-03 15:08:12 +00005025 (RTL_R16(CPlusCmd) & ASF)) {
5026 return;
5027 }
5028
hayeswang01dc7fe2011-03-21 01:50:28 +00005029 if (tp->mac_version == RTL_GIGA_MAC_VER_32 ||
5030 tp->mac_version == RTL_GIGA_MAC_VER_33)
Francois Romieufdf6fc02012-07-06 22:40:38 +02005031 rtl_ephy_write(tp, 0x19, 0xff64);
hayeswang01dc7fe2011-03-21 01:50:28 +00005032
David S. Miller1805b2f2011-10-24 18:18:09 -04005033 if (rtl_wol_pll_power_down(tp))
françois romieu065c27c2011-01-03 15:08:12 +00005034 return;
françois romieu065c27c2011-01-03 15:08:12 +00005035
5036 r8168_phy_power_down(tp);
5037
5038 switch (tp->mac_version) {
5039 case RTL_GIGA_MAC_VER_25:
5040 case RTL_GIGA_MAC_VER_26:
Hayes Wang5d2e1952011-02-22 17:26:22 +08005041 case RTL_GIGA_MAC_VER_27:
5042 case RTL_GIGA_MAC_VER_28:
hayeswang4804b3b2011-03-21 01:50:29 +00005043 case RTL_GIGA_MAC_VER_31:
hayeswang01dc7fe2011-03-21 01:50:28 +00005044 case RTL_GIGA_MAC_VER_32:
5045 case RTL_GIGA_MAC_VER_33:
Chun-Hao Lin42fde732014-10-01 23:17:14 +08005046 case RTL_GIGA_MAC_VER_44:
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08005047 case RTL_GIGA_MAC_VER_45:
5048 case RTL_GIGA_MAC_VER_46:
Chun-Hao Lin935e2212014-10-07 15:10:41 +08005049 case RTL_GIGA_MAC_VER_50:
5050 case RTL_GIGA_MAC_VER_51:
françois romieu065c27c2011-01-03 15:08:12 +00005051 RTL_W8(PMCH, RTL_R8(PMCH) & ~0x80);
5052 break;
hayeswangbeb330a2013-04-01 22:23:39 +00005053 case RTL_GIGA_MAC_VER_40:
5054 case RTL_GIGA_MAC_VER_41:
Chun-Hao Lin935e2212014-10-07 15:10:41 +08005055 case RTL_GIGA_MAC_VER_49:
Chun-Hao Lin706123d2014-10-01 23:17:18 +08005056 rtl_w0w1_eri(tp, 0x1a8, ERIAR_MASK_1111, 0x00000000,
hayeswangbeb330a2013-04-01 22:23:39 +00005057 0xfc000000, ERIAR_EXGMAC);
Chun-Hao Linb8e5e6a2014-10-01 23:17:13 +08005058 RTL_W8(PMCH, RTL_R8(PMCH) & ~0x80);
hayeswangbeb330a2013-04-01 22:23:39 +00005059 break;
françois romieu065c27c2011-01-03 15:08:12 +00005060 }
5061}
5062
5063static void r8168_pll_power_up(struct rtl8169_private *tp)
5064{
5065 void __iomem *ioaddr = tp->mmio_addr;
5066
françois romieu065c27c2011-01-03 15:08:12 +00005067 switch (tp->mac_version) {
5068 case RTL_GIGA_MAC_VER_25:
5069 case RTL_GIGA_MAC_VER_26:
Hayes Wang5d2e1952011-02-22 17:26:22 +08005070 case RTL_GIGA_MAC_VER_27:
5071 case RTL_GIGA_MAC_VER_28:
hayeswang4804b3b2011-03-21 01:50:29 +00005072 case RTL_GIGA_MAC_VER_31:
hayeswang01dc7fe2011-03-21 01:50:28 +00005073 case RTL_GIGA_MAC_VER_32:
5074 case RTL_GIGA_MAC_VER_33:
françois romieu065c27c2011-01-03 15:08:12 +00005075 RTL_W8(PMCH, RTL_R8(PMCH) | 0x80);
5076 break;
Chun-Hao Lin42fde732014-10-01 23:17:14 +08005077 case RTL_GIGA_MAC_VER_44:
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08005078 case RTL_GIGA_MAC_VER_45:
5079 case RTL_GIGA_MAC_VER_46:
Chun-Hao Lin935e2212014-10-07 15:10:41 +08005080 case RTL_GIGA_MAC_VER_50:
5081 case RTL_GIGA_MAC_VER_51:
Chun-Hao Lin05b96872014-10-01 23:17:12 +08005082 RTL_W8(PMCH, RTL_R8(PMCH) | 0xc0);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08005083 break;
hayeswangbeb330a2013-04-01 22:23:39 +00005084 case RTL_GIGA_MAC_VER_40:
5085 case RTL_GIGA_MAC_VER_41:
Chun-Hao Lin935e2212014-10-07 15:10:41 +08005086 case RTL_GIGA_MAC_VER_49:
Chun-Hao Linb8e5e6a2014-10-01 23:17:13 +08005087 RTL_W8(PMCH, RTL_R8(PMCH) | 0xc0);
Chun-Hao Lin706123d2014-10-01 23:17:18 +08005088 rtl_w0w1_eri(tp, 0x1a8, ERIAR_MASK_1111, 0xfc000000,
hayeswangbeb330a2013-04-01 22:23:39 +00005089 0x00000000, ERIAR_EXGMAC);
5090 break;
françois romieu065c27c2011-01-03 15:08:12 +00005091 }
5092
5093 r8168_phy_power_up(tp);
5094}
5095
Francois Romieud58d46b2011-05-03 16:38:29 +02005096static void rtl_generic_op(struct rtl8169_private *tp,
5097 void (*op)(struct rtl8169_private *))
françois romieu065c27c2011-01-03 15:08:12 +00005098{
5099 if (op)
5100 op(tp);
5101}
5102
5103static void rtl_pll_power_down(struct rtl8169_private *tp)
5104{
Francois Romieud58d46b2011-05-03 16:38:29 +02005105 rtl_generic_op(tp, tp->pll_power_ops.down);
françois romieu065c27c2011-01-03 15:08:12 +00005106}
5107
5108static void rtl_pll_power_up(struct rtl8169_private *tp)
5109{
Francois Romieud58d46b2011-05-03 16:38:29 +02005110 rtl_generic_op(tp, tp->pll_power_ops.up);
françois romieu065c27c2011-01-03 15:08:12 +00005111}
5112
Bill Pembertonbaf63292012-12-03 09:23:28 -05005113static void rtl_init_pll_power_ops(struct rtl8169_private *tp)
françois romieu065c27c2011-01-03 15:08:12 +00005114{
5115 struct pll_power_ops *ops = &tp->pll_power_ops;
5116
5117 switch (tp->mac_version) {
5118 case RTL_GIGA_MAC_VER_07:
5119 case RTL_GIGA_MAC_VER_08:
5120 case RTL_GIGA_MAC_VER_09:
5121 case RTL_GIGA_MAC_VER_10:
5122 case RTL_GIGA_MAC_VER_16:
Hayes Wang5a5e4442011-02-22 17:26:21 +08005123 case RTL_GIGA_MAC_VER_29:
5124 case RTL_GIGA_MAC_VER_30:
Hayes Wang7e18dca2012-03-30 14:33:02 +08005125 case RTL_GIGA_MAC_VER_37:
Hayes Wang5598bfe2012-07-02 17:23:21 +08005126 case RTL_GIGA_MAC_VER_39:
hayeswang58152cd2013-04-01 22:23:42 +00005127 case RTL_GIGA_MAC_VER_43:
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08005128 case RTL_GIGA_MAC_VER_47:
5129 case RTL_GIGA_MAC_VER_48:
françois romieu065c27c2011-01-03 15:08:12 +00005130 ops->down = r810x_pll_power_down;
5131 ops->up = r810x_pll_power_up;
5132 break;
5133
5134 case RTL_GIGA_MAC_VER_11:
5135 case RTL_GIGA_MAC_VER_12:
5136 case RTL_GIGA_MAC_VER_17:
5137 case RTL_GIGA_MAC_VER_18:
5138 case RTL_GIGA_MAC_VER_19:
5139 case RTL_GIGA_MAC_VER_20:
5140 case RTL_GIGA_MAC_VER_21:
5141 case RTL_GIGA_MAC_VER_22:
5142 case RTL_GIGA_MAC_VER_23:
5143 case RTL_GIGA_MAC_VER_24:
5144 case RTL_GIGA_MAC_VER_25:
5145 case RTL_GIGA_MAC_VER_26:
5146 case RTL_GIGA_MAC_VER_27:
françois romieue6de30d2011-01-03 15:08:37 +00005147 case RTL_GIGA_MAC_VER_28:
hayeswang4804b3b2011-03-21 01:50:29 +00005148 case RTL_GIGA_MAC_VER_31:
hayeswang01dc7fe2011-03-21 01:50:28 +00005149 case RTL_GIGA_MAC_VER_32:
5150 case RTL_GIGA_MAC_VER_33:
Hayes Wang70090422011-07-06 15:58:06 +08005151 case RTL_GIGA_MAC_VER_34:
Hayes Wangc2218922011-09-06 16:55:18 +08005152 case RTL_GIGA_MAC_VER_35:
5153 case RTL_GIGA_MAC_VER_36:
Hayes Wangb3d7b2f2012-03-30 14:48:06 +08005154 case RTL_GIGA_MAC_VER_38:
Hayes Wangc5583862012-07-02 17:23:22 +08005155 case RTL_GIGA_MAC_VER_40:
5156 case RTL_GIGA_MAC_VER_41:
hayeswang57538c42013-04-01 22:23:40 +00005157 case RTL_GIGA_MAC_VER_42:
hayeswang45dd95c2013-07-08 17:09:01 +08005158 case RTL_GIGA_MAC_VER_44:
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08005159 case RTL_GIGA_MAC_VER_45:
5160 case RTL_GIGA_MAC_VER_46:
Chun-Hao Lin935e2212014-10-07 15:10:41 +08005161 case RTL_GIGA_MAC_VER_49:
5162 case RTL_GIGA_MAC_VER_50:
5163 case RTL_GIGA_MAC_VER_51:
françois romieu065c27c2011-01-03 15:08:12 +00005164 ops->down = r8168_pll_power_down;
5165 ops->up = r8168_pll_power_up;
5166 break;
5167
5168 default:
5169 ops->down = NULL;
5170 ops->up = NULL;
5171 break;
5172 }
5173}
5174
Hayes Wange542a222011-07-06 15:58:04 +08005175static void rtl_init_rxcfg(struct rtl8169_private *tp)
5176{
5177 void __iomem *ioaddr = tp->mmio_addr;
5178
5179 switch (tp->mac_version) {
5180 case RTL_GIGA_MAC_VER_01:
5181 case RTL_GIGA_MAC_VER_02:
5182 case RTL_GIGA_MAC_VER_03:
5183 case RTL_GIGA_MAC_VER_04:
5184 case RTL_GIGA_MAC_VER_05:
5185 case RTL_GIGA_MAC_VER_06:
5186 case RTL_GIGA_MAC_VER_10:
5187 case RTL_GIGA_MAC_VER_11:
5188 case RTL_GIGA_MAC_VER_12:
5189 case RTL_GIGA_MAC_VER_13:
5190 case RTL_GIGA_MAC_VER_14:
5191 case RTL_GIGA_MAC_VER_15:
5192 case RTL_GIGA_MAC_VER_16:
5193 case RTL_GIGA_MAC_VER_17:
5194 RTL_W32(RxConfig, RX_FIFO_THRESH | RX_DMA_BURST);
5195 break;
5196 case RTL_GIGA_MAC_VER_18:
5197 case RTL_GIGA_MAC_VER_19:
5198 case RTL_GIGA_MAC_VER_20:
5199 case RTL_GIGA_MAC_VER_21:
5200 case RTL_GIGA_MAC_VER_22:
5201 case RTL_GIGA_MAC_VER_23:
5202 case RTL_GIGA_MAC_VER_24:
françois romieueb2dc352012-06-20 12:09:18 +00005203 case RTL_GIGA_MAC_VER_34:
françois romieu3ced8c92013-09-08 01:15:35 +02005204 case RTL_GIGA_MAC_VER_35:
Hayes Wange542a222011-07-06 15:58:04 +08005205 RTL_W32(RxConfig, RX128_INT_EN | RX_MULTI_EN | RX_DMA_BURST);
5206 break;
hayeswangbeb330a2013-04-01 22:23:39 +00005207 case RTL_GIGA_MAC_VER_40:
5208 case RTL_GIGA_MAC_VER_41:
hayeswang57538c42013-04-01 22:23:40 +00005209 case RTL_GIGA_MAC_VER_42:
hayeswang58152cd2013-04-01 22:23:42 +00005210 case RTL_GIGA_MAC_VER_43:
hayeswang45dd95c2013-07-08 17:09:01 +08005211 case RTL_GIGA_MAC_VER_44:
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08005212 case RTL_GIGA_MAC_VER_45:
5213 case RTL_GIGA_MAC_VER_46:
5214 case RTL_GIGA_MAC_VER_47:
5215 case RTL_GIGA_MAC_VER_48:
Chun-Hao Lin935e2212014-10-07 15:10:41 +08005216 case RTL_GIGA_MAC_VER_49:
5217 case RTL_GIGA_MAC_VER_50:
5218 case RTL_GIGA_MAC_VER_51:
Ivan Vecera7ebc4822015-08-04 22:11:43 +02005219 RTL_W32(RxConfig, RX128_INT_EN | RX_MULTI_EN | RX_DMA_BURST | RX_EARLY_OFF);
hayeswangbeb330a2013-04-01 22:23:39 +00005220 break;
Hayes Wange542a222011-07-06 15:58:04 +08005221 default:
5222 RTL_W32(RxConfig, RX128_INT_EN | RX_DMA_BURST);
5223 break;
5224 }
5225}
5226
Hayes Wang92fc43b2011-07-06 15:58:03 +08005227static void rtl8169_init_ring_indexes(struct rtl8169_private *tp)
5228{
Timo Teräs9fba0812013-01-15 21:01:24 +00005229 tp->dirty_tx = tp->cur_tx = tp->cur_rx = 0;
Hayes Wang92fc43b2011-07-06 15:58:03 +08005230}
5231
Francois Romieud58d46b2011-05-03 16:38:29 +02005232static void rtl_hw_jumbo_enable(struct rtl8169_private *tp)
5233{
françois romieu9c5028e2012-03-02 04:43:14 +00005234 void __iomem *ioaddr = tp->mmio_addr;
5235
5236 RTL_W8(Cfg9346, Cfg9346_Unlock);
Francois Romieud58d46b2011-05-03 16:38:29 +02005237 rtl_generic_op(tp, tp->jumbo_ops.enable);
françois romieu9c5028e2012-03-02 04:43:14 +00005238 RTL_W8(Cfg9346, Cfg9346_Lock);
Francois Romieud58d46b2011-05-03 16:38:29 +02005239}
5240
5241static void rtl_hw_jumbo_disable(struct rtl8169_private *tp)
5242{
françois romieu9c5028e2012-03-02 04:43:14 +00005243 void __iomem *ioaddr = tp->mmio_addr;
5244
5245 RTL_W8(Cfg9346, Cfg9346_Unlock);
Francois Romieud58d46b2011-05-03 16:38:29 +02005246 rtl_generic_op(tp, tp->jumbo_ops.disable);
françois romieu9c5028e2012-03-02 04:43:14 +00005247 RTL_W8(Cfg9346, Cfg9346_Lock);
Francois Romieud58d46b2011-05-03 16:38:29 +02005248}
5249
5250static void r8168c_hw_jumbo_enable(struct rtl8169_private *tp)
5251{
5252 void __iomem *ioaddr = tp->mmio_addr;
5253
5254 RTL_W8(Config3, RTL_R8(Config3) | Jumbo_En0);
5255 RTL_W8(Config4, RTL_R8(Config4) | Jumbo_En1);
Rafał Miłeckif65d5392015-01-26 18:06:31 +01005256 rtl_tx_performance_tweak(tp->pci_dev, PCI_EXP_DEVCTL_READRQ_512B);
Francois Romieud58d46b2011-05-03 16:38:29 +02005257}
5258
5259static void r8168c_hw_jumbo_disable(struct rtl8169_private *tp)
5260{
5261 void __iomem *ioaddr = tp->mmio_addr;
5262
5263 RTL_W8(Config3, RTL_R8(Config3) & ~Jumbo_En0);
5264 RTL_W8(Config4, RTL_R8(Config4) & ~Jumbo_En1);
5265 rtl_tx_performance_tweak(tp->pci_dev, 0x5 << MAX_READ_REQUEST_SHIFT);
5266}
5267
5268static void r8168dp_hw_jumbo_enable(struct rtl8169_private *tp)
5269{
5270 void __iomem *ioaddr = tp->mmio_addr;
5271
5272 RTL_W8(Config3, RTL_R8(Config3) | Jumbo_En0);
5273}
5274
5275static void r8168dp_hw_jumbo_disable(struct rtl8169_private *tp)
5276{
5277 void __iomem *ioaddr = tp->mmio_addr;
5278
5279 RTL_W8(Config3, RTL_R8(Config3) & ~Jumbo_En0);
5280}
5281
5282static void r8168e_hw_jumbo_enable(struct rtl8169_private *tp)
5283{
5284 void __iomem *ioaddr = tp->mmio_addr;
Francois Romieud58d46b2011-05-03 16:38:29 +02005285
5286 RTL_W8(MaxTxPacketSize, 0x3f);
5287 RTL_W8(Config3, RTL_R8(Config3) | Jumbo_En0);
5288 RTL_W8(Config4, RTL_R8(Config4) | 0x01);
Rafał Miłeckif65d5392015-01-26 18:06:31 +01005289 rtl_tx_performance_tweak(tp->pci_dev, PCI_EXP_DEVCTL_READRQ_512B);
Francois Romieud58d46b2011-05-03 16:38:29 +02005290}
5291
5292static void r8168e_hw_jumbo_disable(struct rtl8169_private *tp)
5293{
5294 void __iomem *ioaddr = tp->mmio_addr;
Francois Romieud58d46b2011-05-03 16:38:29 +02005295
5296 RTL_W8(MaxTxPacketSize, 0x0c);
5297 RTL_W8(Config3, RTL_R8(Config3) & ~Jumbo_En0);
5298 RTL_W8(Config4, RTL_R8(Config4) & ~0x01);
Francois Romieu4512ff92011-12-22 18:59:37 +01005299 rtl_tx_performance_tweak(tp->pci_dev, 0x5 << MAX_READ_REQUEST_SHIFT);
Francois Romieud58d46b2011-05-03 16:38:29 +02005300}
5301
5302static void r8168b_0_hw_jumbo_enable(struct rtl8169_private *tp)
5303{
5304 rtl_tx_performance_tweak(tp->pci_dev,
Rafał Miłeckif65d5392015-01-26 18:06:31 +01005305 PCI_EXP_DEVCTL_READRQ_512B | PCI_EXP_DEVCTL_NOSNOOP_EN);
Francois Romieud58d46b2011-05-03 16:38:29 +02005306}
5307
5308static void r8168b_0_hw_jumbo_disable(struct rtl8169_private *tp)
5309{
5310 rtl_tx_performance_tweak(tp->pci_dev,
5311 (0x5 << MAX_READ_REQUEST_SHIFT) | PCI_EXP_DEVCTL_NOSNOOP_EN);
5312}
5313
5314static void r8168b_1_hw_jumbo_enable(struct rtl8169_private *tp)
5315{
5316 void __iomem *ioaddr = tp->mmio_addr;
5317
5318 r8168b_0_hw_jumbo_enable(tp);
5319
5320 RTL_W8(Config4, RTL_R8(Config4) | (1 << 0));
5321}
5322
5323static void r8168b_1_hw_jumbo_disable(struct rtl8169_private *tp)
5324{
5325 void __iomem *ioaddr = tp->mmio_addr;
5326
5327 r8168b_0_hw_jumbo_disable(tp);
5328
5329 RTL_W8(Config4, RTL_R8(Config4) & ~(1 << 0));
5330}
5331
Bill Pembertonbaf63292012-12-03 09:23:28 -05005332static void rtl_init_jumbo_ops(struct rtl8169_private *tp)
Francois Romieud58d46b2011-05-03 16:38:29 +02005333{
5334 struct jumbo_ops *ops = &tp->jumbo_ops;
5335
5336 switch (tp->mac_version) {
5337 case RTL_GIGA_MAC_VER_11:
5338 ops->disable = r8168b_0_hw_jumbo_disable;
5339 ops->enable = r8168b_0_hw_jumbo_enable;
5340 break;
5341 case RTL_GIGA_MAC_VER_12:
5342 case RTL_GIGA_MAC_VER_17:
5343 ops->disable = r8168b_1_hw_jumbo_disable;
5344 ops->enable = r8168b_1_hw_jumbo_enable;
5345 break;
5346 case RTL_GIGA_MAC_VER_18: /* Wild guess. Needs info from Realtek. */
5347 case RTL_GIGA_MAC_VER_19:
5348 case RTL_GIGA_MAC_VER_20:
5349 case RTL_GIGA_MAC_VER_21: /* Wild guess. Needs info from Realtek. */
5350 case RTL_GIGA_MAC_VER_22:
5351 case RTL_GIGA_MAC_VER_23:
5352 case RTL_GIGA_MAC_VER_24:
5353 case RTL_GIGA_MAC_VER_25:
5354 case RTL_GIGA_MAC_VER_26:
5355 ops->disable = r8168c_hw_jumbo_disable;
5356 ops->enable = r8168c_hw_jumbo_enable;
5357 break;
5358 case RTL_GIGA_MAC_VER_27:
5359 case RTL_GIGA_MAC_VER_28:
5360 ops->disable = r8168dp_hw_jumbo_disable;
5361 ops->enable = r8168dp_hw_jumbo_enable;
5362 break;
5363 case RTL_GIGA_MAC_VER_31: /* Wild guess. Needs info from Realtek. */
5364 case RTL_GIGA_MAC_VER_32:
5365 case RTL_GIGA_MAC_VER_33:
5366 case RTL_GIGA_MAC_VER_34:
5367 ops->disable = r8168e_hw_jumbo_disable;
5368 ops->enable = r8168e_hw_jumbo_enable;
5369 break;
5370
5371 /*
5372 * No action needed for jumbo frames with 8169.
5373 * No jumbo for 810x at all.
5374 */
Hayes Wangc5583862012-07-02 17:23:22 +08005375 case RTL_GIGA_MAC_VER_40:
5376 case RTL_GIGA_MAC_VER_41:
hayeswang57538c42013-04-01 22:23:40 +00005377 case RTL_GIGA_MAC_VER_42:
hayeswang58152cd2013-04-01 22:23:42 +00005378 case RTL_GIGA_MAC_VER_43:
hayeswang45dd95c2013-07-08 17:09:01 +08005379 case RTL_GIGA_MAC_VER_44:
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08005380 case RTL_GIGA_MAC_VER_45:
5381 case RTL_GIGA_MAC_VER_46:
5382 case RTL_GIGA_MAC_VER_47:
5383 case RTL_GIGA_MAC_VER_48:
Chun-Hao Lin935e2212014-10-07 15:10:41 +08005384 case RTL_GIGA_MAC_VER_49:
5385 case RTL_GIGA_MAC_VER_50:
5386 case RTL_GIGA_MAC_VER_51:
Francois Romieud58d46b2011-05-03 16:38:29 +02005387 default:
5388 ops->disable = NULL;
5389 ops->enable = NULL;
5390 break;
5391 }
5392}
5393
Francois Romieuffc46952012-07-06 14:19:23 +02005394DECLARE_RTL_COND(rtl_chipcmd_cond)
5395{
5396 void __iomem *ioaddr = tp->mmio_addr;
5397
5398 return RTL_R8(ChipCmd) & CmdReset;
5399}
5400
Francois Romieu6f43adc2011-04-29 15:05:51 +02005401static void rtl_hw_reset(struct rtl8169_private *tp)
5402{
5403 void __iomem *ioaddr = tp->mmio_addr;
Francois Romieu6f43adc2011-04-29 15:05:51 +02005404
Francois Romieu6f43adc2011-04-29 15:05:51 +02005405 RTL_W8(ChipCmd, CmdReset);
5406
Francois Romieuffc46952012-07-06 14:19:23 +02005407 rtl_udelay_loop_wait_low(tp, &rtl_chipcmd_cond, 100, 100);
Francois Romieu6f43adc2011-04-29 15:05:51 +02005408}
5409
Francois Romieub6ffd972011-06-17 17:00:05 +02005410static void rtl_request_uncached_firmware(struct rtl8169_private *tp)
5411{
5412 struct rtl_fw *rtl_fw;
5413 const char *name;
5414 int rc = -ENOMEM;
5415
5416 name = rtl_lookup_firmware_name(tp);
5417 if (!name)
5418 goto out_no_firmware;
5419
5420 rtl_fw = kzalloc(sizeof(*rtl_fw), GFP_KERNEL);
5421 if (!rtl_fw)
5422 goto err_warn;
5423
5424 rc = request_firmware(&rtl_fw->fw, name, &tp->pci_dev->dev);
5425 if (rc < 0)
5426 goto err_free;
5427
Francois Romieufd112f22011-06-18 00:10:29 +02005428 rc = rtl_check_firmware(tp, rtl_fw);
5429 if (rc < 0)
5430 goto err_release_firmware;
5431
Francois Romieub6ffd972011-06-17 17:00:05 +02005432 tp->rtl_fw = rtl_fw;
5433out:
5434 return;
5435
Francois Romieufd112f22011-06-18 00:10:29 +02005436err_release_firmware:
5437 release_firmware(rtl_fw->fw);
Francois Romieub6ffd972011-06-17 17:00:05 +02005438err_free:
5439 kfree(rtl_fw);
5440err_warn:
5441 netif_warn(tp, ifup, tp->dev, "unable to load firmware patch %s (%d)\n",
5442 name, rc);
5443out_no_firmware:
5444 tp->rtl_fw = NULL;
5445 goto out;
5446}
5447
François Romieu953a12c2011-04-24 17:38:48 +02005448static void rtl_request_firmware(struct rtl8169_private *tp)
5449{
Francois Romieub6ffd972011-06-17 17:00:05 +02005450 if (IS_ERR(tp->rtl_fw))
5451 rtl_request_uncached_firmware(tp);
François Romieu953a12c2011-04-24 17:38:48 +02005452}
5453
Hayes Wang92fc43b2011-07-06 15:58:03 +08005454static void rtl_rx_close(struct rtl8169_private *tp)
5455{
5456 void __iomem *ioaddr = tp->mmio_addr;
Hayes Wang92fc43b2011-07-06 15:58:03 +08005457
Francois Romieu1687b562011-07-19 17:21:29 +02005458 RTL_W32(RxConfig, RTL_R32(RxConfig) & ~RX_CONFIG_ACCEPT_MASK);
Hayes Wang92fc43b2011-07-06 15:58:03 +08005459}
5460
Francois Romieuffc46952012-07-06 14:19:23 +02005461DECLARE_RTL_COND(rtl_npq_cond)
5462{
5463 void __iomem *ioaddr = tp->mmio_addr;
5464
5465 return RTL_R8(TxPoll) & NPQ;
5466}
5467
5468DECLARE_RTL_COND(rtl_txcfg_empty_cond)
5469{
5470 void __iomem *ioaddr = tp->mmio_addr;
5471
5472 return RTL_R32(TxConfig) & TXCFG_EMPTY;
5473}
5474
françois romieue6de30d2011-01-03 15:08:37 +00005475static void rtl8169_hw_reset(struct rtl8169_private *tp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005476{
françois romieue6de30d2011-01-03 15:08:37 +00005477 void __iomem *ioaddr = tp->mmio_addr;
5478
Linus Torvalds1da177e2005-04-16 15:20:36 -07005479 /* Disable interrupts */
françois romieu811fd302011-12-04 20:30:45 +00005480 rtl8169_irq_mask_and_ack(tp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005481
Hayes Wang92fc43b2011-07-06 15:58:03 +08005482 rtl_rx_close(tp);
5483
Hayes Wang5d2e1952011-02-22 17:26:22 +08005484 if (tp->mac_version == RTL_GIGA_MAC_VER_27 ||
hayeswang4804b3b2011-03-21 01:50:29 +00005485 tp->mac_version == RTL_GIGA_MAC_VER_28 ||
5486 tp->mac_version == RTL_GIGA_MAC_VER_31) {
Francois Romieuffc46952012-07-06 14:19:23 +02005487 rtl_udelay_loop_wait_low(tp, &rtl_npq_cond, 20, 42*42);
Hayes Wangc2218922011-09-06 16:55:18 +08005488 } else if (tp->mac_version == RTL_GIGA_MAC_VER_34 ||
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08005489 tp->mac_version == RTL_GIGA_MAC_VER_35 ||
5490 tp->mac_version == RTL_GIGA_MAC_VER_36 ||
5491 tp->mac_version == RTL_GIGA_MAC_VER_37 ||
5492 tp->mac_version == RTL_GIGA_MAC_VER_38 ||
5493 tp->mac_version == RTL_GIGA_MAC_VER_40 ||
5494 tp->mac_version == RTL_GIGA_MAC_VER_41 ||
5495 tp->mac_version == RTL_GIGA_MAC_VER_42 ||
5496 tp->mac_version == RTL_GIGA_MAC_VER_43 ||
5497 tp->mac_version == RTL_GIGA_MAC_VER_44 ||
5498 tp->mac_version == RTL_GIGA_MAC_VER_45 ||
5499 tp->mac_version == RTL_GIGA_MAC_VER_46 ||
5500 tp->mac_version == RTL_GIGA_MAC_VER_47 ||
Chun-Hao Lin935e2212014-10-07 15:10:41 +08005501 tp->mac_version == RTL_GIGA_MAC_VER_48 ||
5502 tp->mac_version == RTL_GIGA_MAC_VER_49 ||
5503 tp->mac_version == RTL_GIGA_MAC_VER_50 ||
5504 tp->mac_version == RTL_GIGA_MAC_VER_51) {
David S. Miller8decf862011-09-22 03:23:13 -04005505 RTL_W8(ChipCmd, RTL_R8(ChipCmd) | StopReq);
Francois Romieuffc46952012-07-06 14:19:23 +02005506 rtl_udelay_loop_wait_high(tp, &rtl_txcfg_empty_cond, 100, 666);
Hayes Wang92fc43b2011-07-06 15:58:03 +08005507 } else {
5508 RTL_W8(ChipCmd, RTL_R8(ChipCmd) | StopReq);
5509 udelay(100);
françois romieue6de30d2011-01-03 15:08:37 +00005510 }
5511
Hayes Wang92fc43b2011-07-06 15:58:03 +08005512 rtl_hw_reset(tp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005513}
5514
Francois Romieu7f796d832007-06-11 23:04:41 +02005515static void rtl_set_rx_tx_config_registers(struct rtl8169_private *tp)
Francois Romieu9cb427b2006-11-02 00:10:16 +01005516{
5517 void __iomem *ioaddr = tp->mmio_addr;
Francois Romieu9cb427b2006-11-02 00:10:16 +01005518
5519 /* Set DMA burst size and Interframe Gap Time */
5520 RTL_W32(TxConfig, (TX_DMA_BURST << TxDMAShift) |
5521 (InterFrameGap << TxInterFrameGapShift));
5522}
5523
Francois Romieu07ce4062007-02-23 23:36:39 +01005524static void rtl_hw_start(struct net_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07005525{
5526 struct rtl8169_private *tp = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005527
Francois Romieu07ce4062007-02-23 23:36:39 +01005528 tp->hw_start(dev);
5529
Francois Romieuda78dbf2012-01-26 14:18:23 +01005530 rtl_irq_enable_all(tp);
Francois Romieu07ce4062007-02-23 23:36:39 +01005531}
5532
Francois Romieu7f796d832007-06-11 23:04:41 +02005533static void rtl_set_rx_tx_desc_registers(struct rtl8169_private *tp,
5534 void __iomem *ioaddr)
5535{
5536 /*
5537 * Magic spell: some iop3xx ARM board needs the TxDescAddrHigh
5538 * register to be written before TxDescAddrLow to work.
5539 * Switching from MMIO to I/O access fixes the issue as well.
5540 */
5541 RTL_W32(TxDescStartAddrHigh, ((u64) tp->TxPhyAddr) >> 32);
Yang Hongyang284901a2009-04-06 19:01:15 -07005542 RTL_W32(TxDescStartAddrLow, ((u64) tp->TxPhyAddr) & DMA_BIT_MASK(32));
Francois Romieu7f796d832007-06-11 23:04:41 +02005543 RTL_W32(RxDescAddrHigh, ((u64) tp->RxPhyAddr) >> 32);
Yang Hongyang284901a2009-04-06 19:01:15 -07005544 RTL_W32(RxDescAddrLow, ((u64) tp->RxPhyAddr) & DMA_BIT_MASK(32));
Francois Romieu7f796d832007-06-11 23:04:41 +02005545}
5546
5547static u16 rtl_rw_cpluscmd(void __iomem *ioaddr)
5548{
5549 u16 cmd;
5550
5551 cmd = RTL_R16(CPlusCmd);
5552 RTL_W16(CPlusCmd, cmd);
5553 return cmd;
5554}
5555
Eric Dumazetfdd7b4c2009-06-09 04:01:02 -07005556static void rtl_set_rx_max_size(void __iomem *ioaddr, unsigned int rx_buf_sz)
Francois Romieu7f796d832007-06-11 23:04:41 +02005557{
5558 /* Low hurts. Let's disable the filtering. */
Raimonds Cicans207d6e872009-10-26 10:52:37 +00005559 RTL_W16(RxMaxSize, rx_buf_sz + 1);
Francois Romieu7f796d832007-06-11 23:04:41 +02005560}
5561
Francois Romieu6dccd162007-02-13 23:38:05 +01005562static void rtl8169_set_magic_reg(void __iomem *ioaddr, unsigned mac_version)
5563{
Francois Romieu37441002011-06-17 22:58:54 +02005564 static const struct rtl_cfg2_info {
Francois Romieu6dccd162007-02-13 23:38:05 +01005565 u32 mac_version;
5566 u32 clk;
5567 u32 val;
5568 } cfg2_info [] = {
5569 { RTL_GIGA_MAC_VER_05, PCI_Clock_33MHz, 0x000fff00 }, // 8110SCd
5570 { RTL_GIGA_MAC_VER_05, PCI_Clock_66MHz, 0x000fffff },
5571 { RTL_GIGA_MAC_VER_06, PCI_Clock_33MHz, 0x00ffff00 }, // 8110SCe
5572 { RTL_GIGA_MAC_VER_06, PCI_Clock_66MHz, 0x00ffffff }
Francois Romieu37441002011-06-17 22:58:54 +02005573 };
5574 const struct rtl_cfg2_info *p = cfg2_info;
Francois Romieu6dccd162007-02-13 23:38:05 +01005575 unsigned int i;
5576 u32 clk;
5577
5578 clk = RTL_R8(Config2) & PCI_Clock_66MHz;
Francois Romieucadf1852008-01-03 23:38:38 +01005579 for (i = 0; i < ARRAY_SIZE(cfg2_info); i++, p++) {
Francois Romieu6dccd162007-02-13 23:38:05 +01005580 if ((p->mac_version == mac_version) && (p->clk == clk)) {
5581 RTL_W32(0x7c, p->val);
5582 break;
5583 }
5584 }
5585}
5586
Francois Romieue6b763e2012-03-08 09:35:39 +01005587static void rtl_set_rx_mode(struct net_device *dev)
5588{
5589 struct rtl8169_private *tp = netdev_priv(dev);
5590 void __iomem *ioaddr = tp->mmio_addr;
5591 u32 mc_filter[2]; /* Multicast hash filter */
5592 int rx_mode;
5593 u32 tmp = 0;
5594
5595 if (dev->flags & IFF_PROMISC) {
5596 /* Unconditionally log net taps. */
5597 netif_notice(tp, link, dev, "Promiscuous mode enabled\n");
5598 rx_mode =
5599 AcceptBroadcast | AcceptMulticast | AcceptMyPhys |
5600 AcceptAllPhys;
5601 mc_filter[1] = mc_filter[0] = 0xffffffff;
5602 } else if ((netdev_mc_count(dev) > multicast_filter_limit) ||
5603 (dev->flags & IFF_ALLMULTI)) {
5604 /* Too many to filter perfectly -- accept all multicasts. */
5605 rx_mode = AcceptBroadcast | AcceptMulticast | AcceptMyPhys;
5606 mc_filter[1] = mc_filter[0] = 0xffffffff;
5607 } else {
5608 struct netdev_hw_addr *ha;
5609
5610 rx_mode = AcceptBroadcast | AcceptMyPhys;
5611 mc_filter[1] = mc_filter[0] = 0;
5612 netdev_for_each_mc_addr(ha, dev) {
5613 int bit_nr = ether_crc(ETH_ALEN, ha->addr) >> 26;
5614 mc_filter[bit_nr >> 5] |= 1 << (bit_nr & 31);
5615 rx_mode |= AcceptMulticast;
5616 }
5617 }
5618
5619 if (dev->features & NETIF_F_RXALL)
5620 rx_mode |= (AcceptErr | AcceptRunt);
5621
5622 tmp = (RTL_R32(RxConfig) & ~RX_CONFIG_ACCEPT_MASK) | rx_mode;
5623
5624 if (tp->mac_version > RTL_GIGA_MAC_VER_06) {
5625 u32 data = mc_filter[0];
5626
5627 mc_filter[0] = swab32(mc_filter[1]);
5628 mc_filter[1] = swab32(data);
5629 }
5630
Nathan Walp04817762012-11-01 12:08:47 +00005631 if (tp->mac_version == RTL_GIGA_MAC_VER_35)
5632 mc_filter[1] = mc_filter[0] = 0xffffffff;
5633
Francois Romieue6b763e2012-03-08 09:35:39 +01005634 RTL_W32(MAR0 + 4, mc_filter[1]);
5635 RTL_W32(MAR0 + 0, mc_filter[0]);
5636
5637 RTL_W32(RxConfig, tmp);
5638}
5639
Francois Romieu07ce4062007-02-23 23:36:39 +01005640static void rtl_hw_start_8169(struct net_device *dev)
5641{
5642 struct rtl8169_private *tp = netdev_priv(dev);
5643 void __iomem *ioaddr = tp->mmio_addr;
5644 struct pci_dev *pdev = tp->pci_dev;
Francois Romieu07ce4062007-02-23 23:36:39 +01005645
Francois Romieu9cb427b2006-11-02 00:10:16 +01005646 if (tp->mac_version == RTL_GIGA_MAC_VER_05) {
5647 RTL_W16(CPlusCmd, RTL_R16(CPlusCmd) | PCIMulRW);
5648 pci_write_config_byte(pdev, PCI_CACHE_LINE_SIZE, 0x08);
5649 }
5650
Linus Torvalds1da177e2005-04-16 15:20:36 -07005651 RTL_W8(Cfg9346, Cfg9346_Unlock);
Francois Romieucecb5fd2011-04-01 10:21:07 +02005652 if (tp->mac_version == RTL_GIGA_MAC_VER_01 ||
5653 tp->mac_version == RTL_GIGA_MAC_VER_02 ||
5654 tp->mac_version == RTL_GIGA_MAC_VER_03 ||
5655 tp->mac_version == RTL_GIGA_MAC_VER_04)
Francois Romieu9cb427b2006-11-02 00:10:16 +01005656 RTL_W8(ChipCmd, CmdTxEnb | CmdRxEnb);
5657
Hayes Wange542a222011-07-06 15:58:04 +08005658 rtl_init_rxcfg(tp);
5659
françois romieuf0298f82011-01-03 15:07:42 +00005660 RTL_W8(EarlyTxThres, NoEarlyTx);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005661
Eric Dumazet6f0333b2010-10-11 11:17:47 +00005662 rtl_set_rx_max_size(ioaddr, rx_buf_sz);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005663
Francois Romieucecb5fd2011-04-01 10:21:07 +02005664 if (tp->mac_version == RTL_GIGA_MAC_VER_01 ||
5665 tp->mac_version == RTL_GIGA_MAC_VER_02 ||
5666 tp->mac_version == RTL_GIGA_MAC_VER_03 ||
5667 tp->mac_version == RTL_GIGA_MAC_VER_04)
Francois Romieuc946b302007-10-04 00:42:50 +02005668 rtl_set_rx_tx_config_registers(tp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005669
Francois Romieu7f796d832007-06-11 23:04:41 +02005670 tp->cp_cmd |= rtl_rw_cpluscmd(ioaddr) | PCIMulRW;
Francois Romieubcf0bf92006-07-26 23:14:13 +02005671
Francois Romieucecb5fd2011-04-01 10:21:07 +02005672 if (tp->mac_version == RTL_GIGA_MAC_VER_02 ||
5673 tp->mac_version == RTL_GIGA_MAC_VER_03) {
Chun-Hao Lin05b96872014-10-01 23:17:12 +08005674 dprintk("Set MAC Reg C+CR Offset 0xe0. "
Linus Torvalds1da177e2005-04-16 15:20:36 -07005675 "Bit-3 and bit-14 MUST be 1\n");
Francois Romieubcf0bf92006-07-26 23:14:13 +02005676 tp->cp_cmd |= (1 << 14);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005677 }
5678
Francois Romieubcf0bf92006-07-26 23:14:13 +02005679 RTL_W16(CPlusCmd, tp->cp_cmd);
5680
Francois Romieu6dccd162007-02-13 23:38:05 +01005681 rtl8169_set_magic_reg(ioaddr, tp->mac_version);
5682
Linus Torvalds1da177e2005-04-16 15:20:36 -07005683 /*
5684 * Undocumented corner. Supposedly:
5685 * (TxTimer << 12) | (TxPackets << 8) | (RxTimer << 4) | RxPackets
5686 */
5687 RTL_W16(IntrMitigate, 0x0000);
5688
Francois Romieu7f796d832007-06-11 23:04:41 +02005689 rtl_set_rx_tx_desc_registers(tp, ioaddr);
Francois Romieu9cb427b2006-11-02 00:10:16 +01005690
Francois Romieucecb5fd2011-04-01 10:21:07 +02005691 if (tp->mac_version != RTL_GIGA_MAC_VER_01 &&
5692 tp->mac_version != RTL_GIGA_MAC_VER_02 &&
5693 tp->mac_version != RTL_GIGA_MAC_VER_03 &&
5694 tp->mac_version != RTL_GIGA_MAC_VER_04) {
Francois Romieuc946b302007-10-04 00:42:50 +02005695 RTL_W8(ChipCmd, CmdTxEnb | CmdRxEnb);
5696 rtl_set_rx_tx_config_registers(tp);
5697 }
5698
Linus Torvalds1da177e2005-04-16 15:20:36 -07005699 RTL_W8(Cfg9346, Cfg9346_Lock);
Francois Romieub518fa82006-08-16 15:23:13 +02005700
5701 /* Initially a 10 us delay. Turned it into a PCI commit. - FR */
5702 RTL_R8(IntrMask);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005703
5704 RTL_W32(RxMissed, 0);
5705
Francois Romieu07ce4062007-02-23 23:36:39 +01005706 rtl_set_rx_mode(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07005707
5708 /* no early-rx interrupts */
Chun-Hao Lin05b96872014-10-01 23:17:12 +08005709 RTL_W16(MultiIntr, RTL_R16(MultiIntr) & 0xf000);
Francois Romieu07ce4062007-02-23 23:36:39 +01005710}
Linus Torvalds1da177e2005-04-16 15:20:36 -07005711
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005712static void rtl_csi_write(struct rtl8169_private *tp, int addr, int value)
5713{
5714 if (tp->csi_ops.write)
Francois Romieu52989f02012-07-06 13:37:00 +02005715 tp->csi_ops.write(tp, addr, value);
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005716}
5717
5718static u32 rtl_csi_read(struct rtl8169_private *tp, int addr)
5719{
Francois Romieu52989f02012-07-06 13:37:00 +02005720 return tp->csi_ops.read ? tp->csi_ops.read(tp, addr) : ~0;
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005721}
5722
5723static void rtl_csi_access_enable(struct rtl8169_private *tp, u32 bits)
Francois Romieudacf8152008-08-02 20:44:13 +02005724{
5725 u32 csi;
5726
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005727 csi = rtl_csi_read(tp, 0x070c) & 0x00ffffff;
5728 rtl_csi_write(tp, 0x070c, csi | bits);
françois romieu650e8d52011-01-03 15:08:29 +00005729}
5730
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005731static void rtl_csi_access_enable_1(struct rtl8169_private *tp)
françois romieue6de30d2011-01-03 15:08:37 +00005732{
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005733 rtl_csi_access_enable(tp, 0x17000000);
françois romieue6de30d2011-01-03 15:08:37 +00005734}
5735
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005736static void rtl_csi_access_enable_2(struct rtl8169_private *tp)
françois romieu650e8d52011-01-03 15:08:29 +00005737{
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005738 rtl_csi_access_enable(tp, 0x27000000);
5739}
5740
Francois Romieuffc46952012-07-06 14:19:23 +02005741DECLARE_RTL_COND(rtl_csiar_cond)
5742{
5743 void __iomem *ioaddr = tp->mmio_addr;
5744
5745 return RTL_R32(CSIAR) & CSIAR_FLAG;
5746}
5747
Francois Romieu52989f02012-07-06 13:37:00 +02005748static void r8169_csi_write(struct rtl8169_private *tp, int addr, int value)
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005749{
Francois Romieu52989f02012-07-06 13:37:00 +02005750 void __iomem *ioaddr = tp->mmio_addr;
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005751
5752 RTL_W32(CSIDR, value);
5753 RTL_W32(CSIAR, CSIAR_WRITE_CMD | (addr & CSIAR_ADDR_MASK) |
5754 CSIAR_BYTE_ENABLE << CSIAR_BYTE_ENABLE_SHIFT);
5755
Francois Romieuffc46952012-07-06 14:19:23 +02005756 rtl_udelay_loop_wait_low(tp, &rtl_csiar_cond, 10, 100);
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005757}
5758
Francois Romieu52989f02012-07-06 13:37:00 +02005759static u32 r8169_csi_read(struct rtl8169_private *tp, int addr)
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005760{
Francois Romieu52989f02012-07-06 13:37:00 +02005761 void __iomem *ioaddr = tp->mmio_addr;
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005762
5763 RTL_W32(CSIAR, (addr & CSIAR_ADDR_MASK) |
5764 CSIAR_BYTE_ENABLE << CSIAR_BYTE_ENABLE_SHIFT);
5765
Francois Romieuffc46952012-07-06 14:19:23 +02005766 return rtl_udelay_loop_wait_high(tp, &rtl_csiar_cond, 10, 100) ?
5767 RTL_R32(CSIDR) : ~0;
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005768}
5769
Francois Romieu52989f02012-07-06 13:37:00 +02005770static void r8402_csi_write(struct rtl8169_private *tp, int addr, int value)
Hayes Wang7e18dca2012-03-30 14:33:02 +08005771{
Francois Romieu52989f02012-07-06 13:37:00 +02005772 void __iomem *ioaddr = tp->mmio_addr;
Hayes Wang7e18dca2012-03-30 14:33:02 +08005773
5774 RTL_W32(CSIDR, value);
5775 RTL_W32(CSIAR, CSIAR_WRITE_CMD | (addr & CSIAR_ADDR_MASK) |
5776 CSIAR_BYTE_ENABLE << CSIAR_BYTE_ENABLE_SHIFT |
5777 CSIAR_FUNC_NIC);
5778
Francois Romieuffc46952012-07-06 14:19:23 +02005779 rtl_udelay_loop_wait_low(tp, &rtl_csiar_cond, 10, 100);
Hayes Wang7e18dca2012-03-30 14:33:02 +08005780}
5781
Francois Romieu52989f02012-07-06 13:37:00 +02005782static u32 r8402_csi_read(struct rtl8169_private *tp, int addr)
Hayes Wang7e18dca2012-03-30 14:33:02 +08005783{
Francois Romieu52989f02012-07-06 13:37:00 +02005784 void __iomem *ioaddr = tp->mmio_addr;
Hayes Wang7e18dca2012-03-30 14:33:02 +08005785
5786 RTL_W32(CSIAR, (addr & CSIAR_ADDR_MASK) | CSIAR_FUNC_NIC |
5787 CSIAR_BYTE_ENABLE << CSIAR_BYTE_ENABLE_SHIFT);
5788
Francois Romieuffc46952012-07-06 14:19:23 +02005789 return rtl_udelay_loop_wait_high(tp, &rtl_csiar_cond, 10, 100) ?
5790 RTL_R32(CSIDR) : ~0;
Hayes Wang7e18dca2012-03-30 14:33:02 +08005791}
5792
hayeswang45dd95c2013-07-08 17:09:01 +08005793static void r8411_csi_write(struct rtl8169_private *tp, int addr, int value)
5794{
5795 void __iomem *ioaddr = tp->mmio_addr;
5796
5797 RTL_W32(CSIDR, value);
5798 RTL_W32(CSIAR, CSIAR_WRITE_CMD | (addr & CSIAR_ADDR_MASK) |
5799 CSIAR_BYTE_ENABLE << CSIAR_BYTE_ENABLE_SHIFT |
5800 CSIAR_FUNC_NIC2);
5801
5802 rtl_udelay_loop_wait_low(tp, &rtl_csiar_cond, 10, 100);
5803}
5804
5805static u32 r8411_csi_read(struct rtl8169_private *tp, int addr)
5806{
5807 void __iomem *ioaddr = tp->mmio_addr;
5808
5809 RTL_W32(CSIAR, (addr & CSIAR_ADDR_MASK) | CSIAR_FUNC_NIC2 |
5810 CSIAR_BYTE_ENABLE << CSIAR_BYTE_ENABLE_SHIFT);
5811
5812 return rtl_udelay_loop_wait_high(tp, &rtl_csiar_cond, 10, 100) ?
5813 RTL_R32(CSIDR) : ~0;
5814}
5815
Bill Pembertonbaf63292012-12-03 09:23:28 -05005816static void rtl_init_csi_ops(struct rtl8169_private *tp)
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005817{
5818 struct csi_ops *ops = &tp->csi_ops;
5819
5820 switch (tp->mac_version) {
5821 case RTL_GIGA_MAC_VER_01:
5822 case RTL_GIGA_MAC_VER_02:
5823 case RTL_GIGA_MAC_VER_03:
5824 case RTL_GIGA_MAC_VER_04:
5825 case RTL_GIGA_MAC_VER_05:
5826 case RTL_GIGA_MAC_VER_06:
5827 case RTL_GIGA_MAC_VER_10:
5828 case RTL_GIGA_MAC_VER_11:
5829 case RTL_GIGA_MAC_VER_12:
5830 case RTL_GIGA_MAC_VER_13:
5831 case RTL_GIGA_MAC_VER_14:
5832 case RTL_GIGA_MAC_VER_15:
5833 case RTL_GIGA_MAC_VER_16:
5834 case RTL_GIGA_MAC_VER_17:
5835 ops->write = NULL;
5836 ops->read = NULL;
5837 break;
5838
Hayes Wang7e18dca2012-03-30 14:33:02 +08005839 case RTL_GIGA_MAC_VER_37:
Hayes Wangb3d7b2f2012-03-30 14:48:06 +08005840 case RTL_GIGA_MAC_VER_38:
Hayes Wang7e18dca2012-03-30 14:33:02 +08005841 ops->write = r8402_csi_write;
5842 ops->read = r8402_csi_read;
5843 break;
5844
hayeswang45dd95c2013-07-08 17:09:01 +08005845 case RTL_GIGA_MAC_VER_44:
5846 ops->write = r8411_csi_write;
5847 ops->read = r8411_csi_read;
5848 break;
5849
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005850 default:
5851 ops->write = r8169_csi_write;
5852 ops->read = r8169_csi_read;
5853 break;
5854 }
Francois Romieudacf8152008-08-02 20:44:13 +02005855}
5856
5857struct ephy_info {
5858 unsigned int offset;
5859 u16 mask;
5860 u16 bits;
5861};
5862
Francois Romieufdf6fc02012-07-06 22:40:38 +02005863static void rtl_ephy_init(struct rtl8169_private *tp, const struct ephy_info *e,
5864 int len)
Francois Romieudacf8152008-08-02 20:44:13 +02005865{
5866 u16 w;
5867
5868 while (len-- > 0) {
Francois Romieufdf6fc02012-07-06 22:40:38 +02005869 w = (rtl_ephy_read(tp, e->offset) & ~e->mask) | e->bits;
5870 rtl_ephy_write(tp, e->offset, w);
Francois Romieudacf8152008-08-02 20:44:13 +02005871 e++;
5872 }
5873}
5874
Francois Romieub726e492008-06-28 12:22:59 +02005875static void rtl_disable_clock_request(struct pci_dev *pdev)
5876{
Jiang Liu7d7903b2012-07-24 17:20:16 +08005877 pcie_capability_clear_word(pdev, PCI_EXP_LNKCTL,
5878 PCI_EXP_LNKCTL_CLKREQ_EN);
Francois Romieub726e492008-06-28 12:22:59 +02005879}
5880
françois romieue6de30d2011-01-03 15:08:37 +00005881static void rtl_enable_clock_request(struct pci_dev *pdev)
5882{
Jiang Liu7d7903b2012-07-24 17:20:16 +08005883 pcie_capability_set_word(pdev, PCI_EXP_LNKCTL,
5884 PCI_EXP_LNKCTL_CLKREQ_EN);
françois romieue6de30d2011-01-03 15:08:37 +00005885}
5886
hayeswangb51ecea2014-07-09 14:52:51 +08005887static void rtl_pcie_state_l2l3_enable(struct rtl8169_private *tp, bool enable)
5888{
5889 void __iomem *ioaddr = tp->mmio_addr;
5890 u8 data;
5891
5892 data = RTL_R8(Config3);
5893
5894 if (enable)
5895 data |= Rdy_to_L23;
5896 else
5897 data &= ~Rdy_to_L23;
5898
5899 RTL_W8(Config3, data);
5900}
5901
Francois Romieub726e492008-06-28 12:22:59 +02005902#define R8168_CPCMD_QUIRK_MASK (\
5903 EnableBist | \
5904 Mac_dbgo_oe | \
5905 Force_half_dup | \
5906 Force_rxflow_en | \
5907 Force_txflow_en | \
5908 Cxpl_dbg_sel | \
5909 ASF | \
5910 PktCntrDisable | \
5911 Mac_dbgo_sel)
5912
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005913static void rtl_hw_start_8168bb(struct rtl8169_private *tp)
Francois Romieu219a1e92008-06-28 11:58:39 +02005914{
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005915 void __iomem *ioaddr = tp->mmio_addr;
5916 struct pci_dev *pdev = tp->pci_dev;
5917
Francois Romieub726e492008-06-28 12:22:59 +02005918 RTL_W8(Config3, RTL_R8(Config3) & ~Beacon_en);
5919
5920 RTL_W16(CPlusCmd, RTL_R16(CPlusCmd) & ~R8168_CPCMD_QUIRK_MASK);
5921
françois romieufaf1e782013-02-27 13:01:57 +00005922 if (tp->dev->mtu <= ETH_DATA_LEN) {
5923 rtl_tx_performance_tweak(pdev, (0x5 << MAX_READ_REQUEST_SHIFT) |
5924 PCI_EXP_DEVCTL_NOSNOOP_EN);
5925 }
Francois Romieu219a1e92008-06-28 11:58:39 +02005926}
5927
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005928static void rtl_hw_start_8168bef(struct rtl8169_private *tp)
Francois Romieu219a1e92008-06-28 11:58:39 +02005929{
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005930 void __iomem *ioaddr = tp->mmio_addr;
5931
5932 rtl_hw_start_8168bb(tp);
Francois Romieub726e492008-06-28 12:22:59 +02005933
françois romieuf0298f82011-01-03 15:07:42 +00005934 RTL_W8(MaxTxPacketSize, TxPacketMax);
Francois Romieub726e492008-06-28 12:22:59 +02005935
5936 RTL_W8(Config4, RTL_R8(Config4) & ~(1 << 0));
Francois Romieu219a1e92008-06-28 11:58:39 +02005937}
5938
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005939static void __rtl_hw_start_8168cp(struct rtl8169_private *tp)
Francois Romieu219a1e92008-06-28 11:58:39 +02005940{
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005941 void __iomem *ioaddr = tp->mmio_addr;
5942 struct pci_dev *pdev = tp->pci_dev;
5943
Francois Romieub726e492008-06-28 12:22:59 +02005944 RTL_W8(Config1, RTL_R8(Config1) | Speed_down);
5945
5946 RTL_W8(Config3, RTL_R8(Config3) & ~Beacon_en);
5947
françois romieufaf1e782013-02-27 13:01:57 +00005948 if (tp->dev->mtu <= ETH_DATA_LEN)
5949 rtl_tx_performance_tweak(pdev, 0x5 << MAX_READ_REQUEST_SHIFT);
Francois Romieub726e492008-06-28 12:22:59 +02005950
5951 rtl_disable_clock_request(pdev);
5952
5953 RTL_W16(CPlusCmd, RTL_R16(CPlusCmd) & ~R8168_CPCMD_QUIRK_MASK);
Francois Romieu219a1e92008-06-28 11:58:39 +02005954}
5955
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005956static void rtl_hw_start_8168cp_1(struct rtl8169_private *tp)
Francois Romieu219a1e92008-06-28 11:58:39 +02005957{
Alexey Dobriyan350f7592009-11-25 15:54:21 -08005958 static const struct ephy_info e_info_8168cp[] = {
Francois Romieub726e492008-06-28 12:22:59 +02005959 { 0x01, 0, 0x0001 },
5960 { 0x02, 0x0800, 0x1000 },
5961 { 0x03, 0, 0x0042 },
5962 { 0x06, 0x0080, 0x0000 },
5963 { 0x07, 0, 0x2000 }
5964 };
5965
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005966 rtl_csi_access_enable_2(tp);
Francois Romieub726e492008-06-28 12:22:59 +02005967
Francois Romieufdf6fc02012-07-06 22:40:38 +02005968 rtl_ephy_init(tp, e_info_8168cp, ARRAY_SIZE(e_info_8168cp));
Francois Romieub726e492008-06-28 12:22:59 +02005969
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005970 __rtl_hw_start_8168cp(tp);
Francois Romieu219a1e92008-06-28 11:58:39 +02005971}
5972
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005973static void rtl_hw_start_8168cp_2(struct rtl8169_private *tp)
Francois Romieuef3386f2008-06-29 12:24:30 +02005974{
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005975 void __iomem *ioaddr = tp->mmio_addr;
5976 struct pci_dev *pdev = tp->pci_dev;
5977
5978 rtl_csi_access_enable_2(tp);
Francois Romieuef3386f2008-06-29 12:24:30 +02005979
5980 RTL_W8(Config3, RTL_R8(Config3) & ~Beacon_en);
5981
françois romieufaf1e782013-02-27 13:01:57 +00005982 if (tp->dev->mtu <= ETH_DATA_LEN)
5983 rtl_tx_performance_tweak(pdev, 0x5 << MAX_READ_REQUEST_SHIFT);
Francois Romieuef3386f2008-06-29 12:24:30 +02005984
5985 RTL_W16(CPlusCmd, RTL_R16(CPlusCmd) & ~R8168_CPCMD_QUIRK_MASK);
5986}
5987
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005988static void rtl_hw_start_8168cp_3(struct rtl8169_private *tp)
Francois Romieu7f3e3d32008-07-20 18:53:20 +02005989{
Hayes Wangbeb1fe12012-03-30 14:33:01 +08005990 void __iomem *ioaddr = tp->mmio_addr;
5991 struct pci_dev *pdev = tp->pci_dev;
5992
5993 rtl_csi_access_enable_2(tp);
Francois Romieu7f3e3d32008-07-20 18:53:20 +02005994
5995 RTL_W8(Config3, RTL_R8(Config3) & ~Beacon_en);
5996
5997 /* Magic. */
5998 RTL_W8(DBG_REG, 0x20);
5999
françois romieuf0298f82011-01-03 15:07:42 +00006000 RTL_W8(MaxTxPacketSize, TxPacketMax);
Francois Romieu7f3e3d32008-07-20 18:53:20 +02006001
françois romieufaf1e782013-02-27 13:01:57 +00006002 if (tp->dev->mtu <= ETH_DATA_LEN)
6003 rtl_tx_performance_tweak(pdev, 0x5 << MAX_READ_REQUEST_SHIFT);
Francois Romieu7f3e3d32008-07-20 18:53:20 +02006004
6005 RTL_W16(CPlusCmd, RTL_R16(CPlusCmd) & ~R8168_CPCMD_QUIRK_MASK);
6006}
6007
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006008static void rtl_hw_start_8168c_1(struct rtl8169_private *tp)
Francois Romieu219a1e92008-06-28 11:58:39 +02006009{
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006010 void __iomem *ioaddr = tp->mmio_addr;
Alexey Dobriyan350f7592009-11-25 15:54:21 -08006011 static const struct ephy_info e_info_8168c_1[] = {
Francois Romieub726e492008-06-28 12:22:59 +02006012 { 0x02, 0x0800, 0x1000 },
6013 { 0x03, 0, 0x0002 },
6014 { 0x06, 0x0080, 0x0000 }
6015 };
6016
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006017 rtl_csi_access_enable_2(tp);
Francois Romieub726e492008-06-28 12:22:59 +02006018
6019 RTL_W8(DBG_REG, 0x06 | FIX_NAK_1 | FIX_NAK_2);
6020
Francois Romieufdf6fc02012-07-06 22:40:38 +02006021 rtl_ephy_init(tp, e_info_8168c_1, ARRAY_SIZE(e_info_8168c_1));
Francois Romieub726e492008-06-28 12:22:59 +02006022
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006023 __rtl_hw_start_8168cp(tp);
Francois Romieu219a1e92008-06-28 11:58:39 +02006024}
6025
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006026static void rtl_hw_start_8168c_2(struct rtl8169_private *tp)
Francois Romieu219a1e92008-06-28 11:58:39 +02006027{
Alexey Dobriyan350f7592009-11-25 15:54:21 -08006028 static const struct ephy_info e_info_8168c_2[] = {
Francois Romieub726e492008-06-28 12:22:59 +02006029 { 0x01, 0, 0x0001 },
6030 { 0x03, 0x0400, 0x0220 }
6031 };
6032
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006033 rtl_csi_access_enable_2(tp);
Francois Romieub726e492008-06-28 12:22:59 +02006034
Francois Romieufdf6fc02012-07-06 22:40:38 +02006035 rtl_ephy_init(tp, e_info_8168c_2, ARRAY_SIZE(e_info_8168c_2));
Francois Romieub726e492008-06-28 12:22:59 +02006036
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006037 __rtl_hw_start_8168cp(tp);
Francois Romieu219a1e92008-06-28 11:58:39 +02006038}
6039
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006040static void rtl_hw_start_8168c_3(struct rtl8169_private *tp)
Francois Romieu197ff762008-06-28 13:16:02 +02006041{
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006042 rtl_hw_start_8168c_2(tp);
Francois Romieu197ff762008-06-28 13:16:02 +02006043}
6044
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006045static void rtl_hw_start_8168c_4(struct rtl8169_private *tp)
Francois Romieu6fb07052008-06-29 11:54:28 +02006046{
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006047 rtl_csi_access_enable_2(tp);
Francois Romieu6fb07052008-06-29 11:54:28 +02006048
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006049 __rtl_hw_start_8168cp(tp);
Francois Romieu6fb07052008-06-29 11:54:28 +02006050}
6051
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006052static void rtl_hw_start_8168d(struct rtl8169_private *tp)
Francois Romieu5b538df2008-07-20 16:22:45 +02006053{
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006054 void __iomem *ioaddr = tp->mmio_addr;
6055 struct pci_dev *pdev = tp->pci_dev;
6056
6057 rtl_csi_access_enable_2(tp);
Francois Romieu5b538df2008-07-20 16:22:45 +02006058
6059 rtl_disable_clock_request(pdev);
6060
françois romieuf0298f82011-01-03 15:07:42 +00006061 RTL_W8(MaxTxPacketSize, TxPacketMax);
Francois Romieu5b538df2008-07-20 16:22:45 +02006062
françois romieufaf1e782013-02-27 13:01:57 +00006063 if (tp->dev->mtu <= ETH_DATA_LEN)
6064 rtl_tx_performance_tweak(pdev, 0x5 << MAX_READ_REQUEST_SHIFT);
Francois Romieu5b538df2008-07-20 16:22:45 +02006065
6066 RTL_W16(CPlusCmd, RTL_R16(CPlusCmd) & ~R8168_CPCMD_QUIRK_MASK);
6067}
6068
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006069static void rtl_hw_start_8168dp(struct rtl8169_private *tp)
hayeswang4804b3b2011-03-21 01:50:29 +00006070{
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006071 void __iomem *ioaddr = tp->mmio_addr;
6072 struct pci_dev *pdev = tp->pci_dev;
6073
6074 rtl_csi_access_enable_1(tp);
hayeswang4804b3b2011-03-21 01:50:29 +00006075
françois romieufaf1e782013-02-27 13:01:57 +00006076 if (tp->dev->mtu <= ETH_DATA_LEN)
6077 rtl_tx_performance_tweak(pdev, 0x5 << MAX_READ_REQUEST_SHIFT);
hayeswang4804b3b2011-03-21 01:50:29 +00006078
6079 RTL_W8(MaxTxPacketSize, TxPacketMax);
6080
6081 rtl_disable_clock_request(pdev);
6082}
6083
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006084static void rtl_hw_start_8168d_4(struct rtl8169_private *tp)
françois romieue6de30d2011-01-03 15:08:37 +00006085{
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006086 void __iomem *ioaddr = tp->mmio_addr;
6087 struct pci_dev *pdev = tp->pci_dev;
françois romieue6de30d2011-01-03 15:08:37 +00006088 static const struct ephy_info e_info_8168d_4[] = {
Chun-Hao Lin1016a4a2015-12-29 22:13:39 +08006089 { 0x0b, 0x0000, 0x0048 },
6090 { 0x19, 0x0020, 0x0050 },
6091 { 0x0c, 0x0100, 0x0020 }
françois romieue6de30d2011-01-03 15:08:37 +00006092 };
françois romieue6de30d2011-01-03 15:08:37 +00006093
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006094 rtl_csi_access_enable_1(tp);
françois romieue6de30d2011-01-03 15:08:37 +00006095
6096 rtl_tx_performance_tweak(pdev, 0x5 << MAX_READ_REQUEST_SHIFT);
6097
6098 RTL_W8(MaxTxPacketSize, TxPacketMax);
6099
Chun-Hao Lin1016a4a2015-12-29 22:13:39 +08006100 rtl_ephy_init(tp, e_info_8168d_4, ARRAY_SIZE(e_info_8168d_4));
françois romieue6de30d2011-01-03 15:08:37 +00006101
6102 rtl_enable_clock_request(pdev);
6103}
6104
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006105static void rtl_hw_start_8168e_1(struct rtl8169_private *tp)
hayeswang01dc7fe2011-03-21 01:50:28 +00006106{
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006107 void __iomem *ioaddr = tp->mmio_addr;
6108 struct pci_dev *pdev = tp->pci_dev;
Hayes Wang70090422011-07-06 15:58:06 +08006109 static const struct ephy_info e_info_8168e_1[] = {
hayeswang01dc7fe2011-03-21 01:50:28 +00006110 { 0x00, 0x0200, 0x0100 },
6111 { 0x00, 0x0000, 0x0004 },
6112 { 0x06, 0x0002, 0x0001 },
6113 { 0x06, 0x0000, 0x0030 },
6114 { 0x07, 0x0000, 0x2000 },
6115 { 0x00, 0x0000, 0x0020 },
6116 { 0x03, 0x5800, 0x2000 },
6117 { 0x03, 0x0000, 0x0001 },
6118 { 0x01, 0x0800, 0x1000 },
6119 { 0x07, 0x0000, 0x4000 },
6120 { 0x1e, 0x0000, 0x2000 },
6121 { 0x19, 0xffff, 0xfe6c },
6122 { 0x0a, 0x0000, 0x0040 }
6123 };
6124
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006125 rtl_csi_access_enable_2(tp);
hayeswang01dc7fe2011-03-21 01:50:28 +00006126
Francois Romieufdf6fc02012-07-06 22:40:38 +02006127 rtl_ephy_init(tp, e_info_8168e_1, ARRAY_SIZE(e_info_8168e_1));
hayeswang01dc7fe2011-03-21 01:50:28 +00006128
françois romieufaf1e782013-02-27 13:01:57 +00006129 if (tp->dev->mtu <= ETH_DATA_LEN)
6130 rtl_tx_performance_tweak(pdev, 0x5 << MAX_READ_REQUEST_SHIFT);
hayeswang01dc7fe2011-03-21 01:50:28 +00006131
6132 RTL_W8(MaxTxPacketSize, TxPacketMax);
6133
6134 rtl_disable_clock_request(pdev);
6135
6136 /* Reset tx FIFO pointer */
Francois Romieucecb5fd2011-04-01 10:21:07 +02006137 RTL_W32(MISC, RTL_R32(MISC) | TXPLA_RST);
6138 RTL_W32(MISC, RTL_R32(MISC) & ~TXPLA_RST);
hayeswang01dc7fe2011-03-21 01:50:28 +00006139
Francois Romieucecb5fd2011-04-01 10:21:07 +02006140 RTL_W8(Config5, RTL_R8(Config5) & ~Spi_en);
hayeswang01dc7fe2011-03-21 01:50:28 +00006141}
6142
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006143static void rtl_hw_start_8168e_2(struct rtl8169_private *tp)
Hayes Wang70090422011-07-06 15:58:06 +08006144{
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006145 void __iomem *ioaddr = tp->mmio_addr;
6146 struct pci_dev *pdev = tp->pci_dev;
Hayes Wang70090422011-07-06 15:58:06 +08006147 static const struct ephy_info e_info_8168e_2[] = {
6148 { 0x09, 0x0000, 0x0080 },
6149 { 0x19, 0x0000, 0x0224 }
6150 };
6151
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006152 rtl_csi_access_enable_1(tp);
Hayes Wang70090422011-07-06 15:58:06 +08006153
Francois Romieufdf6fc02012-07-06 22:40:38 +02006154 rtl_ephy_init(tp, e_info_8168e_2, ARRAY_SIZE(e_info_8168e_2));
Hayes Wang70090422011-07-06 15:58:06 +08006155
françois romieufaf1e782013-02-27 13:01:57 +00006156 if (tp->dev->mtu <= ETH_DATA_LEN)
6157 rtl_tx_performance_tweak(pdev, 0x5 << MAX_READ_REQUEST_SHIFT);
Hayes Wang70090422011-07-06 15:58:06 +08006158
Francois Romieufdf6fc02012-07-06 22:40:38 +02006159 rtl_eri_write(tp, 0xc0, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);
6160 rtl_eri_write(tp, 0xb8, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);
6161 rtl_eri_write(tp, 0xc8, ERIAR_MASK_1111, 0x00100002, ERIAR_EXGMAC);
6162 rtl_eri_write(tp, 0xe8, ERIAR_MASK_1111, 0x00100006, ERIAR_EXGMAC);
6163 rtl_eri_write(tp, 0xcc, ERIAR_MASK_1111, 0x00000050, ERIAR_EXGMAC);
6164 rtl_eri_write(tp, 0xd0, ERIAR_MASK_1111, 0x07ff0060, ERIAR_EXGMAC);
Chun-Hao Lin706123d2014-10-01 23:17:18 +08006165 rtl_w0w1_eri(tp, 0x1b0, ERIAR_MASK_0001, 0x10, 0x00, ERIAR_EXGMAC);
6166 rtl_w0w1_eri(tp, 0x0d4, ERIAR_MASK_0011, 0x0c00, 0xff00, ERIAR_EXGMAC);
Hayes Wang70090422011-07-06 15:58:06 +08006167
Hayes Wang3090bd92011-09-06 16:55:15 +08006168 RTL_W8(MaxTxPacketSize, EarlySize);
Hayes Wang70090422011-07-06 15:58:06 +08006169
Francois Romieu4521e1a92012-11-01 16:46:28 +00006170 rtl_disable_clock_request(pdev);
6171
Hayes Wang70090422011-07-06 15:58:06 +08006172 RTL_W32(TxConfig, RTL_R32(TxConfig) | TXCFG_AUTO_FIFO);
6173 RTL_W8(MCU, RTL_R8(MCU) & ~NOW_IS_OOB);
6174
6175 /* Adjust EEE LED frequency */
6176 RTL_W8(EEE_LED, RTL_R8(EEE_LED) & ~0x07);
6177
6178 RTL_W8(DLLPR, RTL_R8(DLLPR) | PFM_EN);
6179 RTL_W32(MISC, RTL_R32(MISC) | PWM_EN);
Francois Romieu4521e1a92012-11-01 16:46:28 +00006180 RTL_W8(Config5, RTL_R8(Config5) & ~Spi_en);
Hayes Wang70090422011-07-06 15:58:06 +08006181}
6182
Hayes Wang5f886e02012-03-30 14:33:03 +08006183static void rtl_hw_start_8168f(struct rtl8169_private *tp)
Hayes Wangc2218922011-09-06 16:55:18 +08006184{
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006185 void __iomem *ioaddr = tp->mmio_addr;
6186 struct pci_dev *pdev = tp->pci_dev;
Hayes Wangc2218922011-09-06 16:55:18 +08006187
Hayes Wang5f886e02012-03-30 14:33:03 +08006188 rtl_csi_access_enable_2(tp);
Hayes Wangc2218922011-09-06 16:55:18 +08006189
6190 rtl_tx_performance_tweak(pdev, 0x5 << MAX_READ_REQUEST_SHIFT);
6191
Francois Romieufdf6fc02012-07-06 22:40:38 +02006192 rtl_eri_write(tp, 0xc0, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);
6193 rtl_eri_write(tp, 0xb8, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);
6194 rtl_eri_write(tp, 0xc8, ERIAR_MASK_1111, 0x00100002, ERIAR_EXGMAC);
6195 rtl_eri_write(tp, 0xe8, ERIAR_MASK_1111, 0x00100006, ERIAR_EXGMAC);
Chun-Hao Lin706123d2014-10-01 23:17:18 +08006196 rtl_w0w1_eri(tp, 0xdc, ERIAR_MASK_0001, 0x00, 0x01, ERIAR_EXGMAC);
6197 rtl_w0w1_eri(tp, 0xdc, ERIAR_MASK_0001, 0x01, 0x00, ERIAR_EXGMAC);
6198 rtl_w0w1_eri(tp, 0x1b0, ERIAR_MASK_0001, 0x10, 0x00, ERIAR_EXGMAC);
6199 rtl_w0w1_eri(tp, 0x1d0, ERIAR_MASK_0001, 0x10, 0x00, ERIAR_EXGMAC);
Francois Romieufdf6fc02012-07-06 22:40:38 +02006200 rtl_eri_write(tp, 0xcc, ERIAR_MASK_1111, 0x00000050, ERIAR_EXGMAC);
6201 rtl_eri_write(tp, 0xd0, ERIAR_MASK_1111, 0x00000060, ERIAR_EXGMAC);
Hayes Wangc2218922011-09-06 16:55:18 +08006202
6203 RTL_W8(MaxTxPacketSize, EarlySize);
6204
Francois Romieu4521e1a92012-11-01 16:46:28 +00006205 rtl_disable_clock_request(pdev);
6206
Hayes Wangc2218922011-09-06 16:55:18 +08006207 RTL_W32(TxConfig, RTL_R32(TxConfig) | TXCFG_AUTO_FIFO);
6208 RTL_W8(MCU, RTL_R8(MCU) & ~NOW_IS_OOB);
Hayes Wangc2218922011-09-06 16:55:18 +08006209 RTL_W8(DLLPR, RTL_R8(DLLPR) | PFM_EN);
Francois Romieu4521e1a92012-11-01 16:46:28 +00006210 RTL_W32(MISC, RTL_R32(MISC) | PWM_EN);
6211 RTL_W8(Config5, RTL_R8(Config5) & ~Spi_en);
Hayes Wangc2218922011-09-06 16:55:18 +08006212}
6213
Hayes Wang5f886e02012-03-30 14:33:03 +08006214static void rtl_hw_start_8168f_1(struct rtl8169_private *tp)
6215{
6216 void __iomem *ioaddr = tp->mmio_addr;
6217 static const struct ephy_info e_info_8168f_1[] = {
6218 { 0x06, 0x00c0, 0x0020 },
6219 { 0x08, 0x0001, 0x0002 },
6220 { 0x09, 0x0000, 0x0080 },
6221 { 0x19, 0x0000, 0x0224 }
6222 };
6223
6224 rtl_hw_start_8168f(tp);
6225
Francois Romieufdf6fc02012-07-06 22:40:38 +02006226 rtl_ephy_init(tp, e_info_8168f_1, ARRAY_SIZE(e_info_8168f_1));
Hayes Wang5f886e02012-03-30 14:33:03 +08006227
Chun-Hao Lin706123d2014-10-01 23:17:18 +08006228 rtl_w0w1_eri(tp, 0x0d4, ERIAR_MASK_0011, 0x0c00, 0xff00, ERIAR_EXGMAC);
Hayes Wang5f886e02012-03-30 14:33:03 +08006229
6230 /* Adjust EEE LED frequency */
6231 RTL_W8(EEE_LED, RTL_R8(EEE_LED) & ~0x07);
6232}
6233
Hayes Wangb3d7b2f2012-03-30 14:48:06 +08006234static void rtl_hw_start_8411(struct rtl8169_private *tp)
6235{
Hayes Wangb3d7b2f2012-03-30 14:48:06 +08006236 static const struct ephy_info e_info_8168f_1[] = {
6237 { 0x06, 0x00c0, 0x0020 },
6238 { 0x0f, 0xffff, 0x5200 },
6239 { 0x1e, 0x0000, 0x4000 },
6240 { 0x19, 0x0000, 0x0224 }
6241 };
6242
6243 rtl_hw_start_8168f(tp);
hayeswangb51ecea2014-07-09 14:52:51 +08006244 rtl_pcie_state_l2l3_enable(tp, false);
Hayes Wangb3d7b2f2012-03-30 14:48:06 +08006245
Francois Romieufdf6fc02012-07-06 22:40:38 +02006246 rtl_ephy_init(tp, e_info_8168f_1, ARRAY_SIZE(e_info_8168f_1));
Hayes Wangb3d7b2f2012-03-30 14:48:06 +08006247
Chun-Hao Lin706123d2014-10-01 23:17:18 +08006248 rtl_w0w1_eri(tp, 0x0d4, ERIAR_MASK_0011, 0x0c00, 0x0000, ERIAR_EXGMAC);
Hayes Wangb3d7b2f2012-03-30 14:48:06 +08006249}
6250
Chun-Hao Lin5fbea332014-12-10 21:28:38 +08006251static void rtl_hw_start_8168g(struct rtl8169_private *tp)
Hayes Wangc5583862012-07-02 17:23:22 +08006252{
6253 void __iomem *ioaddr = tp->mmio_addr;
6254 struct pci_dev *pdev = tp->pci_dev;
6255
hayeswangbeb330a2013-04-01 22:23:39 +00006256 RTL_W32(TxConfig, RTL_R32(TxConfig) | TXCFG_AUTO_FIFO);
6257
Hayes Wangc5583862012-07-02 17:23:22 +08006258 rtl_eri_write(tp, 0xc8, ERIAR_MASK_0101, 0x080002, ERIAR_EXGMAC);
6259 rtl_eri_write(tp, 0xcc, ERIAR_MASK_0001, 0x38, ERIAR_EXGMAC);
6260 rtl_eri_write(tp, 0xd0, ERIAR_MASK_0001, 0x48, ERIAR_EXGMAC);
6261 rtl_eri_write(tp, 0xe8, ERIAR_MASK_1111, 0x00100006, ERIAR_EXGMAC);
6262
6263 rtl_csi_access_enable_1(tp);
6264
6265 rtl_tx_performance_tweak(pdev, 0x5 << MAX_READ_REQUEST_SHIFT);
6266
Chun-Hao Lin706123d2014-10-01 23:17:18 +08006267 rtl_w0w1_eri(tp, 0xdc, ERIAR_MASK_0001, 0x00, 0x01, ERIAR_EXGMAC);
6268 rtl_w0w1_eri(tp, 0xdc, ERIAR_MASK_0001, 0x01, 0x00, ERIAR_EXGMAC);
hayeswangbeb330a2013-04-01 22:23:39 +00006269 rtl_eri_write(tp, 0x2f8, ERIAR_MASK_0011, 0x1d8f, ERIAR_EXGMAC);
Hayes Wangc5583862012-07-02 17:23:22 +08006270
Francois Romieu4521e1a92012-11-01 16:46:28 +00006271 RTL_W32(MISC, RTL_R32(MISC) & ~RXDV_GATED_EN);
Hayes Wangc5583862012-07-02 17:23:22 +08006272 RTL_W8(MaxTxPacketSize, EarlySize);
6273
6274 rtl_eri_write(tp, 0xc0, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);
6275 rtl_eri_write(tp, 0xb8, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);
6276
6277 /* Adjust EEE LED frequency */
6278 RTL_W8(EEE_LED, RTL_R8(EEE_LED) & ~0x07);
6279
Chun-Hao Lin706123d2014-10-01 23:17:18 +08006280 rtl_w0w1_eri(tp, 0x2fc, ERIAR_MASK_0001, 0x01, 0x06, ERIAR_EXGMAC);
6281 rtl_w0w1_eri(tp, 0x1b0, ERIAR_MASK_0011, 0x0000, 0x1000, ERIAR_EXGMAC);
hayeswangb51ecea2014-07-09 14:52:51 +08006282
6283 rtl_pcie_state_l2l3_enable(tp, false);
Hayes Wangc5583862012-07-02 17:23:22 +08006284}
6285
Chun-Hao Lin5fbea332014-12-10 21:28:38 +08006286static void rtl_hw_start_8168g_1(struct rtl8169_private *tp)
6287{
6288 void __iomem *ioaddr = tp->mmio_addr;
6289 static const struct ephy_info e_info_8168g_1[] = {
6290 { 0x00, 0x0000, 0x0008 },
6291 { 0x0c, 0x37d0, 0x0820 },
6292 { 0x1e, 0x0000, 0x0001 },
6293 { 0x19, 0x8000, 0x0000 }
6294 };
6295
6296 rtl_hw_start_8168g(tp);
6297
6298 /* disable aspm and clock request before access ephy */
6299 RTL_W8(Config2, RTL_R8(Config2) & ~ClkReqEn);
6300 RTL_W8(Config5, RTL_R8(Config5) & ~ASPM_en);
6301 rtl_ephy_init(tp, e_info_8168g_1, ARRAY_SIZE(e_info_8168g_1));
6302}
6303
hayeswang57538c42013-04-01 22:23:40 +00006304static void rtl_hw_start_8168g_2(struct rtl8169_private *tp)
6305{
6306 void __iomem *ioaddr = tp->mmio_addr;
6307 static const struct ephy_info e_info_8168g_2[] = {
6308 { 0x00, 0x0000, 0x0008 },
6309 { 0x0c, 0x3df0, 0x0200 },
6310 { 0x19, 0xffff, 0xfc00 },
6311 { 0x1e, 0xffff, 0x20eb }
6312 };
6313
Chun-Hao Lin5fbea332014-12-10 21:28:38 +08006314 rtl_hw_start_8168g(tp);
hayeswang57538c42013-04-01 22:23:40 +00006315
6316 /* disable aspm and clock request before access ephy */
6317 RTL_W8(Config2, RTL_R8(Config2) & ~ClkReqEn);
6318 RTL_W8(Config5, RTL_R8(Config5) & ~ASPM_en);
6319 rtl_ephy_init(tp, e_info_8168g_2, ARRAY_SIZE(e_info_8168g_2));
6320}
6321
hayeswang45dd95c2013-07-08 17:09:01 +08006322static void rtl_hw_start_8411_2(struct rtl8169_private *tp)
6323{
6324 void __iomem *ioaddr = tp->mmio_addr;
6325 static const struct ephy_info e_info_8411_2[] = {
6326 { 0x00, 0x0000, 0x0008 },
6327 { 0x0c, 0x3df0, 0x0200 },
6328 { 0x0f, 0xffff, 0x5200 },
6329 { 0x19, 0x0020, 0x0000 },
6330 { 0x1e, 0x0000, 0x2000 }
6331 };
6332
Chun-Hao Lin5fbea332014-12-10 21:28:38 +08006333 rtl_hw_start_8168g(tp);
hayeswang45dd95c2013-07-08 17:09:01 +08006334
6335 /* disable aspm and clock request before access ephy */
6336 RTL_W8(Config2, RTL_R8(Config2) & ~ClkReqEn);
6337 RTL_W8(Config5, RTL_R8(Config5) & ~ASPM_en);
6338 rtl_ephy_init(tp, e_info_8411_2, ARRAY_SIZE(e_info_8411_2));
6339}
6340
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08006341static void rtl_hw_start_8168h_1(struct rtl8169_private *tp)
6342{
6343 void __iomem *ioaddr = tp->mmio_addr;
6344 struct pci_dev *pdev = tp->pci_dev;
Andrzej Hajda72521ea2015-09-24 16:00:24 +02006345 int rg_saw_cnt;
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08006346 u32 data;
6347 static const struct ephy_info e_info_8168h_1[] = {
6348 { 0x1e, 0x0800, 0x0001 },
6349 { 0x1d, 0x0000, 0x0800 },
6350 { 0x05, 0xffff, 0x2089 },
6351 { 0x06, 0xffff, 0x5881 },
6352 { 0x04, 0xffff, 0x154a },
6353 { 0x01, 0xffff, 0x068b }
6354 };
6355
6356 /* disable aspm and clock request before access ephy */
6357 RTL_W8(Config2, RTL_R8(Config2) & ~ClkReqEn);
6358 RTL_W8(Config5, RTL_R8(Config5) & ~ASPM_en);
6359 rtl_ephy_init(tp, e_info_8168h_1, ARRAY_SIZE(e_info_8168h_1));
6360
6361 RTL_W32(TxConfig, RTL_R32(TxConfig) | TXCFG_AUTO_FIFO);
6362
6363 rtl_eri_write(tp, 0xc8, ERIAR_MASK_0101, 0x00080002, ERIAR_EXGMAC);
6364 rtl_eri_write(tp, 0xcc, ERIAR_MASK_0001, 0x38, ERIAR_EXGMAC);
6365 rtl_eri_write(tp, 0xd0, ERIAR_MASK_0001, 0x48, ERIAR_EXGMAC);
6366 rtl_eri_write(tp, 0xe8, ERIAR_MASK_1111, 0x00100006, ERIAR_EXGMAC);
6367
6368 rtl_csi_access_enable_1(tp);
6369
6370 rtl_tx_performance_tweak(pdev, 0x5 << MAX_READ_REQUEST_SHIFT);
6371
Chun-Hao Lin706123d2014-10-01 23:17:18 +08006372 rtl_w0w1_eri(tp, 0xdc, ERIAR_MASK_0001, 0x00, 0x01, ERIAR_EXGMAC);
6373 rtl_w0w1_eri(tp, 0xdc, ERIAR_MASK_0001, 0x01, 0x00, ERIAR_EXGMAC);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08006374
Chun-Hao Lin706123d2014-10-01 23:17:18 +08006375 rtl_w0w1_eri(tp, 0xdc, ERIAR_MASK_1111, 0x0010, 0x00, ERIAR_EXGMAC);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08006376
Chun-Hao Lin706123d2014-10-01 23:17:18 +08006377 rtl_w0w1_eri(tp, 0xd4, ERIAR_MASK_1111, 0x1f00, 0x00, ERIAR_EXGMAC);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08006378
6379 rtl_eri_write(tp, 0x5f0, ERIAR_MASK_0011, 0x4f87, ERIAR_EXGMAC);
6380
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08006381 RTL_W32(MISC, RTL_R32(MISC) & ~RXDV_GATED_EN);
6382 RTL_W8(MaxTxPacketSize, EarlySize);
6383
6384 rtl_eri_write(tp, 0xc0, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);
6385 rtl_eri_write(tp, 0xb8, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);
6386
6387 /* Adjust EEE LED frequency */
6388 RTL_W8(EEE_LED, RTL_R8(EEE_LED) & ~0x07);
6389
6390 RTL_W8(DLLPR, RTL_R8(DLLPR) & ~PFM_EN);
Chun-Hao Lin69f3dc32015-12-29 22:13:37 +08006391 RTL_W8(MISC_1, RTL_R8(MISC_1) & ~PFM_D3COLD_EN);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08006392
6393 RTL_W8(DLLPR, RTL_R8(DLLPR) & ~TX_10M_PS_EN);
6394
Chun-Hao Lin706123d2014-10-01 23:17:18 +08006395 rtl_w0w1_eri(tp, 0x1b0, ERIAR_MASK_0011, 0x0000, 0x1000, ERIAR_EXGMAC);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08006396
6397 rtl_pcie_state_l2l3_enable(tp, false);
6398
6399 rtl_writephy(tp, 0x1f, 0x0c42);
Chun-Hao Lin58493332015-12-24 21:15:27 +08006400 rg_saw_cnt = (rtl_readphy(tp, 0x13) & 0x3fff);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08006401 rtl_writephy(tp, 0x1f, 0x0000);
6402 if (rg_saw_cnt > 0) {
6403 u16 sw_cnt_1ms_ini;
6404
6405 sw_cnt_1ms_ini = 16000000/rg_saw_cnt;
6406 sw_cnt_1ms_ini &= 0x0fff;
6407 data = r8168_mac_ocp_read(tp, 0xd412);
Chun-Hao Lina2cb7ec2016-02-05 02:28:00 +08006408 data &= ~0x0fff;
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08006409 data |= sw_cnt_1ms_ini;
6410 r8168_mac_ocp_write(tp, 0xd412, data);
6411 }
6412
6413 data = r8168_mac_ocp_read(tp, 0xe056);
Chun-Hao Lina2cb7ec2016-02-05 02:28:00 +08006414 data &= ~0xf0;
6415 data |= 0x70;
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08006416 r8168_mac_ocp_write(tp, 0xe056, data);
6417
6418 data = r8168_mac_ocp_read(tp, 0xe052);
Chun-Hao Lina2cb7ec2016-02-05 02:28:00 +08006419 data &= ~0x6000;
6420 data |= 0x8008;
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08006421 r8168_mac_ocp_write(tp, 0xe052, data);
6422
6423 data = r8168_mac_ocp_read(tp, 0xe0d6);
Chun-Hao Lina2cb7ec2016-02-05 02:28:00 +08006424 data &= ~0x01ff;
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08006425 data |= 0x017f;
6426 r8168_mac_ocp_write(tp, 0xe0d6, data);
6427
6428 data = r8168_mac_ocp_read(tp, 0xd420);
Chun-Hao Lina2cb7ec2016-02-05 02:28:00 +08006429 data &= ~0x0fff;
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08006430 data |= 0x047f;
6431 r8168_mac_ocp_write(tp, 0xd420, data);
6432
6433 r8168_mac_ocp_write(tp, 0xe63e, 0x0001);
6434 r8168_mac_ocp_write(tp, 0xe63e, 0x0000);
6435 r8168_mac_ocp_write(tp, 0xc094, 0x0000);
6436 r8168_mac_ocp_write(tp, 0xc09e, 0x0000);
6437}
6438
Chun-Hao Lin935e2212014-10-07 15:10:41 +08006439static void rtl_hw_start_8168ep(struct rtl8169_private *tp)
6440{
6441 void __iomem *ioaddr = tp->mmio_addr;
6442 struct pci_dev *pdev = tp->pci_dev;
6443
Chun-Hao Lin003609d2014-12-02 16:48:31 +08006444 rtl8168ep_stop_cmac(tp);
6445
Chun-Hao Lin935e2212014-10-07 15:10:41 +08006446 RTL_W32(TxConfig, RTL_R32(TxConfig) | TXCFG_AUTO_FIFO);
6447
6448 rtl_eri_write(tp, 0xc8, ERIAR_MASK_0101, 0x00080002, ERIAR_EXGMAC);
6449 rtl_eri_write(tp, 0xcc, ERIAR_MASK_0001, 0x2f, ERIAR_EXGMAC);
6450 rtl_eri_write(tp, 0xd0, ERIAR_MASK_0001, 0x5f, ERIAR_EXGMAC);
6451 rtl_eri_write(tp, 0xe8, ERIAR_MASK_1111, 0x00100006, ERIAR_EXGMAC);
6452
6453 rtl_csi_access_enable_1(tp);
6454
6455 rtl_tx_performance_tweak(pdev, 0x5 << MAX_READ_REQUEST_SHIFT);
6456
6457 rtl_w0w1_eri(tp, 0xdc, ERIAR_MASK_0001, 0x00, 0x01, ERIAR_EXGMAC);
6458 rtl_w0w1_eri(tp, 0xdc, ERIAR_MASK_0001, 0x01, 0x00, ERIAR_EXGMAC);
6459
6460 rtl_w0w1_eri(tp, 0xd4, ERIAR_MASK_1111, 0x1f80, 0x00, ERIAR_EXGMAC);
6461
6462 rtl_eri_write(tp, 0x5f0, ERIAR_MASK_0011, 0x4f87, ERIAR_EXGMAC);
6463
Chun-Hao Lin935e2212014-10-07 15:10:41 +08006464 RTL_W32(MISC, RTL_R32(MISC) & ~RXDV_GATED_EN);
6465 RTL_W8(MaxTxPacketSize, EarlySize);
6466
6467 rtl_eri_write(tp, 0xc0, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);
6468 rtl_eri_write(tp, 0xb8, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);
6469
6470 /* Adjust EEE LED frequency */
6471 RTL_W8(EEE_LED, RTL_R8(EEE_LED) & ~0x07);
6472
6473 rtl_w0w1_eri(tp, 0x2fc, ERIAR_MASK_0001, 0x01, 0x06, ERIAR_EXGMAC);
6474
6475 RTL_W8(DLLPR, RTL_R8(DLLPR) & ~TX_10M_PS_EN);
6476
6477 rtl_pcie_state_l2l3_enable(tp, false);
6478}
6479
6480static void rtl_hw_start_8168ep_1(struct rtl8169_private *tp)
6481{
6482 void __iomem *ioaddr = tp->mmio_addr;
6483 static const struct ephy_info e_info_8168ep_1[] = {
6484 { 0x00, 0xffff, 0x10ab },
6485 { 0x06, 0xffff, 0xf030 },
6486 { 0x08, 0xffff, 0x2006 },
6487 { 0x0d, 0xffff, 0x1666 },
6488 { 0x0c, 0x3ff0, 0x0000 }
6489 };
6490
6491 /* disable aspm and clock request before access ephy */
6492 RTL_W8(Config2, RTL_R8(Config2) & ~ClkReqEn);
6493 RTL_W8(Config5, RTL_R8(Config5) & ~ASPM_en);
6494 rtl_ephy_init(tp, e_info_8168ep_1, ARRAY_SIZE(e_info_8168ep_1));
6495
6496 rtl_hw_start_8168ep(tp);
6497}
6498
6499static void rtl_hw_start_8168ep_2(struct rtl8169_private *tp)
6500{
6501 void __iomem *ioaddr = tp->mmio_addr;
6502 static const struct ephy_info e_info_8168ep_2[] = {
6503 { 0x00, 0xffff, 0x10a3 },
6504 { 0x19, 0xffff, 0xfc00 },
6505 { 0x1e, 0xffff, 0x20ea }
6506 };
6507
6508 /* disable aspm and clock request before access ephy */
6509 RTL_W8(Config2, RTL_R8(Config2) & ~ClkReqEn);
6510 RTL_W8(Config5, RTL_R8(Config5) & ~ASPM_en);
6511 rtl_ephy_init(tp, e_info_8168ep_2, ARRAY_SIZE(e_info_8168ep_2));
6512
6513 rtl_hw_start_8168ep(tp);
6514
6515 RTL_W8(DLLPR, RTL_R8(DLLPR) & ~PFM_EN);
Chun-Hao Lin69f3dc32015-12-29 22:13:37 +08006516 RTL_W8(MISC_1, RTL_R8(MISC_1) & ~PFM_D3COLD_EN);
Chun-Hao Lin935e2212014-10-07 15:10:41 +08006517}
6518
6519static void rtl_hw_start_8168ep_3(struct rtl8169_private *tp)
6520{
6521 void __iomem *ioaddr = tp->mmio_addr;
6522 u32 data;
6523 static const struct ephy_info e_info_8168ep_3[] = {
6524 { 0x00, 0xffff, 0x10a3 },
6525 { 0x19, 0xffff, 0x7c00 },
6526 { 0x1e, 0xffff, 0x20eb },
6527 { 0x0d, 0xffff, 0x1666 }
6528 };
6529
6530 /* disable aspm and clock request before access ephy */
6531 RTL_W8(Config2, RTL_R8(Config2) & ~ClkReqEn);
6532 RTL_W8(Config5, RTL_R8(Config5) & ~ASPM_en);
6533 rtl_ephy_init(tp, e_info_8168ep_3, ARRAY_SIZE(e_info_8168ep_3));
6534
6535 rtl_hw_start_8168ep(tp);
6536
6537 RTL_W8(DLLPR, RTL_R8(DLLPR) & ~PFM_EN);
Chun-Hao Lin69f3dc32015-12-29 22:13:37 +08006538 RTL_W8(MISC_1, RTL_R8(MISC_1) & ~PFM_D3COLD_EN);
Chun-Hao Lin935e2212014-10-07 15:10:41 +08006539
6540 data = r8168_mac_ocp_read(tp, 0xd3e2);
6541 data &= 0xf000;
6542 data |= 0x0271;
6543 r8168_mac_ocp_write(tp, 0xd3e2, data);
6544
6545 data = r8168_mac_ocp_read(tp, 0xd3e4);
6546 data &= 0xff00;
6547 r8168_mac_ocp_write(tp, 0xd3e4, data);
6548
6549 data = r8168_mac_ocp_read(tp, 0xe860);
6550 data |= 0x0080;
6551 r8168_mac_ocp_write(tp, 0xe860, data);
6552}
6553
Francois Romieu07ce4062007-02-23 23:36:39 +01006554static void rtl_hw_start_8168(struct net_device *dev)
6555{
Francois Romieu2dd99532007-06-11 23:22:52 +02006556 struct rtl8169_private *tp = netdev_priv(dev);
6557 void __iomem *ioaddr = tp->mmio_addr;
6558
6559 RTL_W8(Cfg9346, Cfg9346_Unlock);
6560
françois romieuf0298f82011-01-03 15:07:42 +00006561 RTL_W8(MaxTxPacketSize, TxPacketMax);
Francois Romieu2dd99532007-06-11 23:22:52 +02006562
Eric Dumazet6f0333b2010-10-11 11:17:47 +00006563 rtl_set_rx_max_size(ioaddr, rx_buf_sz);
Francois Romieu2dd99532007-06-11 23:22:52 +02006564
Francois Romieu0e485152007-02-20 00:00:26 +01006565 tp->cp_cmd |= RTL_R16(CPlusCmd) | PktCntrDisable | INTT_1;
Francois Romieu2dd99532007-06-11 23:22:52 +02006566
6567 RTL_W16(CPlusCmd, tp->cp_cmd);
6568
Francois Romieu0e485152007-02-20 00:00:26 +01006569 RTL_W16(IntrMitigate, 0x5151);
6570
6571 /* Work around for RxFIFO overflow. */
françois romieu811fd302011-12-04 20:30:45 +00006572 if (tp->mac_version == RTL_GIGA_MAC_VER_11) {
Francois Romieuda78dbf2012-01-26 14:18:23 +01006573 tp->event_slow |= RxFIFOOver | PCSTimeout;
6574 tp->event_slow &= ~RxOverflow;
Francois Romieu0e485152007-02-20 00:00:26 +01006575 }
Francois Romieu2dd99532007-06-11 23:22:52 +02006576
6577 rtl_set_rx_tx_desc_registers(tp, ioaddr);
6578
hayeswang1a964642013-04-01 22:23:41 +00006579 rtl_set_rx_tx_config_registers(tp);
Francois Romieu2dd99532007-06-11 23:22:52 +02006580
6581 RTL_R8(IntrMask);
6582
Francois Romieu219a1e92008-06-28 11:58:39 +02006583 switch (tp->mac_version) {
6584 case RTL_GIGA_MAC_VER_11:
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006585 rtl_hw_start_8168bb(tp);
hayeswang4804b3b2011-03-21 01:50:29 +00006586 break;
Francois Romieu219a1e92008-06-28 11:58:39 +02006587
6588 case RTL_GIGA_MAC_VER_12:
6589 case RTL_GIGA_MAC_VER_17:
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006590 rtl_hw_start_8168bef(tp);
hayeswang4804b3b2011-03-21 01:50:29 +00006591 break;
Francois Romieu219a1e92008-06-28 11:58:39 +02006592
6593 case RTL_GIGA_MAC_VER_18:
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006594 rtl_hw_start_8168cp_1(tp);
hayeswang4804b3b2011-03-21 01:50:29 +00006595 break;
Francois Romieu219a1e92008-06-28 11:58:39 +02006596
6597 case RTL_GIGA_MAC_VER_19:
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006598 rtl_hw_start_8168c_1(tp);
hayeswang4804b3b2011-03-21 01:50:29 +00006599 break;
Francois Romieu219a1e92008-06-28 11:58:39 +02006600
6601 case RTL_GIGA_MAC_VER_20:
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006602 rtl_hw_start_8168c_2(tp);
hayeswang4804b3b2011-03-21 01:50:29 +00006603 break;
Francois Romieu219a1e92008-06-28 11:58:39 +02006604
Francois Romieu197ff762008-06-28 13:16:02 +02006605 case RTL_GIGA_MAC_VER_21:
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006606 rtl_hw_start_8168c_3(tp);
hayeswang4804b3b2011-03-21 01:50:29 +00006607 break;
Francois Romieu197ff762008-06-28 13:16:02 +02006608
Francois Romieu6fb07052008-06-29 11:54:28 +02006609 case RTL_GIGA_MAC_VER_22:
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006610 rtl_hw_start_8168c_4(tp);
hayeswang4804b3b2011-03-21 01:50:29 +00006611 break;
Francois Romieu6fb07052008-06-29 11:54:28 +02006612
Francois Romieuef3386f2008-06-29 12:24:30 +02006613 case RTL_GIGA_MAC_VER_23:
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006614 rtl_hw_start_8168cp_2(tp);
hayeswang4804b3b2011-03-21 01:50:29 +00006615 break;
Francois Romieuef3386f2008-06-29 12:24:30 +02006616
Francois Romieu7f3e3d32008-07-20 18:53:20 +02006617 case RTL_GIGA_MAC_VER_24:
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006618 rtl_hw_start_8168cp_3(tp);
hayeswang4804b3b2011-03-21 01:50:29 +00006619 break;
Francois Romieu7f3e3d32008-07-20 18:53:20 +02006620
Francois Romieu5b538df2008-07-20 16:22:45 +02006621 case RTL_GIGA_MAC_VER_25:
françois romieudaf9df62009-10-07 12:44:20 +00006622 case RTL_GIGA_MAC_VER_26:
6623 case RTL_GIGA_MAC_VER_27:
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006624 rtl_hw_start_8168d(tp);
hayeswang4804b3b2011-03-21 01:50:29 +00006625 break;
Francois Romieu5b538df2008-07-20 16:22:45 +02006626
françois romieue6de30d2011-01-03 15:08:37 +00006627 case RTL_GIGA_MAC_VER_28:
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006628 rtl_hw_start_8168d_4(tp);
hayeswang4804b3b2011-03-21 01:50:29 +00006629 break;
Francois Romieucecb5fd2011-04-01 10:21:07 +02006630
hayeswang4804b3b2011-03-21 01:50:29 +00006631 case RTL_GIGA_MAC_VER_31:
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006632 rtl_hw_start_8168dp(tp);
hayeswang4804b3b2011-03-21 01:50:29 +00006633 break;
6634
hayeswang01dc7fe2011-03-21 01:50:28 +00006635 case RTL_GIGA_MAC_VER_32:
6636 case RTL_GIGA_MAC_VER_33:
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006637 rtl_hw_start_8168e_1(tp);
Hayes Wang70090422011-07-06 15:58:06 +08006638 break;
6639 case RTL_GIGA_MAC_VER_34:
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006640 rtl_hw_start_8168e_2(tp);
hayeswang01dc7fe2011-03-21 01:50:28 +00006641 break;
françois romieue6de30d2011-01-03 15:08:37 +00006642
Hayes Wangc2218922011-09-06 16:55:18 +08006643 case RTL_GIGA_MAC_VER_35:
6644 case RTL_GIGA_MAC_VER_36:
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006645 rtl_hw_start_8168f_1(tp);
Hayes Wangc2218922011-09-06 16:55:18 +08006646 break;
6647
Hayes Wangb3d7b2f2012-03-30 14:48:06 +08006648 case RTL_GIGA_MAC_VER_38:
6649 rtl_hw_start_8411(tp);
6650 break;
6651
Hayes Wangc5583862012-07-02 17:23:22 +08006652 case RTL_GIGA_MAC_VER_40:
6653 case RTL_GIGA_MAC_VER_41:
6654 rtl_hw_start_8168g_1(tp);
6655 break;
hayeswang57538c42013-04-01 22:23:40 +00006656 case RTL_GIGA_MAC_VER_42:
6657 rtl_hw_start_8168g_2(tp);
6658 break;
Hayes Wangc5583862012-07-02 17:23:22 +08006659
hayeswang45dd95c2013-07-08 17:09:01 +08006660 case RTL_GIGA_MAC_VER_44:
6661 rtl_hw_start_8411_2(tp);
6662 break;
6663
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08006664 case RTL_GIGA_MAC_VER_45:
6665 case RTL_GIGA_MAC_VER_46:
6666 rtl_hw_start_8168h_1(tp);
6667 break;
6668
Chun-Hao Lin935e2212014-10-07 15:10:41 +08006669 case RTL_GIGA_MAC_VER_49:
6670 rtl_hw_start_8168ep_1(tp);
6671 break;
6672
6673 case RTL_GIGA_MAC_VER_50:
6674 rtl_hw_start_8168ep_2(tp);
6675 break;
6676
6677 case RTL_GIGA_MAC_VER_51:
6678 rtl_hw_start_8168ep_3(tp);
6679 break;
6680
Francois Romieu219a1e92008-06-28 11:58:39 +02006681 default:
6682 printk(KERN_ERR PFX "%s: unknown chipset (mac_version = %d).\n",
6683 dev->name, tp->mac_version);
hayeswang4804b3b2011-03-21 01:50:29 +00006684 break;
Francois Romieu219a1e92008-06-28 11:58:39 +02006685 }
Francois Romieu2dd99532007-06-11 23:22:52 +02006686
hayeswang1a964642013-04-01 22:23:41 +00006687 RTL_W8(Cfg9346, Cfg9346_Lock);
6688
Francois Romieu0e485152007-02-20 00:00:26 +01006689 RTL_W8(ChipCmd, CmdTxEnb | CmdRxEnb);
6690
hayeswang1a964642013-04-01 22:23:41 +00006691 rtl_set_rx_mode(dev);
Francois Romieub8363902008-06-01 12:31:57 +02006692
Chun-Hao Lin05b96872014-10-01 23:17:12 +08006693 RTL_W16(MultiIntr, RTL_R16(MultiIntr) & 0xf000);
Francois Romieu07ce4062007-02-23 23:36:39 +01006694}
Linus Torvalds1da177e2005-04-16 15:20:36 -07006695
Francois Romieu2857ffb2008-08-02 21:08:49 +02006696#define R810X_CPCMD_QUIRK_MASK (\
6697 EnableBist | \
6698 Mac_dbgo_oe | \
6699 Force_half_dup | \
françois romieu5edcc532009-08-10 19:41:52 +00006700 Force_rxflow_en | \
Francois Romieu2857ffb2008-08-02 21:08:49 +02006701 Force_txflow_en | \
6702 Cxpl_dbg_sel | \
6703 ASF | \
6704 PktCntrDisable | \
Hayes Wangd24e9aa2011-02-22 17:26:19 +08006705 Mac_dbgo_sel)
Francois Romieu2857ffb2008-08-02 21:08:49 +02006706
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006707static void rtl_hw_start_8102e_1(struct rtl8169_private *tp)
Francois Romieu2857ffb2008-08-02 21:08:49 +02006708{
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006709 void __iomem *ioaddr = tp->mmio_addr;
6710 struct pci_dev *pdev = tp->pci_dev;
Alexey Dobriyan350f7592009-11-25 15:54:21 -08006711 static const struct ephy_info e_info_8102e_1[] = {
Francois Romieu2857ffb2008-08-02 21:08:49 +02006712 { 0x01, 0, 0x6e65 },
6713 { 0x02, 0, 0x091f },
6714 { 0x03, 0, 0xc2f9 },
6715 { 0x06, 0, 0xafb5 },
6716 { 0x07, 0, 0x0e00 },
6717 { 0x19, 0, 0xec80 },
6718 { 0x01, 0, 0x2e65 },
6719 { 0x01, 0, 0x6e65 }
6720 };
6721 u8 cfg1;
6722
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006723 rtl_csi_access_enable_2(tp);
Francois Romieu2857ffb2008-08-02 21:08:49 +02006724
6725 RTL_W8(DBG_REG, FIX_NAK_1);
6726
6727 rtl_tx_performance_tweak(pdev, 0x5 << MAX_READ_REQUEST_SHIFT);
6728
6729 RTL_W8(Config1,
6730 LEDS1 | LEDS0 | Speed_down | MEMMAP | IOMAP | VPD | PMEnable);
6731 RTL_W8(Config3, RTL_R8(Config3) & ~Beacon_en);
6732
6733 cfg1 = RTL_R8(Config1);
6734 if ((cfg1 & LEDS0) && (cfg1 & LEDS1))
6735 RTL_W8(Config1, cfg1 & ~LEDS0);
6736
Francois Romieufdf6fc02012-07-06 22:40:38 +02006737 rtl_ephy_init(tp, e_info_8102e_1, ARRAY_SIZE(e_info_8102e_1));
Francois Romieu2857ffb2008-08-02 21:08:49 +02006738}
6739
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006740static void rtl_hw_start_8102e_2(struct rtl8169_private *tp)
Francois Romieu2857ffb2008-08-02 21:08:49 +02006741{
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006742 void __iomem *ioaddr = tp->mmio_addr;
6743 struct pci_dev *pdev = tp->pci_dev;
6744
6745 rtl_csi_access_enable_2(tp);
Francois Romieu2857ffb2008-08-02 21:08:49 +02006746
6747 rtl_tx_performance_tweak(pdev, 0x5 << MAX_READ_REQUEST_SHIFT);
6748
6749 RTL_W8(Config1, MEMMAP | IOMAP | VPD | PMEnable);
6750 RTL_W8(Config3, RTL_R8(Config3) & ~Beacon_en);
Francois Romieu2857ffb2008-08-02 21:08:49 +02006751}
6752
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006753static void rtl_hw_start_8102e_3(struct rtl8169_private *tp)
Francois Romieu2857ffb2008-08-02 21:08:49 +02006754{
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006755 rtl_hw_start_8102e_2(tp);
Francois Romieu2857ffb2008-08-02 21:08:49 +02006756
Francois Romieufdf6fc02012-07-06 22:40:38 +02006757 rtl_ephy_write(tp, 0x03, 0xc2f9);
Francois Romieu2857ffb2008-08-02 21:08:49 +02006758}
6759
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006760static void rtl_hw_start_8105e_1(struct rtl8169_private *tp)
Hayes Wang5a5e4442011-02-22 17:26:21 +08006761{
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006762 void __iomem *ioaddr = tp->mmio_addr;
Hayes Wang5a5e4442011-02-22 17:26:21 +08006763 static const struct ephy_info e_info_8105e_1[] = {
6764 { 0x07, 0, 0x4000 },
6765 { 0x19, 0, 0x0200 },
6766 { 0x19, 0, 0x0020 },
6767 { 0x1e, 0, 0x2000 },
6768 { 0x03, 0, 0x0001 },
6769 { 0x19, 0, 0x0100 },
6770 { 0x19, 0, 0x0004 },
6771 { 0x0a, 0, 0x0020 }
6772 };
6773
Francois Romieucecb5fd2011-04-01 10:21:07 +02006774 /* Force LAN exit from ASPM if Rx/Tx are not idle */
Hayes Wang5a5e4442011-02-22 17:26:21 +08006775 RTL_W32(FuncEvent, RTL_R32(FuncEvent) | 0x002800);
6776
Francois Romieucecb5fd2011-04-01 10:21:07 +02006777 /* Disable Early Tally Counter */
Hayes Wang5a5e4442011-02-22 17:26:21 +08006778 RTL_W32(FuncEvent, RTL_R32(FuncEvent) & ~0x010000);
6779
6780 RTL_W8(MCU, RTL_R8(MCU) | EN_NDP | EN_OOB_RESET);
Hayes Wang4f6b00e52011-07-06 15:58:02 +08006781 RTL_W8(DLLPR, RTL_R8(DLLPR) | PFM_EN);
Hayes Wang5a5e4442011-02-22 17:26:21 +08006782
Francois Romieufdf6fc02012-07-06 22:40:38 +02006783 rtl_ephy_init(tp, e_info_8105e_1, ARRAY_SIZE(e_info_8105e_1));
hayeswangb51ecea2014-07-09 14:52:51 +08006784
6785 rtl_pcie_state_l2l3_enable(tp, false);
Hayes Wang5a5e4442011-02-22 17:26:21 +08006786}
6787
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006788static void rtl_hw_start_8105e_2(struct rtl8169_private *tp)
Hayes Wang5a5e4442011-02-22 17:26:21 +08006789{
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006790 rtl_hw_start_8105e_1(tp);
Francois Romieufdf6fc02012-07-06 22:40:38 +02006791 rtl_ephy_write(tp, 0x1e, rtl_ephy_read(tp, 0x1e) | 0x8000);
Hayes Wang5a5e4442011-02-22 17:26:21 +08006792}
6793
Hayes Wang7e18dca2012-03-30 14:33:02 +08006794static void rtl_hw_start_8402(struct rtl8169_private *tp)
6795{
6796 void __iomem *ioaddr = tp->mmio_addr;
6797 static const struct ephy_info e_info_8402[] = {
6798 { 0x19, 0xffff, 0xff64 },
6799 { 0x1e, 0, 0x4000 }
6800 };
6801
6802 rtl_csi_access_enable_2(tp);
6803
6804 /* Force LAN exit from ASPM if Rx/Tx are not idle */
6805 RTL_W32(FuncEvent, RTL_R32(FuncEvent) | 0x002800);
6806
6807 RTL_W32(TxConfig, RTL_R32(TxConfig) | TXCFG_AUTO_FIFO);
6808 RTL_W8(MCU, RTL_R8(MCU) & ~NOW_IS_OOB);
6809
Francois Romieufdf6fc02012-07-06 22:40:38 +02006810 rtl_ephy_init(tp, e_info_8402, ARRAY_SIZE(e_info_8402));
Hayes Wang7e18dca2012-03-30 14:33:02 +08006811
6812 rtl_tx_performance_tweak(tp->pci_dev, 0x5 << MAX_READ_REQUEST_SHIFT);
6813
Francois Romieufdf6fc02012-07-06 22:40:38 +02006814 rtl_eri_write(tp, 0xc8, ERIAR_MASK_1111, 0x00000002, ERIAR_EXGMAC);
6815 rtl_eri_write(tp, 0xe8, ERIAR_MASK_1111, 0x00000006, ERIAR_EXGMAC);
Chun-Hao Lin706123d2014-10-01 23:17:18 +08006816 rtl_w0w1_eri(tp, 0xdc, ERIAR_MASK_0001, 0x00, 0x01, ERIAR_EXGMAC);
6817 rtl_w0w1_eri(tp, 0xdc, ERIAR_MASK_0001, 0x01, 0x00, ERIAR_EXGMAC);
Francois Romieufdf6fc02012-07-06 22:40:38 +02006818 rtl_eri_write(tp, 0xc0, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);
6819 rtl_eri_write(tp, 0xb8, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);
Chun-Hao Lin706123d2014-10-01 23:17:18 +08006820 rtl_w0w1_eri(tp, 0x0d4, ERIAR_MASK_0011, 0x0e00, 0xff00, ERIAR_EXGMAC);
hayeswangb51ecea2014-07-09 14:52:51 +08006821
6822 rtl_pcie_state_l2l3_enable(tp, false);
Hayes Wang7e18dca2012-03-30 14:33:02 +08006823}
6824
Hayes Wang5598bfe2012-07-02 17:23:21 +08006825static void rtl_hw_start_8106(struct rtl8169_private *tp)
6826{
6827 void __iomem *ioaddr = tp->mmio_addr;
6828
6829 /* Force LAN exit from ASPM if Rx/Tx are not idle */
6830 RTL_W32(FuncEvent, RTL_R32(FuncEvent) | 0x002800);
6831
Francois Romieu4521e1a92012-11-01 16:46:28 +00006832 RTL_W32(MISC, (RTL_R32(MISC) | DISABLE_LAN_EN) & ~EARLY_TALLY_EN);
Hayes Wang5598bfe2012-07-02 17:23:21 +08006833 RTL_W8(MCU, RTL_R8(MCU) | EN_NDP | EN_OOB_RESET);
6834 RTL_W8(DLLPR, RTL_R8(DLLPR) & ~PFM_EN);
hayeswangb51ecea2014-07-09 14:52:51 +08006835
6836 rtl_pcie_state_l2l3_enable(tp, false);
Hayes Wang5598bfe2012-07-02 17:23:21 +08006837}
6838
Francois Romieu07ce4062007-02-23 23:36:39 +01006839static void rtl_hw_start_8101(struct net_device *dev)
6840{
Francois Romieucdf1a602007-06-11 23:29:50 +02006841 struct rtl8169_private *tp = netdev_priv(dev);
6842 void __iomem *ioaddr = tp->mmio_addr;
6843 struct pci_dev *pdev = tp->pci_dev;
6844
Francois Romieuda78dbf2012-01-26 14:18:23 +01006845 if (tp->mac_version >= RTL_GIGA_MAC_VER_30)
6846 tp->event_slow &= ~RxFIFOOver;
françois romieu811fd302011-12-04 20:30:45 +00006847
Francois Romieucecb5fd2011-04-01 10:21:07 +02006848 if (tp->mac_version == RTL_GIGA_MAC_VER_13 ||
Jiang Liu7d7903b2012-07-24 17:20:16 +08006849 tp->mac_version == RTL_GIGA_MAC_VER_16)
Bjorn Helgaas8200bc72012-08-22 10:29:42 -06006850 pcie_capability_set_word(pdev, PCI_EXP_DEVCTL,
6851 PCI_EXP_DEVCTL_NOSNOOP_EN);
Francois Romieucdf1a602007-06-11 23:29:50 +02006852
Hayes Wangd24e9aa2011-02-22 17:26:19 +08006853 RTL_W8(Cfg9346, Cfg9346_Unlock);
6854
hayeswang1a964642013-04-01 22:23:41 +00006855 RTL_W8(MaxTxPacketSize, TxPacketMax);
6856
6857 rtl_set_rx_max_size(ioaddr, rx_buf_sz);
6858
6859 tp->cp_cmd &= ~R810X_CPCMD_QUIRK_MASK;
6860 RTL_W16(CPlusCmd, tp->cp_cmd);
6861
6862 rtl_set_rx_tx_desc_registers(tp, ioaddr);
6863
6864 rtl_set_rx_tx_config_registers(tp);
6865
Francois Romieu2857ffb2008-08-02 21:08:49 +02006866 switch (tp->mac_version) {
6867 case RTL_GIGA_MAC_VER_07:
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006868 rtl_hw_start_8102e_1(tp);
Francois Romieu2857ffb2008-08-02 21:08:49 +02006869 break;
6870
6871 case RTL_GIGA_MAC_VER_08:
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006872 rtl_hw_start_8102e_3(tp);
Francois Romieu2857ffb2008-08-02 21:08:49 +02006873 break;
6874
6875 case RTL_GIGA_MAC_VER_09:
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006876 rtl_hw_start_8102e_2(tp);
Francois Romieu2857ffb2008-08-02 21:08:49 +02006877 break;
Hayes Wang5a5e4442011-02-22 17:26:21 +08006878
6879 case RTL_GIGA_MAC_VER_29:
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006880 rtl_hw_start_8105e_1(tp);
Hayes Wang5a5e4442011-02-22 17:26:21 +08006881 break;
6882 case RTL_GIGA_MAC_VER_30:
Hayes Wangbeb1fe12012-03-30 14:33:01 +08006883 rtl_hw_start_8105e_2(tp);
Hayes Wang5a5e4442011-02-22 17:26:21 +08006884 break;
Hayes Wang7e18dca2012-03-30 14:33:02 +08006885
6886 case RTL_GIGA_MAC_VER_37:
6887 rtl_hw_start_8402(tp);
6888 break;
Hayes Wang5598bfe2012-07-02 17:23:21 +08006889
6890 case RTL_GIGA_MAC_VER_39:
6891 rtl_hw_start_8106(tp);
6892 break;
hayeswang58152cd2013-04-01 22:23:42 +00006893 case RTL_GIGA_MAC_VER_43:
6894 rtl_hw_start_8168g_2(tp);
6895 break;
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08006896 case RTL_GIGA_MAC_VER_47:
6897 case RTL_GIGA_MAC_VER_48:
6898 rtl_hw_start_8168h_1(tp);
6899 break;
Francois Romieucdf1a602007-06-11 23:29:50 +02006900 }
6901
Hayes Wangd24e9aa2011-02-22 17:26:19 +08006902 RTL_W8(Cfg9346, Cfg9346_Lock);
Francois Romieucdf1a602007-06-11 23:29:50 +02006903
Francois Romieucdf1a602007-06-11 23:29:50 +02006904 RTL_W16(IntrMitigate, 0x0000);
6905
Francois Romieucdf1a602007-06-11 23:29:50 +02006906 RTL_W8(ChipCmd, CmdTxEnb | CmdRxEnb);
Francois Romieucdf1a602007-06-11 23:29:50 +02006907
Francois Romieucdf1a602007-06-11 23:29:50 +02006908 rtl_set_rx_mode(dev);
6909
hayeswang1a964642013-04-01 22:23:41 +00006910 RTL_R8(IntrMask);
6911
Francois Romieucdf1a602007-06-11 23:29:50 +02006912 RTL_W16(MultiIntr, RTL_R16(MultiIntr) & 0xf000);
Linus Torvalds1da177e2005-04-16 15:20:36 -07006913}
6914
6915static int rtl8169_change_mtu(struct net_device *dev, int new_mtu)
6916{
Francois Romieud58d46b2011-05-03 16:38:29 +02006917 struct rtl8169_private *tp = netdev_priv(dev);
6918
Francois Romieud58d46b2011-05-03 16:38:29 +02006919 if (new_mtu > ETH_DATA_LEN)
6920 rtl_hw_jumbo_enable(tp);
6921 else
6922 rtl_hw_jumbo_disable(tp);
6923
Linus Torvalds1da177e2005-04-16 15:20:36 -07006924 dev->mtu = new_mtu;
Michał Mirosław350fb322011-04-08 06:35:56 +00006925 netdev_update_features(dev);
6926
Stanislaw Gruszka323bb682010-10-20 22:25:41 +00006927 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006928}
6929
6930static inline void rtl8169_make_unusable_by_asic(struct RxDesc *desc)
6931{
Al Viro95e09182007-12-22 18:55:39 +00006932 desc->addr = cpu_to_le64(0x0badbadbadbadbadull);
Linus Torvalds1da177e2005-04-16 15:20:36 -07006933 desc->opts1 &= ~cpu_to_le32(DescOwn | RsvdMask);
6934}
6935
Eric Dumazet6f0333b2010-10-11 11:17:47 +00006936static void rtl8169_free_rx_databuff(struct rtl8169_private *tp,
6937 void **data_buff, struct RxDesc *desc)
Linus Torvalds1da177e2005-04-16 15:20:36 -07006938{
Stanislaw Gruszka48addcc2010-10-20 22:25:39 +00006939 dma_unmap_single(&tp->pci_dev->dev, le64_to_cpu(desc->addr), rx_buf_sz,
Stanislaw Gruszka231aee62010-10-20 22:25:38 +00006940 DMA_FROM_DEVICE);
Stanislaw Gruszka48addcc2010-10-20 22:25:39 +00006941
Eric Dumazet6f0333b2010-10-11 11:17:47 +00006942 kfree(*data_buff);
6943 *data_buff = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006944 rtl8169_make_unusable_by_asic(desc);
6945}
6946
6947static inline void rtl8169_mark_to_asic(struct RxDesc *desc, u32 rx_buf_sz)
6948{
6949 u32 eor = le32_to_cpu(desc->opts1) & RingEnd;
6950
Alexander Duycka0750132014-12-11 15:02:17 -08006951 /* Force memory writes to complete before releasing descriptor */
6952 dma_wmb();
6953
Linus Torvalds1da177e2005-04-16 15:20:36 -07006954 desc->opts1 = cpu_to_le32(DescOwn | eor | rx_buf_sz);
6955}
6956
6957static inline void rtl8169_map_to_asic(struct RxDesc *desc, dma_addr_t mapping,
6958 u32 rx_buf_sz)
6959{
6960 desc->addr = cpu_to_le64(mapping);
Linus Torvalds1da177e2005-04-16 15:20:36 -07006961 rtl8169_mark_to_asic(desc, rx_buf_sz);
6962}
6963
Eric Dumazet6f0333b2010-10-11 11:17:47 +00006964static inline void *rtl8169_align(void *data)
Linus Torvalds1da177e2005-04-16 15:20:36 -07006965{
Eric Dumazet6f0333b2010-10-11 11:17:47 +00006966 return (void *)ALIGN((long)data, 16);
6967}
6968
Stanislaw Gruszka0ecbe1c2010-10-20 22:25:37 +00006969static struct sk_buff *rtl8169_alloc_rx_data(struct rtl8169_private *tp,
6970 struct RxDesc *desc)
Eric Dumazet6f0333b2010-10-11 11:17:47 +00006971{
6972 void *data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006973 dma_addr_t mapping;
Stanislaw Gruszka48addcc2010-10-20 22:25:39 +00006974 struct device *d = &tp->pci_dev->dev;
Stanislaw Gruszka0ecbe1c2010-10-20 22:25:37 +00006975 struct net_device *dev = tp->dev;
Eric Dumazet6f0333b2010-10-11 11:17:47 +00006976 int node = dev->dev.parent ? dev_to_node(dev->dev.parent) : -1;
Linus Torvalds1da177e2005-04-16 15:20:36 -07006977
Eric Dumazet6f0333b2010-10-11 11:17:47 +00006978 data = kmalloc_node(rx_buf_sz, GFP_KERNEL, node);
6979 if (!data)
6980 return NULL;
Francois Romieue9f63f32007-02-28 23:16:57 +01006981
Eric Dumazet6f0333b2010-10-11 11:17:47 +00006982 if (rtl8169_align(data) != data) {
6983 kfree(data);
6984 data = kmalloc_node(rx_buf_sz + 15, GFP_KERNEL, node);
6985 if (!data)
6986 return NULL;
6987 }
Stanislaw Gruszka3eafe502010-10-20 22:25:36 +00006988
Stanislaw Gruszka48addcc2010-10-20 22:25:39 +00006989 mapping = dma_map_single(d, rtl8169_align(data), rx_buf_sz,
Stanislaw Gruszka231aee62010-10-20 22:25:38 +00006990 DMA_FROM_DEVICE);
Stanislaw Gruszkad827d862010-10-20 22:25:43 +00006991 if (unlikely(dma_mapping_error(d, mapping))) {
6992 if (net_ratelimit())
6993 netif_err(tp, drv, tp->dev, "Failed to map RX DMA!\n");
Stanislaw Gruszka3eafe502010-10-20 22:25:36 +00006994 goto err_out;
Stanislaw Gruszkad827d862010-10-20 22:25:43 +00006995 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07006996
6997 rtl8169_map_to_asic(desc, mapping, rx_buf_sz);
Eric Dumazet6f0333b2010-10-11 11:17:47 +00006998 return data;
Stanislaw Gruszka3eafe502010-10-20 22:25:36 +00006999
7000err_out:
7001 kfree(data);
7002 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007003}
7004
7005static void rtl8169_rx_clear(struct rtl8169_private *tp)
7006{
Francois Romieu07d3f512007-02-21 22:40:46 +01007007 unsigned int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007008
7009 for (i = 0; i < NUM_RX_DESC; i++) {
Eric Dumazet6f0333b2010-10-11 11:17:47 +00007010 if (tp->Rx_databuff[i]) {
7011 rtl8169_free_rx_databuff(tp, tp->Rx_databuff + i,
Linus Torvalds1da177e2005-04-16 15:20:36 -07007012 tp->RxDescArray + i);
7013 }
7014 }
7015}
7016
Stanislaw Gruszka0ecbe1c2010-10-20 22:25:37 +00007017static inline void rtl8169_mark_as_last_descriptor(struct RxDesc *desc)
Linus Torvalds1da177e2005-04-16 15:20:36 -07007018{
Stanislaw Gruszka0ecbe1c2010-10-20 22:25:37 +00007019 desc->opts1 |= cpu_to_le32(RingEnd);
7020}
Francois Romieu5b0384f2006-08-16 16:00:01 +02007021
Stanislaw Gruszka0ecbe1c2010-10-20 22:25:37 +00007022static int rtl8169_rx_fill(struct rtl8169_private *tp)
7023{
7024 unsigned int i;
7025
7026 for (i = 0; i < NUM_RX_DESC; i++) {
Eric Dumazet6f0333b2010-10-11 11:17:47 +00007027 void *data;
Francois Romieu4ae47c22007-06-16 23:28:45 +02007028
Eric Dumazet6f0333b2010-10-11 11:17:47 +00007029 if (tp->Rx_databuff[i])
Linus Torvalds1da177e2005-04-16 15:20:36 -07007030 continue;
Francois Romieubcf0bf92006-07-26 23:14:13 +02007031
Stanislaw Gruszka0ecbe1c2010-10-20 22:25:37 +00007032 data = rtl8169_alloc_rx_data(tp, tp->RxDescArray + i);
Eric Dumazet6f0333b2010-10-11 11:17:47 +00007033 if (!data) {
7034 rtl8169_make_unusable_by_asic(tp->RxDescArray + i);
Stanislaw Gruszka0ecbe1c2010-10-20 22:25:37 +00007035 goto err_out;
Eric Dumazet6f0333b2010-10-11 11:17:47 +00007036 }
7037 tp->Rx_databuff[i] = data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007038 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07007039
Stanislaw Gruszka0ecbe1c2010-10-20 22:25:37 +00007040 rtl8169_mark_as_last_descriptor(tp->RxDescArray + NUM_RX_DESC - 1);
7041 return 0;
7042
7043err_out:
7044 rtl8169_rx_clear(tp);
7045 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007046}
7047
Linus Torvalds1da177e2005-04-16 15:20:36 -07007048static int rtl8169_init_ring(struct net_device *dev)
7049{
7050 struct rtl8169_private *tp = netdev_priv(dev);
7051
7052 rtl8169_init_ring_indexes(tp);
7053
7054 memset(tp->tx_skb, 0x0, NUM_TX_DESC * sizeof(struct ring_info));
Eric Dumazet6f0333b2010-10-11 11:17:47 +00007055 memset(tp->Rx_databuff, 0x0, NUM_RX_DESC * sizeof(void *));
Linus Torvalds1da177e2005-04-16 15:20:36 -07007056
Stanislaw Gruszka0ecbe1c2010-10-20 22:25:37 +00007057 return rtl8169_rx_fill(tp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007058}
7059
Stanislaw Gruszka48addcc2010-10-20 22:25:39 +00007060static void rtl8169_unmap_tx_skb(struct device *d, struct ring_info *tx_skb,
Linus Torvalds1da177e2005-04-16 15:20:36 -07007061 struct TxDesc *desc)
7062{
7063 unsigned int len = tx_skb->len;
7064
Stanislaw Gruszka48addcc2010-10-20 22:25:39 +00007065 dma_unmap_single(d, le64_to_cpu(desc->addr), len, DMA_TO_DEVICE);
7066
Linus Torvalds1da177e2005-04-16 15:20:36 -07007067 desc->opts1 = 0x00;
7068 desc->opts2 = 0x00;
7069 desc->addr = 0x00;
7070 tx_skb->len = 0;
7071}
7072
Stanislaw Gruszka3eafe502010-10-20 22:25:36 +00007073static void rtl8169_tx_clear_range(struct rtl8169_private *tp, u32 start,
7074 unsigned int n)
Linus Torvalds1da177e2005-04-16 15:20:36 -07007075{
7076 unsigned int i;
7077
Stanislaw Gruszka3eafe502010-10-20 22:25:36 +00007078 for (i = 0; i < n; i++) {
7079 unsigned int entry = (start + i) % NUM_TX_DESC;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007080 struct ring_info *tx_skb = tp->tx_skb + entry;
7081 unsigned int len = tx_skb->len;
7082
7083 if (len) {
7084 struct sk_buff *skb = tx_skb->skb;
7085
Stanislaw Gruszka48addcc2010-10-20 22:25:39 +00007086 rtl8169_unmap_tx_skb(&tp->pci_dev->dev, tx_skb,
Linus Torvalds1da177e2005-04-16 15:20:36 -07007087 tp->TxDescArray + entry);
7088 if (skb) {
Florian Fainelli7a4b813c2017-08-24 18:34:44 -07007089 dev_consume_skb_any(skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007090 tx_skb->skb = NULL;
7091 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07007092 }
7093 }
Stanislaw Gruszka3eafe502010-10-20 22:25:36 +00007094}
7095
7096static void rtl8169_tx_clear(struct rtl8169_private *tp)
7097{
7098 rtl8169_tx_clear_range(tp, tp->dirty_tx, NUM_TX_DESC);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007099 tp->cur_tx = tp->dirty_tx = 0;
7100}
7101
Francois Romieu4422bcd2012-01-26 11:23:32 +01007102static void rtl_reset_work(struct rtl8169_private *tp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07007103{
David Howellsc4028952006-11-22 14:57:56 +00007104 struct net_device *dev = tp->dev;
Francois Romieu56de4142011-03-15 17:29:31 +01007105 int i;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007106
Francois Romieuda78dbf2012-01-26 14:18:23 +01007107 napi_disable(&tp->napi);
7108 netif_stop_queue(dev);
7109 synchronize_sched();
Linus Torvalds1da177e2005-04-16 15:20:36 -07007110
françois romieuc7c2c392011-12-04 20:30:52 +00007111 rtl8169_hw_reset(tp);
7112
Francois Romieu56de4142011-03-15 17:29:31 +01007113 for (i = 0; i < NUM_RX_DESC; i++)
7114 rtl8169_mark_to_asic(tp->RxDescArray + i, rx_buf_sz);
7115
Linus Torvalds1da177e2005-04-16 15:20:36 -07007116 rtl8169_tx_clear(tp);
françois romieuc7c2c392011-12-04 20:30:52 +00007117 rtl8169_init_ring_indexes(tp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007118
Francois Romieuda78dbf2012-01-26 14:18:23 +01007119 napi_enable(&tp->napi);
Francois Romieu56de4142011-03-15 17:29:31 +01007120 rtl_hw_start(dev);
7121 netif_wake_queue(dev);
7122 rtl8169_check_link_status(dev, tp, tp->mmio_addr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007123}
7124
7125static void rtl8169_tx_timeout(struct net_device *dev)
7126{
Francois Romieuda78dbf2012-01-26 14:18:23 +01007127 struct rtl8169_private *tp = netdev_priv(dev);
7128
7129 rtl_schedule_task(tp, RTL_FLAG_TASK_RESET_PENDING);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007130}
7131
7132static int rtl8169_xmit_frags(struct rtl8169_private *tp, struct sk_buff *skb,
Francois Romieu2b7b4312011-04-18 22:53:24 -07007133 u32 *opts)
Linus Torvalds1da177e2005-04-16 15:20:36 -07007134{
7135 struct skb_shared_info *info = skb_shinfo(skb);
7136 unsigned int cur_frag, entry;
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08007137 struct TxDesc *uninitialized_var(txd);
Stanislaw Gruszka48addcc2010-10-20 22:25:39 +00007138 struct device *d = &tp->pci_dev->dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007139
7140 entry = tp->cur_tx;
7141 for (cur_frag = 0; cur_frag < info->nr_frags; cur_frag++) {
Eric Dumazet9e903e02011-10-18 21:00:24 +00007142 const skb_frag_t *frag = info->frags + cur_frag;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007143 dma_addr_t mapping;
7144 u32 status, len;
7145 void *addr;
7146
7147 entry = (entry + 1) % NUM_TX_DESC;
7148
7149 txd = tp->TxDescArray + entry;
Eric Dumazet9e903e02011-10-18 21:00:24 +00007150 len = skb_frag_size(frag);
Ian Campbell929f6182011-08-31 00:47:06 +00007151 addr = skb_frag_address(frag);
Stanislaw Gruszka48addcc2010-10-20 22:25:39 +00007152 mapping = dma_map_single(d, addr, len, DMA_TO_DEVICE);
Stanislaw Gruszkad827d862010-10-20 22:25:43 +00007153 if (unlikely(dma_mapping_error(d, mapping))) {
7154 if (net_ratelimit())
7155 netif_err(tp, drv, tp->dev,
7156 "Failed to map TX fragments DMA!\n");
Stanislaw Gruszka3eafe502010-10-20 22:25:36 +00007157 goto err_out;
Stanislaw Gruszkad827d862010-10-20 22:25:43 +00007158 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07007159
Francois Romieucecb5fd2011-04-01 10:21:07 +02007160 /* Anti gcc 2.95.3 bugware (sic) */
Francois Romieu2b7b4312011-04-18 22:53:24 -07007161 status = opts[0] | len |
7162 (RingEnd * !((entry + 1) % NUM_TX_DESC));
Linus Torvalds1da177e2005-04-16 15:20:36 -07007163
7164 txd->opts1 = cpu_to_le32(status);
Francois Romieu2b7b4312011-04-18 22:53:24 -07007165 txd->opts2 = cpu_to_le32(opts[1]);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007166 txd->addr = cpu_to_le64(mapping);
7167
7168 tp->tx_skb[entry].len = len;
7169 }
7170
7171 if (cur_frag) {
7172 tp->tx_skb[entry].skb = skb;
7173 txd->opts1 |= cpu_to_le32(LastFrag);
7174 }
7175
7176 return cur_frag;
Stanislaw Gruszka3eafe502010-10-20 22:25:36 +00007177
7178err_out:
7179 rtl8169_tx_clear_range(tp, tp->cur_tx + 1, cur_frag);
7180 return -EIO;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007181}
7182
françois romieub423e9a2013-05-18 01:24:46 +00007183static bool rtl_test_hw_pad_bug(struct rtl8169_private *tp, struct sk_buff *skb)
7184{
7185 return skb->len < ETH_ZLEN && tp->mac_version == RTL_GIGA_MAC_VER_34;
7186}
7187
hayeswange9746042014-07-11 16:25:58 +08007188static netdev_tx_t rtl8169_start_xmit(struct sk_buff *skb,
7189 struct net_device *dev);
7190/* r8169_csum_workaround()
7191 * The hw limites the value the transport offset. When the offset is out of the
7192 * range, calculate the checksum by sw.
7193 */
7194static void r8169_csum_workaround(struct rtl8169_private *tp,
7195 struct sk_buff *skb)
7196{
7197 if (skb_shinfo(skb)->gso_size) {
7198 netdev_features_t features = tp->dev->features;
7199 struct sk_buff *segs, *nskb;
7200
7201 features &= ~(NETIF_F_SG | NETIF_F_IPV6_CSUM | NETIF_F_TSO6);
7202 segs = skb_gso_segment(skb, features);
7203 if (IS_ERR(segs) || !segs)
7204 goto drop;
7205
7206 do {
7207 nskb = segs;
7208 segs = segs->next;
7209 nskb->next = NULL;
7210 rtl8169_start_xmit(nskb, tp->dev);
7211 } while (segs);
7212
Alexander Duyckeb781392015-05-01 10:34:44 -07007213 dev_consume_skb_any(skb);
hayeswange9746042014-07-11 16:25:58 +08007214 } else if (skb->ip_summed == CHECKSUM_PARTIAL) {
7215 if (skb_checksum_help(skb) < 0)
7216 goto drop;
7217
7218 rtl8169_start_xmit(skb, tp->dev);
7219 } else {
7220 struct net_device_stats *stats;
7221
7222drop:
7223 stats = &tp->dev->stats;
7224 stats->tx_dropped++;
Alexander Duyckeb781392015-05-01 10:34:44 -07007225 dev_kfree_skb_any(skb);
hayeswange9746042014-07-11 16:25:58 +08007226 }
7227}
7228
7229/* msdn_giant_send_check()
7230 * According to the document of microsoft, the TCP Pseudo Header excludes the
7231 * packet length for IPv6 TCP large packets.
7232 */
7233static int msdn_giant_send_check(struct sk_buff *skb)
7234{
7235 const struct ipv6hdr *ipv6h;
7236 struct tcphdr *th;
7237 int ret;
7238
7239 ret = skb_cow_head(skb, 0);
7240 if (ret)
7241 return ret;
7242
7243 ipv6h = ipv6_hdr(skb);
7244 th = tcp_hdr(skb);
7245
7246 th->check = 0;
7247 th->check = ~tcp_v6_check(0, &ipv6h->saddr, &ipv6h->daddr, 0);
7248
7249 return ret;
7250}
7251
7252static inline __be16 get_protocol(struct sk_buff *skb)
7253{
7254 __be16 protocol;
7255
7256 if (skb->protocol == htons(ETH_P_8021Q))
7257 protocol = vlan_eth_hdr(skb)->h_vlan_encapsulated_proto;
7258 else
7259 protocol = skb->protocol;
7260
7261 return protocol;
7262}
7263
hayeswang5888d3f2014-07-11 16:25:56 +08007264static bool rtl8169_tso_csum_v1(struct rtl8169_private *tp,
7265 struct sk_buff *skb, u32 *opts)
Linus Torvalds1da177e2005-04-16 15:20:36 -07007266{
Michał Mirosław350fb322011-04-08 06:35:56 +00007267 u32 mss = skb_shinfo(skb)->gso_size;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007268
Francois Romieu2b7b4312011-04-18 22:53:24 -07007269 if (mss) {
7270 opts[0] |= TD_LSO;
hayeswang5888d3f2014-07-11 16:25:56 +08007271 opts[0] |= min(mss, TD_MSS_MAX) << TD0_MSS_SHIFT;
7272 } else if (skb->ip_summed == CHECKSUM_PARTIAL) {
7273 const struct iphdr *ip = ip_hdr(skb);
7274
7275 if (ip->protocol == IPPROTO_TCP)
7276 opts[0] |= TD0_IP_CS | TD0_TCP_CS;
7277 else if (ip->protocol == IPPROTO_UDP)
7278 opts[0] |= TD0_IP_CS | TD0_UDP_CS;
7279 else
7280 WARN_ON_ONCE(1);
7281 }
7282
7283 return true;
7284}
7285
7286static bool rtl8169_tso_csum_v2(struct rtl8169_private *tp,
7287 struct sk_buff *skb, u32 *opts)
7288{
hayeswangbdfa4ed2014-07-11 16:25:57 +08007289 u32 transport_offset = (u32)skb_transport_offset(skb);
hayeswang5888d3f2014-07-11 16:25:56 +08007290 u32 mss = skb_shinfo(skb)->gso_size;
7291
7292 if (mss) {
hayeswange9746042014-07-11 16:25:58 +08007293 if (transport_offset > GTTCPHO_MAX) {
7294 netif_warn(tp, tx_err, tp->dev,
7295 "Invalid transport offset 0x%x for TSO\n",
7296 transport_offset);
7297 return false;
7298 }
7299
7300 switch (get_protocol(skb)) {
7301 case htons(ETH_P_IP):
7302 opts[0] |= TD1_GTSENV4;
7303 break;
7304
7305 case htons(ETH_P_IPV6):
7306 if (msdn_giant_send_check(skb))
7307 return false;
7308
7309 opts[0] |= TD1_GTSENV6;
7310 break;
7311
7312 default:
7313 WARN_ON_ONCE(1);
7314 break;
7315 }
7316
hayeswangbdfa4ed2014-07-11 16:25:57 +08007317 opts[0] |= transport_offset << GTTCPHO_SHIFT;
hayeswang5888d3f2014-07-11 16:25:56 +08007318 opts[1] |= min(mss, TD_MSS_MAX) << TD1_MSS_SHIFT;
Francois Romieu2b7b4312011-04-18 22:53:24 -07007319 } else if (skb->ip_summed == CHECKSUM_PARTIAL) {
hayeswange9746042014-07-11 16:25:58 +08007320 u8 ip_protocol;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007321
françois romieub423e9a2013-05-18 01:24:46 +00007322 if (unlikely(rtl_test_hw_pad_bug(tp, skb)))
Alexander Duyck207c5f42014-12-03 08:18:04 -08007323 return !(skb_checksum_help(skb) || eth_skb_pad(skb));
françois romieub423e9a2013-05-18 01:24:46 +00007324
hayeswange9746042014-07-11 16:25:58 +08007325 if (transport_offset > TCPHO_MAX) {
7326 netif_warn(tp, tx_err, tp->dev,
7327 "Invalid transport offset 0x%x\n",
7328 transport_offset);
7329 return false;
7330 }
7331
7332 switch (get_protocol(skb)) {
7333 case htons(ETH_P_IP):
7334 opts[1] |= TD1_IPv4_CS;
7335 ip_protocol = ip_hdr(skb)->protocol;
7336 break;
7337
7338 case htons(ETH_P_IPV6):
7339 opts[1] |= TD1_IPv6_CS;
7340 ip_protocol = ipv6_hdr(skb)->nexthdr;
7341 break;
7342
7343 default:
7344 ip_protocol = IPPROTO_RAW;
7345 break;
7346 }
7347
7348 if (ip_protocol == IPPROTO_TCP)
7349 opts[1] |= TD1_TCP_CS;
7350 else if (ip_protocol == IPPROTO_UDP)
7351 opts[1] |= TD1_UDP_CS;
Francois Romieu2b7b4312011-04-18 22:53:24 -07007352 else
7353 WARN_ON_ONCE(1);
hayeswange9746042014-07-11 16:25:58 +08007354
7355 opts[1] |= transport_offset << TCPHO_SHIFT;
françois romieub423e9a2013-05-18 01:24:46 +00007356 } else {
7357 if (unlikely(rtl_test_hw_pad_bug(tp, skb)))
Alexander Duyck207c5f42014-12-03 08:18:04 -08007358 return !eth_skb_pad(skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007359 }
hayeswang5888d3f2014-07-11 16:25:56 +08007360
françois romieub423e9a2013-05-18 01:24:46 +00007361 return true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007362}
7363
Stephen Hemminger613573252009-08-31 19:50:58 +00007364static netdev_tx_t rtl8169_start_xmit(struct sk_buff *skb,
7365 struct net_device *dev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07007366{
7367 struct rtl8169_private *tp = netdev_priv(dev);
Stanislaw Gruszka3eafe502010-10-20 22:25:36 +00007368 unsigned int entry = tp->cur_tx % NUM_TX_DESC;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007369 struct TxDesc *txd = tp->TxDescArray + entry;
7370 void __iomem *ioaddr = tp->mmio_addr;
Stanislaw Gruszka48addcc2010-10-20 22:25:39 +00007371 struct device *d = &tp->pci_dev->dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007372 dma_addr_t mapping;
7373 u32 status, len;
Francois Romieu2b7b4312011-04-18 22:53:24 -07007374 u32 opts[2];
Stanislaw Gruszka3eafe502010-10-20 22:25:36 +00007375 int frags;
Francois Romieu5b0384f2006-08-16 16:00:01 +02007376
Julien Ducourthial477206a2012-05-09 00:00:06 +02007377 if (unlikely(!TX_FRAGS_READY_FOR(tp, skb_shinfo(skb)->nr_frags))) {
Joe Perchesbf82c182010-02-09 11:49:50 +00007378 netif_err(tp, drv, dev, "BUG! Tx Ring full when queue awake!\n");
Stanislaw Gruszka3eafe502010-10-20 22:25:36 +00007379 goto err_stop_0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007380 }
7381
7382 if (unlikely(le32_to_cpu(txd->opts1) & DescOwn))
Stanislaw Gruszka3eafe502010-10-20 22:25:36 +00007383 goto err_stop_0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007384
françois romieub423e9a2013-05-18 01:24:46 +00007385 opts[1] = cpu_to_le32(rtl8169_tx_vlan_tag(skb));
7386 opts[0] = DescOwn;
7387
hayeswange9746042014-07-11 16:25:58 +08007388 if (!tp->tso_csum(tp, skb, opts)) {
7389 r8169_csum_workaround(tp, skb);
7390 return NETDEV_TX_OK;
7391 }
françois romieub423e9a2013-05-18 01:24:46 +00007392
Stanislaw Gruszka3eafe502010-10-20 22:25:36 +00007393 len = skb_headlen(skb);
Stanislaw Gruszka48addcc2010-10-20 22:25:39 +00007394 mapping = dma_map_single(d, skb->data, len, DMA_TO_DEVICE);
Stanislaw Gruszkad827d862010-10-20 22:25:43 +00007395 if (unlikely(dma_mapping_error(d, mapping))) {
7396 if (net_ratelimit())
7397 netif_err(tp, drv, dev, "Failed to map TX DMA!\n");
Stanislaw Gruszka3eafe502010-10-20 22:25:36 +00007398 goto err_dma_0;
Stanislaw Gruszkad827d862010-10-20 22:25:43 +00007399 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07007400
7401 tp->tx_skb[entry].len = len;
7402 txd->addr = cpu_to_le64(mapping);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007403
Francois Romieu2b7b4312011-04-18 22:53:24 -07007404 frags = rtl8169_xmit_frags(tp, skb, opts);
Stanislaw Gruszka3eafe502010-10-20 22:25:36 +00007405 if (frags < 0)
7406 goto err_dma_1;
7407 else if (frags)
Francois Romieu2b7b4312011-04-18 22:53:24 -07007408 opts[0] |= FirstFrag;
Stanislaw Gruszka3eafe502010-10-20 22:25:36 +00007409 else {
Francois Romieu2b7b4312011-04-18 22:53:24 -07007410 opts[0] |= FirstFrag | LastFrag;
Stanislaw Gruszka3eafe502010-10-20 22:25:36 +00007411 tp->tx_skb[entry].skb = skb;
7412 }
7413
Francois Romieu2b7b4312011-04-18 22:53:24 -07007414 txd->opts2 = cpu_to_le32(opts[1]);
7415
Richard Cochran5047fb52012-03-10 07:29:42 +00007416 skb_tx_timestamp(skb);
7417
Alexander Duycka0750132014-12-11 15:02:17 -08007418 /* Force memory writes to complete before releasing descriptor */
7419 dma_wmb();
Linus Torvalds1da177e2005-04-16 15:20:36 -07007420
Francois Romieucecb5fd2011-04-01 10:21:07 +02007421 /* Anti gcc 2.95.3 bugware (sic) */
Francois Romieu2b7b4312011-04-18 22:53:24 -07007422 status = opts[0] | len | (RingEnd * !((entry + 1) % NUM_TX_DESC));
Linus Torvalds1da177e2005-04-16 15:20:36 -07007423 txd->opts1 = cpu_to_le32(status);
7424
Alexander Duycka0750132014-12-11 15:02:17 -08007425 /* Force all memory writes to complete before notifying device */
David Dillow4c020a92010-03-03 16:33:10 +00007426 wmb();
Linus Torvalds1da177e2005-04-16 15:20:36 -07007427
Alexander Duycka0750132014-12-11 15:02:17 -08007428 tp->cur_tx += frags + 1;
7429
David S. Miller87cda7c2015-02-22 15:54:29 -05007430 RTL_W8(TxPoll, NPQ);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007431
David S. Miller87cda7c2015-02-22 15:54:29 -05007432 mmiowb();
Francois Romieuda78dbf2012-01-26 14:18:23 +01007433
David S. Miller87cda7c2015-02-22 15:54:29 -05007434 if (!TX_FRAGS_READY_FOR(tp, MAX_SKB_FRAGS)) {
Francois Romieuae1f23f2012-01-31 00:00:19 +01007435 /* Avoid wrongly optimistic queue wake-up: rtl_tx thread must
7436 * not miss a ring update when it notices a stopped queue.
7437 */
7438 smp_wmb();
Linus Torvalds1da177e2005-04-16 15:20:36 -07007439 netif_stop_queue(dev);
Francois Romieuae1f23f2012-01-31 00:00:19 +01007440 /* Sync with rtl_tx:
7441 * - publish queue status and cur_tx ring index (write barrier)
7442 * - refresh dirty_tx ring index (read barrier).
7443 * May the current thread have a pessimistic view of the ring
7444 * status and forget to wake up queue, a racing rtl_tx thread
7445 * can't.
7446 */
Francois Romieu1e874e02012-01-27 15:05:38 +01007447 smp_mb();
Julien Ducourthial477206a2012-05-09 00:00:06 +02007448 if (TX_FRAGS_READY_FOR(tp, MAX_SKB_FRAGS))
Linus Torvalds1da177e2005-04-16 15:20:36 -07007449 netif_wake_queue(dev);
7450 }
7451
Stephen Hemminger613573252009-08-31 19:50:58 +00007452 return NETDEV_TX_OK;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007453
Stanislaw Gruszka3eafe502010-10-20 22:25:36 +00007454err_dma_1:
Stanislaw Gruszka48addcc2010-10-20 22:25:39 +00007455 rtl8169_unmap_tx_skb(d, tp->tx_skb + entry, txd);
Stanislaw Gruszka3eafe502010-10-20 22:25:36 +00007456err_dma_0:
Eric W. Biederman989c9ba2014-03-11 14:16:14 -07007457 dev_kfree_skb_any(skb);
Stanislaw Gruszka3eafe502010-10-20 22:25:36 +00007458 dev->stats.tx_dropped++;
7459 return NETDEV_TX_OK;
7460
7461err_stop_0:
Linus Torvalds1da177e2005-04-16 15:20:36 -07007462 netif_stop_queue(dev);
Francois Romieucebf8cc2007-10-18 12:06:54 +02007463 dev->stats.tx_dropped++;
Stephen Hemminger613573252009-08-31 19:50:58 +00007464 return NETDEV_TX_BUSY;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007465}
7466
7467static void rtl8169_pcierr_interrupt(struct net_device *dev)
7468{
7469 struct rtl8169_private *tp = netdev_priv(dev);
7470 struct pci_dev *pdev = tp->pci_dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007471 u16 pci_status, pci_cmd;
7472
7473 pci_read_config_word(pdev, PCI_COMMAND, &pci_cmd);
7474 pci_read_config_word(pdev, PCI_STATUS, &pci_status);
7475
Joe Perchesbf82c182010-02-09 11:49:50 +00007476 netif_err(tp, intr, dev, "PCI error (cmd = 0x%04x, status = 0x%04x)\n",
7477 pci_cmd, pci_status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007478
7479 /*
7480 * The recovery sequence below admits a very elaborated explanation:
7481 * - it seems to work;
Francois Romieud03902b2006-11-23 00:00:42 +01007482 * - I did not see what else could be done;
7483 * - it makes iop3xx happy.
Linus Torvalds1da177e2005-04-16 15:20:36 -07007484 *
7485 * Feel free to adjust to your needs.
7486 */
Francois Romieua27993f2006-12-18 00:04:19 +01007487 if (pdev->broken_parity_status)
Francois Romieud03902b2006-11-23 00:00:42 +01007488 pci_cmd &= ~PCI_COMMAND_PARITY;
7489 else
7490 pci_cmd |= PCI_COMMAND_SERR | PCI_COMMAND_PARITY;
7491
7492 pci_write_config_word(pdev, PCI_COMMAND, pci_cmd);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007493
7494 pci_write_config_word(pdev, PCI_STATUS,
7495 pci_status & (PCI_STATUS_DETECTED_PARITY |
7496 PCI_STATUS_SIG_SYSTEM_ERROR | PCI_STATUS_REC_MASTER_ABORT |
7497 PCI_STATUS_REC_TARGET_ABORT | PCI_STATUS_SIG_TARGET_ABORT));
7498
7499 /* The infamous DAC f*ckup only happens at boot time */
Timo Teräs9fba0812013-01-15 21:01:24 +00007500 if ((tp->cp_cmd & PCIDAC) && !tp->cur_rx) {
françois romieue6de30d2011-01-03 15:08:37 +00007501 void __iomem *ioaddr = tp->mmio_addr;
7502
Joe Perchesbf82c182010-02-09 11:49:50 +00007503 netif_info(tp, intr, dev, "disabling PCI DAC\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -07007504 tp->cp_cmd &= ~PCIDAC;
7505 RTL_W16(CPlusCmd, tp->cp_cmd);
7506 dev->features &= ~NETIF_F_HIGHDMA;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007507 }
7508
françois romieue6de30d2011-01-03 15:08:37 +00007509 rtl8169_hw_reset(tp);
Francois Romieud03902b2006-11-23 00:00:42 +01007510
Francois Romieu98ddf982012-01-31 10:47:34 +01007511 rtl_schedule_task(tp, RTL_FLAG_TASK_RESET_PENDING);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007512}
7513
Francois Romieuda78dbf2012-01-26 14:18:23 +01007514static void rtl_tx(struct net_device *dev, struct rtl8169_private *tp)
Linus Torvalds1da177e2005-04-16 15:20:36 -07007515{
7516 unsigned int dirty_tx, tx_left;
7517
Linus Torvalds1da177e2005-04-16 15:20:36 -07007518 dirty_tx = tp->dirty_tx;
7519 smp_rmb();
7520 tx_left = tp->cur_tx - dirty_tx;
7521
7522 while (tx_left > 0) {
7523 unsigned int entry = dirty_tx % NUM_TX_DESC;
7524 struct ring_info *tx_skb = tp->tx_skb + entry;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007525 u32 status;
7526
Linus Torvalds1da177e2005-04-16 15:20:36 -07007527 status = le32_to_cpu(tp->TxDescArray[entry].opts1);
7528 if (status & DescOwn)
7529 break;
7530
Alexander Duycka0750132014-12-11 15:02:17 -08007531 /* This barrier is needed to keep us from reading
7532 * any other fields out of the Tx descriptor until
7533 * we know the status of DescOwn
7534 */
7535 dma_rmb();
7536
Stanislaw Gruszka48addcc2010-10-20 22:25:39 +00007537 rtl8169_unmap_tx_skb(&tp->pci_dev->dev, tx_skb,
7538 tp->TxDescArray + entry);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007539 if (status & LastFrag) {
David S. Miller87cda7c2015-02-22 15:54:29 -05007540 u64_stats_update_begin(&tp->tx_stats.syncp);
7541 tp->tx_stats.packets++;
7542 tp->tx_stats.bytes += tx_skb->skb->len;
7543 u64_stats_update_end(&tp->tx_stats.syncp);
Florian Fainelli7a4b813c2017-08-24 18:34:44 -07007544 dev_consume_skb_any(tx_skb->skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007545 tx_skb->skb = NULL;
7546 }
7547 dirty_tx++;
7548 tx_left--;
7549 }
7550
7551 if (tp->dirty_tx != dirty_tx) {
7552 tp->dirty_tx = dirty_tx;
Francois Romieuae1f23f2012-01-31 00:00:19 +01007553 /* Sync with rtl8169_start_xmit:
7554 * - publish dirty_tx ring index (write barrier)
7555 * - refresh cur_tx ring index and queue status (read barrier)
7556 * May the current thread miss the stopped queue condition,
7557 * a racing xmit thread can only have a right view of the
7558 * ring status.
7559 */
Francois Romieu1e874e02012-01-27 15:05:38 +01007560 smp_mb();
Linus Torvalds1da177e2005-04-16 15:20:36 -07007561 if (netif_queue_stopped(dev) &&
Julien Ducourthial477206a2012-05-09 00:00:06 +02007562 TX_FRAGS_READY_FOR(tp, MAX_SKB_FRAGS)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07007563 netif_wake_queue(dev);
7564 }
Francois Romieud78ae2d2007-08-26 20:08:19 +02007565 /*
7566 * 8168 hack: TxPoll requests are lost when the Tx packets are
7567 * too close. Let's kick an extra TxPoll request when a burst
7568 * of start_xmit activity is detected (if it is not detected,
7569 * it is slow enough). -- FR
7570 */
Francois Romieuda78dbf2012-01-26 14:18:23 +01007571 if (tp->cur_tx != dirty_tx) {
7572 void __iomem *ioaddr = tp->mmio_addr;
7573
Francois Romieud78ae2d2007-08-26 20:08:19 +02007574 RTL_W8(TxPoll, NPQ);
Francois Romieuda78dbf2012-01-26 14:18:23 +01007575 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07007576 }
7577}
7578
Francois Romieu126fa4b2005-05-12 20:09:17 -04007579static inline int rtl8169_fragmented_frame(u32 status)
7580{
7581 return (status & (FirstFrag | LastFrag)) != (FirstFrag | LastFrag);
7582}
7583
Eric Dumazetadea1ac72010-09-05 20:04:05 -07007584static inline void rtl8169_rx_csum(struct sk_buff *skb, u32 opts1)
Linus Torvalds1da177e2005-04-16 15:20:36 -07007585{
Linus Torvalds1da177e2005-04-16 15:20:36 -07007586 u32 status = opts1 & RxProtoMask;
7587
7588 if (((status == RxProtoTCP) && !(opts1 & TCPFail)) ||
Shan Weid5d3ebe2010-11-12 00:15:25 +00007589 ((status == RxProtoUDP) && !(opts1 & UDPFail)))
Linus Torvalds1da177e2005-04-16 15:20:36 -07007590 skb->ip_summed = CHECKSUM_UNNECESSARY;
7591 else
Eric Dumazetbc8acf22010-09-02 13:07:41 -07007592 skb_checksum_none_assert(skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007593}
7594
Eric Dumazet6f0333b2010-10-11 11:17:47 +00007595static struct sk_buff *rtl8169_try_rx_copy(void *data,
7596 struct rtl8169_private *tp,
7597 int pkt_size,
7598 dma_addr_t addr)
Linus Torvalds1da177e2005-04-16 15:20:36 -07007599{
Stephen Hemmingerb4496552007-06-17 01:06:49 +02007600 struct sk_buff *skb;
Stanislaw Gruszka48addcc2010-10-20 22:25:39 +00007601 struct device *d = &tp->pci_dev->dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007602
Eric Dumazet6f0333b2010-10-11 11:17:47 +00007603 data = rtl8169_align(data);
Stanislaw Gruszka48addcc2010-10-20 22:25:39 +00007604 dma_sync_single_for_cpu(d, addr, pkt_size, DMA_FROM_DEVICE);
Eric Dumazet6f0333b2010-10-11 11:17:47 +00007605 prefetch(data);
Alexander Duycke2338f82014-12-09 19:41:09 -08007606 skb = napi_alloc_skb(&tp->napi, pkt_size);
Eric Dumazet6f0333b2010-10-11 11:17:47 +00007607 if (skb)
7608 memcpy(skb->data, data, pkt_size);
Stanislaw Gruszka48addcc2010-10-20 22:25:39 +00007609 dma_sync_single_for_device(d, addr, pkt_size, DMA_FROM_DEVICE);
7610
Eric Dumazet6f0333b2010-10-11 11:17:47 +00007611 return skb;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007612}
7613
Francois Romieuda78dbf2012-01-26 14:18:23 +01007614static int rtl_rx(struct net_device *dev, struct rtl8169_private *tp, u32 budget)
Linus Torvalds1da177e2005-04-16 15:20:36 -07007615{
7616 unsigned int cur_rx, rx_left;
Eric Dumazet6f0333b2010-10-11 11:17:47 +00007617 unsigned int count;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007618
Linus Torvalds1da177e2005-04-16 15:20:36 -07007619 cur_rx = tp->cur_rx;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007620
Timo Teräs9fba0812013-01-15 21:01:24 +00007621 for (rx_left = min(budget, NUM_RX_DESC); rx_left > 0; rx_left--, cur_rx++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07007622 unsigned int entry = cur_rx % NUM_RX_DESC;
Francois Romieu126fa4b2005-05-12 20:09:17 -04007623 struct RxDesc *desc = tp->RxDescArray + entry;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007624 u32 status;
7625
David S. Miller8decf862011-09-22 03:23:13 -04007626 status = le32_to_cpu(desc->opts1) & tp->opts1_mask;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007627 if (status & DescOwn)
7628 break;
Alexander Duycka0750132014-12-11 15:02:17 -08007629
7630 /* This barrier is needed to keep us from reading
7631 * any other fields out of the Rx descriptor until
7632 * we know the status of DescOwn
7633 */
7634 dma_rmb();
7635
Richard Dawe4dcb7d32005-05-27 21:12:00 +02007636 if (unlikely(status & RxRES)) {
Joe Perchesbf82c182010-02-09 11:49:50 +00007637 netif_info(tp, rx_err, dev, "Rx ERROR. status = %08x\n",
7638 status);
Francois Romieucebf8cc2007-10-18 12:06:54 +02007639 dev->stats.rx_errors++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007640 if (status & (RxRWT | RxRUNT))
Francois Romieucebf8cc2007-10-18 12:06:54 +02007641 dev->stats.rx_length_errors++;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007642 if (status & RxCRC)
Francois Romieucebf8cc2007-10-18 12:06:54 +02007643 dev->stats.rx_crc_errors++;
Francois Romieu9dccf612006-05-14 12:31:17 +02007644 if (status & RxFOVF) {
Francois Romieuda78dbf2012-01-26 14:18:23 +01007645 rtl_schedule_task(tp, RTL_FLAG_TASK_RESET_PENDING);
Francois Romieucebf8cc2007-10-18 12:06:54 +02007646 dev->stats.rx_fifo_errors++;
Francois Romieu9dccf612006-05-14 12:31:17 +02007647 }
Ben Greear6bbe0212012-02-10 15:04:33 +00007648 if ((status & (RxRUNT | RxCRC)) &&
7649 !(status & (RxRWT | RxFOVF)) &&
7650 (dev->features & NETIF_F_RXALL))
7651 goto process_pkt;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007652 } else {
Eric Dumazet6f0333b2010-10-11 11:17:47 +00007653 struct sk_buff *skb;
Ben Greear6bbe0212012-02-10 15:04:33 +00007654 dma_addr_t addr;
7655 int pkt_size;
7656
7657process_pkt:
7658 addr = le64_to_cpu(desc->addr);
Ben Greear79d0c1d2012-02-10 15:04:34 +00007659 if (likely(!(dev->features & NETIF_F_RXFCS)))
7660 pkt_size = (status & 0x00003fff) - 4;
7661 else
7662 pkt_size = status & 0x00003fff;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007663
Francois Romieu126fa4b2005-05-12 20:09:17 -04007664 /*
7665 * The driver does not support incoming fragmented
7666 * frames. They are seen as a symptom of over-mtu
7667 * sized frames.
7668 */
7669 if (unlikely(rtl8169_fragmented_frame(status))) {
Francois Romieucebf8cc2007-10-18 12:06:54 +02007670 dev->stats.rx_dropped++;
7671 dev->stats.rx_length_errors++;
françois romieuce11ff52013-01-24 13:30:06 +00007672 goto release_descriptor;
Francois Romieu126fa4b2005-05-12 20:09:17 -04007673 }
7674
Eric Dumazet6f0333b2010-10-11 11:17:47 +00007675 skb = rtl8169_try_rx_copy(tp->Rx_databuff[entry],
7676 tp, pkt_size, addr);
Eric Dumazet6f0333b2010-10-11 11:17:47 +00007677 if (!skb) {
7678 dev->stats.rx_dropped++;
françois romieuce11ff52013-01-24 13:30:06 +00007679 goto release_descriptor;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007680 }
7681
Eric Dumazetadea1ac72010-09-05 20:04:05 -07007682 rtl8169_rx_csum(skb, status);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007683 skb_put(skb, pkt_size);
7684 skb->protocol = eth_type_trans(skb, dev);
7685
Francois Romieu7a8fc772011-03-01 17:18:33 +01007686 rtl8169_rx_vlan_tag(desc, skb);
7687
françois romieu39174292015-11-11 23:35:18 +01007688 if (skb->pkt_type == PACKET_MULTICAST)
7689 dev->stats.multicast++;
7690
Francois Romieu56de4142011-03-15 17:29:31 +01007691 napi_gro_receive(&tp->napi, skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007692
Junchang Wang8027aa22012-03-04 23:30:32 +01007693 u64_stats_update_begin(&tp->rx_stats.syncp);
7694 tp->rx_stats.packets++;
7695 tp->rx_stats.bytes += pkt_size;
7696 u64_stats_update_end(&tp->rx_stats.syncp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007697 }
françois romieuce11ff52013-01-24 13:30:06 +00007698release_descriptor:
7699 desc->opts2 = 0;
françois romieuce11ff52013-01-24 13:30:06 +00007700 rtl8169_mark_to_asic(desc, rx_buf_sz);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007701 }
7702
7703 count = cur_rx - tp->cur_rx;
7704 tp->cur_rx = cur_rx;
7705
Linus Torvalds1da177e2005-04-16 15:20:36 -07007706 return count;
7707}
7708
Francois Romieu07d3f512007-02-21 22:40:46 +01007709static irqreturn_t rtl8169_interrupt(int irq, void *dev_instance)
Linus Torvalds1da177e2005-04-16 15:20:36 -07007710{
Francois Romieu07d3f512007-02-21 22:40:46 +01007711 struct net_device *dev = dev_instance;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007712 struct rtl8169_private *tp = netdev_priv(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007713 int handled = 0;
Francois Romieu9085cdfa2012-01-26 12:59:08 +01007714 u16 status;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007715
Francois Romieu9085cdfa2012-01-26 12:59:08 +01007716 status = rtl_get_events(tp);
Francois Romieuda78dbf2012-01-26 14:18:23 +01007717 if (status && status != 0xffff) {
7718 status &= RTL_EVENT_NAPI | tp->event_slow;
7719 if (status) {
7720 handled = 1;
françois romieu811fd302011-12-04 20:30:45 +00007721
Francois Romieuda78dbf2012-01-26 14:18:23 +01007722 rtl_irq_disable(tp);
7723 napi_schedule(&tp->napi);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007724 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07007725 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07007726 return IRQ_RETVAL(handled);
7727}
7728
Francois Romieuda78dbf2012-01-26 14:18:23 +01007729/*
7730 * Workqueue context.
7731 */
7732static void rtl_slow_event_work(struct rtl8169_private *tp)
7733{
7734 struct net_device *dev = tp->dev;
7735 u16 status;
7736
7737 status = rtl_get_events(tp) & tp->event_slow;
7738 rtl_ack_events(tp, status);
7739
7740 if (unlikely(status & RxFIFOOver)) {
7741 switch (tp->mac_version) {
7742 /* Work around for rx fifo overflow */
7743 case RTL_GIGA_MAC_VER_11:
7744 netif_stop_queue(dev);
Francois Romieu934714d2012-01-31 11:09:21 +01007745 /* XXX - Hack alert. See rtl_task(). */
7746 set_bit(RTL_FLAG_TASK_RESET_PENDING, tp->wk.flags);
Francois Romieuda78dbf2012-01-26 14:18:23 +01007747 default:
7748 break;
7749 }
7750 }
7751
7752 if (unlikely(status & SYSErr))
7753 rtl8169_pcierr_interrupt(dev);
7754
7755 if (status & LinkChg)
7756 __rtl8169_check_link_status(dev, tp, tp->mmio_addr, true);
7757
françois romieu7dbb4912012-06-09 10:53:16 +00007758 rtl_irq_enable_all(tp);
Francois Romieuda78dbf2012-01-26 14:18:23 +01007759}
7760
Francois Romieu4422bcd2012-01-26 11:23:32 +01007761static void rtl_task(struct work_struct *work)
7762{
Francois Romieuda78dbf2012-01-26 14:18:23 +01007763 static const struct {
7764 int bitnr;
7765 void (*action)(struct rtl8169_private *);
7766 } rtl_work[] = {
Francois Romieu934714d2012-01-31 11:09:21 +01007767 /* XXX - keep rtl_slow_event_work() as first element. */
Francois Romieuda78dbf2012-01-26 14:18:23 +01007768 { RTL_FLAG_TASK_SLOW_PENDING, rtl_slow_event_work },
7769 { RTL_FLAG_TASK_RESET_PENDING, rtl_reset_work },
7770 { RTL_FLAG_TASK_PHY_PENDING, rtl_phy_work }
7771 };
Francois Romieu4422bcd2012-01-26 11:23:32 +01007772 struct rtl8169_private *tp =
7773 container_of(work, struct rtl8169_private, wk.work);
Francois Romieuda78dbf2012-01-26 14:18:23 +01007774 struct net_device *dev = tp->dev;
7775 int i;
Francois Romieu4422bcd2012-01-26 11:23:32 +01007776
Francois Romieuda78dbf2012-01-26 14:18:23 +01007777 rtl_lock_work(tp);
7778
Francois Romieu6c4a70c2012-01-31 10:56:44 +01007779 if (!netif_running(dev) ||
7780 !test_bit(RTL_FLAG_TASK_ENABLED, tp->wk.flags))
Francois Romieuda78dbf2012-01-26 14:18:23 +01007781 goto out_unlock;
7782
7783 for (i = 0; i < ARRAY_SIZE(rtl_work); i++) {
7784 bool pending;
7785
Francois Romieuda78dbf2012-01-26 14:18:23 +01007786 pending = test_and_clear_bit(rtl_work[i].bitnr, tp->wk.flags);
Francois Romieuda78dbf2012-01-26 14:18:23 +01007787 if (pending)
7788 rtl_work[i].action(tp);
7789 }
7790
7791out_unlock:
7792 rtl_unlock_work(tp);
Francois Romieu4422bcd2012-01-26 11:23:32 +01007793}
7794
Stephen Hemmingerbea33482007-10-03 16:41:36 -07007795static int rtl8169_poll(struct napi_struct *napi, int budget)
Linus Torvalds1da177e2005-04-16 15:20:36 -07007796{
Stephen Hemmingerbea33482007-10-03 16:41:36 -07007797 struct rtl8169_private *tp = container_of(napi, struct rtl8169_private, napi);
7798 struct net_device *dev = tp->dev;
Francois Romieuda78dbf2012-01-26 14:18:23 +01007799 u16 enable_mask = RTL_EVENT_NAPI | tp->event_slow;
7800 int work_done= 0;
7801 u16 status;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007802
Francois Romieuda78dbf2012-01-26 14:18:23 +01007803 status = rtl_get_events(tp);
7804 rtl_ack_events(tp, status & ~tp->event_slow);
7805
7806 if (status & RTL_EVENT_NAPI_RX)
7807 work_done = rtl_rx(dev, tp, (u32) budget);
7808
7809 if (status & RTL_EVENT_NAPI_TX)
7810 rtl_tx(dev, tp);
7811
7812 if (status & tp->event_slow) {
7813 enable_mask &= ~tp->event_slow;
7814
7815 rtl_schedule_task(tp, RTL_FLAG_TASK_SLOW_PENDING);
7816 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07007817
Stephen Hemmingerbea33482007-10-03 16:41:36 -07007818 if (work_done < budget) {
Eric Dumazet6ad20162017-01-30 08:22:01 -08007819 napi_complete_done(napi, work_done);
David Dillowf11a3772009-05-22 15:29:34 +00007820
Francois Romieuda78dbf2012-01-26 14:18:23 +01007821 rtl_irq_enable(tp, enable_mask);
7822 mmiowb();
Linus Torvalds1da177e2005-04-16 15:20:36 -07007823 }
7824
Stephen Hemmingerbea33482007-10-03 16:41:36 -07007825 return work_done;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007826}
Linus Torvalds1da177e2005-04-16 15:20:36 -07007827
Francois Romieu523a6092008-09-10 22:28:56 +02007828static void rtl8169_rx_missed(struct net_device *dev, void __iomem *ioaddr)
7829{
7830 struct rtl8169_private *tp = netdev_priv(dev);
7831
7832 if (tp->mac_version > RTL_GIGA_MAC_VER_06)
7833 return;
7834
7835 dev->stats.rx_missed_errors += (RTL_R32(RxMissed) & 0xffffff);
7836 RTL_W32(RxMissed, 0);
7837}
7838
Linus Torvalds1da177e2005-04-16 15:20:36 -07007839static void rtl8169_down(struct net_device *dev)
7840{
7841 struct rtl8169_private *tp = netdev_priv(dev);
7842 void __iomem *ioaddr = tp->mmio_addr;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007843
Francois Romieu4876cc12011-03-11 21:07:11 +01007844 del_timer_sync(&tp->timer);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007845
Stephen Hemminger93dd79e2007-10-28 17:14:06 +01007846 napi_disable(&tp->napi);
Francois Romieuda78dbf2012-01-26 14:18:23 +01007847 netif_stop_queue(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007848
Hayes Wang92fc43b2011-07-06 15:58:03 +08007849 rtl8169_hw_reset(tp);
Stanislaw Gruszka323bb682010-10-20 22:25:41 +00007850 /*
7851 * At this point device interrupts can not be enabled in any function,
Francois Romieu209e5ac2012-01-26 09:59:50 +01007852 * as netif_running is not true (rtl8169_interrupt, rtl8169_reset_task)
7853 * and napi is disabled (rtl8169_poll).
Stanislaw Gruszka323bb682010-10-20 22:25:41 +00007854 */
Francois Romieu523a6092008-09-10 22:28:56 +02007855 rtl8169_rx_missed(dev, ioaddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007856
Linus Torvalds1da177e2005-04-16 15:20:36 -07007857 /* Give a racing hard_start_xmit a few cycles to complete. */
Francois Romieuda78dbf2012-01-26 14:18:23 +01007858 synchronize_sched();
Linus Torvalds1da177e2005-04-16 15:20:36 -07007859
Linus Torvalds1da177e2005-04-16 15:20:36 -07007860 rtl8169_tx_clear(tp);
7861
7862 rtl8169_rx_clear(tp);
françois romieu065c27c2011-01-03 15:08:12 +00007863
7864 rtl_pll_power_down(tp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007865}
7866
7867static int rtl8169_close(struct net_device *dev)
7868{
7869 struct rtl8169_private *tp = netdev_priv(dev);
7870 struct pci_dev *pdev = tp->pci_dev;
7871
Rafael J. Wysockie1759442010-03-14 14:33:51 +00007872 pm_runtime_get_sync(&pdev->dev);
7873
Francois Romieucecb5fd2011-04-01 10:21:07 +02007874 /* Update counters before going down */
Ivan Vecera355423d2009-02-06 21:49:57 -08007875 rtl8169_update_counters(dev);
7876
Francois Romieuda78dbf2012-01-26 14:18:23 +01007877 rtl_lock_work(tp);
Francois Romieu6c4a70c2012-01-31 10:56:44 +01007878 clear_bit(RTL_FLAG_TASK_ENABLED, tp->wk.flags);
Francois Romieuda78dbf2012-01-26 14:18:23 +01007879
Linus Torvalds1da177e2005-04-16 15:20:36 -07007880 rtl8169_down(dev);
Francois Romieuda78dbf2012-01-26 14:18:23 +01007881 rtl_unlock_work(tp);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007882
Lekensteyn4ea72442013-07-22 09:53:30 +02007883 cancel_work_sync(&tp->wk.work);
7884
Francois Romieu92a7c4e2012-03-10 10:42:12 +01007885 free_irq(pdev->irq, dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007886
Stanislaw Gruszka82553bb2010-10-08 04:25:01 +00007887 dma_free_coherent(&pdev->dev, R8169_RX_RING_BYTES, tp->RxDescArray,
7888 tp->RxPhyAddr);
7889 dma_free_coherent(&pdev->dev, R8169_TX_RING_BYTES, tp->TxDescArray,
7890 tp->TxPhyAddr);
Linus Torvalds1da177e2005-04-16 15:20:36 -07007891 tp->TxDescArray = NULL;
7892 tp->RxDescArray = NULL;
7893
Rafael J. Wysockie1759442010-03-14 14:33:51 +00007894 pm_runtime_put_sync(&pdev->dev);
7895
Linus Torvalds1da177e2005-04-16 15:20:36 -07007896 return 0;
7897}
7898
Francois Romieudc1c00c2012-03-08 10:06:18 +01007899#ifdef CONFIG_NET_POLL_CONTROLLER
7900static void rtl8169_netpoll(struct net_device *dev)
7901{
7902 struct rtl8169_private *tp = netdev_priv(dev);
7903
7904 rtl8169_interrupt(tp->pci_dev->irq, dev);
7905}
7906#endif
7907
Francois Romieudf43ac72012-03-08 09:48:40 +01007908static int rtl_open(struct net_device *dev)
7909{
7910 struct rtl8169_private *tp = netdev_priv(dev);
7911 void __iomem *ioaddr = tp->mmio_addr;
7912 struct pci_dev *pdev = tp->pci_dev;
7913 int retval = -ENOMEM;
7914
7915 pm_runtime_get_sync(&pdev->dev);
7916
7917 /*
Jiri Kosinae75d6602012-04-08 21:48:52 +02007918 * Rx and Tx descriptors needs 256 bytes alignment.
Francois Romieudf43ac72012-03-08 09:48:40 +01007919 * dma_alloc_coherent provides more.
7920 */
7921 tp->TxDescArray = dma_alloc_coherent(&pdev->dev, R8169_TX_RING_BYTES,
7922 &tp->TxPhyAddr, GFP_KERNEL);
7923 if (!tp->TxDescArray)
7924 goto err_pm_runtime_put;
7925
7926 tp->RxDescArray = dma_alloc_coherent(&pdev->dev, R8169_RX_RING_BYTES,
7927 &tp->RxPhyAddr, GFP_KERNEL);
7928 if (!tp->RxDescArray)
7929 goto err_free_tx_0;
7930
7931 retval = rtl8169_init_ring(dev);
7932 if (retval < 0)
7933 goto err_free_rx_1;
7934
7935 INIT_WORK(&tp->wk.work, rtl_task);
7936
7937 smp_mb();
7938
7939 rtl_request_firmware(tp);
7940
Francois Romieu92a7c4e2012-03-10 10:42:12 +01007941 retval = request_irq(pdev->irq, rtl8169_interrupt,
Francois Romieudf43ac72012-03-08 09:48:40 +01007942 (tp->features & RTL_FEATURE_MSI) ? 0 : IRQF_SHARED,
7943 dev->name, dev);
7944 if (retval < 0)
7945 goto err_release_fw_2;
7946
7947 rtl_lock_work(tp);
7948
7949 set_bit(RTL_FLAG_TASK_ENABLED, tp->wk.flags);
7950
7951 napi_enable(&tp->napi);
7952
7953 rtl8169_init_phy(dev, tp);
7954
7955 __rtl8169_set_features(dev, dev->features);
7956
7957 rtl_pll_power_up(tp);
7958
7959 rtl_hw_start(dev);
7960
Corinna Vinschen6e85d5a2015-08-24 12:52:39 +02007961 if (!rtl8169_init_counter_offsets(dev))
7962 netif_warn(tp, hw, dev, "counter reset/update failed\n");
7963
Francois Romieudf43ac72012-03-08 09:48:40 +01007964 netif_start_queue(dev);
7965
7966 rtl_unlock_work(tp);
7967
7968 tp->saved_wolopts = 0;
7969 pm_runtime_put_noidle(&pdev->dev);
7970
7971 rtl8169_check_link_status(dev, tp, ioaddr);
7972out:
7973 return retval;
7974
7975err_release_fw_2:
7976 rtl_release_firmware(tp);
7977 rtl8169_rx_clear(tp);
7978err_free_rx_1:
7979 dma_free_coherent(&pdev->dev, R8169_RX_RING_BYTES, tp->RxDescArray,
7980 tp->RxPhyAddr);
7981 tp->RxDescArray = NULL;
7982err_free_tx_0:
7983 dma_free_coherent(&pdev->dev, R8169_TX_RING_BYTES, tp->TxDescArray,
7984 tp->TxPhyAddr);
7985 tp->TxDescArray = NULL;
7986err_pm_runtime_put:
7987 pm_runtime_put_noidle(&pdev->dev);
7988 goto out;
7989}
7990
stephen hemmingerbc1f4472017-01-06 19:12:52 -08007991static void
Junchang Wang8027aa22012-03-04 23:30:32 +01007992rtl8169_get_stats64(struct net_device *dev, struct rtnl_link_stats64 *stats)
Linus Torvalds1da177e2005-04-16 15:20:36 -07007993{
7994 struct rtl8169_private *tp = netdev_priv(dev);
7995 void __iomem *ioaddr = tp->mmio_addr;
Chun-Hao Linf09cf4b2016-02-24 14:18:42 +08007996 struct pci_dev *pdev = tp->pci_dev;
Corinna Vinschen42020322015-09-10 10:47:35 +02007997 struct rtl8169_counters *counters = tp->counters;
Junchang Wang8027aa22012-03-04 23:30:32 +01007998 unsigned int start;
Linus Torvalds1da177e2005-04-16 15:20:36 -07007999
Chun-Hao Linf09cf4b2016-02-24 14:18:42 +08008000 pm_runtime_get_noresume(&pdev->dev);
8001
8002 if (netif_running(dev) && pm_runtime_active(&pdev->dev))
Francois Romieu523a6092008-09-10 22:28:56 +02008003 rtl8169_rx_missed(dev, ioaddr);
Francois Romieu5b0384f2006-08-16 16:00:01 +02008004
Junchang Wang8027aa22012-03-04 23:30:32 +01008005 do {
Eric W. Biederman57a77442014-03-13 21:26:42 -07008006 start = u64_stats_fetch_begin_irq(&tp->rx_stats.syncp);
Junchang Wang8027aa22012-03-04 23:30:32 +01008007 stats->rx_packets = tp->rx_stats.packets;
8008 stats->rx_bytes = tp->rx_stats.bytes;
Eric W. Biederman57a77442014-03-13 21:26:42 -07008009 } while (u64_stats_fetch_retry_irq(&tp->rx_stats.syncp, start));
Junchang Wang8027aa22012-03-04 23:30:32 +01008010
Junchang Wang8027aa22012-03-04 23:30:32 +01008011 do {
Eric W. Biederman57a77442014-03-13 21:26:42 -07008012 start = u64_stats_fetch_begin_irq(&tp->tx_stats.syncp);
Junchang Wang8027aa22012-03-04 23:30:32 +01008013 stats->tx_packets = tp->tx_stats.packets;
8014 stats->tx_bytes = tp->tx_stats.bytes;
Eric W. Biederman57a77442014-03-13 21:26:42 -07008015 } while (u64_stats_fetch_retry_irq(&tp->tx_stats.syncp, start));
Junchang Wang8027aa22012-03-04 23:30:32 +01008016
8017 stats->rx_dropped = dev->stats.rx_dropped;
8018 stats->tx_dropped = dev->stats.tx_dropped;
8019 stats->rx_length_errors = dev->stats.rx_length_errors;
8020 stats->rx_errors = dev->stats.rx_errors;
8021 stats->rx_crc_errors = dev->stats.rx_crc_errors;
8022 stats->rx_fifo_errors = dev->stats.rx_fifo_errors;
8023 stats->rx_missed_errors = dev->stats.rx_missed_errors;
Corinna Vinschend7d2d892015-08-27 17:11:48 +02008024 stats->multicast = dev->stats.multicast;
Junchang Wang8027aa22012-03-04 23:30:32 +01008025
Corinna Vinschen6e85d5a2015-08-24 12:52:39 +02008026 /*
8027 * Fetch additonal counter values missing in stats collected by driver
8028 * from tally counters.
8029 */
Chun-Hao Linf09cf4b2016-02-24 14:18:42 +08008030 if (pm_runtime_active(&pdev->dev))
8031 rtl8169_update_counters(dev);
Corinna Vinschen6e85d5a2015-08-24 12:52:39 +02008032
8033 /*
8034 * Subtract values fetched during initalization.
8035 * See rtl8169_init_counter_offsets for a description why we do that.
8036 */
Corinna Vinschen42020322015-09-10 10:47:35 +02008037 stats->tx_errors = le64_to_cpu(counters->tx_errors) -
Corinna Vinschen6e85d5a2015-08-24 12:52:39 +02008038 le64_to_cpu(tp->tc_offset.tx_errors);
Corinna Vinschen42020322015-09-10 10:47:35 +02008039 stats->collisions = le32_to_cpu(counters->tx_multi_collision) -
Corinna Vinschen6e85d5a2015-08-24 12:52:39 +02008040 le32_to_cpu(tp->tc_offset.tx_multi_collision);
Corinna Vinschen42020322015-09-10 10:47:35 +02008041 stats->tx_aborted_errors = le16_to_cpu(counters->tx_aborted) -
Corinna Vinschen6e85d5a2015-08-24 12:52:39 +02008042 le16_to_cpu(tp->tc_offset.tx_aborted);
8043
Chun-Hao Linf09cf4b2016-02-24 14:18:42 +08008044 pm_runtime_put_noidle(&pdev->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -07008045}
8046
Rafael J. Wysocki861ab442009-04-05 08:40:04 +00008047static void rtl8169_net_suspend(struct net_device *dev)
Francois Romieu5d06a992006-02-23 00:47:58 +01008048{
françois romieu065c27c2011-01-03 15:08:12 +00008049 struct rtl8169_private *tp = netdev_priv(dev);
8050
Francois Romieu5d06a992006-02-23 00:47:58 +01008051 if (!netif_running(dev))
Rafael J. Wysocki861ab442009-04-05 08:40:04 +00008052 return;
Francois Romieu5d06a992006-02-23 00:47:58 +01008053
8054 netif_device_detach(dev);
8055 netif_stop_queue(dev);
Francois Romieuda78dbf2012-01-26 14:18:23 +01008056
8057 rtl_lock_work(tp);
8058 napi_disable(&tp->napi);
Francois Romieu6c4a70c2012-01-31 10:56:44 +01008059 clear_bit(RTL_FLAG_TASK_ENABLED, tp->wk.flags);
Francois Romieuda78dbf2012-01-26 14:18:23 +01008060 rtl_unlock_work(tp);
8061
8062 rtl_pll_power_down(tp);
Rafael J. Wysocki861ab442009-04-05 08:40:04 +00008063}
Francois Romieu5d06a992006-02-23 00:47:58 +01008064
Rafael J. Wysocki861ab442009-04-05 08:40:04 +00008065#ifdef CONFIG_PM
8066
8067static int rtl8169_suspend(struct device *device)
8068{
8069 struct pci_dev *pdev = to_pci_dev(device);
8070 struct net_device *dev = pci_get_drvdata(pdev);
8071
8072 rtl8169_net_suspend(dev);
Francois Romieu1371fa62007-04-02 23:01:11 +02008073
Francois Romieu5d06a992006-02-23 00:47:58 +01008074 return 0;
8075}
8076
Rafael J. Wysockie1759442010-03-14 14:33:51 +00008077static void __rtl8169_resume(struct net_device *dev)
8078{
françois romieu065c27c2011-01-03 15:08:12 +00008079 struct rtl8169_private *tp = netdev_priv(dev);
8080
Rafael J. Wysockie1759442010-03-14 14:33:51 +00008081 netif_device_attach(dev);
françois romieu065c27c2011-01-03 15:08:12 +00008082
8083 rtl_pll_power_up(tp);
8084
Artem Savkovcff4c162012-04-03 10:29:11 +00008085 rtl_lock_work(tp);
8086 napi_enable(&tp->napi);
Francois Romieu6c4a70c2012-01-31 10:56:44 +01008087 set_bit(RTL_FLAG_TASK_ENABLED, tp->wk.flags);
Artem Savkovcff4c162012-04-03 10:29:11 +00008088 rtl_unlock_work(tp);
Francois Romieuda78dbf2012-01-26 14:18:23 +01008089
Francois Romieu98ddf982012-01-31 10:47:34 +01008090 rtl_schedule_task(tp, RTL_FLAG_TASK_RESET_PENDING);
Rafael J. Wysockie1759442010-03-14 14:33:51 +00008091}
8092
Rafael J. Wysocki861ab442009-04-05 08:40:04 +00008093static int rtl8169_resume(struct device *device)
Francois Romieu5d06a992006-02-23 00:47:58 +01008094{
Rafael J. Wysocki861ab442009-04-05 08:40:04 +00008095 struct pci_dev *pdev = to_pci_dev(device);
Francois Romieu5d06a992006-02-23 00:47:58 +01008096 struct net_device *dev = pci_get_drvdata(pdev);
Stanislaw Gruszkafccec102010-10-20 22:25:42 +00008097 struct rtl8169_private *tp = netdev_priv(dev);
8098
8099 rtl8169_init_phy(dev, tp);
Francois Romieu5d06a992006-02-23 00:47:58 +01008100
Rafael J. Wysockie1759442010-03-14 14:33:51 +00008101 if (netif_running(dev))
8102 __rtl8169_resume(dev);
Francois Romieu5d06a992006-02-23 00:47:58 +01008103
Francois Romieu5d06a992006-02-23 00:47:58 +01008104 return 0;
8105}
8106
Rafael J. Wysockie1759442010-03-14 14:33:51 +00008107static int rtl8169_runtime_suspend(struct device *device)
8108{
8109 struct pci_dev *pdev = to_pci_dev(device);
8110 struct net_device *dev = pci_get_drvdata(pdev);
8111 struct rtl8169_private *tp = netdev_priv(dev);
8112
8113 if (!tp->TxDescArray)
8114 return 0;
8115
Francois Romieuda78dbf2012-01-26 14:18:23 +01008116 rtl_lock_work(tp);
Rafael J. Wysockie1759442010-03-14 14:33:51 +00008117 tp->saved_wolopts = __rtl8169_get_wol(tp);
8118 __rtl8169_set_wol(tp, WAKE_ANY);
Francois Romieuda78dbf2012-01-26 14:18:23 +01008119 rtl_unlock_work(tp);
Rafael J. Wysockie1759442010-03-14 14:33:51 +00008120
8121 rtl8169_net_suspend(dev);
8122
Chun-Hao Linf09cf4b2016-02-24 14:18:42 +08008123 /* Update counters before going runtime suspend */
8124 rtl8169_rx_missed(dev, tp->mmio_addr);
8125 rtl8169_update_counters(dev);
8126
Rafael J. Wysockie1759442010-03-14 14:33:51 +00008127 return 0;
8128}
8129
8130static int rtl8169_runtime_resume(struct device *device)
8131{
8132 struct pci_dev *pdev = to_pci_dev(device);
8133 struct net_device *dev = pci_get_drvdata(pdev);
8134 struct rtl8169_private *tp = netdev_priv(dev);
Chun-Hao Linf51d4a12016-07-29 16:37:56 +08008135 rtl_rar_set(tp, dev->dev_addr);
Rafael J. Wysockie1759442010-03-14 14:33:51 +00008136
8137 if (!tp->TxDescArray)
8138 return 0;
8139
Francois Romieuda78dbf2012-01-26 14:18:23 +01008140 rtl_lock_work(tp);
Rafael J. Wysockie1759442010-03-14 14:33:51 +00008141 __rtl8169_set_wol(tp, tp->saved_wolopts);
8142 tp->saved_wolopts = 0;
Francois Romieuda78dbf2012-01-26 14:18:23 +01008143 rtl_unlock_work(tp);
Rafael J. Wysockie1759442010-03-14 14:33:51 +00008144
Stanislaw Gruszkafccec102010-10-20 22:25:42 +00008145 rtl8169_init_phy(dev, tp);
8146
Rafael J. Wysockie1759442010-03-14 14:33:51 +00008147 __rtl8169_resume(dev);
8148
8149 return 0;
8150}
8151
8152static int rtl8169_runtime_idle(struct device *device)
8153{
8154 struct pci_dev *pdev = to_pci_dev(device);
8155 struct net_device *dev = pci_get_drvdata(pdev);
8156 struct rtl8169_private *tp = netdev_priv(dev);
8157
Rafael J. Wysockie4fbce72010-12-08 15:32:14 +00008158 return tp->TxDescArray ? -EBUSY : 0;
Rafael J. Wysockie1759442010-03-14 14:33:51 +00008159}
8160
Alexey Dobriyan47145212009-12-14 18:00:08 -08008161static const struct dev_pm_ops rtl8169_pm_ops = {
Francois Romieucecb5fd2011-04-01 10:21:07 +02008162 .suspend = rtl8169_suspend,
8163 .resume = rtl8169_resume,
8164 .freeze = rtl8169_suspend,
8165 .thaw = rtl8169_resume,
8166 .poweroff = rtl8169_suspend,
8167 .restore = rtl8169_resume,
8168 .runtime_suspend = rtl8169_runtime_suspend,
8169 .runtime_resume = rtl8169_runtime_resume,
8170 .runtime_idle = rtl8169_runtime_idle,
Rafael J. Wysocki861ab442009-04-05 08:40:04 +00008171};
8172
8173#define RTL8169_PM_OPS (&rtl8169_pm_ops)
8174
8175#else /* !CONFIG_PM */
8176
8177#define RTL8169_PM_OPS NULL
8178
8179#endif /* !CONFIG_PM */
8180
David S. Miller1805b2f2011-10-24 18:18:09 -04008181static void rtl_wol_shutdown_quirk(struct rtl8169_private *tp)
8182{
8183 void __iomem *ioaddr = tp->mmio_addr;
8184
8185 /* WoL fails with 8168b when the receiver is disabled. */
8186 switch (tp->mac_version) {
8187 case RTL_GIGA_MAC_VER_11:
8188 case RTL_GIGA_MAC_VER_12:
8189 case RTL_GIGA_MAC_VER_17:
8190 pci_clear_master(tp->pci_dev);
8191
8192 RTL_W8(ChipCmd, CmdRxEnb);
8193 /* PCI commit */
8194 RTL_R8(ChipCmd);
8195 break;
8196 default:
8197 break;
8198 }
8199}
8200
Francois Romieu1765f952008-09-13 17:21:40 +02008201static void rtl_shutdown(struct pci_dev *pdev)
8202{
Rafael J. Wysocki861ab442009-04-05 08:40:04 +00008203 struct net_device *dev = pci_get_drvdata(pdev);
françois romieu4bb3f522009-06-17 11:41:45 +00008204 struct rtl8169_private *tp = netdev_priv(dev);
françois romieu2a15cd22012-03-06 01:14:12 +00008205 struct device *d = &pdev->dev;
8206
8207 pm_runtime_get_sync(d);
Francois Romieu1765f952008-09-13 17:21:40 +02008208
Rafael J. Wysocki861ab442009-04-05 08:40:04 +00008209 rtl8169_net_suspend(dev);
8210
Francois Romieucecb5fd2011-04-01 10:21:07 +02008211 /* Restore original MAC address */
Ivan Veceracc098dc2009-11-29 23:12:52 -08008212 rtl_rar_set(tp, dev->perm_addr);
8213
Hayes Wang92fc43b2011-07-06 15:58:03 +08008214 rtl8169_hw_reset(tp);
françois romieu4bb3f522009-06-17 11:41:45 +00008215
Rafael J. Wysocki861ab442009-04-05 08:40:04 +00008216 if (system_state == SYSTEM_POWER_OFF) {
David S. Miller1805b2f2011-10-24 18:18:09 -04008217 if (__rtl8169_get_wol(tp) & WAKE_ANY) {
8218 rtl_wol_suspend_quirk(tp);
8219 rtl_wol_shutdown_quirk(tp);
françois romieuca52efd2009-07-24 12:34:19 +00008220 }
8221
Rafael J. Wysocki861ab442009-04-05 08:40:04 +00008222 pci_wake_from_d3(pdev, true);
8223 pci_set_power_state(pdev, PCI_D3hot);
8224 }
françois romieu2a15cd22012-03-06 01:14:12 +00008225
8226 pm_runtime_put_noidle(d);
Rafael J. Wysocki861ab442009-04-05 08:40:04 +00008227}
Francois Romieu5d06a992006-02-23 00:47:58 +01008228
Bill Pembertonbaf63292012-12-03 09:23:28 -05008229static void rtl_remove_one(struct pci_dev *pdev)
Francois Romieue27566e2012-03-08 09:54:01 +01008230{
8231 struct net_device *dev = pci_get_drvdata(pdev);
8232 struct rtl8169_private *tp = netdev_priv(dev);
8233
Chun-Hao Linee7a1be2014-10-01 23:17:21 +08008234 if ((tp->mac_version == RTL_GIGA_MAC_VER_27 ||
8235 tp->mac_version == RTL_GIGA_MAC_VER_28 ||
Chun-Hao Lin935e2212014-10-07 15:10:41 +08008236 tp->mac_version == RTL_GIGA_MAC_VER_31 ||
8237 tp->mac_version == RTL_GIGA_MAC_VER_49 ||
8238 tp->mac_version == RTL_GIGA_MAC_VER_50 ||
8239 tp->mac_version == RTL_GIGA_MAC_VER_51) &&
Chun-Hao Linee7a1be2014-10-01 23:17:21 +08008240 r8168_check_dash(tp)) {
Francois Romieue27566e2012-03-08 09:54:01 +01008241 rtl8168_driver_stop(tp);
8242 }
8243
Devendra Nagaad1be8d2012-05-31 01:51:20 +00008244 netif_napi_del(&tp->napi);
8245
Francois Romieue27566e2012-03-08 09:54:01 +01008246 unregister_netdev(dev);
8247
Corinna Vinschen42020322015-09-10 10:47:35 +02008248 dma_free_coherent(&tp->pci_dev->dev, sizeof(*tp->counters),
8249 tp->counters, tp->counters_phys_addr);
8250
Francois Romieue27566e2012-03-08 09:54:01 +01008251 rtl_release_firmware(tp);
8252
8253 if (pci_dev_run_wake(pdev))
8254 pm_runtime_get_noresume(&pdev->dev);
8255
8256 /* restore original MAC address */
8257 rtl_rar_set(tp, dev->perm_addr);
8258
8259 rtl_disable_msi(pdev, tp);
8260 rtl8169_release_board(pdev, dev, tp->mmio_addr);
Francois Romieue27566e2012-03-08 09:54:01 +01008261}
8262
Francois Romieufa9c3852012-03-08 10:01:50 +01008263static const struct net_device_ops rtl_netdev_ops = {
Francois Romieudf43ac72012-03-08 09:48:40 +01008264 .ndo_open = rtl_open,
Francois Romieufa9c3852012-03-08 10:01:50 +01008265 .ndo_stop = rtl8169_close,
8266 .ndo_get_stats64 = rtl8169_get_stats64,
8267 .ndo_start_xmit = rtl8169_start_xmit,
8268 .ndo_tx_timeout = rtl8169_tx_timeout,
8269 .ndo_validate_addr = eth_validate_addr,
8270 .ndo_change_mtu = rtl8169_change_mtu,
8271 .ndo_fix_features = rtl8169_fix_features,
8272 .ndo_set_features = rtl8169_set_features,
8273 .ndo_set_mac_address = rtl_set_mac_address,
8274 .ndo_do_ioctl = rtl8169_ioctl,
8275 .ndo_set_rx_mode = rtl_set_rx_mode,
8276#ifdef CONFIG_NET_POLL_CONTROLLER
8277 .ndo_poll_controller = rtl8169_netpoll,
8278#endif
8279
8280};
8281
Francois Romieu31fa8b12012-03-08 10:09:40 +01008282static const struct rtl_cfg_info {
8283 void (*hw_start)(struct net_device *);
8284 unsigned int region;
8285 unsigned int align;
8286 u16 event_slow;
8287 unsigned features;
Francois Romieu50970832017-10-27 13:24:49 +03008288 const struct rtl_coalesce_info *coalesce_info;
Francois Romieu31fa8b12012-03-08 10:09:40 +01008289 u8 default_ver;
8290} rtl_cfg_infos [] = {
8291 [RTL_CFG_0] = {
8292 .hw_start = rtl_hw_start_8169,
8293 .region = 1,
8294 .align = 0,
8295 .event_slow = SYSErr | LinkChg | RxOverflow | RxFIFOOver,
8296 .features = RTL_FEATURE_GMII,
Francois Romieu50970832017-10-27 13:24:49 +03008297 .coalesce_info = rtl_coalesce_info_8169,
Francois Romieu31fa8b12012-03-08 10:09:40 +01008298 .default_ver = RTL_GIGA_MAC_VER_01,
8299 },
8300 [RTL_CFG_1] = {
8301 .hw_start = rtl_hw_start_8168,
8302 .region = 2,
8303 .align = 8,
8304 .event_slow = SYSErr | LinkChg | RxOverflow,
8305 .features = RTL_FEATURE_GMII | RTL_FEATURE_MSI,
Francois Romieu50970832017-10-27 13:24:49 +03008306 .coalesce_info = rtl_coalesce_info_8168_8136,
Francois Romieu31fa8b12012-03-08 10:09:40 +01008307 .default_ver = RTL_GIGA_MAC_VER_11,
8308 },
8309 [RTL_CFG_2] = {
8310 .hw_start = rtl_hw_start_8101,
8311 .region = 2,
8312 .align = 8,
8313 .event_slow = SYSErr | LinkChg | RxOverflow | RxFIFOOver |
8314 PCSTimeout,
8315 .features = RTL_FEATURE_MSI,
Francois Romieu50970832017-10-27 13:24:49 +03008316 .coalesce_info = rtl_coalesce_info_8168_8136,
Francois Romieu31fa8b12012-03-08 10:09:40 +01008317 .default_ver = RTL_GIGA_MAC_VER_13,
8318 }
8319};
8320
8321/* Cfg9346_Unlock assumed. */
8322static unsigned rtl_try_msi(struct rtl8169_private *tp,
8323 const struct rtl_cfg_info *cfg)
8324{
8325 void __iomem *ioaddr = tp->mmio_addr;
8326 unsigned msi = 0;
8327 u8 cfg2;
8328
8329 cfg2 = RTL_R8(Config2) & ~MSIEnable;
8330 if (cfg->features & RTL_FEATURE_MSI) {
8331 if (pci_enable_msi(tp->pci_dev)) {
8332 netif_info(tp, hw, tp->dev, "no MSI. Back to INTx.\n");
8333 } else {
8334 cfg2 |= MSIEnable;
8335 msi = RTL_FEATURE_MSI;
8336 }
8337 }
8338 if (tp->mac_version <= RTL_GIGA_MAC_VER_06)
8339 RTL_W8(Config2, cfg2);
8340 return msi;
8341}
8342
Hayes Wangc5583862012-07-02 17:23:22 +08008343DECLARE_RTL_COND(rtl_link_list_ready_cond)
8344{
8345 void __iomem *ioaddr = tp->mmio_addr;
8346
8347 return RTL_R8(MCU) & LINK_LIST_RDY;
8348}
8349
8350DECLARE_RTL_COND(rtl_rxtx_empty_cond)
8351{
8352 void __iomem *ioaddr = tp->mmio_addr;
8353
8354 return (RTL_R8(MCU) & RXTX_EMPTY) == RXTX_EMPTY;
8355}
8356
Bill Pembertonbaf63292012-12-03 09:23:28 -05008357static void rtl_hw_init_8168g(struct rtl8169_private *tp)
Hayes Wangc5583862012-07-02 17:23:22 +08008358{
8359 void __iomem *ioaddr = tp->mmio_addr;
8360 u32 data;
8361
8362 tp->ocp_base = OCP_STD_PHY_BASE;
8363
8364 RTL_W32(MISC, RTL_R32(MISC) | RXDV_GATED_EN);
8365
8366 if (!rtl_udelay_loop_wait_high(tp, &rtl_txcfg_empty_cond, 100, 42))
8367 return;
8368
8369 if (!rtl_udelay_loop_wait_high(tp, &rtl_rxtx_empty_cond, 100, 42))
8370 return;
8371
8372 RTL_W8(ChipCmd, RTL_R8(ChipCmd) & ~(CmdTxEnb | CmdRxEnb));
8373 msleep(1);
8374 RTL_W8(MCU, RTL_R8(MCU) & ~NOW_IS_OOB);
8375
Hayes Wang5f8bcce2012-07-10 08:47:05 +02008376 data = r8168_mac_ocp_read(tp, 0xe8de);
Hayes Wangc5583862012-07-02 17:23:22 +08008377 data &= ~(1 << 14);
8378 r8168_mac_ocp_write(tp, 0xe8de, data);
8379
8380 if (!rtl_udelay_loop_wait_high(tp, &rtl_link_list_ready_cond, 100, 42))
8381 return;
8382
Hayes Wang5f8bcce2012-07-10 08:47:05 +02008383 data = r8168_mac_ocp_read(tp, 0xe8de);
Hayes Wangc5583862012-07-02 17:23:22 +08008384 data |= (1 << 15);
8385 r8168_mac_ocp_write(tp, 0xe8de, data);
8386
8387 if (!rtl_udelay_loop_wait_high(tp, &rtl_link_list_ready_cond, 100, 42))
8388 return;
8389}
8390
Chun-Hao Lin003609d2014-12-02 16:48:31 +08008391static void rtl_hw_init_8168ep(struct rtl8169_private *tp)
8392{
8393 rtl8168ep_stop_cmac(tp);
8394 rtl_hw_init_8168g(tp);
8395}
8396
Bill Pembertonbaf63292012-12-03 09:23:28 -05008397static void rtl_hw_initialize(struct rtl8169_private *tp)
Hayes Wangc5583862012-07-02 17:23:22 +08008398{
8399 switch (tp->mac_version) {
8400 case RTL_GIGA_MAC_VER_40:
8401 case RTL_GIGA_MAC_VER_41:
hayeswang57538c42013-04-01 22:23:40 +00008402 case RTL_GIGA_MAC_VER_42:
hayeswang58152cd2013-04-01 22:23:42 +00008403 case RTL_GIGA_MAC_VER_43:
hayeswang45dd95c2013-07-08 17:09:01 +08008404 case RTL_GIGA_MAC_VER_44:
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08008405 case RTL_GIGA_MAC_VER_45:
8406 case RTL_GIGA_MAC_VER_46:
8407 case RTL_GIGA_MAC_VER_47:
8408 case RTL_GIGA_MAC_VER_48:
Chun-Hao Lin003609d2014-12-02 16:48:31 +08008409 rtl_hw_init_8168g(tp);
8410 break;
Chun-Hao Lin935e2212014-10-07 15:10:41 +08008411 case RTL_GIGA_MAC_VER_49:
8412 case RTL_GIGA_MAC_VER_50:
8413 case RTL_GIGA_MAC_VER_51:
Chun-Hao Lin003609d2014-12-02 16:48:31 +08008414 rtl_hw_init_8168ep(tp);
Hayes Wangc5583862012-07-02 17:23:22 +08008415 break;
Hayes Wangc5583862012-07-02 17:23:22 +08008416 default:
8417 break;
8418 }
8419}
8420
hayeswang929a0312014-09-16 11:40:47 +08008421static int rtl_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
Francois Romieu3b6cf252012-03-08 09:59:04 +01008422{
8423 const struct rtl_cfg_info *cfg = rtl_cfg_infos + ent->driver_data;
8424 const unsigned int region = cfg->region;
8425 struct rtl8169_private *tp;
8426 struct mii_if_info *mii;
8427 struct net_device *dev;
8428 void __iomem *ioaddr;
8429 int chipset, i;
8430 int rc;
8431
8432 if (netif_msg_drv(&debug)) {
8433 printk(KERN_INFO "%s Gigabit Ethernet driver %s loaded\n",
8434 MODULENAME, RTL8169_VERSION);
8435 }
8436
8437 dev = alloc_etherdev(sizeof (*tp));
8438 if (!dev) {
8439 rc = -ENOMEM;
8440 goto out;
8441 }
8442
8443 SET_NETDEV_DEV(dev, &pdev->dev);
Francois Romieufa9c3852012-03-08 10:01:50 +01008444 dev->netdev_ops = &rtl_netdev_ops;
Francois Romieu3b6cf252012-03-08 09:59:04 +01008445 tp = netdev_priv(dev);
8446 tp->dev = dev;
8447 tp->pci_dev = pdev;
8448 tp->msg_enable = netif_msg_init(debug.msg_enable, R8169_MSG_DEFAULT);
8449
8450 mii = &tp->mii;
8451 mii->dev = dev;
8452 mii->mdio_read = rtl_mdio_read;
8453 mii->mdio_write = rtl_mdio_write;
8454 mii->phy_id_mask = 0x1f;
8455 mii->reg_num_mask = 0x1f;
8456 mii->supports_gmii = !!(cfg->features & RTL_FEATURE_GMII);
8457
8458 /* disable ASPM completely as that cause random device stop working
8459 * problems as well as full system hangs for some PCIe devices users */
8460 pci_disable_link_state(pdev, PCIE_LINK_STATE_L0S | PCIE_LINK_STATE_L1 |
8461 PCIE_LINK_STATE_CLKPM);
8462
8463 /* enable device (incl. PCI PM wakeup and hotplug setup) */
8464 rc = pci_enable_device(pdev);
8465 if (rc < 0) {
8466 netif_err(tp, probe, dev, "enable failure\n");
8467 goto err_out_free_dev_1;
8468 }
8469
8470 if (pci_set_mwi(pdev) < 0)
8471 netif_info(tp, probe, dev, "Mem-Wr-Inval unavailable\n");
8472
8473 /* make sure PCI base addr 1 is MMIO */
8474 if (!(pci_resource_flags(pdev, region) & IORESOURCE_MEM)) {
8475 netif_err(tp, probe, dev,
8476 "region #%d not an MMIO resource, aborting\n",
8477 region);
8478 rc = -ENODEV;
8479 goto err_out_mwi_2;
8480 }
8481
8482 /* check for weird/broken PCI region reporting */
8483 if (pci_resource_len(pdev, region) < R8169_REGS_SIZE) {
8484 netif_err(tp, probe, dev,
8485 "Invalid PCI region size(s), aborting\n");
8486 rc = -ENODEV;
8487 goto err_out_mwi_2;
8488 }
8489
8490 rc = pci_request_regions(pdev, MODULENAME);
8491 if (rc < 0) {
8492 netif_err(tp, probe, dev, "could not request regions\n");
8493 goto err_out_mwi_2;
8494 }
8495
Francois Romieu3b6cf252012-03-08 09:59:04 +01008496 /* ioremap MMIO region */
8497 ioaddr = ioremap(pci_resource_start(pdev, region), R8169_REGS_SIZE);
8498 if (!ioaddr) {
8499 netif_err(tp, probe, dev, "cannot remap MMIO, aborting\n");
8500 rc = -EIO;
8501 goto err_out_free_res_3;
8502 }
8503 tp->mmio_addr = ioaddr;
8504
8505 if (!pci_is_pcie(pdev))
8506 netif_info(tp, probe, dev, "not PCI Express\n");
8507
8508 /* Identify chip attached to board */
8509 rtl8169_get_mac_version(tp, dev, cfg->default_ver);
8510
Ard Biesheuvel27896c82016-05-14 22:40:15 +02008511 tp->cp_cmd = 0;
8512
8513 if ((sizeof(dma_addr_t) > 4) &&
8514 (use_dac == 1 || (use_dac == -1 && pci_is_pcie(pdev) &&
8515 tp->mac_version >= RTL_GIGA_MAC_VER_18)) &&
Ard Biesheuvelf0076432016-10-14 14:40:33 +01008516 !pci_set_dma_mask(pdev, DMA_BIT_MASK(64)) &&
8517 !pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64))) {
Ard Biesheuvel27896c82016-05-14 22:40:15 +02008518
8519 /* CPlusCmd Dual Access Cycle is only needed for non-PCIe */
8520 if (!pci_is_pcie(pdev))
8521 tp->cp_cmd |= PCIDAC;
8522 dev->features |= NETIF_F_HIGHDMA;
8523 } else {
8524 rc = pci_set_dma_mask(pdev, DMA_BIT_MASK(32));
8525 if (rc < 0) {
8526 netif_err(tp, probe, dev, "DMA configuration failed\n");
8527 goto err_out_unmap_4;
8528 }
8529 }
8530
Francois Romieu3b6cf252012-03-08 09:59:04 +01008531 rtl_init_rxcfg(tp);
8532
8533 rtl_irq_disable(tp);
8534
Hayes Wangc5583862012-07-02 17:23:22 +08008535 rtl_hw_initialize(tp);
8536
Francois Romieu3b6cf252012-03-08 09:59:04 +01008537 rtl_hw_reset(tp);
8538
8539 rtl_ack_events(tp, 0xffff);
8540
8541 pci_set_master(pdev);
8542
Francois Romieu3b6cf252012-03-08 09:59:04 +01008543 rtl_init_mdio_ops(tp);
8544 rtl_init_pll_power_ops(tp);
8545 rtl_init_jumbo_ops(tp);
Hayes Wangbeb1fe12012-03-30 14:33:01 +08008546 rtl_init_csi_ops(tp);
Francois Romieu3b6cf252012-03-08 09:59:04 +01008547
8548 rtl8169_print_mac_version(tp);
8549
8550 chipset = tp->mac_version;
8551 tp->txd_version = rtl_chip_infos[chipset].txd_version;
8552
8553 RTL_W8(Cfg9346, Cfg9346_Unlock);
8554 RTL_W8(Config1, RTL_R8(Config1) | PMEnable);
Peter Wu8f9d5132013-08-17 11:00:02 +02008555 RTL_W8(Config5, RTL_R8(Config5) & (BWF | MWF | UWF | LanWake | PMEStatus));
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08008556 switch (tp->mac_version) {
Chun-Hao Linac85bcd2014-10-01 23:17:16 +08008557 case RTL_GIGA_MAC_VER_34:
8558 case RTL_GIGA_MAC_VER_35:
8559 case RTL_GIGA_MAC_VER_36:
8560 case RTL_GIGA_MAC_VER_37:
8561 case RTL_GIGA_MAC_VER_38:
8562 case RTL_GIGA_MAC_VER_40:
8563 case RTL_GIGA_MAC_VER_41:
8564 case RTL_GIGA_MAC_VER_42:
8565 case RTL_GIGA_MAC_VER_43:
8566 case RTL_GIGA_MAC_VER_44:
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08008567 case RTL_GIGA_MAC_VER_45:
8568 case RTL_GIGA_MAC_VER_46:
Chun-Hao Linac85bcd2014-10-01 23:17:16 +08008569 case RTL_GIGA_MAC_VER_47:
8570 case RTL_GIGA_MAC_VER_48:
Chun-Hao Lin935e2212014-10-07 15:10:41 +08008571 case RTL_GIGA_MAC_VER_49:
8572 case RTL_GIGA_MAC_VER_50:
8573 case RTL_GIGA_MAC_VER_51:
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08008574 if (rtl_eri_read(tp, 0xdc, ERIAR_EXGMAC) & MagicPacket_v2)
8575 tp->features |= RTL_FEATURE_WOL;
8576 if ((RTL_R8(Config3) & LinkUp) != 0)
8577 tp->features |= RTL_FEATURE_WOL;
8578 break;
8579 default:
8580 if ((RTL_R8(Config3) & (LinkUp | MagicPacket)) != 0)
8581 tp->features |= RTL_FEATURE_WOL;
8582 break;
8583 }
Francois Romieu3b6cf252012-03-08 09:59:04 +01008584 if ((RTL_R8(Config5) & (UWF | BWF | MWF)) != 0)
8585 tp->features |= RTL_FEATURE_WOL;
8586 tp->features |= rtl_try_msi(tp, cfg);
8587 RTL_W8(Cfg9346, Cfg9346_Lock);
8588
8589 if (rtl_tbi_enabled(tp)) {
8590 tp->set_speed = rtl8169_set_speed_tbi;
Philippe Reynes6fa1ba62017-02-23 22:34:43 +01008591 tp->get_link_ksettings = rtl8169_get_link_ksettings_tbi;
Francois Romieu3b6cf252012-03-08 09:59:04 +01008592 tp->phy_reset_enable = rtl8169_tbi_reset_enable;
8593 tp->phy_reset_pending = rtl8169_tbi_reset_pending;
8594 tp->link_ok = rtl8169_tbi_link_ok;
8595 tp->do_ioctl = rtl_tbi_ioctl;
8596 } else {
8597 tp->set_speed = rtl8169_set_speed_xmii;
Philippe Reynes6fa1ba62017-02-23 22:34:43 +01008598 tp->get_link_ksettings = rtl8169_get_link_ksettings_xmii;
Francois Romieu3b6cf252012-03-08 09:59:04 +01008599 tp->phy_reset_enable = rtl8169_xmii_reset_enable;
8600 tp->phy_reset_pending = rtl8169_xmii_reset_pending;
8601 tp->link_ok = rtl8169_xmii_link_ok;
8602 tp->do_ioctl = rtl_xmii_ioctl;
8603 }
8604
8605 mutex_init(&tp->wk.mutex);
Kyle McMartin340fea32014-02-24 20:12:28 -05008606 u64_stats_init(&tp->rx_stats.syncp);
8607 u64_stats_init(&tp->tx_stats.syncp);
Francois Romieu3b6cf252012-03-08 09:59:04 +01008608
8609 /* Get MAC address */
Chun-Hao Lin89cceb22014-10-01 23:17:15 +08008610 if (tp->mac_version == RTL_GIGA_MAC_VER_35 ||
8611 tp->mac_version == RTL_GIGA_MAC_VER_36 ||
8612 tp->mac_version == RTL_GIGA_MAC_VER_37 ||
8613 tp->mac_version == RTL_GIGA_MAC_VER_38 ||
8614 tp->mac_version == RTL_GIGA_MAC_VER_40 ||
8615 tp->mac_version == RTL_GIGA_MAC_VER_41 ||
8616 tp->mac_version == RTL_GIGA_MAC_VER_42 ||
8617 tp->mac_version == RTL_GIGA_MAC_VER_43 ||
8618 tp->mac_version == RTL_GIGA_MAC_VER_44 ||
8619 tp->mac_version == RTL_GIGA_MAC_VER_45 ||
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08008620 tp->mac_version == RTL_GIGA_MAC_VER_46 ||
8621 tp->mac_version == RTL_GIGA_MAC_VER_47 ||
Chun-Hao Lin935e2212014-10-07 15:10:41 +08008622 tp->mac_version == RTL_GIGA_MAC_VER_48 ||
8623 tp->mac_version == RTL_GIGA_MAC_VER_49 ||
8624 tp->mac_version == RTL_GIGA_MAC_VER_50 ||
8625 tp->mac_version == RTL_GIGA_MAC_VER_51) {
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08008626 u16 mac_addr[3];
8627
Chun-Hao Lin05b96872014-10-01 23:17:12 +08008628 *(u32 *)&mac_addr[0] = rtl_eri_read(tp, 0xe0, ERIAR_EXGMAC);
8629 *(u16 *)&mac_addr[2] = rtl_eri_read(tp, 0xe4, ERIAR_EXGMAC);
Chun-Hao Lin6e1d0b82014-08-20 01:54:04 +08008630
8631 if (is_valid_ether_addr((u8 *)mac_addr))
8632 rtl_rar_set(tp, (u8 *)mac_addr);
8633 }
Francois Romieu3b6cf252012-03-08 09:59:04 +01008634 for (i = 0; i < ETH_ALEN; i++)
8635 dev->dev_addr[i] = RTL_R8(MAC0 + i);
Francois Romieu3b6cf252012-03-08 09:59:04 +01008636
Wilfried Klaebe7ad24ea2014-05-11 00:12:32 +00008637 dev->ethtool_ops = &rtl8169_ethtool_ops;
Francois Romieu3b6cf252012-03-08 09:59:04 +01008638 dev->watchdog_timeo = RTL8169_TX_TIMEOUT;
Francois Romieu3b6cf252012-03-08 09:59:04 +01008639
8640 netif_napi_add(dev, &tp->napi, rtl8169_poll, R8169_NAPI_WEIGHT);
8641
8642 /* don't enable SG, IP_CSUM and TSO by default - it might not work
8643 * properly for all devices */
8644 dev->features |= NETIF_F_RXCSUM |
Patrick McHardyf6469682013-04-19 02:04:27 +00008645 NETIF_F_HW_VLAN_CTAG_TX | NETIF_F_HW_VLAN_CTAG_RX;
Francois Romieu3b6cf252012-03-08 09:59:04 +01008646
8647 dev->hw_features = NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_TSO |
Patrick McHardyf6469682013-04-19 02:04:27 +00008648 NETIF_F_RXCSUM | NETIF_F_HW_VLAN_CTAG_TX |
8649 NETIF_F_HW_VLAN_CTAG_RX;
Francois Romieu3b6cf252012-03-08 09:59:04 +01008650 dev->vlan_features = NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_TSO |
8651 NETIF_F_HIGHDMA;
8652
hayeswang929a0312014-09-16 11:40:47 +08008653 tp->cp_cmd |= RxChkSum | RxVlan;
8654
8655 /*
8656 * Pretend we are using VLANs; This bypasses a nasty bug where
8657 * Interrupts stop flowing on high load on 8110SCd controllers.
8658 */
Francois Romieu3b6cf252012-03-08 09:59:04 +01008659 if (tp->mac_version == RTL_GIGA_MAC_VER_05)
hayeswang929a0312014-09-16 11:40:47 +08008660 /* Disallow toggling */
Patrick McHardyf6469682013-04-19 02:04:27 +00008661 dev->hw_features &= ~NETIF_F_HW_VLAN_CTAG_RX;
Francois Romieu3b6cf252012-03-08 09:59:04 +01008662
hayeswang5888d3f2014-07-11 16:25:56 +08008663 if (tp->txd_version == RTL_TD_0)
8664 tp->tso_csum = rtl8169_tso_csum_v1;
hayeswange9746042014-07-11 16:25:58 +08008665 else if (tp->txd_version == RTL_TD_1) {
hayeswang5888d3f2014-07-11 16:25:56 +08008666 tp->tso_csum = rtl8169_tso_csum_v2;
hayeswange9746042014-07-11 16:25:58 +08008667 dev->hw_features |= NETIF_F_IPV6_CSUM | NETIF_F_TSO6;
8668 } else
hayeswang5888d3f2014-07-11 16:25:56 +08008669 WARN_ON_ONCE(1);
8670
Francois Romieu3b6cf252012-03-08 09:59:04 +01008671 dev->hw_features |= NETIF_F_RXALL;
8672 dev->hw_features |= NETIF_F_RXFCS;
8673
Jarod Wilsonc7315a92016-10-17 15:54:09 -04008674 /* MTU range: 60 - hw-specific max */
8675 dev->min_mtu = ETH_ZLEN;
8676 dev->max_mtu = rtl_chip_infos[chipset].jumbo_max;
8677
Francois Romieu3b6cf252012-03-08 09:59:04 +01008678 tp->hw_start = cfg->hw_start;
8679 tp->event_slow = cfg->event_slow;
Francois Romieu50970832017-10-27 13:24:49 +03008680 tp->coalesce_info = cfg->coalesce_info;
Francois Romieu3b6cf252012-03-08 09:59:04 +01008681
8682 tp->opts1_mask = (tp->mac_version != RTL_GIGA_MAC_VER_01) ?
8683 ~(RxBOVF | RxFOVF) : ~0;
8684
Kees Cook9de36cc2017-10-25 03:53:12 -07008685 timer_setup(&tp->timer, rtl8169_phy_timer, 0);
Francois Romieu3b6cf252012-03-08 09:59:04 +01008686
8687 tp->rtl_fw = RTL_FIRMWARE_UNKNOWN;
8688
Corinna Vinschen42020322015-09-10 10:47:35 +02008689 tp->counters = dma_alloc_coherent (&pdev->dev, sizeof(*tp->counters),
8690 &tp->counters_phys_addr, GFP_KERNEL);
8691 if (!tp->counters) {
8692 rc = -ENOMEM;
Ard Biesheuvel27896c82016-05-14 22:40:15 +02008693 goto err_out_msi_5;
Corinna Vinschen42020322015-09-10 10:47:35 +02008694 }
8695
Francois Romieu3b6cf252012-03-08 09:59:04 +01008696 rc = register_netdev(dev);
8697 if (rc < 0)
Ard Biesheuvel27896c82016-05-14 22:40:15 +02008698 goto err_out_cnt_6;
Francois Romieu3b6cf252012-03-08 09:59:04 +01008699
8700 pci_set_drvdata(pdev, dev);
8701
Francois Romieu92a7c4e2012-03-10 10:42:12 +01008702 netif_info(tp, probe, dev, "%s at 0x%p, %pM, XID %08x IRQ %d\n",
8703 rtl_chip_infos[chipset].name, ioaddr, dev->dev_addr,
8704 (u32)(RTL_R32(TxConfig) & 0x9cf0f8ff), pdev->irq);
Francois Romieu3b6cf252012-03-08 09:59:04 +01008705 if (rtl_chip_infos[chipset].jumbo_max != JUMBO_1K) {
8706 netif_info(tp, probe, dev, "jumbo features [frames: %d bytes, "
8707 "tx checksumming: %s]\n",
8708 rtl_chip_infos[chipset].jumbo_max,
8709 rtl_chip_infos[chipset].jumbo_tx_csum ? "ok" : "ko");
8710 }
8711
Chun-Hao Linee7a1be2014-10-01 23:17:21 +08008712 if ((tp->mac_version == RTL_GIGA_MAC_VER_27 ||
8713 tp->mac_version == RTL_GIGA_MAC_VER_28 ||
Chun-Hao Lin935e2212014-10-07 15:10:41 +08008714 tp->mac_version == RTL_GIGA_MAC_VER_31 ||
8715 tp->mac_version == RTL_GIGA_MAC_VER_49 ||
8716 tp->mac_version == RTL_GIGA_MAC_VER_50 ||
8717 tp->mac_version == RTL_GIGA_MAC_VER_51) &&
Chun-Hao Linee7a1be2014-10-01 23:17:21 +08008718 r8168_check_dash(tp)) {
Francois Romieu3b6cf252012-03-08 09:59:04 +01008719 rtl8168_driver_start(tp);
8720 }
8721
Francois Romieu3b6cf252012-03-08 09:59:04 +01008722 if (pci_dev_run_wake(pdev))
8723 pm_runtime_put_noidle(&pdev->dev);
8724
8725 netif_carrier_off(dev);
8726
8727out:
8728 return rc;
8729
Ard Biesheuvel27896c82016-05-14 22:40:15 +02008730err_out_cnt_6:
Corinna Vinschen42020322015-09-10 10:47:35 +02008731 dma_free_coherent(&pdev->dev, sizeof(*tp->counters), tp->counters,
8732 tp->counters_phys_addr);
Ard Biesheuvel27896c82016-05-14 22:40:15 +02008733err_out_msi_5:
Devendra Nagaad1be8d2012-05-31 01:51:20 +00008734 netif_napi_del(&tp->napi);
Francois Romieu3b6cf252012-03-08 09:59:04 +01008735 rtl_disable_msi(pdev, tp);
Ard Biesheuvel27896c82016-05-14 22:40:15 +02008736err_out_unmap_4:
Francois Romieu3b6cf252012-03-08 09:59:04 +01008737 iounmap(ioaddr);
8738err_out_free_res_3:
8739 pci_release_regions(pdev);
8740err_out_mwi_2:
8741 pci_clear_mwi(pdev);
8742 pci_disable_device(pdev);
8743err_out_free_dev_1:
8744 free_netdev(dev);
8745 goto out;
8746}
8747
Linus Torvalds1da177e2005-04-16 15:20:36 -07008748static struct pci_driver rtl8169_pci_driver = {
8749 .name = MODULENAME,
8750 .id_table = rtl8169_pci_tbl,
Francois Romieu3b6cf252012-03-08 09:59:04 +01008751 .probe = rtl_init_one,
Bill Pembertonbaf63292012-12-03 09:23:28 -05008752 .remove = rtl_remove_one,
Francois Romieu1765f952008-09-13 17:21:40 +02008753 .shutdown = rtl_shutdown,
Rafael J. Wysocki861ab442009-04-05 08:40:04 +00008754 .driver.pm = RTL8169_PM_OPS,
Linus Torvalds1da177e2005-04-16 15:20:36 -07008755};
8756
Devendra Naga3eeb7da2012-10-26 09:27:42 +00008757module_pci_driver(rtl8169_pci_driver);