r8169.c 208.3 KB
Newer Older
L
Linus Torvalds 已提交
1
/*
F
Francois Romieu 已提交
2 3 4 5 6 7 8
 * r8169.c: RealTek 8169/8168/8101 ethernet driver.
 *
 * Copyright (c) 2002 ShuChen <shuchen@realtek.com.tw>
 * Copyright (c) 2003 - 2007 Francois Romieu <romieu@fr.zoreil.com>
 * Copyright (c) a lot of people too. Please respect their work.
 *
 * See MAINTAINERS file for support contact information.
L
Linus Torvalds 已提交
9 10 11 12 13 14 15 16 17 18 19 20 21 22 23
 */

#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/pci.h>
#include <linux/netdevice.h>
#include <linux/etherdevice.h>
#include <linux/delay.h>
#include <linux/ethtool.h>
#include <linux/mii.h>
#include <linux/if_vlan.h>
#include <linux/crc32.h>
#include <linux/in.h>
#include <linux/ip.h>
#include <linux/tcp.h>
24
#include <linux/interrupt.h>
L
Linus Torvalds 已提交
25
#include <linux/dma-mapping.h>
26
#include <linux/pm_runtime.h>
27
#include <linux/firmware.h>
S
Stanislaw Gruszka 已提交
28
#include <linux/pci-aspm.h>
29
#include <linux/prefetch.h>
H
hayeswang 已提交
30 31
#include <linux/ipv6.h>
#include <net/ip6_checksum.h>
L
Linus Torvalds 已提交
32 33 34 35

#include <asm/io.h>
#include <asm/irq.h>

F
Francois Romieu 已提交
36
#define RTL8169_VERSION "2.3LK-NAPI"
L
Linus Torvalds 已提交
37 38 39
#define MODULENAME "r8169"
#define PFX MODULENAME ": "

40 41
#define FIRMWARE_8168D_1	"rtl_nic/rtl8168d-1.fw"
#define FIRMWARE_8168D_2	"rtl_nic/rtl8168d-2.fw"
H
hayeswang 已提交
42 43
#define FIRMWARE_8168E_1	"rtl_nic/rtl8168e-1.fw"
#define FIRMWARE_8168E_2	"rtl_nic/rtl8168e-2.fw"
H
Hayes Wang 已提交
44
#define FIRMWARE_8168E_3	"rtl_nic/rtl8168e-3.fw"
45 46
#define FIRMWARE_8168F_1	"rtl_nic/rtl8168f-1.fw"
#define FIRMWARE_8168F_2	"rtl_nic/rtl8168f-2.fw"
47
#define FIRMWARE_8105E_1	"rtl_nic/rtl8105e-1.fw"
48
#define FIRMWARE_8402_1		"rtl_nic/rtl8402-1.fw"
49
#define FIRMWARE_8411_1		"rtl_nic/rtl8411-1.fw"
H
hayeswang 已提交
50
#define FIRMWARE_8411_2		"rtl_nic/rtl8411-2.fw"
H
Hayes Wang 已提交
51
#define FIRMWARE_8106E_1	"rtl_nic/rtl8106e-1.fw"
H
hayeswang 已提交
52
#define FIRMWARE_8106E_2	"rtl_nic/rtl8106e-2.fw"
53
#define FIRMWARE_8168G_2	"rtl_nic/rtl8168g-2.fw"
H
hayeswang 已提交
54
#define FIRMWARE_8168G_3	"rtl_nic/rtl8168g-3.fw"
55 56 57 58
#define FIRMWARE_8168H_1	"rtl_nic/rtl8168h-1.fw"
#define FIRMWARE_8168H_2	"rtl_nic/rtl8168h-2.fw"
#define FIRMWARE_8107E_1	"rtl_nic/rtl8107e-1.fw"
#define FIRMWARE_8107E_2	"rtl_nic/rtl8107e-2.fw"
59

L
Linus Torvalds 已提交
60 61
#ifdef RTL8169_DEBUG
#define assert(expr) \
62 63
	if (!(expr)) {					\
		printk( "Assertion failed! %s,%s,%s,line=%d\n",	\
64
		#expr,__FILE__,__func__,__LINE__);		\
65
	}
66 67
#define dprintk(fmt, args...) \
	do { printk(KERN_DEBUG PFX fmt, ## args); } while (0)
L
Linus Torvalds 已提交
68 69 70 71 72
#else
#define assert(expr) do {} while (0)
#define dprintk(fmt, args...)	do {} while (0)
#endif /* RTL8169_DEBUG */

73
#define R8169_MSG_DEFAULT \
74
	(NETIF_MSG_DRV | NETIF_MSG_PROBE | NETIF_MSG_IFUP | NETIF_MSG_IFDOWN)
75

76 77 78 79 80 81
#define TX_SLOTS_AVAIL(tp) \
	(tp->dirty_tx + NUM_TX_DESC - tp->cur_tx)

/* A skbuff with nr_frags needs nr_frags+1 entries in the tx queue */
#define TX_FRAGS_READY_FOR(tp,nr_frags) \
	(TX_SLOTS_AVAIL(tp) >= (nr_frags + 1))
L
Linus Torvalds 已提交
82 83 84

/* Maximum number of multicast addresses to filter (vs. Rx-all-multicast).
   The RTL chips use a 64 element hash table based on the Ethernet CRC. */
85
static const int multicast_filter_limit = 32;
L
Linus Torvalds 已提交
86

87
#define TX_DMA_BURST	7	/* Maximum PCI burst, '7' is unlimited */
L
Linus Torvalds 已提交
88 89 90 91
#define InterFrameGap	0x03	/* 3 means InterFrameGap = the shortest one */

#define R8169_REGS_SIZE		256
#define NUM_TX_DESC	64	/* Number of Tx descriptor registers */
92
#define NUM_RX_DESC	256U	/* Number of Rx descriptor registers */
L
Linus Torvalds 已提交
93 94 95 96 97 98 99
#define R8169_TX_RING_BYTES	(NUM_TX_DESC * sizeof(struct TxDesc))
#define R8169_RX_RING_BYTES	(NUM_RX_DESC * sizeof(struct RxDesc))

#define RTL8169_TX_TIMEOUT	(6*HZ)
#define RTL8169_PHY_TIMEOUT	(10*HZ)

/* write/read MMIO register */
100 101 102 103 104 105
#define RTL_W8(tp, reg, val8)	writeb((val8), tp->mmio_addr + (reg))
#define RTL_W16(tp, reg, val16)	writew((val16), tp->mmio_addr + (reg))
#define RTL_W32(tp, reg, val32)	writel((val32), tp->mmio_addr + (reg))
#define RTL_R8(tp, reg)		readb(tp->mmio_addr + (reg))
#define RTL_R16(tp, reg)		readw(tp->mmio_addr + (reg))
#define RTL_R32(tp, reg)		readl(tp->mmio_addr + (reg))
L
Linus Torvalds 已提交
106 107

enum mac_version {
108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140
	RTL_GIGA_MAC_VER_01 = 0,
	RTL_GIGA_MAC_VER_02,
	RTL_GIGA_MAC_VER_03,
	RTL_GIGA_MAC_VER_04,
	RTL_GIGA_MAC_VER_05,
	RTL_GIGA_MAC_VER_06,
	RTL_GIGA_MAC_VER_07,
	RTL_GIGA_MAC_VER_08,
	RTL_GIGA_MAC_VER_09,
	RTL_GIGA_MAC_VER_10,
	RTL_GIGA_MAC_VER_11,
	RTL_GIGA_MAC_VER_12,
	RTL_GIGA_MAC_VER_13,
	RTL_GIGA_MAC_VER_14,
	RTL_GIGA_MAC_VER_15,
	RTL_GIGA_MAC_VER_16,
	RTL_GIGA_MAC_VER_17,
	RTL_GIGA_MAC_VER_18,
	RTL_GIGA_MAC_VER_19,
	RTL_GIGA_MAC_VER_20,
	RTL_GIGA_MAC_VER_21,
	RTL_GIGA_MAC_VER_22,
	RTL_GIGA_MAC_VER_23,
	RTL_GIGA_MAC_VER_24,
	RTL_GIGA_MAC_VER_25,
	RTL_GIGA_MAC_VER_26,
	RTL_GIGA_MAC_VER_27,
	RTL_GIGA_MAC_VER_28,
	RTL_GIGA_MAC_VER_29,
	RTL_GIGA_MAC_VER_30,
	RTL_GIGA_MAC_VER_31,
	RTL_GIGA_MAC_VER_32,
	RTL_GIGA_MAC_VER_33,
H
Hayes Wang 已提交
141
	RTL_GIGA_MAC_VER_34,
142 143
	RTL_GIGA_MAC_VER_35,
	RTL_GIGA_MAC_VER_36,
144
	RTL_GIGA_MAC_VER_37,
145
	RTL_GIGA_MAC_VER_38,
H
Hayes Wang 已提交
146
	RTL_GIGA_MAC_VER_39,
H
Hayes Wang 已提交
147 148
	RTL_GIGA_MAC_VER_40,
	RTL_GIGA_MAC_VER_41,
H
hayeswang 已提交
149
	RTL_GIGA_MAC_VER_42,
H
hayeswang 已提交
150
	RTL_GIGA_MAC_VER_43,
H
hayeswang 已提交
151
	RTL_GIGA_MAC_VER_44,
152 153 154 155
	RTL_GIGA_MAC_VER_45,
	RTL_GIGA_MAC_VER_46,
	RTL_GIGA_MAC_VER_47,
	RTL_GIGA_MAC_VER_48,
C
Chun-Hao Lin 已提交
156 157 158
	RTL_GIGA_MAC_VER_49,
	RTL_GIGA_MAC_VER_50,
	RTL_GIGA_MAC_VER_51,
159
	RTL_GIGA_MAC_NONE   = 0xff,
L
Linus Torvalds 已提交
160 161
};

F
Francois Romieu 已提交
162 163 164 165 166
enum rtl_tx_desc_version {
	RTL_TD_0	= 0,
	RTL_TD_1	= 1,
};

F
Francois Romieu 已提交
167 168 169 170 171 172 173 174 175 176 177 178 179
#define JUMBO_1K	ETH_DATA_LEN
#define JUMBO_4K	(4*1024 - ETH_HLEN - 2)
#define JUMBO_6K	(6*1024 - ETH_HLEN - 2)
#define JUMBO_7K	(7*1024 - ETH_HLEN - 2)
#define JUMBO_9K	(9*1024 - ETH_HLEN - 2)

#define _R(NAME,TD,FW,SZ,B) {	\
	.name = NAME,		\
	.txd_version = TD,	\
	.fw_name = FW,		\
	.jumbo_max = SZ,	\
	.jumbo_tx_csum = B	\
}
L
Linus Torvalds 已提交
180

181
static const struct {
L
Linus Torvalds 已提交
182
	const char *name;
F
Francois Romieu 已提交
183
	enum rtl_tx_desc_version txd_version;
184
	const char *fw_name;
F
Francois Romieu 已提交
185 186
	u16 jumbo_max;
	bool jumbo_tx_csum;
187 188 189
} rtl_chip_infos[] = {
	/* PCI devices. */
	[RTL_GIGA_MAC_VER_01] =
F
Francois Romieu 已提交
190
		_R("RTL8169",		RTL_TD_0, NULL, JUMBO_7K, true),
191
	[RTL_GIGA_MAC_VER_02] =
F
Francois Romieu 已提交
192
		_R("RTL8169s",		RTL_TD_0, NULL, JUMBO_7K, true),
193
	[RTL_GIGA_MAC_VER_03] =
F
Francois Romieu 已提交
194
		_R("RTL8110s",		RTL_TD_0, NULL, JUMBO_7K, true),
195
	[RTL_GIGA_MAC_VER_04] =
F
Francois Romieu 已提交
196
		_R("RTL8169sb/8110sb",	RTL_TD_0, NULL, JUMBO_7K, true),
197
	[RTL_GIGA_MAC_VER_05] =
F
Francois Romieu 已提交
198
		_R("RTL8169sc/8110sc",	RTL_TD_0, NULL, JUMBO_7K, true),
199
	[RTL_GIGA_MAC_VER_06] =
F
Francois Romieu 已提交
200
		_R("RTL8169sc/8110sc",	RTL_TD_0, NULL, JUMBO_7K, true),
201 202
	/* PCI-E devices. */
	[RTL_GIGA_MAC_VER_07] =
F
Francois Romieu 已提交
203
		_R("RTL8102e",		RTL_TD_1, NULL, JUMBO_1K, true),
204
	[RTL_GIGA_MAC_VER_08] =
F
Francois Romieu 已提交
205
		_R("RTL8102e",		RTL_TD_1, NULL, JUMBO_1K, true),
206
	[RTL_GIGA_MAC_VER_09] =
F
Francois Romieu 已提交
207
		_R("RTL8102e",		RTL_TD_1, NULL, JUMBO_1K, true),
208
	[RTL_GIGA_MAC_VER_10] =
F
Francois Romieu 已提交
209
		_R("RTL8101e",		RTL_TD_0, NULL, JUMBO_1K, true),
210
	[RTL_GIGA_MAC_VER_11] =
F
Francois Romieu 已提交
211
		_R("RTL8168b/8111b",	RTL_TD_0, NULL, JUMBO_4K, false),
212
	[RTL_GIGA_MAC_VER_12] =
F
Francois Romieu 已提交
213
		_R("RTL8168b/8111b",	RTL_TD_0, NULL, JUMBO_4K, false),
214
	[RTL_GIGA_MAC_VER_13] =
F
Francois Romieu 已提交
215
		_R("RTL8101e",		RTL_TD_0, NULL, JUMBO_1K, true),
216
	[RTL_GIGA_MAC_VER_14] =
F
Francois Romieu 已提交
217
		_R("RTL8100e",		RTL_TD_0, NULL, JUMBO_1K, true),
218
	[RTL_GIGA_MAC_VER_15] =
F
Francois Romieu 已提交
219
		_R("RTL8100e",		RTL_TD_0, NULL, JUMBO_1K, true),
220
	[RTL_GIGA_MAC_VER_16] =
F
Francois Romieu 已提交
221
		_R("RTL8101e",		RTL_TD_0, NULL, JUMBO_1K, true),
222
	[RTL_GIGA_MAC_VER_17] =
223
		_R("RTL8168b/8111b",	RTL_TD_0, NULL, JUMBO_4K, false),
224
	[RTL_GIGA_MAC_VER_18] =
F
Francois Romieu 已提交
225
		_R("RTL8168cp/8111cp",	RTL_TD_1, NULL, JUMBO_6K, false),
226
	[RTL_GIGA_MAC_VER_19] =
F
Francois Romieu 已提交
227
		_R("RTL8168c/8111c",	RTL_TD_1, NULL, JUMBO_6K, false),
228
	[RTL_GIGA_MAC_VER_20] =
F
Francois Romieu 已提交
229
		_R("RTL8168c/8111c",	RTL_TD_1, NULL, JUMBO_6K, false),
230
	[RTL_GIGA_MAC_VER_21] =
F
Francois Romieu 已提交
231
		_R("RTL8168c/8111c",	RTL_TD_1, NULL, JUMBO_6K, false),
232
	[RTL_GIGA_MAC_VER_22] =
F
Francois Romieu 已提交
233
		_R("RTL8168c/8111c",	RTL_TD_1, NULL, JUMBO_6K, false),
234
	[RTL_GIGA_MAC_VER_23] =
F
Francois Romieu 已提交
235
		_R("RTL8168cp/8111cp",	RTL_TD_1, NULL, JUMBO_6K, false),
236
	[RTL_GIGA_MAC_VER_24] =
F
Francois Romieu 已提交
237
		_R("RTL8168cp/8111cp",	RTL_TD_1, NULL, JUMBO_6K, false),
238
	[RTL_GIGA_MAC_VER_25] =
F
Francois Romieu 已提交
239 240
		_R("RTL8168d/8111d",	RTL_TD_1, FIRMWARE_8168D_1,
							JUMBO_9K, false),
241
	[RTL_GIGA_MAC_VER_26] =
F
Francois Romieu 已提交
242 243
		_R("RTL8168d/8111d",	RTL_TD_1, FIRMWARE_8168D_2,
							JUMBO_9K, false),
244
	[RTL_GIGA_MAC_VER_27] =
F
Francois Romieu 已提交
245
		_R("RTL8168dp/8111dp",	RTL_TD_1, NULL, JUMBO_9K, false),
246
	[RTL_GIGA_MAC_VER_28] =
F
Francois Romieu 已提交
247
		_R("RTL8168dp/8111dp",	RTL_TD_1, NULL, JUMBO_9K, false),
248
	[RTL_GIGA_MAC_VER_29] =
F
Francois Romieu 已提交
249 250
		_R("RTL8105e",		RTL_TD_1, FIRMWARE_8105E_1,
							JUMBO_1K, true),
251
	[RTL_GIGA_MAC_VER_30] =
F
Francois Romieu 已提交
252 253
		_R("RTL8105e",		RTL_TD_1, FIRMWARE_8105E_1,
							JUMBO_1K, true),
254
	[RTL_GIGA_MAC_VER_31] =
F
Francois Romieu 已提交
255
		_R("RTL8168dp/8111dp",	RTL_TD_1, NULL, JUMBO_9K, false),
256
	[RTL_GIGA_MAC_VER_32] =
F
Francois Romieu 已提交
257 258
		_R("RTL8168e/8111e",	RTL_TD_1, FIRMWARE_8168E_1,
							JUMBO_9K, false),
259
	[RTL_GIGA_MAC_VER_33] =
F
Francois Romieu 已提交
260 261
		_R("RTL8168e/8111e",	RTL_TD_1, FIRMWARE_8168E_2,
							JUMBO_9K, false),
H
Hayes Wang 已提交
262
	[RTL_GIGA_MAC_VER_34] =
F
Francois Romieu 已提交
263 264
		_R("RTL8168evl/8111evl",RTL_TD_1, FIRMWARE_8168E_3,
							JUMBO_9K, false),
265
	[RTL_GIGA_MAC_VER_35] =
F
Francois Romieu 已提交
266 267
		_R("RTL8168f/8111f",	RTL_TD_1, FIRMWARE_8168F_1,
							JUMBO_9K, false),
268
	[RTL_GIGA_MAC_VER_36] =
F
Francois Romieu 已提交
269 270
		_R("RTL8168f/8111f",	RTL_TD_1, FIRMWARE_8168F_2,
							JUMBO_9K, false),
271 272 273
	[RTL_GIGA_MAC_VER_37] =
		_R("RTL8402",		RTL_TD_1, FIRMWARE_8402_1,
							JUMBO_1K, true),
274 275 276
	[RTL_GIGA_MAC_VER_38] =
		_R("RTL8411",		RTL_TD_1, FIRMWARE_8411_1,
							JUMBO_9K, false),
H
Hayes Wang 已提交
277 278 279
	[RTL_GIGA_MAC_VER_39] =
		_R("RTL8106e",		RTL_TD_1, FIRMWARE_8106E_1,
							JUMBO_1K, true),
H
Hayes Wang 已提交
280
	[RTL_GIGA_MAC_VER_40] =
281
		_R("RTL8168g/8111g",	RTL_TD_1, FIRMWARE_8168G_2,
H
Hayes Wang 已提交
282 283 284
							JUMBO_9K, false),
	[RTL_GIGA_MAC_VER_41] =
		_R("RTL8168g/8111g",	RTL_TD_1, NULL, JUMBO_9K, false),
H
hayeswang 已提交
285 286 287
	[RTL_GIGA_MAC_VER_42] =
		_R("RTL8168g/8111g",	RTL_TD_1, FIRMWARE_8168G_3,
							JUMBO_9K, false),
H
hayeswang 已提交
288 289 290
	[RTL_GIGA_MAC_VER_43] =
		_R("RTL8106e",		RTL_TD_1, FIRMWARE_8106E_2,
							JUMBO_1K, true),
H
hayeswang 已提交
291 292 293
	[RTL_GIGA_MAC_VER_44] =
		_R("RTL8411",		RTL_TD_1, FIRMWARE_8411_2,
							JUMBO_9K, false),
294 295 296 297 298 299 300 301 302 303 304 305
	[RTL_GIGA_MAC_VER_45] =
		_R("RTL8168h/8111h",	RTL_TD_1, FIRMWARE_8168H_1,
							JUMBO_9K, false),
	[RTL_GIGA_MAC_VER_46] =
		_R("RTL8168h/8111h",	RTL_TD_1, FIRMWARE_8168H_2,
							JUMBO_9K, false),
	[RTL_GIGA_MAC_VER_47] =
		_R("RTL8107e",		RTL_TD_1, FIRMWARE_8107E_1,
							JUMBO_1K, false),
	[RTL_GIGA_MAC_VER_48] =
		_R("RTL8107e",		RTL_TD_1, FIRMWARE_8107E_2,
							JUMBO_1K, false),
C
Chun-Hao Lin 已提交
306 307 308 309 310 311 312 313 314
	[RTL_GIGA_MAC_VER_49] =
		_R("RTL8168ep/8111ep",	RTL_TD_1, NULL,
							JUMBO_9K, false),
	[RTL_GIGA_MAC_VER_50] =
		_R("RTL8168ep/8111ep",	RTL_TD_1, NULL,
							JUMBO_9K, false),
	[RTL_GIGA_MAC_VER_51] =
		_R("RTL8168ep/8111ep",	RTL_TD_1, NULL,
							JUMBO_9K, false),
315
};
316
#undef _R
317

318 319 320 321 322 323
enum cfg_version {
	RTL_CFG_0 = 0x00,
	RTL_CFG_1,
	RTL_CFG_2
};

324
static const struct pci_device_id rtl8169_pci_tbl[] = {
325
	{ PCI_DEVICE(PCI_VENDOR_ID_REALTEK,	0x8129), 0, 0, RTL_CFG_0 },
326
	{ PCI_DEVICE(PCI_VENDOR_ID_REALTEK,	0x8136), 0, 0, RTL_CFG_2 },
327
	{ PCI_DEVICE(PCI_VENDOR_ID_REALTEK,	0x8161), 0, 0, RTL_CFG_1 },
328
	{ PCI_DEVICE(PCI_VENDOR_ID_REALTEK,	0x8167), 0, 0, RTL_CFG_0 },
329
	{ PCI_DEVICE(PCI_VENDOR_ID_REALTEK,	0x8168), 0, 0, RTL_CFG_1 },
330
	{ PCI_DEVICE(PCI_VENDOR_ID_REALTEK,	0x8169), 0, 0, RTL_CFG_0 },
331 332
	{ PCI_VENDOR_ID_DLINK,			0x4300,
		PCI_VENDOR_ID_DLINK, 0x4b10,		 0, 0, RTL_CFG_1 },
333
	{ PCI_DEVICE(PCI_VENDOR_ID_DLINK,	0x4300), 0, 0, RTL_CFG_0 },
334
	{ PCI_DEVICE(PCI_VENDOR_ID_DLINK,	0x4302), 0, 0, RTL_CFG_0 },
335
	{ PCI_DEVICE(PCI_VENDOR_ID_AT,		0xc107), 0, 0, RTL_CFG_0 },
336 337 338
	{ PCI_DEVICE(0x16ec,			0x0116), 0, 0, RTL_CFG_0 },
	{ PCI_VENDOR_ID_LINKSYS,		0x1032,
		PCI_ANY_ID, 0x0024, 0, 0, RTL_CFG_0 },
339 340
	{ 0x0001,				0x8168,
		PCI_ANY_ID, 0x2410, 0, 0, RTL_CFG_2 },
L
Linus Torvalds 已提交
341 342 343 344 345
	{0,},
};

MODULE_DEVICE_TABLE(pci, rtl8169_pci_tbl);

E
Eric Dumazet 已提交
346
static int rx_buf_sz = 16383;
347
static int use_dac = -1;
348 349 350
static struct {
	u32 msg_enable;
} debug = { -1 };
L
Linus Torvalds 已提交
351

F
Francois Romieu 已提交
352 353
enum rtl_registers {
	MAC0		= 0,	/* Ethernet hardware address. */
354
	MAC4		= 4,
F
Francois Romieu 已提交
355 356 357 358 359 360 361 362 363 364 365 366 367
	MAR0		= 8,	/* Multicast filter. */
	CounterAddrLow		= 0x10,
	CounterAddrHigh		= 0x14,
	TxDescStartAddrLow	= 0x20,
	TxDescStartAddrHigh	= 0x24,
	TxHDescStartAddrLow	= 0x28,
	TxHDescStartAddrHigh	= 0x2c,
	FLASH		= 0x30,
	ERSR		= 0x36,
	ChipCmd		= 0x37,
	TxPoll		= 0x38,
	IntrMask	= 0x3c,
	IntrStatus	= 0x3e,
H
Hayes Wang 已提交
368

F
Francois Romieu 已提交
369
	TxConfig	= 0x40,
H
Hayes Wang 已提交
370 371
#define	TXCFG_AUTO_FIFO			(1 << 7)	/* 8111e-vl */
#define	TXCFG_EMPTY			(1 << 11)	/* 8111e-vl */
F
Francois Romieu 已提交
372

H
Hayes Wang 已提交
373 374 375 376 377 378
	RxConfig	= 0x44,
#define	RX128_INT_EN			(1 << 15)	/* 8111c and later */
#define	RX_MULTI_EN			(1 << 14)	/* 8111c only */
#define	RXCFG_FIFO_SHIFT		13
					/* No threshold before first PCI xfer */
#define	RX_FIFO_THRESH			(7 << RXCFG_FIFO_SHIFT)
379
#define	RX_EARLY_OFF			(1 << 11)
H
Hayes Wang 已提交
380 381 382
#define	RXCFG_DMA_SHIFT			8
					/* Unlimited maximum PCI burst. */
#define	RX_DMA_BURST			(7 << RXCFG_DMA_SHIFT)
F
Francois Romieu 已提交
383

F
Francois Romieu 已提交
384 385 386 387 388
	RxMissed	= 0x4c,
	Cfg9346		= 0x50,
	Config0		= 0x51,
	Config1		= 0x52,
	Config2		= 0x53,
389 390
#define PME_SIGNAL			(1 << 5)	/* 8168c and later */

F
Francois Romieu 已提交
391 392 393 394 395 396 397 398 399
	Config3		= 0x54,
	Config4		= 0x55,
	Config5		= 0x56,
	MultiIntr	= 0x5c,
	PHYAR		= 0x60,
	PHYstatus	= 0x6c,
	RxMaxSize	= 0xda,
	CPlusCmd	= 0xe0,
	IntrMitigate	= 0xe2,
400 401 402 403 404 405

#define RTL_COALESCE_MASK	0x0f
#define RTL_COALESCE_SHIFT	4
#define RTL_COALESCE_T_MAX	(RTL_COALESCE_MASK)
#define RTL_COALESCE_FRAME_MAX	(RTL_COALESCE_MASK << 2)

F
Francois Romieu 已提交
406 407
	RxDescAddrLow	= 0xe4,
	RxDescAddrHigh	= 0xe8,
408 409 410 411 412 413 414
	EarlyTxThres	= 0xec,	/* 8169. Unit of 32 bytes. */

#define NoEarlyTx	0x3f	/* Max value : no early transmit. */

	MaxTxPacketSize	= 0xec,	/* 8101/8168. Unit of 128 bytes. */

#define TxPacketMax	(8064 >> 7)
415
#define EarlySize	0x27
416

F
Francois Romieu 已提交
417 418 419
	FuncEvent	= 0xf0,
	FuncEventMask	= 0xf4,
	FuncPresetState	= 0xf8,
C
Chun-Hao Lin 已提交
420 421 422 423
	IBCR0           = 0xf8,
	IBCR2           = 0xf9,
	IBIMR0          = 0xfa,
	IBISR0          = 0xfb,
F
Francois Romieu 已提交
424
	FuncForceEvent	= 0xfc,
L
Linus Torvalds 已提交
425 426
};

427 428 429 430 431 432 433 434 435 436 437 438 439 440
enum rtl8110_registers {
	TBICSR			= 0x64,
	TBI_ANAR		= 0x68,
	TBI_LPAR		= 0x6a,
};

enum rtl8168_8101_registers {
	CSIDR			= 0x64,
	CSIAR			= 0x68,
#define	CSIAR_FLAG			0x80000000
#define	CSIAR_WRITE_CMD			0x80000000
#define	CSIAR_BYTE_ENABLE		0x0f
#define	CSIAR_BYTE_ENABLE_SHIFT		12
#define	CSIAR_ADDR_MASK			0x0fff
441 442 443
#define CSIAR_FUNC_CARD			0x00000000
#define CSIAR_FUNC_SDIO			0x00010000
#define CSIAR_FUNC_NIC			0x00020000
H
hayeswang 已提交
444
#define CSIAR_FUNC_NIC2			0x00010000
F
françois romieu 已提交
445
	PMCH			= 0x6f,
446 447 448 449 450 451
	EPHYAR			= 0x80,
#define	EPHYAR_FLAG			0x80000000
#define	EPHYAR_WRITE_CMD		0x80000000
#define	EPHYAR_REG_MASK			0x1f
#define	EPHYAR_REG_SHIFT		16
#define	EPHYAR_DATA_MASK		0xffff
452
	DLLPR			= 0xd0,
H
Hayes Wang 已提交
453
#define	PFM_EN				(1 << 6)
454
#define	TX_10M_PS_EN			(1 << 7)
455 456 457
	DBG_REG			= 0xd1,
#define	FIX_NAK_1			(1 << 4)
#define	FIX_NAK_2			(1 << 3)
458 459
	TWSI			= 0xd2,
	MCU			= 0xd3,
H
Hayes Wang 已提交
460
#define	NOW_IS_OOB			(1 << 7)
H
Hayes Wang 已提交
461 462 463
#define	TX_EMPTY			(1 << 5)
#define	RX_EMPTY			(1 << 4)
#define	RXTX_EMPTY			(TX_EMPTY | RX_EMPTY)
464 465
#define	EN_NDP				(1 << 3)
#define	EN_OOB_RESET			(1 << 2)
H
Hayes Wang 已提交
466
#define	LINK_LIST_RDY			(1 << 1)
467 468 469 470 471 472 473
	EFUSEAR			= 0xdc,
#define	EFUSEAR_FLAG			0x80000000
#define	EFUSEAR_WRITE_CMD		0x80000000
#define	EFUSEAR_READ_CMD		0x00000000
#define	EFUSEAR_REG_MASK		0x03ff
#define	EFUSEAR_REG_SHIFT		8
#define	EFUSEAR_DATA_MASK		0xff
474 475
	MISC_1			= 0xf2,
#define	PFM_D3COLD_EN			(1 << 6)
476 477
};

478
enum rtl8168_registers {
H
Hayes Wang 已提交
479 480
	LED_FREQ		= 0x1a,
	EEE_LED			= 0x1b,
F
françois romieu 已提交
481 482 483 484 485 486 487
	ERIDR			= 0x70,
	ERIAR			= 0x74,
#define ERIAR_FLAG			0x80000000
#define ERIAR_WRITE_CMD			0x80000000
#define ERIAR_READ_CMD			0x00000000
#define ERIAR_ADDR_BYTE_ALIGN		4
#define ERIAR_TYPE_SHIFT		16
H
Hayes Wang 已提交
488 489 490
#define ERIAR_EXGMAC			(0x00 << ERIAR_TYPE_SHIFT)
#define ERIAR_MSIX			(0x01 << ERIAR_TYPE_SHIFT)
#define ERIAR_ASF			(0x02 << ERIAR_TYPE_SHIFT)
C
Chun-Hao Lin 已提交
491
#define ERIAR_OOB			(0x02 << ERIAR_TYPE_SHIFT)
H
Hayes Wang 已提交
492 493 494
#define ERIAR_MASK_SHIFT		12
#define ERIAR_MASK_0001			(0x1 << ERIAR_MASK_SHIFT)
#define ERIAR_MASK_0011			(0x3 << ERIAR_MASK_SHIFT)
495
#define ERIAR_MASK_0100			(0x4 << ERIAR_MASK_SHIFT)
H
Hayes Wang 已提交
496
#define ERIAR_MASK_0101			(0x5 << ERIAR_MASK_SHIFT)
H
Hayes Wang 已提交
497
#define ERIAR_MASK_1111			(0xf << ERIAR_MASK_SHIFT)
498 499 500 501 502 503 504 505 506 507 508
	EPHY_RXER_NUM		= 0x7c,
	OCPDR			= 0xb0,	/* OCP GPHY access */
#define OCPDR_WRITE_CMD			0x80000000
#define OCPDR_READ_CMD			0x00000000
#define OCPDR_REG_MASK			0x7f
#define OCPDR_GPHY_REG_SHIFT		16
#define OCPDR_DATA_MASK			0xffff
	OCPAR			= 0xb4,
#define OCPAR_FLAG			0x80000000
#define OCPAR_GPHY_WRITE_CMD		0x8000f060
#define OCPAR_GPHY_READ_CMD		0x0000f060
H
Hayes Wang 已提交
509
	GPHY_OCP		= 0xb8,
H
hayeswang 已提交
510 511
	RDSAR1			= 0xd0,	/* 8168c only. Undocumented on 8168dp */
	MISC			= 0xf0,	/* 8168e only. */
F
Francois Romieu 已提交
512
#define TXPLA_RST			(1 << 29)
H
Hayes Wang 已提交
513
#define DISABLE_LAN_EN			(1 << 23) /* Enable GPIO pin */
H
Hayes Wang 已提交
514
#define PWM_EN				(1 << 22)
H
Hayes Wang 已提交
515
#define RXDV_GATED_EN			(1 << 19)
H
Hayes Wang 已提交
516
#define EARLY_TALLY_EN			(1 << 16)
517 518
};

F
Francois Romieu 已提交
519
enum rtl_register_content {
L
Linus Torvalds 已提交
520
	/* InterruptStatusBits */
F
Francois Romieu 已提交
521 522 523 524 525 526 527 528 529 530 531
	SYSErr		= 0x8000,
	PCSTimeout	= 0x4000,
	SWInt		= 0x0100,
	TxDescUnavail	= 0x0080,
	RxFIFOOver	= 0x0040,
	LinkChg		= 0x0020,
	RxOverflow	= 0x0010,
	TxErr		= 0x0008,
	TxOK		= 0x0004,
	RxErr		= 0x0002,
	RxOK		= 0x0001,
L
Linus Torvalds 已提交
532 533

	/* RxStatusDesc */
534
	RxBOVF	= (1 << 24),
535 536 537 538 539
	RxFOVF	= (1 << 23),
	RxRWT	= (1 << 22),
	RxRES	= (1 << 21),
	RxRUNT	= (1 << 20),
	RxCRC	= (1 << 19),
L
Linus Torvalds 已提交
540 541

	/* ChipCmdBits */
H
Hayes Wang 已提交
542
	StopReq		= 0x80,
F
Francois Romieu 已提交
543 544 545 546
	CmdReset	= 0x10,
	CmdRxEnb	= 0x08,
	CmdTxEnb	= 0x04,
	RxBufEmpty	= 0x01,
L
Linus Torvalds 已提交
547

548 549 550 551 552
	/* TXPoll register p.5 */
	HPQ		= 0x80,		/* Poll cmd on the high prio queue */
	NPQ		= 0x40,		/* Poll cmd on the low prio queue */
	FSWInt		= 0x01,		/* Forced software interrupt */

L
Linus Torvalds 已提交
553
	/* Cfg9346Bits */
F
Francois Romieu 已提交
554 555
	Cfg9346_Lock	= 0x00,
	Cfg9346_Unlock	= 0xc0,
L
Linus Torvalds 已提交
556 557

	/* rx_mode_bits */
F
Francois Romieu 已提交
558 559 560 561 562 563
	AcceptErr	= 0x20,
	AcceptRunt	= 0x10,
	AcceptBroadcast	= 0x08,
	AcceptMulticast	= 0x04,
	AcceptMyPhys	= 0x02,
	AcceptAllPhys	= 0x01,
564
#define RX_CONFIG_ACCEPT_MASK		0x3f
L
Linus Torvalds 已提交
565 566 567 568 569

	/* TxConfigBits */
	TxInterFrameGapShift = 24,
	TxDMAShift = 8,	/* DMA burst value (0-7) is shift this many bits */

570
	/* Config1 register p.24 */
571 572 573 574 575 576
	LEDS1		= (1 << 7),
	LEDS0		= (1 << 6),
	Speed_down	= (1 << 4),
	MEMMAP		= (1 << 3),
	IOMAP		= (1 << 2),
	VPD		= (1 << 1),
577 578
	PMEnable	= (1 << 0),	/* Power Management Enable */

579
	/* Config2 register p. 25 */
H
hayeswang 已提交
580
	ClkReqEn	= (1 << 7),	/* Clock Request Enable */
581
	MSIEnable	= (1 << 5),	/* 8169 only. Reserved in the 8168. */
582 583 584
	PCI_Clock_66MHz = 0x01,
	PCI_Clock_33MHz = 0x00,

F
Francois Romieu 已提交
585 586 587
	/* Config3 register p.25 */
	MagicPacket	= (1 << 5),	/* Wake up when receives a Magic Packet */
	LinkUp		= (1 << 4),	/* Wake up when the cable connection is re-established */
F
Francois Romieu 已提交
588
	Jumbo_En0	= (1 << 2),	/* 8168 only. Reserved in the 8168b */
H
hayeswang 已提交
589
	Rdy_to_L23	= (1 << 1),	/* L23 Enable */
590
	Beacon_en	= (1 << 0),	/* 8168 only. Reserved in the 8168b */
F
Francois Romieu 已提交
591

F
Francois Romieu 已提交
592 593 594
	/* Config4 register */
	Jumbo_En1	= (1 << 1),	/* 8168 only. Reserved in the 8168b */

595
	/* Config5 register p.27 */
F
Francois Romieu 已提交
596 597 598
	BWF		= (1 << 6),	/* Accept Broadcast wakeup frame */
	MWF		= (1 << 5),	/* Accept Multicast wakeup frame */
	UWF		= (1 << 4),	/* Accept Unicast wakeup frame */
F
Francois Romieu 已提交
599
	Spi_en		= (1 << 3),
F
Francois Romieu 已提交
600
	LanWake		= (1 << 1),	/* LanWake enable/disable */
601
	PMEStatus	= (1 << 0),	/* PME status can be reset by PCI RST# */
H
hayeswang 已提交
602
	ASPM_en		= (1 << 0),	/* ASPM enable */
603

L
Linus Torvalds 已提交
604 605 606 607 608 609 610 611 612
	/* TBICSR p.28 */
	TBIReset	= 0x80000000,
	TBILoopback	= 0x40000000,
	TBINwEnable	= 0x20000000,
	TBINwRestart	= 0x10000000,
	TBILinkOk	= 0x02000000,
	TBINwComplete	= 0x01000000,

	/* CPlusCmd p.31 */
613 614 615 616 617 618 619 620 621 622
	EnableBist	= (1 << 15),	// 8168 8101
	Mac_dbgo_oe	= (1 << 14),	// 8168 8101
	Normal_mode	= (1 << 13),	// unused
	Force_half_dup	= (1 << 12),	// 8168 8101
	Force_rxflow_en	= (1 << 11),	// 8168 8101
	Force_txflow_en	= (1 << 10),	// 8168 8101
	Cxpl_dbg_sel	= (1 << 9),	// 8168 8101
	ASF		= (1 << 8),	// 8168 8101
	PktCntrDisable	= (1 << 7),	// 8168 8101
	Mac_dbgo_sel	= 0x001c,	// 8168
L
Linus Torvalds 已提交
623 624 625 626
	RxVlan		= (1 << 6),
	RxChkSum	= (1 << 5),
	PCIDAC		= (1 << 4),
	PCIMulRW	= (1 << 3),
627 628 629 630
	INTT_0		= 0x0000,	// 8168
	INTT_1		= 0x0001,	// 8168
	INTT_2		= 0x0002,	// 8168
	INTT_3		= 0x0003,	// 8168
L
Linus Torvalds 已提交
631 632

	/* rtl8169_PHYstatus */
F
Francois Romieu 已提交
633 634 635 636 637 638 639 640
	TBI_Enable	= 0x80,
	TxFlowCtrl	= 0x40,
	RxFlowCtrl	= 0x20,
	_1000bpsF	= 0x10,
	_100bps		= 0x08,
	_10bps		= 0x04,
	LinkStatus	= 0x02,
	FullDup		= 0x01,
L
Linus Torvalds 已提交
641 642

	/* _TBICSRBit */
F
Francois Romieu 已提交
643
	TBILinkOK	= 0x02000000,
644

645 646 647
	/* ResetCounterCommand */
	CounterReset	= 0x1,

648
	/* DumpCounterCommand */
F
Francois Romieu 已提交
649
	CounterDump	= 0x8,
650 651 652

	/* magic enable v2 */
	MagicPacket_v2	= (1 << 16),	/* Wake up when receives a Magic Packet */
L
Linus Torvalds 已提交
653 654
};

F
Francois Romieu 已提交
655 656
enum rtl_desc_bit {
	/* First doubleword. */
L
Linus Torvalds 已提交
657 658 659 660
	DescOwn		= (1 << 31), /* Descriptor is owned by NIC */
	RingEnd		= (1 << 30), /* End of descriptor ring */
	FirstFrag	= (1 << 29), /* First segment of a packet */
	LastFrag	= (1 << 28), /* Final segment of a packet */
F
Francois Romieu 已提交
661 662 663 664 665 666 667
};

/* Generic case. */
enum rtl_tx_desc_bit {
	/* First doubleword. */
	TD_LSO		= (1 << 27),		/* Large Send Offload */
#define TD_MSS_MAX			0x07ffu	/* MSS value */
L
Linus Torvalds 已提交
668

F
Francois Romieu 已提交
669 670 671 672 673 674 675 676 677 678 679 680 681 682 683
	/* Second doubleword. */
	TxVlanTag	= (1 << 17),		/* Add VLAN tag */
};

/* 8169, 8168b and 810x except 8102e. */
enum rtl_tx_desc_bit_0 {
	/* First doubleword. */
#define TD0_MSS_SHIFT			16	/* MSS position (11 bits) */
	TD0_TCP_CS	= (1 << 16),		/* Calculate TCP/IP checksum */
	TD0_UDP_CS	= (1 << 17),		/* Calculate UDP/IP checksum */
	TD0_IP_CS	= (1 << 18),		/* Calculate IP checksum */
};

/* 8102e, 8168c and beyond. */
enum rtl_tx_desc_bit_1 {
H
hayeswang 已提交
684 685
	/* First doubleword. */
	TD1_GTSENV4	= (1 << 26),		/* Giant Send for IPv4 */
H
hayeswang 已提交
686
	TD1_GTSENV6	= (1 << 25),		/* Giant Send for IPv6 */
H
hayeswang 已提交
687
#define GTTCPHO_SHIFT			18
H
hayeswang 已提交
688
#define GTTCPHO_MAX			0x7fU
H
hayeswang 已提交
689

F
Francois Romieu 已提交
690
	/* Second doubleword. */
H
hayeswang 已提交
691 692
#define TCPHO_SHIFT			18
#define TCPHO_MAX			0x3ffU
F
Francois Romieu 已提交
693
#define TD1_MSS_SHIFT			18	/* MSS position (11 bits) */
H
hayeswang 已提交
694 695
	TD1_IPv6_CS	= (1 << 28),		/* Calculate IPv6 checksum */
	TD1_IPv4_CS	= (1 << 29),		/* Calculate IPv4 checksum */
F
Francois Romieu 已提交
696 697 698
	TD1_TCP_CS	= (1 << 30),		/* Calculate TCP/IP checksum */
	TD1_UDP_CS	= (1 << 31),		/* Calculate UDP/IP checksum */
};
L
Linus Torvalds 已提交
699

F
Francois Romieu 已提交
700
enum rtl_rx_desc_bit {
L
Linus Torvalds 已提交
701 702
	/* Rx private */
	PID1		= (1 << 18), /* Protocol ID bit 1/2 */
Z
Zhu Yanjun 已提交
703
	PID0		= (1 << 17), /* Protocol ID bit 0/2 */
L
Linus Torvalds 已提交
704 705 706 707 708 709 710 711 712 713 714 715 716 717 718

#define RxProtoUDP	(PID1)
#define RxProtoTCP	(PID0)
#define RxProtoIP	(PID1 | PID0)
#define RxProtoMask	RxProtoIP

	IPFail		= (1 << 16), /* IP checksum failed */
	UDPFail		= (1 << 15), /* UDP/IP checksum failed */
	TCPFail		= (1 << 14), /* TCP/IP checksum failed */
	RxVlanTag	= (1 << 16), /* VLAN tag available */
};

#define RsvdMask	0x3fffc000

struct TxDesc {
719 720 721
	__le32 opts1;
	__le32 opts2;
	__le64 addr;
L
Linus Torvalds 已提交
722 723 724
};

struct RxDesc {
725 726 727
	__le32 opts1;
	__le32 opts2;
	__le64 addr;
L
Linus Torvalds 已提交
728 729 730 731 732 733 734 735
};

struct ring_info {
	struct sk_buff	*skb;
	u32		len;
	u8		__pad[sizeof(void *) - sizeof(u32)];
};

736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751
struct rtl8169_counters {
	__le64	tx_packets;
	__le64	rx_packets;
	__le64	tx_errors;
	__le32	rx_errors;
	__le16	rx_missed;
	__le16	align_errors;
	__le32	tx_one_collision;
	__le32	tx_multi_collision;
	__le64	rx_unicast;
	__le64	rx_broadcast;
	__le32	rx_multicast;
	__le16	tx_aborted;
	__le16	tx_underun;
};

752 753 754 755 756 757 758
struct rtl8169_tc_offsets {
	bool	inited;
	__le64	tx_errors;
	__le32	tx_multi_collision;
	__le16	tx_aborted;
};

759
enum rtl_flag {
760
	RTL_FLAG_TASK_ENABLED,
761 762 763 764 765 766
	RTL_FLAG_TASK_SLOW_PENDING,
	RTL_FLAG_TASK_RESET_PENDING,
	RTL_FLAG_TASK_PHY_PENDING,
	RTL_FLAG_MAX
};

J
Junchang Wang 已提交
767 768 769 770 771 772
struct rtl8169_stats {
	u64			packets;
	u64			bytes;
	struct u64_stats_sync	syncp;
};

L
Linus Torvalds 已提交
773 774
struct rtl8169_private {
	void __iomem *mmio_addr;	/* memory map physical address */
F
Francois Romieu 已提交
775
	struct pci_dev *pci_dev;
D
David Howells 已提交
776
	struct net_device *dev;
777
	struct napi_struct napi;
778
	u32 msg_enable;
F
Francois Romieu 已提交
779 780
	u16 txd_version;
	u16 mac_version;
L
Linus Torvalds 已提交
781 782 783
	u32 cur_rx; /* Index into the Rx descriptor buffer of next Rx pkt. */
	u32 cur_tx; /* Index into the Tx descriptor buffer of next Rx pkt. */
	u32 dirty_tx;
J
Junchang Wang 已提交
784 785
	struct rtl8169_stats rx_stats;
	struct rtl8169_stats tx_stats;
L
Linus Torvalds 已提交
786 787 788 789
	struct TxDesc *TxDescArray;	/* 256-aligned Tx descriptor ring */
	struct RxDesc *RxDescArray;	/* 256-aligned Rx descriptor ring */
	dma_addr_t TxPhyAddr;
	dma_addr_t RxPhyAddr;
E
Eric Dumazet 已提交
790
	void *Rx_databuff[NUM_RX_DESC];	/* Rx data buffers */
L
Linus Torvalds 已提交
791 792 793
	struct ring_info tx_skb[NUM_TX_DESC];	/* Tx data buffers */
	struct timer_list timer;
	u16 cp_cmd;
794 795

	u16 event_slow;
796
	const struct rtl_coalesce_info *coalesce_info;
797 798

	struct mdio_ops {
799 800
		void (*write)(struct rtl8169_private *, int, int);
		int (*read)(struct rtl8169_private *, int);
801 802
	} mdio_ops;

F
françois romieu 已提交
803 804 805 806 807
	struct pll_power_ops {
		void (*down)(struct rtl8169_private *);
		void (*up)(struct rtl8169_private *);
	} pll_power_ops;

F
Francois Romieu 已提交
808 809 810 811 812
	struct jumbo_ops {
		void (*enable)(struct rtl8169_private *);
		void (*disable)(struct rtl8169_private *);
	} jumbo_ops;

813
	struct csi_ops {
814 815
		void (*write)(struct rtl8169_private *, int, int);
		u32 (*read)(struct rtl8169_private *, int);
816 817
	} csi_ops;

818
	int (*set_speed)(struct net_device *, u8 aneg, u16 sp, u8 dpx, u32 adv);
819 820
	int (*get_link_ksettings)(struct net_device *,
				  struct ethtool_link_ksettings *);
821
	void (*phy_reset_enable)(struct rtl8169_private *tp);
822
	void (*hw_start)(struct net_device *);
823
	unsigned int (*phy_reset_pending)(struct rtl8169_private *tp);
824
	unsigned int (*link_ok)(struct rtl8169_private *tp);
F
Francois Romieu 已提交
825
	int (*do_ioctl)(struct rtl8169_private *tp, struct mii_ioctl_data *data, int cmd);
H
hayeswang 已提交
826
	bool (*tso_csum)(struct rtl8169_private *, struct sk_buff *, u32 *);
827 828

	struct {
829 830
		DECLARE_BITMAP(flags, RTL_FLAG_MAX);
		struct mutex mutex;
831 832 833
		struct work_struct work;
	} wk;

834
	struct mii_if_info mii;
835 836
	dma_addr_t counters_phys_addr;
	struct rtl8169_counters *counters;
837
	struct rtl8169_tc_offsets tc_offset;
838
	u32 saved_wolopts;
839
	u32 opts1_mask;
840

841 842
	struct rtl_fw {
		const struct firmware *fw;
843 844 845 846 847 848 849 850 851

#define RTL_VER_SIZE		32

		char version[RTL_VER_SIZE];

		struct rtl_fw_phy_action {
			__le32 *code;
			size_t size;
		} phy_action;
852
	} *rtl_fw;
853
#define RTL_FIRMWARE_UNKNOWN	ERR_PTR(-EAGAIN)
H
Hayes Wang 已提交
854 855

	u32 ocp_base;
L
Linus Torvalds 已提交
856 857
};

858
MODULE_AUTHOR("Realtek and the Linux r8169 crew <netdev@vger.kernel.org>");
L
Linus Torvalds 已提交
859 860
MODULE_DESCRIPTION("RealTek RTL-8169 Gigabit Ethernet driver");
module_param(use_dac, int, 0);
861
MODULE_PARM_DESC(use_dac, "Enable PCI DAC. Unsafe on 32 bit PCI slot.");
862 863
module_param_named(debug, debug.msg_enable, int, 0);
MODULE_PARM_DESC(debug, "Debug verbosity level (0=none, ..., 16=all)");
L
Linus Torvalds 已提交
864 865
MODULE_LICENSE("GPL");
MODULE_VERSION(RTL8169_VERSION);
866 867
MODULE_FIRMWARE(FIRMWARE_8168D_1);
MODULE_FIRMWARE(FIRMWARE_8168D_2);
H
hayeswang 已提交
868 869
MODULE_FIRMWARE(FIRMWARE_8168E_1);
MODULE_FIRMWARE(FIRMWARE_8168E_2);
870
MODULE_FIRMWARE(FIRMWARE_8168E_3);
871
MODULE_FIRMWARE(FIRMWARE_8105E_1);
872 873
MODULE_FIRMWARE(FIRMWARE_8168F_1);
MODULE_FIRMWARE(FIRMWARE_8168F_2);
874
MODULE_FIRMWARE(FIRMWARE_8402_1);
875
MODULE_FIRMWARE(FIRMWARE_8411_1);
H
hayeswang 已提交
876
MODULE_FIRMWARE(FIRMWARE_8411_2);
H
Hayes Wang 已提交
877
MODULE_FIRMWARE(FIRMWARE_8106E_1);
H
hayeswang 已提交
878
MODULE_FIRMWARE(FIRMWARE_8106E_2);
879
MODULE_FIRMWARE(FIRMWARE_8168G_2);
H
hayeswang 已提交
880
MODULE_FIRMWARE(FIRMWARE_8168G_3);
881 882
MODULE_FIRMWARE(FIRMWARE_8168H_1);
MODULE_FIRMWARE(FIRMWARE_8168H_2);
883 884
MODULE_FIRMWARE(FIRMWARE_8107E_1);
MODULE_FIRMWARE(FIRMWARE_8107E_2);
L
Linus Torvalds 已提交
885

H
Heiner Kallweit 已提交
886 887 888 889 890
static inline struct device *tp_to_dev(struct rtl8169_private *tp)
{
	return &tp->pci_dev->dev;
}

891 892 893 894 895 896 897 898 899 900
static void rtl_lock_work(struct rtl8169_private *tp)
{
	mutex_lock(&tp->wk.mutex);
}

static void rtl_unlock_work(struct rtl8169_private *tp)
{
	mutex_unlock(&tp->wk.mutex);
}

901
static void rtl_tx_performance_tweak(struct rtl8169_private *tp, u16 force)
F
Francois Romieu 已提交
902
{
903
	pcie_capability_clear_and_set_word(tp->pci_dev, PCI_EXP_DEVCTL,
904
					   PCI_EXP_DEVCTL_READRQ, force);
F
Francois Romieu 已提交
905 906
}

907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927
struct rtl_cond {
	bool (*check)(struct rtl8169_private *);
	const char *msg;
};

static void rtl_udelay(unsigned int d)
{
	udelay(d);
}

static bool rtl_loop_wait(struct rtl8169_private *tp, const struct rtl_cond *c,
			  void (*delay)(unsigned int), unsigned int d, int n,
			  bool high)
{
	int i;

	for (i = 0; i < n; i++) {
		delay(d);
		if (c->check(tp) == high)
			return true;
	}
F
Francois Romieu 已提交
928 929
	netif_err(tp, drv, tp->dev, "%s == %d (loop: %d, delay: %d).\n",
		  c->msg, !high, n, d);
930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970
	return false;
}

static bool rtl_udelay_loop_wait_high(struct rtl8169_private *tp,
				      const struct rtl_cond *c,
				      unsigned int d, int n)
{
	return rtl_loop_wait(tp, c, rtl_udelay, d, n, true);
}

static bool rtl_udelay_loop_wait_low(struct rtl8169_private *tp,
				     const struct rtl_cond *c,
				     unsigned int d, int n)
{
	return rtl_loop_wait(tp, c, rtl_udelay, d, n, false);
}

static bool rtl_msleep_loop_wait_high(struct rtl8169_private *tp,
				      const struct rtl_cond *c,
				      unsigned int d, int n)
{
	return rtl_loop_wait(tp, c, msleep, d, n, true);
}

static bool rtl_msleep_loop_wait_low(struct rtl8169_private *tp,
				     const struct rtl_cond *c,
				     unsigned int d, int n)
{
	return rtl_loop_wait(tp, c, msleep, d, n, false);
}

#define DECLARE_RTL_COND(name)				\
static bool name ## _check(struct rtl8169_private *);	\
							\
static const struct rtl_cond name = {			\
	.check	= name ## _check,			\
	.msg	= #name					\
};							\
							\
static bool name ## _check(struct rtl8169_private *tp)

H
Hayes Wang 已提交
971 972 973 974 975 976 977 978 979 980 981
static bool rtl_ocp_reg_failure(struct rtl8169_private *tp, u32 reg)
{
	if (reg & 0xffff0001) {
		netif_err(tp, drv, tp->dev, "Invalid ocp reg %x!\n", reg);
		return true;
	}
	return false;
}

DECLARE_RTL_COND(rtl_ocp_gphy_cond)
{
982
	return RTL_R32(tp, GPHY_OCP) & OCPAR_FLAG;
H
Hayes Wang 已提交
983 984 985 986 987 988 989
}

static void r8168_phy_ocp_write(struct rtl8169_private *tp, u32 reg, u32 data)
{
	if (rtl_ocp_reg_failure(tp, reg))
		return;

990
	RTL_W32(tp, GPHY_OCP, OCPAR_FLAG | (reg << 15) | data);
H
Hayes Wang 已提交
991 992 993 994 995 996 997 998 999

	rtl_udelay_loop_wait_low(tp, &rtl_ocp_gphy_cond, 25, 10);
}

static u16 r8168_phy_ocp_read(struct rtl8169_private *tp, u32 reg)
{
	if (rtl_ocp_reg_failure(tp, reg))
		return 0;

1000
	RTL_W32(tp, GPHY_OCP, reg << 15);
H
Hayes Wang 已提交
1001 1002

	return rtl_udelay_loop_wait_high(tp, &rtl_ocp_gphy_cond, 25, 10) ?
1003
		(RTL_R32(tp, GPHY_OCP) & 0xffff) : ~0;
H
Hayes Wang 已提交
1004 1005 1006 1007 1008 1009 1010
}

static void r8168_mac_ocp_write(struct rtl8169_private *tp, u32 reg, u32 data)
{
	if (rtl_ocp_reg_failure(tp, reg))
		return;

1011
	RTL_W32(tp, OCPDR, OCPAR_FLAG | (reg << 15) | data);
H
Hayes Wang 已提交
1012 1013 1014 1015 1016 1017 1018
}

static u16 r8168_mac_ocp_read(struct rtl8169_private *tp, u32 reg)
{
	if (rtl_ocp_reg_failure(tp, reg))
		return 0;

1019
	RTL_W32(tp, OCPDR, reg << 15);
H
Hayes Wang 已提交
1020

1021
	return RTL_R32(tp, OCPDR);
H
Hayes Wang 已提交
1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046
}

#define OCP_STD_PHY_BASE	0xa400

static void r8168g_mdio_write(struct rtl8169_private *tp, int reg, int value)
{
	if (reg == 0x1f) {
		tp->ocp_base = value ? value << 4 : OCP_STD_PHY_BASE;
		return;
	}

	if (tp->ocp_base != OCP_STD_PHY_BASE)
		reg -= 0x10;

	r8168_phy_ocp_write(tp, tp->ocp_base + reg * 2, value);
}

static int r8168g_mdio_read(struct rtl8169_private *tp, int reg)
{
	if (tp->ocp_base != OCP_STD_PHY_BASE)
		reg -= 0x10;

	return r8168_phy_ocp_read(tp, tp->ocp_base + reg * 2);
}

1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061
static void mac_mcu_write(struct rtl8169_private *tp, int reg, int value)
{
	if (reg == 0x1f) {
		tp->ocp_base = value << 4;
		return;
	}

	r8168_mac_ocp_write(tp, tp->ocp_base + reg, value);
}

static int mac_mcu_read(struct rtl8169_private *tp, int reg)
{
	return r8168_mac_ocp_read(tp, tp->ocp_base + reg);
}

1062 1063
DECLARE_RTL_COND(rtl_phyar_cond)
{
1064
	return RTL_R32(tp, PHYAR) & 0x80000000;
1065 1066
}

1067
static void r8169_mdio_write(struct rtl8169_private *tp, int reg, int value)
L
Linus Torvalds 已提交
1068
{
1069
	RTL_W32(tp, PHYAR, 0x80000000 | (reg & 0x1f) << 16 | (value & 0xffff));
L
Linus Torvalds 已提交
1070

1071
	rtl_udelay_loop_wait_low(tp, &rtl_phyar_cond, 25, 20);
1072
	/*
1073 1074
	 * According to hardware specs a 20us delay is required after write
	 * complete indication, but before sending next command.
1075
	 */
1076
	udelay(20);
L
Linus Torvalds 已提交
1077 1078
}

1079
static int r8169_mdio_read(struct rtl8169_private *tp, int reg)
L
Linus Torvalds 已提交
1080
{
1081
	int value;
L
Linus Torvalds 已提交
1082

1083
	RTL_W32(tp, PHYAR, 0x0 | (reg & 0x1f) << 16);
L
Linus Torvalds 已提交
1084

1085
	value = rtl_udelay_loop_wait_high(tp, &rtl_phyar_cond, 25, 20) ?
1086
		RTL_R32(tp, PHYAR) & 0xffff : ~0;
1087

1088 1089 1090 1091 1092 1093
	/*
	 * According to hardware specs a 20us delay is required after read
	 * complete indication, but before sending next command.
	 */
	udelay(20);

L
Linus Torvalds 已提交
1094 1095 1096
	return value;
}

C
Chun-Hao Lin 已提交
1097 1098
DECLARE_RTL_COND(rtl_ocpar_cond)
{
1099
	return RTL_R32(tp, OCPAR) & OCPAR_FLAG;
C
Chun-Hao Lin 已提交
1100 1101
}

1102
static void r8168dp_1_mdio_access(struct rtl8169_private *tp, int reg, u32 data)
1103
{
1104 1105 1106
	RTL_W32(tp, OCPDR, data | ((reg & OCPDR_REG_MASK) << OCPDR_GPHY_REG_SHIFT));
	RTL_W32(tp, OCPAR, OCPAR_GPHY_WRITE_CMD);
	RTL_W32(tp, EPHY_RXER_NUM, 0);
1107

1108
	rtl_udelay_loop_wait_low(tp, &rtl_ocpar_cond, 1000, 100);
1109 1110
}

1111
static void r8168dp_1_mdio_write(struct rtl8169_private *tp, int reg, int value)
1112
{
1113 1114
	r8168dp_1_mdio_access(tp, reg,
			      OCPDR_WRITE_CMD | (value & OCPDR_DATA_MASK));
1115 1116
}

1117
static int r8168dp_1_mdio_read(struct rtl8169_private *tp, int reg)
1118
{
1119
	r8168dp_1_mdio_access(tp, reg, OCPDR_READ_CMD);
1120 1121

	mdelay(1);
1122 1123
	RTL_W32(tp, OCPAR, OCPAR_GPHY_READ_CMD);
	RTL_W32(tp, EPHY_RXER_NUM, 0);
1124

1125
	return rtl_udelay_loop_wait_high(tp, &rtl_ocpar_cond, 1000, 100) ?
1126
		RTL_R32(tp, OCPDR) & OCPDR_DATA_MASK : ~0;
1127 1128
}

F
françois romieu 已提交
1129 1130
#define R8168DP_1_MDIO_ACCESS_BIT	0x00020000

1131
static void r8168dp_2_mdio_start(struct rtl8169_private *tp)
F
françois romieu 已提交
1132
{
1133
	RTL_W32(tp, 0xd0, RTL_R32(tp, 0xd0) & ~R8168DP_1_MDIO_ACCESS_BIT);
F
françois romieu 已提交
1134 1135
}

1136
static void r8168dp_2_mdio_stop(struct rtl8169_private *tp)
F
françois romieu 已提交
1137
{
1138
	RTL_W32(tp, 0xd0, RTL_R32(tp, 0xd0) | R8168DP_1_MDIO_ACCESS_BIT);
F
françois romieu 已提交
1139 1140
}

1141
static void r8168dp_2_mdio_write(struct rtl8169_private *tp, int reg, int value)
F
françois romieu 已提交
1142
{
1143
	r8168dp_2_mdio_start(tp);
F
françois romieu 已提交
1144

1145
	r8169_mdio_write(tp, reg, value);
F
françois romieu 已提交
1146

1147
	r8168dp_2_mdio_stop(tp);
F
françois romieu 已提交
1148 1149
}

1150
static int r8168dp_2_mdio_read(struct rtl8169_private *tp, int reg)
F
françois romieu 已提交
1151 1152 1153
{
	int value;

1154
	r8168dp_2_mdio_start(tp);
F
françois romieu 已提交
1155

1156
	value = r8169_mdio_read(tp, reg);
F
françois romieu 已提交
1157

1158
	r8168dp_2_mdio_stop(tp);
F
françois romieu 已提交
1159 1160 1161 1162

	return value;
}

1163
static void rtl_writephy(struct rtl8169_private *tp, int location, u32 val)
1164
{
1165
	tp->mdio_ops.write(tp, location, val);
1166 1167
}

1168 1169
static int rtl_readphy(struct rtl8169_private *tp, int location)
{
1170
	return tp->mdio_ops.read(tp, location);
1171 1172 1173 1174 1175 1176 1177
}

static void rtl_patchphy(struct rtl8169_private *tp, int reg_addr, int value)
{
	rtl_writephy(tp, reg_addr, rtl_readphy(tp, reg_addr) | value);
}

1178
static void rtl_w0w1_phy(struct rtl8169_private *tp, int reg_addr, int p, int m)
1179 1180 1181
{
	int val;

1182
	val = rtl_readphy(tp, reg_addr);
1183
	rtl_writephy(tp, reg_addr, (val & ~m) | p);
1184 1185
}

1186 1187 1188 1189 1190
static void rtl_mdio_write(struct net_device *dev, int phy_id, int location,
			   int val)
{
	struct rtl8169_private *tp = netdev_priv(dev);

1191
	rtl_writephy(tp, location, val);
1192 1193 1194 1195 1196 1197
}

static int rtl_mdio_read(struct net_device *dev, int phy_id, int location)
{
	struct rtl8169_private *tp = netdev_priv(dev);

1198
	return rtl_readphy(tp, location);
1199 1200
}

1201 1202
DECLARE_RTL_COND(rtl_ephyar_cond)
{
1203
	return RTL_R32(tp, EPHYAR) & EPHYAR_FLAG;
1204 1205
}

1206
static void rtl_ephy_write(struct rtl8169_private *tp, int reg_addr, int value)
1207
{
1208
	RTL_W32(tp, EPHYAR, EPHYAR_WRITE_CMD | (value & EPHYAR_DATA_MASK) |
1209 1210
		(reg_addr & EPHYAR_REG_MASK) << EPHYAR_REG_SHIFT);

1211 1212 1213
	rtl_udelay_loop_wait_low(tp, &rtl_ephyar_cond, 10, 100);

	udelay(10);
1214 1215
}

1216
static u16 rtl_ephy_read(struct rtl8169_private *tp, int reg_addr)
1217
{
1218
	RTL_W32(tp, EPHYAR, (reg_addr & EPHYAR_REG_MASK) << EPHYAR_REG_SHIFT);
1219

1220
	return rtl_udelay_loop_wait_high(tp, &rtl_ephyar_cond, 10, 100) ?
1221
		RTL_R32(tp, EPHYAR) & EPHYAR_DATA_MASK : ~0;
1222 1223
}

C
Chun-Hao Lin 已提交
1224 1225
DECLARE_RTL_COND(rtl_eriar_cond)
{
1226
	return RTL_R32(tp, ERIAR) & ERIAR_FLAG;
C
Chun-Hao Lin 已提交
1227 1228
}

1229 1230
static void rtl_eri_write(struct rtl8169_private *tp, int addr, u32 mask,
			  u32 val, int type)
H
Hayes Wang 已提交
1231 1232
{
	BUG_ON((addr & 3) || (mask == 0));
1233 1234
	RTL_W32(tp, ERIDR, val);
	RTL_W32(tp, ERIAR, ERIAR_WRITE_CMD | type | mask | addr);
H
Hayes Wang 已提交
1235

1236
	rtl_udelay_loop_wait_low(tp, &rtl_eriar_cond, 100, 100);
H
Hayes Wang 已提交
1237 1238
}

1239
static u32 rtl_eri_read(struct rtl8169_private *tp, int addr, int type)
H
Hayes Wang 已提交
1240
{
1241
	RTL_W32(tp, ERIAR, ERIAR_READ_CMD | type | ERIAR_MASK_1111 | addr);
H
Hayes Wang 已提交
1242

1243
	return rtl_udelay_loop_wait_high(tp, &rtl_eriar_cond, 100, 100) ?
1244
		RTL_R32(tp, ERIDR) : ~0;
H
Hayes Wang 已提交
1245 1246
}

1247
static void rtl_w0w1_eri(struct rtl8169_private *tp, int addr, u32 mask, u32 p,
1248
			 u32 m, int type)
H
Hayes Wang 已提交
1249 1250 1251
{
	u32 val;

1252 1253
	val = rtl_eri_read(tp, addr, type);
	rtl_eri_write(tp, addr, mask, (val & ~m) | p, type);
H
Hayes Wang 已提交
1254 1255
}

C
Chun-Hao Lin 已提交
1256 1257
static u32 r8168dp_ocp_read(struct rtl8169_private *tp, u8 mask, u16 reg)
{
1258
	RTL_W32(tp, OCPAR, ((u32)mask & 0x0f) << 12 | (reg & 0x0fff));
C
Chun-Hao Lin 已提交
1259
	return rtl_udelay_loop_wait_high(tp, &rtl_ocpar_cond, 100, 20) ?
1260
		RTL_R32(tp, OCPDR) : ~0;
C
Chun-Hao Lin 已提交
1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287
}

static u32 r8168ep_ocp_read(struct rtl8169_private *tp, u8 mask, u16 reg)
{
	return rtl_eri_read(tp, reg, ERIAR_OOB);
}

static u32 ocp_read(struct rtl8169_private *tp, u8 mask, u16 reg)
{
	switch (tp->mac_version) {
	case RTL_GIGA_MAC_VER_27:
	case RTL_GIGA_MAC_VER_28:
	case RTL_GIGA_MAC_VER_31:
		return r8168dp_ocp_read(tp, mask, reg);
	case RTL_GIGA_MAC_VER_49:
	case RTL_GIGA_MAC_VER_50:
	case RTL_GIGA_MAC_VER_51:
		return r8168ep_ocp_read(tp, mask, reg);
	default:
		BUG();
		return ~0;
	}
}

static void r8168dp_ocp_write(struct rtl8169_private *tp, u8 mask, u16 reg,
			      u32 data)
{
1288 1289
	RTL_W32(tp, OCPDR, data);
	RTL_W32(tp, OCPAR, OCPAR_FLAG | ((u32)mask & 0x0f) << 12 | (reg & 0x0fff));
C
Chun-Hao Lin 已提交
1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318
	rtl_udelay_loop_wait_low(tp, &rtl_ocpar_cond, 100, 20);
}

static void r8168ep_ocp_write(struct rtl8169_private *tp, u8 mask, u16 reg,
			      u32 data)
{
	rtl_eri_write(tp, reg, ((u32)mask & 0x0f) << ERIAR_MASK_SHIFT,
		      data, ERIAR_OOB);
}

static void ocp_write(struct rtl8169_private *tp, u8 mask, u16 reg, u32 data)
{
	switch (tp->mac_version) {
	case RTL_GIGA_MAC_VER_27:
	case RTL_GIGA_MAC_VER_28:
	case RTL_GIGA_MAC_VER_31:
		r8168dp_ocp_write(tp, mask, reg, data);
		break;
	case RTL_GIGA_MAC_VER_49:
	case RTL_GIGA_MAC_VER_50:
	case RTL_GIGA_MAC_VER_51:
		r8168ep_ocp_write(tp, mask, reg, data);
		break;
	default:
		BUG();
		break;
	}
}

1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343
static void rtl8168_oob_notify(struct rtl8169_private *tp, u8 cmd)
{
	rtl_eri_write(tp, 0xe8, ERIAR_MASK_0001, cmd, ERIAR_EXGMAC);

	ocp_write(tp, 0x1, 0x30, 0x00000001);
}

#define OOB_CMD_RESET		0x00
#define OOB_CMD_DRIVER_START	0x05
#define OOB_CMD_DRIVER_STOP	0x06

static u16 rtl8168_get_ocp_reg(struct rtl8169_private *tp)
{
	return (tp->mac_version == RTL_GIGA_MAC_VER_31) ? 0xb8 : 0x10;
}

DECLARE_RTL_COND(rtl_ocp_read_cond)
{
	u16 reg;

	reg = rtl8168_get_ocp_reg(tp);

	return ocp_read(tp, 0x0f, reg) & 0x00000800;
}

C
Chun-Hao Lin 已提交
1344
DECLARE_RTL_COND(rtl_ep_ocp_read_cond)
1345
{
C
Chun-Hao Lin 已提交
1346 1347 1348 1349 1350
	return ocp_read(tp, 0x0f, 0x124) & 0x00000001;
}

DECLARE_RTL_COND(rtl_ocp_tx_cond)
{
1351
	return RTL_R8(tp, IBISR0) & 0x20;
C
Chun-Hao Lin 已提交
1352
}
1353

C
Chun-Hao Lin 已提交
1354 1355
static void rtl8168ep_stop_cmac(struct rtl8169_private *tp)
{
1356
	RTL_W8(tp, IBCR2, RTL_R8(tp, IBCR2) & ~0x01);
1357
	rtl_msleep_loop_wait_high(tp, &rtl_ocp_tx_cond, 50, 2000);
1358 1359
	RTL_W8(tp, IBISR0, RTL_R8(tp, IBISR0) | 0x20);
	RTL_W8(tp, IBCR0, RTL_R8(tp, IBCR0) & ~0x01);
C
Chun-Hao Lin 已提交
1360 1361
}

C
Chun-Hao Lin 已提交
1362 1363 1364
static void rtl8168dp_driver_start(struct rtl8169_private *tp)
{
	rtl8168_oob_notify(tp, OOB_CMD_DRIVER_START);
1365 1366 1367
	rtl_msleep_loop_wait_high(tp, &rtl_ocp_read_cond, 10, 10);
}

C
Chun-Hao Lin 已提交
1368
static void rtl8168ep_driver_start(struct rtl8169_private *tp)
1369
{
C
Chun-Hao Lin 已提交
1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392
	ocp_write(tp, 0x01, 0x180, OOB_CMD_DRIVER_START);
	ocp_write(tp, 0x01, 0x30, ocp_read(tp, 0x01, 0x30) | 0x01);
	rtl_msleep_loop_wait_high(tp, &rtl_ep_ocp_read_cond, 10, 10);
}

static void rtl8168_driver_start(struct rtl8169_private *tp)
{
	switch (tp->mac_version) {
	case RTL_GIGA_MAC_VER_27:
	case RTL_GIGA_MAC_VER_28:
	case RTL_GIGA_MAC_VER_31:
		rtl8168dp_driver_start(tp);
		break;
	case RTL_GIGA_MAC_VER_49:
	case RTL_GIGA_MAC_VER_50:
	case RTL_GIGA_MAC_VER_51:
		rtl8168ep_driver_start(tp);
		break;
	default:
		BUG();
		break;
	}
}
1393

C
Chun-Hao Lin 已提交
1394 1395 1396
static void rtl8168dp_driver_stop(struct rtl8169_private *tp)
{
	rtl8168_oob_notify(tp, OOB_CMD_DRIVER_STOP);
1397 1398 1399
	rtl_msleep_loop_wait_low(tp, &rtl_ocp_read_cond, 10, 10);
}

C
Chun-Hao Lin 已提交
1400 1401
static void rtl8168ep_driver_stop(struct rtl8169_private *tp)
{
C
Chun-Hao Lin 已提交
1402
	rtl8168ep_stop_cmac(tp);
C
Chun-Hao Lin 已提交
1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426
	ocp_write(tp, 0x01, 0x180, OOB_CMD_DRIVER_STOP);
	ocp_write(tp, 0x01, 0x30, ocp_read(tp, 0x01, 0x30) | 0x01);
	rtl_msleep_loop_wait_low(tp, &rtl_ep_ocp_read_cond, 10, 10);
}

static void rtl8168_driver_stop(struct rtl8169_private *tp)
{
	switch (tp->mac_version) {
	case RTL_GIGA_MAC_VER_27:
	case RTL_GIGA_MAC_VER_28:
	case RTL_GIGA_MAC_VER_31:
		rtl8168dp_driver_stop(tp);
		break;
	case RTL_GIGA_MAC_VER_49:
	case RTL_GIGA_MAC_VER_50:
	case RTL_GIGA_MAC_VER_51:
		rtl8168ep_driver_stop(tp);
		break;
	default:
		BUG();
		break;
	}
}

1427
static bool r8168dp_check_dash(struct rtl8169_private *tp)
1428 1429 1430
{
	u16 reg = rtl8168_get_ocp_reg(tp);

1431
	return !!(ocp_read(tp, 0x0f, reg) & 0x00008000);
1432 1433
}

1434
static bool r8168ep_check_dash(struct rtl8169_private *tp)
C
Chun-Hao Lin 已提交
1435
{
1436
	return !!(ocp_read(tp, 0x0f, 0x128) & 0x00000001);
C
Chun-Hao Lin 已提交
1437 1438
}

1439
static bool r8168_check_dash(struct rtl8169_private *tp)
C
Chun-Hao Lin 已提交
1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450
{
	switch (tp->mac_version) {
	case RTL_GIGA_MAC_VER_27:
	case RTL_GIGA_MAC_VER_28:
	case RTL_GIGA_MAC_VER_31:
		return r8168dp_check_dash(tp);
	case RTL_GIGA_MAC_VER_49:
	case RTL_GIGA_MAC_VER_50:
	case RTL_GIGA_MAC_VER_51:
		return r8168ep_check_dash(tp);
	default:
1451
		return false;
C
Chun-Hao Lin 已提交
1452 1453 1454
	}
}

1455 1456 1457 1458 1459 1460
struct exgmac_reg {
	u16 addr;
	u16 mask;
	u32 val;
};

1461
static void rtl_write_exgmac_batch(struct rtl8169_private *tp,
1462 1463 1464
				   const struct exgmac_reg *r, int len)
{
	while (len-- > 0) {
1465
		rtl_eri_write(tp, r->addr, r->mask, r->val, ERIAR_EXGMAC);
1466 1467 1468 1469
		r++;
	}
}

1470 1471
DECLARE_RTL_COND(rtl_efusear_cond)
{
1472
	return RTL_R32(tp, EFUSEAR) & EFUSEAR_FLAG;
1473 1474
}

1475
static u8 rtl8168d_efuse_read(struct rtl8169_private *tp, int reg_addr)
1476
{
1477
	RTL_W32(tp, EFUSEAR, (reg_addr & EFUSEAR_REG_MASK) << EFUSEAR_REG_SHIFT);
1478

1479
	return rtl_udelay_loop_wait_high(tp, &rtl_efusear_cond, 100, 300) ?
1480
		RTL_R32(tp, EFUSEAR) & EFUSEAR_DATA_MASK : ~0;
1481 1482
}

F
Francois Romieu 已提交
1483 1484
static u16 rtl_get_events(struct rtl8169_private *tp)
{
1485
	return RTL_R16(tp, IntrStatus);
F
Francois Romieu 已提交
1486 1487 1488 1489
}

static void rtl_ack_events(struct rtl8169_private *tp, u16 bits)
{
1490
	RTL_W16(tp, IntrStatus, bits);
F
Francois Romieu 已提交
1491 1492 1493 1494 1495
	mmiowb();
}

static void rtl_irq_disable(struct rtl8169_private *tp)
{
1496
	RTL_W16(tp, IntrMask, 0);
F
Francois Romieu 已提交
1497 1498 1499
	mmiowb();
}

1500 1501
static void rtl_irq_enable(struct rtl8169_private *tp, u16 bits)
{
1502
	RTL_W16(tp, IntrMask, bits);
1503 1504
}

1505 1506 1507 1508 1509 1510 1511 1512 1513
#define RTL_EVENT_NAPI_RX	(RxOK | RxErr)
#define RTL_EVENT_NAPI_TX	(TxOK | TxErr)
#define RTL_EVENT_NAPI		(RTL_EVENT_NAPI_RX | RTL_EVENT_NAPI_TX)

static void rtl_irq_enable_all(struct rtl8169_private *tp)
{
	rtl_irq_enable(tp, RTL_EVENT_NAPI | tp->event_slow);
}

F
françois romieu 已提交
1514
static void rtl8169_irq_mask_and_ack(struct rtl8169_private *tp)
L
Linus Torvalds 已提交
1515
{
F
Francois Romieu 已提交
1516
	rtl_irq_disable(tp);
1517
	rtl_ack_events(tp, RTL_EVENT_NAPI | tp->event_slow);
1518
	RTL_R8(tp, ChipCmd);
L
Linus Torvalds 已提交
1519 1520
}

1521
static unsigned int rtl8169_tbi_reset_pending(struct rtl8169_private *tp)
L
Linus Torvalds 已提交
1522
{
1523
	return RTL_R32(tp, TBICSR) & TBIReset;
L
Linus Torvalds 已提交
1524 1525
}

1526
static unsigned int rtl8169_xmii_reset_pending(struct rtl8169_private *tp)
L
Linus Torvalds 已提交
1527
{
1528
	return rtl_readphy(tp, MII_BMCR) & BMCR_RESET;
L
Linus Torvalds 已提交
1529 1530
}

1531
static unsigned int rtl8169_tbi_link_ok(struct rtl8169_private *tp)
L
Linus Torvalds 已提交
1532
{
1533
	return RTL_R32(tp, TBICSR) & TBILinkOk;
L
Linus Torvalds 已提交
1534 1535
}

1536
static unsigned int rtl8169_xmii_link_ok(struct rtl8169_private *tp)
L
Linus Torvalds 已提交
1537
{
1538
	return RTL_R8(tp, PHYstatus) & LinkStatus;
L
Linus Torvalds 已提交
1539 1540
}

1541
static void rtl8169_tbi_reset_enable(struct rtl8169_private *tp)
L
Linus Torvalds 已提交
1542
{
1543
	RTL_W32(tp, TBICSR, RTL_R32(tp, TBICSR) | TBIReset);
L
Linus Torvalds 已提交
1544 1545
}

1546
static void rtl8169_xmii_reset_enable(struct rtl8169_private *tp)
L
Linus Torvalds 已提交
1547 1548 1549
{
	unsigned int val;

1550 1551
	val = rtl_readphy(tp, MII_BMCR) | BMCR_RESET;
	rtl_writephy(tp, MII_BMCR, val & 0xffff);
L
Linus Torvalds 已提交
1552 1553
}

H
Hayes Wang 已提交
1554 1555 1556 1557 1558 1559 1560
static void rtl_link_chg_patch(struct rtl8169_private *tp)
{
	struct net_device *dev = tp->dev;

	if (!netif_running(dev))
		return;

1561 1562
	if (tp->mac_version == RTL_GIGA_MAC_VER_34 ||
	    tp->mac_version == RTL_GIGA_MAC_VER_38) {
1563
		if (RTL_R8(tp, PHYstatus) & _1000bpsF) {
1564 1565 1566 1567
			rtl_eri_write(tp, 0x1bc, ERIAR_MASK_1111, 0x00000011,
				      ERIAR_EXGMAC);
			rtl_eri_write(tp, 0x1dc, ERIAR_MASK_1111, 0x00000005,
				      ERIAR_EXGMAC);
1568
		} else if (RTL_R8(tp, PHYstatus) & _100bps) {
1569 1570 1571 1572
			rtl_eri_write(tp, 0x1bc, ERIAR_MASK_1111, 0x0000001f,
				      ERIAR_EXGMAC);
			rtl_eri_write(tp, 0x1dc, ERIAR_MASK_1111, 0x00000005,
				      ERIAR_EXGMAC);
H
Hayes Wang 已提交
1573
		} else {
1574 1575 1576 1577
			rtl_eri_write(tp, 0x1bc, ERIAR_MASK_1111, 0x0000001f,
				      ERIAR_EXGMAC);
			rtl_eri_write(tp, 0x1dc, ERIAR_MASK_1111, 0x0000003f,
				      ERIAR_EXGMAC);
H
Hayes Wang 已提交
1578 1579
		}
		/* Reset packet filter */
1580
		rtl_w0w1_eri(tp, 0xdc, ERIAR_MASK_0001, 0x00, 0x01,
H
Hayes Wang 已提交
1581
			     ERIAR_EXGMAC);
1582
		rtl_w0w1_eri(tp, 0xdc, ERIAR_MASK_0001, 0x01, 0x00,
H
Hayes Wang 已提交
1583
			     ERIAR_EXGMAC);
1584 1585
	} else if (tp->mac_version == RTL_GIGA_MAC_VER_35 ||
		   tp->mac_version == RTL_GIGA_MAC_VER_36) {
1586
		if (RTL_R8(tp, PHYstatus) & _1000bpsF) {
1587 1588 1589 1590
			rtl_eri_write(tp, 0x1bc, ERIAR_MASK_1111, 0x00000011,
				      ERIAR_EXGMAC);
			rtl_eri_write(tp, 0x1dc, ERIAR_MASK_1111, 0x00000005,
				      ERIAR_EXGMAC);
1591
		} else {
1592 1593 1594 1595
			rtl_eri_write(tp, 0x1bc, ERIAR_MASK_1111, 0x0000001f,
				      ERIAR_EXGMAC);
			rtl_eri_write(tp, 0x1dc, ERIAR_MASK_1111, 0x0000003f,
				      ERIAR_EXGMAC);
1596
		}
1597
	} else if (tp->mac_version == RTL_GIGA_MAC_VER_37) {
1598
		if (RTL_R8(tp, PHYstatus) & _10bps) {
1599 1600 1601 1602
			rtl_eri_write(tp, 0x1d0, ERIAR_MASK_0011, 0x4d02,
				      ERIAR_EXGMAC);
			rtl_eri_write(tp, 0x1dc, ERIAR_MASK_0011, 0x0060,
				      ERIAR_EXGMAC);
1603
		} else {
1604 1605
			rtl_eri_write(tp, 0x1d0, ERIAR_MASK_0011, 0x0000,
				      ERIAR_EXGMAC);
1606
		}
H
Hayes Wang 已提交
1607 1608 1609
	}
}

1610
static void rtl8169_check_link_status(struct net_device *dev,
1611
				      struct rtl8169_private *tp)
L
Linus Torvalds 已提交
1612
{
H
Heiner Kallweit 已提交
1613 1614
	struct device *d = tp_to_dev(tp);

1615
	if (tp->link_ok(tp)) {
H
Hayes Wang 已提交
1616
		rtl_link_chg_patch(tp);
1617
		/* This is to cancel a scheduled suspend if there's one. */
H
Heiner Kallweit 已提交
1618
		pm_request_resume(d);
L
Linus Torvalds 已提交
1619
		netif_carrier_on(dev);
1620 1621
		if (net_ratelimit())
			netif_info(tp, ifup, dev, "link up\n");
1622
	} else {
L
Linus Torvalds 已提交
1623
		netif_carrier_off(dev);
1624
		netif_info(tp, ifdown, dev, "link down\n");
H
Heiner Kallweit 已提交
1625
		pm_runtime_idle(d);
1626
	}
L
Linus Torvalds 已提交
1627 1628
}

1629 1630 1631
#define WAKE_ANY (WAKE_PHY | WAKE_MAGIC | WAKE_UCAST | WAKE_BCAST | WAKE_MCAST)

static u32 __rtl8169_get_wol(struct rtl8169_private *tp)
F
Francois Romieu 已提交
1632 1633
{
	u8 options;
1634
	u32 wolopts = 0;
F
Francois Romieu 已提交
1635

1636
	options = RTL_R8(tp, Config1);
F
Francois Romieu 已提交
1637
	if (!(options & PMEnable))
1638
		return 0;
F
Francois Romieu 已提交
1639

1640
	options = RTL_R8(tp, Config3);
F
Francois Romieu 已提交
1641
	if (options & LinkUp)
1642
		wolopts |= WAKE_PHY;
1643
	switch (tp->mac_version) {
1644 1645 1646 1647 1648 1649 1650 1651 1652 1653
	case RTL_GIGA_MAC_VER_34:
	case RTL_GIGA_MAC_VER_35:
	case RTL_GIGA_MAC_VER_36:
	case RTL_GIGA_MAC_VER_37:
	case RTL_GIGA_MAC_VER_38:
	case RTL_GIGA_MAC_VER_40:
	case RTL_GIGA_MAC_VER_41:
	case RTL_GIGA_MAC_VER_42:
	case RTL_GIGA_MAC_VER_43:
	case RTL_GIGA_MAC_VER_44:
1654 1655
	case RTL_GIGA_MAC_VER_45:
	case RTL_GIGA_MAC_VER_46:
1656 1657
	case RTL_GIGA_MAC_VER_47:
	case RTL_GIGA_MAC_VER_48:
C
Chun-Hao Lin 已提交
1658 1659 1660
	case RTL_GIGA_MAC_VER_49:
	case RTL_GIGA_MAC_VER_50:
	case RTL_GIGA_MAC_VER_51:
1661 1662 1663 1664 1665 1666 1667 1668
		if (rtl_eri_read(tp, 0xdc, ERIAR_EXGMAC) & MagicPacket_v2)
			wolopts |= WAKE_MAGIC;
		break;
	default:
		if (options & MagicPacket)
			wolopts |= WAKE_MAGIC;
		break;
	}
F
Francois Romieu 已提交
1669

1670
	options = RTL_R8(tp, Config5);
F
Francois Romieu 已提交
1671
	if (options & UWF)
1672
		wolopts |= WAKE_UCAST;
F
Francois Romieu 已提交
1673
	if (options & BWF)
1674
		wolopts |= WAKE_BCAST;
F
Francois Romieu 已提交
1675
	if (options & MWF)
1676
		wolopts |= WAKE_MCAST;
F
Francois Romieu 已提交
1677

1678
	return wolopts;
F
Francois Romieu 已提交
1679 1680
}

1681
static void rtl8169_get_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
F
Francois Romieu 已提交
1682 1683
{
	struct rtl8169_private *tp = netdev_priv(dev);
H
Heiner Kallweit 已提交
1684
	struct device *d = tp_to_dev(tp);
1685 1686

	pm_runtime_get_noresume(d);
1687

1688
	rtl_lock_work(tp);
1689 1690

	wol->supported = WAKE_ANY;
1691 1692 1693 1694
	if (pm_runtime_active(d))
		wol->wolopts = __rtl8169_get_wol(tp);
	else
		wol->wolopts = tp->saved_wolopts;
1695

1696
	rtl_unlock_work(tp);
1697 1698

	pm_runtime_put_noidle(d);
1699 1700 1701 1702
}

static void __rtl8169_set_wol(struct rtl8169_private *tp, u32 wolopts)
{
1703
	unsigned int i, tmp;
1704
	static const struct {
F
Francois Romieu 已提交
1705 1706 1707 1708 1709 1710 1711 1712
		u32 opt;
		u16 reg;
		u8  mask;
	} cfg[] = {
		{ WAKE_PHY,   Config3, LinkUp },
		{ WAKE_UCAST, Config5, UWF },
		{ WAKE_BCAST, Config5, BWF },
		{ WAKE_MCAST, Config5, MWF },
1713 1714
		{ WAKE_ANY,   Config5, LanWake },
		{ WAKE_MAGIC, Config3, MagicPacket }
F
Francois Romieu 已提交
1715
	};
1716
	u8 options;
F
Francois Romieu 已提交
1717

1718
	RTL_W8(tp, Cfg9346, Cfg9346_Unlock);
F
Francois Romieu 已提交
1719

1720
	switch (tp->mac_version) {
1721 1722 1723 1724 1725 1726 1727 1728 1729 1730
	case RTL_GIGA_MAC_VER_34:
	case RTL_GIGA_MAC_VER_35:
	case RTL_GIGA_MAC_VER_36:
	case RTL_GIGA_MAC_VER_37:
	case RTL_GIGA_MAC_VER_38:
	case RTL_GIGA_MAC_VER_40:
	case RTL_GIGA_MAC_VER_41:
	case RTL_GIGA_MAC_VER_42:
	case RTL_GIGA_MAC_VER_43:
	case RTL_GIGA_MAC_VER_44:
1731 1732
	case RTL_GIGA_MAC_VER_45:
	case RTL_GIGA_MAC_VER_46:
1733 1734
	case RTL_GIGA_MAC_VER_47:
	case RTL_GIGA_MAC_VER_48:
C
Chun-Hao Lin 已提交
1735 1736 1737
	case RTL_GIGA_MAC_VER_49:
	case RTL_GIGA_MAC_VER_50:
	case RTL_GIGA_MAC_VER_51:
1738 1739
		tmp = ARRAY_SIZE(cfg) - 1;
		if (wolopts & WAKE_MAGIC)
1740
			rtl_w0w1_eri(tp,
1741 1742 1743 1744 1745 1746
				     0x0dc,
				     ERIAR_MASK_0100,
				     MagicPacket_v2,
				     0x0000,
				     ERIAR_EXGMAC);
		else
1747
			rtl_w0w1_eri(tp,
1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759
				     0x0dc,
				     ERIAR_MASK_0100,
				     0x0000,
				     MagicPacket_v2,
				     ERIAR_EXGMAC);
		break;
	default:
		tmp = ARRAY_SIZE(cfg);
		break;
	}

	for (i = 0; i < tmp; i++) {
1760
		options = RTL_R8(tp, cfg[i].reg) & ~cfg[i].mask;
1761
		if (wolopts & cfg[i].opt)
F
Francois Romieu 已提交
1762
			options |= cfg[i].mask;
1763
		RTL_W8(tp, cfg[i].reg, options);
F
Francois Romieu 已提交
1764 1765
	}

1766 1767
	switch (tp->mac_version) {
	case RTL_GIGA_MAC_VER_01 ... RTL_GIGA_MAC_VER_17:
1768
		options = RTL_R8(tp, Config1) & ~PMEnable;
1769 1770
		if (wolopts)
			options |= PMEnable;
1771
		RTL_W8(tp, Config1, options);
1772 1773
		break;
	default:
1774
		options = RTL_R8(tp, Config2) & ~PME_SIGNAL;
1775 1776
		if (wolopts)
			options |= PME_SIGNAL;
1777
		RTL_W8(tp, Config2, options);
1778 1779 1780
		break;
	}

1781
	RTL_W8(tp, Cfg9346, Cfg9346_Lock);
1782 1783 1784 1785 1786
}

static int rtl8169_set_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
{
	struct rtl8169_private *tp = netdev_priv(dev);
H
Heiner Kallweit 已提交
1787
	struct device *d = tp_to_dev(tp);
1788 1789

	pm_runtime_get_noresume(d);
1790

1791
	rtl_lock_work(tp);
F
Francois Romieu 已提交
1792

1793 1794 1795 1796
	if (pm_runtime_active(d))
		__rtl8169_set_wol(tp, wol->wolopts);
	else
		tp->saved_wolopts = wol->wolopts;
1797 1798

	rtl_unlock_work(tp);
F
Francois Romieu 已提交
1799

H
Heiner Kallweit 已提交
1800
	device_set_wakeup_enable(d, wol->wolopts);
1801

1802 1803
	pm_runtime_put_noidle(d);

F
Francois Romieu 已提交
1804 1805 1806
	return 0;
}

1807 1808
static const char *rtl_lookup_firmware_name(struct rtl8169_private *tp)
{
1809
	return rtl_chip_infos[tp->mac_version].fw_name;
1810 1811
}

L
Linus Torvalds 已提交
1812 1813 1814 1815
static void rtl8169_get_drvinfo(struct net_device *dev,
				struct ethtool_drvinfo *info)
{
	struct rtl8169_private *tp = netdev_priv(dev);
1816
	struct rtl_fw *rtl_fw = tp->rtl_fw;
L
Linus Torvalds 已提交
1817

1818 1819 1820
	strlcpy(info->driver, MODULENAME, sizeof(info->driver));
	strlcpy(info->version, RTL8169_VERSION, sizeof(info->version));
	strlcpy(info->bus_info, pci_name(tp->pci_dev), sizeof(info->bus_info));
1821
	BUILD_BUG_ON(sizeof(info->fw_version) < sizeof(rtl_fw->version));
1822 1823 1824
	if (!IS_ERR_OR_NULL(rtl_fw))
		strlcpy(info->fw_version, rtl_fw->version,
			sizeof(info->fw_version));
L
Linus Torvalds 已提交
1825 1826 1827 1828 1829 1830 1831 1832
}

static int rtl8169_get_regs_len(struct net_device *dev)
{
	return R8169_REGS_SIZE;
}

static int rtl8169_set_speed_tbi(struct net_device *dev,
1833
				 u8 autoneg, u16 speed, u8 duplex, u32 ignored)
L
Linus Torvalds 已提交
1834 1835 1836 1837 1838
{
	struct rtl8169_private *tp = netdev_priv(dev);
	int ret = 0;
	u32 reg;

1839
	reg = RTL_R32(tp, TBICSR);
L
Linus Torvalds 已提交
1840 1841
	if ((autoneg == AUTONEG_DISABLE) && (speed == SPEED_1000) &&
	    (duplex == DUPLEX_FULL)) {
1842
		RTL_W32(tp, TBICSR, reg & ~(TBINwEnable | TBINwRestart));
L
Linus Torvalds 已提交
1843
	} else if (autoneg == AUTONEG_ENABLE)
1844
		RTL_W32(tp, TBICSR, reg | TBINwEnable | TBINwRestart);
L
Linus Torvalds 已提交
1845
	else {
1846 1847
		netif_warn(tp, link, dev,
			   "incorrect speed setting refused in TBI mode\n");
L
Linus Torvalds 已提交
1848 1849 1850 1851 1852 1853 1854
		ret = -EOPNOTSUPP;
	}

	return ret;
}

static int rtl8169_set_speed_xmii(struct net_device *dev,
1855
				  u8 autoneg, u16 speed, u8 duplex, u32 adv)
L
Linus Torvalds 已提交
1856 1857
{
	struct rtl8169_private *tp = netdev_priv(dev);
1858
	int giga_ctrl, bmcr;
1859
	int rc = -EINVAL;
L
Linus Torvalds 已提交
1860

1861
	rtl_writephy(tp, 0x1f, 0x0000);
L
Linus Torvalds 已提交
1862 1863

	if (autoneg == AUTONEG_ENABLE) {
1864 1865
		int auto_nego;

1866
		auto_nego = rtl_readphy(tp, MII_ADVERTISE);
1867 1868 1869 1870 1871 1872 1873 1874 1875 1876 1877 1878
		auto_nego &= ~(ADVERTISE_10HALF | ADVERTISE_10FULL |
				ADVERTISE_100HALF | ADVERTISE_100FULL);

		if (adv & ADVERTISED_10baseT_Half)
			auto_nego |= ADVERTISE_10HALF;
		if (adv & ADVERTISED_10baseT_Full)
			auto_nego |= ADVERTISE_10FULL;
		if (adv & ADVERTISED_100baseT_Half)
			auto_nego |= ADVERTISE_100HALF;
		if (adv & ADVERTISED_100baseT_Full)
			auto_nego |= ADVERTISE_100FULL;

1879
		auto_nego |= ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM;
L
Linus Torvalds 已提交
1880

1881
		giga_ctrl = rtl_readphy(tp, MII_CTRL1000);
1882
		giga_ctrl &= ~(ADVERTISE_1000FULL | ADVERTISE_1000HALF);
1883

1884
		/* The 8100e/8101e/8102e do Fast Ethernet only. */
1885
		if (tp->mii.supports_gmii) {
1886 1887 1888 1889 1890 1891
			if (adv & ADVERTISED_1000baseT_Half)
				giga_ctrl |= ADVERTISE_1000HALF;
			if (adv & ADVERTISED_1000baseT_Full)
				giga_ctrl |= ADVERTISE_1000FULL;
		} else if (adv & (ADVERTISED_1000baseT_Half |
				  ADVERTISED_1000baseT_Full)) {
1892 1893
			netif_info(tp, link, dev,
				   "PHY does not support 1000Mbps\n");
1894
			goto out;
1895
		}
L
Linus Torvalds 已提交
1896

1897 1898
		bmcr = BMCR_ANENABLE | BMCR_ANRESTART;

1899 1900
		rtl_writephy(tp, MII_ADVERTISE, auto_nego);
		rtl_writephy(tp, MII_CTRL1000, giga_ctrl);
1901 1902 1903 1904 1905 1906
	} else {
		if (speed == SPEED_10)
			bmcr = 0;
		else if (speed == SPEED_100)
			bmcr = BMCR_SPEED100;
		else
1907
			goto out;
1908 1909 1910

		if (duplex == DUPLEX_FULL)
			bmcr |= BMCR_FULLDPLX;
R
Roger So 已提交
1911 1912
	}

1913
	rtl_writephy(tp, MII_BMCR, bmcr);
1914

F
Francois Romieu 已提交
1915 1916
	if (tp->mac_version == RTL_GIGA_MAC_VER_02 ||
	    tp->mac_version == RTL_GIGA_MAC_VER_03) {
1917
		if ((speed == SPEED_100) && (autoneg != AUTONEG_ENABLE)) {
1918 1919
			rtl_writephy(tp, 0x17, 0x2138);
			rtl_writephy(tp, 0x0e, 0x0260);
1920
		} else {
1921 1922
			rtl_writephy(tp, 0x17, 0x2108);
			rtl_writephy(tp, 0x0e, 0x0000);
1923 1924 1925
		}
	}

1926 1927 1928
	rc = 0;
out:
	return rc;
L
Linus Torvalds 已提交
1929 1930 1931
}

static int rtl8169_set_speed(struct net_device *dev,
1932
			     u8 autoneg, u16 speed, u8 duplex, u32 advertising)
L
Linus Torvalds 已提交
1933 1934 1935 1936
{
	struct rtl8169_private *tp = netdev_priv(dev);
	int ret;

1937
	ret = tp->set_speed(dev, autoneg, speed, duplex, advertising);
1938 1939
	if (ret < 0)
		goto out;
L
Linus Torvalds 已提交
1940

1941
	if (netif_running(dev) && (autoneg == AUTONEG_ENABLE) &&
1942 1943
	    (advertising & ADVERTISED_1000baseT_Full) &&
	    !pci_is_pcie(tp->pci_dev)) {
L
Linus Torvalds 已提交
1944
		mod_timer(&tp->timer, jiffies + RTL8169_PHY_TIMEOUT);
1945 1946
	}
out:
L
Linus Torvalds 已提交
1947 1948 1949
	return ret;
}

1950 1951
static netdev_features_t rtl8169_fix_features(struct net_device *dev,
	netdev_features_t features)
L
Linus Torvalds 已提交
1952
{
F
Francois Romieu 已提交
1953 1954
	struct rtl8169_private *tp = netdev_priv(dev);

F
Francois Romieu 已提交
1955
	if (dev->mtu > TD_MSS_MAX)
1956
		features &= ~NETIF_F_ALL_TSO;
L
Linus Torvalds 已提交
1957

F
Francois Romieu 已提交
1958 1959 1960 1961
	if (dev->mtu > JUMBO_1K &&
	    !rtl_chip_infos[tp->mac_version].jumbo_tx_csum)
		features &= ~NETIF_F_IP_CSUM;

1962
	return features;
L
Linus Torvalds 已提交
1963 1964
}

1965 1966
static void __rtl8169_set_features(struct net_device *dev,
				   netdev_features_t features)
L
Linus Torvalds 已提交
1967 1968
{
	struct rtl8169_private *tp = netdev_priv(dev);
H
hayeswang 已提交
1969
	u32 rx_config;
L
Linus Torvalds 已提交
1970

1971
	rx_config = RTL_R32(tp, RxConfig);
H
hayeswang 已提交
1972 1973 1974 1975
	if (features & NETIF_F_RXALL)
		rx_config |= (AcceptErr | AcceptRunt);
	else
		rx_config &= ~(AcceptErr | AcceptRunt);
L
Linus Torvalds 已提交
1976

1977
	RTL_W32(tp, RxConfig, rx_config);
1978

H
hayeswang 已提交
1979 1980 1981 1982
	if (features & NETIF_F_RXCSUM)
		tp->cp_cmd |= RxChkSum;
	else
		tp->cp_cmd &= ~RxChkSum;
B
Ben Greear 已提交
1983

H
hayeswang 已提交
1984 1985 1986 1987 1988
	if (features & NETIF_F_HW_VLAN_CTAG_RX)
		tp->cp_cmd |= RxVlan;
	else
		tp->cp_cmd &= ~RxVlan;

1989
	tp->cp_cmd |= RTL_R16(tp, CPlusCmd) & ~(RxVlan | RxChkSum);
H
hayeswang 已提交
1990

1991 1992
	RTL_W16(tp, CPlusCmd, tp->cp_cmd);
	RTL_R16(tp, CPlusCmd);
1993
}
L
Linus Torvalds 已提交
1994

1995 1996 1997 1998 1999
static int rtl8169_set_features(struct net_device *dev,
				netdev_features_t features)
{
	struct rtl8169_private *tp = netdev_priv(dev);

H
hayeswang 已提交
2000 2001
	features &= NETIF_F_RXALL | NETIF_F_RXCSUM | NETIF_F_HW_VLAN_CTAG_RX;

2002
	rtl_lock_work(tp);
D
Dan Carpenter 已提交
2003
	if (features ^ dev->features)
H
hayeswang 已提交
2004
		__rtl8169_set_features(dev, features);
2005
	rtl_unlock_work(tp);
L
Linus Torvalds 已提交
2006 2007 2008 2009

	return 0;
}

2010

2011
static inline u32 rtl8169_tx_vlan_tag(struct sk_buff *skb)
L
Linus Torvalds 已提交
2012
{
2013 2014
	return (skb_vlan_tag_present(skb)) ?
		TxVlanTag | swab16(skb_vlan_tag_get(skb)) : 0x00;
L
Linus Torvalds 已提交
2015 2016
}

2017
static void rtl8169_rx_vlan_tag(struct RxDesc *desc, struct sk_buff *skb)
L
Linus Torvalds 已提交
2018 2019 2020
{
	u32 opts2 = le32_to_cpu(desc->opts2);

2021
	if (opts2 & RxVlanTag)
2022
		__vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), swab16(opts2 & 0xffff));
L
Linus Torvalds 已提交
2023 2024
}

2025 2026
static int rtl8169_get_link_ksettings_tbi(struct net_device *dev,
					  struct ethtool_link_ksettings *cmd)
L
Linus Torvalds 已提交
2027 2028 2029
{
	struct rtl8169_private *tp = netdev_priv(dev);
	u32 status;
2030
	u32 supported, advertising;
L
Linus Torvalds 已提交
2031

2032
	supported =
L
Linus Torvalds 已提交
2033
		SUPPORTED_1000baseT_Full | SUPPORTED_Autoneg | SUPPORTED_FIBRE;
2034
	cmd->base.port = PORT_FIBRE;
L
Linus Torvalds 已提交
2035

2036
	status = RTL_R32(tp, TBICSR);
2037 2038
	advertising = (status & TBINwEnable) ?  ADVERTISED_Autoneg : 0;
	cmd->base.autoneg = !!(status & TBINwEnable);
L
Linus Torvalds 已提交
2039

2040 2041 2042 2043 2044 2045 2046
	cmd->base.speed = SPEED_1000;
	cmd->base.duplex = DUPLEX_FULL; /* Always set */

	ethtool_convert_legacy_u32_to_link_mode(cmd->link_modes.supported,
						supported);
	ethtool_convert_legacy_u32_to_link_mode(cmd->link_modes.advertising,
						advertising);
2047 2048

	return 0;
L
Linus Torvalds 已提交
2049 2050
}

2051 2052
static int rtl8169_get_link_ksettings_xmii(struct net_device *dev,
					   struct ethtool_link_ksettings *cmd)
L
Linus Torvalds 已提交
2053 2054
{
	struct rtl8169_private *tp = netdev_priv(dev);
2055

2056 2057 2058
	mii_ethtool_get_link_ksettings(&tp->mii, cmd);

	return 0;
L
Linus Torvalds 已提交
2059 2060
}

2061 2062
static int rtl8169_get_link_ksettings(struct net_device *dev,
				      struct ethtool_link_ksettings *cmd)
L
Linus Torvalds 已提交
2063 2064
{
	struct rtl8169_private *tp = netdev_priv(dev);
2065
	int rc;
L
Linus Torvalds 已提交
2066

2067
	rtl_lock_work(tp);
2068
	rc = tp->get_link_ksettings(dev, cmd);
2069
	rtl_unlock_work(tp);
L
Linus Torvalds 已提交
2070

2071
	return rc;
L
Linus Torvalds 已提交
2072 2073
}

2074 2075 2076 2077 2078 2079 2080 2081 2082 2083 2084 2085 2086 2087 2088 2089 2090 2091 2092 2093 2094
static int rtl8169_set_link_ksettings(struct net_device *dev,
				      const struct ethtool_link_ksettings *cmd)
{
	struct rtl8169_private *tp = netdev_priv(dev);
	int rc;
	u32 advertising;

	if (!ethtool_convert_link_mode_to_legacy_u32(&advertising,
	    cmd->link_modes.advertising))
		return -EINVAL;

	del_timer_sync(&tp->timer);

	rtl_lock_work(tp);
	rc = rtl8169_set_speed(dev, cmd->base.autoneg, cmd->base.speed,
			       cmd->base.duplex, advertising);
	rtl_unlock_work(tp);

	return rc;
}

L
Linus Torvalds 已提交
2095 2096 2097
static void rtl8169_get_regs(struct net_device *dev, struct ethtool_regs *regs,
			     void *p)
{
2098
	struct rtl8169_private *tp = netdev_priv(dev);
P
Peter Wu 已提交
2099 2100 2101
	u32 __iomem *data = tp->mmio_addr;
	u32 *dw = p;
	int i;
L
Linus Torvalds 已提交
2102

2103
	rtl_lock_work(tp);
P
Peter Wu 已提交
2104 2105
	for (i = 0; i < R8169_REGS_SIZE; i += 4)
		memcpy_fromio(dw++, data++, 4);
2106
	rtl_unlock_work(tp);
L
Linus Torvalds 已提交
2107 2108
}

2109 2110 2111 2112 2113 2114 2115 2116 2117 2118 2119 2120 2121 2122
static u32 rtl8169_get_msglevel(struct net_device *dev)
{
	struct rtl8169_private *tp = netdev_priv(dev);

	return tp->msg_enable;
}

static void rtl8169_set_msglevel(struct net_device *dev, u32 value)
{
	struct rtl8169_private *tp = netdev_priv(dev);

	tp->msg_enable = value;
}

2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134 2135 2136 2137 2138
static const char rtl8169_gstrings[][ETH_GSTRING_LEN] = {
	"tx_packets",
	"rx_packets",
	"tx_errors",
	"rx_errors",
	"rx_missed",
	"align_errors",
	"tx_single_collisions",
	"tx_multi_collisions",
	"unicast",
	"broadcast",
	"multicast",
	"tx_aborted",
	"tx_underrun",
};

2139
static int rtl8169_get_sset_count(struct net_device *dev, int sset)
2140
{
2141 2142 2143 2144 2145 2146
	switch (sset) {
	case ETH_SS_STATS:
		return ARRAY_SIZE(rtl8169_gstrings);
	default:
		return -EOPNOTSUPP;
	}
2147 2148
}

2149
DECLARE_RTL_COND(rtl_counters_cond)
2150
{
2151
	return RTL_R32(tp, CounterAddrLow) & (CounterReset | CounterDump);
2152 2153
}

2154
static bool rtl8169_do_counters(struct net_device *dev, u32 counter_cmd)
2155 2156
{
	struct rtl8169_private *tp = netdev_priv(dev);
2157 2158
	dma_addr_t paddr = tp->counters_phys_addr;
	u32 cmd;
2159

2160 2161
	RTL_W32(tp, CounterAddrHigh, (u64)paddr >> 32);
	RTL_R32(tp, CounterAddrHigh);
2162
	cmd = (u64)paddr & DMA_BIT_MASK(32);
2163 2164
	RTL_W32(tp, CounterAddrLow, cmd);
	RTL_W32(tp, CounterAddrLow, cmd | counter_cmd);
2165

2166
	return rtl_udelay_loop_wait_low(tp, &rtl_counters_cond, 10, 1000);
2167 2168 2169 2170 2171 2172 2173 2174 2175 2176 2177 2178 2179
}

static bool rtl8169_reset_counters(struct net_device *dev)
{
	struct rtl8169_private *tp = netdev_priv(dev);

	/*
	 * Versions prior to RTL_GIGA_MAC_VER_19 don't support resetting the
	 * tally counters.
	 */
	if (tp->mac_version < RTL_GIGA_MAC_VER_19)
		return true;

2180
	return rtl8169_do_counters(dev, CounterReset);
2181 2182
}

2183
static bool rtl8169_update_counters(struct net_device *dev)
2184 2185 2186
{
	struct rtl8169_private *tp = netdev_priv(dev);

2187 2188 2189 2190
	/*
	 * Some chips are unable to dump tally counters when the receiver
	 * is disabled.
	 */
2191
	if ((RTL_R8(tp, ChipCmd) & CmdRxEnb) == 0)
2192
		return true;
2193

2194
	return rtl8169_do_counters(dev, CounterDump);
2195 2196 2197 2198 2199
}

static bool rtl8169_init_counter_offsets(struct net_device *dev)
{
	struct rtl8169_private *tp = netdev_priv(dev);
2200
	struct rtl8169_counters *counters = tp->counters;
2201 2202 2203 2204 2205 2206 2207 2208 2209 2210 2211 2212 2213 2214 2215 2216 2217 2218 2219 2220 2221 2222 2223 2224 2225 2226 2227
	bool ret = false;

	/*
	 * rtl8169_init_counter_offsets is called from rtl_open.  On chip
	 * versions prior to RTL_GIGA_MAC_VER_19 the tally counters are only
	 * reset by a power cycle, while the counter values collected by the
	 * driver are reset at every driver unload/load cycle.
	 *
	 * To make sure the HW values returned by @get_stats64 match the SW
	 * values, we collect the initial values at first open(*) and use them
	 * as offsets to normalize the values returned by @get_stats64.
	 *
	 * (*) We can't call rtl8169_init_counter_offsets from rtl_init_one
	 * for the reason stated in rtl8169_update_counters; CmdRxEnb is only
	 * set at open time by rtl_hw_start.
	 */

	if (tp->tc_offset.inited)
		return true;

	/* If both, reset and update fail, propagate to caller. */
	if (rtl8169_reset_counters(dev))
		ret = true;

	if (rtl8169_update_counters(dev))
		ret = true;

2228 2229 2230
	tp->tc_offset.tx_errors = counters->tx_errors;
	tp->tc_offset.tx_multi_collision = counters->tx_multi_collision;
	tp->tc_offset.tx_aborted = counters->tx_aborted;
2231 2232 2233
	tp->tc_offset.inited = true;

	return ret;
2234 2235
}

2236 2237 2238 2239
static void rtl8169_get_ethtool_stats(struct net_device *dev,
				      struct ethtool_stats *stats, u64 *data)
{
	struct rtl8169_private *tp = netdev_priv(dev);
H
Heiner Kallweit 已提交
2240
	struct device *d = tp_to_dev(tp);
2241
	struct rtl8169_counters *counters = tp->counters;
2242 2243 2244

	ASSERT_RTNL();

2245 2246 2247 2248 2249 2250
	pm_runtime_get_noresume(d);

	if (pm_runtime_active(d))
		rtl8169_update_counters(dev);

	pm_runtime_put_noidle(d);
2251

2252 2253 2254 2255 2256 2257 2258 2259 2260 2261 2262 2263 2264
	data[0] = le64_to_cpu(counters->tx_packets);
	data[1] = le64_to_cpu(counters->rx_packets);
	data[2] = le64_to_cpu(counters->tx_errors);
	data[3] = le32_to_cpu(counters->rx_errors);
	data[4] = le16_to_cpu(counters->rx_missed);
	data[5] = le16_to_cpu(counters->align_errors);
	data[6] = le32_to_cpu(counters->tx_one_collision);
	data[7] = le32_to_cpu(counters->tx_multi_collision);
	data[8] = le64_to_cpu(counters->rx_unicast);
	data[9] = le64_to_cpu(counters->rx_broadcast);
	data[10] = le32_to_cpu(counters->rx_multicast);
	data[11] = le16_to_cpu(counters->tx_aborted);
	data[12] = le16_to_cpu(counters->tx_underun);
2265 2266
}

2267 2268 2269 2270 2271 2272 2273 2274 2275
static void rtl8169_get_strings(struct net_device *dev, u32 stringset, u8 *data)
{
	switch(stringset) {
	case ETH_SS_STATS:
		memcpy(data, *rtl8169_gstrings, sizeof(rtl8169_gstrings));
		break;
	}
}

2276 2277 2278 2279 2280 2281 2282
static int rtl8169_nway_reset(struct net_device *dev)
{
	struct rtl8169_private *tp = netdev_priv(dev);

	return mii_nway_restart(&tp->mii);
}

2283 2284 2285 2286 2287 2288 2289 2290 2291 2292 2293 2294 2295 2296 2297 2298 2299 2300 2301 2302 2303 2304 2305 2306 2307 2308 2309 2310 2311 2312 2313 2314 2315 2316 2317 2318 2319 2320 2321 2322 2323 2324 2325 2326 2327 2328 2329 2330 2331 2332 2333 2334 2335 2336 2337 2338 2339 2340 2341 2342 2343 2344 2345 2346 2347 2348 2349 2350 2351 2352 2353 2354 2355 2356 2357 2358 2359 2360 2361 2362 2363 2364 2365 2366 2367 2368 2369 2370 2371 2372 2373 2374 2375 2376 2377 2378 2379 2380 2381 2382 2383 2384 2385 2386 2387 2388 2389
/*
 * Interrupt coalescing
 *
 * > 1 - the availability of the IntrMitigate (0xe2) register through the
 * >     8169, 8168 and 810x line of chipsets
 *
 * 8169, 8168, and 8136(810x) serial chipsets support it.
 *
 * > 2 - the Tx timer unit at gigabit speed
 *
 * The unit of the timer depends on both the speed and the setting of CPlusCmd
 * (0xe0) bit 1 and bit 0.
 *
 * For 8169
 * bit[1:0] \ speed        1000M           100M            10M
 * 0 0                     320ns           2.56us          40.96us
 * 0 1                     2.56us          20.48us         327.7us
 * 1 0                     5.12us          40.96us         655.4us
 * 1 1                     10.24us         81.92us         1.31ms
 *
 * For the other
 * bit[1:0] \ speed        1000M           100M            10M
 * 0 0                     5us             2.56us          40.96us
 * 0 1                     40us            20.48us         327.7us
 * 1 0                     80us            40.96us         655.4us
 * 1 1                     160us           81.92us         1.31ms
 */

/* rx/tx scale factors for one particular CPlusCmd[0:1] value */
struct rtl_coalesce_scale {
	/* Rx / Tx */
	u32 nsecs[2];
};

/* rx/tx scale factors for all CPlusCmd[0:1] cases */
struct rtl_coalesce_info {
	u32 speed;
	struct rtl_coalesce_scale scalev[4];	/* each CPlusCmd[0:1] case */
};

/* produce (r,t) pairs with each being in series of *1, *8, *8*2, *8*2*2 */
#define rxtx_x1822(r, t) {		\
	{{(r),		(t)}},		\
	{{(r)*8,	(t)*8}},	\
	{{(r)*8*2,	(t)*8*2}},	\
	{{(r)*8*2*2,	(t)*8*2*2}},	\
}
static const struct rtl_coalesce_info rtl_coalesce_info_8169[] = {
	/* speed	delays:     rx00   tx00	*/
	{ SPEED_10,	rxtx_x1822(40960, 40960)	},
	{ SPEED_100,	rxtx_x1822( 2560,  2560)	},
	{ SPEED_1000,	rxtx_x1822(  320,   320)	},
	{ 0 },
};

static const struct rtl_coalesce_info rtl_coalesce_info_8168_8136[] = {
	/* speed	delays:     rx00   tx00	*/
	{ SPEED_10,	rxtx_x1822(40960, 40960)	},
	{ SPEED_100,	rxtx_x1822( 2560,  2560)	},
	{ SPEED_1000,	rxtx_x1822( 5000,  5000)	},
	{ 0 },
};
#undef rxtx_x1822

/* get rx/tx scale vector corresponding to current speed */
static const struct rtl_coalesce_info *rtl_coalesce_info(struct net_device *dev)
{
	struct rtl8169_private *tp = netdev_priv(dev);
	struct ethtool_link_ksettings ecmd;
	const struct rtl_coalesce_info *ci;
	int rc;

	rc = rtl8169_get_link_ksettings(dev, &ecmd);
	if (rc < 0)
		return ERR_PTR(rc);

	for (ci = tp->coalesce_info; ci->speed != 0; ci++) {
		if (ecmd.base.speed == ci->speed) {
			return ci;
		}
	}

	return ERR_PTR(-ELNRNG);
}

static int rtl_get_coalesce(struct net_device *dev, struct ethtool_coalesce *ec)
{
	struct rtl8169_private *tp = netdev_priv(dev);
	const struct rtl_coalesce_info *ci;
	const struct rtl_coalesce_scale *scale;
	struct {
		u32 *max_frames;
		u32 *usecs;
	} coal_settings [] = {
		{ &ec->rx_max_coalesced_frames, &ec->rx_coalesce_usecs },
		{ &ec->tx_max_coalesced_frames, &ec->tx_coalesce_usecs }
	}, *p = coal_settings;
	int i;
	u16 w;

	memset(ec, 0, sizeof(*ec));

	/* get rx/tx scale corresponding to current speed and CPlusCmd[0:1] */
	ci = rtl_coalesce_info(dev);
	if (IS_ERR(ci))
		return PTR_ERR(ci);

2390
	scale = &ci->scalev[RTL_R16(tp, CPlusCmd) & 3];
2391 2392

	/* read IntrMitigate and adjust according to scale */
2393
	for (w = RTL_R16(tp, IntrMitigate); w; w >>= RTL_COALESCE_SHIFT, p++) {
2394 2395 2396 2397 2398 2399 2400 2401 2402 2403 2404 2405 2406 2407 2408 2409 2410 2411 2412 2413 2414 2415 2416 2417 2418 2419 2420 2421 2422 2423 2424 2425 2426 2427 2428 2429 2430 2431 2432 2433 2434 2435 2436 2437 2438 2439 2440 2441 2442 2443 2444 2445 2446 2447 2448 2449 2450 2451 2452 2453 2454 2455 2456 2457 2458 2459 2460 2461 2462 2463 2464 2465 2466 2467 2468 2469 2470 2471 2472 2473 2474 2475 2476 2477 2478 2479 2480 2481 2482 2483 2484 2485 2486
		*p->max_frames = (w & RTL_COALESCE_MASK) << 2;
		w >>= RTL_COALESCE_SHIFT;
		*p->usecs = w & RTL_COALESCE_MASK;
	}

	for (i = 0; i < 2; i++) {
		p = coal_settings + i;
		*p->usecs = (*p->usecs * scale->nsecs[i]) / 1000;

		/*
		 * ethtool_coalesce says it is illegal to set both usecs and
		 * max_frames to 0.
		 */
		if (!*p->usecs && !*p->max_frames)
			*p->max_frames = 1;
	}

	return 0;
}

/* choose appropriate scale factor and CPlusCmd[0:1] for (speed, nsec) */
static const struct rtl_coalesce_scale *rtl_coalesce_choose_scale(
			struct net_device *dev, u32 nsec, u16 *cp01)
{
	const struct rtl_coalesce_info *ci;
	u16 i;

	ci = rtl_coalesce_info(dev);
	if (IS_ERR(ci))
		return ERR_CAST(ci);

	for (i = 0; i < 4; i++) {
		u32 rxtx_maxscale = max(ci->scalev[i].nsecs[0],
					ci->scalev[i].nsecs[1]);
		if (nsec <= rxtx_maxscale * RTL_COALESCE_T_MAX) {
			*cp01 = i;
			return &ci->scalev[i];
		}
	}

	return ERR_PTR(-EINVAL);
}

static int rtl_set_coalesce(struct net_device *dev, struct ethtool_coalesce *ec)
{
	struct rtl8169_private *tp = netdev_priv(dev);
	const struct rtl_coalesce_scale *scale;
	struct {
		u32 frames;
		u32 usecs;
	} coal_settings [] = {
		{ ec->rx_max_coalesced_frames, ec->rx_coalesce_usecs },
		{ ec->tx_max_coalesced_frames, ec->tx_coalesce_usecs }
	}, *p = coal_settings;
	u16 w = 0, cp01;
	int i;

	scale = rtl_coalesce_choose_scale(dev,
			max(p[0].usecs, p[1].usecs) * 1000, &cp01);
	if (IS_ERR(scale))
		return PTR_ERR(scale);

	for (i = 0; i < 2; i++, p++) {
		u32 units;

		/*
		 * accept max_frames=1 we returned in rtl_get_coalesce.
		 * accept it not only when usecs=0 because of e.g. the following scenario:
		 *
		 * - both rx_usecs=0 & rx_frames=0 in hardware (no delay on RX)
		 * - rtl_get_coalesce returns rx_usecs=0, rx_frames=1
		 * - then user does `ethtool -C eth0 rx-usecs 100`
		 *
		 * since ethtool sends to kernel whole ethtool_coalesce
		 * settings, if we do not handle rx_usecs=!0, rx_frames=1
		 * we'll reject it below in `frames % 4 != 0`.
		 */
		if (p->frames == 1) {
			p->frames = 0;
		}

		units = p->usecs * 1000 / scale->nsecs[i];
		if (p->frames > RTL_COALESCE_FRAME_MAX || p->frames % 4)
			return -EINVAL;

		w <<= RTL_COALESCE_SHIFT;
		w |= units;
		w <<= RTL_COALESCE_SHIFT;
		w |= p->frames >> 2;
	}

	rtl_lock_work(tp);

2487
	RTL_W16(tp, IntrMitigate, swab16(w));
2488 2489

	tp->cp_cmd = (tp->cp_cmd & ~3) | cp01;
2490 2491
	RTL_W16(tp, CPlusCmd, tp->cp_cmd);
	RTL_R16(tp, CPlusCmd);
2492 2493 2494 2495 2496 2497

	rtl_unlock_work(tp);

	return 0;
}

2498
static const struct ethtool_ops rtl8169_ethtool_ops = {
L
Linus Torvalds 已提交
2499 2500 2501
	.get_drvinfo		= rtl8169_get_drvinfo,
	.get_regs_len		= rtl8169_get_regs_len,
	.get_link		= ethtool_op_get_link,
2502 2503
	.get_coalesce		= rtl_get_coalesce,
	.set_coalesce		= rtl_set_coalesce,
2504 2505
	.get_msglevel		= rtl8169_get_msglevel,
	.set_msglevel		= rtl8169_set_msglevel,
L
Linus Torvalds 已提交
2506
	.get_regs		= rtl8169_get_regs,
F
Francois Romieu 已提交
2507 2508
	.get_wol		= rtl8169_get_wol,
	.set_wol		= rtl8169_set_wol,
2509
	.get_strings		= rtl8169_get_strings,
2510
	.get_sset_count		= rtl8169_get_sset_count,
2511
	.get_ethtool_stats	= rtl8169_get_ethtool_stats,
2512
	.get_ts_info		= ethtool_op_get_ts_info,
2513
	.nway_reset		= rtl8169_nway_reset,
2514
	.get_link_ksettings	= rtl8169_get_link_ksettings,
2515
	.set_link_ksettings	= rtl8169_set_link_ksettings,
L
Linus Torvalds 已提交
2516 2517
};

F
Francois Romieu 已提交
2518
static void rtl8169_get_mac_version(struct rtl8169_private *tp,
2519
				    struct net_device *dev, u8 default_version)
L
Linus Torvalds 已提交
2520
{
2521 2522 2523 2524 2525
	/*
	 * The driver currently handles the 8168Bf and the 8168Be identically
	 * but they can be identified more specifically through the test below
	 * if needed:
	 *
2526
	 * (RTL_R32(tp, TxConfig) & 0x700000) == 0x500000 ? 8168Bf : 8168Be
F
Francois Romieu 已提交
2527 2528 2529
	 *
	 * Same thing for the 8101Eb and the 8101Ec:
	 *
2530
	 * (RTL_R32(tp, TxConfig) & 0x700000) == 0x200000 ? 8101Eb : 8101Ec
2531
	 */
2532
	static const struct rtl_mac_info {
L
Linus Torvalds 已提交
2533
		u32 mask;
F
Francois Romieu 已提交
2534
		u32 val;
L
Linus Torvalds 已提交
2535 2536
		int mac_version;
	} mac_info[] = {
C
Chun-Hao Lin 已提交
2537 2538 2539 2540 2541
		/* 8168EP family. */
		{ 0x7cf00000, 0x50200000,	RTL_GIGA_MAC_VER_51 },
		{ 0x7cf00000, 0x50100000,	RTL_GIGA_MAC_VER_50 },
		{ 0x7cf00000, 0x50000000,	RTL_GIGA_MAC_VER_49 },

2542 2543 2544 2545
		/* 8168H family. */
		{ 0x7cf00000, 0x54100000,	RTL_GIGA_MAC_VER_46 },
		{ 0x7cf00000, 0x54000000,	RTL_GIGA_MAC_VER_45 },

H
Hayes Wang 已提交
2546
		/* 8168G family. */
H
hayeswang 已提交
2547
		{ 0x7cf00000, 0x5c800000,	RTL_GIGA_MAC_VER_44 },
H
hayeswang 已提交
2548
		{ 0x7cf00000, 0x50900000,	RTL_GIGA_MAC_VER_42 },
H
Hayes Wang 已提交
2549 2550 2551
		{ 0x7cf00000, 0x4c100000,	RTL_GIGA_MAC_VER_41 },
		{ 0x7cf00000, 0x4c000000,	RTL_GIGA_MAC_VER_40 },

2552
		/* 8168F family. */
2553
		{ 0x7c800000, 0x48800000,	RTL_GIGA_MAC_VER_38 },
2554 2555 2556
		{ 0x7cf00000, 0x48100000,	RTL_GIGA_MAC_VER_36 },
		{ 0x7cf00000, 0x48000000,	RTL_GIGA_MAC_VER_35 },

H
hayeswang 已提交
2557
		/* 8168E family. */
H
Hayes Wang 已提交
2558
		{ 0x7c800000, 0x2c800000,	RTL_GIGA_MAC_VER_34 },
H
hayeswang 已提交
2559 2560 2561 2562
		{ 0x7cf00000, 0x2c200000,	RTL_GIGA_MAC_VER_33 },
		{ 0x7cf00000, 0x2c100000,	RTL_GIGA_MAC_VER_32 },
		{ 0x7c800000, 0x2c000000,	RTL_GIGA_MAC_VER_33 },

F
Francois Romieu 已提交
2563
		/* 8168D family. */
2564 2565 2566
		{ 0x7cf00000, 0x28300000,	RTL_GIGA_MAC_VER_26 },
		{ 0x7cf00000, 0x28100000,	RTL_GIGA_MAC_VER_25 },
		{ 0x7c800000, 0x28000000,	RTL_GIGA_MAC_VER_26 },
F
Francois Romieu 已提交
2567

F
françois romieu 已提交
2568 2569 2570
		/* 8168DP family. */
		{ 0x7cf00000, 0x28800000,	RTL_GIGA_MAC_VER_27 },
		{ 0x7cf00000, 0x28a00000,	RTL_GIGA_MAC_VER_28 },
2571
		{ 0x7cf00000, 0x28b00000,	RTL_GIGA_MAC_VER_31 },
F
françois romieu 已提交
2572

2573
		/* 8168C family. */
2574
		{ 0x7cf00000, 0x3cb00000,	RTL_GIGA_MAC_VER_24 },
F
Francois Romieu 已提交
2575
		{ 0x7cf00000, 0x3c900000,	RTL_GIGA_MAC_VER_23 },
2576
		{ 0x7cf00000, 0x3c800000,	RTL_GIGA_MAC_VER_18 },
2577
		{ 0x7c800000, 0x3c800000,	RTL_GIGA_MAC_VER_24 },
F
Francois Romieu 已提交
2578 2579
		{ 0x7cf00000, 0x3c000000,	RTL_GIGA_MAC_VER_19 },
		{ 0x7cf00000, 0x3c200000,	RTL_GIGA_MAC_VER_20 },
F
Francois Romieu 已提交
2580
		{ 0x7cf00000, 0x3c300000,	RTL_GIGA_MAC_VER_21 },
2581
		{ 0x7cf00000, 0x3c400000,	RTL_GIGA_MAC_VER_22 },
2582
		{ 0x7c800000, 0x3c000000,	RTL_GIGA_MAC_VER_22 },
F
Francois Romieu 已提交
2583 2584 2585 2586 2587 2588 2589 2590

		/* 8168B family. */
		{ 0x7cf00000, 0x38000000,	RTL_GIGA_MAC_VER_12 },
		{ 0x7cf00000, 0x38500000,	RTL_GIGA_MAC_VER_17 },
		{ 0x7c800000, 0x38000000,	RTL_GIGA_MAC_VER_17 },
		{ 0x7c800000, 0x30000000,	RTL_GIGA_MAC_VER_11 },

		/* 8101 family. */
H
Hayes Wang 已提交
2591 2592
		{ 0x7cf00000, 0x44900000,	RTL_GIGA_MAC_VER_39 },
		{ 0x7c800000, 0x44800000,	RTL_GIGA_MAC_VER_39 },
2593
		{ 0x7c800000, 0x44000000,	RTL_GIGA_MAC_VER_37 },
2594
		{ 0x7cf00000, 0x40b00000,	RTL_GIGA_MAC_VER_30 },
2595 2596 2597
		{ 0x7cf00000, 0x40a00000,	RTL_GIGA_MAC_VER_30 },
		{ 0x7cf00000, 0x40900000,	RTL_GIGA_MAC_VER_29 },
		{ 0x7c800000, 0x40800000,	RTL_GIGA_MAC_VER_30 },
2598 2599 2600 2601 2602 2603
		{ 0x7cf00000, 0x34a00000,	RTL_GIGA_MAC_VER_09 },
		{ 0x7cf00000, 0x24a00000,	RTL_GIGA_MAC_VER_09 },
		{ 0x7cf00000, 0x34900000,	RTL_GIGA_MAC_VER_08 },
		{ 0x7cf00000, 0x24900000,	RTL_GIGA_MAC_VER_08 },
		{ 0x7cf00000, 0x34800000,	RTL_GIGA_MAC_VER_07 },
		{ 0x7cf00000, 0x24800000,	RTL_GIGA_MAC_VER_07 },
F
Francois Romieu 已提交
2604
		{ 0x7cf00000, 0x34000000,	RTL_GIGA_MAC_VER_13 },
2605
		{ 0x7cf00000, 0x34300000,	RTL_GIGA_MAC_VER_10 },
F
Francois Romieu 已提交
2606
		{ 0x7cf00000, 0x34200000,	RTL_GIGA_MAC_VER_16 },
2607 2608
		{ 0x7c800000, 0x34800000,	RTL_GIGA_MAC_VER_09 },
		{ 0x7c800000, 0x24800000,	RTL_GIGA_MAC_VER_09 },
F
Francois Romieu 已提交
2609 2610 2611 2612 2613 2614 2615 2616 2617 2618 2619 2620 2621
		{ 0x7c800000, 0x34000000,	RTL_GIGA_MAC_VER_16 },
		/* FIXME: where did these entries come from ? -- FR */
		{ 0xfc800000, 0x38800000,	RTL_GIGA_MAC_VER_15 },
		{ 0xfc800000, 0x30800000,	RTL_GIGA_MAC_VER_14 },

		/* 8110 family. */
		{ 0xfc800000, 0x98000000,	RTL_GIGA_MAC_VER_06 },
		{ 0xfc800000, 0x18000000,	RTL_GIGA_MAC_VER_05 },
		{ 0xfc800000, 0x10000000,	RTL_GIGA_MAC_VER_04 },
		{ 0xfc800000, 0x04000000,	RTL_GIGA_MAC_VER_03 },
		{ 0xfc800000, 0x00800000,	RTL_GIGA_MAC_VER_02 },
		{ 0xfc800000, 0x00000000,	RTL_GIGA_MAC_VER_01 },

2622 2623
		/* Catch-all */
		{ 0x00000000, 0x00000000,	RTL_GIGA_MAC_NONE   }
2624 2625
	};
	const struct rtl_mac_info *p = mac_info;
L
Linus Torvalds 已提交
2626 2627
	u32 reg;

2628
	reg = RTL_R32(tp, TxConfig);
F
Francois Romieu 已提交
2629
	while ((reg & p->mask) != p->val)
L
Linus Torvalds 已提交
2630 2631
		p++;
	tp->mac_version = p->mac_version;
2632 2633 2634 2635 2636

	if (tp->mac_version == RTL_GIGA_MAC_NONE) {
		netif_notice(tp, probe, dev,
			     "unknown MAC, using family default\n");
		tp->mac_version = default_version;
H
hayeswang 已提交
2637 2638 2639 2640
	} else if (tp->mac_version == RTL_GIGA_MAC_VER_42) {
		tp->mac_version = tp->mii.supports_gmii ?
				  RTL_GIGA_MAC_VER_42 :
				  RTL_GIGA_MAC_VER_43;
2641 2642 2643 2644 2645 2646 2647 2648
	} else if (tp->mac_version == RTL_GIGA_MAC_VER_45) {
		tp->mac_version = tp->mii.supports_gmii ?
				  RTL_GIGA_MAC_VER_45 :
				  RTL_GIGA_MAC_VER_47;
	} else if (tp->mac_version == RTL_GIGA_MAC_VER_46) {
		tp->mac_version = tp->mii.supports_gmii ?
				  RTL_GIGA_MAC_VER_46 :
				  RTL_GIGA_MAC_VER_48;
2649
	}
L
Linus Torvalds 已提交
2650 2651 2652 2653
}

static void rtl8169_print_mac_version(struct rtl8169_private *tp)
{
2654
	dprintk("mac_version = 0x%02x\n", tp->mac_version);
L
Linus Torvalds 已提交
2655 2656
}

F
Francois Romieu 已提交
2657 2658 2659 2660 2661
struct phy_reg {
	u16 reg;
	u16 val;
};

2662 2663
static void rtl_writephy_batch(struct rtl8169_private *tp,
			       const struct phy_reg *regs, int len)
F
Francois Romieu 已提交
2664 2665
{
	while (len-- > 0) {
2666
		rtl_writephy(tp, regs->reg, regs->val);
F
Francois Romieu 已提交
2667 2668 2669 2670
		regs++;
	}
}

2671 2672 2673 2674
#define PHY_READ		0x00000000
#define PHY_DATA_OR		0x10000000
#define PHY_DATA_AND		0x20000000
#define PHY_BJMPN		0x30000000
2675
#define PHY_MDIO_CHG		0x40000000
2676 2677 2678 2679 2680 2681 2682 2683 2684
#define PHY_CLEAR_READCOUNT	0x70000000
#define PHY_WRITE		0x80000000
#define PHY_READCOUNT_EQ_SKIP	0x90000000
#define PHY_COMP_EQ_SKIPN	0xa0000000
#define PHY_COMP_NEQ_SKIPN	0xb0000000
#define PHY_WRITE_PREVIOUS	0xc0000000
#define PHY_SKIPN		0xd0000000
#define PHY_DELAY_MS		0xe0000000

H
Hayes Wang 已提交
2685 2686 2687 2688 2689 2690 2691 2692
struct fw_info {
	u32	magic;
	char	version[RTL_VER_SIZE];
	__le32	fw_start;
	__le32	fw_len;
	u8	chksum;
} __packed;

2693 2694 2695
#define FW_OPCODE_SIZE	sizeof(typeof(*((struct rtl_fw_phy_action *)0)->code))

static bool rtl_fw_format_ok(struct rtl8169_private *tp, struct rtl_fw *rtl_fw)
2696
{
2697
	const struct firmware *fw = rtl_fw->fw;
H
Hayes Wang 已提交
2698
	struct fw_info *fw_info = (struct fw_info *)fw->data;
2699 2700 2701 2702 2703 2704
	struct rtl_fw_phy_action *pa = &rtl_fw->phy_action;
	char *version = rtl_fw->version;
	bool rc = false;

	if (fw->size < FW_OPCODE_SIZE)
		goto out;
H
Hayes Wang 已提交
2705 2706 2707 2708 2709 2710 2711 2712 2713 2714 2715 2716 2717 2718 2719 2720 2721 2722 2723 2724 2725 2726 2727 2728 2729 2730

	if (!fw_info->magic) {
		size_t i, size, start;
		u8 checksum = 0;

		if (fw->size < sizeof(*fw_info))
			goto out;

		for (i = 0; i < fw->size; i++)
			checksum += fw->data[i];
		if (checksum != 0)
			goto out;

		start = le32_to_cpu(fw_info->fw_start);
		if (start > fw->size)
			goto out;

		size = le32_to_cpu(fw_info->fw_len);
		if (size > (fw->size - start) / FW_OPCODE_SIZE)
			goto out;

		memcpy(version, fw_info->version, RTL_VER_SIZE);

		pa->code = (__le32 *)(fw->data + start);
		pa->size = size;
	} else {
2731 2732 2733 2734 2735 2736 2737 2738 2739 2740 2741 2742 2743 2744 2745
		if (fw->size % FW_OPCODE_SIZE)
			goto out;

		strlcpy(version, rtl_lookup_firmware_name(tp), RTL_VER_SIZE);

		pa->code = (__le32 *)fw->data;
		pa->size = fw->size / FW_OPCODE_SIZE;
	}
	version[RTL_VER_SIZE - 1] = 0;

	rc = true;
out:
	return rc;
}

2746 2747
static bool rtl_fw_data_ok(struct rtl8169_private *tp, struct net_device *dev,
			   struct rtl_fw_phy_action *pa)
2748
{
2749
	bool rc = false;
2750
	size_t index;
2751

2752 2753
	for (index = 0; index < pa->size; index++) {
		u32 action = le32_to_cpu(pa->code[index]);
2754
		u32 regno = (action & 0x0fff0000) >> 16;
2755

2756 2757 2758 2759
		switch(action & 0xf0000000) {
		case PHY_READ:
		case PHY_DATA_OR:
		case PHY_DATA_AND:
2760
		case PHY_MDIO_CHG:
2761 2762 2763 2764 2765 2766 2767 2768
		case PHY_CLEAR_READCOUNT:
		case PHY_WRITE:
		case PHY_WRITE_PREVIOUS:
		case PHY_DELAY_MS:
			break;

		case PHY_BJMPN:
			if (regno > index) {
2769
				netif_err(tp, ifup, tp->dev,
F
Francois Romieu 已提交
2770
					  "Out of range of firmware\n");
2771
				goto out;
2772 2773 2774
			}
			break;
		case PHY_READCOUNT_EQ_SKIP:
2775
			if (index + 2 >= pa->size) {
2776
				netif_err(tp, ifup, tp->dev,
F
Francois Romieu 已提交
2777
					  "Out of range of firmware\n");
2778
				goto out;
2779 2780 2781 2782 2783
			}
			break;
		case PHY_COMP_EQ_SKIPN:
		case PHY_COMP_NEQ_SKIPN:
		case PHY_SKIPN:
2784
			if (index + 1 + regno >= pa->size) {
2785
				netif_err(tp, ifup, tp->dev,
F
Francois Romieu 已提交
2786
					  "Out of range of firmware\n");
2787
				goto out;
2788
			}
2789 2790
			break;

2791
		default:
2792
			netif_err(tp, ifup, tp->dev,
2793
				  "Invalid action 0x%08x\n", action);
2794
			goto out;
2795 2796
		}
	}
2797 2798 2799 2800
	rc = true;
out:
	return rc;
}
2801

2802 2803 2804 2805 2806 2807
static int rtl_check_firmware(struct rtl8169_private *tp, struct rtl_fw *rtl_fw)
{
	struct net_device *dev = tp->dev;
	int rc = -EINVAL;

	if (!rtl_fw_format_ok(tp, rtl_fw)) {
2808
		netif_err(tp, ifup, dev, "invalid firmware\n");
2809 2810 2811 2812 2813 2814 2815 2816 2817 2818 2819 2820
		goto out;
	}

	if (rtl_fw_data_ok(tp, dev, &rtl_fw->phy_action))
		rc = 0;
out:
	return rc;
}

static void rtl_phy_write_fw(struct rtl8169_private *tp, struct rtl_fw *rtl_fw)
{
	struct rtl_fw_phy_action *pa = &rtl_fw->phy_action;
2821
	struct mdio_ops org, *ops = &tp->mdio_ops;
2822 2823 2824 2825
	u32 predata, count;
	size_t index;

	predata = count = 0;
2826 2827
	org.write = ops->write;
	org.read = ops->read;
2828

2829 2830
	for (index = 0; index < pa->size; ) {
		u32 action = le32_to_cpu(pa->code[index]);
2831
		u32 data = action & 0x0000ffff;
2832 2833 2834 2835
		u32 regno = (action & 0x0fff0000) >> 16;

		if (!action)
			break;
2836 2837

		switch(action & 0xf0000000) {
2838 2839 2840 2841 2842 2843 2844 2845 2846 2847 2848 2849 2850 2851 2852 2853
		case PHY_READ:
			predata = rtl_readphy(tp, regno);
			count++;
			index++;
			break;
		case PHY_DATA_OR:
			predata |= data;
			index++;
			break;
		case PHY_DATA_AND:
			predata &= data;
			index++;
			break;
		case PHY_BJMPN:
			index -= regno;
			break;
2854 2855 2856 2857 2858 2859 2860 2861 2862
		case PHY_MDIO_CHG:
			if (data == 0) {
				ops->write = org.write;
				ops->read = org.read;
			} else if (data == 1) {
				ops->write = mac_mcu_write;
				ops->read = mac_mcu_read;
			}

2863 2864 2865 2866 2867 2868
			index++;
			break;
		case PHY_CLEAR_READCOUNT:
			count = 0;
			index++;
			break;
2869
		case PHY_WRITE:
2870 2871 2872 2873
			rtl_writephy(tp, regno, data);
			index++;
			break;
		case PHY_READCOUNT_EQ_SKIP:
F
Francois Romieu 已提交
2874
			index += (count == data) ? 2 : 1;
2875
			break;
2876 2877 2878 2879 2880 2881 2882 2883 2884 2885 2886 2887 2888 2889 2890 2891 2892 2893 2894 2895 2896 2897
		case PHY_COMP_EQ_SKIPN:
			if (predata == data)
				index += regno;
			index++;
			break;
		case PHY_COMP_NEQ_SKIPN:
			if (predata != data)
				index += regno;
			index++;
			break;
		case PHY_WRITE_PREVIOUS:
			rtl_writephy(tp, regno, predata);
			index++;
			break;
		case PHY_SKIPN:
			index += regno + 1;
			break;
		case PHY_DELAY_MS:
			mdelay(data);
			index++;
			break;

2898 2899 2900 2901
		default:
			BUG();
		}
	}
2902 2903 2904

	ops->write = org.write;
	ops->read = org.read;
2905 2906
}

2907 2908
static void rtl_release_firmware(struct rtl8169_private *tp)
{
2909 2910 2911 2912 2913
	if (!IS_ERR_OR_NULL(tp->rtl_fw)) {
		release_firmware(tp->rtl_fw->fw);
		kfree(tp->rtl_fw);
	}
	tp->rtl_fw = RTL_FIRMWARE_UNKNOWN;
2914 2915
}

2916
static void rtl_apply_firmware(struct rtl8169_private *tp)
2917
{
2918
	struct rtl_fw *rtl_fw = tp->rtl_fw;
2919 2920

	/* TODO: release firmware once rtl_phy_write_fw signals failures. */
2921
	if (!IS_ERR_OR_NULL(rtl_fw))
2922
		rtl_phy_write_fw(tp, rtl_fw);
2923 2924 2925 2926 2927 2928 2929 2930
}

static void rtl_apply_firmware_cond(struct rtl8169_private *tp, u8 reg, u16 val)
{
	if (rtl_readphy(tp, reg) != val)
		netif_warn(tp, hw, tp->dev, "chipset not ready for firmware\n");
	else
		rtl_apply_firmware(tp);
2931 2932
}

2933
static void rtl8169s_hw_phy_config(struct rtl8169_private *tp)
L
Linus Torvalds 已提交
2934
{
2935
	static const struct phy_reg phy_reg_init[] = {
F
françois romieu 已提交
2936 2937 2938 2939 2940
		{ 0x1f, 0x0001 },
		{ 0x06, 0x006e },
		{ 0x08, 0x0708 },
		{ 0x15, 0x4000 },
		{ 0x18, 0x65c7 },
L
Linus Torvalds 已提交
2941

F
françois romieu 已提交
2942 2943 2944 2945 2946 2947 2948
		{ 0x1f, 0x0001 },
		{ 0x03, 0x00a1 },
		{ 0x02, 0x0008 },
		{ 0x01, 0x0120 },
		{ 0x00, 0x1000 },
		{ 0x04, 0x0800 },
		{ 0x04, 0x0000 },
L
Linus Torvalds 已提交
2949

F
françois romieu 已提交
2950 2951 2952 2953 2954 2955 2956 2957 2958 2959 2960 2961 2962 2963 2964 2965 2966 2967 2968 2969 2970 2971 2972 2973 2974 2975 2976 2977 2978 2979 2980 2981 2982 2983 2984 2985 2986 2987 2988 2989 2990 2991 2992 2993 2994 2995
		{ 0x03, 0xff41 },
		{ 0x02, 0xdf60 },
		{ 0x01, 0x0140 },
		{ 0x00, 0x0077 },
		{ 0x04, 0x7800 },
		{ 0x04, 0x7000 },

		{ 0x03, 0x802f },
		{ 0x02, 0x4f02 },
		{ 0x01, 0x0409 },
		{ 0x00, 0xf0f9 },
		{ 0x04, 0x9800 },
		{ 0x04, 0x9000 },

		{ 0x03, 0xdf01 },
		{ 0x02, 0xdf20 },
		{ 0x01, 0xff95 },
		{ 0x00, 0xba00 },
		{ 0x04, 0xa800 },
		{ 0x04, 0xa000 },

		{ 0x03, 0xff41 },
		{ 0x02, 0xdf20 },
		{ 0x01, 0x0140 },
		{ 0x00, 0x00bb },
		{ 0x04, 0xb800 },
		{ 0x04, 0xb000 },

		{ 0x03, 0xdf41 },
		{ 0x02, 0xdc60 },
		{ 0x01, 0x6340 },
		{ 0x00, 0x007d },
		{ 0x04, 0xd800 },
		{ 0x04, 0xd000 },

		{ 0x03, 0xdf01 },
		{ 0x02, 0xdf20 },
		{ 0x01, 0x100a },
		{ 0x00, 0xa0ff },
		{ 0x04, 0xf800 },
		{ 0x04, 0xf000 },

		{ 0x1f, 0x0000 },
		{ 0x0b, 0x0000 },
		{ 0x00, 0x9200 }
	};
L
Linus Torvalds 已提交
2996

2997
	rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
L
Linus Torvalds 已提交
2998 2999
}

3000
static void rtl8169sb_hw_phy_config(struct rtl8169_private *tp)
3001
{
3002
	static const struct phy_reg phy_reg_init[] = {
F
Francois Romieu 已提交
3003 3004 3005 3006 3007
		{ 0x1f, 0x0002 },
		{ 0x01, 0x90d0 },
		{ 0x1f, 0x0000 }
	};

3008
	rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
3009 3010
}

3011
static void rtl8169scd_hw_phy_config_quirk(struct rtl8169_private *tp)
3012 3013 3014
{
	struct pci_dev *pdev = tp->pci_dev;

3015 3016
	if ((pdev->subsystem_vendor != PCI_VENDOR_ID_GIGABYTE) ||
	    (pdev->subsystem_device != 0xe000))
3017 3018
		return;

3019 3020 3021
	rtl_writephy(tp, 0x1f, 0x0001);
	rtl_writephy(tp, 0x10, 0xf01b);
	rtl_writephy(tp, 0x1f, 0x0000);
3022 3023
}

3024
static void rtl8169scd_hw_phy_config(struct rtl8169_private *tp)
3025
{
3026
	static const struct phy_reg phy_reg_init[] = {
3027 3028 3029 3030 3031 3032 3033 3034 3035 3036 3037 3038 3039 3040 3041 3042 3043 3044 3045 3046 3047 3048 3049 3050 3051 3052 3053 3054 3055 3056 3057 3058 3059 3060 3061 3062 3063 3064 3065
		{ 0x1f, 0x0001 },
		{ 0x04, 0x0000 },
		{ 0x03, 0x00a1 },
		{ 0x02, 0x0008 },
		{ 0x01, 0x0120 },
		{ 0x00, 0x1000 },
		{ 0x04, 0x0800 },
		{ 0x04, 0x9000 },
		{ 0x03, 0x802f },
		{ 0x02, 0x4f02 },
		{ 0x01, 0x0409 },
		{ 0x00, 0xf099 },
		{ 0x04, 0x9800 },
		{ 0x04, 0xa000 },
		{ 0x03, 0xdf01 },
		{ 0x02, 0xdf20 },
		{ 0x01, 0xff95 },
		{ 0x00, 0xba00 },
		{ 0x04, 0xa800 },
		{ 0x04, 0xf000 },
		{ 0x03, 0xdf01 },
		{ 0x02, 0xdf20 },
		{ 0x01, 0x101a },
		{ 0x00, 0xa0ff },
		{ 0x04, 0xf800 },
		{ 0x04, 0x0000 },
		{ 0x1f, 0x0000 },

		{ 0x1f, 0x0001 },
		{ 0x10, 0xf41b },
		{ 0x14, 0xfb54 },
		{ 0x18, 0xf5c7 },
		{ 0x1f, 0x0000 },

		{ 0x1f, 0x0001 },
		{ 0x17, 0x0cc0 },
		{ 0x1f, 0x0000 }
	};

3066
	rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
3067

3068
	rtl8169scd_hw_phy_config_quirk(tp);
3069 3070
}

3071
static void rtl8169sce_hw_phy_config(struct rtl8169_private *tp)
3072
{
3073
	static const struct phy_reg phy_reg_init[] = {
3074 3075 3076 3077 3078 3079 3080 3081 3082 3083 3084 3085 3086 3087 3088 3089 3090 3091 3092 3093 3094 3095 3096 3097 3098 3099 3100 3101 3102 3103 3104 3105 3106 3107 3108 3109 3110 3111 3112 3113 3114 3115 3116 3117 3118 3119 3120
		{ 0x1f, 0x0001 },
		{ 0x04, 0x0000 },
		{ 0x03, 0x00a1 },
		{ 0x02, 0x0008 },
		{ 0x01, 0x0120 },
		{ 0x00, 0x1000 },
		{ 0x04, 0x0800 },
		{ 0x04, 0x9000 },
		{ 0x03, 0x802f },
		{ 0x02, 0x4f02 },
		{ 0x01, 0x0409 },
		{ 0x00, 0xf099 },
		{ 0x04, 0x9800 },
		{ 0x04, 0xa000 },
		{ 0x03, 0xdf01 },
		{ 0x02, 0xdf20 },
		{ 0x01, 0xff95 },
		{ 0x00, 0xba00 },
		{ 0x04, 0xa800 },
		{ 0x04, 0xf000 },
		{ 0x03, 0xdf01 },
		{ 0x02, 0xdf20 },
		{ 0x01, 0x101a },
		{ 0x00, 0xa0ff },
		{ 0x04, 0xf800 },
		{ 0x04, 0x0000 },
		{ 0x1f, 0x0000 },

		{ 0x1f, 0x0001 },
		{ 0x0b, 0x8480 },
		{ 0x1f, 0x0000 },

		{ 0x1f, 0x0001 },
		{ 0x18, 0x67c7 },
		{ 0x04, 0x2000 },
		{ 0x03, 0x002f },
		{ 0x02, 0x4360 },
		{ 0x01, 0x0109 },
		{ 0x00, 0x3022 },
		{ 0x04, 0x2800 },
		{ 0x1f, 0x0000 },

		{ 0x1f, 0x0001 },
		{ 0x17, 0x0cc0 },
		{ 0x1f, 0x0000 }
	};

3121
	rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
3122 3123
}

3124
static void rtl8168bb_hw_phy_config(struct rtl8169_private *tp)
3125
{
3126
	static const struct phy_reg phy_reg_init[] = {
3127 3128 3129 3130
		{ 0x10, 0xf41b },
		{ 0x1f, 0x0000 }
	};

3131 3132
	rtl_writephy(tp, 0x1f, 0x0001);
	rtl_patchphy(tp, 0x16, 1 << 0);
3133

3134
	rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
3135 3136
}

3137
static void rtl8168bef_hw_phy_config(struct rtl8169_private *tp)
3138
{
3139
	static const struct phy_reg phy_reg_init[] = {
3140 3141 3142 3143 3144
		{ 0x1f, 0x0001 },
		{ 0x10, 0xf41b },
		{ 0x1f, 0x0000 }
	};

3145
	rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
3146 3147
}

3148
static void rtl8168cp_1_hw_phy_config(struct rtl8169_private *tp)
F
Francois Romieu 已提交
3149
{
3150
	static const struct phy_reg phy_reg_init[] = {
F
Francois Romieu 已提交
3151 3152 3153 3154 3155 3156 3157
		{ 0x1f, 0x0000 },
		{ 0x1d, 0x0f00 },
		{ 0x1f, 0x0002 },
		{ 0x0c, 0x1ec8 },
		{ 0x1f, 0x0000 }
	};

3158
	rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
F
Francois Romieu 已提交
3159 3160
}

3161
static void rtl8168cp_2_hw_phy_config(struct rtl8169_private *tp)
F
Francois Romieu 已提交
3162
{
3163
	static const struct phy_reg phy_reg_init[] = {
F
Francois Romieu 已提交
3164 3165 3166 3167 3168
		{ 0x1f, 0x0001 },
		{ 0x1d, 0x3d98 },
		{ 0x1f, 0x0000 }
	};

3169 3170 3171
	rtl_writephy(tp, 0x1f, 0x0000);
	rtl_patchphy(tp, 0x14, 1 << 5);
	rtl_patchphy(tp, 0x0d, 1 << 5);
F
Francois Romieu 已提交
3172

3173
	rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
F
Francois Romieu 已提交
3174 3175
}

3176
static void rtl8168c_1_hw_phy_config(struct rtl8169_private *tp)
F
Francois Romieu 已提交
3177
{
3178
	static const struct phy_reg phy_reg_init[] = {
3179 3180
		{ 0x1f, 0x0001 },
		{ 0x12, 0x2300 },
F
Francois Romieu 已提交
3181 3182 3183 3184 3185 3186 3187 3188 3189 3190 3191
		{ 0x1f, 0x0002 },
		{ 0x00, 0x88d4 },
		{ 0x01, 0x82b1 },
		{ 0x03, 0x7002 },
		{ 0x08, 0x9e30 },
		{ 0x09, 0x01f0 },
		{ 0x0a, 0x5500 },
		{ 0x0c, 0x00c8 },
		{ 0x1f, 0x0003 },
		{ 0x12, 0xc096 },
		{ 0x16, 0x000a },
3192 3193 3194 3195
		{ 0x1f, 0x0000 },
		{ 0x1f, 0x0000 },
		{ 0x09, 0x2000 },
		{ 0x09, 0x0000 }
F
Francois Romieu 已提交
3196 3197
	};

3198
	rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
3199

3200 3201 3202
	rtl_patchphy(tp, 0x14, 1 << 5);
	rtl_patchphy(tp, 0x0d, 1 << 5);
	rtl_writephy(tp, 0x1f, 0x0000);
F
Francois Romieu 已提交
3203 3204
}

3205
static void rtl8168c_2_hw_phy_config(struct rtl8169_private *tp)
3206
{
3207
	static const struct phy_reg phy_reg_init[] = {
3208
		{ 0x1f, 0x0001 },
3209
		{ 0x12, 0x2300 },
3210 3211 3212 3213 3214 3215 3216
		{ 0x03, 0x802f },
		{ 0x02, 0x4f02 },
		{ 0x01, 0x0409 },
		{ 0x00, 0xf099 },
		{ 0x04, 0x9800 },
		{ 0x04, 0x9000 },
		{ 0x1d, 0x3d98 },
3217 3218
		{ 0x1f, 0x0002 },
		{ 0x0c, 0x7eb8 },
3219 3220 3221
		{ 0x06, 0x0761 },
		{ 0x1f, 0x0003 },
		{ 0x16, 0x0f0a },
3222 3223 3224
		{ 0x1f, 0x0000 }
	};

3225
	rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
3226

3227 3228 3229 3230
	rtl_patchphy(tp, 0x16, 1 << 0);
	rtl_patchphy(tp, 0x14, 1 << 5);
	rtl_patchphy(tp, 0x0d, 1 << 5);
	rtl_writephy(tp, 0x1f, 0x0000);
3231 3232
}

3233
static void rtl8168c_3_hw_phy_config(struct rtl8169_private *tp)
F
Francois Romieu 已提交
3234
{
3235
	static const struct phy_reg phy_reg_init[] = {
F
Francois Romieu 已提交
3236 3237 3238 3239 3240 3241 3242 3243 3244 3245 3246
		{ 0x1f, 0x0001 },
		{ 0x12, 0x2300 },
		{ 0x1d, 0x3d98 },
		{ 0x1f, 0x0002 },
		{ 0x0c, 0x7eb8 },
		{ 0x06, 0x5461 },
		{ 0x1f, 0x0003 },
		{ 0x16, 0x0f0a },
		{ 0x1f, 0x0000 }
	};

3247
	rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
F
Francois Romieu 已提交
3248

3249 3250 3251 3252
	rtl_patchphy(tp, 0x16, 1 << 0);
	rtl_patchphy(tp, 0x14, 1 << 5);
	rtl_patchphy(tp, 0x0d, 1 << 5);
	rtl_writephy(tp, 0x1f, 0x0000);
F
Francois Romieu 已提交
3253 3254
}

3255
static void rtl8168c_4_hw_phy_config(struct rtl8169_private *tp)
3256
{
3257
	rtl8168c_3_hw_phy_config(tp);
3258 3259
}

3260
static void rtl8168d_1_hw_phy_config(struct rtl8169_private *tp)
F
Francois Romieu 已提交
3261
{
3262
	static const struct phy_reg phy_reg_init_0[] = {
3263
		/* Channel Estimation */
F
Francois Romieu 已提交
3264
		{ 0x1f, 0x0001 },
3265 3266 3267 3268 3269 3270 3271 3272 3273 3274 3275
		{ 0x06, 0x4064 },
		{ 0x07, 0x2863 },
		{ 0x08, 0x059c },
		{ 0x09, 0x26b4 },
		{ 0x0a, 0x6a19 },
		{ 0x0b, 0xdcc8 },
		{ 0x10, 0xf06d },
		{ 0x14, 0x7f68 },
		{ 0x18, 0x7fd9 },
		{ 0x1c, 0xf0ff },
		{ 0x1d, 0x3d9c },
F
Francois Romieu 已提交
3276
		{ 0x1f, 0x0003 },
3277 3278 3279
		{ 0x12, 0xf49f },
		{ 0x13, 0x070b },
		{ 0x1a, 0x05ad },
3280 3281 3282 3283
		{ 0x14, 0x94c0 },

		/*
		 * Tx Error Issue
F
Francois Romieu 已提交
3284
		 * Enhance line driver power
3285
		 */
F
Francois Romieu 已提交
3286
		{ 0x1f, 0x0002 },
3287 3288 3289
		{ 0x06, 0x5561 },
		{ 0x1f, 0x0005 },
		{ 0x05, 0x8332 },
3290 3291 3292 3293 3294 3295 3296 3297
		{ 0x06, 0x5561 },

		/*
		 * Can not link to 1Gbps with bad cable
		 * Decrease SNR threshold form 21.07dB to 19.04dB
		 */
		{ 0x1f, 0x0001 },
		{ 0x17, 0x0cc0 },
3298

F
Francois Romieu 已提交
3299
		{ 0x1f, 0x0000 },
3300
		{ 0x0d, 0xf880 }
3301 3302
	};

3303
	rtl_writephy_batch(tp, phy_reg_init_0, ARRAY_SIZE(phy_reg_init_0));
3304

3305 3306 3307 3308
	/*
	 * Rx Error Issue
	 * Fine Tune Switching regulator parameter
	 */
3309
	rtl_writephy(tp, 0x1f, 0x0002);
3310 3311
	rtl_w0w1_phy(tp, 0x0b, 0x0010, 0x00ef);
	rtl_w0w1_phy(tp, 0x0c, 0xa200, 0x5d00);
3312

3313
	if (rtl8168d_efuse_read(tp, 0x01) == 0xb1) {
3314
		static const struct phy_reg phy_reg_init[] = {
3315 3316 3317 3318 3319 3320 3321 3322 3323
			{ 0x1f, 0x0002 },
			{ 0x05, 0x669a },
			{ 0x1f, 0x0005 },
			{ 0x05, 0x8330 },
			{ 0x06, 0x669a },
			{ 0x1f, 0x0002 }
		};
		int val;

3324
		rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
3325

3326
		val = rtl_readphy(tp, 0x0d);
3327 3328

		if ((val & 0x00ff) != 0x006c) {
3329
			static const u32 set[] = {
3330 3331 3332 3333 3334
				0x0065, 0x0066, 0x0067, 0x0068,
				0x0069, 0x006a, 0x006b, 0x006c
			};
			int i;

3335
			rtl_writephy(tp, 0x1f, 0x0002);
3336 3337 3338

			val &= 0xff00;
			for (i = 0; i < ARRAY_SIZE(set); i++)
3339
				rtl_writephy(tp, 0x0d, val | set[i]);
3340 3341
		}
	} else {
3342
		static const struct phy_reg phy_reg_init[] = {
3343 3344 3345 3346 3347 3348 3349
			{ 0x1f, 0x0002 },
			{ 0x05, 0x6662 },
			{ 0x1f, 0x0005 },
			{ 0x05, 0x8330 },
			{ 0x06, 0x6662 }
		};

3350
		rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
3351 3352
	}

3353
	/* RSET couple improve */
3354 3355 3356
	rtl_writephy(tp, 0x1f, 0x0002);
	rtl_patchphy(tp, 0x0d, 0x0300);
	rtl_patchphy(tp, 0x0f, 0x0010);
3357

3358
	/* Fine tune PLL performance */
3359
	rtl_writephy(tp, 0x1f, 0x0002);
3360 3361
	rtl_w0w1_phy(tp, 0x02, 0x0100, 0x0600);
	rtl_w0w1_phy(tp, 0x03, 0x0000, 0xe000);
3362

3363 3364
	rtl_writephy(tp, 0x1f, 0x0005);
	rtl_writephy(tp, 0x05, 0x001b);
3365 3366

	rtl_apply_firmware_cond(tp, MII_EXPANSION, 0xbf00);
3367

3368
	rtl_writephy(tp, 0x1f, 0x0000);
3369 3370
}

3371
static void rtl8168d_2_hw_phy_config(struct rtl8169_private *tp)
3372
{
3373
	static const struct phy_reg phy_reg_init_0[] = {
3374
		/* Channel Estimation */
3375 3376 3377 3378 3379 3380 3381 3382 3383 3384 3385 3386 3387 3388 3389 3390 3391 3392
		{ 0x1f, 0x0001 },
		{ 0x06, 0x4064 },
		{ 0x07, 0x2863 },
		{ 0x08, 0x059c },
		{ 0x09, 0x26b4 },
		{ 0x0a, 0x6a19 },
		{ 0x0b, 0xdcc8 },
		{ 0x10, 0xf06d },
		{ 0x14, 0x7f68 },
		{ 0x18, 0x7fd9 },
		{ 0x1c, 0xf0ff },
		{ 0x1d, 0x3d9c },
		{ 0x1f, 0x0003 },
		{ 0x12, 0xf49f },
		{ 0x13, 0x070b },
		{ 0x1a, 0x05ad },
		{ 0x14, 0x94c0 },

3393 3394
		/*
		 * Tx Error Issue
F
Francois Romieu 已提交
3395
		 * Enhance line driver power
3396
		 */
3397 3398 3399 3400
		{ 0x1f, 0x0002 },
		{ 0x06, 0x5561 },
		{ 0x1f, 0x0005 },
		{ 0x05, 0x8332 },
3401 3402 3403 3404 3405 3406 3407 3408
		{ 0x06, 0x5561 },

		/*
		 * Can not link to 1Gbps with bad cable
		 * Decrease SNR threshold form 21.07dB to 19.04dB
		 */
		{ 0x1f, 0x0001 },
		{ 0x17, 0x0cc0 },
3409 3410

		{ 0x1f, 0x0000 },
3411
		{ 0x0d, 0xf880 }
F
Francois Romieu 已提交
3412 3413
	};

3414
	rtl_writephy_batch(tp, phy_reg_init_0, ARRAY_SIZE(phy_reg_init_0));
F
Francois Romieu 已提交
3415

3416
	if (rtl8168d_efuse_read(tp, 0x01) == 0xb1) {
3417
		static const struct phy_reg phy_reg_init[] = {
3418 3419
			{ 0x1f, 0x0002 },
			{ 0x05, 0x669a },
F
Francois Romieu 已提交
3420
			{ 0x1f, 0x0005 },
3421 3422 3423 3424 3425 3426 3427
			{ 0x05, 0x8330 },
			{ 0x06, 0x669a },

			{ 0x1f, 0x0002 }
		};
		int val;

3428
		rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
3429

3430
		val = rtl_readphy(tp, 0x0d);
3431
		if ((val & 0x00ff) != 0x006c) {
J
Joe Perches 已提交
3432
			static const u32 set[] = {
3433 3434 3435 3436 3437
				0x0065, 0x0066, 0x0067, 0x0068,
				0x0069, 0x006a, 0x006b, 0x006c
			};
			int i;

3438
			rtl_writephy(tp, 0x1f, 0x0002);
3439 3440 3441

			val &= 0xff00;
			for (i = 0; i < ARRAY_SIZE(set); i++)
3442
				rtl_writephy(tp, 0x0d, val | set[i]);
3443 3444
		}
	} else {
3445
		static const struct phy_reg phy_reg_init[] = {
3446 3447
			{ 0x1f, 0x0002 },
			{ 0x05, 0x2642 },
F
Francois Romieu 已提交
3448
			{ 0x1f, 0x0005 },
3449 3450
			{ 0x05, 0x8330 },
			{ 0x06, 0x2642 }
F
Francois Romieu 已提交
3451 3452
		};

3453
		rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
F
Francois Romieu 已提交
3454 3455
	}

3456
	/* Fine tune PLL performance */
3457
	rtl_writephy(tp, 0x1f, 0x0002);
3458 3459
	rtl_w0w1_phy(tp, 0x02, 0x0100, 0x0600);
	rtl_w0w1_phy(tp, 0x03, 0x0000, 0xe000);
3460

3461
	/* Switching regulator Slew rate */
3462 3463
	rtl_writephy(tp, 0x1f, 0x0002);
	rtl_patchphy(tp, 0x0f, 0x0017);
3464

3465 3466
	rtl_writephy(tp, 0x1f, 0x0005);
	rtl_writephy(tp, 0x05, 0x001b);
3467 3468

	rtl_apply_firmware_cond(tp, MII_EXPANSION, 0xb300);
3469

3470
	rtl_writephy(tp, 0x1f, 0x0000);
3471 3472
}

3473
static void rtl8168d_3_hw_phy_config(struct rtl8169_private *tp)
3474
{
3475
	static const struct phy_reg phy_reg_init[] = {
3476 3477 3478 3479 3480 3481 3482 3483 3484 3485 3486 3487 3488 3489 3490 3491 3492 3493 3494 3495 3496 3497 3498 3499 3500 3501 3502 3503 3504 3505 3506 3507 3508 3509 3510 3511 3512 3513 3514 3515 3516 3517 3518 3519 3520 3521 3522 3523 3524 3525 3526 3527 3528 3529 3530
		{ 0x1f, 0x0002 },
		{ 0x10, 0x0008 },
		{ 0x0d, 0x006c },

		{ 0x1f, 0x0000 },
		{ 0x0d, 0xf880 },

		{ 0x1f, 0x0001 },
		{ 0x17, 0x0cc0 },

		{ 0x1f, 0x0001 },
		{ 0x0b, 0xa4d8 },
		{ 0x09, 0x281c },
		{ 0x07, 0x2883 },
		{ 0x0a, 0x6b35 },
		{ 0x1d, 0x3da4 },
		{ 0x1c, 0xeffd },
		{ 0x14, 0x7f52 },
		{ 0x18, 0x7fc6 },
		{ 0x08, 0x0601 },
		{ 0x06, 0x4063 },
		{ 0x10, 0xf074 },
		{ 0x1f, 0x0003 },
		{ 0x13, 0x0789 },
		{ 0x12, 0xf4bd },
		{ 0x1a, 0x04fd },
		{ 0x14, 0x84b0 },
		{ 0x1f, 0x0000 },
		{ 0x00, 0x9200 },

		{ 0x1f, 0x0005 },
		{ 0x01, 0x0340 },
		{ 0x1f, 0x0001 },
		{ 0x04, 0x4000 },
		{ 0x03, 0x1d21 },
		{ 0x02, 0x0c32 },
		{ 0x01, 0x0200 },
		{ 0x00, 0x5554 },
		{ 0x04, 0x4800 },
		{ 0x04, 0x4000 },
		{ 0x04, 0xf000 },
		{ 0x03, 0xdf01 },
		{ 0x02, 0xdf20 },
		{ 0x01, 0x101a },
		{ 0x00, 0xa0ff },
		{ 0x04, 0xf800 },
		{ 0x04, 0xf000 },
		{ 0x1f, 0x0000 },

		{ 0x1f, 0x0007 },
		{ 0x1e, 0x0023 },
		{ 0x16, 0x0000 },
		{ 0x1f, 0x0000 }
	};

3531
	rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
F
Francois Romieu 已提交
3532 3533
}

F
françois romieu 已提交
3534 3535 3536 3537 3538 3539 3540 3541 3542 3543 3544 3545 3546 3547 3548 3549
static void rtl8168d_4_hw_phy_config(struct rtl8169_private *tp)
{
	static const struct phy_reg phy_reg_init[] = {
		{ 0x1f, 0x0001 },
		{ 0x17, 0x0cc0 },

		{ 0x1f, 0x0007 },
		{ 0x1e, 0x002d },
		{ 0x18, 0x0040 },
		{ 0x1f, 0x0000 }
	};

	rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
	rtl_patchphy(tp, 0x0d, 1 << 5);
}

H
Hayes Wang 已提交
3550
static void rtl8168e_1_hw_phy_config(struct rtl8169_private *tp)
H
hayeswang 已提交
3551 3552 3553 3554 3555 3556 3557 3558 3559 3560 3561 3562 3563 3564 3565 3566 3567 3568 3569 3570 3571 3572 3573 3574 3575 3576 3577 3578 3579
{
	static const struct phy_reg phy_reg_init[] = {
		/* Enable Delay cap */
		{ 0x1f, 0x0005 },
		{ 0x05, 0x8b80 },
		{ 0x06, 0xc896 },
		{ 0x1f, 0x0000 },

		/* Channel estimation fine tune */
		{ 0x1f, 0x0001 },
		{ 0x0b, 0x6c20 },
		{ 0x07, 0x2872 },
		{ 0x1c, 0xefff },
		{ 0x1f, 0x0003 },
		{ 0x14, 0x6420 },
		{ 0x1f, 0x0000 },

		/* Update PFM & 10M TX idle timer */
		{ 0x1f, 0x0007 },
		{ 0x1e, 0x002f },
		{ 0x15, 0x1919 },
		{ 0x1f, 0x0000 },

		{ 0x1f, 0x0007 },
		{ 0x1e, 0x00ac },
		{ 0x18, 0x0006 },
		{ 0x1f, 0x0000 }
	};

F
Francois Romieu 已提交
3580 3581
	rtl_apply_firmware(tp);

H
hayeswang 已提交
3582 3583 3584 3585 3586
	rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));

	/* DCO enable for 10M IDLE Power */
	rtl_writephy(tp, 0x1f, 0x0007);
	rtl_writephy(tp, 0x1e, 0x0023);
3587
	rtl_w0w1_phy(tp, 0x17, 0x0006, 0x0000);
H
hayeswang 已提交
3588 3589 3590 3591
	rtl_writephy(tp, 0x1f, 0x0000);

	/* For impedance matching */
	rtl_writephy(tp, 0x1f, 0x0002);
3592
	rtl_w0w1_phy(tp, 0x08, 0x8000, 0x7f00);
F
Francois Romieu 已提交
3593
	rtl_writephy(tp, 0x1f, 0x0000);
H
hayeswang 已提交
3594 3595 3596 3597

	/* PHY auto speed down */
	rtl_writephy(tp, 0x1f, 0x0007);
	rtl_writephy(tp, 0x1e, 0x002d);
3598
	rtl_w0w1_phy(tp, 0x18, 0x0050, 0x0000);
H
hayeswang 已提交
3599
	rtl_writephy(tp, 0x1f, 0x0000);
3600
	rtl_w0w1_phy(tp, 0x14, 0x8000, 0x0000);
H
hayeswang 已提交
3601 3602 3603

	rtl_writephy(tp, 0x1f, 0x0005);
	rtl_writephy(tp, 0x05, 0x8b86);
3604
	rtl_w0w1_phy(tp, 0x06, 0x0001, 0x0000);
H
hayeswang 已提交
3605 3606 3607 3608
	rtl_writephy(tp, 0x1f, 0x0000);

	rtl_writephy(tp, 0x1f, 0x0005);
	rtl_writephy(tp, 0x05, 0x8b85);
3609
	rtl_w0w1_phy(tp, 0x06, 0x0000, 0x2000);
H
hayeswang 已提交
3610 3611
	rtl_writephy(tp, 0x1f, 0x0007);
	rtl_writephy(tp, 0x1e, 0x0020);
3612
	rtl_w0w1_phy(tp, 0x15, 0x0000, 0x1100);
H
hayeswang 已提交
3613 3614 3615 3616 3617 3618 3619 3620 3621 3622
	rtl_writephy(tp, 0x1f, 0x0006);
	rtl_writephy(tp, 0x00, 0x5a00);
	rtl_writephy(tp, 0x1f, 0x0000);
	rtl_writephy(tp, 0x0d, 0x0007);
	rtl_writephy(tp, 0x0e, 0x003c);
	rtl_writephy(tp, 0x0d, 0x4007);
	rtl_writephy(tp, 0x0e, 0x0000);
	rtl_writephy(tp, 0x0d, 0x0000);
}

3623 3624 3625 3626 3627 3628 3629 3630 3631 3632 3633 3634 3635 3636 3637 3638 3639
static void rtl_rar_exgmac_set(struct rtl8169_private *tp, u8 *addr)
{
	const u16 w[] = {
		addr[0] | (addr[1] << 8),
		addr[2] | (addr[3] << 8),
		addr[4] | (addr[5] << 8)
	};
	const struct exgmac_reg e[] = {
		{ .addr = 0xe0, ERIAR_MASK_1111, .val = w[0] | (w[1] << 16) },
		{ .addr = 0xe4, ERIAR_MASK_1111, .val = w[2] },
		{ .addr = 0xf0, ERIAR_MASK_1111, .val = w[0] << 16 },
		{ .addr = 0xf4, ERIAR_MASK_1111, .val = w[1] | (w[2] << 16) }
	};

	rtl_write_exgmac_batch(tp, e, ARRAY_SIZE(e));
}

H
Hayes Wang 已提交
3640 3641 3642 3643 3644 3645 3646 3647 3648 3649 3650 3651 3652 3653 3654 3655 3656 3657 3658 3659 3660 3661 3662 3663 3664 3665 3666 3667 3668 3669 3670 3671 3672 3673 3674 3675
static void rtl8168e_2_hw_phy_config(struct rtl8169_private *tp)
{
	static const struct phy_reg phy_reg_init[] = {
		/* Enable Delay cap */
		{ 0x1f, 0x0004 },
		{ 0x1f, 0x0007 },
		{ 0x1e, 0x00ac },
		{ 0x18, 0x0006 },
		{ 0x1f, 0x0002 },
		{ 0x1f, 0x0000 },
		{ 0x1f, 0x0000 },

		/* Channel estimation fine tune */
		{ 0x1f, 0x0003 },
		{ 0x09, 0xa20f },
		{ 0x1f, 0x0000 },
		{ 0x1f, 0x0000 },

		/* Green Setting */
		{ 0x1f, 0x0005 },
		{ 0x05, 0x8b5b },
		{ 0x06, 0x9222 },
		{ 0x05, 0x8b6d },
		{ 0x06, 0x8000 },
		{ 0x05, 0x8b76 },
		{ 0x06, 0x8000 },
		{ 0x1f, 0x0000 }
	};

	rtl_apply_firmware(tp);

	rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));

	/* For 4-corner performance improve */
	rtl_writephy(tp, 0x1f, 0x0005);
	rtl_writephy(tp, 0x05, 0x8b80);
3676
	rtl_w0w1_phy(tp, 0x17, 0x0006, 0x0000);
H
Hayes Wang 已提交
3677 3678 3679 3680 3681 3682
	rtl_writephy(tp, 0x1f, 0x0000);

	/* PHY auto speed down */
	rtl_writephy(tp, 0x1f, 0x0004);
	rtl_writephy(tp, 0x1f, 0x0007);
	rtl_writephy(tp, 0x1e, 0x002d);
3683
	rtl_w0w1_phy(tp, 0x18, 0x0010, 0x0000);
H
Hayes Wang 已提交
3684 3685
	rtl_writephy(tp, 0x1f, 0x0002);
	rtl_writephy(tp, 0x1f, 0x0000);
3686
	rtl_w0w1_phy(tp, 0x14, 0x8000, 0x0000);
H
Hayes Wang 已提交
3687 3688 3689 3690

	/* improve 10M EEE waveform */
	rtl_writephy(tp, 0x1f, 0x0005);
	rtl_writephy(tp, 0x05, 0x8b86);
3691
	rtl_w0w1_phy(tp, 0x06, 0x0001, 0x0000);
H
Hayes Wang 已提交
3692 3693 3694 3695 3696
	rtl_writephy(tp, 0x1f, 0x0000);

	/* Improve 2-pair detection performance */
	rtl_writephy(tp, 0x1f, 0x0005);
	rtl_writephy(tp, 0x05, 0x8b85);
3697
	rtl_w0w1_phy(tp, 0x06, 0x4000, 0x0000);
H
Hayes Wang 已提交
3698 3699 3700
	rtl_writephy(tp, 0x1f, 0x0000);

	/* EEE setting */
3701
	rtl_w0w1_eri(tp, 0x1b0, ERIAR_MASK_1111, 0x0003, 0x0000, ERIAR_EXGMAC);
H
Hayes Wang 已提交
3702 3703
	rtl_writephy(tp, 0x1f, 0x0005);
	rtl_writephy(tp, 0x05, 0x8b85);
3704
	rtl_w0w1_phy(tp, 0x06, 0x2000, 0x0000);
H
Hayes Wang 已提交
3705 3706 3707
	rtl_writephy(tp, 0x1f, 0x0004);
	rtl_writephy(tp, 0x1f, 0x0007);
	rtl_writephy(tp, 0x1e, 0x0020);
3708
	rtl_w0w1_phy(tp, 0x15, 0x0100, 0x0000);
H
Hayes Wang 已提交
3709 3710 3711 3712 3713
	rtl_writephy(tp, 0x1f, 0x0002);
	rtl_writephy(tp, 0x1f, 0x0000);
	rtl_writephy(tp, 0x0d, 0x0007);
	rtl_writephy(tp, 0x0e, 0x003c);
	rtl_writephy(tp, 0x0d, 0x4007);
3714
	rtl_writephy(tp, 0x0e, 0x0006);
H
Hayes Wang 已提交
3715 3716 3717 3718
	rtl_writephy(tp, 0x0d, 0x0000);

	/* Green feature */
	rtl_writephy(tp, 0x1f, 0x0003);
3719 3720
	rtl_w0w1_phy(tp, 0x19, 0x0001, 0x0000);
	rtl_w0w1_phy(tp, 0x10, 0x0400, 0x0000);
H
Hayes Wang 已提交
3721
	rtl_writephy(tp, 0x1f, 0x0000);
3722 3723 3724
	rtl_writephy(tp, 0x1f, 0x0005);
	rtl_w0w1_phy(tp, 0x01, 0x0100, 0x0000);
	rtl_writephy(tp, 0x1f, 0x0000);
H
hayeswang 已提交
3725

3726 3727
	/* Broken BIOS workaround: feed GigaMAC registers with MAC address. */
	rtl_rar_exgmac_set(tp, tp->dev->dev_addr);
H
Hayes Wang 已提交
3728 3729
}

3730 3731 3732 3733 3734
static void rtl8168f_hw_phy_config(struct rtl8169_private *tp)
{
	/* For 4-corner performance improve */
	rtl_writephy(tp, 0x1f, 0x0005);
	rtl_writephy(tp, 0x05, 0x8b80);
3735
	rtl_w0w1_phy(tp, 0x06, 0x0006, 0x0000);
3736 3737 3738 3739 3740
	rtl_writephy(tp, 0x1f, 0x0000);

	/* PHY auto speed down */
	rtl_writephy(tp, 0x1f, 0x0007);
	rtl_writephy(tp, 0x1e, 0x002d);
3741
	rtl_w0w1_phy(tp, 0x18, 0x0010, 0x0000);
3742
	rtl_writephy(tp, 0x1f, 0x0000);
3743
	rtl_w0w1_phy(tp, 0x14, 0x8000, 0x0000);
3744 3745 3746 3747

	/* Improve 10M EEE waveform */
	rtl_writephy(tp, 0x1f, 0x0005);
	rtl_writephy(tp, 0x05, 0x8b86);
3748
	rtl_w0w1_phy(tp, 0x06, 0x0001, 0x0000);
3749 3750 3751
	rtl_writephy(tp, 0x1f, 0x0000);
}

3752 3753 3754 3755 3756 3757 3758 3759 3760 3761 3762 3763 3764 3765 3766 3767 3768 3769 3770 3771 3772 3773 3774 3775 3776 3777 3778 3779 3780 3781 3782 3783 3784 3785 3786 3787 3788 3789 3790 3791 3792
static void rtl8168f_1_hw_phy_config(struct rtl8169_private *tp)
{
	static const struct phy_reg phy_reg_init[] = {
		/* Channel estimation fine tune */
		{ 0x1f, 0x0003 },
		{ 0x09, 0xa20f },
		{ 0x1f, 0x0000 },

		/* Modify green table for giga & fnet */
		{ 0x1f, 0x0005 },
		{ 0x05, 0x8b55 },
		{ 0x06, 0x0000 },
		{ 0x05, 0x8b5e },
		{ 0x06, 0x0000 },
		{ 0x05, 0x8b67 },
		{ 0x06, 0x0000 },
		{ 0x05, 0x8b70 },
		{ 0x06, 0x0000 },
		{ 0x1f, 0x0000 },
		{ 0x1f, 0x0007 },
		{ 0x1e, 0x0078 },
		{ 0x17, 0x0000 },
		{ 0x19, 0x00fb },
		{ 0x1f, 0x0000 },

		/* Modify green table for 10M */
		{ 0x1f, 0x0005 },
		{ 0x05, 0x8b79 },
		{ 0x06, 0xaa00 },
		{ 0x1f, 0x0000 },

		/* Disable hiimpedance detection (RTCT) */
		{ 0x1f, 0x0003 },
		{ 0x01, 0x328a },
		{ 0x1f, 0x0000 }
	};

	rtl_apply_firmware(tp);

	rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));

3793
	rtl8168f_hw_phy_config(tp);
3794 3795 3796 3797

	/* Improve 2-pair detection performance */
	rtl_writephy(tp, 0x1f, 0x0005);
	rtl_writephy(tp, 0x05, 0x8b85);
3798
	rtl_w0w1_phy(tp, 0x06, 0x4000, 0x0000);
3799 3800 3801 3802 3803 3804 3805
	rtl_writephy(tp, 0x1f, 0x0000);
}

static void rtl8168f_2_hw_phy_config(struct rtl8169_private *tp)
{
	rtl_apply_firmware(tp);

3806
	rtl8168f_hw_phy_config(tp);
3807 3808
}

3809 3810 3811 3812 3813 3814 3815 3816 3817 3818 3819 3820 3821 3822 3823 3824 3825 3826 3827 3828 3829 3830 3831 3832 3833 3834 3835 3836 3837 3838 3839 3840 3841 3842 3843 3844 3845 3846 3847 3848 3849 3850 3851 3852 3853
static void rtl8411_hw_phy_config(struct rtl8169_private *tp)
{
	static const struct phy_reg phy_reg_init[] = {
		/* Channel estimation fine tune */
		{ 0x1f, 0x0003 },
		{ 0x09, 0xa20f },
		{ 0x1f, 0x0000 },

		/* Modify green table for giga & fnet */
		{ 0x1f, 0x0005 },
		{ 0x05, 0x8b55 },
		{ 0x06, 0x0000 },
		{ 0x05, 0x8b5e },
		{ 0x06, 0x0000 },
		{ 0x05, 0x8b67 },
		{ 0x06, 0x0000 },
		{ 0x05, 0x8b70 },
		{ 0x06, 0x0000 },
		{ 0x1f, 0x0000 },
		{ 0x1f, 0x0007 },
		{ 0x1e, 0x0078 },
		{ 0x17, 0x0000 },
		{ 0x19, 0x00aa },
		{ 0x1f, 0x0000 },

		/* Modify green table for 10M */
		{ 0x1f, 0x0005 },
		{ 0x05, 0x8b79 },
		{ 0x06, 0xaa00 },
		{ 0x1f, 0x0000 },

		/* Disable hiimpedance detection (RTCT) */
		{ 0x1f, 0x0003 },
		{ 0x01, 0x328a },
		{ 0x1f, 0x0000 }
	};


	rtl_apply_firmware(tp);

	rtl8168f_hw_phy_config(tp);

	/* Improve 2-pair detection performance */
	rtl_writephy(tp, 0x1f, 0x0005);
	rtl_writephy(tp, 0x05, 0x8b85);
3854
	rtl_w0w1_phy(tp, 0x06, 0x4000, 0x0000);
3855 3856 3857 3858 3859 3860 3861
	rtl_writephy(tp, 0x1f, 0x0000);

	rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));

	/* Modify green table for giga */
	rtl_writephy(tp, 0x1f, 0x0005);
	rtl_writephy(tp, 0x05, 0x8b54);
3862
	rtl_w0w1_phy(tp, 0x06, 0x0000, 0x0800);
3863
	rtl_writephy(tp, 0x05, 0x8b5d);
3864
	rtl_w0w1_phy(tp, 0x06, 0x0000, 0x0800);
3865
	rtl_writephy(tp, 0x05, 0x8a7c);
3866
	rtl_w0w1_phy(tp, 0x06, 0x0000, 0x0100);
3867
	rtl_writephy(tp, 0x05, 0x8a7f);
3868
	rtl_w0w1_phy(tp, 0x06, 0x0100, 0x0000);
3869
	rtl_writephy(tp, 0x05, 0x8a82);
3870
	rtl_w0w1_phy(tp, 0x06, 0x0000, 0x0100);
3871
	rtl_writephy(tp, 0x05, 0x8a85);
3872
	rtl_w0w1_phy(tp, 0x06, 0x0000, 0x0100);
3873
	rtl_writephy(tp, 0x05, 0x8a88);
3874
	rtl_w0w1_phy(tp, 0x06, 0x0000, 0x0100);
3875 3876 3877 3878 3879
	rtl_writephy(tp, 0x1f, 0x0000);

	/* uc same-seed solution */
	rtl_writephy(tp, 0x1f, 0x0005);
	rtl_writephy(tp, 0x05, 0x8b85);
3880
	rtl_w0w1_phy(tp, 0x06, 0x8000, 0x0000);
3881 3882 3883
	rtl_writephy(tp, 0x1f, 0x0000);

	/* eee setting */
3884
	rtl_w0w1_eri(tp, 0x1b0, ERIAR_MASK_0001, 0x00, 0x03, ERIAR_EXGMAC);
3885 3886
	rtl_writephy(tp, 0x1f, 0x0005);
	rtl_writephy(tp, 0x05, 0x8b85);
3887
	rtl_w0w1_phy(tp, 0x06, 0x0000, 0x2000);
3888 3889 3890
	rtl_writephy(tp, 0x1f, 0x0004);
	rtl_writephy(tp, 0x1f, 0x0007);
	rtl_writephy(tp, 0x1e, 0x0020);
3891
	rtl_w0w1_phy(tp, 0x15, 0x0000, 0x0100);
3892 3893 3894 3895 3896 3897 3898 3899 3900
	rtl_writephy(tp, 0x1f, 0x0000);
	rtl_writephy(tp, 0x0d, 0x0007);
	rtl_writephy(tp, 0x0e, 0x003c);
	rtl_writephy(tp, 0x0d, 0x4007);
	rtl_writephy(tp, 0x0e, 0x0000);
	rtl_writephy(tp, 0x0d, 0x0000);

	/* Green feature */
	rtl_writephy(tp, 0x1f, 0x0003);
3901 3902
	rtl_w0w1_phy(tp, 0x19, 0x0000, 0x0001);
	rtl_w0w1_phy(tp, 0x10, 0x0000, 0x0400);
3903 3904 3905
	rtl_writephy(tp, 0x1f, 0x0000);
}

H
Hayes Wang 已提交
3906 3907 3908 3909
static void rtl8168g_1_hw_phy_config(struct rtl8169_private *tp)
{
	rtl_apply_firmware(tp);

3910 3911 3912
	rtl_writephy(tp, 0x1f, 0x0a46);
	if (rtl_readphy(tp, 0x10) & 0x0100) {
		rtl_writephy(tp, 0x1f, 0x0bcc);
3913
		rtl_w0w1_phy(tp, 0x12, 0x0000, 0x8000);
3914 3915
	} else {
		rtl_writephy(tp, 0x1f, 0x0bcc);
3916
		rtl_w0w1_phy(tp, 0x12, 0x8000, 0x0000);
3917
	}
H
Hayes Wang 已提交
3918

3919 3920 3921
	rtl_writephy(tp, 0x1f, 0x0a46);
	if (rtl_readphy(tp, 0x13) & 0x0100) {
		rtl_writephy(tp, 0x1f, 0x0c41);
3922
		rtl_w0w1_phy(tp, 0x15, 0x0002, 0x0000);
3923
	} else {
3924
		rtl_writephy(tp, 0x1f, 0x0c41);
3925
		rtl_w0w1_phy(tp, 0x15, 0x0000, 0x0002);
3926
	}
H
Hayes Wang 已提交
3927

3928 3929
	/* Enable PHY auto speed down */
	rtl_writephy(tp, 0x1f, 0x0a44);
3930
	rtl_w0w1_phy(tp, 0x11, 0x000c, 0x0000);
H
Hayes Wang 已提交
3931

3932
	rtl_writephy(tp, 0x1f, 0x0bcc);
3933
	rtl_w0w1_phy(tp, 0x14, 0x0100, 0x0000);
3934
	rtl_writephy(tp, 0x1f, 0x0a44);
3935
	rtl_w0w1_phy(tp, 0x11, 0x00c0, 0x0000);
3936 3937
	rtl_writephy(tp, 0x1f, 0x0a43);
	rtl_writephy(tp, 0x13, 0x8084);
3938 3939
	rtl_w0w1_phy(tp, 0x14, 0x0000, 0x6000);
	rtl_w0w1_phy(tp, 0x10, 0x1003, 0x0000);
3940

3941 3942
	/* EEE auto-fallback function */
	rtl_writephy(tp, 0x1f, 0x0a4b);
3943
	rtl_w0w1_phy(tp, 0x11, 0x0004, 0x0000);
H
Hayes Wang 已提交
3944

3945 3946 3947
	/* Enable UC LPF tune function */
	rtl_writephy(tp, 0x1f, 0x0a43);
	rtl_writephy(tp, 0x13, 0x8012);
3948
	rtl_w0w1_phy(tp, 0x14, 0x8000, 0x0000);
3949 3950

	rtl_writephy(tp, 0x1f, 0x0c42);
3951
	rtl_w0w1_phy(tp, 0x11, 0x4000, 0x2000);
3952

3953 3954 3955 3956 3957 3958 3959 3960 3961 3962 3963
	/* Improve SWR Efficiency */
	rtl_writephy(tp, 0x1f, 0x0bcd);
	rtl_writephy(tp, 0x14, 0x5065);
	rtl_writephy(tp, 0x14, 0xd065);
	rtl_writephy(tp, 0x1f, 0x0bc8);
	rtl_writephy(tp, 0x11, 0x5655);
	rtl_writephy(tp, 0x1f, 0x0bcd);
	rtl_writephy(tp, 0x14, 0x1065);
	rtl_writephy(tp, 0x14, 0x9065);
	rtl_writephy(tp, 0x14, 0x1065);

3964 3965 3966
	/* Check ALDPS bit, disable it if enabled */
	rtl_writephy(tp, 0x1f, 0x0a43);
	if (rtl_readphy(tp, 0x10) & 0x0004)
3967
		rtl_w0w1_phy(tp, 0x10, 0x0000, 0x0004);
3968

3969
	rtl_writephy(tp, 0x1f, 0x0000);
H
Hayes Wang 已提交
3970 3971
}

H
hayeswang 已提交
3972 3973 3974 3975 3976
static void rtl8168g_2_hw_phy_config(struct rtl8169_private *tp)
{
	rtl_apply_firmware(tp);
}

3977 3978 3979 3980 3981 3982 3983 3984 3985 3986
static void rtl8168h_1_hw_phy_config(struct rtl8169_private *tp)
{
	u16 dout_tapbin;
	u32 data;

	rtl_apply_firmware(tp);

	/* CHN EST parameters adjust - giga master */
	rtl_writephy(tp, 0x1f, 0x0a43);
	rtl_writephy(tp, 0x13, 0x809b);
3987
	rtl_w0w1_phy(tp, 0x14, 0x8000, 0xf800);
3988
	rtl_writephy(tp, 0x13, 0x80a2);
3989
	rtl_w0w1_phy(tp, 0x14, 0x8000, 0xff00);
3990
	rtl_writephy(tp, 0x13, 0x80a4);
3991
	rtl_w0w1_phy(tp, 0x14, 0x8500, 0xff00);
3992
	rtl_writephy(tp, 0x13, 0x809c);
3993
	rtl_w0w1_phy(tp, 0x14, 0xbd00, 0xff00);
3994 3995 3996 3997 3998
	rtl_writephy(tp, 0x1f, 0x0000);

	/* CHN EST parameters adjust - giga slave */
	rtl_writephy(tp, 0x1f, 0x0a43);
	rtl_writephy(tp, 0x13, 0x80ad);
3999
	rtl_w0w1_phy(tp, 0x14, 0x7000, 0xf800);
4000
	rtl_writephy(tp, 0x13, 0x80b4);
4001
	rtl_w0w1_phy(tp, 0x14, 0x5000, 0xff00);
4002
	rtl_writephy(tp, 0x13, 0x80ac);
4003
	rtl_w0w1_phy(tp, 0x14, 0x4000, 0xff00);
4004 4005 4006 4007 4008
	rtl_writephy(tp, 0x1f, 0x0000);

	/* CHN EST parameters adjust - fnet */
	rtl_writephy(tp, 0x1f, 0x0a43);
	rtl_writephy(tp, 0x13, 0x808e);
4009
	rtl_w0w1_phy(tp, 0x14, 0x1200, 0xff00);
4010
	rtl_writephy(tp, 0x13, 0x8090);
4011
	rtl_w0w1_phy(tp, 0x14, 0xe500, 0xff00);
4012
	rtl_writephy(tp, 0x13, 0x8092);
4013
	rtl_w0w1_phy(tp, 0x14, 0x9f00, 0xff00);
4014 4015 4016 4017 4018 4019 4020 4021 4022 4023 4024 4025 4026 4027 4028 4029 4030 4031
	rtl_writephy(tp, 0x1f, 0x0000);

	/* enable R-tune & PGA-retune function */
	dout_tapbin = 0;
	rtl_writephy(tp, 0x1f, 0x0a46);
	data = rtl_readphy(tp, 0x13);
	data &= 3;
	data <<= 2;
	dout_tapbin |= data;
	data = rtl_readphy(tp, 0x12);
	data &= 0xc000;
	data >>= 14;
	dout_tapbin |= data;
	dout_tapbin = ~(dout_tapbin^0x08);
	dout_tapbin <<= 12;
	dout_tapbin &= 0xf000;
	rtl_writephy(tp, 0x1f, 0x0a43);
	rtl_writephy(tp, 0x13, 0x827a);
4032
	rtl_w0w1_phy(tp, 0x14, dout_tapbin, 0xf000);
4033
	rtl_writephy(tp, 0x13, 0x827b);
4034
	rtl_w0w1_phy(tp, 0x14, dout_tapbin, 0xf000);
4035
	rtl_writephy(tp, 0x13, 0x827c);
4036
	rtl_w0w1_phy(tp, 0x14, dout_tapbin, 0xf000);
4037
	rtl_writephy(tp, 0x13, 0x827d);
4038
	rtl_w0w1_phy(tp, 0x14, dout_tapbin, 0xf000);
4039 4040 4041

	rtl_writephy(tp, 0x1f, 0x0a43);
	rtl_writephy(tp, 0x13, 0x0811);
4042
	rtl_w0w1_phy(tp, 0x14, 0x0800, 0x0000);
4043
	rtl_writephy(tp, 0x1f, 0x0a42);
4044
	rtl_w0w1_phy(tp, 0x16, 0x0002, 0x0000);
4045 4046 4047 4048
	rtl_writephy(tp, 0x1f, 0x0000);

	/* enable GPHY 10M */
	rtl_writephy(tp, 0x1f, 0x0a44);
4049
	rtl_w0w1_phy(tp, 0x11, 0x0800, 0x0000);
4050 4051 4052 4053
	rtl_writephy(tp, 0x1f, 0x0000);

	/* SAR ADC performance */
	rtl_writephy(tp, 0x1f, 0x0bca);
4054
	rtl_w0w1_phy(tp, 0x17, 0x4000, 0x3000);
4055 4056 4057 4058
	rtl_writephy(tp, 0x1f, 0x0000);

	rtl_writephy(tp, 0x1f, 0x0a43);
	rtl_writephy(tp, 0x13, 0x803f);
4059
	rtl_w0w1_phy(tp, 0x14, 0x0000, 0x3000);
4060
	rtl_writephy(tp, 0x13, 0x8047);
4061
	rtl_w0w1_phy(tp, 0x14, 0x0000, 0x3000);
4062
	rtl_writephy(tp, 0x13, 0x804f);
4063
	rtl_w0w1_phy(tp, 0x14, 0x0000, 0x3000);
4064
	rtl_writephy(tp, 0x13, 0x8057);
4065
	rtl_w0w1_phy(tp, 0x14, 0x0000, 0x3000);
4066
	rtl_writephy(tp, 0x13, 0x805f);
4067
	rtl_w0w1_phy(tp, 0x14, 0x0000, 0x3000);
4068
	rtl_writephy(tp, 0x13, 0x8067);
4069
	rtl_w0w1_phy(tp, 0x14, 0x0000, 0x3000);
4070
	rtl_writephy(tp, 0x13, 0x806f);
4071
	rtl_w0w1_phy(tp, 0x14, 0x0000, 0x3000);
4072 4073 4074 4075
	rtl_writephy(tp, 0x1f, 0x0000);

	/* disable phy pfm mode */
	rtl_writephy(tp, 0x1f, 0x0a44);
4076
	rtl_w0w1_phy(tp, 0x11, 0x0000, 0x0080);
4077 4078 4079 4080 4081
	rtl_writephy(tp, 0x1f, 0x0000);

	/* Check ALDPS bit, disable it if enabled */
	rtl_writephy(tp, 0x1f, 0x0a43);
	if (rtl_readphy(tp, 0x10) & 0x0004)
4082
		rtl_w0w1_phy(tp, 0x10, 0x0000, 0x0004);
4083 4084 4085 4086 4087 4088 4089 4090 4091 4092 4093 4094 4095 4096 4097

	rtl_writephy(tp, 0x1f, 0x0000);
}

static void rtl8168h_2_hw_phy_config(struct rtl8169_private *tp)
{
	u16 ioffset_p3, ioffset_p2, ioffset_p1, ioffset_p0;
	u16 rlen;
	u32 data;

	rtl_apply_firmware(tp);

	/* CHIN EST parameter update */
	rtl_writephy(tp, 0x1f, 0x0a43);
	rtl_writephy(tp, 0x13, 0x808a);
4098
	rtl_w0w1_phy(tp, 0x14, 0x000a, 0x003f);
4099 4100 4101 4102 4103
	rtl_writephy(tp, 0x1f, 0x0000);

	/* enable R-tune & PGA-retune function */
	rtl_writephy(tp, 0x1f, 0x0a43);
	rtl_writephy(tp, 0x13, 0x0811);
4104
	rtl_w0w1_phy(tp, 0x14, 0x0800, 0x0000);
4105
	rtl_writephy(tp, 0x1f, 0x0a42);
4106
	rtl_w0w1_phy(tp, 0x16, 0x0002, 0x0000);
4107 4108 4109 4110
	rtl_writephy(tp, 0x1f, 0x0000);

	/* enable GPHY 10M */
	rtl_writephy(tp, 0x1f, 0x0a44);
4111
	rtl_w0w1_phy(tp, 0x11, 0x0800, 0x0000);
4112 4113 4114 4115 4116 4117 4118 4119 4120 4121 4122 4123 4124 4125 4126 4127
	rtl_writephy(tp, 0x1f, 0x0000);

	r8168_mac_ocp_write(tp, 0xdd02, 0x807d);
	data = r8168_mac_ocp_read(tp, 0xdd02);
	ioffset_p3 = ((data & 0x80)>>7);
	ioffset_p3 <<= 3;

	data = r8168_mac_ocp_read(tp, 0xdd00);
	ioffset_p3 |= ((data & (0xe000))>>13);
	ioffset_p2 = ((data & (0x1e00))>>9);
	ioffset_p1 = ((data & (0x01e0))>>5);
	ioffset_p0 = ((data & 0x0010)>>4);
	ioffset_p0 <<= 3;
	ioffset_p0 |= (data & (0x07));
	data = (ioffset_p3<<12)|(ioffset_p2<<8)|(ioffset_p1<<4)|(ioffset_p0);

4128
	if ((ioffset_p3 != 0x0f) || (ioffset_p2 != 0x0f) ||
4129
	    (ioffset_p1 != 0x0f) || (ioffset_p0 != 0x0f)) {
4130 4131 4132 4133 4134 4135 4136 4137 4138 4139 4140 4141 4142 4143 4144 4145 4146 4147 4148
		rtl_writephy(tp, 0x1f, 0x0bcf);
		rtl_writephy(tp, 0x16, data);
		rtl_writephy(tp, 0x1f, 0x0000);
	}

	/* Modify rlen (TX LPF corner frequency) level */
	rtl_writephy(tp, 0x1f, 0x0bcd);
	data = rtl_readphy(tp, 0x16);
	data &= 0x000f;
	rlen = 0;
	if (data > 3)
		rlen = data - 3;
	data = rlen | (rlen<<4) | (rlen<<8) | (rlen<<12);
	rtl_writephy(tp, 0x17, data);
	rtl_writephy(tp, 0x1f, 0x0bcd);
	rtl_writephy(tp, 0x1f, 0x0000);

	/* disable phy pfm mode */
	rtl_writephy(tp, 0x1f, 0x0a44);
4149
	rtl_w0w1_phy(tp, 0x11, 0x0000, 0x0080);
4150 4151 4152 4153 4154
	rtl_writephy(tp, 0x1f, 0x0000);

	/* Check ALDPS bit, disable it if enabled */
	rtl_writephy(tp, 0x1f, 0x0a43);
	if (rtl_readphy(tp, 0x10) & 0x0004)
4155
		rtl_w0w1_phy(tp, 0x10, 0x0000, 0x0004);
4156 4157 4158 4159

	rtl_writephy(tp, 0x1f, 0x0000);
}

C
Chun-Hao Lin 已提交
4160 4161 4162 4163 4164 4165 4166 4167 4168 4169 4170 4171 4172 4173 4174 4175 4176 4177 4178 4179 4180 4181 4182 4183 4184 4185 4186 4187 4188 4189 4190 4191 4192 4193 4194 4195 4196 4197 4198 4199 4200 4201 4202 4203 4204 4205 4206 4207 4208 4209 4210 4211 4212 4213 4214 4215 4216 4217 4218 4219 4220 4221 4222 4223 4224 4225 4226 4227 4228 4229 4230 4231 4232 4233 4234 4235 4236 4237 4238 4239 4240 4241 4242 4243 4244 4245 4246 4247 4248 4249 4250 4251 4252 4253 4254 4255 4256 4257 4258 4259 4260 4261 4262 4263 4264 4265 4266 4267 4268 4269 4270 4271 4272 4273 4274 4275 4276 4277 4278 4279 4280 4281 4282 4283 4284 4285 4286 4287 4288 4289 4290 4291 4292
static void rtl8168ep_1_hw_phy_config(struct rtl8169_private *tp)
{
	/* Enable PHY auto speed down */
	rtl_writephy(tp, 0x1f, 0x0a44);
	rtl_w0w1_phy(tp, 0x11, 0x000c, 0x0000);
	rtl_writephy(tp, 0x1f, 0x0000);

	/* patch 10M & ALDPS */
	rtl_writephy(tp, 0x1f, 0x0bcc);
	rtl_w0w1_phy(tp, 0x14, 0x0000, 0x0100);
	rtl_writephy(tp, 0x1f, 0x0a44);
	rtl_w0w1_phy(tp, 0x11, 0x00c0, 0x0000);
	rtl_writephy(tp, 0x1f, 0x0a43);
	rtl_writephy(tp, 0x13, 0x8084);
	rtl_w0w1_phy(tp, 0x14, 0x0000, 0x6000);
	rtl_w0w1_phy(tp, 0x10, 0x1003, 0x0000);
	rtl_writephy(tp, 0x1f, 0x0000);

	/* Enable EEE auto-fallback function */
	rtl_writephy(tp, 0x1f, 0x0a4b);
	rtl_w0w1_phy(tp, 0x11, 0x0004, 0x0000);
	rtl_writephy(tp, 0x1f, 0x0000);

	/* Enable UC LPF tune function */
	rtl_writephy(tp, 0x1f, 0x0a43);
	rtl_writephy(tp, 0x13, 0x8012);
	rtl_w0w1_phy(tp, 0x14, 0x8000, 0x0000);
	rtl_writephy(tp, 0x1f, 0x0000);

	/* set rg_sel_sdm_rate */
	rtl_writephy(tp, 0x1f, 0x0c42);
	rtl_w0w1_phy(tp, 0x11, 0x4000, 0x2000);
	rtl_writephy(tp, 0x1f, 0x0000);

	/* Check ALDPS bit, disable it if enabled */
	rtl_writephy(tp, 0x1f, 0x0a43);
	if (rtl_readphy(tp, 0x10) & 0x0004)
		rtl_w0w1_phy(tp, 0x10, 0x0000, 0x0004);

	rtl_writephy(tp, 0x1f, 0x0000);
}

static void rtl8168ep_2_hw_phy_config(struct rtl8169_private *tp)
{
	/* patch 10M & ALDPS */
	rtl_writephy(tp, 0x1f, 0x0bcc);
	rtl_w0w1_phy(tp, 0x14, 0x0000, 0x0100);
	rtl_writephy(tp, 0x1f, 0x0a44);
	rtl_w0w1_phy(tp, 0x11, 0x00c0, 0x0000);
	rtl_writephy(tp, 0x1f, 0x0a43);
	rtl_writephy(tp, 0x13, 0x8084);
	rtl_w0w1_phy(tp, 0x14, 0x0000, 0x6000);
	rtl_w0w1_phy(tp, 0x10, 0x1003, 0x0000);
	rtl_writephy(tp, 0x1f, 0x0000);

	/* Enable UC LPF tune function */
	rtl_writephy(tp, 0x1f, 0x0a43);
	rtl_writephy(tp, 0x13, 0x8012);
	rtl_w0w1_phy(tp, 0x14, 0x8000, 0x0000);
	rtl_writephy(tp, 0x1f, 0x0000);

	/* Set rg_sel_sdm_rate */
	rtl_writephy(tp, 0x1f, 0x0c42);
	rtl_w0w1_phy(tp, 0x11, 0x4000, 0x2000);
	rtl_writephy(tp, 0x1f, 0x0000);

	/* Channel estimation parameters */
	rtl_writephy(tp, 0x1f, 0x0a43);
	rtl_writephy(tp, 0x13, 0x80f3);
	rtl_w0w1_phy(tp, 0x14, 0x8b00, ~0x8bff);
	rtl_writephy(tp, 0x13, 0x80f0);
	rtl_w0w1_phy(tp, 0x14, 0x3a00, ~0x3aff);
	rtl_writephy(tp, 0x13, 0x80ef);
	rtl_w0w1_phy(tp, 0x14, 0x0500, ~0x05ff);
	rtl_writephy(tp, 0x13, 0x80f6);
	rtl_w0w1_phy(tp, 0x14, 0x6e00, ~0x6eff);
	rtl_writephy(tp, 0x13, 0x80ec);
	rtl_w0w1_phy(tp, 0x14, 0x6800, ~0x68ff);
	rtl_writephy(tp, 0x13, 0x80ed);
	rtl_w0w1_phy(tp, 0x14, 0x7c00, ~0x7cff);
	rtl_writephy(tp, 0x13, 0x80f2);
	rtl_w0w1_phy(tp, 0x14, 0xf400, ~0xf4ff);
	rtl_writephy(tp, 0x13, 0x80f4);
	rtl_w0w1_phy(tp, 0x14, 0x8500, ~0x85ff);
	rtl_writephy(tp, 0x1f, 0x0a43);
	rtl_writephy(tp, 0x13, 0x8110);
	rtl_w0w1_phy(tp, 0x14, 0xa800, ~0xa8ff);
	rtl_writephy(tp, 0x13, 0x810f);
	rtl_w0w1_phy(tp, 0x14, 0x1d00, ~0x1dff);
	rtl_writephy(tp, 0x13, 0x8111);
	rtl_w0w1_phy(tp, 0x14, 0xf500, ~0xf5ff);
	rtl_writephy(tp, 0x13, 0x8113);
	rtl_w0w1_phy(tp, 0x14, 0x6100, ~0x61ff);
	rtl_writephy(tp, 0x13, 0x8115);
	rtl_w0w1_phy(tp, 0x14, 0x9200, ~0x92ff);
	rtl_writephy(tp, 0x13, 0x810e);
	rtl_w0w1_phy(tp, 0x14, 0x0400, ~0x04ff);
	rtl_writephy(tp, 0x13, 0x810c);
	rtl_w0w1_phy(tp, 0x14, 0x7c00, ~0x7cff);
	rtl_writephy(tp, 0x13, 0x810b);
	rtl_w0w1_phy(tp, 0x14, 0x5a00, ~0x5aff);
	rtl_writephy(tp, 0x1f, 0x0a43);
	rtl_writephy(tp, 0x13, 0x80d1);
	rtl_w0w1_phy(tp, 0x14, 0xff00, ~0xffff);
	rtl_writephy(tp, 0x13, 0x80cd);
	rtl_w0w1_phy(tp, 0x14, 0x9e00, ~0x9eff);
	rtl_writephy(tp, 0x13, 0x80d3);
	rtl_w0w1_phy(tp, 0x14, 0x0e00, ~0x0eff);
	rtl_writephy(tp, 0x13, 0x80d5);
	rtl_w0w1_phy(tp, 0x14, 0xca00, ~0xcaff);
	rtl_writephy(tp, 0x13, 0x80d7);
	rtl_w0w1_phy(tp, 0x14, 0x8400, ~0x84ff);

	/* Force PWM-mode */
	rtl_writephy(tp, 0x1f, 0x0bcd);
	rtl_writephy(tp, 0x14, 0x5065);
	rtl_writephy(tp, 0x14, 0xd065);
	rtl_writephy(tp, 0x1f, 0x0bc8);
	rtl_writephy(tp, 0x12, 0x00ed);
	rtl_writephy(tp, 0x1f, 0x0bcd);
	rtl_writephy(tp, 0x14, 0x1065);
	rtl_writephy(tp, 0x14, 0x9065);
	rtl_writephy(tp, 0x14, 0x1065);
	rtl_writephy(tp, 0x1f, 0x0000);

	/* Check ALDPS bit, disable it if enabled */
	rtl_writephy(tp, 0x1f, 0x0a43);
	if (rtl_readphy(tp, 0x10) & 0x0004)
		rtl_w0w1_phy(tp, 0x10, 0x0000, 0x0004);

	rtl_writephy(tp, 0x1f, 0x0000);
}

4293
static void rtl8102e_hw_phy_config(struct rtl8169_private *tp)
4294
{
4295
	static const struct phy_reg phy_reg_init[] = {
4296 4297 4298 4299 4300 4301
		{ 0x1f, 0x0003 },
		{ 0x08, 0x441d },
		{ 0x01, 0x9100 },
		{ 0x1f, 0x0000 }
	};

4302 4303 4304 4305
	rtl_writephy(tp, 0x1f, 0x0000);
	rtl_patchphy(tp, 0x11, 1 << 12);
	rtl_patchphy(tp, 0x19, 1 << 13);
	rtl_patchphy(tp, 0x10, 1 << 15);
4306

4307
	rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
4308 4309
}

4310 4311 4312 4313 4314 4315 4316 4317 4318 4319 4320 4321 4322 4323 4324 4325 4326
static void rtl8105e_hw_phy_config(struct rtl8169_private *tp)
{
	static const struct phy_reg phy_reg_init[] = {
		{ 0x1f, 0x0005 },
		{ 0x1a, 0x0000 },
		{ 0x1f, 0x0000 },

		{ 0x1f, 0x0004 },
		{ 0x1c, 0x0000 },
		{ 0x1f, 0x0000 },

		{ 0x1f, 0x0001 },
		{ 0x15, 0x7701 },
		{ 0x1f, 0x0000 }
	};

	/* Disable ALDPS before ram code */
4327 4328 4329
	rtl_writephy(tp, 0x1f, 0x0000);
	rtl_writephy(tp, 0x18, 0x0310);
	msleep(100);
4330

4331
	rtl_apply_firmware(tp);
4332 4333 4334 4335

	rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));
}

4336 4337 4338
static void rtl8402_hw_phy_config(struct rtl8169_private *tp)
{
	/* Disable ALDPS before setting firmware */
4339 4340 4341
	rtl_writephy(tp, 0x1f, 0x0000);
	rtl_writephy(tp, 0x18, 0x0310);
	msleep(20);
4342 4343 4344 4345

	rtl_apply_firmware(tp);

	/* EEE setting */
4346
	rtl_eri_write(tp, 0x1b0, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);
4347 4348 4349 4350 4351 4352
	rtl_writephy(tp, 0x1f, 0x0004);
	rtl_writephy(tp, 0x10, 0x401f);
	rtl_writephy(tp, 0x19, 0x7030);
	rtl_writephy(tp, 0x1f, 0x0000);
}

H
Hayes Wang 已提交
4353 4354 4355 4356 4357 4358 4359 4360 4361 4362
static void rtl8106e_hw_phy_config(struct rtl8169_private *tp)
{
	static const struct phy_reg phy_reg_init[] = {
		{ 0x1f, 0x0004 },
		{ 0x10, 0xc07f },
		{ 0x19, 0x7030 },
		{ 0x1f, 0x0000 }
	};

	/* Disable ALDPS before ram code */
4363 4364 4365
	rtl_writephy(tp, 0x1f, 0x0000);
	rtl_writephy(tp, 0x18, 0x0310);
	msleep(100);
H
Hayes Wang 已提交
4366 4367 4368

	rtl_apply_firmware(tp);

4369
	rtl_eri_write(tp, 0x1b0, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);
H
Hayes Wang 已提交
4370 4371
	rtl_writephy_batch(tp, phy_reg_init, ARRAY_SIZE(phy_reg_init));

4372
	rtl_eri_write(tp, 0x1d0, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);
H
Hayes Wang 已提交
4373 4374
}

4375 4376 4377 4378 4379 4380 4381 4382 4383 4384 4385
static void rtl_hw_phy_config(struct net_device *dev)
{
	struct rtl8169_private *tp = netdev_priv(dev);

	rtl8169_print_mac_version(tp);

	switch (tp->mac_version) {
	case RTL_GIGA_MAC_VER_01:
		break;
	case RTL_GIGA_MAC_VER_02:
	case RTL_GIGA_MAC_VER_03:
4386
		rtl8169s_hw_phy_config(tp);
4387 4388
		break;
	case RTL_GIGA_MAC_VER_04:
4389
		rtl8169sb_hw_phy_config(tp);
4390
		break;
4391
	case RTL_GIGA_MAC_VER_05:
4392
		rtl8169scd_hw_phy_config(tp);
4393
		break;
4394
	case RTL_GIGA_MAC_VER_06:
4395
		rtl8169sce_hw_phy_config(tp);
4396
		break;
4397 4398 4399
	case RTL_GIGA_MAC_VER_07:
	case RTL_GIGA_MAC_VER_08:
	case RTL_GIGA_MAC_VER_09:
4400
		rtl8102e_hw_phy_config(tp);
4401
		break;
4402
	case RTL_GIGA_MAC_VER_11:
4403
		rtl8168bb_hw_phy_config(tp);
4404 4405
		break;
	case RTL_GIGA_MAC_VER_12:
4406
		rtl8168bef_hw_phy_config(tp);
4407 4408
		break;
	case RTL_GIGA_MAC_VER_17:
4409
		rtl8168bef_hw_phy_config(tp);
4410
		break;
F
Francois Romieu 已提交
4411
	case RTL_GIGA_MAC_VER_18:
4412
		rtl8168cp_1_hw_phy_config(tp);
F
Francois Romieu 已提交
4413 4414
		break;
	case RTL_GIGA_MAC_VER_19:
4415
		rtl8168c_1_hw_phy_config(tp);
F
Francois Romieu 已提交
4416
		break;
4417
	case RTL_GIGA_MAC_VER_20:
4418
		rtl8168c_2_hw_phy_config(tp);
4419
		break;
F
Francois Romieu 已提交
4420
	case RTL_GIGA_MAC_VER_21:
4421
		rtl8168c_3_hw_phy_config(tp);
F
Francois Romieu 已提交
4422
		break;
4423
	case RTL_GIGA_MAC_VER_22:
4424
		rtl8168c_4_hw_phy_config(tp);
4425
		break;
F
Francois Romieu 已提交
4426
	case RTL_GIGA_MAC_VER_23:
4427
	case RTL_GIGA_MAC_VER_24:
4428
		rtl8168cp_2_hw_phy_config(tp);
F
Francois Romieu 已提交
4429
		break;
F
Francois Romieu 已提交
4430
	case RTL_GIGA_MAC_VER_25:
4431
		rtl8168d_1_hw_phy_config(tp);
4432 4433
		break;
	case RTL_GIGA_MAC_VER_26:
4434
		rtl8168d_2_hw_phy_config(tp);
4435 4436
		break;
	case RTL_GIGA_MAC_VER_27:
4437
		rtl8168d_3_hw_phy_config(tp);
F
Francois Romieu 已提交
4438
		break;
F
françois romieu 已提交
4439 4440 4441
	case RTL_GIGA_MAC_VER_28:
		rtl8168d_4_hw_phy_config(tp);
		break;
4442 4443 4444 4445
	case RTL_GIGA_MAC_VER_29:
	case RTL_GIGA_MAC_VER_30:
		rtl8105e_hw_phy_config(tp);
		break;
F
Francois Romieu 已提交
4446 4447 4448
	case RTL_GIGA_MAC_VER_31:
		/* None. */
		break;
H
hayeswang 已提交
4449 4450
	case RTL_GIGA_MAC_VER_32:
	case RTL_GIGA_MAC_VER_33:
H
Hayes Wang 已提交
4451 4452 4453 4454
		rtl8168e_1_hw_phy_config(tp);
		break;
	case RTL_GIGA_MAC_VER_34:
		rtl8168e_2_hw_phy_config(tp);
H
hayeswang 已提交
4455
		break;
4456 4457 4458 4459 4460 4461
	case RTL_GIGA_MAC_VER_35:
		rtl8168f_1_hw_phy_config(tp);
		break;
	case RTL_GIGA_MAC_VER_36:
		rtl8168f_2_hw_phy_config(tp);
		break;
F
Francois Romieu 已提交
4462

4463 4464 4465 4466
	case RTL_GIGA_MAC_VER_37:
		rtl8402_hw_phy_config(tp);
		break;

4467 4468 4469 4470
	case RTL_GIGA_MAC_VER_38:
		rtl8411_hw_phy_config(tp);
		break;

H
Hayes Wang 已提交
4471 4472 4473 4474
	case RTL_GIGA_MAC_VER_39:
		rtl8106e_hw_phy_config(tp);
		break;

H
Hayes Wang 已提交
4475 4476 4477
	case RTL_GIGA_MAC_VER_40:
		rtl8168g_1_hw_phy_config(tp);
		break;
H
hayeswang 已提交
4478
	case RTL_GIGA_MAC_VER_42:
H
hayeswang 已提交
4479
	case RTL_GIGA_MAC_VER_43:
H
hayeswang 已提交
4480
	case RTL_GIGA_MAC_VER_44:
H
hayeswang 已提交
4481 4482
		rtl8168g_2_hw_phy_config(tp);
		break;
4483 4484 4485 4486 4487 4488 4489 4490
	case RTL_GIGA_MAC_VER_45:
	case RTL_GIGA_MAC_VER_47:
		rtl8168h_1_hw_phy_config(tp);
		break;
	case RTL_GIGA_MAC_VER_46:
	case RTL_GIGA_MAC_VER_48:
		rtl8168h_2_hw_phy_config(tp);
		break;
H
Hayes Wang 已提交
4491

C
Chun-Hao Lin 已提交
4492 4493 4494 4495 4496 4497 4498 4499
	case RTL_GIGA_MAC_VER_49:
		rtl8168ep_1_hw_phy_config(tp);
		break;
	case RTL_GIGA_MAC_VER_50:
	case RTL_GIGA_MAC_VER_51:
		rtl8168ep_2_hw_phy_config(tp);
		break;

H
Hayes Wang 已提交
4500
	case RTL_GIGA_MAC_VER_41:
4501 4502 4503 4504 4505
	default:
		break;
	}
}

4506
static void rtl_phy_work(struct rtl8169_private *tp)
L
Linus Torvalds 已提交
4507 4508 4509 4510
{
	struct timer_list *timer = &tp->timer;
	unsigned long timeout = RTL8169_PHY_TIMEOUT;

4511
	assert(tp->mac_version > RTL_GIGA_MAC_VER_01);
L
Linus Torvalds 已提交
4512

4513
	if (tp->phy_reset_pending(tp)) {
4514
		/*
L
Linus Torvalds 已提交
4515 4516 4517 4518 4519 4520 4521
		 * A busy loop could burn quite a few cycles on nowadays CPU.
		 * Let's delay the execution of the timer for a few ticks.
		 */
		timeout = HZ/10;
		goto out_mod_timer;
	}

4522
	if (tp->link_ok(tp))
4523
		return;
L
Linus Torvalds 已提交
4524

4525
	netif_dbg(tp, link, tp->dev, "PHY reset until link up\n");
L
Linus Torvalds 已提交
4526

4527
	tp->phy_reset_enable(tp);
L
Linus Torvalds 已提交
4528 4529 4530

out_mod_timer:
	mod_timer(timer, jiffies + timeout);
4531 4532 4533 4534 4535 4536 4537 4538
}

static void rtl_schedule_task(struct rtl8169_private *tp, enum rtl_flag flag)
{
	if (!test_and_set_bit(flag, tp->wk.flags))
		schedule_work(&tp->wk.work);
}

4539
static void rtl8169_phy_timer(struct timer_list *t)
4540
{
4541
	struct rtl8169_private *tp = from_timer(tp, t, timer);
4542

4543
	rtl_schedule_task(tp, RTL_FLAG_TASK_PHY_PENDING);
L
Linus Torvalds 已提交
4544 4545
}

4546 4547 4548 4549 4550
DECLARE_RTL_COND(rtl_phy_reset_cond)
{
	return tp->phy_reset_pending(tp);
}

4551 4552 4553
static void rtl8169_phy_reset(struct net_device *dev,
			      struct rtl8169_private *tp)
{
4554
	tp->phy_reset_enable(tp);
4555
	rtl_msleep_loop_wait_low(tp, &rtl_phy_reset_cond, 1, 100);
4556 4557
}

4558 4559 4560
static bool rtl_tbi_enabled(struct rtl8169_private *tp)
{
	return (tp->mac_version == RTL_GIGA_MAC_VER_01) &&
4561
	    (RTL_R8(tp, PHYstatus) & TBI_Enable);
4562 4563
}

4564 4565
static void rtl8169_init_phy(struct net_device *dev, struct rtl8169_private *tp)
{
4566
	rtl_hw_phy_config(dev);
4567

4568 4569
	if (tp->mac_version <= RTL_GIGA_MAC_VER_06) {
		dprintk("Set MAC Reg C+CR Offset 0x82h = 0x01h\n");
4570
		RTL_W8(tp, 0x82, 0x01);
4571
	}
4572

4573 4574 4575 4576
	pci_write_config_byte(tp->pci_dev, PCI_LATENCY_TIMER, 0x40);

	if (tp->mac_version <= RTL_GIGA_MAC_VER_06)
		pci_write_config_byte(tp->pci_dev, PCI_CACHE_LINE_SIZE, 0x08);
4577

4578
	if (tp->mac_version == RTL_GIGA_MAC_VER_02) {
4579
		dprintk("Set MAC Reg C+CR Offset 0x82h = 0x01h\n");
4580
		RTL_W8(tp, 0x82, 0x01);
4581
		dprintk("Set PHY Reg 0x0bh = 0x00h\n");
4582
		rtl_writephy(tp, 0x0b, 0x0000); //w 0x0b 15 0 0
4583 4584
	}

4585 4586
	rtl8169_phy_reset(dev, tp);

4587
	rtl8169_set_speed(dev, AUTONEG_ENABLE, SPEED_1000, DUPLEX_FULL,
F
Francois Romieu 已提交
4588 4589 4590 4591 4592
			  ADVERTISED_10baseT_Half | ADVERTISED_10baseT_Full |
			  ADVERTISED_100baseT_Half | ADVERTISED_100baseT_Full |
			  (tp->mii.supports_gmii ?
			   ADVERTISED_1000baseT_Half |
			   ADVERTISED_1000baseT_Full : 0));
4593

4594
	if (rtl_tbi_enabled(tp))
4595
		netif_info(tp, link, dev, "TBI auto-negotiating\n");
4596 4597
}

4598 4599
static void rtl_rar_set(struct rtl8169_private *tp, u8 *addr)
{
4600
	rtl_lock_work(tp);
4601

4602
	RTL_W8(tp, Cfg9346, Cfg9346_Unlock);
4603

4604 4605
	RTL_W32(tp, MAC4, addr[4] | addr[5] << 8);
	RTL_R32(tp, MAC4);
4606

4607 4608
	RTL_W32(tp, MAC0, addr[0] | addr[1] << 8 | addr[2] << 16 | addr[3] << 24);
	RTL_R32(tp, MAC0);
4609

4610 4611
	if (tp->mac_version == RTL_GIGA_MAC_VER_34)
		rtl_rar_exgmac_set(tp, addr);
4612

4613
	RTL_W8(tp, Cfg9346, Cfg9346_Lock);
4614

4615
	rtl_unlock_work(tp);
4616 4617 4618 4619 4620
}

static int rtl_set_mac_address(struct net_device *dev, void *p)
{
	struct rtl8169_private *tp = netdev_priv(dev);
H
Heiner Kallweit 已提交
4621
	struct device *d = tp_to_dev(tp);
4622
	int ret;
4623

4624 4625 4626
	ret = eth_mac_addr(dev, p);
	if (ret)
		return ret;
4627

4628 4629 4630 4631 4632 4633
	pm_runtime_get_noresume(d);

	if (pm_runtime_active(d))
		rtl_rar_set(tp, dev->dev_addr);

	pm_runtime_put_noidle(d);
4634 4635 4636 4637

	return 0;
}

4638 4639 4640 4641 4642
static int rtl8169_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
{
	struct rtl8169_private *tp = netdev_priv(dev);
	struct mii_ioctl_data *data = if_mii(ifr);

F
Francois Romieu 已提交
4643 4644
	return netif_running(dev) ? tp->do_ioctl(tp, data, cmd) : -ENODEV;
}
4645

F
Francois Romieu 已提交
4646 4647
static int rtl_xmii_ioctl(struct rtl8169_private *tp,
			  struct mii_ioctl_data *data, int cmd)
F
Francois Romieu 已提交
4648
{
4649 4650 4651 4652 4653 4654
	switch (cmd) {
	case SIOCGMIIPHY:
		data->phy_id = 32; /* Internal PHY */
		return 0;

	case SIOCGMIIREG:
4655
		data->val_out = rtl_readphy(tp, data->reg_num & 0x1f);
4656 4657 4658
		return 0;

	case SIOCSMIIREG:
4659
		rtl_writephy(tp, data->reg_num & 0x1f, data->val_in);
4660 4661 4662 4663 4664
		return 0;
	}
	return -EOPNOTSUPP;
}

F
Francois Romieu 已提交
4665 4666 4667 4668 4669
static int rtl_tbi_ioctl(struct rtl8169_private *tp, struct mii_ioctl_data *data, int cmd)
{
	return -EOPNOTSUPP;
}

B
Bill Pemberton 已提交
4670
static void rtl_init_mdio_ops(struct rtl8169_private *tp)
4671 4672 4673 4674 4675 4676 4677 4678
{
	struct mdio_ops *ops = &tp->mdio_ops;

	switch (tp->mac_version) {
	case RTL_GIGA_MAC_VER_27:
		ops->write	= r8168dp_1_mdio_write;
		ops->read	= r8168dp_1_mdio_read;
		break;
F
françois romieu 已提交
4679
	case RTL_GIGA_MAC_VER_28:
4680
	case RTL_GIGA_MAC_VER_31:
F
françois romieu 已提交
4681 4682 4683
		ops->write	= r8168dp_2_mdio_write;
		ops->read	= r8168dp_2_mdio_read;
		break;
H
Hayes Wang 已提交
4684 4685
	case RTL_GIGA_MAC_VER_40:
	case RTL_GIGA_MAC_VER_41:
H
hayeswang 已提交
4686
	case RTL_GIGA_MAC_VER_42:
H
hayeswang 已提交
4687
	case RTL_GIGA_MAC_VER_43:
H
hayeswang 已提交
4688
	case RTL_GIGA_MAC_VER_44:
4689 4690 4691 4692
	case RTL_GIGA_MAC_VER_45:
	case RTL_GIGA_MAC_VER_46:
	case RTL_GIGA_MAC_VER_47:
	case RTL_GIGA_MAC_VER_48:
C
Chun-Hao Lin 已提交
4693 4694 4695
	case RTL_GIGA_MAC_VER_49:
	case RTL_GIGA_MAC_VER_50:
	case RTL_GIGA_MAC_VER_51:
H
Hayes Wang 已提交
4696 4697 4698
		ops->write	= r8168g_mdio_write;
		ops->read	= r8168g_mdio_read;
		break;
4699 4700 4701 4702 4703 4704 4705
	default:
		ops->write	= r8169_mdio_write;
		ops->read	= r8169_mdio_read;
		break;
	}
}

H
hayeswang 已提交
4706 4707 4708 4709 4710 4711 4712 4713 4714 4715 4716 4717 4718 4719 4720 4721 4722 4723 4724 4725 4726 4727 4728 4729
static void rtl_speed_down(struct rtl8169_private *tp)
{
	u32 adv;
	int lpa;

	rtl_writephy(tp, 0x1f, 0x0000);
	lpa = rtl_readphy(tp, MII_LPA);

	if (lpa & (LPA_10HALF | LPA_10FULL))
		adv = ADVERTISED_10baseT_Half | ADVERTISED_10baseT_Full;
	else if (lpa & (LPA_100HALF | LPA_100FULL))
		adv = ADVERTISED_10baseT_Half | ADVERTISED_10baseT_Full |
		      ADVERTISED_100baseT_Half | ADVERTISED_100baseT_Full;
	else
		adv = ADVERTISED_10baseT_Half | ADVERTISED_10baseT_Full |
		      ADVERTISED_100baseT_Half | ADVERTISED_100baseT_Full |
		      (tp->mii.supports_gmii ?
		       ADVERTISED_1000baseT_Half |
		       ADVERTISED_1000baseT_Full : 0);

	rtl8169_set_speed(tp->dev, AUTONEG_ENABLE, SPEED_1000, DUPLEX_FULL,
			  adv);
}

4730 4731 4732
static void rtl_wol_suspend_quirk(struct rtl8169_private *tp)
{
	switch (tp->mac_version) {
4733 4734
	case RTL_GIGA_MAC_VER_25:
	case RTL_GIGA_MAC_VER_26:
4735 4736 4737 4738 4739
	case RTL_GIGA_MAC_VER_29:
	case RTL_GIGA_MAC_VER_30:
	case RTL_GIGA_MAC_VER_32:
	case RTL_GIGA_MAC_VER_33:
	case RTL_GIGA_MAC_VER_34:
4740
	case RTL_GIGA_MAC_VER_37:
4741
	case RTL_GIGA_MAC_VER_38:
H
Hayes Wang 已提交
4742
	case RTL_GIGA_MAC_VER_39:
H
Hayes Wang 已提交
4743 4744
	case RTL_GIGA_MAC_VER_40:
	case RTL_GIGA_MAC_VER_41:
H
hayeswang 已提交
4745
	case RTL_GIGA_MAC_VER_42:
H
hayeswang 已提交
4746
	case RTL_GIGA_MAC_VER_43:
H
hayeswang 已提交
4747
	case RTL_GIGA_MAC_VER_44:
4748 4749 4750 4751
	case RTL_GIGA_MAC_VER_45:
	case RTL_GIGA_MAC_VER_46:
	case RTL_GIGA_MAC_VER_47:
	case RTL_GIGA_MAC_VER_48:
C
Chun-Hao Lin 已提交
4752 4753 4754
	case RTL_GIGA_MAC_VER_49:
	case RTL_GIGA_MAC_VER_50:
	case RTL_GIGA_MAC_VER_51:
4755
		RTL_W32(tp, RxConfig, RTL_R32(tp, RxConfig) |
4756 4757 4758 4759 4760 4761 4762 4763 4764 4765 4766 4767
			AcceptBroadcast | AcceptMulticast | AcceptMyPhys);
		break;
	default:
		break;
	}
}

static bool rtl_wol_pll_power_down(struct rtl8169_private *tp)
{
	if (!(__rtl8169_get_wol(tp) & WAKE_ANY))
		return false;

H
hayeswang 已提交
4768
	rtl_speed_down(tp);
4769 4770 4771 4772 4773
	rtl_wol_suspend_quirk(tp);

	return true;
}

F
françois romieu 已提交
4774 4775 4776 4777 4778 4779 4780 4781 4782 4783 4784 4785 4786 4787
static void r810x_phy_power_down(struct rtl8169_private *tp)
{
	rtl_writephy(tp, 0x1f, 0x0000);
	rtl_writephy(tp, MII_BMCR, BMCR_PDOWN);
}

static void r810x_phy_power_up(struct rtl8169_private *tp)
{
	rtl_writephy(tp, 0x1f, 0x0000);
	rtl_writephy(tp, MII_BMCR, BMCR_ANENABLE);
}

static void r810x_pll_power_down(struct rtl8169_private *tp)
{
4788
	if (rtl_wol_pll_power_down(tp))
F
françois romieu 已提交
4789 4790 4791
		return;

	r810x_phy_power_down(tp);
H
Hayes Wang 已提交
4792 4793 4794 4795 4796 4797 4798 4799 4800 4801

	switch (tp->mac_version) {
	case RTL_GIGA_MAC_VER_07:
	case RTL_GIGA_MAC_VER_08:
	case RTL_GIGA_MAC_VER_09:
	case RTL_GIGA_MAC_VER_10:
	case RTL_GIGA_MAC_VER_13:
	case RTL_GIGA_MAC_VER_16:
		break;
	default:
4802
		RTL_W8(tp, PMCH, RTL_R8(tp, PMCH) & ~0x80);
H
Hayes Wang 已提交
4803 4804
		break;
	}
F
françois romieu 已提交
4805 4806 4807 4808 4809
}

static void r810x_pll_power_up(struct rtl8169_private *tp)
{
	r810x_phy_power_up(tp);
H
Hayes Wang 已提交
4810 4811 4812 4813 4814 4815 4816 4817 4818

	switch (tp->mac_version) {
	case RTL_GIGA_MAC_VER_07:
	case RTL_GIGA_MAC_VER_08:
	case RTL_GIGA_MAC_VER_09:
	case RTL_GIGA_MAC_VER_10:
	case RTL_GIGA_MAC_VER_13:
	case RTL_GIGA_MAC_VER_16:
		break;
4819 4820
	case RTL_GIGA_MAC_VER_47:
	case RTL_GIGA_MAC_VER_48:
4821
		RTL_W8(tp, PMCH, RTL_R8(tp, PMCH) | 0xc0);
4822
		break;
H
Hayes Wang 已提交
4823
	default:
4824
		RTL_W8(tp, PMCH, RTL_R8(tp, PMCH) | 0x80);
H
Hayes Wang 已提交
4825 4826
		break;
	}
F
françois romieu 已提交
4827 4828 4829 4830 4831
}

static void r8168_phy_power_up(struct rtl8169_private *tp)
{
	rtl_writephy(tp, 0x1f, 0x0000);
H
hayeswang 已提交
4832 4833 4834 4835 4836 4837 4838 4839 4840 4841 4842 4843 4844 4845 4846 4847 4848 4849 4850 4851 4852
	switch (tp->mac_version) {
	case RTL_GIGA_MAC_VER_11:
	case RTL_GIGA_MAC_VER_12:
	case RTL_GIGA_MAC_VER_17:
	case RTL_GIGA_MAC_VER_18:
	case RTL_GIGA_MAC_VER_19:
	case RTL_GIGA_MAC_VER_20:
	case RTL_GIGA_MAC_VER_21:
	case RTL_GIGA_MAC_VER_22:
	case RTL_GIGA_MAC_VER_23:
	case RTL_GIGA_MAC_VER_24:
	case RTL_GIGA_MAC_VER_25:
	case RTL_GIGA_MAC_VER_26:
	case RTL_GIGA_MAC_VER_27:
	case RTL_GIGA_MAC_VER_28:
	case RTL_GIGA_MAC_VER_31:
		rtl_writephy(tp, 0x0e, 0x0000);
		break;
	default:
		break;
	}
F
françois romieu 已提交
4853 4854 4855 4856 4857 4858
	rtl_writephy(tp, MII_BMCR, BMCR_ANENABLE);
}

static void r8168_phy_power_down(struct rtl8169_private *tp)
{
	rtl_writephy(tp, 0x1f, 0x0000);
H
hayeswang 已提交
4859 4860 4861
	switch (tp->mac_version) {
	case RTL_GIGA_MAC_VER_32:
	case RTL_GIGA_MAC_VER_33:
4862 4863
	case RTL_GIGA_MAC_VER_40:
	case RTL_GIGA_MAC_VER_41:
H
hayeswang 已提交
4864 4865 4866 4867 4868 4869 4870 4871 4872 4873 4874 4875 4876 4877 4878 4879 4880 4881 4882 4883 4884 4885 4886
		rtl_writephy(tp, MII_BMCR, BMCR_ANENABLE | BMCR_PDOWN);
		break;

	case RTL_GIGA_MAC_VER_11:
	case RTL_GIGA_MAC_VER_12:
	case RTL_GIGA_MAC_VER_17:
	case RTL_GIGA_MAC_VER_18:
	case RTL_GIGA_MAC_VER_19:
	case RTL_GIGA_MAC_VER_20:
	case RTL_GIGA_MAC_VER_21:
	case RTL_GIGA_MAC_VER_22:
	case RTL_GIGA_MAC_VER_23:
	case RTL_GIGA_MAC_VER_24:
	case RTL_GIGA_MAC_VER_25:
	case RTL_GIGA_MAC_VER_26:
	case RTL_GIGA_MAC_VER_27:
	case RTL_GIGA_MAC_VER_28:
	case RTL_GIGA_MAC_VER_31:
		rtl_writephy(tp, 0x0e, 0x0200);
	default:
		rtl_writephy(tp, MII_BMCR, BMCR_PDOWN);
		break;
	}
F
françois romieu 已提交
4887 4888 4889 4890
}

static void r8168_pll_power_down(struct rtl8169_private *tp)
{
4891
	if (r8168_check_dash(tp))
F
françois romieu 已提交
4892 4893
		return;

F
Francois Romieu 已提交
4894 4895
	if ((tp->mac_version == RTL_GIGA_MAC_VER_23 ||
	     tp->mac_version == RTL_GIGA_MAC_VER_24) &&
4896
	    (RTL_R16(tp, CPlusCmd) & ASF)) {
F
françois romieu 已提交
4897 4898 4899
		return;
	}

H
hayeswang 已提交
4900 4901
	if (tp->mac_version == RTL_GIGA_MAC_VER_32 ||
	    tp->mac_version == RTL_GIGA_MAC_VER_33)
4902
		rtl_ephy_write(tp, 0x19, 0xff64);
H
hayeswang 已提交
4903

4904
	if (rtl_wol_pll_power_down(tp))
F
françois romieu 已提交
4905 4906 4907 4908 4909 4910 4911
		return;

	r8168_phy_power_down(tp);

	switch (tp->mac_version) {
	case RTL_GIGA_MAC_VER_25:
	case RTL_GIGA_MAC_VER_26:
4912 4913
	case RTL_GIGA_MAC_VER_27:
	case RTL_GIGA_MAC_VER_28:
4914
	case RTL_GIGA_MAC_VER_31:
H
hayeswang 已提交
4915 4916
	case RTL_GIGA_MAC_VER_32:
	case RTL_GIGA_MAC_VER_33:
4917
	case RTL_GIGA_MAC_VER_44:
4918 4919
	case RTL_GIGA_MAC_VER_45:
	case RTL_GIGA_MAC_VER_46:
C
Chun-Hao Lin 已提交
4920 4921
	case RTL_GIGA_MAC_VER_50:
	case RTL_GIGA_MAC_VER_51:
4922
		RTL_W8(tp, PMCH, RTL_R8(tp, PMCH) & ~0x80);
F
françois romieu 已提交
4923
		break;
4924 4925
	case RTL_GIGA_MAC_VER_40:
	case RTL_GIGA_MAC_VER_41:
C
Chun-Hao Lin 已提交
4926
	case RTL_GIGA_MAC_VER_49:
4927
		rtl_w0w1_eri(tp, 0x1a8, ERIAR_MASK_1111, 0x00000000,
4928
			     0xfc000000, ERIAR_EXGMAC);
4929
		RTL_W8(tp, PMCH, RTL_R8(tp, PMCH) & ~0x80);
4930
		break;
F
françois romieu 已提交
4931 4932 4933 4934 4935 4936 4937 4938
	}
}

static void r8168_pll_power_up(struct rtl8169_private *tp)
{
	switch (tp->mac_version) {
	case RTL_GIGA_MAC_VER_25:
	case RTL_GIGA_MAC_VER_26:
4939 4940
	case RTL_GIGA_MAC_VER_27:
	case RTL_GIGA_MAC_VER_28:
4941
	case RTL_GIGA_MAC_VER_31:
H
hayeswang 已提交
4942 4943
	case RTL_GIGA_MAC_VER_32:
	case RTL_GIGA_MAC_VER_33:
4944
		RTL_W8(tp, PMCH, RTL_R8(tp, PMCH) | 0x80);
F
françois romieu 已提交
4945
		break;
4946
	case RTL_GIGA_MAC_VER_44:
4947 4948
	case RTL_GIGA_MAC_VER_45:
	case RTL_GIGA_MAC_VER_46:
C
Chun-Hao Lin 已提交
4949 4950
	case RTL_GIGA_MAC_VER_50:
	case RTL_GIGA_MAC_VER_51:
4951
		RTL_W8(tp, PMCH, RTL_R8(tp, PMCH) | 0xc0);
4952
		break;
4953 4954
	case RTL_GIGA_MAC_VER_40:
	case RTL_GIGA_MAC_VER_41:
C
Chun-Hao Lin 已提交
4955
	case RTL_GIGA_MAC_VER_49:
4956
		RTL_W8(tp, PMCH, RTL_R8(tp, PMCH) | 0xc0);
4957
		rtl_w0w1_eri(tp, 0x1a8, ERIAR_MASK_1111, 0xfc000000,
4958 4959
			     0x00000000, ERIAR_EXGMAC);
		break;
F
françois romieu 已提交
4960 4961 4962 4963 4964
	}

	r8168_phy_power_up(tp);
}

F
Francois Romieu 已提交
4965 4966
static void rtl_generic_op(struct rtl8169_private *tp,
			   void (*op)(struct rtl8169_private *))
F
françois romieu 已提交
4967 4968 4969 4970 4971 4972 4973
{
	if (op)
		op(tp);
}

static void rtl_pll_power_down(struct rtl8169_private *tp)
{
F
Francois Romieu 已提交
4974
	rtl_generic_op(tp, tp->pll_power_ops.down);
F
françois romieu 已提交
4975 4976 4977 4978
}

static void rtl_pll_power_up(struct rtl8169_private *tp)
{
F
Francois Romieu 已提交
4979
	rtl_generic_op(tp, tp->pll_power_ops.up);
F
françois romieu 已提交
4980 4981
}

B
Bill Pemberton 已提交
4982
static void rtl_init_pll_power_ops(struct rtl8169_private *tp)
F
françois romieu 已提交
4983 4984 4985 4986 4987 4988 4989 4990 4991
{
	struct pll_power_ops *ops = &tp->pll_power_ops;

	switch (tp->mac_version) {
	case RTL_GIGA_MAC_VER_07:
	case RTL_GIGA_MAC_VER_08:
	case RTL_GIGA_MAC_VER_09:
	case RTL_GIGA_MAC_VER_10:
	case RTL_GIGA_MAC_VER_16:
4992 4993
	case RTL_GIGA_MAC_VER_29:
	case RTL_GIGA_MAC_VER_30:
4994
	case RTL_GIGA_MAC_VER_37:
H
Hayes Wang 已提交
4995
	case RTL_GIGA_MAC_VER_39:
H
hayeswang 已提交
4996
	case RTL_GIGA_MAC_VER_43:
4997 4998
	case RTL_GIGA_MAC_VER_47:
	case RTL_GIGA_MAC_VER_48:
F
françois romieu 已提交
4999 5000 5001 5002 5003 5004 5005 5006 5007 5008 5009 5010 5011 5012 5013 5014 5015
		ops->down	= r810x_pll_power_down;
		ops->up		= r810x_pll_power_up;
		break;

	case RTL_GIGA_MAC_VER_11:
	case RTL_GIGA_MAC_VER_12:
	case RTL_GIGA_MAC_VER_17:
	case RTL_GIGA_MAC_VER_18:
	case RTL_GIGA_MAC_VER_19:
	case RTL_GIGA_MAC_VER_20:
	case RTL_GIGA_MAC_VER_21:
	case RTL_GIGA_MAC_VER_22:
	case RTL_GIGA_MAC_VER_23:
	case RTL_GIGA_MAC_VER_24:
	case RTL_GIGA_MAC_VER_25:
	case RTL_GIGA_MAC_VER_26:
	case RTL_GIGA_MAC_VER_27:
F
françois romieu 已提交
5016
	case RTL_GIGA_MAC_VER_28:
5017
	case RTL_GIGA_MAC_VER_31:
H
hayeswang 已提交
5018 5019
	case RTL_GIGA_MAC_VER_32:
	case RTL_GIGA_MAC_VER_33:
H
Hayes Wang 已提交
5020
	case RTL_GIGA_MAC_VER_34:
5021 5022
	case RTL_GIGA_MAC_VER_35:
	case RTL_GIGA_MAC_VER_36:
5023
	case RTL_GIGA_MAC_VER_38:
H
Hayes Wang 已提交
5024 5025
	case RTL_GIGA_MAC_VER_40:
	case RTL_GIGA_MAC_VER_41:
H
hayeswang 已提交
5026
	case RTL_GIGA_MAC_VER_42:
H
hayeswang 已提交
5027
	case RTL_GIGA_MAC_VER_44:
5028 5029
	case RTL_GIGA_MAC_VER_45:
	case RTL_GIGA_MAC_VER_46:
C
Chun-Hao Lin 已提交
5030 5031 5032
	case RTL_GIGA_MAC_VER_49:
	case RTL_GIGA_MAC_VER_50:
	case RTL_GIGA_MAC_VER_51:
F
françois romieu 已提交
5033 5034 5035 5036 5037 5038 5039 5040 5041 5042 5043
		ops->down	= r8168_pll_power_down;
		ops->up		= r8168_pll_power_up;
		break;

	default:
		ops->down	= NULL;
		ops->up		= NULL;
		break;
	}
}

5044 5045 5046 5047 5048 5049 5050 5051 5052 5053 5054 5055 5056 5057 5058 5059 5060
static void rtl_init_rxcfg(struct rtl8169_private *tp)
{
	switch (tp->mac_version) {
	case RTL_GIGA_MAC_VER_01:
	case RTL_GIGA_MAC_VER_02:
	case RTL_GIGA_MAC_VER_03:
	case RTL_GIGA_MAC_VER_04:
	case RTL_GIGA_MAC_VER_05:
	case RTL_GIGA_MAC_VER_06:
	case RTL_GIGA_MAC_VER_10:
	case RTL_GIGA_MAC_VER_11:
	case RTL_GIGA_MAC_VER_12:
	case RTL_GIGA_MAC_VER_13:
	case RTL_GIGA_MAC_VER_14:
	case RTL_GIGA_MAC_VER_15:
	case RTL_GIGA_MAC_VER_16:
	case RTL_GIGA_MAC_VER_17:
5061
		RTL_W32(tp, RxConfig, RX_FIFO_THRESH | RX_DMA_BURST);
5062 5063 5064 5065 5066 5067 5068 5069
		break;
	case RTL_GIGA_MAC_VER_18:
	case RTL_GIGA_MAC_VER_19:
	case RTL_GIGA_MAC_VER_20:
	case RTL_GIGA_MAC_VER_21:
	case RTL_GIGA_MAC_VER_22:
	case RTL_GIGA_MAC_VER_23:
	case RTL_GIGA_MAC_VER_24:
5070
	case RTL_GIGA_MAC_VER_34:
5071
	case RTL_GIGA_MAC_VER_35:
5072
		RTL_W32(tp, RxConfig, RX128_INT_EN | RX_MULTI_EN | RX_DMA_BURST);
5073
		break;
5074 5075
	case RTL_GIGA_MAC_VER_40:
	case RTL_GIGA_MAC_VER_41:
H
hayeswang 已提交
5076
	case RTL_GIGA_MAC_VER_42:
H
hayeswang 已提交
5077
	case RTL_GIGA_MAC_VER_43:
H
hayeswang 已提交
5078
	case RTL_GIGA_MAC_VER_44:
5079 5080 5081 5082
	case RTL_GIGA_MAC_VER_45:
	case RTL_GIGA_MAC_VER_46:
	case RTL_GIGA_MAC_VER_47:
	case RTL_GIGA_MAC_VER_48:
C
Chun-Hao Lin 已提交
5083 5084 5085
	case RTL_GIGA_MAC_VER_49:
	case RTL_GIGA_MAC_VER_50:
	case RTL_GIGA_MAC_VER_51:
5086
		RTL_W32(tp, RxConfig, RX128_INT_EN | RX_MULTI_EN | RX_DMA_BURST | RX_EARLY_OFF);
5087
		break;
5088
	default:
5089
		RTL_W32(tp, RxConfig, RX128_INT_EN | RX_DMA_BURST);
5090 5091 5092 5093
		break;
	}
}

5094 5095
static void rtl8169_init_ring_indexes(struct rtl8169_private *tp)
{
5096
	tp->dirty_tx = tp->cur_tx = tp->cur_rx = 0;
5097 5098
}

F
Francois Romieu 已提交
5099 5100
static void rtl_hw_jumbo_enable(struct rtl8169_private *tp)
{
5101
	RTL_W8(tp, Cfg9346, Cfg9346_Unlock);
F
Francois Romieu 已提交
5102
	rtl_generic_op(tp, tp->jumbo_ops.enable);
5103
	RTL_W8(tp, Cfg9346, Cfg9346_Lock);
F
Francois Romieu 已提交
5104 5105 5106 5107
}

static void rtl_hw_jumbo_disable(struct rtl8169_private *tp)
{
5108
	RTL_W8(tp, Cfg9346, Cfg9346_Unlock);
F
Francois Romieu 已提交
5109
	rtl_generic_op(tp, tp->jumbo_ops.disable);
5110
	RTL_W8(tp, Cfg9346, Cfg9346_Lock);
F
Francois Romieu 已提交
5111 5112 5113 5114
}

static void r8168c_hw_jumbo_enable(struct rtl8169_private *tp)
{
5115 5116
	RTL_W8(tp, Config3, RTL_R8(tp, Config3) | Jumbo_En0);
	RTL_W8(tp, Config4, RTL_R8(tp, Config4) | Jumbo_En1);
5117
	rtl_tx_performance_tweak(tp, PCI_EXP_DEVCTL_READRQ_512B);
F
Francois Romieu 已提交
5118 5119 5120 5121
}

static void r8168c_hw_jumbo_disable(struct rtl8169_private *tp)
{
5122 5123
	RTL_W8(tp, Config3, RTL_R8(tp, Config3) & ~Jumbo_En0);
	RTL_W8(tp, Config4, RTL_R8(tp, Config4) & ~Jumbo_En1);
5124
	rtl_tx_performance_tweak(tp, PCI_EXP_DEVCTL_READRQ_4096B);
F
Francois Romieu 已提交
5125 5126 5127 5128
}

static void r8168dp_hw_jumbo_enable(struct rtl8169_private *tp)
{
5129
	RTL_W8(tp, Config3, RTL_R8(tp, Config3) | Jumbo_En0);
F
Francois Romieu 已提交
5130 5131 5132 5133
}

static void r8168dp_hw_jumbo_disable(struct rtl8169_private *tp)
{
5134
	RTL_W8(tp, Config3, RTL_R8(tp, Config3) & ~Jumbo_En0);
F
Francois Romieu 已提交
5135 5136 5137 5138
}

static void r8168e_hw_jumbo_enable(struct rtl8169_private *tp)
{
5139 5140 5141
	RTL_W8(tp, MaxTxPacketSize, 0x3f);
	RTL_W8(tp, Config3, RTL_R8(tp, Config3) | Jumbo_En0);
	RTL_W8(tp, Config4, RTL_R8(tp, Config4) | 0x01);
5142
	rtl_tx_performance_tweak(tp, PCI_EXP_DEVCTL_READRQ_512B);
F
Francois Romieu 已提交
5143 5144 5145 5146
}

static void r8168e_hw_jumbo_disable(struct rtl8169_private *tp)
{
5147 5148 5149
	RTL_W8(tp, MaxTxPacketSize, 0x0c);
	RTL_W8(tp, Config3, RTL_R8(tp, Config3) & ~Jumbo_En0);
	RTL_W8(tp, Config4, RTL_R8(tp, Config4) & ~0x01);
5150
	rtl_tx_performance_tweak(tp, PCI_EXP_DEVCTL_READRQ_4096B);
F
Francois Romieu 已提交
5151 5152 5153 5154
}

static void r8168b_0_hw_jumbo_enable(struct rtl8169_private *tp)
{
5155
	rtl_tx_performance_tweak(tp,
5156
		PCI_EXP_DEVCTL_READRQ_512B | PCI_EXP_DEVCTL_NOSNOOP_EN);
F
Francois Romieu 已提交
5157 5158 5159 5160
}

static void r8168b_0_hw_jumbo_disable(struct rtl8169_private *tp)
{
5161
	rtl_tx_performance_tweak(tp,
5162
		PCI_EXP_DEVCTL_READRQ_4096B | PCI_EXP_DEVCTL_NOSNOOP_EN);
F
Francois Romieu 已提交
5163 5164 5165 5166 5167 5168
}

static void r8168b_1_hw_jumbo_enable(struct rtl8169_private *tp)
{
	r8168b_0_hw_jumbo_enable(tp);

5169
	RTL_W8(tp, Config4, RTL_R8(tp, Config4) | (1 << 0));
F
Francois Romieu 已提交
5170 5171 5172 5173 5174 5175
}

static void r8168b_1_hw_jumbo_disable(struct rtl8169_private *tp)
{
	r8168b_0_hw_jumbo_disable(tp);

5176
	RTL_W8(tp, Config4, RTL_R8(tp, Config4) & ~(1 << 0));
F
Francois Romieu 已提交
5177 5178
}

B
Bill Pemberton 已提交
5179
static void rtl_init_jumbo_ops(struct rtl8169_private *tp)
F
Francois Romieu 已提交
5180 5181 5182 5183 5184 5185 5186 5187 5188 5189 5190 5191 5192 5193 5194 5195 5196 5197 5198 5199 5200 5201 5202 5203 5204 5205 5206 5207 5208 5209 5210 5211 5212 5213 5214 5215 5216 5217 5218 5219 5220 5221
{
	struct jumbo_ops *ops = &tp->jumbo_ops;

	switch (tp->mac_version) {
	case RTL_GIGA_MAC_VER_11:
		ops->disable	= r8168b_0_hw_jumbo_disable;
		ops->enable	= r8168b_0_hw_jumbo_enable;
		break;
	case RTL_GIGA_MAC_VER_12:
	case RTL_GIGA_MAC_VER_17:
		ops->disable	= r8168b_1_hw_jumbo_disable;
		ops->enable	= r8168b_1_hw_jumbo_enable;
		break;
	case RTL_GIGA_MAC_VER_18: /* Wild guess. Needs info from Realtek. */
	case RTL_GIGA_MAC_VER_19:
	case RTL_GIGA_MAC_VER_20:
	case RTL_GIGA_MAC_VER_21: /* Wild guess. Needs info from Realtek. */
	case RTL_GIGA_MAC_VER_22:
	case RTL_GIGA_MAC_VER_23:
	case RTL_GIGA_MAC_VER_24:
	case RTL_GIGA_MAC_VER_25:
	case RTL_GIGA_MAC_VER_26:
		ops->disable	= r8168c_hw_jumbo_disable;
		ops->enable	= r8168c_hw_jumbo_enable;
		break;
	case RTL_GIGA_MAC_VER_27:
	case RTL_GIGA_MAC_VER_28:
		ops->disable	= r8168dp_hw_jumbo_disable;
		ops->enable	= r8168dp_hw_jumbo_enable;
		break;
	case RTL_GIGA_MAC_VER_31: /* Wild guess. Needs info from Realtek. */
	case RTL_GIGA_MAC_VER_32:
	case RTL_GIGA_MAC_VER_33:
	case RTL_GIGA_MAC_VER_34:
		ops->disable	= r8168e_hw_jumbo_disable;
		ops->enable	= r8168e_hw_jumbo_enable;
		break;

	/*
	 * No action needed for jumbo frames with 8169.
	 * No jumbo for 810x at all.
	 */
H
Hayes Wang 已提交
5222 5223
	case RTL_GIGA_MAC_VER_40:
	case RTL_GIGA_MAC_VER_41:
H
hayeswang 已提交
5224
	case RTL_GIGA_MAC_VER_42:
H
hayeswang 已提交
5225
	case RTL_GIGA_MAC_VER_43:
H
hayeswang 已提交
5226
	case RTL_GIGA_MAC_VER_44:
5227 5228 5229 5230
	case RTL_GIGA_MAC_VER_45:
	case RTL_GIGA_MAC_VER_46:
	case RTL_GIGA_MAC_VER_47:
	case RTL_GIGA_MAC_VER_48:
C
Chun-Hao Lin 已提交
5231 5232 5233
	case RTL_GIGA_MAC_VER_49:
	case RTL_GIGA_MAC_VER_50:
	case RTL_GIGA_MAC_VER_51:
F
Francois Romieu 已提交
5234 5235 5236 5237 5238 5239 5240
	default:
		ops->disable	= NULL;
		ops->enable	= NULL;
		break;
	}
}

5241 5242
DECLARE_RTL_COND(rtl_chipcmd_cond)
{
5243
	return RTL_R8(tp, ChipCmd) & CmdReset;
5244 5245
}

5246 5247
static void rtl_hw_reset(struct rtl8169_private *tp)
{
5248
	RTL_W8(tp, ChipCmd, CmdReset);
5249

5250
	rtl_udelay_loop_wait_low(tp, &rtl_chipcmd_cond, 100, 100);
5251 5252
}

5253
static void rtl_request_uncached_firmware(struct rtl8169_private *tp)
5254
{
5255 5256 5257
	struct rtl_fw *rtl_fw;
	const char *name;
	int rc = -ENOMEM;
5258

5259 5260 5261
	name = rtl_lookup_firmware_name(tp);
	if (!name)
		goto out_no_firmware;
5262

5263 5264 5265
	rtl_fw = kzalloc(sizeof(*rtl_fw), GFP_KERNEL);
	if (!rtl_fw)
		goto err_warn;
5266

H
Heiner Kallweit 已提交
5267
	rc = request_firmware(&rtl_fw->fw, name, tp_to_dev(tp));
5268 5269 5270
	if (rc < 0)
		goto err_free;

5271 5272 5273 5274
	rc = rtl_check_firmware(tp, rtl_fw);
	if (rc < 0)
		goto err_release_firmware;

5275 5276 5277 5278
	tp->rtl_fw = rtl_fw;
out:
	return;

5279 5280
err_release_firmware:
	release_firmware(rtl_fw->fw);
5281 5282 5283 5284 5285 5286 5287 5288 5289 5290 5291 5292 5293 5294
err_free:
	kfree(rtl_fw);
err_warn:
	netif_warn(tp, ifup, tp->dev, "unable to load firmware patch %s (%d)\n",
		   name, rc);
out_no_firmware:
	tp->rtl_fw = NULL;
	goto out;
}

static void rtl_request_firmware(struct rtl8169_private *tp)
{
	if (IS_ERR(tp->rtl_fw))
		rtl_request_uncached_firmware(tp);
5295 5296
}

5297 5298
static void rtl_rx_close(struct rtl8169_private *tp)
{
5299
	RTL_W32(tp, RxConfig, RTL_R32(tp, RxConfig) & ~RX_CONFIG_ACCEPT_MASK);
5300 5301
}

5302 5303
DECLARE_RTL_COND(rtl_npq_cond)
{
5304
	return RTL_R8(tp, TxPoll) & NPQ;
5305 5306 5307 5308
}

DECLARE_RTL_COND(rtl_txcfg_empty_cond)
{
5309
	return RTL_R32(tp, TxConfig) & TXCFG_EMPTY;
5310 5311
}

F
françois romieu 已提交
5312
static void rtl8169_hw_reset(struct rtl8169_private *tp)
L
Linus Torvalds 已提交
5313 5314
{
	/* Disable interrupts */
F
françois romieu 已提交
5315
	rtl8169_irq_mask_and_ack(tp);
L
Linus Torvalds 已提交
5316

5317 5318
	rtl_rx_close(tp);

5319
	if (tp->mac_version == RTL_GIGA_MAC_VER_27 ||
5320 5321
	    tp->mac_version == RTL_GIGA_MAC_VER_28 ||
	    tp->mac_version == RTL_GIGA_MAC_VER_31) {
5322
		rtl_udelay_loop_wait_low(tp, &rtl_npq_cond, 20, 42*42);
5323
	} else if (tp->mac_version == RTL_GIGA_MAC_VER_34 ||
5324 5325 5326 5327 5328 5329 5330 5331 5332 5333 5334 5335
		   tp->mac_version == RTL_GIGA_MAC_VER_35 ||
		   tp->mac_version == RTL_GIGA_MAC_VER_36 ||
		   tp->mac_version == RTL_GIGA_MAC_VER_37 ||
		   tp->mac_version == RTL_GIGA_MAC_VER_38 ||
		   tp->mac_version == RTL_GIGA_MAC_VER_40 ||
		   tp->mac_version == RTL_GIGA_MAC_VER_41 ||
		   tp->mac_version == RTL_GIGA_MAC_VER_42 ||
		   tp->mac_version == RTL_GIGA_MAC_VER_43 ||
		   tp->mac_version == RTL_GIGA_MAC_VER_44 ||
		   tp->mac_version == RTL_GIGA_MAC_VER_45 ||
		   tp->mac_version == RTL_GIGA_MAC_VER_46 ||
		   tp->mac_version == RTL_GIGA_MAC_VER_47 ||
C
Chun-Hao Lin 已提交
5336 5337 5338 5339
		   tp->mac_version == RTL_GIGA_MAC_VER_48 ||
		   tp->mac_version == RTL_GIGA_MAC_VER_49 ||
		   tp->mac_version == RTL_GIGA_MAC_VER_50 ||
		   tp->mac_version == RTL_GIGA_MAC_VER_51) {
5340
		RTL_W8(tp, ChipCmd, RTL_R8(tp, ChipCmd) | StopReq);
5341
		rtl_udelay_loop_wait_high(tp, &rtl_txcfg_empty_cond, 100, 666);
5342
	} else {
5343
		RTL_W8(tp, ChipCmd, RTL_R8(tp, ChipCmd) | StopReq);
5344
		udelay(100);
F
françois romieu 已提交
5345 5346
	}

5347
	rtl_hw_reset(tp);
L
Linus Torvalds 已提交
5348 5349
}

5350
static void rtl_set_rx_tx_config_registers(struct rtl8169_private *tp)
5351 5352
{
	/* Set DMA burst size and Interframe Gap Time */
5353
	RTL_W32(tp, TxConfig, (TX_DMA_BURST << TxDMAShift) |
5354 5355 5356
		(InterFrameGap << TxInterFrameGapShift));
}

5357
static void rtl_hw_start(struct net_device *dev)
L
Linus Torvalds 已提交
5358 5359 5360
{
	struct rtl8169_private *tp = netdev_priv(dev);

5361 5362
	tp->hw_start(dev);

5363
	rtl_irq_enable_all(tp);
5364 5365
}

5366
static void rtl_set_rx_tx_desc_registers(struct rtl8169_private *tp)
5367 5368 5369 5370 5371 5372
{
	/*
	 * Magic spell: some iop3xx ARM board needs the TxDescAddrHigh
	 * register to be written before TxDescAddrLow to work.
	 * Switching from MMIO to I/O access fixes the issue as well.
	 */
5373 5374 5375 5376
	RTL_W32(tp, TxDescStartAddrHigh, ((u64) tp->TxPhyAddr) >> 32);
	RTL_W32(tp, TxDescStartAddrLow, ((u64) tp->TxPhyAddr) & DMA_BIT_MASK(32));
	RTL_W32(tp, RxDescAddrHigh, ((u64) tp->RxPhyAddr) >> 32);
	RTL_W32(tp, RxDescAddrLow, ((u64) tp->RxPhyAddr) & DMA_BIT_MASK(32));
5377 5378
}

5379
static u16 rtl_rw_cpluscmd(struct rtl8169_private *tp)
5380 5381 5382
{
	u16 cmd;

5383 5384
	cmd = RTL_R16(tp, CPlusCmd);
	RTL_W16(tp, CPlusCmd, cmd);
5385 5386 5387
	return cmd;
}

5388
static void rtl_set_rx_max_size(struct rtl8169_private *tp, unsigned int rx_buf_sz)
5389 5390
{
	/* Low hurts. Let's disable the filtering. */
5391
	RTL_W16(tp, RxMaxSize, rx_buf_sz + 1);
5392 5393
}

5394
static void rtl8169_set_magic_reg(struct rtl8169_private *tp, unsigned mac_version)
5395
{
5396
	static const struct rtl_cfg2_info {
5397 5398 5399 5400 5401 5402 5403 5404
		u32 mac_version;
		u32 clk;
		u32 val;
	} cfg2_info [] = {
		{ RTL_GIGA_MAC_VER_05, PCI_Clock_33MHz, 0x000fff00 }, // 8110SCd
		{ RTL_GIGA_MAC_VER_05, PCI_Clock_66MHz, 0x000fffff },
		{ RTL_GIGA_MAC_VER_06, PCI_Clock_33MHz, 0x00ffff00 }, // 8110SCe
		{ RTL_GIGA_MAC_VER_06, PCI_Clock_66MHz, 0x00ffffff }
5405 5406
	};
	const struct rtl_cfg2_info *p = cfg2_info;
5407 5408 5409
	unsigned int i;
	u32 clk;

5410
	clk = RTL_R8(tp, Config2) & PCI_Clock_66MHz;
5411
	for (i = 0; i < ARRAY_SIZE(cfg2_info); i++, p++) {
5412
		if ((p->mac_version == mac_version) && (p->clk == clk)) {
5413
			RTL_W32(tp, 0x7c, p->val);
5414 5415 5416 5417 5418
			break;
		}
	}
}

5419 5420 5421 5422 5423 5424 5425 5426 5427 5428 5429 5430 5431 5432 5433 5434 5435 5436 5437 5438 5439 5440 5441 5442 5443 5444 5445 5446 5447 5448 5449 5450 5451 5452
static void rtl_set_rx_mode(struct net_device *dev)
{
	struct rtl8169_private *tp = netdev_priv(dev);
	u32 mc_filter[2];	/* Multicast hash filter */
	int rx_mode;
	u32 tmp = 0;

	if (dev->flags & IFF_PROMISC) {
		/* Unconditionally log net taps. */
		netif_notice(tp, link, dev, "Promiscuous mode enabled\n");
		rx_mode =
		    AcceptBroadcast | AcceptMulticast | AcceptMyPhys |
		    AcceptAllPhys;
		mc_filter[1] = mc_filter[0] = 0xffffffff;
	} else if ((netdev_mc_count(dev) > multicast_filter_limit) ||
		   (dev->flags & IFF_ALLMULTI)) {
		/* Too many to filter perfectly -- accept all multicasts. */
		rx_mode = AcceptBroadcast | AcceptMulticast | AcceptMyPhys;
		mc_filter[1] = mc_filter[0] = 0xffffffff;
	} else {
		struct netdev_hw_addr *ha;

		rx_mode = AcceptBroadcast | AcceptMyPhys;
		mc_filter[1] = mc_filter[0] = 0;
		netdev_for_each_mc_addr(ha, dev) {
			int bit_nr = ether_crc(ETH_ALEN, ha->addr) >> 26;
			mc_filter[bit_nr >> 5] |= 1 << (bit_nr & 31);
			rx_mode |= AcceptMulticast;
		}
	}

	if (dev->features & NETIF_F_RXALL)
		rx_mode |= (AcceptErr | AcceptRunt);

5453
	tmp = (RTL_R32(tp, RxConfig) & ~RX_CONFIG_ACCEPT_MASK) | rx_mode;
5454 5455 5456 5457 5458 5459 5460 5461

	if (tp->mac_version > RTL_GIGA_MAC_VER_06) {
		u32 data = mc_filter[0];

		mc_filter[0] = swab32(mc_filter[1]);
		mc_filter[1] = swab32(data);
	}

5462 5463 5464
	if (tp->mac_version == RTL_GIGA_MAC_VER_35)
		mc_filter[1] = mc_filter[0] = 0xffffffff;

5465 5466
	RTL_W32(tp, MAR0 + 4, mc_filter[1]);
	RTL_W32(tp, MAR0 + 0, mc_filter[0]);
5467

5468
	RTL_W32(tp, RxConfig, tmp);
5469 5470
}

5471 5472 5473 5474 5475
static void rtl_hw_start_8169(struct net_device *dev)
{
	struct rtl8169_private *tp = netdev_priv(dev);
	struct pci_dev *pdev = tp->pci_dev;

5476
	if (tp->mac_version == RTL_GIGA_MAC_VER_05) {
5477
		RTL_W16(tp, CPlusCmd, RTL_R16(tp, CPlusCmd) | PCIMulRW);
5478 5479 5480
		pci_write_config_byte(pdev, PCI_CACHE_LINE_SIZE, 0x08);
	}

5481
	RTL_W8(tp, Cfg9346, Cfg9346_Unlock);
F
Francois Romieu 已提交
5482 5483 5484 5485
	if (tp->mac_version == RTL_GIGA_MAC_VER_01 ||
	    tp->mac_version == RTL_GIGA_MAC_VER_02 ||
	    tp->mac_version == RTL_GIGA_MAC_VER_03 ||
	    tp->mac_version == RTL_GIGA_MAC_VER_04)
5486
		RTL_W8(tp, ChipCmd, CmdTxEnb | CmdRxEnb);
5487

5488 5489
	rtl_init_rxcfg(tp);

5490
	RTL_W8(tp, EarlyTxThres, NoEarlyTx);
L
Linus Torvalds 已提交
5491

5492
	rtl_set_rx_max_size(tp, rx_buf_sz);
L
Linus Torvalds 已提交
5493

F
Francois Romieu 已提交
5494 5495 5496 5497
	if (tp->mac_version == RTL_GIGA_MAC_VER_01 ||
	    tp->mac_version == RTL_GIGA_MAC_VER_02 ||
	    tp->mac_version == RTL_GIGA_MAC_VER_03 ||
	    tp->mac_version == RTL_GIGA_MAC_VER_04)
5498
		rtl_set_rx_tx_config_registers(tp);
L
Linus Torvalds 已提交
5499

5500
	tp->cp_cmd |= rtl_rw_cpluscmd(tp) | PCIMulRW;
L
Linus Torvalds 已提交
5501

F
Francois Romieu 已提交
5502 5503
	if (tp->mac_version == RTL_GIGA_MAC_VER_02 ||
	    tp->mac_version == RTL_GIGA_MAC_VER_03) {
5504
		dprintk("Set MAC Reg C+CR Offset 0xe0. "
L
Linus Torvalds 已提交
5505
			"Bit-3 and bit-14 MUST be 1\n");
5506
		tp->cp_cmd |= (1 << 14);
L
Linus Torvalds 已提交
5507 5508
	}

5509
	RTL_W16(tp, CPlusCmd, tp->cp_cmd);
5510

5511
	rtl8169_set_magic_reg(tp, tp->mac_version);
5512

L
Linus Torvalds 已提交
5513 5514 5515 5516
	/*
	 * Undocumented corner. Supposedly:
	 * (TxTimer << 12) | (TxPackets << 8) | (RxTimer << 4) | RxPackets
	 */
5517
	RTL_W16(tp, IntrMitigate, 0x0000);
L
Linus Torvalds 已提交
5518

5519
	rtl_set_rx_tx_desc_registers(tp);
5520

F
Francois Romieu 已提交
5521 5522 5523 5524
	if (tp->mac_version != RTL_GIGA_MAC_VER_01 &&
	    tp->mac_version != RTL_GIGA_MAC_VER_02 &&
	    tp->mac_version != RTL_GIGA_MAC_VER_03 &&
	    tp->mac_version != RTL_GIGA_MAC_VER_04) {
5525
		RTL_W8(tp, ChipCmd, CmdTxEnb | CmdRxEnb);
5526 5527 5528
		rtl_set_rx_tx_config_registers(tp);
	}

5529
	RTL_W8(tp, Cfg9346, Cfg9346_Lock);
F
Francois Romieu 已提交
5530 5531

	/* Initially a 10 us delay. Turned it into a PCI commit. - FR */
5532
	RTL_R8(tp, IntrMask);
L
Linus Torvalds 已提交
5533

5534
	RTL_W32(tp, RxMissed, 0);
L
Linus Torvalds 已提交
5535

5536
	rtl_set_rx_mode(dev);
L
Linus Torvalds 已提交
5537 5538

	/* no early-rx interrupts */
5539
	RTL_W16(tp, MultiIntr, RTL_R16(tp, MultiIntr) & 0xf000);
5540
}
L
Linus Torvalds 已提交
5541

5542 5543 5544
static void rtl_csi_write(struct rtl8169_private *tp, int addr, int value)
{
	if (tp->csi_ops.write)
5545
		tp->csi_ops.write(tp, addr, value);
5546 5547 5548 5549
}

static u32 rtl_csi_read(struct rtl8169_private *tp, int addr)
{
5550
	return tp->csi_ops.read ? tp->csi_ops.read(tp, addr) : ~0;
5551 5552 5553
}

static void rtl_csi_access_enable(struct rtl8169_private *tp, u32 bits)
5554 5555 5556
{
	u32 csi;

5557 5558 5559 5560 5561 5562 5563
	csi = rtl_csi_read(tp, 0x070c) & 0x00ffffff;
	rtl_csi_write(tp, 0x070c, csi | bits);
}

static void rtl_csi_access_enable_1(struct rtl8169_private *tp)
{
	rtl_csi_access_enable(tp, 0x17000000);
5564 5565
}

5566
static void rtl_csi_access_enable_2(struct rtl8169_private *tp)
F
françois romieu 已提交
5567
{
5568
	rtl_csi_access_enable(tp, 0x27000000);
F
françois romieu 已提交
5569 5570
}

5571 5572
DECLARE_RTL_COND(rtl_csiar_cond)
{
5573
	return RTL_R32(tp, CSIAR) & CSIAR_FLAG;
5574 5575
}

5576
static void r8169_csi_write(struct rtl8169_private *tp, int addr, int value)
5577
{
5578 5579
	RTL_W32(tp, CSIDR, value);
	RTL_W32(tp, CSIAR, CSIAR_WRITE_CMD | (addr & CSIAR_ADDR_MASK) |
5580 5581
		CSIAR_BYTE_ENABLE << CSIAR_BYTE_ENABLE_SHIFT);

5582
	rtl_udelay_loop_wait_low(tp, &rtl_csiar_cond, 10, 100);
5583 5584
}

5585
static u32 r8169_csi_read(struct rtl8169_private *tp, int addr)
5586
{
5587
	RTL_W32(tp, CSIAR, (addr & CSIAR_ADDR_MASK) |
5588 5589
		CSIAR_BYTE_ENABLE << CSIAR_BYTE_ENABLE_SHIFT);

5590
	return rtl_udelay_loop_wait_high(tp, &rtl_csiar_cond, 10, 100) ?
5591
		RTL_R32(tp, CSIDR) : ~0;
5592 5593
}

5594
static void r8402_csi_write(struct rtl8169_private *tp, int addr, int value)
5595
{
5596 5597
	RTL_W32(tp, CSIDR, value);
	RTL_W32(tp, CSIAR, CSIAR_WRITE_CMD | (addr & CSIAR_ADDR_MASK) |
5598 5599 5600
		CSIAR_BYTE_ENABLE << CSIAR_BYTE_ENABLE_SHIFT |
		CSIAR_FUNC_NIC);

5601
	rtl_udelay_loop_wait_low(tp, &rtl_csiar_cond, 10, 100);
5602 5603
}

5604
static u32 r8402_csi_read(struct rtl8169_private *tp, int addr)
5605
{
5606
	RTL_W32(tp, CSIAR, (addr & CSIAR_ADDR_MASK) | CSIAR_FUNC_NIC |
5607 5608
		CSIAR_BYTE_ENABLE << CSIAR_BYTE_ENABLE_SHIFT);

5609
	return rtl_udelay_loop_wait_high(tp, &rtl_csiar_cond, 10, 100) ?
5610
		RTL_R32(tp, CSIDR) : ~0;
5611 5612
}

H
hayeswang 已提交
5613 5614
static void r8411_csi_write(struct rtl8169_private *tp, int addr, int value)
{
5615 5616
	RTL_W32(tp, CSIDR, value);
	RTL_W32(tp, CSIAR, CSIAR_WRITE_CMD | (addr & CSIAR_ADDR_MASK) |
H
hayeswang 已提交
5617 5618 5619 5620 5621 5622 5623 5624
		CSIAR_BYTE_ENABLE << CSIAR_BYTE_ENABLE_SHIFT |
		CSIAR_FUNC_NIC2);

	rtl_udelay_loop_wait_low(tp, &rtl_csiar_cond, 10, 100);
}

static u32 r8411_csi_read(struct rtl8169_private *tp, int addr)
{
5625
	RTL_W32(tp, CSIAR, (addr & CSIAR_ADDR_MASK) | CSIAR_FUNC_NIC2 |
H
hayeswang 已提交
5626 5627 5628
		CSIAR_BYTE_ENABLE << CSIAR_BYTE_ENABLE_SHIFT);

	return rtl_udelay_loop_wait_high(tp, &rtl_csiar_cond, 10, 100) ?
5629
		RTL_R32(tp, CSIDR) : ~0;
H
hayeswang 已提交
5630 5631
}

B
Bill Pemberton 已提交
5632
static void rtl_init_csi_ops(struct rtl8169_private *tp)
5633 5634 5635 5636 5637 5638 5639 5640 5641 5642 5643 5644 5645 5646 5647 5648 5649 5650 5651 5652 5653 5654
{
	struct csi_ops *ops = &tp->csi_ops;

	switch (tp->mac_version) {
	case RTL_GIGA_MAC_VER_01:
	case RTL_GIGA_MAC_VER_02:
	case RTL_GIGA_MAC_VER_03:
	case RTL_GIGA_MAC_VER_04:
	case RTL_GIGA_MAC_VER_05:
	case RTL_GIGA_MAC_VER_06:
	case RTL_GIGA_MAC_VER_10:
	case RTL_GIGA_MAC_VER_11:
	case RTL_GIGA_MAC_VER_12:
	case RTL_GIGA_MAC_VER_13:
	case RTL_GIGA_MAC_VER_14:
	case RTL_GIGA_MAC_VER_15:
	case RTL_GIGA_MAC_VER_16:
	case RTL_GIGA_MAC_VER_17:
		ops->write	= NULL;
		ops->read	= NULL;
		break;

5655
	case RTL_GIGA_MAC_VER_37:
5656
	case RTL_GIGA_MAC_VER_38:
5657 5658 5659 5660
		ops->write	= r8402_csi_write;
		ops->read	= r8402_csi_read;
		break;

H
hayeswang 已提交
5661 5662 5663 5664 5665
	case RTL_GIGA_MAC_VER_44:
		ops->write	= r8411_csi_write;
		ops->read	= r8411_csi_read;
		break;

5666 5667 5668 5669 5670
	default:
		ops->write	= r8169_csi_write;
		ops->read	= r8169_csi_read;
		break;
	}
5671 5672 5673 5674 5675 5676 5677 5678
}

struct ephy_info {
	unsigned int offset;
	u16 mask;
	u16 bits;
};

5679 5680
static void rtl_ephy_init(struct rtl8169_private *tp, const struct ephy_info *e,
			  int len)
5681 5682 5683 5684
{
	u16 w;

	while (len-- > 0) {
5685 5686
		w = (rtl_ephy_read(tp, e->offset) & ~e->mask) | e->bits;
		rtl_ephy_write(tp, e->offset, w);
5687 5688 5689 5690
		e++;
	}
}

5691
static void rtl_disable_clock_request(struct rtl8169_private *tp)
5692
{
5693
	pcie_capability_clear_word(tp->pci_dev, PCI_EXP_LNKCTL,
5694
				   PCI_EXP_LNKCTL_CLKREQ_EN);
5695 5696
}

5697
static void rtl_enable_clock_request(struct rtl8169_private *tp)
F
françois romieu 已提交
5698
{
5699
	pcie_capability_set_word(tp->pci_dev, PCI_EXP_LNKCTL,
5700
				 PCI_EXP_LNKCTL_CLKREQ_EN);
F
françois romieu 已提交
5701 5702
}

H
hayeswang 已提交
5703 5704 5705 5706
static void rtl_pcie_state_l2l3_enable(struct rtl8169_private *tp, bool enable)
{
	u8 data;

5707
	data = RTL_R8(tp, Config3);
H
hayeswang 已提交
5708 5709 5710 5711 5712 5713

	if (enable)
		data |= Rdy_to_L23;
	else
		data &= ~Rdy_to_L23;

5714
	RTL_W8(tp, Config3, data);
H
hayeswang 已提交
5715 5716
}

5717 5718 5719 5720 5721 5722 5723 5724 5725 5726 5727
#define R8168_CPCMD_QUIRK_MASK (\
	EnableBist | \
	Mac_dbgo_oe | \
	Force_half_dup | \
	Force_rxflow_en | \
	Force_txflow_en | \
	Cxpl_dbg_sel | \
	ASF | \
	PktCntrDisable | \
	Mac_dbgo_sel)

5728
static void rtl_hw_start_8168bb(struct rtl8169_private *tp)
5729
{
5730
	RTL_W8(tp, Config3, RTL_R8(tp, Config3) & ~Beacon_en);
5731

5732
	RTL_W16(tp, CPlusCmd, RTL_R16(tp, CPlusCmd) & ~R8168_CPCMD_QUIRK_MASK);
5733

5734
	if (tp->dev->mtu <= ETH_DATA_LEN) {
5735
		rtl_tx_performance_tweak(tp, PCI_EXP_DEVCTL_READRQ_4096B |
5736 5737
					 PCI_EXP_DEVCTL_NOSNOOP_EN);
	}
5738 5739
}

5740
static void rtl_hw_start_8168bef(struct rtl8169_private *tp)
5741
{
5742
	rtl_hw_start_8168bb(tp);
5743

5744
	RTL_W8(tp, MaxTxPacketSize, TxPacketMax);
5745

5746
	RTL_W8(tp, Config4, RTL_R8(tp, Config4) & ~(1 << 0));
5747 5748
}

5749
static void __rtl_hw_start_8168cp(struct rtl8169_private *tp)
5750
{
5751
	RTL_W8(tp, Config1, RTL_R8(tp, Config1) | Speed_down);
5752

5753
	RTL_W8(tp, Config3, RTL_R8(tp, Config3) & ~Beacon_en);
5754

5755
	if (tp->dev->mtu <= ETH_DATA_LEN)
5756
		rtl_tx_performance_tweak(tp, PCI_EXP_DEVCTL_READRQ_4096B);
5757

5758
	rtl_disable_clock_request(tp);
5759

5760
	RTL_W16(tp, CPlusCmd, RTL_R16(tp, CPlusCmd) & ~R8168_CPCMD_QUIRK_MASK);
5761 5762
}

5763
static void rtl_hw_start_8168cp_1(struct rtl8169_private *tp)
5764
{
5765
	static const struct ephy_info e_info_8168cp[] = {
5766 5767 5768 5769 5770 5771 5772
		{ 0x01, 0,	0x0001 },
		{ 0x02, 0x0800,	0x1000 },
		{ 0x03, 0,	0x0042 },
		{ 0x06, 0x0080,	0x0000 },
		{ 0x07, 0,	0x2000 }
	};

5773
	rtl_csi_access_enable_2(tp);
5774

5775
	rtl_ephy_init(tp, e_info_8168cp, ARRAY_SIZE(e_info_8168cp));
5776

5777
	__rtl_hw_start_8168cp(tp);
5778 5779
}

5780
static void rtl_hw_start_8168cp_2(struct rtl8169_private *tp)
F
Francois Romieu 已提交
5781
{
5782
	rtl_csi_access_enable_2(tp);
F
Francois Romieu 已提交
5783

5784
	RTL_W8(tp, Config3, RTL_R8(tp, Config3) & ~Beacon_en);
F
Francois Romieu 已提交
5785

5786
	if (tp->dev->mtu <= ETH_DATA_LEN)
5787
		rtl_tx_performance_tweak(tp, PCI_EXP_DEVCTL_READRQ_4096B);
F
Francois Romieu 已提交
5788

5789
	RTL_W16(tp, CPlusCmd, RTL_R16(tp, CPlusCmd) & ~R8168_CPCMD_QUIRK_MASK);
F
Francois Romieu 已提交
5790 5791
}

5792
static void rtl_hw_start_8168cp_3(struct rtl8169_private *tp)
5793
{
5794
	rtl_csi_access_enable_2(tp);
5795

5796
	RTL_W8(tp, Config3, RTL_R8(tp, Config3) & ~Beacon_en);
5797 5798

	/* Magic. */
5799
	RTL_W8(tp, DBG_REG, 0x20);
5800

5801
	RTL_W8(tp, MaxTxPacketSize, TxPacketMax);
5802

5803
	if (tp->dev->mtu <= ETH_DATA_LEN)
5804
		rtl_tx_performance_tweak(tp, PCI_EXP_DEVCTL_READRQ_4096B);
5805

5806
	RTL_W16(tp, CPlusCmd, RTL_R16(tp, CPlusCmd) & ~R8168_CPCMD_QUIRK_MASK);
5807 5808
}

5809
static void rtl_hw_start_8168c_1(struct rtl8169_private *tp)
5810
{
5811
	static const struct ephy_info e_info_8168c_1[] = {
5812 5813 5814 5815 5816
		{ 0x02, 0x0800,	0x1000 },
		{ 0x03, 0,	0x0002 },
		{ 0x06, 0x0080,	0x0000 }
	};

5817
	rtl_csi_access_enable_2(tp);
5818

5819
	RTL_W8(tp, DBG_REG, 0x06 | FIX_NAK_1 | FIX_NAK_2);
5820

5821
	rtl_ephy_init(tp, e_info_8168c_1, ARRAY_SIZE(e_info_8168c_1));
5822

5823
	__rtl_hw_start_8168cp(tp);
5824 5825
}

5826
static void rtl_hw_start_8168c_2(struct rtl8169_private *tp)
5827
{
5828
	static const struct ephy_info e_info_8168c_2[] = {
5829 5830 5831 5832
		{ 0x01, 0,	0x0001 },
		{ 0x03, 0x0400,	0x0220 }
	};

5833
	rtl_csi_access_enable_2(tp);
5834

5835
	rtl_ephy_init(tp, e_info_8168c_2, ARRAY_SIZE(e_info_8168c_2));
5836

5837
	__rtl_hw_start_8168cp(tp);
5838 5839
}

5840
static void rtl_hw_start_8168c_3(struct rtl8169_private *tp)
F
Francois Romieu 已提交
5841
{
5842
	rtl_hw_start_8168c_2(tp);
F
Francois Romieu 已提交
5843 5844
}

5845
static void rtl_hw_start_8168c_4(struct rtl8169_private *tp)
5846
{
5847
	rtl_csi_access_enable_2(tp);
5848

5849
	__rtl_hw_start_8168cp(tp);
5850 5851
}

5852
static void rtl_hw_start_8168d(struct rtl8169_private *tp)
F
Francois Romieu 已提交
5853
{
5854
	rtl_csi_access_enable_2(tp);
F
Francois Romieu 已提交
5855

5856
	rtl_disable_clock_request(tp);
F
Francois Romieu 已提交
5857

5858
	RTL_W8(tp, MaxTxPacketSize, TxPacketMax);
F
Francois Romieu 已提交
5859

5860
	if (tp->dev->mtu <= ETH_DATA_LEN)
5861
		rtl_tx_performance_tweak(tp, PCI_EXP_DEVCTL_READRQ_4096B);
F
Francois Romieu 已提交
5862

5863
	RTL_W16(tp, CPlusCmd, RTL_R16(tp, CPlusCmd) & ~R8168_CPCMD_QUIRK_MASK);
F
Francois Romieu 已提交
5864 5865
}

5866
static void rtl_hw_start_8168dp(struct rtl8169_private *tp)
5867
{
5868
	rtl_csi_access_enable_1(tp);
5869

5870
	if (tp->dev->mtu <= ETH_DATA_LEN)
5871
		rtl_tx_performance_tweak(tp, PCI_EXP_DEVCTL_READRQ_4096B);
5872

5873
	RTL_W8(tp, MaxTxPacketSize, TxPacketMax);
5874

5875
	rtl_disable_clock_request(tp);
5876 5877
}

5878
static void rtl_hw_start_8168d_4(struct rtl8169_private *tp)
F
françois romieu 已提交
5879 5880
{
	static const struct ephy_info e_info_8168d_4[] = {
5881 5882 5883
		{ 0x0b, 0x0000,	0x0048 },
		{ 0x19, 0x0020,	0x0050 },
		{ 0x0c, 0x0100,	0x0020 }
F
françois romieu 已提交
5884 5885
	};

5886
	rtl_csi_access_enable_1(tp);
F
françois romieu 已提交
5887

5888
	rtl_tx_performance_tweak(tp, PCI_EXP_DEVCTL_READRQ_4096B);
F
françois romieu 已提交
5889

5890
	RTL_W8(tp, MaxTxPacketSize, TxPacketMax);
F
françois romieu 已提交
5891

5892
	rtl_ephy_init(tp, e_info_8168d_4, ARRAY_SIZE(e_info_8168d_4));
F
françois romieu 已提交
5893

5894
	rtl_enable_clock_request(tp);
F
françois romieu 已提交
5895 5896
}

5897
static void rtl_hw_start_8168e_1(struct rtl8169_private *tp)
H
hayeswang 已提交
5898
{
H
Hayes Wang 已提交
5899
	static const struct ephy_info e_info_8168e_1[] = {
H
hayeswang 已提交
5900 5901 5902 5903 5904 5905 5906 5907 5908 5909 5910 5911 5912 5913 5914
		{ 0x00, 0x0200,	0x0100 },
		{ 0x00, 0x0000,	0x0004 },
		{ 0x06, 0x0002,	0x0001 },
		{ 0x06, 0x0000,	0x0030 },
		{ 0x07, 0x0000,	0x2000 },
		{ 0x00, 0x0000,	0x0020 },
		{ 0x03, 0x5800,	0x2000 },
		{ 0x03, 0x0000,	0x0001 },
		{ 0x01, 0x0800,	0x1000 },
		{ 0x07, 0x0000,	0x4000 },
		{ 0x1e, 0x0000,	0x2000 },
		{ 0x19, 0xffff,	0xfe6c },
		{ 0x0a, 0x0000,	0x0040 }
	};

5915
	rtl_csi_access_enable_2(tp);
H
hayeswang 已提交
5916

5917
	rtl_ephy_init(tp, e_info_8168e_1, ARRAY_SIZE(e_info_8168e_1));
H
hayeswang 已提交
5918

5919
	if (tp->dev->mtu <= ETH_DATA_LEN)
5920
		rtl_tx_performance_tweak(tp, PCI_EXP_DEVCTL_READRQ_4096B);
H
hayeswang 已提交
5921

5922
	RTL_W8(tp, MaxTxPacketSize, TxPacketMax);
H
hayeswang 已提交
5923

5924
	rtl_disable_clock_request(tp);
H
hayeswang 已提交
5925 5926

	/* Reset tx FIFO pointer */
5927 5928
	RTL_W32(tp, MISC, RTL_R32(tp, MISC) | TXPLA_RST);
	RTL_W32(tp, MISC, RTL_R32(tp, MISC) & ~TXPLA_RST);
H
hayeswang 已提交
5929

5930
	RTL_W8(tp, Config5, RTL_R8(tp, Config5) & ~Spi_en);
H
hayeswang 已提交
5931 5932
}

5933
static void rtl_hw_start_8168e_2(struct rtl8169_private *tp)
H
Hayes Wang 已提交
5934 5935 5936 5937 5938 5939
{
	static const struct ephy_info e_info_8168e_2[] = {
		{ 0x09, 0x0000,	0x0080 },
		{ 0x19, 0x0000,	0x0224 }
	};

5940
	rtl_csi_access_enable_1(tp);
H
Hayes Wang 已提交
5941

5942
	rtl_ephy_init(tp, e_info_8168e_2, ARRAY_SIZE(e_info_8168e_2));
H
Hayes Wang 已提交
5943

5944
	if (tp->dev->mtu <= ETH_DATA_LEN)
5945
		rtl_tx_performance_tweak(tp, PCI_EXP_DEVCTL_READRQ_4096B);
H
Hayes Wang 已提交
5946

5947 5948 5949 5950 5951 5952
	rtl_eri_write(tp, 0xc0, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);
	rtl_eri_write(tp, 0xb8, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);
	rtl_eri_write(tp, 0xc8, ERIAR_MASK_1111, 0x00100002, ERIAR_EXGMAC);
	rtl_eri_write(tp, 0xe8, ERIAR_MASK_1111, 0x00100006, ERIAR_EXGMAC);
	rtl_eri_write(tp, 0xcc, ERIAR_MASK_1111, 0x00000050, ERIAR_EXGMAC);
	rtl_eri_write(tp, 0xd0, ERIAR_MASK_1111, 0x07ff0060, ERIAR_EXGMAC);
5953 5954
	rtl_w0w1_eri(tp, 0x1b0, ERIAR_MASK_0001, 0x10, 0x00, ERIAR_EXGMAC);
	rtl_w0w1_eri(tp, 0x0d4, ERIAR_MASK_0011, 0x0c00, 0xff00, ERIAR_EXGMAC);
H
Hayes Wang 已提交
5955

5956
	RTL_W8(tp, MaxTxPacketSize, EarlySize);
H
Hayes Wang 已提交
5957

5958
	rtl_disable_clock_request(tp);
5959

5960 5961
	RTL_W32(tp, TxConfig, RTL_R32(tp, TxConfig) | TXCFG_AUTO_FIFO);
	RTL_W8(tp, MCU, RTL_R8(tp, MCU) & ~NOW_IS_OOB);
H
Hayes Wang 已提交
5962 5963

	/* Adjust EEE LED frequency */
5964
	RTL_W8(tp, EEE_LED, RTL_R8(tp, EEE_LED) & ~0x07);
H
Hayes Wang 已提交
5965

5966 5967 5968
	RTL_W8(tp, DLLPR, RTL_R8(tp, DLLPR) | PFM_EN);
	RTL_W32(tp, MISC, RTL_R32(tp, MISC) | PWM_EN);
	RTL_W8(tp, Config5, RTL_R8(tp, Config5) & ~Spi_en);
H
Hayes Wang 已提交
5969 5970
}

5971
static void rtl_hw_start_8168f(struct rtl8169_private *tp)
5972
{
5973
	rtl_csi_access_enable_2(tp);
5974

5975
	rtl_tx_performance_tweak(tp, PCI_EXP_DEVCTL_READRQ_4096B);
5976

5977 5978 5979 5980
	rtl_eri_write(tp, 0xc0, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);
	rtl_eri_write(tp, 0xb8, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);
	rtl_eri_write(tp, 0xc8, ERIAR_MASK_1111, 0x00100002, ERIAR_EXGMAC);
	rtl_eri_write(tp, 0xe8, ERIAR_MASK_1111, 0x00100006, ERIAR_EXGMAC);
5981 5982 5983 5984
	rtl_w0w1_eri(tp, 0xdc, ERIAR_MASK_0001, 0x00, 0x01, ERIAR_EXGMAC);
	rtl_w0w1_eri(tp, 0xdc, ERIAR_MASK_0001, 0x01, 0x00, ERIAR_EXGMAC);
	rtl_w0w1_eri(tp, 0x1b0, ERIAR_MASK_0001, 0x10, 0x00, ERIAR_EXGMAC);
	rtl_w0w1_eri(tp, 0x1d0, ERIAR_MASK_0001, 0x10, 0x00, ERIAR_EXGMAC);
5985 5986
	rtl_eri_write(tp, 0xcc, ERIAR_MASK_1111, 0x00000050, ERIAR_EXGMAC);
	rtl_eri_write(tp, 0xd0, ERIAR_MASK_1111, 0x00000060, ERIAR_EXGMAC);
5987

5988
	RTL_W8(tp, MaxTxPacketSize, EarlySize);
5989

5990
	rtl_disable_clock_request(tp);
5991

5992 5993 5994 5995 5996
	RTL_W32(tp, TxConfig, RTL_R32(tp, TxConfig) | TXCFG_AUTO_FIFO);
	RTL_W8(tp, MCU, RTL_R8(tp, MCU) & ~NOW_IS_OOB);
	RTL_W8(tp, DLLPR, RTL_R8(tp, DLLPR) | PFM_EN);
	RTL_W32(tp, MISC, RTL_R32(tp, MISC) | PWM_EN);
	RTL_W8(tp, Config5, RTL_R8(tp, Config5) & ~Spi_en);
5997 5998
}

5999 6000 6001 6002 6003 6004 6005 6006 6007 6008 6009
static void rtl_hw_start_8168f_1(struct rtl8169_private *tp)
{
	static const struct ephy_info e_info_8168f_1[] = {
		{ 0x06, 0x00c0,	0x0020 },
		{ 0x08, 0x0001,	0x0002 },
		{ 0x09, 0x0000,	0x0080 },
		{ 0x19, 0x0000,	0x0224 }
	};

	rtl_hw_start_8168f(tp);

6010
	rtl_ephy_init(tp, e_info_8168f_1, ARRAY_SIZE(e_info_8168f_1));
6011

6012
	rtl_w0w1_eri(tp, 0x0d4, ERIAR_MASK_0011, 0x0c00, 0xff00, ERIAR_EXGMAC);
6013 6014

	/* Adjust EEE LED frequency */
6015
	RTL_W8(tp, EEE_LED, RTL_R8(tp, EEE_LED) & ~0x07);
6016 6017
}

6018 6019 6020 6021 6022 6023 6024 6025 6026 6027
static void rtl_hw_start_8411(struct rtl8169_private *tp)
{
	static const struct ephy_info e_info_8168f_1[] = {
		{ 0x06, 0x00c0,	0x0020 },
		{ 0x0f, 0xffff,	0x5200 },
		{ 0x1e, 0x0000,	0x4000 },
		{ 0x19, 0x0000,	0x0224 }
	};

	rtl_hw_start_8168f(tp);
H
hayeswang 已提交
6028
	rtl_pcie_state_l2l3_enable(tp, false);
6029

6030
	rtl_ephy_init(tp, e_info_8168f_1, ARRAY_SIZE(e_info_8168f_1));
6031

6032
	rtl_w0w1_eri(tp, 0x0d4, ERIAR_MASK_0011, 0x0c00, 0x0000, ERIAR_EXGMAC);
6033 6034
}

6035
static void rtl_hw_start_8168g(struct rtl8169_private *tp)
H
Hayes Wang 已提交
6036
{
6037
	RTL_W32(tp, TxConfig, RTL_R32(tp, TxConfig) | TXCFG_AUTO_FIFO);
6038

H
Hayes Wang 已提交
6039 6040 6041 6042 6043 6044 6045
	rtl_eri_write(tp, 0xc8, ERIAR_MASK_0101, 0x080002, ERIAR_EXGMAC);
	rtl_eri_write(tp, 0xcc, ERIAR_MASK_0001, 0x38, ERIAR_EXGMAC);
	rtl_eri_write(tp, 0xd0, ERIAR_MASK_0001, 0x48, ERIAR_EXGMAC);
	rtl_eri_write(tp, 0xe8, ERIAR_MASK_1111, 0x00100006, ERIAR_EXGMAC);

	rtl_csi_access_enable_1(tp);

6046
	rtl_tx_performance_tweak(tp, PCI_EXP_DEVCTL_READRQ_4096B);
H
Hayes Wang 已提交
6047

6048 6049
	rtl_w0w1_eri(tp, 0xdc, ERIAR_MASK_0001, 0x00, 0x01, ERIAR_EXGMAC);
	rtl_w0w1_eri(tp, 0xdc, ERIAR_MASK_0001, 0x01, 0x00, ERIAR_EXGMAC);
6050
	rtl_eri_write(tp, 0x2f8, ERIAR_MASK_0011, 0x1d8f, ERIAR_EXGMAC);
H
Hayes Wang 已提交
6051

6052 6053
	RTL_W32(tp, MISC, RTL_R32(tp, MISC) & ~RXDV_GATED_EN);
	RTL_W8(tp, MaxTxPacketSize, EarlySize);
H
Hayes Wang 已提交
6054 6055 6056 6057 6058

	rtl_eri_write(tp, 0xc0, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);
	rtl_eri_write(tp, 0xb8, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);

	/* Adjust EEE LED frequency */
6059
	RTL_W8(tp, EEE_LED, RTL_R8(tp, EEE_LED) & ~0x07);
H
Hayes Wang 已提交
6060

6061 6062
	rtl_w0w1_eri(tp, 0x2fc, ERIAR_MASK_0001, 0x01, 0x06, ERIAR_EXGMAC);
	rtl_w0w1_eri(tp, 0x1b0, ERIAR_MASK_0011, 0x0000, 0x1000, ERIAR_EXGMAC);
H
hayeswang 已提交
6063 6064

	rtl_pcie_state_l2l3_enable(tp, false);
H
Hayes Wang 已提交
6065 6066
}

6067 6068 6069 6070 6071 6072 6073 6074 6075 6076 6077 6078
static void rtl_hw_start_8168g_1(struct rtl8169_private *tp)
{
	static const struct ephy_info e_info_8168g_1[] = {
		{ 0x00, 0x0000,	0x0008 },
		{ 0x0c, 0x37d0,	0x0820 },
		{ 0x1e, 0x0000,	0x0001 },
		{ 0x19, 0x8000,	0x0000 }
	};

	rtl_hw_start_8168g(tp);

	/* disable aspm and clock request before access ephy */
6079 6080
	RTL_W8(tp, Config2, RTL_R8(tp, Config2) & ~ClkReqEn);
	RTL_W8(tp, Config5, RTL_R8(tp, Config5) & ~ASPM_en);
6081 6082 6083
	rtl_ephy_init(tp, e_info_8168g_1, ARRAY_SIZE(e_info_8168g_1));
}

H
hayeswang 已提交
6084 6085 6086 6087 6088 6089 6090 6091 6092
static void rtl_hw_start_8168g_2(struct rtl8169_private *tp)
{
	static const struct ephy_info e_info_8168g_2[] = {
		{ 0x00, 0x0000,	0x0008 },
		{ 0x0c, 0x3df0,	0x0200 },
		{ 0x19, 0xffff,	0xfc00 },
		{ 0x1e, 0xffff,	0x20eb }
	};

6093
	rtl_hw_start_8168g(tp);
H
hayeswang 已提交
6094 6095

	/* disable aspm and clock request before access ephy */
6096 6097
	RTL_W8(tp, Config2, RTL_R8(tp, Config2) & ~ClkReqEn);
	RTL_W8(tp, Config5, RTL_R8(tp, Config5) & ~ASPM_en);
H
hayeswang 已提交
6098 6099 6100
	rtl_ephy_init(tp, e_info_8168g_2, ARRAY_SIZE(e_info_8168g_2));
}

H
hayeswang 已提交
6101 6102 6103 6104 6105 6106 6107 6108 6109 6110
static void rtl_hw_start_8411_2(struct rtl8169_private *tp)
{
	static const struct ephy_info e_info_8411_2[] = {
		{ 0x00, 0x0000,	0x0008 },
		{ 0x0c, 0x3df0,	0x0200 },
		{ 0x0f, 0xffff,	0x5200 },
		{ 0x19, 0x0020,	0x0000 },
		{ 0x1e, 0x0000,	0x2000 }
	};

6111
	rtl_hw_start_8168g(tp);
H
hayeswang 已提交
6112 6113

	/* disable aspm and clock request before access ephy */
6114 6115
	RTL_W8(tp, Config2, RTL_R8(tp, Config2) & ~ClkReqEn);
	RTL_W8(tp, Config5, RTL_R8(tp, Config5) & ~ASPM_en);
H
hayeswang 已提交
6116 6117 6118
	rtl_ephy_init(tp, e_info_8411_2, ARRAY_SIZE(e_info_8411_2));
}

6119 6120
static void rtl_hw_start_8168h_1(struct rtl8169_private *tp)
{
6121
	int rg_saw_cnt;
6122 6123 6124 6125 6126 6127 6128 6129 6130 6131 6132
	u32 data;
	static const struct ephy_info e_info_8168h_1[] = {
		{ 0x1e, 0x0800,	0x0001 },
		{ 0x1d, 0x0000,	0x0800 },
		{ 0x05, 0xffff,	0x2089 },
		{ 0x06, 0xffff,	0x5881 },
		{ 0x04, 0xffff,	0x154a },
		{ 0x01, 0xffff,	0x068b }
	};

	/* disable aspm and clock request before access ephy */
6133 6134
	RTL_W8(tp, Config2, RTL_R8(tp, Config2) & ~ClkReqEn);
	RTL_W8(tp, Config5, RTL_R8(tp, Config5) & ~ASPM_en);
6135 6136
	rtl_ephy_init(tp, e_info_8168h_1, ARRAY_SIZE(e_info_8168h_1));

6137
	RTL_W32(tp, TxConfig, RTL_R32(tp, TxConfig) | TXCFG_AUTO_FIFO);
6138 6139 6140 6141 6142 6143 6144 6145

	rtl_eri_write(tp, 0xc8, ERIAR_MASK_0101, 0x00080002, ERIAR_EXGMAC);
	rtl_eri_write(tp, 0xcc, ERIAR_MASK_0001, 0x38, ERIAR_EXGMAC);
	rtl_eri_write(tp, 0xd0, ERIAR_MASK_0001, 0x48, ERIAR_EXGMAC);
	rtl_eri_write(tp, 0xe8, ERIAR_MASK_1111, 0x00100006, ERIAR_EXGMAC);

	rtl_csi_access_enable_1(tp);

6146
	rtl_tx_performance_tweak(tp, PCI_EXP_DEVCTL_READRQ_4096B);
6147

6148 6149
	rtl_w0w1_eri(tp, 0xdc, ERIAR_MASK_0001, 0x00, 0x01, ERIAR_EXGMAC);
	rtl_w0w1_eri(tp, 0xdc, ERIAR_MASK_0001, 0x01, 0x00, ERIAR_EXGMAC);
6150

6151
	rtl_w0w1_eri(tp, 0xdc, ERIAR_MASK_1111, 0x0010, 0x00, ERIAR_EXGMAC);
6152

6153
	rtl_w0w1_eri(tp, 0xd4, ERIAR_MASK_1111, 0x1f00, 0x00, ERIAR_EXGMAC);
6154 6155 6156

	rtl_eri_write(tp, 0x5f0, ERIAR_MASK_0011, 0x4f87, ERIAR_EXGMAC);

6157 6158
	RTL_W32(tp, MISC, RTL_R32(tp, MISC) & ~RXDV_GATED_EN);
	RTL_W8(tp, MaxTxPacketSize, EarlySize);
6159 6160 6161 6162 6163

	rtl_eri_write(tp, 0xc0, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);
	rtl_eri_write(tp, 0xb8, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);

	/* Adjust EEE LED frequency */
6164
	RTL_W8(tp, EEE_LED, RTL_R8(tp, EEE_LED) & ~0x07);
6165

6166 6167
	RTL_W8(tp, DLLPR, RTL_R8(tp, DLLPR) & ~PFM_EN);
	RTL_W8(tp, MISC_1, RTL_R8(tp, MISC_1) & ~PFM_D3COLD_EN);
6168

6169
	RTL_W8(tp, DLLPR, RTL_R8(tp, DLLPR) & ~TX_10M_PS_EN);
6170

6171
	rtl_w0w1_eri(tp, 0x1b0, ERIAR_MASK_0011, 0x0000, 0x1000, ERIAR_EXGMAC);
6172 6173 6174 6175

	rtl_pcie_state_l2l3_enable(tp, false);

	rtl_writephy(tp, 0x1f, 0x0c42);
6176
	rg_saw_cnt = (rtl_readphy(tp, 0x13) & 0x3fff);
6177 6178 6179 6180 6181 6182 6183
	rtl_writephy(tp, 0x1f, 0x0000);
	if (rg_saw_cnt > 0) {
		u16 sw_cnt_1ms_ini;

		sw_cnt_1ms_ini = 16000000/rg_saw_cnt;
		sw_cnt_1ms_ini &= 0x0fff;
		data = r8168_mac_ocp_read(tp, 0xd412);
C
Chun-Hao Lin 已提交
6184
		data &= ~0x0fff;
6185 6186 6187 6188 6189
		data |= sw_cnt_1ms_ini;
		r8168_mac_ocp_write(tp, 0xd412, data);
	}

	data = r8168_mac_ocp_read(tp, 0xe056);
C
Chun-Hao Lin 已提交
6190 6191
	data &= ~0xf0;
	data |= 0x70;
6192 6193 6194
	r8168_mac_ocp_write(tp, 0xe056, data);

	data = r8168_mac_ocp_read(tp, 0xe052);
C
Chun-Hao Lin 已提交
6195 6196
	data &= ~0x6000;
	data |= 0x8008;
6197 6198 6199
	r8168_mac_ocp_write(tp, 0xe052, data);

	data = r8168_mac_ocp_read(tp, 0xe0d6);
C
Chun-Hao Lin 已提交
6200
	data &= ~0x01ff;
6201 6202 6203 6204
	data |= 0x017f;
	r8168_mac_ocp_write(tp, 0xe0d6, data);

	data = r8168_mac_ocp_read(tp, 0xd420);
C
Chun-Hao Lin 已提交
6205
	data &= ~0x0fff;
6206 6207 6208 6209 6210 6211 6212 6213 6214
	data |= 0x047f;
	r8168_mac_ocp_write(tp, 0xd420, data);

	r8168_mac_ocp_write(tp, 0xe63e, 0x0001);
	r8168_mac_ocp_write(tp, 0xe63e, 0x0000);
	r8168_mac_ocp_write(tp, 0xc094, 0x0000);
	r8168_mac_ocp_write(tp, 0xc09e, 0x0000);
}

C
Chun-Hao Lin 已提交
6215 6216
static void rtl_hw_start_8168ep(struct rtl8169_private *tp)
{
C
Chun-Hao Lin 已提交
6217 6218
	rtl8168ep_stop_cmac(tp);

6219
	RTL_W32(tp, TxConfig, RTL_R32(tp, TxConfig) | TXCFG_AUTO_FIFO);
C
Chun-Hao Lin 已提交
6220 6221 6222 6223 6224 6225 6226 6227

	rtl_eri_write(tp, 0xc8, ERIAR_MASK_0101, 0x00080002, ERIAR_EXGMAC);
	rtl_eri_write(tp, 0xcc, ERIAR_MASK_0001, 0x2f, ERIAR_EXGMAC);
	rtl_eri_write(tp, 0xd0, ERIAR_MASK_0001, 0x5f, ERIAR_EXGMAC);
	rtl_eri_write(tp, 0xe8, ERIAR_MASK_1111, 0x00100006, ERIAR_EXGMAC);

	rtl_csi_access_enable_1(tp);

6228
	rtl_tx_performance_tweak(tp, PCI_EXP_DEVCTL_READRQ_4096B);
C
Chun-Hao Lin 已提交
6229 6230 6231 6232 6233 6234 6235 6236

	rtl_w0w1_eri(tp, 0xdc, ERIAR_MASK_0001, 0x00, 0x01, ERIAR_EXGMAC);
	rtl_w0w1_eri(tp, 0xdc, ERIAR_MASK_0001, 0x01, 0x00, ERIAR_EXGMAC);

	rtl_w0w1_eri(tp, 0xd4, ERIAR_MASK_1111, 0x1f80, 0x00, ERIAR_EXGMAC);

	rtl_eri_write(tp, 0x5f0, ERIAR_MASK_0011, 0x4f87, ERIAR_EXGMAC);

6237 6238
	RTL_W32(tp, MISC, RTL_R32(tp, MISC) & ~RXDV_GATED_EN);
	RTL_W8(tp, MaxTxPacketSize, EarlySize);
C
Chun-Hao Lin 已提交
6239 6240 6241 6242 6243

	rtl_eri_write(tp, 0xc0, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);
	rtl_eri_write(tp, 0xb8, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);

	/* Adjust EEE LED frequency */
6244
	RTL_W8(tp, EEE_LED, RTL_R8(tp, EEE_LED) & ~0x07);
C
Chun-Hao Lin 已提交
6245 6246 6247

	rtl_w0w1_eri(tp, 0x2fc, ERIAR_MASK_0001, 0x01, 0x06, ERIAR_EXGMAC);

6248
	RTL_W8(tp, DLLPR, RTL_R8(tp, DLLPR) & ~TX_10M_PS_EN);
C
Chun-Hao Lin 已提交
6249 6250 6251 6252 6253 6254 6255 6256 6257 6258 6259 6260 6261 6262 6263

	rtl_pcie_state_l2l3_enable(tp, false);
}

static void rtl_hw_start_8168ep_1(struct rtl8169_private *tp)
{
	static const struct ephy_info e_info_8168ep_1[] = {
		{ 0x00, 0xffff,	0x10ab },
		{ 0x06, 0xffff,	0xf030 },
		{ 0x08, 0xffff,	0x2006 },
		{ 0x0d, 0xffff,	0x1666 },
		{ 0x0c, 0x3ff0,	0x0000 }
	};

	/* disable aspm and clock request before access ephy */
6264 6265
	RTL_W8(tp, Config2, RTL_R8(tp, Config2) & ~ClkReqEn);
	RTL_W8(tp, Config5, RTL_R8(tp, Config5) & ~ASPM_en);
C
Chun-Hao Lin 已提交
6266 6267 6268 6269 6270 6271 6272 6273 6274 6275 6276 6277 6278 6279
	rtl_ephy_init(tp, e_info_8168ep_1, ARRAY_SIZE(e_info_8168ep_1));

	rtl_hw_start_8168ep(tp);
}

static void rtl_hw_start_8168ep_2(struct rtl8169_private *tp)
{
	static const struct ephy_info e_info_8168ep_2[] = {
		{ 0x00, 0xffff,	0x10a3 },
		{ 0x19, 0xffff,	0xfc00 },
		{ 0x1e, 0xffff,	0x20ea }
	};

	/* disable aspm and clock request before access ephy */
6280 6281
	RTL_W8(tp, Config2, RTL_R8(tp, Config2) & ~ClkReqEn);
	RTL_W8(tp, Config5, RTL_R8(tp, Config5) & ~ASPM_en);
C
Chun-Hao Lin 已提交
6282 6283 6284 6285
	rtl_ephy_init(tp, e_info_8168ep_2, ARRAY_SIZE(e_info_8168ep_2));

	rtl_hw_start_8168ep(tp);

6286 6287
	RTL_W8(tp, DLLPR, RTL_R8(tp, DLLPR) & ~PFM_EN);
	RTL_W8(tp, MISC_1, RTL_R8(tp, MISC_1) & ~PFM_D3COLD_EN);
C
Chun-Hao Lin 已提交
6288 6289 6290 6291 6292 6293 6294 6295 6296 6297 6298 6299 6300
}

static void rtl_hw_start_8168ep_3(struct rtl8169_private *tp)
{
	u32 data;
	static const struct ephy_info e_info_8168ep_3[] = {
		{ 0x00, 0xffff,	0x10a3 },
		{ 0x19, 0xffff,	0x7c00 },
		{ 0x1e, 0xffff,	0x20eb },
		{ 0x0d, 0xffff,	0x1666 }
	};

	/* disable aspm and clock request before access ephy */
6301 6302
	RTL_W8(tp, Config2, RTL_R8(tp, Config2) & ~ClkReqEn);
	RTL_W8(tp, Config5, RTL_R8(tp, Config5) & ~ASPM_en);
C
Chun-Hao Lin 已提交
6303 6304 6305 6306
	rtl_ephy_init(tp, e_info_8168ep_3, ARRAY_SIZE(e_info_8168ep_3));

	rtl_hw_start_8168ep(tp);

6307 6308
	RTL_W8(tp, DLLPR, RTL_R8(tp, DLLPR) & ~PFM_EN);
	RTL_W8(tp, MISC_1, RTL_R8(tp, MISC_1) & ~PFM_D3COLD_EN);
C
Chun-Hao Lin 已提交
6309 6310 6311 6312 6313 6314 6315 6316 6317 6318 6319 6320 6321 6322 6323

	data = r8168_mac_ocp_read(tp, 0xd3e2);
	data &= 0xf000;
	data |= 0x0271;
	r8168_mac_ocp_write(tp, 0xd3e2, data);

	data = r8168_mac_ocp_read(tp, 0xd3e4);
	data &= 0xff00;
	r8168_mac_ocp_write(tp, 0xd3e4, data);

	data = r8168_mac_ocp_read(tp, 0xe860);
	data |= 0x0080;
	r8168_mac_ocp_write(tp, 0xe860, data);
}

6324 6325
static void rtl_hw_start_8168(struct net_device *dev)
{
6326 6327
	struct rtl8169_private *tp = netdev_priv(dev);

6328
	RTL_W8(tp, Cfg9346, Cfg9346_Unlock);
6329

6330
	RTL_W8(tp, MaxTxPacketSize, TxPacketMax);
6331

6332
	rtl_set_rx_max_size(tp, rx_buf_sz);
6333

6334
	tp->cp_cmd |= RTL_R16(tp, CPlusCmd) | PktCntrDisable | INTT_1;
6335

6336
	RTL_W16(tp, CPlusCmd, tp->cp_cmd);
6337

6338
	RTL_W16(tp, IntrMitigate, 0x5151);
6339

6340
	/* Work around for RxFIFO overflow. */
F
françois romieu 已提交
6341
	if (tp->mac_version == RTL_GIGA_MAC_VER_11) {
6342 6343
		tp->event_slow |= RxFIFOOver | PCSTimeout;
		tp->event_slow &= ~RxOverflow;
6344 6345
	}

6346
	rtl_set_rx_tx_desc_registers(tp);
6347

H
hayeswang 已提交
6348
	rtl_set_rx_tx_config_registers(tp);
6349

6350
	RTL_R8(tp, IntrMask);
6351

6352 6353
	switch (tp->mac_version) {
	case RTL_GIGA_MAC_VER_11:
6354
		rtl_hw_start_8168bb(tp);
6355
		break;
6356 6357 6358

	case RTL_GIGA_MAC_VER_12:
	case RTL_GIGA_MAC_VER_17:
6359
		rtl_hw_start_8168bef(tp);
6360
		break;
6361 6362

	case RTL_GIGA_MAC_VER_18:
6363
		rtl_hw_start_8168cp_1(tp);
6364
		break;
6365 6366

	case RTL_GIGA_MAC_VER_19:
6367
		rtl_hw_start_8168c_1(tp);
6368
		break;
6369 6370

	case RTL_GIGA_MAC_VER_20:
6371
		rtl_hw_start_8168c_2(tp);
6372
		break;
6373

F
Francois Romieu 已提交
6374
	case RTL_GIGA_MAC_VER_21:
6375
		rtl_hw_start_8168c_3(tp);
6376
		break;
F
Francois Romieu 已提交
6377

6378
	case RTL_GIGA_MAC_VER_22:
6379
		rtl_hw_start_8168c_4(tp);
6380
		break;
6381

F
Francois Romieu 已提交
6382
	case RTL_GIGA_MAC_VER_23:
6383
		rtl_hw_start_8168cp_2(tp);
6384
		break;
F
Francois Romieu 已提交
6385

6386
	case RTL_GIGA_MAC_VER_24:
6387
		rtl_hw_start_8168cp_3(tp);
6388
		break;
6389

F
Francois Romieu 已提交
6390
	case RTL_GIGA_MAC_VER_25:
6391 6392
	case RTL_GIGA_MAC_VER_26:
	case RTL_GIGA_MAC_VER_27:
6393
		rtl_hw_start_8168d(tp);
6394
		break;
F
Francois Romieu 已提交
6395

F
françois romieu 已提交
6396
	case RTL_GIGA_MAC_VER_28:
6397
		rtl_hw_start_8168d_4(tp);
6398
		break;
F
Francois Romieu 已提交
6399

6400
	case RTL_GIGA_MAC_VER_31:
6401
		rtl_hw_start_8168dp(tp);
6402 6403
		break;

H
hayeswang 已提交
6404 6405
	case RTL_GIGA_MAC_VER_32:
	case RTL_GIGA_MAC_VER_33:
6406
		rtl_hw_start_8168e_1(tp);
H
Hayes Wang 已提交
6407 6408
		break;
	case RTL_GIGA_MAC_VER_34:
6409
		rtl_hw_start_8168e_2(tp);
H
hayeswang 已提交
6410
		break;
F
françois romieu 已提交
6411

6412 6413
	case RTL_GIGA_MAC_VER_35:
	case RTL_GIGA_MAC_VER_36:
6414
		rtl_hw_start_8168f_1(tp);
6415 6416
		break;

6417 6418 6419 6420
	case RTL_GIGA_MAC_VER_38:
		rtl_hw_start_8411(tp);
		break;

H
Hayes Wang 已提交
6421 6422 6423 6424
	case RTL_GIGA_MAC_VER_40:
	case RTL_GIGA_MAC_VER_41:
		rtl_hw_start_8168g_1(tp);
		break;
H
hayeswang 已提交
6425 6426 6427
	case RTL_GIGA_MAC_VER_42:
		rtl_hw_start_8168g_2(tp);
		break;
H
Hayes Wang 已提交
6428

H
hayeswang 已提交
6429 6430 6431 6432
	case RTL_GIGA_MAC_VER_44:
		rtl_hw_start_8411_2(tp);
		break;

6433 6434 6435 6436 6437
	case RTL_GIGA_MAC_VER_45:
	case RTL_GIGA_MAC_VER_46:
		rtl_hw_start_8168h_1(tp);
		break;

C
Chun-Hao Lin 已提交
6438 6439 6440 6441 6442 6443 6444 6445 6446 6447 6448 6449
	case RTL_GIGA_MAC_VER_49:
		rtl_hw_start_8168ep_1(tp);
		break;

	case RTL_GIGA_MAC_VER_50:
		rtl_hw_start_8168ep_2(tp);
		break;

	case RTL_GIGA_MAC_VER_51:
		rtl_hw_start_8168ep_3(tp);
		break;

6450 6451 6452
	default:
		printk(KERN_ERR PFX "%s: unknown chipset (mac_version = %d).\n",
			dev->name, tp->mac_version);
6453
		break;
6454
	}
6455

6456
	RTL_W8(tp, Cfg9346, Cfg9346_Lock);
H
hayeswang 已提交
6457

6458
	RTL_W8(tp, ChipCmd, CmdTxEnb | CmdRxEnb);
6459

H
hayeswang 已提交
6460
	rtl_set_rx_mode(dev);
6461

6462
	RTL_W16(tp, MultiIntr, RTL_R16(tp, MultiIntr) & 0xf000);
6463
}
L
Linus Torvalds 已提交
6464

6465 6466 6467 6468
#define R810X_CPCMD_QUIRK_MASK (\
	EnableBist | \
	Mac_dbgo_oe | \
	Force_half_dup | \
F
françois romieu 已提交
6469
	Force_rxflow_en | \
6470 6471 6472 6473
	Force_txflow_en | \
	Cxpl_dbg_sel | \
	ASF | \
	PktCntrDisable | \
6474
	Mac_dbgo_sel)
6475

6476
static void rtl_hw_start_8102e_1(struct rtl8169_private *tp)
6477
{
6478
	static const struct ephy_info e_info_8102e_1[] = {
6479 6480 6481 6482 6483 6484 6485 6486 6487 6488 6489
		{ 0x01,	0, 0x6e65 },
		{ 0x02,	0, 0x091f },
		{ 0x03,	0, 0xc2f9 },
		{ 0x06,	0, 0xafb5 },
		{ 0x07,	0, 0x0e00 },
		{ 0x19,	0, 0xec80 },
		{ 0x01,	0, 0x2e65 },
		{ 0x01,	0, 0x6e65 }
	};
	u8 cfg1;

6490
	rtl_csi_access_enable_2(tp);
6491

6492
	RTL_W8(tp, DBG_REG, FIX_NAK_1);
6493

6494
	rtl_tx_performance_tweak(tp, PCI_EXP_DEVCTL_READRQ_4096B);
6495

6496
	RTL_W8(tp, Config1,
6497
	       LEDS1 | LEDS0 | Speed_down | MEMMAP | IOMAP | VPD | PMEnable);
6498
	RTL_W8(tp, Config3, RTL_R8(tp, Config3) & ~Beacon_en);
6499

6500
	cfg1 = RTL_R8(tp, Config1);
6501
	if ((cfg1 & LEDS0) && (cfg1 & LEDS1))
6502
		RTL_W8(tp, Config1, cfg1 & ~LEDS0);
6503

6504
	rtl_ephy_init(tp, e_info_8102e_1, ARRAY_SIZE(e_info_8102e_1));
6505 6506
}

6507
static void rtl_hw_start_8102e_2(struct rtl8169_private *tp)
6508
{
6509
	rtl_csi_access_enable_2(tp);
6510

6511
	rtl_tx_performance_tweak(tp, PCI_EXP_DEVCTL_READRQ_4096B);
6512

6513 6514
	RTL_W8(tp, Config1, MEMMAP | IOMAP | VPD | PMEnable);
	RTL_W8(tp, Config3, RTL_R8(tp, Config3) & ~Beacon_en);
6515 6516
}

6517
static void rtl_hw_start_8102e_3(struct rtl8169_private *tp)
6518
{
6519
	rtl_hw_start_8102e_2(tp);
6520

6521
	rtl_ephy_write(tp, 0x03, 0xc2f9);
6522 6523
}

6524
static void rtl_hw_start_8105e_1(struct rtl8169_private *tp)
6525 6526 6527 6528 6529 6530 6531 6532 6533 6534 6535 6536
{
	static const struct ephy_info e_info_8105e_1[] = {
		{ 0x07,	0, 0x4000 },
		{ 0x19,	0, 0x0200 },
		{ 0x19,	0, 0x0020 },
		{ 0x1e,	0, 0x2000 },
		{ 0x03,	0, 0x0001 },
		{ 0x19,	0, 0x0100 },
		{ 0x19,	0, 0x0004 },
		{ 0x0a,	0, 0x0020 }
	};

F
Francois Romieu 已提交
6537
	/* Force LAN exit from ASPM if Rx/Tx are not idle */
6538
	RTL_W32(tp, FuncEvent, RTL_R32(tp, FuncEvent) | 0x002800);
6539

F
Francois Romieu 已提交
6540
	/* Disable Early Tally Counter */
6541
	RTL_W32(tp, FuncEvent, RTL_R32(tp, FuncEvent) & ~0x010000);
6542

6543 6544
	RTL_W8(tp, MCU, RTL_R8(tp, MCU) | EN_NDP | EN_OOB_RESET);
	RTL_W8(tp, DLLPR, RTL_R8(tp, DLLPR) | PFM_EN);
6545

6546
	rtl_ephy_init(tp, e_info_8105e_1, ARRAY_SIZE(e_info_8105e_1));
H
hayeswang 已提交
6547 6548

	rtl_pcie_state_l2l3_enable(tp, false);
6549 6550
}

6551
static void rtl_hw_start_8105e_2(struct rtl8169_private *tp)
6552
{
6553
	rtl_hw_start_8105e_1(tp);
6554
	rtl_ephy_write(tp, 0x1e, rtl_ephy_read(tp, 0x1e) | 0x8000);
6555 6556
}

6557 6558 6559 6560 6561 6562 6563 6564 6565 6566
static void rtl_hw_start_8402(struct rtl8169_private *tp)
{
	static const struct ephy_info e_info_8402[] = {
		{ 0x19,	0xffff, 0xff64 },
		{ 0x1e,	0, 0x4000 }
	};

	rtl_csi_access_enable_2(tp);

	/* Force LAN exit from ASPM if Rx/Tx are not idle */
6567
	RTL_W32(tp, FuncEvent, RTL_R32(tp, FuncEvent) | 0x002800);
6568

6569 6570
	RTL_W32(tp, TxConfig, RTL_R32(tp, TxConfig) | TXCFG_AUTO_FIFO);
	RTL_W8(tp, MCU, RTL_R8(tp, MCU) & ~NOW_IS_OOB);
6571

6572
	rtl_ephy_init(tp, e_info_8402, ARRAY_SIZE(e_info_8402));
6573

6574
	rtl_tx_performance_tweak(tp, PCI_EXP_DEVCTL_READRQ_4096B);
6575

6576 6577
	rtl_eri_write(tp, 0xc8, ERIAR_MASK_1111, 0x00000002, ERIAR_EXGMAC);
	rtl_eri_write(tp, 0xe8, ERIAR_MASK_1111, 0x00000006, ERIAR_EXGMAC);
6578 6579
	rtl_w0w1_eri(tp, 0xdc, ERIAR_MASK_0001, 0x00, 0x01, ERIAR_EXGMAC);
	rtl_w0w1_eri(tp, 0xdc, ERIAR_MASK_0001, 0x01, 0x00, ERIAR_EXGMAC);
6580 6581
	rtl_eri_write(tp, 0xc0, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);
	rtl_eri_write(tp, 0xb8, ERIAR_MASK_0011, 0x0000, ERIAR_EXGMAC);
6582
	rtl_w0w1_eri(tp, 0x0d4, ERIAR_MASK_0011, 0x0e00, 0xff00, ERIAR_EXGMAC);
H
hayeswang 已提交
6583 6584

	rtl_pcie_state_l2l3_enable(tp, false);
6585 6586
}

H
Hayes Wang 已提交
6587 6588 6589
static void rtl_hw_start_8106(struct rtl8169_private *tp)
{
	/* Force LAN exit from ASPM if Rx/Tx are not idle */
6590
	RTL_W32(tp, FuncEvent, RTL_R32(tp, FuncEvent) | 0x002800);
H
Hayes Wang 已提交
6591

6592 6593 6594
	RTL_W32(tp, MISC, (RTL_R32(tp, MISC) | DISABLE_LAN_EN) & ~EARLY_TALLY_EN);
	RTL_W8(tp, MCU, RTL_R8(tp, MCU) | EN_NDP | EN_OOB_RESET);
	RTL_W8(tp, DLLPR, RTL_R8(tp, DLLPR) & ~PFM_EN);
H
hayeswang 已提交
6595 6596

	rtl_pcie_state_l2l3_enable(tp, false);
H
Hayes Wang 已提交
6597 6598
}

6599 6600
static void rtl_hw_start_8101(struct net_device *dev)
{
6601 6602 6603
	struct rtl8169_private *tp = netdev_priv(dev);
	struct pci_dev *pdev = tp->pci_dev;

6604 6605
	if (tp->mac_version >= RTL_GIGA_MAC_VER_30)
		tp->event_slow &= ~RxFIFOOver;
F
françois romieu 已提交
6606

F
Francois Romieu 已提交
6607
	if (tp->mac_version == RTL_GIGA_MAC_VER_13 ||
6608
	    tp->mac_version == RTL_GIGA_MAC_VER_16)
6609 6610
		pcie_capability_set_word(pdev, PCI_EXP_DEVCTL,
					 PCI_EXP_DEVCTL_NOSNOOP_EN);
6611

6612
	RTL_W8(tp, Cfg9346, Cfg9346_Unlock);
6613

6614
	RTL_W8(tp, MaxTxPacketSize, TxPacketMax);
H
hayeswang 已提交
6615

6616
	rtl_set_rx_max_size(tp, rx_buf_sz);
H
hayeswang 已提交
6617 6618

	tp->cp_cmd &= ~R810X_CPCMD_QUIRK_MASK;
6619
	RTL_W16(tp, CPlusCmd, tp->cp_cmd);
H
hayeswang 已提交
6620

6621
	rtl_set_rx_tx_desc_registers(tp);
H
hayeswang 已提交
6622 6623 6624

	rtl_set_rx_tx_config_registers(tp);

6625 6626
	switch (tp->mac_version) {
	case RTL_GIGA_MAC_VER_07:
6627
		rtl_hw_start_8102e_1(tp);
6628 6629 6630
		break;

	case RTL_GIGA_MAC_VER_08:
6631
		rtl_hw_start_8102e_3(tp);
6632 6633 6634
		break;

	case RTL_GIGA_MAC_VER_09:
6635
		rtl_hw_start_8102e_2(tp);
6636
		break;
6637 6638

	case RTL_GIGA_MAC_VER_29:
6639
		rtl_hw_start_8105e_1(tp);
6640 6641
		break;
	case RTL_GIGA_MAC_VER_30:
6642
		rtl_hw_start_8105e_2(tp);
6643
		break;
6644 6645 6646 6647

	case RTL_GIGA_MAC_VER_37:
		rtl_hw_start_8402(tp);
		break;
H
Hayes Wang 已提交
6648 6649 6650 6651

	case RTL_GIGA_MAC_VER_39:
		rtl_hw_start_8106(tp);
		break;
H
hayeswang 已提交
6652 6653 6654
	case RTL_GIGA_MAC_VER_43:
		rtl_hw_start_8168g_2(tp);
		break;
6655 6656 6657 6658
	case RTL_GIGA_MAC_VER_47:
	case RTL_GIGA_MAC_VER_48:
		rtl_hw_start_8168h_1(tp);
		break;
6659 6660
	}

6661
	RTL_W8(tp, Cfg9346, Cfg9346_Lock);
6662

6663
	RTL_W16(tp, IntrMitigate, 0x0000);
6664

6665
	RTL_W8(tp, ChipCmd, CmdTxEnb | CmdRxEnb);
6666 6667 6668

	rtl_set_rx_mode(dev);

6669
	RTL_R8(tp, IntrMask);
H
hayeswang 已提交
6670

6671
	RTL_W16(tp, MultiIntr, RTL_R16(tp, MultiIntr) & 0xf000);
L
Linus Torvalds 已提交
6672 6673 6674 6675
}

static int rtl8169_change_mtu(struct net_device *dev, int new_mtu)
{
F
Francois Romieu 已提交
6676 6677 6678 6679 6680 6681 6682
	struct rtl8169_private *tp = netdev_priv(dev);

	if (new_mtu > ETH_DATA_LEN)
		rtl_hw_jumbo_enable(tp);
	else
		rtl_hw_jumbo_disable(tp);

L
Linus Torvalds 已提交
6683
	dev->mtu = new_mtu;
6684 6685
	netdev_update_features(dev);

S
Stanislaw Gruszka 已提交
6686
	return 0;
L
Linus Torvalds 已提交
6687 6688 6689 6690
}

static inline void rtl8169_make_unusable_by_asic(struct RxDesc *desc)
{
A
Al Viro 已提交
6691
	desc->addr = cpu_to_le64(0x0badbadbadbadbadull);
L
Linus Torvalds 已提交
6692 6693 6694
	desc->opts1 &= ~cpu_to_le32(DescOwn | RsvdMask);
}

E
Eric Dumazet 已提交
6695 6696
static void rtl8169_free_rx_databuff(struct rtl8169_private *tp,
				     void **data_buff, struct RxDesc *desc)
L
Linus Torvalds 已提交
6697
{
H
Heiner Kallweit 已提交
6698
	dma_unmap_single(tp_to_dev(tp), le64_to_cpu(desc->addr), rx_buf_sz,
6699
			 DMA_FROM_DEVICE);
6700

E
Eric Dumazet 已提交
6701 6702
	kfree(*data_buff);
	*data_buff = NULL;
L
Linus Torvalds 已提交
6703 6704 6705 6706 6707 6708 6709
	rtl8169_make_unusable_by_asic(desc);
}

static inline void rtl8169_mark_to_asic(struct RxDesc *desc, u32 rx_buf_sz)
{
	u32 eor = le32_to_cpu(desc->opts1) & RingEnd;

6710 6711 6712
	/* Force memory writes to complete before releasing descriptor */
	dma_wmb();

L
Linus Torvalds 已提交
6713 6714 6715 6716 6717 6718 6719 6720 6721 6722
	desc->opts1 = cpu_to_le32(DescOwn | eor | rx_buf_sz);
}

static inline void rtl8169_map_to_asic(struct RxDesc *desc, dma_addr_t mapping,
				       u32 rx_buf_sz)
{
	desc->addr = cpu_to_le64(mapping);
	rtl8169_mark_to_asic(desc, rx_buf_sz);
}

E
Eric Dumazet 已提交
6723 6724 6725 6726 6727
static inline void *rtl8169_align(void *data)
{
	return (void *)ALIGN((long)data, 16);
}

S
Stanislaw Gruszka 已提交
6728 6729
static struct sk_buff *rtl8169_alloc_rx_data(struct rtl8169_private *tp,
					     struct RxDesc *desc)
L
Linus Torvalds 已提交
6730
{
E
Eric Dumazet 已提交
6731
	void *data;
L
Linus Torvalds 已提交
6732
	dma_addr_t mapping;
H
Heiner Kallweit 已提交
6733
	struct device *d = tp_to_dev(tp);
6734
	int node = dev_to_node(d);
L
Linus Torvalds 已提交
6735

E
Eric Dumazet 已提交
6736 6737 6738
	data = kmalloc_node(rx_buf_sz, GFP_KERNEL, node);
	if (!data)
		return NULL;
6739

E
Eric Dumazet 已提交
6740 6741 6742 6743 6744 6745
	if (rtl8169_align(data) != data) {
		kfree(data);
		data = kmalloc_node(rx_buf_sz + 15, GFP_KERNEL, node);
		if (!data)
			return NULL;
	}
6746

6747
	mapping = dma_map_single(d, rtl8169_align(data), rx_buf_sz,
6748
				 DMA_FROM_DEVICE);
6749 6750 6751
	if (unlikely(dma_mapping_error(d, mapping))) {
		if (net_ratelimit())
			netif_err(tp, drv, tp->dev, "Failed to map RX DMA!\n");
6752
		goto err_out;
6753
	}
L
Linus Torvalds 已提交
6754 6755

	rtl8169_map_to_asic(desc, mapping, rx_buf_sz);
E
Eric Dumazet 已提交
6756
	return data;
6757 6758 6759 6760

err_out:
	kfree(data);
	return NULL;
L
Linus Torvalds 已提交
6761 6762 6763 6764
}

static void rtl8169_rx_clear(struct rtl8169_private *tp)
{
F
Francois Romieu 已提交
6765
	unsigned int i;
L
Linus Torvalds 已提交
6766 6767

	for (i = 0; i < NUM_RX_DESC; i++) {
E
Eric Dumazet 已提交
6768 6769
		if (tp->Rx_databuff[i]) {
			rtl8169_free_rx_databuff(tp, tp->Rx_databuff + i,
L
Linus Torvalds 已提交
6770 6771 6772 6773 6774
					    tp->RxDescArray + i);
		}
	}
}

S
Stanislaw Gruszka 已提交
6775
static inline void rtl8169_mark_as_last_descriptor(struct RxDesc *desc)
L
Linus Torvalds 已提交
6776
{
S
Stanislaw Gruszka 已提交
6777 6778
	desc->opts1 |= cpu_to_le32(RingEnd);
}
6779

S
Stanislaw Gruszka 已提交
6780 6781 6782
static int rtl8169_rx_fill(struct rtl8169_private *tp)
{
	unsigned int i;
L
Linus Torvalds 已提交
6783

S
Stanislaw Gruszka 已提交
6784 6785
	for (i = 0; i < NUM_RX_DESC; i++) {
		void *data;
6786

E
Eric Dumazet 已提交
6787
		if (tp->Rx_databuff[i])
L
Linus Torvalds 已提交
6788
			continue;
6789

S
Stanislaw Gruszka 已提交
6790
		data = rtl8169_alloc_rx_data(tp, tp->RxDescArray + i);
E
Eric Dumazet 已提交
6791 6792
		if (!data) {
			rtl8169_make_unusable_by_asic(tp->RxDescArray + i);
S
Stanislaw Gruszka 已提交
6793
			goto err_out;
E
Eric Dumazet 已提交
6794 6795
		}
		tp->Rx_databuff[i] = data;
L
Linus Torvalds 已提交
6796 6797
	}

S
Stanislaw Gruszka 已提交
6798 6799 6800 6801 6802 6803
	rtl8169_mark_as_last_descriptor(tp->RxDescArray + NUM_RX_DESC - 1);
	return 0;

err_out:
	rtl8169_rx_clear(tp);
	return -ENOMEM;
L
Linus Torvalds 已提交
6804 6805 6806 6807 6808 6809 6810 6811 6812
}

static int rtl8169_init_ring(struct net_device *dev)
{
	struct rtl8169_private *tp = netdev_priv(dev);

	rtl8169_init_ring_indexes(tp);

	memset(tp->tx_skb, 0x0, NUM_TX_DESC * sizeof(struct ring_info));
E
Eric Dumazet 已提交
6813
	memset(tp->Rx_databuff, 0x0, NUM_RX_DESC * sizeof(void *));
L
Linus Torvalds 已提交
6814

S
Stanislaw Gruszka 已提交
6815
	return rtl8169_rx_fill(tp);
L
Linus Torvalds 已提交
6816 6817
}

6818
static void rtl8169_unmap_tx_skb(struct device *d, struct ring_info *tx_skb,
L
Linus Torvalds 已提交
6819 6820 6821 6822
				 struct TxDesc *desc)
{
	unsigned int len = tx_skb->len;

6823 6824
	dma_unmap_single(d, le64_to_cpu(desc->addr), len, DMA_TO_DEVICE);

L
Linus Torvalds 已提交
6825 6826 6827 6828 6829 6830
	desc->opts1 = 0x00;
	desc->opts2 = 0x00;
	desc->addr = 0x00;
	tx_skb->len = 0;
}

6831 6832
static void rtl8169_tx_clear_range(struct rtl8169_private *tp, u32 start,
				   unsigned int n)
L
Linus Torvalds 已提交
6833 6834 6835
{
	unsigned int i;

6836 6837
	for (i = 0; i < n; i++) {
		unsigned int entry = (start + i) % NUM_TX_DESC;
L
Linus Torvalds 已提交
6838 6839 6840 6841 6842 6843
		struct ring_info *tx_skb = tp->tx_skb + entry;
		unsigned int len = tx_skb->len;

		if (len) {
			struct sk_buff *skb = tx_skb->skb;

H
Heiner Kallweit 已提交
6844
			rtl8169_unmap_tx_skb(tp_to_dev(tp), tx_skb,
L
Linus Torvalds 已提交
6845 6846
					     tp->TxDescArray + entry);
			if (skb) {
6847
				dev_consume_skb_any(skb);
L
Linus Torvalds 已提交
6848 6849 6850 6851
				tx_skb->skb = NULL;
			}
		}
	}
6852 6853 6854 6855 6856
}

static void rtl8169_tx_clear(struct rtl8169_private *tp)
{
	rtl8169_tx_clear_range(tp, tp->dirty_tx, NUM_TX_DESC);
L
Linus Torvalds 已提交
6857 6858 6859
	tp->cur_tx = tp->dirty_tx = 0;
}

6860
static void rtl_reset_work(struct rtl8169_private *tp)
L
Linus Torvalds 已提交
6861
{
D
David Howells 已提交
6862
	struct net_device *dev = tp->dev;
6863
	int i;
L
Linus Torvalds 已提交
6864

6865 6866 6867
	napi_disable(&tp->napi);
	netif_stop_queue(dev);
	synchronize_sched();
L
Linus Torvalds 已提交
6868

6869 6870
	rtl8169_hw_reset(tp);

6871 6872 6873
	for (i = 0; i < NUM_RX_DESC; i++)
		rtl8169_mark_to_asic(tp->RxDescArray + i, rx_buf_sz);

L
Linus Torvalds 已提交
6874
	rtl8169_tx_clear(tp);
6875
	rtl8169_init_ring_indexes(tp);
L
Linus Torvalds 已提交
6876

6877
	napi_enable(&tp->napi);
6878 6879
	rtl_hw_start(dev);
	netif_wake_queue(dev);
6880
	rtl8169_check_link_status(dev, tp);
L
Linus Torvalds 已提交
6881 6882 6883 6884
}

static void rtl8169_tx_timeout(struct net_device *dev)
{
6885 6886 6887
	struct rtl8169_private *tp = netdev_priv(dev);

	rtl_schedule_task(tp, RTL_FLAG_TASK_RESET_PENDING);
L
Linus Torvalds 已提交
6888 6889 6890
}

static int rtl8169_xmit_frags(struct rtl8169_private *tp, struct sk_buff *skb,
F
Francois Romieu 已提交
6891
			      u32 *opts)
L
Linus Torvalds 已提交
6892 6893 6894
{
	struct skb_shared_info *info = skb_shinfo(skb);
	unsigned int cur_frag, entry;
6895
	struct TxDesc *uninitialized_var(txd);
H
Heiner Kallweit 已提交
6896
	struct device *d = tp_to_dev(tp);
L
Linus Torvalds 已提交
6897 6898 6899

	entry = tp->cur_tx;
	for (cur_frag = 0; cur_frag < info->nr_frags; cur_frag++) {
E
Eric Dumazet 已提交
6900
		const skb_frag_t *frag = info->frags + cur_frag;
L
Linus Torvalds 已提交
6901 6902 6903 6904 6905 6906 6907
		dma_addr_t mapping;
		u32 status, len;
		void *addr;

		entry = (entry + 1) % NUM_TX_DESC;

		txd = tp->TxDescArray + entry;
E
Eric Dumazet 已提交
6908
		len = skb_frag_size(frag);
6909
		addr = skb_frag_address(frag);
6910
		mapping = dma_map_single(d, addr, len, DMA_TO_DEVICE);
6911 6912 6913 6914
		if (unlikely(dma_mapping_error(d, mapping))) {
			if (net_ratelimit())
				netif_err(tp, drv, tp->dev,
					  "Failed to map TX fragments DMA!\n");
6915
			goto err_out;
6916
		}
L
Linus Torvalds 已提交
6917

F
Francois Romieu 已提交
6918
		/* Anti gcc 2.95.3 bugware (sic) */
F
Francois Romieu 已提交
6919 6920
		status = opts[0] | len |
			(RingEnd * !((entry + 1) % NUM_TX_DESC));
L
Linus Torvalds 已提交
6921 6922

		txd->opts1 = cpu_to_le32(status);
F
Francois Romieu 已提交
6923
		txd->opts2 = cpu_to_le32(opts[1]);
L
Linus Torvalds 已提交
6924 6925 6926 6927 6928 6929 6930 6931 6932 6933 6934
		txd->addr = cpu_to_le64(mapping);

		tp->tx_skb[entry].len = len;
	}

	if (cur_frag) {
		tp->tx_skb[entry].skb = skb;
		txd->opts1 |= cpu_to_le32(LastFrag);
	}

	return cur_frag;
6935 6936 6937 6938

err_out:
	rtl8169_tx_clear_range(tp, tp->cur_tx + 1, cur_frag);
	return -EIO;
L
Linus Torvalds 已提交
6939 6940
}

6941 6942 6943 6944 6945
static bool rtl_test_hw_pad_bug(struct rtl8169_private *tp, struct sk_buff *skb)
{
	return skb->len < ETH_ZLEN && tp->mac_version == RTL_GIGA_MAC_VER_34;
}

H
hayeswang 已提交
6946 6947 6948 6949 6950 6951 6952 6953 6954 6955 6956 6957 6958 6959 6960 6961 6962 6963 6964 6965 6966 6967 6968 6969 6970
static netdev_tx_t rtl8169_start_xmit(struct sk_buff *skb,
				      struct net_device *dev);
/* r8169_csum_workaround()
 * The hw limites the value the transport offset. When the offset is out of the
 * range, calculate the checksum by sw.
 */
static void r8169_csum_workaround(struct rtl8169_private *tp,
				  struct sk_buff *skb)
{
	if (skb_shinfo(skb)->gso_size) {
		netdev_features_t features = tp->dev->features;
		struct sk_buff *segs, *nskb;

		features &= ~(NETIF_F_SG | NETIF_F_IPV6_CSUM | NETIF_F_TSO6);
		segs = skb_gso_segment(skb, features);
		if (IS_ERR(segs) || !segs)
			goto drop;

		do {
			nskb = segs;
			segs = segs->next;
			nskb->next = NULL;
			rtl8169_start_xmit(nskb, tp->dev);
		} while (segs);

6971
		dev_consume_skb_any(skb);
H
hayeswang 已提交
6972 6973 6974 6975 6976 6977 6978 6979 6980 6981 6982
	} else if (skb->ip_summed == CHECKSUM_PARTIAL) {
		if (skb_checksum_help(skb) < 0)
			goto drop;

		rtl8169_start_xmit(skb, tp->dev);
	} else {
		struct net_device_stats *stats;

drop:
		stats = &tp->dev->stats;
		stats->tx_dropped++;
6983
		dev_kfree_skb_any(skb);
H
hayeswang 已提交
6984 6985 6986 6987 6988 6989 6990 6991 6992 6993 6994 6995 6996 6997 6998 6999 7000 7001 7002 7003 7004 7005 7006 7007 7008 7009 7010 7011 7012 7013 7014 7015 7016 7017 7018 7019 7020 7021
	}
}

/* msdn_giant_send_check()
 * According to the document of microsoft, the TCP Pseudo Header excludes the
 * packet length for IPv6 TCP large packets.
 */
static int msdn_giant_send_check(struct sk_buff *skb)
{
	const struct ipv6hdr *ipv6h;
	struct tcphdr *th;
	int ret;

	ret = skb_cow_head(skb, 0);
	if (ret)
		return ret;

	ipv6h = ipv6_hdr(skb);
	th = tcp_hdr(skb);

	th->check = 0;
	th->check = ~tcp_v6_check(0, &ipv6h->saddr, &ipv6h->daddr, 0);

	return ret;
}

static inline __be16 get_protocol(struct sk_buff *skb)
{
	__be16 protocol;

	if (skb->protocol == htons(ETH_P_8021Q))
		protocol = vlan_eth_hdr(skb)->h_vlan_encapsulated_proto;
	else
		protocol = skb->protocol;

	return protocol;
}

H
hayeswang 已提交
7022 7023
static bool rtl8169_tso_csum_v1(struct rtl8169_private *tp,
				struct sk_buff *skb, u32 *opts)
L
Linus Torvalds 已提交
7024
{
7025 7026
	u32 mss = skb_shinfo(skb)->gso_size;

F
Francois Romieu 已提交
7027 7028
	if (mss) {
		opts[0] |= TD_LSO;
H
hayeswang 已提交
7029 7030 7031 7032 7033 7034 7035 7036 7037 7038 7039 7040 7041 7042 7043 7044 7045 7046
		opts[0] |= min(mss, TD_MSS_MAX) << TD0_MSS_SHIFT;
	} else if (skb->ip_summed == CHECKSUM_PARTIAL) {
		const struct iphdr *ip = ip_hdr(skb);

		if (ip->protocol == IPPROTO_TCP)
			opts[0] |= TD0_IP_CS | TD0_TCP_CS;
		else if (ip->protocol == IPPROTO_UDP)
			opts[0] |= TD0_IP_CS | TD0_UDP_CS;
		else
			WARN_ON_ONCE(1);
	}

	return true;
}

static bool rtl8169_tso_csum_v2(struct rtl8169_private *tp,
				struct sk_buff *skb, u32 *opts)
{
H
hayeswang 已提交
7047
	u32 transport_offset = (u32)skb_transport_offset(skb);
H
hayeswang 已提交
7048 7049 7050
	u32 mss = skb_shinfo(skb)->gso_size;

	if (mss) {
H
hayeswang 已提交
7051 7052 7053 7054 7055 7056 7057 7058 7059 7060 7061 7062 7063 7064 7065 7066 7067 7068 7069 7070 7071 7072 7073 7074
		if (transport_offset > GTTCPHO_MAX) {
			netif_warn(tp, tx_err, tp->dev,
				   "Invalid transport offset 0x%x for TSO\n",
				   transport_offset);
			return false;
		}

		switch (get_protocol(skb)) {
		case htons(ETH_P_IP):
			opts[0] |= TD1_GTSENV4;
			break;

		case htons(ETH_P_IPV6):
			if (msdn_giant_send_check(skb))
				return false;

			opts[0] |= TD1_GTSENV6;
			break;

		default:
			WARN_ON_ONCE(1);
			break;
		}

H
hayeswang 已提交
7075
		opts[0] |= transport_offset << GTTCPHO_SHIFT;
H
hayeswang 已提交
7076
		opts[1] |= min(mss, TD_MSS_MAX) << TD1_MSS_SHIFT;
F
Francois Romieu 已提交
7077
	} else if (skb->ip_summed == CHECKSUM_PARTIAL) {
H
hayeswang 已提交
7078
		u8 ip_protocol;
L
Linus Torvalds 已提交
7079

7080
		if (unlikely(rtl_test_hw_pad_bug(tp, skb)))
A
Alexander Duyck 已提交
7081
			return !(skb_checksum_help(skb) || eth_skb_pad(skb));
7082

H
hayeswang 已提交
7083 7084 7085 7086 7087 7088 7089 7090 7091 7092 7093 7094 7095 7096 7097 7098 7099 7100 7101 7102 7103 7104 7105 7106 7107 7108 7109
		if (transport_offset > TCPHO_MAX) {
			netif_warn(tp, tx_err, tp->dev,
				   "Invalid transport offset 0x%x\n",
				   transport_offset);
			return false;
		}

		switch (get_protocol(skb)) {
		case htons(ETH_P_IP):
			opts[1] |= TD1_IPv4_CS;
			ip_protocol = ip_hdr(skb)->protocol;
			break;

		case htons(ETH_P_IPV6):
			opts[1] |= TD1_IPv6_CS;
			ip_protocol = ipv6_hdr(skb)->nexthdr;
			break;

		default:
			ip_protocol = IPPROTO_RAW;
			break;
		}

		if (ip_protocol == IPPROTO_TCP)
			opts[1] |= TD1_TCP_CS;
		else if (ip_protocol == IPPROTO_UDP)
			opts[1] |= TD1_UDP_CS;
F
Francois Romieu 已提交
7110 7111
		else
			WARN_ON_ONCE(1);
H
hayeswang 已提交
7112 7113

		opts[1] |= transport_offset << TCPHO_SHIFT;
7114 7115
	} else {
		if (unlikely(rtl_test_hw_pad_bug(tp, skb)))
A
Alexander Duyck 已提交
7116
			return !eth_skb_pad(skb);
L
Linus Torvalds 已提交
7117
	}
H
hayeswang 已提交
7118

7119
	return true;
L
Linus Torvalds 已提交
7120 7121
}

7122 7123
static netdev_tx_t rtl8169_start_xmit(struct sk_buff *skb,
				      struct net_device *dev)
L
Linus Torvalds 已提交
7124 7125
{
	struct rtl8169_private *tp = netdev_priv(dev);
7126
	unsigned int entry = tp->cur_tx % NUM_TX_DESC;
L
Linus Torvalds 已提交
7127
	struct TxDesc *txd = tp->TxDescArray + entry;
H
Heiner Kallweit 已提交
7128
	struct device *d = tp_to_dev(tp);
L
Linus Torvalds 已提交
7129 7130
	dma_addr_t mapping;
	u32 status, len;
F
Francois Romieu 已提交
7131
	u32 opts[2];
7132
	int frags;
7133

7134
	if (unlikely(!TX_FRAGS_READY_FOR(tp, skb_shinfo(skb)->nr_frags))) {
7135
		netif_err(tp, drv, dev, "BUG! Tx Ring full when queue awake!\n");
7136
		goto err_stop_0;
L
Linus Torvalds 已提交
7137 7138 7139
	}

	if (unlikely(le32_to_cpu(txd->opts1) & DescOwn))
7140 7141
		goto err_stop_0;

7142 7143 7144
	opts[1] = cpu_to_le32(rtl8169_tx_vlan_tag(skb));
	opts[0] = DescOwn;

H
hayeswang 已提交
7145 7146 7147 7148
	if (!tp->tso_csum(tp, skb, opts)) {
		r8169_csum_workaround(tp, skb);
		return NETDEV_TX_OK;
	}
7149

7150
	len = skb_headlen(skb);
7151
	mapping = dma_map_single(d, skb->data, len, DMA_TO_DEVICE);
7152 7153 7154
	if (unlikely(dma_mapping_error(d, mapping))) {
		if (net_ratelimit())
			netif_err(tp, drv, dev, "Failed to map TX DMA!\n");
7155
		goto err_dma_0;
7156
	}
7157 7158 7159

	tp->tx_skb[entry].len = len;
	txd->addr = cpu_to_le64(mapping);
L
Linus Torvalds 已提交
7160

F
Francois Romieu 已提交
7161
	frags = rtl8169_xmit_frags(tp, skb, opts);
7162 7163 7164
	if (frags < 0)
		goto err_dma_1;
	else if (frags)
F
Francois Romieu 已提交
7165
		opts[0] |= FirstFrag;
7166
	else {
F
Francois Romieu 已提交
7167
		opts[0] |= FirstFrag | LastFrag;
L
Linus Torvalds 已提交
7168 7169 7170
		tp->tx_skb[entry].skb = skb;
	}

F
Francois Romieu 已提交
7171 7172
	txd->opts2 = cpu_to_le32(opts[1]);

7173 7174
	skb_tx_timestamp(skb);

7175 7176
	/* Force memory writes to complete before releasing descriptor */
	dma_wmb();
L
Linus Torvalds 已提交
7177

F
Francois Romieu 已提交
7178
	/* Anti gcc 2.95.3 bugware (sic) */
F
Francois Romieu 已提交
7179
	status = opts[0] | len | (RingEnd * !((entry + 1) % NUM_TX_DESC));
L
Linus Torvalds 已提交
7180 7181
	txd->opts1 = cpu_to_le32(status);

7182
	/* Force all memory writes to complete before notifying device */
7183
	wmb();
L
Linus Torvalds 已提交
7184

7185 7186
	tp->cur_tx += frags + 1;

7187
	RTL_W8(tp, TxPoll, NPQ);
L
Linus Torvalds 已提交
7188

7189
	mmiowb();
7190

7191
	if (!TX_FRAGS_READY_FOR(tp, MAX_SKB_FRAGS)) {
7192 7193 7194 7195
		/* Avoid wrongly optimistic queue wake-up: rtl_tx thread must
		 * not miss a ring update when it notices a stopped queue.
		 */
		smp_wmb();
L
Linus Torvalds 已提交
7196
		netif_stop_queue(dev);
7197 7198 7199 7200 7201 7202 7203
		/* Sync with rtl_tx:
		 * - publish queue status and cur_tx ring index (write barrier)
		 * - refresh dirty_tx ring index (read barrier).
		 * May the current thread have a pessimistic view of the ring
		 * status and forget to wake up queue, a racing rtl_tx thread
		 * can't.
		 */
F
Francois Romieu 已提交
7204
		smp_mb();
7205
		if (TX_FRAGS_READY_FOR(tp, MAX_SKB_FRAGS))
L
Linus Torvalds 已提交
7206 7207 7208
			netif_wake_queue(dev);
	}

7209
	return NETDEV_TX_OK;
L
Linus Torvalds 已提交
7210

7211
err_dma_1:
7212
	rtl8169_unmap_tx_skb(d, tp->tx_skb + entry, txd);
7213
err_dma_0:
7214
	dev_kfree_skb_any(skb);
7215 7216 7217 7218
	dev->stats.tx_dropped++;
	return NETDEV_TX_OK;

err_stop_0:
L
Linus Torvalds 已提交
7219
	netif_stop_queue(dev);
7220
	dev->stats.tx_dropped++;
7221
	return NETDEV_TX_BUSY;
L
Linus Torvalds 已提交
7222 7223 7224 7225 7226 7227 7228 7229 7230 7231 7232
}

static void rtl8169_pcierr_interrupt(struct net_device *dev)
{
	struct rtl8169_private *tp = netdev_priv(dev);
	struct pci_dev *pdev = tp->pci_dev;
	u16 pci_status, pci_cmd;

	pci_read_config_word(pdev, PCI_COMMAND, &pci_cmd);
	pci_read_config_word(pdev, PCI_STATUS, &pci_status);

7233 7234
	netif_err(tp, intr, dev, "PCI error (cmd = 0x%04x, status = 0x%04x)\n",
		  pci_cmd, pci_status);
L
Linus Torvalds 已提交
7235 7236 7237 7238

	/*
	 * The recovery sequence below admits a very elaborated explanation:
	 * - it seems to work;
7239 7240
	 * - I did not see what else could be done;
	 * - it makes iop3xx happy.
L
Linus Torvalds 已提交
7241 7242 7243
	 *
	 * Feel free to adjust to your needs.
	 */
7244
	if (pdev->broken_parity_status)
7245 7246 7247 7248 7249
		pci_cmd &= ~PCI_COMMAND_PARITY;
	else
		pci_cmd |= PCI_COMMAND_SERR | PCI_COMMAND_PARITY;

	pci_write_config_word(pdev, PCI_COMMAND, pci_cmd);
L
Linus Torvalds 已提交
7250 7251 7252 7253 7254 7255 7256

	pci_write_config_word(pdev, PCI_STATUS,
		pci_status & (PCI_STATUS_DETECTED_PARITY |
		PCI_STATUS_SIG_SYSTEM_ERROR | PCI_STATUS_REC_MASTER_ABORT |
		PCI_STATUS_REC_TARGET_ABORT | PCI_STATUS_SIG_TARGET_ABORT));

	/* The infamous DAC f*ckup only happens at boot time */
7257
	if ((tp->cp_cmd & PCIDAC) && !tp->cur_rx) {
7258
		netif_info(tp, intr, dev, "disabling PCI DAC\n");
L
Linus Torvalds 已提交
7259
		tp->cp_cmd &= ~PCIDAC;
7260
		RTL_W16(tp, CPlusCmd, tp->cp_cmd);
L
Linus Torvalds 已提交
7261 7262 7263
		dev->features &= ~NETIF_F_HIGHDMA;
	}

F
françois romieu 已提交
7264
	rtl8169_hw_reset(tp);
7265

7266
	rtl_schedule_task(tp, RTL_FLAG_TASK_RESET_PENDING);
L
Linus Torvalds 已提交
7267 7268
}

7269
static void rtl_tx(struct net_device *dev, struct rtl8169_private *tp)
L
Linus Torvalds 已提交
7270 7271 7272 7273 7274 7275 7276 7277 7278 7279 7280 7281 7282 7283 7284 7285
{
	unsigned int dirty_tx, tx_left;

	dirty_tx = tp->dirty_tx;
	smp_rmb();
	tx_left = tp->cur_tx - dirty_tx;

	while (tx_left > 0) {
		unsigned int entry = dirty_tx % NUM_TX_DESC;
		struct ring_info *tx_skb = tp->tx_skb + entry;
		u32 status;

		status = le32_to_cpu(tp->TxDescArray[entry].opts1);
		if (status & DescOwn)
			break;

7286 7287 7288 7289 7290 7291
		/* This barrier is needed to keep us from reading
		 * any other fields out of the Tx descriptor until
		 * we know the status of DescOwn
		 */
		dma_rmb();

H
Heiner Kallweit 已提交
7292
		rtl8169_unmap_tx_skb(tp_to_dev(tp), tx_skb,
7293
				     tp->TxDescArray + entry);
L
Linus Torvalds 已提交
7294
		if (status & LastFrag) {
7295 7296 7297 7298
			u64_stats_update_begin(&tp->tx_stats.syncp);
			tp->tx_stats.packets++;
			tp->tx_stats.bytes += tx_skb->skb->len;
			u64_stats_update_end(&tp->tx_stats.syncp);
7299
			dev_consume_skb_any(tx_skb->skb);
L
Linus Torvalds 已提交
7300 7301 7302 7303 7304 7305 7306 7307
			tx_skb->skb = NULL;
		}
		dirty_tx++;
		tx_left--;
	}

	if (tp->dirty_tx != dirty_tx) {
		tp->dirty_tx = dirty_tx;
7308 7309 7310 7311 7312 7313 7314
		/* Sync with rtl8169_start_xmit:
		 * - publish dirty_tx ring index (write barrier)
		 * - refresh cur_tx ring index and queue status (read barrier)
		 * May the current thread miss the stopped queue condition,
		 * a racing xmit thread can only have a right view of the
		 * ring status.
		 */
F
Francois Romieu 已提交
7315
		smp_mb();
L
Linus Torvalds 已提交
7316
		if (netif_queue_stopped(dev) &&
7317
		    TX_FRAGS_READY_FOR(tp, MAX_SKB_FRAGS)) {
L
Linus Torvalds 已提交
7318 7319
			netif_wake_queue(dev);
		}
7320 7321 7322 7323 7324 7325
		/*
		 * 8168 hack: TxPoll requests are lost when the Tx packets are
		 * too close. Let's kick an extra TxPoll request when a burst
		 * of start_xmit activity is detected (if it is not detected,
		 * it is slow enough). -- FR
		 */
7326 7327
		if (tp->cur_tx != dirty_tx)
			RTL_W8(tp, TxPoll, NPQ);
L
Linus Torvalds 已提交
7328 7329 7330
	}
}

7331 7332 7333 7334 7335
static inline int rtl8169_fragmented_frame(u32 status)
{
	return (status & (FirstFrag | LastFrag)) != (FirstFrag | LastFrag);
}

E
Eric Dumazet 已提交
7336
static inline void rtl8169_rx_csum(struct sk_buff *skb, u32 opts1)
L
Linus Torvalds 已提交
7337 7338 7339 7340
{
	u32 status = opts1 & RxProtoMask;

	if (((status == RxProtoTCP) && !(opts1 & TCPFail)) ||
S
Shan Wei 已提交
7341
	    ((status == RxProtoUDP) && !(opts1 & UDPFail)))
L
Linus Torvalds 已提交
7342 7343
		skb->ip_summed = CHECKSUM_UNNECESSARY;
	else
7344
		skb_checksum_none_assert(skb);
L
Linus Torvalds 已提交
7345 7346
}

E
Eric Dumazet 已提交
7347 7348 7349 7350
static struct sk_buff *rtl8169_try_rx_copy(void *data,
					   struct rtl8169_private *tp,
					   int pkt_size,
					   dma_addr_t addr)
L
Linus Torvalds 已提交
7351
{
S
Stephen Hemminger 已提交
7352
	struct sk_buff *skb;
H
Heiner Kallweit 已提交
7353
	struct device *d = tp_to_dev(tp);
S
Stephen Hemminger 已提交
7354

E
Eric Dumazet 已提交
7355
	data = rtl8169_align(data);
7356
	dma_sync_single_for_cpu(d, addr, pkt_size, DMA_FROM_DEVICE);
E
Eric Dumazet 已提交
7357
	prefetch(data);
7358
	skb = napi_alloc_skb(&tp->napi, pkt_size);
E
Eric Dumazet 已提交
7359
	if (skb)
7360
		skb_copy_to_linear_data(skb, data, pkt_size);
7361 7362
	dma_sync_single_for_device(d, addr, pkt_size, DMA_FROM_DEVICE);

E
Eric Dumazet 已提交
7363
	return skb;
L
Linus Torvalds 已提交
7364 7365
}

7366
static int rtl_rx(struct net_device *dev, struct rtl8169_private *tp, u32 budget)
L
Linus Torvalds 已提交
7367 7368
{
	unsigned int cur_rx, rx_left;
E
Eric Dumazet 已提交
7369
	unsigned int count;
L
Linus Torvalds 已提交
7370 7371 7372

	cur_rx = tp->cur_rx;

7373
	for (rx_left = min(budget, NUM_RX_DESC); rx_left > 0; rx_left--, cur_rx++) {
L
Linus Torvalds 已提交
7374
		unsigned int entry = cur_rx % NUM_RX_DESC;
7375
		struct RxDesc *desc = tp->RxDescArray + entry;
L
Linus Torvalds 已提交
7376 7377
		u32 status;

7378
		status = le32_to_cpu(desc->opts1) & tp->opts1_mask;
L
Linus Torvalds 已提交
7379 7380
		if (status & DescOwn)
			break;
7381 7382 7383 7384 7385 7386 7387

		/* This barrier is needed to keep us from reading
		 * any other fields out of the Rx descriptor until
		 * we know the status of DescOwn
		 */
		dma_rmb();

R
Richard Dawe 已提交
7388
		if (unlikely(status & RxRES)) {
7389 7390
			netif_info(tp, rx_err, dev, "Rx ERROR. status = %08x\n",
				   status);
7391
			dev->stats.rx_errors++;
L
Linus Torvalds 已提交
7392
			if (status & (RxRWT | RxRUNT))
7393
				dev->stats.rx_length_errors++;
L
Linus Torvalds 已提交
7394
			if (status & RxCRC)
7395
				dev->stats.rx_crc_errors++;
7396
			if (status & RxFOVF) {
7397
				rtl_schedule_task(tp, RTL_FLAG_TASK_RESET_PENDING);
7398
				dev->stats.rx_fifo_errors++;
7399
			}
B
Ben Greear 已提交
7400 7401 7402 7403
			if ((status & (RxRUNT | RxCRC)) &&
			    !(status & (RxRWT | RxFOVF)) &&
			    (dev->features & NETIF_F_RXALL))
				goto process_pkt;
L
Linus Torvalds 已提交
7404
		} else {
E
Eric Dumazet 已提交
7405
			struct sk_buff *skb;
B
Ben Greear 已提交
7406 7407 7408 7409 7410
			dma_addr_t addr;
			int pkt_size;

process_pkt:
			addr = le64_to_cpu(desc->addr);
B
Ben Greear 已提交
7411 7412 7413 7414
			if (likely(!(dev->features & NETIF_F_RXFCS)))
				pkt_size = (status & 0x00003fff) - 4;
			else
				pkt_size = status & 0x00003fff;
L
Linus Torvalds 已提交
7415

7416 7417 7418 7419 7420 7421
			/*
			 * The driver does not support incoming fragmented
			 * frames. They are seen as a symptom of over-mtu
			 * sized frames.
			 */
			if (unlikely(rtl8169_fragmented_frame(status))) {
7422 7423
				dev->stats.rx_dropped++;
				dev->stats.rx_length_errors++;
7424
				goto release_descriptor;
7425 7426
			}

E
Eric Dumazet 已提交
7427 7428 7429 7430
			skb = rtl8169_try_rx_copy(tp->Rx_databuff[entry],
						  tp, pkt_size, addr);
			if (!skb) {
				dev->stats.rx_dropped++;
7431
				goto release_descriptor;
L
Linus Torvalds 已提交
7432 7433
			}

E
Eric Dumazet 已提交
7434
			rtl8169_rx_csum(skb, status);
L
Linus Torvalds 已提交
7435 7436 7437
			skb_put(skb, pkt_size);
			skb->protocol = eth_type_trans(skb, dev);

7438 7439
			rtl8169_rx_vlan_tag(desc, skb);

7440 7441 7442
			if (skb->pkt_type == PACKET_MULTICAST)
				dev->stats.multicast++;

7443
			napi_gro_receive(&tp->napi, skb);
L
Linus Torvalds 已提交
7444

J
Junchang Wang 已提交
7445 7446 7447 7448
			u64_stats_update_begin(&tp->rx_stats.syncp);
			tp->rx_stats.packets++;
			tp->rx_stats.bytes += pkt_size;
			u64_stats_update_end(&tp->rx_stats.syncp);
L
Linus Torvalds 已提交
7449
		}
7450 7451 7452
release_descriptor:
		desc->opts2 = 0;
		rtl8169_mark_to_asic(desc, rx_buf_sz);
L
Linus Torvalds 已提交
7453 7454 7455 7456 7457 7458 7459 7460
	}

	count = cur_rx - tp->cur_rx;
	tp->cur_rx = cur_rx;

	return count;
}

F
Francois Romieu 已提交
7461
static irqreturn_t rtl8169_interrupt(int irq, void *dev_instance)
L
Linus Torvalds 已提交
7462
{
F
Francois Romieu 已提交
7463
	struct net_device *dev = dev_instance;
L
Linus Torvalds 已提交
7464 7465
	struct rtl8169_private *tp = netdev_priv(dev);
	int handled = 0;
F
Francois Romieu 已提交
7466
	u16 status;
L
Linus Torvalds 已提交
7467

F
Francois Romieu 已提交
7468
	status = rtl_get_events(tp);
7469 7470 7471 7472
	if (status && status != 0xffff) {
		status &= RTL_EVENT_NAPI | tp->event_slow;
		if (status) {
			handled = 1;
L
Linus Torvalds 已提交
7473

7474
			rtl_irq_disable(tp);
7475
			napi_schedule_irqoff(&tp->napi);
7476
		}
7477 7478 7479
	}
	return IRQ_RETVAL(handled);
}
L
Linus Torvalds 已提交
7480

7481 7482 7483 7484 7485 7486 7487 7488 7489 7490
/*
 * Workqueue context.
 */
static void rtl_slow_event_work(struct rtl8169_private *tp)
{
	struct net_device *dev = tp->dev;
	u16 status;

	status = rtl_get_events(tp) & tp->event_slow;
	rtl_ack_events(tp, status);
L
Linus Torvalds 已提交
7491

7492 7493 7494 7495 7496
	if (unlikely(status & RxFIFOOver)) {
		switch (tp->mac_version) {
		/* Work around for rx fifo overflow */
		case RTL_GIGA_MAC_VER_11:
			netif_stop_queue(dev);
7497 7498
			/* XXX - Hack alert. See rtl_task(). */
			set_bit(RTL_FLAG_TASK_RESET_PENDING, tp->wk.flags);
7499
		default:
7500 7501
			break;
		}
7502
	}
L
Linus Torvalds 已提交
7503

7504 7505
	if (unlikely(status & SYSErr))
		rtl8169_pcierr_interrupt(dev);
7506

7507
	if (status & LinkChg)
7508
		rtl8169_check_link_status(dev, tp);
L
Linus Torvalds 已提交
7509

7510
	rtl_irq_enable_all(tp);
L
Linus Torvalds 已提交
7511 7512
}

7513 7514
static void rtl_task(struct work_struct *work)
{
7515 7516 7517 7518
	static const struct {
		int bitnr;
		void (*action)(struct rtl8169_private *);
	} rtl_work[] = {
7519
		/* XXX - keep rtl_slow_event_work() as first element. */
7520 7521 7522 7523
		{ RTL_FLAG_TASK_SLOW_PENDING,	rtl_slow_event_work },
		{ RTL_FLAG_TASK_RESET_PENDING,	rtl_reset_work },
		{ RTL_FLAG_TASK_PHY_PENDING,	rtl_phy_work }
	};
7524 7525
	struct rtl8169_private *tp =
		container_of(work, struct rtl8169_private, wk.work);
7526 7527 7528 7529 7530
	struct net_device *dev = tp->dev;
	int i;

	rtl_lock_work(tp);

7531 7532
	if (!netif_running(dev) ||
	    !test_bit(RTL_FLAG_TASK_ENABLED, tp->wk.flags))
7533 7534 7535 7536 7537 7538 7539 7540 7541
		goto out_unlock;

	for (i = 0; i < ARRAY_SIZE(rtl_work); i++) {
		bool pending;

		pending = test_and_clear_bit(rtl_work[i].bitnr, tp->wk.flags);
		if (pending)
			rtl_work[i].action(tp);
	}
7542

7543 7544
out_unlock:
	rtl_unlock_work(tp);
7545 7546
}

7547
static int rtl8169_poll(struct napi_struct *napi, int budget)
L
Linus Torvalds 已提交
7548
{
7549 7550
	struct rtl8169_private *tp = container_of(napi, struct rtl8169_private, napi);
	struct net_device *dev = tp->dev;
7551 7552 7553 7554 7555 7556 7557 7558 7559 7560 7561 7562
	u16 enable_mask = RTL_EVENT_NAPI | tp->event_slow;
	int work_done= 0;
	u16 status;

	status = rtl_get_events(tp);
	rtl_ack_events(tp, status & ~tp->event_slow);

	if (status & RTL_EVENT_NAPI_RX)
		work_done = rtl_rx(dev, tp, (u32) budget);

	if (status & RTL_EVENT_NAPI_TX)
		rtl_tx(dev, tp);
L
Linus Torvalds 已提交
7563

7564 7565 7566 7567 7568
	if (status & tp->event_slow) {
		enable_mask &= ~tp->event_slow;

		rtl_schedule_task(tp, RTL_FLAG_TASK_SLOW_PENDING);
	}
L
Linus Torvalds 已提交
7569

7570
	if (work_done < budget) {
7571
		napi_complete_done(napi, work_done);
7572

7573 7574
		rtl_irq_enable(tp, enable_mask);
		mmiowb();
L
Linus Torvalds 已提交
7575 7576
	}

7577
	return work_done;
L
Linus Torvalds 已提交
7578 7579
}

7580
static void rtl8169_rx_missed(struct net_device *dev)
7581 7582 7583 7584 7585 7586
{
	struct rtl8169_private *tp = netdev_priv(dev);

	if (tp->mac_version > RTL_GIGA_MAC_VER_06)
		return;

7587 7588
	dev->stats.rx_missed_errors += RTL_R32(tp, RxMissed) & 0xffffff;
	RTL_W32(tp, RxMissed, 0);
7589 7590
}

L
Linus Torvalds 已提交
7591 7592 7593 7594
static void rtl8169_down(struct net_device *dev)
{
	struct rtl8169_private *tp = netdev_priv(dev);

7595
	del_timer_sync(&tp->timer);
L
Linus Torvalds 已提交
7596

7597
	napi_disable(&tp->napi);
7598
	netif_stop_queue(dev);
L
Linus Torvalds 已提交
7599

7600
	rtl8169_hw_reset(tp);
S
Stanislaw Gruszka 已提交
7601 7602
	/*
	 * At this point device interrupts can not be enabled in any function,
7603 7604
	 * as netif_running is not true (rtl8169_interrupt, rtl8169_reset_task)
	 * and napi is disabled (rtl8169_poll).
S
Stanislaw Gruszka 已提交
7605
	 */
7606
	rtl8169_rx_missed(dev);
L
Linus Torvalds 已提交
7607 7608

	/* Give a racing hard_start_xmit a few cycles to complete. */
7609
	synchronize_sched();
L
Linus Torvalds 已提交
7610 7611 7612 7613

	rtl8169_tx_clear(tp);

	rtl8169_rx_clear(tp);
F
françois romieu 已提交
7614 7615

	rtl_pll_power_down(tp);
L
Linus Torvalds 已提交
7616 7617 7618 7619 7620 7621 7622
}

static int rtl8169_close(struct net_device *dev)
{
	struct rtl8169_private *tp = netdev_priv(dev);
	struct pci_dev *pdev = tp->pci_dev;

7623 7624
	pm_runtime_get_sync(&pdev->dev);

F
Francois Romieu 已提交
7625
	/* Update counters before going down */
7626 7627
	rtl8169_update_counters(dev);

7628
	rtl_lock_work(tp);
7629
	clear_bit(RTL_FLAG_TASK_ENABLED, tp->wk.flags);
7630

L
Linus Torvalds 已提交
7631
	rtl8169_down(dev);
7632
	rtl_unlock_work(tp);
L
Linus Torvalds 已提交
7633

7634 7635
	cancel_work_sync(&tp->wk.work);

7636
	pci_free_irq(pdev, 0, dev);
L
Linus Torvalds 已提交
7637

7638 7639 7640 7641
	dma_free_coherent(&pdev->dev, R8169_RX_RING_BYTES, tp->RxDescArray,
			  tp->RxPhyAddr);
	dma_free_coherent(&pdev->dev, R8169_TX_RING_BYTES, tp->TxDescArray,
			  tp->TxPhyAddr);
L
Linus Torvalds 已提交
7642 7643 7644
	tp->TxDescArray = NULL;
	tp->RxDescArray = NULL;

7645 7646
	pm_runtime_put_sync(&pdev->dev);

L
Linus Torvalds 已提交
7647 7648 7649
	return 0;
}

7650 7651 7652 7653 7654
#ifdef CONFIG_NET_POLL_CONTROLLER
static void rtl8169_netpoll(struct net_device *dev)
{
	struct rtl8169_private *tp = netdev_priv(dev);

7655
	rtl8169_interrupt(pci_irq_vector(tp->pci_dev, 0), dev);
7656 7657 7658
}
#endif

7659 7660 7661 7662 7663 7664 7665 7666 7667
static int rtl_open(struct net_device *dev)
{
	struct rtl8169_private *tp = netdev_priv(dev);
	struct pci_dev *pdev = tp->pci_dev;
	int retval = -ENOMEM;

	pm_runtime_get_sync(&pdev->dev);

	/*
7668
	 * Rx and Tx descriptors needs 256 bytes alignment.
7669 7670 7671 7672 7673 7674 7675 7676 7677 7678 7679 7680 7681 7682 7683 7684 7685 7686 7687 7688 7689 7690
	 * dma_alloc_coherent provides more.
	 */
	tp->TxDescArray = dma_alloc_coherent(&pdev->dev, R8169_TX_RING_BYTES,
					     &tp->TxPhyAddr, GFP_KERNEL);
	if (!tp->TxDescArray)
		goto err_pm_runtime_put;

	tp->RxDescArray = dma_alloc_coherent(&pdev->dev, R8169_RX_RING_BYTES,
					     &tp->RxPhyAddr, GFP_KERNEL);
	if (!tp->RxDescArray)
		goto err_free_tx_0;

	retval = rtl8169_init_ring(dev);
	if (retval < 0)
		goto err_free_rx_1;

	INIT_WORK(&tp->wk.work, rtl_task);

	smp_mb();

	rtl_request_firmware(tp);

7691 7692
	retval = pci_request_irq(pdev, 0, rtl8169_interrupt, NULL, dev,
				 dev->name);
7693 7694 7695 7696 7697 7698 7699 7700 7701 7702 7703 7704 7705 7706 7707 7708 7709
	if (retval < 0)
		goto err_release_fw_2;

	rtl_lock_work(tp);

	set_bit(RTL_FLAG_TASK_ENABLED, tp->wk.flags);

	napi_enable(&tp->napi);

	rtl8169_init_phy(dev, tp);

	__rtl8169_set_features(dev, dev->features);

	rtl_pll_power_up(tp);

	rtl_hw_start(dev);

7710 7711 7712
	if (!rtl8169_init_counter_offsets(dev))
		netif_warn(tp, hw, dev, "counter reset/update failed\n");

7713 7714 7715 7716 7717
	netif_start_queue(dev);

	rtl_unlock_work(tp);

	tp->saved_wolopts = 0;
7718
	pm_runtime_put_sync(&pdev->dev);
7719

7720
	rtl8169_check_link_status(dev, tp);
7721 7722 7723 7724 7725 7726 7727 7728 7729 7730 7731 7732 7733 7734 7735 7736 7737 7738 7739
out:
	return retval;

err_release_fw_2:
	rtl_release_firmware(tp);
	rtl8169_rx_clear(tp);
err_free_rx_1:
	dma_free_coherent(&pdev->dev, R8169_RX_RING_BYTES, tp->RxDescArray,
			  tp->RxPhyAddr);
	tp->RxDescArray = NULL;
err_free_tx_0:
	dma_free_coherent(&pdev->dev, R8169_TX_RING_BYTES, tp->TxDescArray,
			  tp->TxPhyAddr);
	tp->TxDescArray = NULL;
err_pm_runtime_put:
	pm_runtime_put_noidle(&pdev->dev);
	goto out;
}

7740
static void
J
Junchang Wang 已提交
7741
rtl8169_get_stats64(struct net_device *dev, struct rtnl_link_stats64 *stats)
L
Linus Torvalds 已提交
7742 7743
{
	struct rtl8169_private *tp = netdev_priv(dev);
7744
	struct pci_dev *pdev = tp->pci_dev;
7745
	struct rtl8169_counters *counters = tp->counters;
J
Junchang Wang 已提交
7746
	unsigned int start;
L
Linus Torvalds 已提交
7747

7748 7749 7750
	pm_runtime_get_noresume(&pdev->dev);

	if (netif_running(dev) && pm_runtime_active(&pdev->dev))
7751
		rtl8169_rx_missed(dev);
7752

J
Junchang Wang 已提交
7753
	do {
7754
		start = u64_stats_fetch_begin_irq(&tp->rx_stats.syncp);
J
Junchang Wang 已提交
7755 7756
		stats->rx_packets = tp->rx_stats.packets;
		stats->rx_bytes	= tp->rx_stats.bytes;
7757
	} while (u64_stats_fetch_retry_irq(&tp->rx_stats.syncp, start));
J
Junchang Wang 已提交
7758 7759

	do {
7760
		start = u64_stats_fetch_begin_irq(&tp->tx_stats.syncp);
J
Junchang Wang 已提交
7761 7762
		stats->tx_packets = tp->tx_stats.packets;
		stats->tx_bytes	= tp->tx_stats.bytes;
7763
	} while (u64_stats_fetch_retry_irq(&tp->tx_stats.syncp, start));
J
Junchang Wang 已提交
7764 7765 7766 7767 7768 7769 7770 7771

	stats->rx_dropped	= dev->stats.rx_dropped;
	stats->tx_dropped	= dev->stats.tx_dropped;
	stats->rx_length_errors = dev->stats.rx_length_errors;
	stats->rx_errors	= dev->stats.rx_errors;
	stats->rx_crc_errors	= dev->stats.rx_crc_errors;
	stats->rx_fifo_errors	= dev->stats.rx_fifo_errors;
	stats->rx_missed_errors = dev->stats.rx_missed_errors;
7772
	stats->multicast	= dev->stats.multicast;
J
Junchang Wang 已提交
7773

7774 7775 7776 7777
	/*
	 * Fetch additonal counter values missing in stats collected by driver
	 * from tally counters.
	 */
7778 7779
	if (pm_runtime_active(&pdev->dev))
		rtl8169_update_counters(dev);
7780 7781 7782 7783 7784

	/*
	 * Subtract values fetched during initalization.
	 * See rtl8169_init_counter_offsets for a description why we do that.
	 */
7785
	stats->tx_errors = le64_to_cpu(counters->tx_errors) -
7786
		le64_to_cpu(tp->tc_offset.tx_errors);
7787
	stats->collisions = le32_to_cpu(counters->tx_multi_collision) -
7788
		le32_to_cpu(tp->tc_offset.tx_multi_collision);
7789
	stats->tx_aborted_errors = le16_to_cpu(counters->tx_aborted) -
7790 7791
		le16_to_cpu(tp->tc_offset.tx_aborted);

7792
	pm_runtime_put_noidle(&pdev->dev);
L
Linus Torvalds 已提交
7793 7794
}

7795
static void rtl8169_net_suspend(struct net_device *dev)
7796
{
F
françois romieu 已提交
7797 7798
	struct rtl8169_private *tp = netdev_priv(dev);

7799
	if (!netif_running(dev))
7800
		return;
7801 7802 7803

	netif_device_detach(dev);
	netif_stop_queue(dev);
7804 7805 7806

	rtl_lock_work(tp);
	napi_disable(&tp->napi);
7807
	clear_bit(RTL_FLAG_TASK_ENABLED, tp->wk.flags);
7808 7809 7810
	rtl_unlock_work(tp);

	rtl_pll_power_down(tp);
7811 7812 7813 7814 7815 7816 7817 7818
}

#ifdef CONFIG_PM

static int rtl8169_suspend(struct device *device)
{
	struct pci_dev *pdev = to_pci_dev(device);
	struct net_device *dev = pci_get_drvdata(pdev);
7819

7820
	rtl8169_net_suspend(dev);
7821

7822 7823 7824
	return 0;
}

7825 7826
static void __rtl8169_resume(struct net_device *dev)
{
F
françois romieu 已提交
7827 7828
	struct rtl8169_private *tp = netdev_priv(dev);

7829
	netif_device_attach(dev);
F
françois romieu 已提交
7830 7831 7832

	rtl_pll_power_up(tp);

A
Artem Savkov 已提交
7833 7834
	rtl_lock_work(tp);
	napi_enable(&tp->napi);
7835
	set_bit(RTL_FLAG_TASK_ENABLED, tp->wk.flags);
A
Artem Savkov 已提交
7836
	rtl_unlock_work(tp);
7837

7838
	rtl_schedule_task(tp, RTL_FLAG_TASK_RESET_PENDING);
7839 7840
}

7841
static int rtl8169_resume(struct device *device)
7842
{
7843
	struct pci_dev *pdev = to_pci_dev(device);
7844
	struct net_device *dev = pci_get_drvdata(pdev);
S
Stanislaw Gruszka 已提交
7845 7846 7847
	struct rtl8169_private *tp = netdev_priv(dev);

	rtl8169_init_phy(dev, tp);
7848

7849 7850
	if (netif_running(dev))
		__rtl8169_resume(dev);
7851

7852 7853 7854 7855 7856 7857 7858 7859 7860
	return 0;
}

static int rtl8169_runtime_suspend(struct device *device)
{
	struct pci_dev *pdev = to_pci_dev(device);
	struct net_device *dev = pci_get_drvdata(pdev);
	struct rtl8169_private *tp = netdev_priv(dev);

7861 7862
	if (!tp->TxDescArray) {
		rtl_pll_power_down(tp);
7863
		return 0;
7864
	}
7865

7866
	rtl_lock_work(tp);
7867 7868
	tp->saved_wolopts = __rtl8169_get_wol(tp);
	__rtl8169_set_wol(tp, WAKE_ANY);
7869
	rtl_unlock_work(tp);
7870 7871 7872

	rtl8169_net_suspend(dev);

7873
	/* Update counters before going runtime suspend */
7874
	rtl8169_rx_missed(dev);
7875 7876
	rtl8169_update_counters(dev);

7877 7878 7879 7880 7881 7882 7883 7884
	return 0;
}

static int rtl8169_runtime_resume(struct device *device)
{
	struct pci_dev *pdev = to_pci_dev(device);
	struct net_device *dev = pci_get_drvdata(pdev);
	struct rtl8169_private *tp = netdev_priv(dev);
7885
	rtl_rar_set(tp, dev->dev_addr);
7886 7887 7888 7889

	if (!tp->TxDescArray)
		return 0;

7890
	rtl_lock_work(tp);
7891 7892
	__rtl8169_set_wol(tp, tp->saved_wolopts);
	tp->saved_wolopts = 0;
7893
	rtl_unlock_work(tp);
7894

S
Stanislaw Gruszka 已提交
7895 7896
	rtl8169_init_phy(dev, tp);

7897
	__rtl8169_resume(dev);
7898 7899 7900 7901

	return 0;
}

7902 7903 7904 7905 7906
static int rtl8169_runtime_idle(struct device *device)
{
	struct pci_dev *pdev = to_pci_dev(device);
	struct net_device *dev = pci_get_drvdata(pdev);

7907 7908 7909 7910
	if (!netif_running(dev) || !netif_carrier_ok(dev))
		pm_schedule_suspend(device, 10000);

	return -EBUSY;
7911 7912
}

7913
static const struct dev_pm_ops rtl8169_pm_ops = {
F
Francois Romieu 已提交
7914 7915 7916 7917 7918 7919 7920 7921 7922
	.suspend		= rtl8169_suspend,
	.resume			= rtl8169_resume,
	.freeze			= rtl8169_suspend,
	.thaw			= rtl8169_resume,
	.poweroff		= rtl8169_suspend,
	.restore		= rtl8169_resume,
	.runtime_suspend	= rtl8169_runtime_suspend,
	.runtime_resume		= rtl8169_runtime_resume,
	.runtime_idle		= rtl8169_runtime_idle,
7923 7924 7925 7926 7927 7928 7929 7930 7931 7932
};

#define RTL8169_PM_OPS	(&rtl8169_pm_ops)

#else /* !CONFIG_PM */

#define RTL8169_PM_OPS	NULL

#endif /* !CONFIG_PM */

7933 7934 7935 7936 7937 7938 7939 7940 7941
static void rtl_wol_shutdown_quirk(struct rtl8169_private *tp)
{
	/* WoL fails with 8168b when the receiver is disabled. */
	switch (tp->mac_version) {
	case RTL_GIGA_MAC_VER_11:
	case RTL_GIGA_MAC_VER_12:
	case RTL_GIGA_MAC_VER_17:
		pci_clear_master(tp->pci_dev);

7942
		RTL_W8(tp, ChipCmd, CmdRxEnb);
7943
		/* PCI commit */
7944
		RTL_R8(tp, ChipCmd);
7945 7946 7947 7948 7949 7950
		break;
	default:
		break;
	}
}

F
Francois Romieu 已提交
7951 7952
static void rtl_shutdown(struct pci_dev *pdev)
{
7953
	struct net_device *dev = pci_get_drvdata(pdev);
7954
	struct rtl8169_private *tp = netdev_priv(dev);
7955 7956

	rtl8169_net_suspend(dev);
F
Francois Romieu 已提交
7957

F
Francois Romieu 已提交
7958
	/* Restore original MAC address */
7959 7960
	rtl_rar_set(tp, dev->perm_addr);

7961
	rtl8169_hw_reset(tp);
7962

7963
	if (system_state == SYSTEM_POWER_OFF) {
7964 7965 7966
		if (__rtl8169_get_wol(tp) & WAKE_ANY) {
			rtl_wol_suspend_quirk(tp);
			rtl_wol_shutdown_quirk(tp);
7967 7968
		}

7969 7970 7971 7972
		pci_wake_from_d3(pdev, true);
		pci_set_power_state(pdev, PCI_D3hot);
	}
}
7973

B
Bill Pemberton 已提交
7974
static void rtl_remove_one(struct pci_dev *pdev)
7975 7976 7977 7978
{
	struct net_device *dev = pci_get_drvdata(pdev);
	struct rtl8169_private *tp = netdev_priv(dev);

7979
	if (r8168_check_dash(tp))
7980 7981
		rtl8168_driver_stop(tp);

7982 7983
	netif_napi_del(&tp->napi);

7984 7985 7986 7987 7988 7989 7990 7991 7992 7993 7994
	unregister_netdev(dev);

	rtl_release_firmware(tp);

	if (pci_dev_run_wake(pdev))
		pm_runtime_get_noresume(&pdev->dev);

	/* restore original MAC address */
	rtl_rar_set(tp, dev->perm_addr);
}

7995
static const struct net_device_ops rtl_netdev_ops = {
7996
	.ndo_open		= rtl_open,
7997 7998 7999 8000 8001 8002 8003 8004 8005 8006 8007 8008 8009 8010 8011 8012 8013
	.ndo_stop		= rtl8169_close,
	.ndo_get_stats64	= rtl8169_get_stats64,
	.ndo_start_xmit		= rtl8169_start_xmit,
	.ndo_tx_timeout		= rtl8169_tx_timeout,
	.ndo_validate_addr	= eth_validate_addr,
	.ndo_change_mtu		= rtl8169_change_mtu,
	.ndo_fix_features	= rtl8169_fix_features,
	.ndo_set_features	= rtl8169_set_features,
	.ndo_set_mac_address	= rtl_set_mac_address,
	.ndo_do_ioctl		= rtl8169_ioctl,
	.ndo_set_rx_mode	= rtl_set_rx_mode,
#ifdef CONFIG_NET_POLL_CONTROLLER
	.ndo_poll_controller	= rtl8169_netpoll,
#endif

};

8014 8015 8016 8017
static const struct rtl_cfg_info {
	void (*hw_start)(struct net_device *);
	unsigned int region;
	u16 event_slow;
8018
	unsigned int has_gmii:1;
8019
	const struct rtl_coalesce_info *coalesce_info;
8020 8021 8022 8023 8024 8025
	u8 default_ver;
} rtl_cfg_infos [] = {
	[RTL_CFG_0] = {
		.hw_start	= rtl_hw_start_8169,
		.region		= 1,
		.event_slow	= SYSErr | LinkChg | RxOverflow | RxFIFOOver,
8026
		.has_gmii	= 1,
8027
		.coalesce_info	= rtl_coalesce_info_8169,
8028 8029 8030 8031 8032 8033
		.default_ver	= RTL_GIGA_MAC_VER_01,
	},
	[RTL_CFG_1] = {
		.hw_start	= rtl_hw_start_8168,
		.region		= 2,
		.event_slow	= SYSErr | LinkChg | RxOverflow,
8034
		.has_gmii	= 1,
8035
		.coalesce_info	= rtl_coalesce_info_8168_8136,
8036 8037 8038 8039 8040 8041 8042
		.default_ver	= RTL_GIGA_MAC_VER_11,
	},
	[RTL_CFG_2] = {
		.hw_start	= rtl_hw_start_8101,
		.region		= 2,
		.event_slow	= SYSErr | LinkChg | RxOverflow | RxFIFOOver |
				  PCSTimeout,
8043
		.coalesce_info	= rtl_coalesce_info_8168_8136,
8044 8045 8046 8047
		.default_ver	= RTL_GIGA_MAC_VER_13,
	}
};

8048
static int rtl_alloc_irq(struct rtl8169_private *tp)
8049
{
8050
	unsigned int flags;
8051

8052
	if (tp->mac_version <= RTL_GIGA_MAC_VER_06) {
8053 8054 8055
		RTL_W8(tp, Cfg9346, Cfg9346_Unlock);
		RTL_W8(tp, Config2, RTL_R8(tp, Config2) & ~MSIEnable);
		RTL_W8(tp, Cfg9346, Cfg9346_Lock);
8056 8057 8058
		flags = PCI_IRQ_LEGACY;
	} else {
		flags = PCI_IRQ_ALL_TYPES;
8059
	}
8060 8061

	return pci_alloc_irq_vectors(tp->pci_dev, 1, 1, flags);
8062 8063
}

H
Hayes Wang 已提交
8064 8065
DECLARE_RTL_COND(rtl_link_list_ready_cond)
{
8066
	return RTL_R8(tp, MCU) & LINK_LIST_RDY;
H
Hayes Wang 已提交
8067 8068 8069 8070
}

DECLARE_RTL_COND(rtl_rxtx_empty_cond)
{
8071
	return (RTL_R8(tp, MCU) & RXTX_EMPTY) == RXTX_EMPTY;
H
Hayes Wang 已提交
8072 8073
}

B
Bill Pemberton 已提交
8074
static void rtl_hw_init_8168g(struct rtl8169_private *tp)
H
Hayes Wang 已提交
8075 8076 8077 8078 8079
{
	u32 data;

	tp->ocp_base = OCP_STD_PHY_BASE;

8080
	RTL_W32(tp, MISC, RTL_R32(tp, MISC) | RXDV_GATED_EN);
H
Hayes Wang 已提交
8081 8082 8083 8084 8085 8086 8087

	if (!rtl_udelay_loop_wait_high(tp, &rtl_txcfg_empty_cond, 100, 42))
		return;

	if (!rtl_udelay_loop_wait_high(tp, &rtl_rxtx_empty_cond, 100, 42))
		return;

8088
	RTL_W8(tp, ChipCmd, RTL_R8(tp, ChipCmd) & ~(CmdTxEnb | CmdRxEnb));
H
Hayes Wang 已提交
8089
	msleep(1);
8090
	RTL_W8(tp, MCU, RTL_R8(tp, MCU) & ~NOW_IS_OOB);
H
Hayes Wang 已提交
8091

8092
	data = r8168_mac_ocp_read(tp, 0xe8de);
H
Hayes Wang 已提交
8093 8094 8095 8096 8097 8098
	data &= ~(1 << 14);
	r8168_mac_ocp_write(tp, 0xe8de, data);

	if (!rtl_udelay_loop_wait_high(tp, &rtl_link_list_ready_cond, 100, 42))
		return;

8099
	data = r8168_mac_ocp_read(tp, 0xe8de);
H
Hayes Wang 已提交
8100 8101 8102 8103 8104 8105 8106
	data |= (1 << 15);
	r8168_mac_ocp_write(tp, 0xe8de, data);

	if (!rtl_udelay_loop_wait_high(tp, &rtl_link_list_ready_cond, 100, 42))
		return;
}

C
Chun-Hao Lin 已提交
8107 8108 8109 8110 8111 8112
static void rtl_hw_init_8168ep(struct rtl8169_private *tp)
{
	rtl8168ep_stop_cmac(tp);
	rtl_hw_init_8168g(tp);
}

B
Bill Pemberton 已提交
8113
static void rtl_hw_initialize(struct rtl8169_private *tp)
H
Hayes Wang 已提交
8114 8115 8116 8117
{
	switch (tp->mac_version) {
	case RTL_GIGA_MAC_VER_40:
	case RTL_GIGA_MAC_VER_41:
H
hayeswang 已提交
8118
	case RTL_GIGA_MAC_VER_42:
H
hayeswang 已提交
8119
	case RTL_GIGA_MAC_VER_43:
H
hayeswang 已提交
8120
	case RTL_GIGA_MAC_VER_44:
8121 8122 8123 8124
	case RTL_GIGA_MAC_VER_45:
	case RTL_GIGA_MAC_VER_46:
	case RTL_GIGA_MAC_VER_47:
	case RTL_GIGA_MAC_VER_48:
C
Chun-Hao Lin 已提交
8125 8126
		rtl_hw_init_8168g(tp);
		break;
C
Chun-Hao Lin 已提交
8127 8128 8129
	case RTL_GIGA_MAC_VER_49:
	case RTL_GIGA_MAC_VER_50:
	case RTL_GIGA_MAC_VER_51:
C
Chun-Hao Lin 已提交
8130
		rtl_hw_init_8168ep(tp);
H
Hayes Wang 已提交
8131 8132 8133 8134 8135 8136
		break;
	default:
		break;
	}
}

H
hayeswang 已提交
8137
static int rtl_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
8138 8139 8140 8141 8142 8143 8144 8145 8146 8147 8148 8149 8150 8151
{
	const struct rtl_cfg_info *cfg = rtl_cfg_infos + ent->driver_data;
	const unsigned int region = cfg->region;
	struct rtl8169_private *tp;
	struct mii_if_info *mii;
	struct net_device *dev;
	int chipset, i;
	int rc;

	if (netif_msg_drv(&debug)) {
		printk(KERN_INFO "%s Gigabit Ethernet driver %s loaded\n",
		       MODULENAME, RTL8169_VERSION);
	}

8152 8153 8154
	dev = devm_alloc_etherdev(&pdev->dev, sizeof (*tp));
	if (!dev)
		return -ENOMEM;
8155 8156

	SET_NETDEV_DEV(dev, &pdev->dev);
8157
	dev->netdev_ops = &rtl_netdev_ops;
8158 8159 8160 8161 8162 8163 8164 8165 8166 8167 8168
	tp = netdev_priv(dev);
	tp->dev = dev;
	tp->pci_dev = pdev;
	tp->msg_enable = netif_msg_init(debug.msg_enable, R8169_MSG_DEFAULT);

	mii = &tp->mii;
	mii->dev = dev;
	mii->mdio_read = rtl_mdio_read;
	mii->mdio_write = rtl_mdio_write;
	mii->phy_id_mask = 0x1f;
	mii->reg_num_mask = 0x1f;
8169
	mii->supports_gmii = cfg->has_gmii;
8170 8171 8172 8173 8174 8175 8176

	/* disable ASPM completely as that cause random device stop working
	 * problems as well as full system hangs for some PCIe devices users */
	pci_disable_link_state(pdev, PCIE_LINK_STATE_L0S | PCIE_LINK_STATE_L1 |
				     PCIE_LINK_STATE_CLKPM);

	/* enable device (incl. PCI PM wakeup and hotplug setup) */
8177
	rc = pcim_enable_device(pdev);
8178 8179
	if (rc < 0) {
		netif_err(tp, probe, dev, "enable failure\n");
8180
		return rc;
8181 8182
	}

8183
	if (pcim_set_mwi(pdev) < 0)
8184 8185 8186 8187 8188 8189 8190
		netif_info(tp, probe, dev, "Mem-Wr-Inval unavailable\n");

	/* make sure PCI base addr 1 is MMIO */
	if (!(pci_resource_flags(pdev, region) & IORESOURCE_MEM)) {
		netif_err(tp, probe, dev,
			  "region #%d not an MMIO resource, aborting\n",
			  region);
8191
		return -ENODEV;
8192 8193 8194 8195 8196 8197
	}

	/* check for weird/broken PCI region reporting */
	if (pci_resource_len(pdev, region) < R8169_REGS_SIZE) {
		netif_err(tp, probe, dev,
			  "Invalid PCI region size(s), aborting\n");
8198
		return -ENODEV;
8199 8200
	}

8201
	rc = pcim_iomap_regions(pdev, BIT(region), MODULENAME);
8202
	if (rc < 0) {
8203
		netif_err(tp, probe, dev, "cannot remap MMIO, aborting\n");
8204
		return rc;
8205 8206
	}

8207
	tp->mmio_addr = pcim_iomap_table(pdev)[region];
8208 8209 8210 8211 8212 8213 8214

	if (!pci_is_pcie(pdev))
		netif_info(tp, probe, dev, "not PCI Express\n");

	/* Identify chip attached to board */
	rtl8169_get_mac_version(tp, dev, cfg->default_ver);

8215 8216 8217 8218 8219
	tp->cp_cmd = 0;

	if ((sizeof(dma_addr_t) > 4) &&
	    (use_dac == 1 || (use_dac == -1 && pci_is_pcie(pdev) &&
			      tp->mac_version >= RTL_GIGA_MAC_VER_18)) &&
8220 8221
	    !pci_set_dma_mask(pdev, DMA_BIT_MASK(64)) &&
	    !pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64))) {
8222 8223 8224 8225 8226 8227 8228 8229 8230

		/* CPlusCmd Dual Access Cycle is only needed for non-PCIe */
		if (!pci_is_pcie(pdev))
			tp->cp_cmd |= PCIDAC;
		dev->features |= NETIF_F_HIGHDMA;
	} else {
		rc = pci_set_dma_mask(pdev, DMA_BIT_MASK(32));
		if (rc < 0) {
			netif_err(tp, probe, dev, "DMA configuration failed\n");
8231
			return rc;
8232 8233 8234
		}
	}

8235 8236 8237 8238
	rtl_init_rxcfg(tp);

	rtl_irq_disable(tp);

H
Hayes Wang 已提交
8239 8240
	rtl_hw_initialize(tp);

8241 8242 8243 8244 8245 8246 8247 8248 8249
	rtl_hw_reset(tp);

	rtl_ack_events(tp, 0xffff);

	pci_set_master(pdev);

	rtl_init_mdio_ops(tp);
	rtl_init_pll_power_ops(tp);
	rtl_init_jumbo_ops(tp);
8250
	rtl_init_csi_ops(tp);
8251 8252 8253 8254 8255 8256

	rtl8169_print_mac_version(tp);

	chipset = tp->mac_version;
	tp->txd_version = rtl_chip_infos[chipset].txd_version;

8257 8258 8259 8260 8261
	rc = rtl_alloc_irq(tp);
	if (rc < 0) {
		netif_err(tp, probe, dev, "Can't allocate interrupt\n");
		return rc;
	}
8262

H
Heiner Kallweit 已提交
8263 8264 8265
	/* override BIOS settings, use userspace tools to enable WOL */
	__rtl8169_set_wol(tp, 0);

8266 8267
	if (rtl_tbi_enabled(tp)) {
		tp->set_speed = rtl8169_set_speed_tbi;
8268
		tp->get_link_ksettings = rtl8169_get_link_ksettings_tbi;
8269 8270 8271 8272 8273 8274
		tp->phy_reset_enable = rtl8169_tbi_reset_enable;
		tp->phy_reset_pending = rtl8169_tbi_reset_pending;
		tp->link_ok = rtl8169_tbi_link_ok;
		tp->do_ioctl = rtl_tbi_ioctl;
	} else {
		tp->set_speed = rtl8169_set_speed_xmii;
8275
		tp->get_link_ksettings = rtl8169_get_link_ksettings_xmii;
8276 8277 8278 8279 8280 8281 8282
		tp->phy_reset_enable = rtl8169_xmii_reset_enable;
		tp->phy_reset_pending = rtl8169_xmii_reset_pending;
		tp->link_ok = rtl8169_xmii_link_ok;
		tp->do_ioctl = rtl_xmii_ioctl;
	}

	mutex_init(&tp->wk.mutex);
8283 8284
	u64_stats_init(&tp->rx_stats.syncp);
	u64_stats_init(&tp->tx_stats.syncp);
8285 8286

	/* Get MAC address */
8287 8288 8289 8290 8291 8292 8293 8294 8295 8296
	if (tp->mac_version == RTL_GIGA_MAC_VER_35 ||
	    tp->mac_version == RTL_GIGA_MAC_VER_36 ||
	    tp->mac_version == RTL_GIGA_MAC_VER_37 ||
	    tp->mac_version == RTL_GIGA_MAC_VER_38 ||
	    tp->mac_version == RTL_GIGA_MAC_VER_40 ||
	    tp->mac_version == RTL_GIGA_MAC_VER_41 ||
	    tp->mac_version == RTL_GIGA_MAC_VER_42 ||
	    tp->mac_version == RTL_GIGA_MAC_VER_43 ||
	    tp->mac_version == RTL_GIGA_MAC_VER_44 ||
	    tp->mac_version == RTL_GIGA_MAC_VER_45 ||
8297 8298
	    tp->mac_version == RTL_GIGA_MAC_VER_46 ||
	    tp->mac_version == RTL_GIGA_MAC_VER_47 ||
C
Chun-Hao Lin 已提交
8299 8300 8301 8302
	    tp->mac_version == RTL_GIGA_MAC_VER_48 ||
	    tp->mac_version == RTL_GIGA_MAC_VER_49 ||
	    tp->mac_version == RTL_GIGA_MAC_VER_50 ||
	    tp->mac_version == RTL_GIGA_MAC_VER_51) {
8303 8304
		u16 mac_addr[3];

8305 8306
		*(u32 *)&mac_addr[0] = rtl_eri_read(tp, 0xe0, ERIAR_EXGMAC);
		*(u16 *)&mac_addr[2] = rtl_eri_read(tp, 0xe4, ERIAR_EXGMAC);
8307 8308 8309 8310

		if (is_valid_ether_addr((u8 *)mac_addr))
			rtl_rar_set(tp, (u8 *)mac_addr);
	}
8311
	for (i = 0; i < ETH_ALEN; i++)
8312
		dev->dev_addr[i] = RTL_R8(tp, MAC0 + i);
8313

8314
	dev->ethtool_ops = &rtl8169_ethtool_ops;
8315 8316
	dev->watchdog_timeo = RTL8169_TX_TIMEOUT;

8317
	netif_napi_add(dev, &tp->napi, rtl8169_poll, NAPI_POLL_WEIGHT);
8318 8319 8320 8321

	/* don't enable SG, IP_CSUM and TSO by default - it might not work
	 * properly for all devices */
	dev->features |= NETIF_F_RXCSUM |
8322
		NETIF_F_HW_VLAN_CTAG_TX | NETIF_F_HW_VLAN_CTAG_RX;
8323 8324

	dev->hw_features = NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_TSO |
8325 8326
		NETIF_F_RXCSUM | NETIF_F_HW_VLAN_CTAG_TX |
		NETIF_F_HW_VLAN_CTAG_RX;
8327 8328 8329
	dev->vlan_features = NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_TSO |
		NETIF_F_HIGHDMA;

H
hayeswang 已提交
8330 8331 8332 8333 8334 8335
	tp->cp_cmd |= RxChkSum | RxVlan;

	/*
	 * Pretend we are using VLANs; This bypasses a nasty bug where
	 * Interrupts stop flowing on high load on 8110SCd controllers.
	 */
8336
	if (tp->mac_version == RTL_GIGA_MAC_VER_05)
H
hayeswang 已提交
8337
		/* Disallow toggling */
8338
		dev->hw_features &= ~NETIF_F_HW_VLAN_CTAG_RX;
8339

H
hayeswang 已提交
8340 8341
	if (tp->txd_version == RTL_TD_0)
		tp->tso_csum = rtl8169_tso_csum_v1;
H
hayeswang 已提交
8342
	else if (tp->txd_version == RTL_TD_1) {
H
hayeswang 已提交
8343
		tp->tso_csum = rtl8169_tso_csum_v2;
H
hayeswang 已提交
8344 8345
		dev->hw_features |= NETIF_F_IPV6_CSUM | NETIF_F_TSO6;
	} else
H
hayeswang 已提交
8346 8347
		WARN_ON_ONCE(1);

8348 8349 8350
	dev->hw_features |= NETIF_F_RXALL;
	dev->hw_features |= NETIF_F_RXFCS;

8351 8352 8353 8354
	/* MTU range: 60 - hw-specific max */
	dev->min_mtu = ETH_ZLEN;
	dev->max_mtu = rtl_chip_infos[chipset].jumbo_max;

8355 8356
	tp->hw_start = cfg->hw_start;
	tp->event_slow = cfg->event_slow;
8357
	tp->coalesce_info = cfg->coalesce_info;
8358 8359 8360 8361

	tp->opts1_mask = (tp->mac_version != RTL_GIGA_MAC_VER_01) ?
		~(RxBOVF | RxFOVF) : ~0;

8362
	timer_setup(&tp->timer, rtl8169_phy_timer, 0);
8363 8364 8365

	tp->rtl_fw = RTL_FIRMWARE_UNKNOWN;

8366 8367 8368
	tp->counters = dmam_alloc_coherent (&pdev->dev, sizeof(*tp->counters),
					    &tp->counters_phys_addr,
					    GFP_KERNEL);
8369 8370
	if (!tp->counters)
		return -ENOMEM;
8371

8372 8373
	pci_set_drvdata(pdev, dev);

8374 8375
	rc = register_netdev(dev);
	if (rc < 0)
8376
		return rc;
8377

8378
	netif_info(tp, probe, dev, "%s at 0x%p, %pM, XID %08x IRQ %d\n",
8379
		   rtl_chip_infos[chipset].name, tp->mmio_addr, dev->dev_addr,
8380
		   (u32)(RTL_R32(tp, TxConfig) & 0x9cf0f8ff),
8381
		   pci_irq_vector(pdev, 0));
8382 8383 8384 8385 8386 8387 8388
	if (rtl_chip_infos[chipset].jumbo_max != JUMBO_1K) {
		netif_info(tp, probe, dev, "jumbo features [frames: %d bytes, "
			   "tx checksumming: %s]\n",
			   rtl_chip_infos[chipset].jumbo_max,
			   rtl_chip_infos[chipset].jumbo_tx_csum ? "ok" : "ko");
	}

8389
	if (r8168_check_dash(tp))
8390 8391 8392 8393
		rtl8168_driver_start(tp);

	netif_carrier_off(dev);

8394 8395 8396
	if (pci_dev_run_wake(pdev))
		pm_runtime_put_sync(&pdev->dev);

8397
	return 0;
8398 8399
}

L
Linus Torvalds 已提交
8400 8401 8402
static struct pci_driver rtl8169_pci_driver = {
	.name		= MODULENAME,
	.id_table	= rtl8169_pci_tbl,
8403
	.probe		= rtl_init_one,
B
Bill Pemberton 已提交
8404
	.remove		= rtl_remove_one,
F
Francois Romieu 已提交
8405
	.shutdown	= rtl_shutdown,
8406
	.driver.pm	= RTL8169_PM_OPS,
L
Linus Torvalds 已提交
8407 8408
};

8409
module_pci_driver(rtl8169_pci_driver);