r8152.c 98.6 KB
Newer Older
H
hayeswang 已提交
1
/*
H
hayeswang 已提交
2
 *  Copyright (c) 2014 Realtek Semiconductor Corp. All rights reserved.
H
hayeswang 已提交
3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * version 2 as published by the Free Software Foundation.
 *
 */

#include <linux/signal.h>
#include <linux/slab.h>
#include <linux/module.h>
#include <linux/netdevice.h>
#include <linux/etherdevice.h>
#include <linux/mii.h>
#include <linux/ethtool.h>
#include <linux/usb.h>
#include <linux/crc32.h>
#include <linux/if_vlan.h>
#include <linux/uaccess.h>
H
hayeswang 已提交
21
#include <linux/list.h>
H
hayeswang 已提交
22 23
#include <linux/ip.h>
#include <linux/ipv6.h>
H
hayeswang 已提交
24
#include <net/ip6_checksum.h>
H
hayeswang 已提交
25 26
#include <uapi/linux/mdio.h>
#include <linux/mdio.h>
H
hayeswang 已提交
27
#include <linux/usb/cdc.h>
H
hayeswang 已提交
28
#include <linux/suspend.h>
H
hayeswang 已提交
29

H
hayeswang 已提交
30 31 32 33
/* Information for net-next */
#define NETNEXT_VERSION		"08"

/* Information for net */
34
#define NET_VERSION		"5"
H
hayeswang 已提交
35 36

#define DRIVER_VERSION		"v1." NETNEXT_VERSION "." NET_VERSION
H
hayeswang 已提交
37
#define DRIVER_AUTHOR "Realtek linux nic maintainers <nic_swsd@realtek.com>"
H
hayeswang 已提交
38
#define DRIVER_DESC "Realtek RTL8152/RTL8153 Based USB Ethernet Adapters"
H
hayeswang 已提交
39 40 41 42 43 44 45 46 47 48
#define MODULENAME "r8152"

#define R8152_PHY_ID		32

#define PLA_IDR			0xc000
#define PLA_RCR			0xc010
#define PLA_RMS			0xc016
#define PLA_RXFIFO_CTRL0	0xc0a0
#define PLA_RXFIFO_CTRL1	0xc0a4
#define PLA_RXFIFO_CTRL2	0xc0a8
H
hayeswang 已提交
49
#define PLA_DMY_REG0		0xc0b0
H
hayeswang 已提交
50 51
#define PLA_FMC			0xc0b4
#define PLA_CFG_WOL		0xc0b6
H
hayeswang 已提交
52
#define PLA_TEREDO_CFG		0xc0bc
H
hayeswang 已提交
53
#define PLA_MAR			0xcd00
H
hayeswang 已提交
54
#define PLA_BACKUP		0xd000
H
hayeswang 已提交
55
#define PAL_BDC_CR		0xd1a0
H
hayeswang 已提交
56 57
#define PLA_TEREDO_TIMER	0xd2cc
#define PLA_REALWOW_TIMER	0xd2e8
H
hayeswang 已提交
58 59 60
#define PLA_LEDSEL		0xdd90
#define PLA_LED_FEATURE		0xdd92
#define PLA_PHYAR		0xde00
H
hayeswang 已提交
61
#define PLA_BOOT_CTRL		0xe004
H
hayeswang 已提交
62 63 64 65
#define PLA_GPHY_INTR_IMR	0xe022
#define PLA_EEE_CR		0xe040
#define PLA_EEEP_CR		0xe080
#define PLA_MAC_PWR_CTRL	0xe0c0
H
hayeswang 已提交
66 67 68 69
#define PLA_MAC_PWR_CTRL2	0xe0ca
#define PLA_MAC_PWR_CTRL3	0xe0cc
#define PLA_MAC_PWR_CTRL4	0xe0ce
#define PLA_WDT6_CTRL		0xe428
H
hayeswang 已提交
70 71
#define PLA_TCR0		0xe610
#define PLA_TCR1		0xe612
72
#define PLA_MTPS		0xe615
H
hayeswang 已提交
73
#define PLA_TXFIFO_CTRL		0xe618
74
#define PLA_RSTTALLY		0xe800
H
hayeswang 已提交
75 76
#define PLA_CR			0xe813
#define PLA_CRWECR		0xe81c
H
hayeswang 已提交
77 78
#define PLA_CONFIG12		0xe81e	/* CONFIG1, CONFIG2 */
#define PLA_CONFIG34		0xe820	/* CONFIG3, CONFIG4 */
H
hayeswang 已提交
79 80 81 82 83 84 85
#define PLA_CONFIG5		0xe822
#define PLA_PHY_PWR		0xe84c
#define PLA_OOB_CTRL		0xe84f
#define PLA_CPCR		0xe854
#define PLA_MISC_0		0xe858
#define PLA_MISC_1		0xe85a
#define PLA_OCP_GPHY_BASE	0xe86c
86
#define PLA_TALLYCNT		0xe890
H
hayeswang 已提交
87 88 89 90 91 92 93 94 95 96 97
#define PLA_SFF_STS_7		0xe8de
#define PLA_PHYSTATUS		0xe908
#define PLA_BP_BA		0xfc26
#define PLA_BP_0		0xfc28
#define PLA_BP_1		0xfc2a
#define PLA_BP_2		0xfc2c
#define PLA_BP_3		0xfc2e
#define PLA_BP_4		0xfc30
#define PLA_BP_5		0xfc32
#define PLA_BP_6		0xfc34
#define PLA_BP_7		0xfc36
H
hayeswang 已提交
98
#define PLA_BP_EN		0xfc38
H
hayeswang 已提交
99

H
hayeswang 已提交
100 101
#define USB_USB2PHY		0xb41e
#define USB_SSPHYLINK2		0xb428
H
hayeswang 已提交
102
#define USB_U2P3_CTRL		0xb460
H
hayeswang 已提交
103 104
#define USB_CSR_DUMMY1		0xb464
#define USB_CSR_DUMMY2		0xb466
H
hayeswang 已提交
105
#define USB_DEV_STAT		0xb808
H
hayeswang 已提交
106 107
#define USB_CONNECT_TIMER	0xcbf8
#define USB_BURST_SIZE		0xcfc0
H
hayeswang 已提交
108 109 110 111 112
#define USB_USB_CTRL		0xd406
#define USB_PHY_CTRL		0xd408
#define USB_TX_AGG		0xd40a
#define USB_RX_BUF_TH		0xd40c
#define USB_USB_TIMER		0xd428
H
hayeswang 已提交
113 114
#define USB_RX_EARLY_TIMEOUT	0xd42c
#define USB_RX_EARLY_SIZE	0xd42e
H
hayeswang 已提交
115 116
#define USB_PM_CTRL_STATUS	0xd432
#define USB_TX_DMA		0xd434
H
hayeswang 已提交
117 118
#define USB_TOLERANCE		0xd490
#define USB_LPM_CTRL		0xd41a
H
hayeswang 已提交
119
#define USB_BMU_RESET		0xd4b0
H
hayeswang 已提交
120
#define USB_UPS_CTRL		0xd800
H
hayeswang 已提交
121 122 123 124
#define USB_MISC_0		0xd81a
#define USB_POWER_CUT		0xd80a
#define USB_AFE_CTRL2		0xd824
#define USB_WDT11_CTRL		0xe43c
H
hayeswang 已提交
125 126 127 128 129 130 131 132 133
#define USB_BP_BA		0xfc26
#define USB_BP_0		0xfc28
#define USB_BP_1		0xfc2a
#define USB_BP_2		0xfc2c
#define USB_BP_3		0xfc2e
#define USB_BP_4		0xfc30
#define USB_BP_5		0xfc32
#define USB_BP_6		0xfc34
#define USB_BP_7		0xfc36
H
hayeswang 已提交
134
#define USB_BP_EN		0xfc38
H
hayeswang 已提交
135 136 137 138 139 140

/* OCP Registers */
#define OCP_ALDPS_CONFIG	0x2010
#define OCP_EEE_CONFIG1		0x2080
#define OCP_EEE_CONFIG2		0x2092
#define OCP_EEE_CONFIG3		0x2094
141
#define OCP_BASE_MII		0xa400
H
hayeswang 已提交
142 143
#define OCP_EEE_AR		0xa41a
#define OCP_EEE_DATA		0xa41c
H
hayeswang 已提交
144 145 146 147 148 149
#define OCP_PHY_STATUS		0xa420
#define OCP_POWER_CFG		0xa430
#define OCP_EEE_CFG		0xa432
#define OCP_SRAM_ADDR		0xa436
#define OCP_SRAM_DATA		0xa438
#define OCP_DOWN_SPEED		0xa442
H
hayeswang 已提交
150
#define OCP_EEE_ABLE		0xa5c4
H
hayeswang 已提交
151
#define OCP_EEE_ADV		0xa5d0
H
hayeswang 已提交
152
#define OCP_EEE_LPABLE		0xa5d2
153
#define OCP_PHY_STATE		0xa708		/* nway state for 8153 */
H
hayeswang 已提交
154 155 156 157 158 159 160
#define OCP_ADC_CFG		0xbc06

/* SRAM Register */
#define SRAM_LPF_CFG		0x8012
#define SRAM_10M_AMP1		0x8080
#define SRAM_10M_AMP2		0x8082
#define SRAM_IMPEDANCE		0x8084
H
hayeswang 已提交
161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176

/* PLA_RCR */
#define RCR_AAP			0x00000001
#define RCR_APM			0x00000002
#define RCR_AM			0x00000004
#define RCR_AB			0x00000008
#define RCR_ACPT_ALL		(RCR_AAP | RCR_APM | RCR_AM | RCR_AB)

/* PLA_RXFIFO_CTRL0 */
#define RXFIFO_THR1_NORMAL	0x00080002
#define RXFIFO_THR1_OOB		0x01800003

/* PLA_RXFIFO_CTRL1 */
#define RXFIFO_THR2_FULL	0x00000060
#define RXFIFO_THR2_HIGH	0x00000038
#define RXFIFO_THR2_OOB		0x0000004a
H
hayeswang 已提交
177
#define RXFIFO_THR2_NORMAL	0x00a0
H
hayeswang 已提交
178 179 180 181 182

/* PLA_RXFIFO_CTRL2 */
#define RXFIFO_THR3_FULL	0x00000078
#define RXFIFO_THR3_HIGH	0x00000048
#define RXFIFO_THR3_OOB		0x0000005a
H
hayeswang 已提交
183
#define RXFIFO_THR3_NORMAL	0x0110
H
hayeswang 已提交
184 185 186

/* PLA_TXFIFO_CTRL */
#define TXFIFO_THR_NORMAL	0x00400008
H
hayeswang 已提交
187
#define TXFIFO_THR_NORMAL2	0x01000008
H
hayeswang 已提交
188

H
hayeswang 已提交
189 190 191
/* PLA_DMY_REG0 */
#define ECM_ALDPS		0x0002

H
hayeswang 已提交
192 193 194 195 196 197
/* PLA_FMC */
#define FMC_FCR_MCU_EN		0x0001

/* PLA_EEEP_CR */
#define EEEP_CR_EEEP_TX		0x0002

H
hayeswang 已提交
198 199 200
/* PLA_WDT6_CTRL */
#define WDT6_SET_MODE		0x0010

H
hayeswang 已提交
201 202 203 204 205 206 207
/* PLA_TCR0 */
#define TCR0_TX_EMPTY		0x0800
#define TCR0_AUTO_FIFO		0x0080

/* PLA_TCR1 */
#define VERSION_MASK		0x7cf0

208 209 210 211
/* PLA_MTPS */
#define MTPS_JUMBO		(12 * 1024 / 64)
#define MTPS_DEFAULT		(6 * 1024 / 64)

212 213 214
/* PLA_RSTTALLY */
#define TALLY_RESET		0x0001

H
hayeswang 已提交
215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244
/* PLA_CR */
#define CR_RST			0x10
#define CR_RE			0x08
#define CR_TE			0x04

/* PLA_CRWECR */
#define CRWECR_NORAML		0x00
#define CRWECR_CONFIG		0xc0

/* PLA_OOB_CTRL */
#define NOW_IS_OOB		0x80
#define TXFIFO_EMPTY		0x20
#define RXFIFO_EMPTY		0x10
#define LINK_LIST_READY		0x02
#define DIS_MCU_CLROOB		0x01
#define FIFO_EMPTY		(TXFIFO_EMPTY | RXFIFO_EMPTY)

/* PLA_MISC_1 */
#define RXDY_GATED_EN		0x0008

/* PLA_SFF_STS_7 */
#define RE_INIT_LL		0x8000
#define MCU_BORW_EN		0x4000

/* PLA_CPCR */
#define CPCR_RX_VLAN		0x0040

/* PLA_CFG_WOL */
#define MAGIC_EN		0x0001

H
hayeswang 已提交
245 246 247 248 249 250
/* PLA_TEREDO_CFG */
#define TEREDO_SEL		0x8000
#define TEREDO_WAKE_MASK	0x7f00
#define TEREDO_RS_EVENT_MASK	0x00fe
#define OOB_TEREDO_EN		0x0001

H
hayeswang 已提交
251 252 253
/* PAL_BDC_CR */
#define ALDPS_PROXY_MODE	0x0001

H
hayeswang 已提交
254 255 256 257
/* PLA_CONFIG34 */
#define LINK_ON_WAKE_EN		0x0010
#define LINK_OFF_WAKE_EN	0x0008

H
hayeswang 已提交
258
/* PLA_CONFIG5 */
H
hayeswang 已提交
259 260 261
#define BWF_EN			0x0040
#define MWF_EN			0x0020
#define UWF_EN			0x0010
H
hayeswang 已提交
262 263 264 265 266 267 268 269 270 271 272 273 274
#define LAN_WAKE_EN		0x0002

/* PLA_LED_FEATURE */
#define LED_MODE_MASK		0x0700

/* PLA_PHY_PWR */
#define TX_10M_IDLE_EN		0x0080
#define PFM_PWM_SWITCH		0x0040

/* PLA_MAC_PWR_CTRL */
#define D3_CLK_GATED_EN		0x00004000
#define MCU_CLK_RATIO		0x07010f07
#define MCU_CLK_RATIO_MASK	0x0f0f0f0f
H
hayeswang 已提交
275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293
#define ALDPS_SPDWN_RATIO	0x0f87

/* PLA_MAC_PWR_CTRL2 */
#define EEE_SPDWN_RATIO		0x8007

/* PLA_MAC_PWR_CTRL3 */
#define PKT_AVAIL_SPDWN_EN	0x0100
#define SUSPEND_SPDWN_EN	0x0004
#define U1U2_SPDWN_EN		0x0002
#define L1_SPDWN_EN		0x0001

/* PLA_MAC_PWR_CTRL4 */
#define PWRSAVE_SPDWN_EN	0x1000
#define RXDV_SPDWN_EN		0x0800
#define TX10MIDLE_EN		0x0100
#define TP100_SPDWN_EN		0x0020
#define TP500_SPDWN_EN		0x0010
#define TP1000_SPDWN_EN		0x0008
#define EEE_SPDWN_EN		0x0001
H
hayeswang 已提交
294 295 296 297 298 299 300 301 302 303 304 305 306 307

/* PLA_GPHY_INTR_IMR */
#define GPHY_STS_MSK		0x0001
#define SPEED_DOWN_MSK		0x0002
#define SPDWN_RXDV_MSK		0x0004
#define SPDWN_LINKCHG_MSK	0x0008

/* PLA_PHYAR */
#define PHYAR_FLAG		0x80000000

/* PLA_EEE_CR */
#define EEE_RX_EN		0x0001
#define EEE_TX_EN		0x0002

H
hayeswang 已提交
308 309 310
/* PLA_BOOT_CTRL */
#define AUTOLOAD_DONE		0x0002

H
hayeswang 已提交
311 312 313 314 315 316 317 318 319 320 321 322 323 324
/* USB_USB2PHY */
#define USB2PHY_SUSPEND		0x0001
#define USB2PHY_L1		0x0002

/* USB_SSPHYLINK2 */
#define pwd_dn_scale_mask	0x3ffe
#define pwd_dn_scale(x)		((x) << 1)

/* USB_CSR_DUMMY1 */
#define DYNAMIC_BURST		0x0001

/* USB_CSR_DUMMY2 */
#define EP4_FULL_FC		0x0001

H
hayeswang 已提交
325 326 327
/* USB_DEV_STAT */
#define STAT_SPEED_MASK		0x0006
#define STAT_SPEED_HIGH		0x0000
328
#define STAT_SPEED_FULL		0x0002
H
hayeswang 已提交
329 330 331 332 333

/* USB_TX_AGG */
#define TX_AGG_MAX_THRESHOLD	0x03

/* USB_RX_BUF_TH */
H
hayeswang 已提交
334
#define RX_THR_SUPPER		0x0c350180
H
hayeswang 已提交
335
#define RX_THR_HIGH		0x7a120180
H
hayeswang 已提交
336
#define RX_THR_SLOW		0xffff0180
H
hayeswang 已提交
337 338 339 340 341

/* USB_TX_DMA */
#define TEST_MODE_DISABLE	0x00000001
#define TX_SIZE_ADJUST1		0x00000100

H
hayeswang 已提交
342 343 344 345
/* USB_BMU_RESET */
#define BMU_RESET_EP_IN		0x01
#define BMU_RESET_EP_OUT	0x02

H
hayeswang 已提交
346 347 348 349
/* USB_UPS_CTRL */
#define POWER_CUT		0x0100

/* USB_PM_CTRL_STATUS */
H
hayeswang 已提交
350
#define RESUME_INDICATE		0x0001
H
hayeswang 已提交
351 352 353

/* USB_USB_CTRL */
#define RX_AGG_DISABLE		0x0010
354
#define RX_ZERO_EN		0x0080
H
hayeswang 已提交
355

H
hayeswang 已提交
356 357 358 359 360 361 362 363 364 365
/* USB_U2P3_CTRL */
#define U2P3_ENABLE		0x0001

/* USB_POWER_CUT */
#define PWR_EN			0x0001
#define PHASE2_EN		0x0008

/* USB_MISC_0 */
#define PCUT_STATUS		0x0001

H
hayeswang 已提交
366 367 368 369
/* USB_RX_EARLY_TIMEOUT */
#define COALESCE_SUPER		 85000U
#define COALESCE_HIGH		250000U
#define COALESCE_SLOW		524280U
H
hayeswang 已提交
370 371 372 373 374

/* USB_WDT11_CTRL */
#define TIMER11_EN		0x0001

/* USB_LPM_CTRL */
H
hayeswang 已提交
375 376 377
/* bit 4 ~ 5: fifo empty boundary */
#define FIFO_EMPTY_1FB		0x30	/* 0x1fb * 64 = 32448 bytes */
/* bit 2 ~ 3: LMP timer */
H
hayeswang 已提交
378 379 380
#define LPM_TIMER_MASK		0x0c
#define LPM_TIMER_500MS		0x04	/* 500 ms */
#define LPM_TIMER_500US		0x0c	/* 500 us */
H
hayeswang 已提交
381
#define ROK_EXIT_LPM		0x02
H
hayeswang 已提交
382 383 384 385 386 387

/* USB_AFE_CTRL2 */
#define SEN_VAL_MASK		0xf800
#define SEN_VAL_NORMAL		0xa000
#define SEL_RXIDLE		0x0100

H
hayeswang 已提交
388 389 390 391 392 393
/* OCP_ALDPS_CONFIG */
#define ENPWRSAVE		0x8000
#define ENPDNPS			0x0200
#define LINKENA			0x0100
#define DIS_SDSAVE		0x0010

H
hayeswang 已提交
394 395 396 397 398 399 400 401 402 403
/* OCP_PHY_STATUS */
#define PHY_STAT_MASK		0x0007
#define PHY_STAT_LAN_ON		3
#define PHY_STAT_PWRDN		5

/* OCP_POWER_CFG */
#define EEE_CLKDIV_EN		0x8000
#define EN_ALDPS		0x0004
#define EN_10M_PLLOFF		0x0001

H
hayeswang 已提交
404 405 406 407 408 409 410
/* OCP_EEE_CONFIG1 */
#define RG_TXLPI_MSK_HFDUP	0x8000
#define RG_MATCLR_EN		0x4000
#define EEE_10_CAP		0x2000
#define EEE_NWAY_EN		0x1000
#define TX_QUIET_EN		0x0200
#define RX_QUIET_EN		0x0100
H
hayeswang 已提交
411
#define sd_rise_time_mask	0x0070
H
hayeswang 已提交
412
#define sd_rise_time(x)		(min(x, 7) << 4)	/* bit 4 ~ 6 */
H
hayeswang 已提交
413 414 415 416 417 418 419 420 421 422 423
#define RG_RXLPI_MSK_HFDUP	0x0008
#define SDFALLTIME		0x0007	/* bit 0 ~ 2 */

/* OCP_EEE_CONFIG2 */
#define RG_LPIHYS_NUM		0x7000	/* bit 12 ~ 15 */
#define RG_DACQUIET_EN		0x0400
#define RG_LDVQUIET_EN		0x0200
#define RG_CKRSEL		0x0020
#define RG_EEEPRG_EN		0x0010

/* OCP_EEE_CONFIG3 */
H
hayeswang 已提交
424
#define fast_snr_mask		0xff80
H
hayeswang 已提交
425
#define fast_snr(x)		(min(x, 0x1ff) << 7)	/* bit 7 ~ 15 */
H
hayeswang 已提交
426 427 428 429 430 431 432 433 434
#define RG_LFS_SEL		0x0060	/* bit 6 ~ 5 */
#define MSK_PH			0x0006	/* bit 0 ~ 3 */

/* OCP_EEE_AR */
/* bit[15:14] function */
#define FUN_ADDR		0x0000
#define FUN_DATA		0x4000
/* bit[4:0] device addr */

H
hayeswang 已提交
435 436 437 438 439 440 441
/* OCP_EEE_CFG */
#define CTAP_SHORT_EN		0x0040
#define EEE10_EN		0x0010

/* OCP_DOWN_SPEED */
#define EN_10M_BGOFF		0x0080

442 443 444 445
/* OCP_PHY_STATE */
#define TXDIS_STATE		0x01
#define ABD_STATE		0x02

H
hayeswang 已提交
446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462
/* OCP_ADC_CFG */
#define CKADSEL_L		0x0100
#define ADC_EN			0x0080
#define EN_EMI_L		0x0040

/* SRAM_LPF_CFG */
#define LPF_AUTO_TUNE		0x8000

/* SRAM_10M_AMP1 */
#define GDAC_IB_UPALL		0x0008

/* SRAM_10M_AMP2 */
#define AMP_DN			0x0200

/* SRAM_IMPEDANCE */
#define RX_DRIVING_MASK		0x6000

H
hayeswang 已提交
463
enum rtl_register_content {
H
hayeswang 已提交
464
	_1000bps	= 0x10,
H
hayeswang 已提交
465 466 467 468 469 470
	_100bps		= 0x08,
	_10bps		= 0x04,
	LINK_STATUS	= 0x02,
	FULL_DUP	= 0x01,
};

H
hayeswang 已提交
471
#define RTL8152_MAX_TX		4
H
hayeswang 已提交
472
#define RTL8152_MAX_RX		10
473
#define INTBUFSIZE		2
H
hayeswang 已提交
474 475 476
#define CRC_SIZE		4
#define TX_ALIGN		4
#define RX_ALIGN		8
477 478

#define INTR_LINK		0x0004
H
hayeswang 已提交
479

H
hayeswang 已提交
480 481 482 483 484 485 486 487 488 489 490 491
#define RTL8152_REQT_READ	0xc0
#define RTL8152_REQT_WRITE	0x40
#define RTL8152_REQ_GET_REGS	0x05
#define RTL8152_REQ_SET_REGS	0x05

#define BYTE_EN_DWORD		0xff
#define BYTE_EN_WORD		0x33
#define BYTE_EN_BYTE		0x11
#define BYTE_EN_SIX_BYTES	0x3f
#define BYTE_EN_START_MASK	0x0f
#define BYTE_EN_END_MASK	0xf0

492 493
#define RTL8153_MAX_PACKET	9216 /* 9K */
#define RTL8153_MAX_MTU		(RTL8153_MAX_PACKET - VLAN_ETH_HLEN - VLAN_HLEN)
H
hayeswang 已提交
494
#define RTL8152_RMS		(VLAN_ETH_FRAME_LEN + VLAN_HLEN)
495
#define RTL8153_RMS		RTL8153_MAX_PACKET
H
hayeswang 已提交
496
#define RTL8152_TX_TIMEOUT	(5 * HZ)
H
hayeswang 已提交
497
#define RTL8152_NAPI_WEIGHT	64
H
hayeswang 已提交
498 499 500 501 502

/* rtl8152 flags */
enum rtl8152_flags {
	RTL8152_UNPLUG = 0,
	RTL8152_SET_RX_MODE,
503 504
	WORK_ENABLE,
	RTL8152_LINK_CHG,
H
hayeswang 已提交
505
	SELECTIVE_SUSPEND,
506
	PHY_RESET,
H
hayeswang 已提交
507
	SCHEDULE_NAPI,
H
hayeswang 已提交
508 509 510 511
};

/* Define these values to match your device */
#define VENDOR_ID_REALTEK		0x0bda
H
hayeswang 已提交
512
#define VENDOR_ID_SAMSUNG		0x04e8
513
#define VENDOR_ID_LENOVO		0x17ef
514
#define VENDOR_ID_NVIDIA		0x0955
H
hayeswang 已提交
515 516 517 518

#define MCU_TYPE_PLA			0x0100
#define MCU_TYPE_USB			0x0000

519 520 521 522 523 524 525 526 527 528 529 530 531
struct tally_counter {
	__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;
H
hayeswang 已提交
532
	__le16	tx_underrun;
533 534
};

H
hayeswang 已提交
535
struct rx_desc {
536
	__le32 opts1;
H
hayeswang 已提交
537
#define RX_LEN_MASK			0x7fff
H
hayeswang 已提交
538

539
	__le32 opts2;
H
hayeswang 已提交
540 541 542 543
#define RD_UDP_CS			BIT(23)
#define RD_TCP_CS			BIT(22)
#define RD_IPV6_CS			BIT(20)
#define RD_IPV4_CS			BIT(19)
H
hayeswang 已提交
544

545
	__le32 opts3;
H
hayeswang 已提交
546 547 548 549
#define IPF				BIT(23) /* IP checksum fail */
#define UDPF				BIT(22) /* UDP checksum fail */
#define TCPF				BIT(21) /* TCP checksum fail */
#define RX_VLAN_TAG			BIT(16)
H
hayeswang 已提交
550

551 552 553
	__le32 opts4;
	__le32 opts5;
	__le32 opts6;
H
hayeswang 已提交
554 555 556
};

struct tx_desc {
557
	__le32 opts1;
H
hayeswang 已提交
558 559 560 561
#define TX_FS			BIT(31) /* First segment of a packet */
#define TX_LS			BIT(30) /* Final segment of a packet */
#define GTSENDV4		BIT(28)
#define GTSENDV6		BIT(27)
H
hayeswang 已提交
562
#define GTTCPHO_SHIFT		18
H
hayeswang 已提交
563
#define GTTCPHO_MAX		0x7fU
H
hayeswang 已提交
564
#define TX_LEN_MAX		0x3ffffU
H
hayeswang 已提交
565

566
	__le32 opts2;
H
hayeswang 已提交
567 568 569 570
#define UDP_CS			BIT(31) /* Calculate UDP/IP checksum */
#define TCP_CS			BIT(30) /* Calculate TCP/IP checksum */
#define IPV4_CS			BIT(29) /* Calculate IPv4 checksum */
#define IPV6_CS			BIT(28) /* Calculate IPv6 checksum */
H
hayeswang 已提交
571 572 573
#define MSS_SHIFT		17
#define MSS_MAX			0x7ffU
#define TCPHO_SHIFT		17
H
hayeswang 已提交
574
#define TCPHO_MAX		0x7ffU
H
hayeswang 已提交
575
#define TX_VLAN_TAG		BIT(16)
H
hayeswang 已提交
576 577
};

578 579
struct r8152;

H
hayeswang 已提交
580 581 582
struct rx_agg {
	struct list_head list;
	struct urb *urb;
583
	struct r8152 *context;
H
hayeswang 已提交
584 585 586 587 588 589 590
	void *buffer;
	void *head;
};

struct tx_agg {
	struct list_head list;
	struct urb *urb;
591
	struct r8152 *context;
H
hayeswang 已提交
592 593 594 595 596 597
	void *buffer;
	void *head;
	u32 skb_num;
	u32 skb_len;
};

H
hayeswang 已提交
598 599 600
struct r8152 {
	unsigned long flags;
	struct usb_device *udev;
H
hayeswang 已提交
601
	struct napi_struct napi;
602
	struct usb_interface *intf;
H
hayeswang 已提交
603
	struct net_device *netdev;
604
	struct urb *intr_urb;
H
hayeswang 已提交
605 606 607
	struct tx_agg tx_info[RTL8152_MAX_TX];
	struct rx_agg rx_info[RTL8152_MAX_RX];
	struct list_head rx_done, tx_free;
H
hayeswang 已提交
608
	struct sk_buff_head tx_queue, rx_queue;
H
hayeswang 已提交
609
	spinlock_t rx_lock, tx_lock;
H
hayeswang 已提交
610 611
	struct delayed_work schedule;
	struct mii_if_info mii;
H
hayeswang 已提交
612
	struct mutex control;	/* use for hw setting */
H
hayeswang 已提交
613 614 615
#ifdef CONFIG_PM_SLEEP
	struct notifier_block pm_notifier;
#endif
H
hayeswang 已提交
616 617 618 619 620

	struct rtl_ops {
		void (*init)(struct r8152 *);
		int (*enable)(struct r8152 *);
		void (*disable)(struct r8152 *);
621
		void (*up)(struct r8152 *);
H
hayeswang 已提交
622 623
		void (*down)(struct r8152 *);
		void (*unload)(struct r8152 *);
H
hayeswang 已提交
624 625
		int (*eee_get)(struct r8152 *, struct ethtool_eee *);
		int (*eee_set)(struct r8152 *, struct ethtool_eee *);
626
		bool (*in_nway)(struct r8152 *);
627
		void (*autosuspend_en)(struct r8152 *tp, bool enable);
H
hayeswang 已提交
628 629
	} rtl_ops;

630
	int intr_interval;
H
hayeswang 已提交
631
	u32 saved_wolopts;
H
hayeswang 已提交
632
	u32 msg_enable;
633
	u32 tx_qlen;
H
hayeswang 已提交
634
	u32 coalesce;
H
hayeswang 已提交
635
	u16 ocp_base;
636
	u8 *intr_buff;
H
hayeswang 已提交
637 638 639 640 641 642
	u8 version;
};

enum rtl_version {
	RTL_VER_UNKNOWN = 0,
	RTL_VER_01,
H
hayeswang 已提交
643 644 645 646
	RTL_VER_02,
	RTL_VER_03,
	RTL_VER_04,
	RTL_VER_05,
H
hayeswang 已提交
647
	RTL_VER_06,
H
hayeswang 已提交
648
	RTL_VER_MAX
H
hayeswang 已提交
649 650
};

H
hayeswang 已提交
651 652 653 654 655 656
enum tx_csum_stat {
	TX_CSUM_SUCCESS = 0,
	TX_CSUM_TSO,
	TX_CSUM_NONE
};

H
hayeswang 已提交
657 658 659 660
/* Maximum number of multicast addresses to filter (vs. Rx-all-multicast).
 * The RTL chips use a 64 element hash table based on the Ethernet CRC.
 */
static const int multicast_filter_limit = 32;
H
hayeswang 已提交
661
static unsigned int agg_buf_sz = 16384;
H
hayeswang 已提交
662

H
hayeswang 已提交
663
#define RTL_LIMITED_TSO_SIZE	(agg_buf_sz - sizeof(struct tx_desc) - \
H
hayeswang 已提交
664 665
				 VLAN_ETH_HLEN - VLAN_HLEN)

H
hayeswang 已提交
666 667 668
static
int get_registers(struct r8152 *tp, u16 value, u16 index, u16 size, void *data)
{
669 670 671 672 673 674 675 676
	int ret;
	void *tmp;

	tmp = kmalloc(size, GFP_KERNEL);
	if (!tmp)
		return -ENOMEM;

	ret = usb_control_msg(tp->udev, usb_rcvctrlpipe(tp->udev, 0),
H
hayeswang 已提交
677 678
			      RTL8152_REQ_GET_REGS, RTL8152_REQT_READ,
			      value, index, tmp, size, 500);
679 680 681 682 683

	memcpy(data, tmp, size);
	kfree(tmp);

	return ret;
H
hayeswang 已提交
684 685 686 687 688
}

static
int set_registers(struct r8152 *tp, u16 value, u16 index, u16 size, void *data)
{
689 690 691
	int ret;
	void *tmp;

692
	tmp = kmemdup(data, size, GFP_KERNEL);
693 694 695 696
	if (!tmp)
		return -ENOMEM;

	ret = usb_control_msg(tp->udev, usb_sndctrlpipe(tp->udev, 0),
H
hayeswang 已提交
697 698
			      RTL8152_REQ_SET_REGS, RTL8152_REQT_WRITE,
			      value, index, tmp, size, 500);
699 700

	kfree(tmp);
701

702
	return ret;
H
hayeswang 已提交
703 704 705
}

static int generic_ocp_read(struct r8152 *tp, u16 index, u16 size,
H
hayeswang 已提交
706
			    void *data, u16 type)
H
hayeswang 已提交
707
{
H
hayeswang 已提交
708 709
	u16 limit = 64;
	int ret = 0;
H
hayeswang 已提交
710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741

	if (test_bit(RTL8152_UNPLUG, &tp->flags))
		return -ENODEV;

	/* both size and indix must be 4 bytes align */
	if ((size & 3) || !size || (index & 3) || !data)
		return -EPERM;

	if ((u32)index + (u32)size > 0xffff)
		return -EPERM;

	while (size) {
		if (size > limit) {
			ret = get_registers(tp, index, type, limit, data);
			if (ret < 0)
				break;

			index += limit;
			data += limit;
			size -= limit;
		} else {
			ret = get_registers(tp, index, type, size, data);
			if (ret < 0)
				break;

			index += size;
			data += size;
			size = 0;
			break;
		}
	}

742 743 744
	if (ret == -ENODEV)
		set_bit(RTL8152_UNPLUG, &tp->flags);

H
hayeswang 已提交
745 746 747 748
	return ret;
}

static int generic_ocp_write(struct r8152 *tp, u16 index, u16 byteen,
H
hayeswang 已提交
749
			     u16 size, void *data, u16 type)
H
hayeswang 已提交
750
{
H
hayeswang 已提交
751 752 753
	int ret;
	u16 byteen_start, byteen_end, byen;
	u16 limit = 512;
H
hayeswang 已提交
754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782

	if (test_bit(RTL8152_UNPLUG, &tp->flags))
		return -ENODEV;

	/* both size and indix must be 4 bytes align */
	if ((size & 3) || !size || (index & 3) || !data)
		return -EPERM;

	if ((u32)index + (u32)size > 0xffff)
		return -EPERM;

	byteen_start = byteen & BYTE_EN_START_MASK;
	byteen_end = byteen & BYTE_EN_END_MASK;

	byen = byteen_start | (byteen_start << 4);
	ret = set_registers(tp, index, type | byen, 4, data);
	if (ret < 0)
		goto error1;

	index += 4;
	data += 4;
	size -= 4;

	if (size) {
		size -= 4;

		while (size) {
			if (size > limit) {
				ret = set_registers(tp, index,
H
hayeswang 已提交
783 784
						    type | BYTE_EN_DWORD,
						    limit, data);
H
hayeswang 已提交
785 786 787 788 789 790 791 792
				if (ret < 0)
					goto error1;

				index += limit;
				data += limit;
				size -= limit;
			} else {
				ret = set_registers(tp, index,
H
hayeswang 已提交
793 794
						    type | BYTE_EN_DWORD,
						    size, data);
H
hayeswang 已提交
795 796 797 798 799 800 801 802 803 804 805 806 807 808 809 810 811
				if (ret < 0)
					goto error1;

				index += size;
				data += size;
				size = 0;
				break;
			}
		}

		byen = byteen_end | (byteen_end >> 4);
		ret = set_registers(tp, index, type | byen, 4, data);
		if (ret < 0)
			goto error1;
	}

error1:
812 813 814
	if (ret == -ENODEV)
		set_bit(RTL8152_UNPLUG, &tp->flags);

H
hayeswang 已提交
815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843
	return ret;
}

static inline
int pla_ocp_read(struct r8152 *tp, u16 index, u16 size, void *data)
{
	return generic_ocp_read(tp, index, size, data, MCU_TYPE_PLA);
}

static inline
int pla_ocp_write(struct r8152 *tp, u16 index, u16 byteen, u16 size, void *data)
{
	return generic_ocp_write(tp, index, byteen, size, data, MCU_TYPE_PLA);
}

static inline
int usb_ocp_read(struct r8152 *tp, u16 index, u16 size, void *data)
{
	return generic_ocp_read(tp, index, size, data, MCU_TYPE_USB);
}

static inline
int usb_ocp_write(struct r8152 *tp, u16 index, u16 byteen, u16 size, void *data)
{
	return generic_ocp_write(tp, index, byteen, size, data, MCU_TYPE_USB);
}

static u32 ocp_read_dword(struct r8152 *tp, u16 type, u16 index)
{
844
	__le32 data;
H
hayeswang 已提交
845

846
	generic_ocp_read(tp, index, sizeof(data), &data, type);
H
hayeswang 已提交
847 848 849 850 851 852

	return __le32_to_cpu(data);
}

static void ocp_write_dword(struct r8152 *tp, u16 type, u16 index, u32 data)
{
853 854 855
	__le32 tmp = __cpu_to_le32(data);

	generic_ocp_write(tp, index, BYTE_EN_DWORD, sizeof(tmp), &tmp, type);
H
hayeswang 已提交
856 857 858 859 860
}

static u16 ocp_read_word(struct r8152 *tp, u16 type, u16 index)
{
	u32 data;
861
	__le32 tmp;
H
hayeswang 已提交
862 863 864 865
	u8 shift = index & 2;

	index &= ~3;

866
	generic_ocp_read(tp, index, sizeof(tmp), &tmp, type);
H
hayeswang 已提交
867

868
	data = __le32_to_cpu(tmp);
H
hayeswang 已提交
869 870 871 872 873 874 875 876
	data >>= (shift * 8);
	data &= 0xffff;

	return (u16)data;
}

static void ocp_write_word(struct r8152 *tp, u16 type, u16 index, u32 data)
{
877 878
	u32 mask = 0xffff;
	__le32 tmp;
H
hayeswang 已提交
879 880 881 882 883 884 885 886 887 888 889 890
	u16 byen = BYTE_EN_WORD;
	u8 shift = index & 2;

	data &= mask;

	if (index & 2) {
		byen <<= shift;
		mask <<= (shift * 8);
		data <<= (shift * 8);
		index &= ~3;
	}

891
	tmp = __cpu_to_le32(data);
H
hayeswang 已提交
892

893
	generic_ocp_write(tp, index, byen, sizeof(tmp), &tmp, type);
H
hayeswang 已提交
894 895 896 897 898
}

static u8 ocp_read_byte(struct r8152 *tp, u16 type, u16 index)
{
	u32 data;
899
	__le32 tmp;
H
hayeswang 已提交
900 901 902 903
	u8 shift = index & 3;

	index &= ~3;

904
	generic_ocp_read(tp, index, sizeof(tmp), &tmp, type);
H
hayeswang 已提交
905

906
	data = __le32_to_cpu(tmp);
H
hayeswang 已提交
907 908 909 910 911 912 913 914
	data >>= (shift * 8);
	data &= 0xff;

	return (u8)data;
}

static void ocp_write_byte(struct r8152 *tp, u16 type, u16 index, u32 data)
{
915 916
	u32 mask = 0xff;
	__le32 tmp;
H
hayeswang 已提交
917 918 919 920 921 922 923 924 925 926 927 928
	u16 byen = BYTE_EN_BYTE;
	u8 shift = index & 3;

	data &= mask;

	if (index & 3) {
		byen <<= shift;
		mask <<= (shift * 8);
		data <<= (shift * 8);
		index &= ~3;
	}

929
	tmp = __cpu_to_le32(data);
H
hayeswang 已提交
930

931
	generic_ocp_write(tp, index, byen, sizeof(tmp), &tmp, type);
H
hayeswang 已提交
932 933
}

934
static u16 ocp_reg_read(struct r8152 *tp, u16 addr)
935 936 937 938 939 940 941 942 943 944
{
	u16 ocp_base, ocp_index;

	ocp_base = addr & 0xf000;
	if (ocp_base != tp->ocp_base) {
		ocp_write_word(tp, MCU_TYPE_PLA, PLA_OCP_GPHY_BASE, ocp_base);
		tp->ocp_base = ocp_base;
	}

	ocp_index = (addr & 0x0fff) | 0xb000;
945
	return ocp_read_word(tp, MCU_TYPE_PLA, ocp_index);
946 947
}

948
static void ocp_reg_write(struct r8152 *tp, u16 addr, u16 data)
H
hayeswang 已提交
949
{
950
	u16 ocp_base, ocp_index;
H
hayeswang 已提交
951

952 953 954 955
	ocp_base = addr & 0xf000;
	if (ocp_base != tp->ocp_base) {
		ocp_write_word(tp, MCU_TYPE_PLA, PLA_OCP_GPHY_BASE, ocp_base);
		tp->ocp_base = ocp_base;
H
hayeswang 已提交
956
	}
957 958 959

	ocp_index = (addr & 0x0fff) | 0xb000;
	ocp_write_word(tp, MCU_TYPE_PLA, ocp_index, data);
H
hayeswang 已提交
960 961
}

962
static inline void r8152_mdio_write(struct r8152 *tp, u32 reg_addr, u32 value)
H
hayeswang 已提交
963
{
964 965
	ocp_reg_write(tp, OCP_BASE_MII + reg_addr * 2, value);
}
H
hayeswang 已提交
966

967 968 969
static inline int r8152_mdio_read(struct r8152 *tp, u32 reg_addr)
{
	return ocp_reg_read(tp, OCP_BASE_MII + reg_addr * 2);
H
hayeswang 已提交
970 971
}

H
hayeswang 已提交
972 973 974 975 976 977
static void sram_write(struct r8152 *tp, u16 addr, u16 data)
{
	ocp_reg_write(tp, OCP_SRAM_ADDR, addr);
	ocp_reg_write(tp, OCP_SRAM_DATA, data);
}

H
hayeswang 已提交
978 979 980
static int read_mii_word(struct net_device *netdev, int phy_id, int reg)
{
	struct r8152 *tp = netdev_priv(netdev);
H
hayeswang 已提交
981
	int ret;
H
hayeswang 已提交
982

H
hayeswang 已提交
983 984 985
	if (test_bit(RTL8152_UNPLUG, &tp->flags))
		return -ENODEV;

H
hayeswang 已提交
986 987 988
	if (phy_id != R8152_PHY_ID)
		return -EINVAL;

H
hayeswang 已提交
989 990 991
	ret = r8152_mdio_read(tp, reg);

	return ret;
H
hayeswang 已提交
992 993 994 995 996 997 998
}

static
void write_mii_word(struct net_device *netdev, int phy_id, int reg, int val)
{
	struct r8152 *tp = netdev_priv(netdev);

H
hayeswang 已提交
999 1000 1001
	if (test_bit(RTL8152_UNPLUG, &tp->flags))
		return;

H
hayeswang 已提交
1002 1003 1004 1005 1006 1007
	if (phy_id != R8152_PHY_ID)
		return;

	r8152_mdio_write(tp, reg, val);
}

H
hayeswang 已提交
1008 1009
static int
r8152_submit_rx(struct r8152 *tp, struct rx_agg *agg, gfp_t mem_flags);
H
hayeswang 已提交
1010

1011 1012 1013 1014
static int rtl8152_set_mac_address(struct net_device *netdev, void *p)
{
	struct r8152 *tp = netdev_priv(netdev);
	struct sockaddr *addr = p;
1015
	int ret = -EADDRNOTAVAIL;
1016 1017

	if (!is_valid_ether_addr(addr->sa_data))
1018 1019 1020 1021 1022
		goto out1;

	ret = usb_autopm_get_interface(tp->intf);
	if (ret < 0)
		goto out1;
1023

H
hayeswang 已提交
1024 1025
	mutex_lock(&tp->control);

1026 1027 1028 1029 1030 1031
	memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);

	ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CRWECR, CRWECR_CONFIG);
	pla_ocp_write(tp, PLA_IDR, BYTE_EN_SIX_BYTES, 8, addr->sa_data);
	ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CRWECR, CRWECR_NORAML);

H
hayeswang 已提交
1032 1033
	mutex_unlock(&tp->control);

1034 1035 1036
	usb_autopm_put_interface(tp->intf);
out1:
	return ret;
1037 1038
}

H
hayeswang 已提交
1039
static int set_ethernet_addr(struct r8152 *tp)
H
hayeswang 已提交
1040 1041
{
	struct net_device *dev = tp->netdev;
H
hayeswang 已提交
1042
	struct sockaddr sa;
H
hayeswang 已提交
1043
	int ret;
H
hayeswang 已提交
1044

H
hayeswang 已提交
1045
	if (tp->version == RTL_VER_01)
H
hayeswang 已提交
1046
		ret = pla_ocp_read(tp, PLA_IDR, 8, sa.sa_data);
H
hayeswang 已提交
1047
	else
H
hayeswang 已提交
1048
		ret = pla_ocp_read(tp, PLA_BACKUP, 8, sa.sa_data);
H
hayeswang 已提交
1049 1050

	if (ret < 0) {
H
hayeswang 已提交
1051 1052 1053 1054 1055 1056 1057 1058 1059
		netif_err(tp, probe, dev, "Get ether addr fail\n");
	} else if (!is_valid_ether_addr(sa.sa_data)) {
		netif_err(tp, probe, dev, "Invalid ether addr %pM\n",
			  sa.sa_data);
		eth_hw_addr_random(dev);
		ether_addr_copy(sa.sa_data, dev->dev_addr);
		ret = rtl8152_set_mac_address(dev, &sa);
		netif_info(tp, probe, dev, "Random ether addr %pM\n",
			   sa.sa_data);
H
hayeswang 已提交
1060
	} else {
H
hayeswang 已提交
1061 1062 1063 1064
		if (tp->version == RTL_VER_01)
			ether_addr_copy(dev->dev_addr, sa.sa_data);
		else
			ret = rtl8152_set_mac_address(dev, &sa);
H
hayeswang 已提交
1065
	}
H
hayeswang 已提交
1066 1067

	return ret;
H
hayeswang 已提交
1068 1069 1070 1071 1072 1073
}

static void read_bulk_callback(struct urb *urb)
{
	struct net_device *netdev;
	int status = urb->status;
H
hayeswang 已提交
1074 1075
	struct rx_agg *agg;
	struct r8152 *tp;
H
hayeswang 已提交
1076

H
hayeswang 已提交
1077 1078 1079 1080 1081
	agg = urb->context;
	if (!agg)
		return;

	tp = agg->context;
H
hayeswang 已提交
1082 1083
	if (!tp)
		return;
H
hayeswang 已提交
1084

H
hayeswang 已提交
1085 1086
	if (test_bit(RTL8152_UNPLUG, &tp->flags))
		return;
H
hayeswang 已提交
1087 1088 1089 1090

	if (!test_bit(WORK_ENABLE, &tp->flags))
		return;

H
hayeswang 已提交
1091
	netdev = tp->netdev;
H
hayeswang 已提交
1092 1093 1094

	/* When link down, the driver would cancel all bulks. */
	/* This avoid the re-submitting bulk */
H
hayeswang 已提交
1095
	if (!netif_carrier_ok(netdev))
H
hayeswang 已提交
1096 1097
		return;

H
hayeswang 已提交
1098 1099
	usb_mark_last_busy(tp->udev);

H
hayeswang 已提交
1100 1101
	switch (status) {
	case 0:
H
hayeswang 已提交
1102 1103 1104
		if (urb->actual_length < ETH_ZLEN)
			break;

1105
		spin_lock(&tp->rx_lock);
H
hayeswang 已提交
1106
		list_add_tail(&agg->list, &tp->rx_done);
1107
		spin_unlock(&tp->rx_lock);
H
hayeswang 已提交
1108
		napi_schedule(&tp->napi);
H
hayeswang 已提交
1109
		return;
H
hayeswang 已提交
1110 1111 1112
	case -ESHUTDOWN:
		set_bit(RTL8152_UNPLUG, &tp->flags);
		netif_device_detach(tp->netdev);
H
hayeswang 已提交
1113
		return;
H
hayeswang 已提交
1114 1115 1116
	case -ENOENT:
		return;	/* the urb is in unlink state */
	case -ETIME:
H
Hayes Wang 已提交
1117 1118
		if (net_ratelimit())
			netdev_warn(netdev, "maybe reset is needed?\n");
H
hayeswang 已提交
1119
		break;
H
hayeswang 已提交
1120
	default:
H
Hayes Wang 已提交
1121 1122
		if (net_ratelimit())
			netdev_warn(netdev, "Rx status %d\n", status);
H
hayeswang 已提交
1123
		break;
H
hayeswang 已提交
1124 1125
	}

H
hayeswang 已提交
1126
	r8152_submit_rx(tp, agg, GFP_ATOMIC);
H
hayeswang 已提交
1127 1128
}

H
hayeswang 已提交
1129
static void write_bulk_callback(struct urb *urb)
H
hayeswang 已提交
1130
{
H
hayeswang 已提交
1131
	struct net_device_stats *stats;
1132
	struct net_device *netdev;
H
hayeswang 已提交
1133
	struct tx_agg *agg;
H
hayeswang 已提交
1134
	struct r8152 *tp;
H
hayeswang 已提交
1135
	int status = urb->status;
H
hayeswang 已提交
1136

H
hayeswang 已提交
1137 1138
	agg = urb->context;
	if (!agg)
H
hayeswang 已提交
1139 1140
		return;

H
hayeswang 已提交
1141 1142 1143 1144
	tp = agg->context;
	if (!tp)
		return;

1145
	netdev = tp->netdev;
H
hayeswang 已提交
1146
	stats = &netdev->stats;
H
hayeswang 已提交
1147
	if (status) {
H
Hayes Wang 已提交
1148
		if (net_ratelimit())
1149
			netdev_warn(netdev, "Tx status %d\n", status);
H
hayeswang 已提交
1150
		stats->tx_errors += agg->skb_num;
H
hayeswang 已提交
1151
	} else {
H
hayeswang 已提交
1152 1153
		stats->tx_packets += agg->skb_num;
		stats->tx_bytes += agg->skb_len;
H
hayeswang 已提交
1154 1155
	}

1156
	spin_lock(&tp->tx_lock);
H
hayeswang 已提交
1157
	list_add_tail(&agg->list, &tp->tx_free);
1158
	spin_unlock(&tp->tx_lock);
H
hayeswang 已提交
1159

H
hayeswang 已提交
1160 1161
	usb_autopm_put_interface_async(tp->intf);

1162
	if (!netif_carrier_ok(netdev))
H
hayeswang 已提交
1163 1164 1165 1166 1167 1168 1169 1170 1171
		return;

	if (!test_bit(WORK_ENABLE, &tp->flags))
		return;

	if (test_bit(RTL8152_UNPLUG, &tp->flags))
		return;

	if (!skb_queue_empty(&tp->tx_queue))
H
hayeswang 已提交
1172
		napi_schedule(&tp->napi);
H
hayeswang 已提交
1173 1174
}

1175 1176 1177
static void intr_callback(struct urb *urb)
{
	struct r8152 *tp;
1178
	__le16 *d;
1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198
	int status = urb->status;
	int res;

	tp = urb->context;
	if (!tp)
		return;

	if (!test_bit(WORK_ENABLE, &tp->flags))
		return;

	if (test_bit(RTL8152_UNPLUG, &tp->flags))
		return;

	switch (status) {
	case 0:			/* success */
		break;
	case -ECONNRESET:	/* unlink */
	case -ESHUTDOWN:
		netif_device_detach(tp->netdev);
	case -ENOENT:
1199 1200 1201
	case -EPROTO:
		netif_info(tp, intr, tp->netdev,
			   "Stop submitting intr, status %d\n", status);
1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213
		return;
	case -EOVERFLOW:
		netif_info(tp, intr, tp->netdev, "intr status -EOVERFLOW\n");
		goto resubmit;
	/* -EPIPE:  should clear the halt */
	default:
		netif_info(tp, intr, tp->netdev, "intr status %d\n", status);
		goto resubmit;
	}

	d = urb->transfer_buffer;
	if (INTR_LINK & __le16_to_cpu(d[0])) {
1214
		if (!netif_carrier_ok(tp->netdev)) {
1215 1216 1217 1218
			set_bit(RTL8152_LINK_CHG, &tp->flags);
			schedule_delayed_work(&tp->schedule, 0);
		}
	} else {
1219
		if (netif_carrier_ok(tp->netdev)) {
1220 1221 1222 1223 1224 1225 1226
			set_bit(RTL8152_LINK_CHG, &tp->flags);
			schedule_delayed_work(&tp->schedule, 0);
		}
	}

resubmit:
	res = usb_submit_urb(urb, GFP_ATOMIC);
1227 1228
	if (res == -ENODEV) {
		set_bit(RTL8152_UNPLUG, &tp->flags);
1229
		netif_device_detach(tp->netdev);
1230
	} else if (res) {
1231
		netif_err(tp, intr, tp->netdev,
H
Hayes Wang 已提交
1232
			  "can't resubmit intr, status %d\n", res);
1233
	}
1234 1235
}

H
hayeswang 已提交
1236 1237
static inline void *rx_agg_align(void *data)
{
H
hayeswang 已提交
1238
	return (void *)ALIGN((uintptr_t)data, RX_ALIGN);
H
hayeswang 已提交
1239 1240 1241 1242
}

static inline void *tx_agg_align(void *data)
{
H
hayeswang 已提交
1243
	return (void *)ALIGN((uintptr_t)data, TX_ALIGN);
H
hayeswang 已提交
1244 1245 1246 1247 1248 1249 1250
}

static void free_all_mem(struct r8152 *tp)
{
	int i;

	for (i = 0; i < RTL8152_MAX_RX; i++) {
1251 1252
		usb_free_urb(tp->rx_info[i].urb);
		tp->rx_info[i].urb = NULL;
H
hayeswang 已提交
1253

1254 1255 1256
		kfree(tp->rx_info[i].buffer);
		tp->rx_info[i].buffer = NULL;
		tp->rx_info[i].head = NULL;
H
hayeswang 已提交
1257 1258 1259
	}

	for (i = 0; i < RTL8152_MAX_TX; i++) {
1260 1261
		usb_free_urb(tp->tx_info[i].urb);
		tp->tx_info[i].urb = NULL;
H
hayeswang 已提交
1262

1263 1264 1265
		kfree(tp->tx_info[i].buffer);
		tp->tx_info[i].buffer = NULL;
		tp->tx_info[i].head = NULL;
H
hayeswang 已提交
1266
	}
1267

1268 1269
	usb_free_urb(tp->intr_urb);
	tp->intr_urb = NULL;
1270

1271 1272
	kfree(tp->intr_buff);
	tp->intr_buff = NULL;
H
hayeswang 已提交
1273 1274 1275 1276 1277
}

static int alloc_all_mem(struct r8152 *tp)
{
	struct net_device *netdev = tp->netdev;
1278 1279 1280
	struct usb_interface *intf = tp->intf;
	struct usb_host_interface *alt = intf->cur_altsetting;
	struct usb_host_endpoint *ep_intr = alt->endpoint + 2;
H
hayeswang 已提交
1281 1282 1283 1284 1285 1286 1287 1288 1289 1290
	struct urb *urb;
	int node, i;
	u8 *buf;

	node = netdev->dev.parent ? dev_to_node(netdev->dev.parent) : -1;

	spin_lock_init(&tp->rx_lock);
	spin_lock_init(&tp->tx_lock);
	INIT_LIST_HEAD(&tp->tx_free);
	skb_queue_head_init(&tp->tx_queue);
H
hayeswang 已提交
1291
	skb_queue_head_init(&tp->rx_queue);
H
hayeswang 已提交
1292 1293

	for (i = 0; i < RTL8152_MAX_RX; i++) {
H
hayeswang 已提交
1294
		buf = kmalloc_node(agg_buf_sz, GFP_KERNEL, node);
H
hayeswang 已提交
1295 1296 1297 1298 1299
		if (!buf)
			goto err1;

		if (buf != rx_agg_align(buf)) {
			kfree(buf);
H
hayeswang 已提交
1300
			buf = kmalloc_node(agg_buf_sz + RX_ALIGN, GFP_KERNEL,
H
hayeswang 已提交
1301
					   node);
H
hayeswang 已提交
1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319
			if (!buf)
				goto err1;
		}

		urb = usb_alloc_urb(0, GFP_KERNEL);
		if (!urb) {
			kfree(buf);
			goto err1;
		}

		INIT_LIST_HEAD(&tp->rx_info[i].list);
		tp->rx_info[i].context = tp;
		tp->rx_info[i].urb = urb;
		tp->rx_info[i].buffer = buf;
		tp->rx_info[i].head = rx_agg_align(buf);
	}

	for (i = 0; i < RTL8152_MAX_TX; i++) {
H
hayeswang 已提交
1320
		buf = kmalloc_node(agg_buf_sz, GFP_KERNEL, node);
H
hayeswang 已提交
1321 1322 1323 1324 1325
		if (!buf)
			goto err1;

		if (buf != tx_agg_align(buf)) {
			kfree(buf);
H
hayeswang 已提交
1326
			buf = kmalloc_node(agg_buf_sz + TX_ALIGN, GFP_KERNEL,
H
hayeswang 已提交
1327
					   node);
H
hayeswang 已提交
1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346
			if (!buf)
				goto err1;
		}

		urb = usb_alloc_urb(0, GFP_KERNEL);
		if (!urb) {
			kfree(buf);
			goto err1;
		}

		INIT_LIST_HEAD(&tp->tx_info[i].list);
		tp->tx_info[i].context = tp;
		tp->tx_info[i].urb = urb;
		tp->tx_info[i].buffer = buf;
		tp->tx_info[i].head = tx_agg_align(buf);

		list_add_tail(&tp->tx_info[i].list, &tp->tx_free);
	}

1347 1348 1349 1350 1351 1352 1353 1354 1355 1356
	tp->intr_urb = usb_alloc_urb(0, GFP_KERNEL);
	if (!tp->intr_urb)
		goto err1;

	tp->intr_buff = kmalloc(INTBUFSIZE, GFP_KERNEL);
	if (!tp->intr_buff)
		goto err1;

	tp->intr_interval = (int)ep_intr->desc.bInterval;
	usb_fill_int_urb(tp->intr_urb, tp->udev, usb_rcvintpipe(tp->udev, 3),
H
hayeswang 已提交
1357 1358
			 tp->intr_buff, INTBUFSIZE, intr_callback,
			 tp, tp->intr_interval);
1359

H
hayeswang 已提交
1360 1361 1362 1363 1364 1365 1366
	return 0;

err1:
	free_all_mem(tp);
	return -ENOMEM;
}

H
hayeswang 已提交
1367 1368 1369 1370 1371
static struct tx_agg *r8152_get_tx_agg(struct r8152 *tp)
{
	struct tx_agg *agg = NULL;
	unsigned long flags;

1372 1373 1374
	if (list_empty(&tp->tx_free))
		return NULL;

H
hayeswang 已提交
1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387
	spin_lock_irqsave(&tp->tx_lock, flags);
	if (!list_empty(&tp->tx_free)) {
		struct list_head *cursor;

		cursor = tp->tx_free.next;
		list_del_init(cursor);
		agg = list_entry(cursor, struct tx_agg, list);
	}
	spin_unlock_irqrestore(&tp->tx_lock, flags);

	return agg;
}

H
hayeswang 已提交
1388
/* r8152_csum_workaround()
H
hayeswang 已提交
1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399
 * The hw limites the value the transport offset. When the offset is out of the
 * range, calculate the checksum by sw.
 */
static void r8152_csum_workaround(struct r8152 *tp, struct sk_buff *skb,
				  struct sk_buff_head *list)
{
	if (skb_shinfo(skb)->gso_size) {
		netdev_features_t features = tp->netdev->features;
		struct sk_buff_head seg_list;
		struct sk_buff *segs, *nskb;

1400
		features &= ~(NETIF_F_SG | NETIF_F_IPV6_CSUM | NETIF_F_TSO6);
H
hayeswang 已提交
1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430
		segs = skb_gso_segment(skb, features);
		if (IS_ERR(segs) || !segs)
			goto drop;

		__skb_queue_head_init(&seg_list);

		do {
			nskb = segs;
			segs = segs->next;
			nskb->next = NULL;
			__skb_queue_tail(&seg_list, nskb);
		} while (segs);

		skb_queue_splice(&seg_list, list);
		dev_kfree_skb(skb);
	} else if (skb->ip_summed == CHECKSUM_PARTIAL) {
		if (skb_checksum_help(skb) < 0)
			goto drop;

		__skb_queue_head(list, skb);
	} else {
		struct net_device_stats *stats;

drop:
		stats = &tp->netdev->stats;
		stats->tx_dropped++;
		dev_kfree_skb(skb);
	}
}

H
hayeswang 已提交
1431
/* msdn_giant_send_check()
H
hayeswang 已提交
1432 1433 1434 1435 1436 1437 1438
 * 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;
H
hayeswang 已提交
1439 1440 1441 1442 1443
	int ret;

	ret = skb_cow_head(skb, 0);
	if (ret)
		return ret;
H
hayeswang 已提交
1444 1445 1446 1447 1448 1449 1450

	ipv6h = ipv6_hdr(skb);
	th = tcp_hdr(skb);

	th->check = 0;
	th->check = ~tcp_v6_check(0, &ipv6h->saddr, &ipv6h->daddr, 0);

H
hayeswang 已提交
1451
	return ret;
H
hayeswang 已提交
1452 1453
}

H
hayeswang 已提交
1454 1455
static inline void rtl_tx_vlan_tag(struct tx_desc *desc, struct sk_buff *skb)
{
1456
	if (skb_vlan_tag_present(skb)) {
H
hayeswang 已提交
1457 1458
		u32 opts2;

1459
		opts2 = TX_VLAN_TAG | swab16(skb_vlan_tag_get(skb));
H
hayeswang 已提交
1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472
		desc->opts2 |= cpu_to_le32(opts2);
	}
}

static inline void rtl_rx_vlan_tag(struct rx_desc *desc, struct sk_buff *skb)
{
	u32 opts2 = le32_to_cpu(desc->opts2);

	if (opts2 & RX_VLAN_TAG)
		__vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q),
				       swab16(opts2 & 0xffff));
}

H
hayeswang 已提交
1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484
static int r8152_tx_csum(struct r8152 *tp, struct tx_desc *desc,
			 struct sk_buff *skb, u32 len, u32 transport_offset)
{
	u32 mss = skb_shinfo(skb)->gso_size;
	u32 opts1, opts2 = 0;
	int ret = TX_CSUM_SUCCESS;

	WARN_ON_ONCE(len > TX_LEN_MAX);

	opts1 = len | TX_FS | TX_LS;

	if (mss) {
H
hayeswang 已提交
1485 1486 1487 1488 1489 1490 1491 1492
		if (transport_offset > GTTCPHO_MAX) {
			netif_warn(tp, tx_err, tp->netdev,
				   "Invalid transport offset 0x%x for TSO\n",
				   transport_offset);
			ret = TX_CSUM_TSO;
			goto unavailable;
		}

1493
		switch (vlan_get_protocol(skb)) {
H
hayeswang 已提交
1494 1495 1496 1497
		case htons(ETH_P_IP):
			opts1 |= GTSENDV4;
			break;

H
hayeswang 已提交
1498
		case htons(ETH_P_IPV6):
H
hayeswang 已提交
1499 1500 1501 1502
			if (msdn_giant_send_check(skb)) {
				ret = TX_CSUM_TSO;
				goto unavailable;
			}
H
hayeswang 已提交
1503 1504 1505
			opts1 |= GTSENDV6;
			break;

H
hayeswang 已提交
1506 1507 1508 1509 1510 1511 1512 1513 1514
		default:
			WARN_ON_ONCE(1);
			break;
		}

		opts1 |= transport_offset << GTTCPHO_SHIFT;
		opts2 |= min(mss, MSS_MAX) << MSS_SHIFT;
	} else if (skb->ip_summed == CHECKSUM_PARTIAL) {
		u8 ip_protocol;
H
hayeswang 已提交
1515

H
hayeswang 已提交
1516 1517 1518 1519 1520 1521 1522 1523
		if (transport_offset > TCPHO_MAX) {
			netif_warn(tp, tx_err, tp->netdev,
				   "Invalid transport offset 0x%x\n",
				   transport_offset);
			ret = TX_CSUM_NONE;
			goto unavailable;
		}

1524
		switch (vlan_get_protocol(skb)) {
H
hayeswang 已提交
1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539
		case htons(ETH_P_IP):
			opts2 |= IPV4_CS;
			ip_protocol = ip_hdr(skb)->protocol;
			break;

		case htons(ETH_P_IPV6):
			opts2 |= IPV6_CS;
			ip_protocol = ipv6_hdr(skb)->nexthdr;
			break;

		default:
			ip_protocol = IPPROTO_RAW;
			break;
		}

H
hayeswang 已提交
1540
		if (ip_protocol == IPPROTO_TCP)
H
hayeswang 已提交
1541
			opts2 |= TCP_CS;
H
hayeswang 已提交
1542
		else if (ip_protocol == IPPROTO_UDP)
H
hayeswang 已提交
1543
			opts2 |= UDP_CS;
H
hayeswang 已提交
1544
		else
H
hayeswang 已提交
1545 1546
			WARN_ON_ONCE(1);

H
hayeswang 已提交
1547
		opts2 |= transport_offset << TCPHO_SHIFT;
H
hayeswang 已提交
1548
	}
H
hayeswang 已提交
1549 1550 1551 1552

	desc->opts2 = cpu_to_le32(opts2);
	desc->opts1 = cpu_to_le32(opts1);

H
hayeswang 已提交
1553
unavailable:
H
hayeswang 已提交
1554
	return ret;
H
hayeswang 已提交
1555 1556
}

H
hayeswang 已提交
1557 1558
static int r8152_tx_agg_fill(struct r8152 *tp, struct tx_agg *agg)
{
1559
	struct sk_buff_head skb_head, *tx_queue = &tp->tx_queue;
H
hayeswang 已提交
1560
	int remain, ret;
H
hayeswang 已提交
1561 1562
	u8 *tx_data;

1563
	__skb_queue_head_init(&skb_head);
1564
	spin_lock(&tx_queue->lock);
1565
	skb_queue_splice_init(tx_queue, &skb_head);
1566
	spin_unlock(&tx_queue->lock);
1567

H
hayeswang 已提交
1568
	tx_data = agg->head;
H
hayeswang 已提交
1569 1570
	agg->skb_num = 0;
	agg->skb_len = 0;
H
hayeswang 已提交
1571
	remain = agg_buf_sz;
H
hayeswang 已提交
1572

H
hayeswang 已提交
1573
	while (remain >= ETH_ZLEN + sizeof(struct tx_desc)) {
H
hayeswang 已提交
1574 1575 1576
		struct tx_desc *tx_desc;
		struct sk_buff *skb;
		unsigned int len;
H
hayeswang 已提交
1577
		u32 offset;
H
hayeswang 已提交
1578

1579
		skb = __skb_dequeue(&skb_head);
H
hayeswang 已提交
1580 1581 1582
		if (!skb)
			break;

H
hayeswang 已提交
1583 1584 1585
		len = skb->len + sizeof(*tx_desc);

		if (len > remain) {
1586
			__skb_queue_head(&skb_head, skb);
H
hayeswang 已提交
1587 1588 1589
			break;
		}

H
hayeswang 已提交
1590
		tx_data = tx_agg_align(tx_data);
H
hayeswang 已提交
1591
		tx_desc = (struct tx_desc *)tx_data;
H
hayeswang 已提交
1592 1593 1594

		offset = (u32)skb_transport_offset(skb);

H
hayeswang 已提交
1595 1596 1597 1598
		if (r8152_tx_csum(tp, tx_desc, skb, skb->len, offset)) {
			r8152_csum_workaround(tp, skb, &skb_head);
			continue;
		}
H
hayeswang 已提交
1599

H
hayeswang 已提交
1600 1601
		rtl_tx_vlan_tag(tx_desc, skb);

H
hayeswang 已提交
1602 1603
		tx_data += sizeof(*tx_desc);

H
hayeswang 已提交
1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614
		len = skb->len;
		if (skb_copy_bits(skb, 0, tx_data, len) < 0) {
			struct net_device_stats *stats = &tp->netdev->stats;

			stats->tx_dropped++;
			dev_kfree_skb_any(skb);
			tx_data -= sizeof(*tx_desc);
			continue;
		}

		tx_data += len;
H
hayeswang 已提交
1615
		agg->skb_len += len;
H
hayeswang 已提交
1616 1617
		agg->skb_num++;

H
hayeswang 已提交
1618 1619
		dev_kfree_skb_any(skb);

H
hayeswang 已提交
1620
		remain = agg_buf_sz - (int)(tx_agg_align(tx_data) - agg->head);
H
hayeswang 已提交
1621 1622
	}

1623
	if (!skb_queue_empty(&skb_head)) {
1624
		spin_lock(&tx_queue->lock);
1625
		skb_queue_splice(&skb_head, tx_queue);
1626
		spin_unlock(&tx_queue->lock);
1627 1628
	}

1629
	netif_tx_lock(tp->netdev);
1630 1631 1632 1633 1634

	if (netif_queue_stopped(tp->netdev) &&
	    skb_queue_len(&tp->tx_queue) < tp->tx_qlen)
		netif_wake_queue(tp->netdev);

1635
	netif_tx_unlock(tp->netdev);
H
hayeswang 已提交
1636

1637
	ret = usb_autopm_get_interface_async(tp->intf);
H
hayeswang 已提交
1638 1639
	if (ret < 0)
		goto out_tx_fill;
1640

H
hayeswang 已提交
1641 1642 1643 1644
	usb_fill_bulk_urb(agg->urb, tp->udev, usb_sndbulkpipe(tp->udev, 2),
			  agg->head, (int)(tx_data - (u8 *)agg->head),
			  (usb_complete_t)write_bulk_callback, agg);

1645
	ret = usb_submit_urb(agg->urb, GFP_ATOMIC);
H
hayeswang 已提交
1646
	if (ret < 0)
1647
		usb_autopm_put_interface_async(tp->intf);
H
hayeswang 已提交
1648 1649 1650

out_tx_fill:
	return ret;
H
hayeswang 已提交
1651 1652
}

H
hayeswang 已提交
1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672
static u8 r8152_rx_csum(struct r8152 *tp, struct rx_desc *rx_desc)
{
	u8 checksum = CHECKSUM_NONE;
	u32 opts2, opts3;

	if (tp->version == RTL_VER_01)
		goto return_result;

	opts2 = le32_to_cpu(rx_desc->opts2);
	opts3 = le32_to_cpu(rx_desc->opts3);

	if (opts2 & RD_IPV4_CS) {
		if (opts3 & IPF)
			checksum = CHECKSUM_NONE;
		else if ((opts2 & RD_UDP_CS) && (opts3 & UDPF))
			checksum = CHECKSUM_NONE;
		else if ((opts2 & RD_TCP_CS) && (opts3 & TCPF))
			checksum = CHECKSUM_NONE;
		else
			checksum = CHECKSUM_UNNECESSARY;
H
hayeswang 已提交
1673 1674 1675 1676 1677
	} else if (RD_IPV6_CS) {
		if ((opts2 & RD_UDP_CS) && !(opts3 & UDPF))
			checksum = CHECKSUM_UNNECESSARY;
		else if ((opts2 & RD_TCP_CS) && !(opts3 & TCPF))
			checksum = CHECKSUM_UNNECESSARY;
H
hayeswang 已提交
1678 1679 1680 1681 1682 1683
	}

return_result:
	return checksum;
}

H
hayeswang 已提交
1684
static int rx_bottom(struct r8152 *tp, int budget)
H
hayeswang 已提交
1685
{
H
hayeswang 已提交
1686
	unsigned long flags;
1687
	struct list_head *cursor, *next, rx_queue;
H
hayeswang 已提交
1688
	int ret = 0, work_done = 0;
H
hayeswang 已提交
1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706

	if (!skb_queue_empty(&tp->rx_queue)) {
		while (work_done < budget) {
			struct sk_buff *skb = __skb_dequeue(&tp->rx_queue);
			struct net_device *netdev = tp->netdev;
			struct net_device_stats *stats = &netdev->stats;
			unsigned int pkt_len;

			if (!skb)
				break;

			pkt_len = skb->len;
			napi_gro_receive(&tp->napi, skb);
			work_done++;
			stats->rx_packets++;
			stats->rx_bytes += pkt_len;
		}
	}
H
hayeswang 已提交
1707

1708
	if (list_empty(&tp->rx_done))
H
hayeswang 已提交
1709
		goto out1;
1710 1711

	INIT_LIST_HEAD(&rx_queue);
H
hayeswang 已提交
1712
	spin_lock_irqsave(&tp->rx_lock, flags);
1713 1714 1715 1716
	list_splice_init(&tp->rx_done, &rx_queue);
	spin_unlock_irqrestore(&tp->rx_lock, flags);

	list_for_each_safe(cursor, next, &rx_queue) {
1717 1718 1719 1720 1721 1722
		struct rx_desc *rx_desc;
		struct rx_agg *agg;
		int len_used = 0;
		struct urb *urb;
		u8 *rx_data;

H
hayeswang 已提交
1723 1724 1725 1726
		list_del_init(cursor);

		agg = list_entry(cursor, struct rx_agg, list);
		urb = agg->urb;
H
hayeswang 已提交
1727 1728
		if (urb->actual_length < ETH_ZLEN)
			goto submit;
H
hayeswang 已提交
1729 1730 1731

		rx_desc = agg->head;
		rx_data = agg->head;
H
hayeswang 已提交
1732
		len_used += sizeof(struct rx_desc);
H
hayeswang 已提交
1733

H
hayeswang 已提交
1734
		while (urb->actual_length > len_used) {
1735
			struct net_device *netdev = tp->netdev;
H
hayeswang 已提交
1736
			struct net_device_stats *stats = &netdev->stats;
H
hayeswang 已提交
1737
			unsigned int pkt_len;
1738 1739
			struct sk_buff *skb;

H
hayeswang 已提交
1740
			pkt_len = le32_to_cpu(rx_desc->opts1) & RX_LEN_MASK;
H
hayeswang 已提交
1741 1742 1743
			if (pkt_len < ETH_ZLEN)
				break;

H
hayeswang 已提交
1744 1745 1746 1747
			len_used += pkt_len;
			if (urb->actual_length < len_used)
				break;

H
hayeswang 已提交
1748
			pkt_len -= CRC_SIZE;
H
hayeswang 已提交
1749 1750 1751 1752 1753
			rx_data += sizeof(struct rx_desc);

			skb = netdev_alloc_skb_ip_align(netdev, pkt_len);
			if (!skb) {
				stats->rx_dropped++;
1754
				goto find_next_rx;
H
hayeswang 已提交
1755
			}
H
hayeswang 已提交
1756 1757

			skb->ip_summed = r8152_rx_csum(tp, rx_desc);
H
hayeswang 已提交
1758 1759 1760
			memcpy(skb->data, rx_data, pkt_len);
			skb_put(skb, pkt_len);
			skb->protocol = eth_type_trans(skb, netdev);
H
hayeswang 已提交
1761
			rtl_rx_vlan_tag(rx_desc, skb);
H
hayeswang 已提交
1762 1763 1764 1765 1766 1767 1768 1769
			if (work_done < budget) {
				napi_gro_receive(&tp->napi, skb);
				work_done++;
				stats->rx_packets++;
				stats->rx_bytes += pkt_len;
			} else {
				__skb_queue_tail(&tp->rx_queue, skb);
			}
H
hayeswang 已提交
1770

1771
find_next_rx:
H
hayeswang 已提交
1772
			rx_data = rx_agg_align(rx_data + pkt_len + CRC_SIZE);
H
hayeswang 已提交
1773 1774
			rx_desc = (struct rx_desc *)rx_data;
			len_used = (int)(rx_data - (u8 *)agg->head);
H
hayeswang 已提交
1775
			len_used += sizeof(struct rx_desc);
H
hayeswang 已提交
1776 1777
		}

H
hayeswang 已提交
1778
submit:
H
hayeswang 已提交
1779 1780 1781 1782 1783 1784 1785 1786 1787 1788 1789 1790
		if (!ret) {
			ret = r8152_submit_rx(tp, agg, GFP_ATOMIC);
		} else {
			urb->actual_length = 0;
			list_add_tail(&agg->list, next);
		}
	}

	if (!list_empty(&rx_queue)) {
		spin_lock_irqsave(&tp->rx_lock, flags);
		list_splice_tail(&rx_queue, &tp->rx_done);
		spin_unlock_irqrestore(&tp->rx_lock, flags);
H
hayeswang 已提交
1791
	}
H
hayeswang 已提交
1792 1793 1794

out1:
	return work_done;
H
hayeswang 已提交
1795 1796 1797 1798 1799 1800
}

static void tx_bottom(struct r8152 *tp)
{
	int res;

H
hayeswang 已提交
1801 1802
	do {
		struct tx_agg *agg;
H
hayeswang 已提交
1803

H
hayeswang 已提交
1804
		if (skb_queue_empty(&tp->tx_queue))
H
hayeswang 已提交
1805 1806
			break;

H
hayeswang 已提交
1807 1808
		agg = r8152_get_tx_agg(tp);
		if (!agg)
H
hayeswang 已提交
1809 1810
			break;

H
hayeswang 已提交
1811 1812
		res = r8152_tx_agg_fill(tp, agg);
		if (res) {
H
hayeswang 已提交
1813
			struct net_device *netdev = tp->netdev;
H
hayeswang 已提交
1814

H
hayeswang 已提交
1815
			if (res == -ENODEV) {
1816
				set_bit(RTL8152_UNPLUG, &tp->flags);
H
hayeswang 已提交
1817 1818
				netif_device_detach(netdev);
			} else {
H
hayeswang 已提交
1819 1820 1821
				struct net_device_stats *stats = &netdev->stats;
				unsigned long flags;

H
hayeswang 已提交
1822 1823 1824
				netif_warn(tp, tx_err, netdev,
					   "failed tx_urb %d\n", res);
				stats->tx_dropped += agg->skb_num;
1825

H
hayeswang 已提交
1826 1827 1828 1829
				spin_lock_irqsave(&tp->tx_lock, flags);
				list_add_tail(&agg->list, &tp->tx_free);
				spin_unlock_irqrestore(&tp->tx_lock, flags);
			}
H
hayeswang 已提交
1830
		}
H
hayeswang 已提交
1831
	} while (res == 0);
H
hayeswang 已提交
1832 1833
}

H
hayeswang 已提交
1834
static void bottom_half(struct r8152 *tp)
H
hayeswang 已提交
1835
{
H
hayeswang 已提交
1836 1837 1838 1839
	if (test_bit(RTL8152_UNPLUG, &tp->flags))
		return;

	if (!test_bit(WORK_ENABLE, &tp->flags))
H
hayeswang 已提交
1840
		return;
H
hayeswang 已提交
1841

H
hayeswang 已提交
1842 1843
	/* When link down, the driver would cancel all bulks. */
	/* This avoid the re-submitting bulk */
H
hayeswang 已提交
1844
	if (!netif_carrier_ok(tp->netdev))
H
hayeswang 已提交
1845
		return;
H
hayeswang 已提交
1846

H
hayeswang 已提交
1847
	clear_bit(SCHEDULE_NAPI, &tp->flags);
1848

1849
	tx_bottom(tp);
H
hayeswang 已提交
1850 1851
}

H
hayeswang 已提交
1852 1853 1854 1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868
static int r8152_poll(struct napi_struct *napi, int budget)
{
	struct r8152 *tp = container_of(napi, struct r8152, napi);
	int work_done;

	work_done = rx_bottom(tp, budget);
	bottom_half(tp);

	if (work_done < budget) {
		napi_complete(napi);
		if (!list_empty(&tp->rx_done))
			napi_schedule(napi);
	}

	return work_done;
}

H
hayeswang 已提交
1869 1870 1871
static
int r8152_submit_rx(struct r8152 *tp, struct rx_agg *agg, gfp_t mem_flags)
{
H
hayeswang 已提交
1872 1873
	int ret;

1874 1875 1876 1877 1878
	/* The rx would be stopped, so skip submitting */
	if (test_bit(RTL8152_UNPLUG, &tp->flags) ||
	    !test_bit(WORK_ENABLE, &tp->flags) || !netif_carrier_ok(tp->netdev))
		return 0;

H
hayeswang 已提交
1879
	usb_fill_bulk_urb(agg->urb, tp->udev, usb_rcvbulkpipe(tp->udev, 1),
H
hayeswang 已提交
1880
			  agg->head, agg_buf_sz,
H
hayeswang 已提交
1881
			  (usb_complete_t)read_bulk_callback, agg);
H
hayeswang 已提交
1882

H
hayeswang 已提交
1883 1884 1885 1886 1887 1888 1889 1890 1891 1892 1893 1894
	ret = usb_submit_urb(agg->urb, mem_flags);
	if (ret == -ENODEV) {
		set_bit(RTL8152_UNPLUG, &tp->flags);
		netif_device_detach(tp->netdev);
	} else if (ret) {
		struct urb *urb = agg->urb;
		unsigned long flags;

		urb->actual_length = 0;
		spin_lock_irqsave(&tp->rx_lock, flags);
		list_add_tail(&agg->list, &tp->rx_done);
		spin_unlock_irqrestore(&tp->rx_lock, flags);
H
hayeswang 已提交
1895 1896 1897 1898 1899

		netif_err(tp, rx_err, tp->netdev,
			  "Couldn't submit rx[%p], ret = %d\n", agg, ret);

		napi_schedule(&tp->napi);
H
hayeswang 已提交
1900 1901 1902
	}

	return ret;
H
hayeswang 已提交
1903 1904
}

H
hayeswang 已提交
1905 1906 1907
static void rtl_drop_queued_tx(struct r8152 *tp)
{
	struct net_device_stats *stats = &tp->netdev->stats;
1908
	struct sk_buff_head skb_head, *tx_queue = &tp->tx_queue;
H
hayeswang 已提交
1909 1910
	struct sk_buff *skb;

1911 1912 1913 1914
	if (skb_queue_empty(tx_queue))
		return;

	__skb_queue_head_init(&skb_head);
1915
	spin_lock_bh(&tx_queue->lock);
1916
	skb_queue_splice_init(tx_queue, &skb_head);
1917
	spin_unlock_bh(&tx_queue->lock);
1918 1919

	while ((skb = __skb_dequeue(&skb_head))) {
H
hayeswang 已提交
1920 1921 1922 1923 1924
		dev_kfree_skb(skb);
		stats->tx_dropped++;
	}
}

H
hayeswang 已提交
1925 1926 1927
static void rtl8152_tx_timeout(struct net_device *netdev)
{
	struct r8152 *tp = netdev_priv(netdev);
H
hayeswang 已提交
1928

H
Hayes Wang 已提交
1929
	netif_warn(tp, tx_err, netdev, "Tx timeout\n");
H
hayeswang 已提交
1930 1931

	usb_queue_reset_device(tp->intf);
H
hayeswang 已提交
1932 1933 1934 1935 1936 1937
}

static void rtl8152_set_rx_mode(struct net_device *netdev)
{
	struct r8152 *tp = netdev_priv(netdev);

1938
	if (netif_carrier_ok(netdev)) {
H
hayeswang 已提交
1939
		set_bit(RTL8152_SET_RX_MODE, &tp->flags);
1940 1941
		schedule_delayed_work(&tp->schedule, 0);
	}
H
hayeswang 已提交
1942 1943 1944 1945 1946
}

static void _rtl8152_set_rx_mode(struct net_device *netdev)
{
	struct r8152 *tp = netdev_priv(netdev);
1947 1948
	u32 mc_filter[2];	/* Multicast hash filter */
	__le32 tmp[2];
H
hayeswang 已提交
1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959
	u32 ocp_data;

	netif_stop_queue(netdev);
	ocp_data = ocp_read_dword(tp, MCU_TYPE_PLA, PLA_RCR);
	ocp_data &= ~RCR_ACPT_ALL;
	ocp_data |= RCR_AB | RCR_APM;

	if (netdev->flags & IFF_PROMISC) {
		/* Unconditionally log net taps. */
		netif_notice(tp, link, netdev, "Promiscuous mode enabled\n");
		ocp_data |= RCR_AM | RCR_AAP;
H
hayeswang 已提交
1960 1961
		mc_filter[1] = 0xffffffff;
		mc_filter[0] = 0xffffffff;
H
hayeswang 已提交
1962 1963 1964 1965
	} else if ((netdev_mc_count(netdev) > multicast_filter_limit) ||
		   (netdev->flags & IFF_ALLMULTI)) {
		/* Too many to filter perfectly -- accept all multicasts. */
		ocp_data |= RCR_AM;
H
hayeswang 已提交
1966 1967
		mc_filter[1] = 0xffffffff;
		mc_filter[0] = 0xffffffff;
H
hayeswang 已提交
1968 1969 1970
	} else {
		struct netdev_hw_addr *ha;

H
hayeswang 已提交
1971 1972
		mc_filter[1] = 0;
		mc_filter[0] = 0;
H
hayeswang 已提交
1973 1974
		netdev_for_each_mc_addr(ha, netdev) {
			int bit_nr = ether_crc(ETH_ALEN, ha->addr) >> 26;
H
hayeswang 已提交
1975

H
hayeswang 已提交
1976 1977 1978 1979 1980
			mc_filter[bit_nr >> 5] |= 1 << (bit_nr & 31);
			ocp_data |= RCR_AM;
		}
	}

1981 1982
	tmp[0] = __cpu_to_le32(swab32(mc_filter[1]));
	tmp[1] = __cpu_to_le32(swab32(mc_filter[0]));
H
hayeswang 已提交
1983

1984
	pla_ocp_write(tp, PLA_MAR, BYTE_EN_DWORD, sizeof(tmp), tmp);
H
hayeswang 已提交
1985 1986 1987 1988
	ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RCR, ocp_data);
	netif_wake_queue(netdev);
}

H
hayeswang 已提交
1989 1990 1991 1992 1993 1994 1995 1996 1997
static netdev_features_t
rtl8152_features_check(struct sk_buff *skb, struct net_device *dev,
		       netdev_features_t features)
{
	u32 mss = skb_shinfo(skb)->gso_size;
	int max_offset = mss ? GTTCPHO_MAX : TCPHO_MAX;
	int offset = skb_transport_offset(skb);

	if ((mss || skb->ip_summed == CHECKSUM_PARTIAL) && offset > max_offset)
1998
		features &= ~(NETIF_F_CSUM_MASK | NETIF_F_GSO_MASK);
H
hayeswang 已提交
1999 2000 2001 2002 2003 2004
	else if ((skb->len + sizeof(struct tx_desc)) > agg_buf_sz)
		features &= ~NETIF_F_GSO_MASK;

	return features;
}

H
hayeswang 已提交
2005
static netdev_tx_t rtl8152_start_xmit(struct sk_buff *skb,
H
hayeswang 已提交
2006
				      struct net_device *netdev)
H
hayeswang 已提交
2007 2008 2009
{
	struct r8152 *tp = netdev_priv(netdev);

H
hayeswang 已提交
2010
	skb_tx_timestamp(skb);
H
hayeswang 已提交
2011

H
hayeswang 已提交
2012
	skb_queue_tail(&tp->tx_queue, skb);
H
hayeswang 已提交
2013

2014 2015
	if (!list_empty(&tp->tx_free)) {
		if (test_bit(SELECTIVE_SUSPEND, &tp->flags)) {
H
hayeswang 已提交
2016
			set_bit(SCHEDULE_NAPI, &tp->flags);
2017 2018 2019
			schedule_delayed_work(&tp->schedule, 0);
		} else {
			usb_mark_last_busy(tp->udev);
H
hayeswang 已提交
2020
			napi_schedule(&tp->napi);
2021
		}
H
hayeswang 已提交
2022
	} else if (skb_queue_len(&tp->tx_queue) > tp->tx_qlen) {
2023
		netif_stop_queue(netdev);
H
hayeswang 已提交
2024
	}
2025

H
hayeswang 已提交
2026 2027 2028 2029 2030 2031 2032 2033 2034 2035 2036 2037 2038 2039 2040 2041 2042 2043 2044 2045 2046 2047 2048
	return NETDEV_TX_OK;
}

static void r8152b_reset_packet_filter(struct r8152 *tp)
{
	u32	ocp_data;

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_FMC);
	ocp_data &= ~FMC_FCR_MCU_EN;
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_FMC, ocp_data);
	ocp_data |= FMC_FCR_MCU_EN;
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_FMC, ocp_data);
}

static void rtl8152_nic_reset(struct r8152 *tp)
{
	int	i;

	ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CR, CR_RST);

	for (i = 0; i < 1000; i++) {
		if (!(ocp_read_byte(tp, MCU_TYPE_PLA, PLA_CR) & CR_RST))
			break;
H
hayeswang 已提交
2049
		usleep_range(100, 400);
H
hayeswang 已提交
2050 2051 2052
	}
}

2053 2054 2055 2056
static void set_tx_qlen(struct r8152 *tp)
{
	struct net_device *netdev = tp->netdev;

H
hayeswang 已提交
2057 2058
	tp->tx_qlen = agg_buf_sz / (netdev->mtu + VLAN_ETH_HLEN + VLAN_HLEN +
				    sizeof(struct tx_desc));
2059 2060
}

H
hayeswang 已提交
2061 2062 2063 2064 2065
static inline u8 rtl8152_get_speed(struct r8152 *tp)
{
	return ocp_read_byte(tp, MCU_TYPE_PLA, PLA_PHYSTATUS);
}

H
hayeswang 已提交
2066
static void rtl_set_eee_plus(struct r8152 *tp)
H
hayeswang 已提交
2067
{
H
hayeswang 已提交
2068
	u32 ocp_data;
H
hayeswang 已提交
2069 2070 2071
	u8 speed;

	speed = rtl8152_get_speed(tp);
H
hayeswang 已提交
2072
	if (speed & _10bps) {
H
hayeswang 已提交
2073
		ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_EEEP_CR);
H
hayeswang 已提交
2074
		ocp_data |= EEEP_CR_EEEP_TX;
H
hayeswang 已提交
2075 2076 2077
		ocp_write_word(tp, MCU_TYPE_PLA, PLA_EEEP_CR, ocp_data);
	} else {
		ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_EEEP_CR);
H
hayeswang 已提交
2078
		ocp_data &= ~EEEP_CR_EEEP_TX;
H
hayeswang 已提交
2079 2080
		ocp_write_word(tp, MCU_TYPE_PLA, PLA_EEEP_CR, ocp_data);
	}
H
hayeswang 已提交
2081 2082
}

H
hayeswang 已提交
2083 2084 2085 2086 2087 2088 2089 2090 2091 2092 2093 2094
static void rxdy_gated_en(struct r8152 *tp, bool enable)
{
	u32 ocp_data;

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_MISC_1);
	if (enable)
		ocp_data |= RXDY_GATED_EN;
	else
		ocp_data &= ~RXDY_GATED_EN;
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_MISC_1, ocp_data);
}

2095 2096 2097 2098 2099 2100 2101 2102 2103 2104 2105 2106
static int rtl_start_rx(struct r8152 *tp)
{
	int i, ret = 0;

	INIT_LIST_HEAD(&tp->rx_done);
	for (i = 0; i < RTL8152_MAX_RX; i++) {
		INIT_LIST_HEAD(&tp->rx_info[i].list);
		ret = r8152_submit_rx(tp, &tp->rx_info[i], GFP_KERNEL);
		if (ret)
			break;
	}

H
hayeswang 已提交
2107 2108 2109 2110 2111 2112 2113 2114 2115 2116 2117 2118 2119 2120 2121 2122 2123 2124 2125
	if (ret && ++i < RTL8152_MAX_RX) {
		struct list_head rx_queue;
		unsigned long flags;

		INIT_LIST_HEAD(&rx_queue);

		do {
			struct rx_agg *agg = &tp->rx_info[i++];
			struct urb *urb = agg->urb;

			urb->actual_length = 0;
			list_add_tail(&agg->list, &rx_queue);
		} while (i < RTL8152_MAX_RX);

		spin_lock_irqsave(&tp->rx_lock, flags);
		list_splice_tail(&rx_queue, &tp->rx_done);
		spin_unlock_irqrestore(&tp->rx_lock, flags);
	}

2126 2127 2128 2129 2130 2131 2132 2133 2134 2135
	return ret;
}

static int rtl_stop_rx(struct r8152 *tp)
{
	int i;

	for (i = 0; i < RTL8152_MAX_RX; i++)
		usb_kill_urb(tp->rx_info[i].urb);

H
hayeswang 已提交
2136 2137 2138
	while (!skb_queue_empty(&tp->rx_queue))
		dev_kfree_skb(__skb_dequeue(&tp->rx_queue));

2139 2140 2141
	return 0;
}

H
hayeswang 已提交
2142 2143 2144
static int rtl_enable(struct r8152 *tp)
{
	u32 ocp_data;
H
hayeswang 已提交
2145 2146 2147 2148 2149 2150 2151

	r8152b_reset_packet_filter(tp);

	ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_CR);
	ocp_data |= CR_RE | CR_TE;
	ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CR, ocp_data);

H
hayeswang 已提交
2152
	rxdy_gated_en(tp, false);
H
hayeswang 已提交
2153

2154
	return 0;
H
hayeswang 已提交
2155 2156
}

H
hayeswang 已提交
2157 2158
static int rtl8152_enable(struct r8152 *tp)
{
H
hayeswang 已提交
2159 2160 2161
	if (test_bit(RTL8152_UNPLUG, &tp->flags))
		return -ENODEV;

H
hayeswang 已提交
2162 2163 2164 2165 2166 2167
	set_tx_qlen(tp);
	rtl_set_eee_plus(tp);

	return rtl_enable(tp);
}

H
hayeswang 已提交
2168
static void r8153_set_rx_early_timeout(struct r8152 *tp)
H
hayeswang 已提交
2169
{
H
hayeswang 已提交
2170
	u32 ocp_data = tp->coalesce / 8;
H
hayeswang 已提交
2171

H
hayeswang 已提交
2172 2173 2174 2175 2176 2177
	ocp_write_word(tp, MCU_TYPE_USB, USB_RX_EARLY_TIMEOUT, ocp_data);
}

static void r8153_set_rx_early_size(struct r8152 *tp)
{
	u32 mtu = tp->netdev->mtu;
H
hayeswang 已提交
2178
	u32 ocp_data = (agg_buf_sz - mtu - VLAN_ETH_HLEN - VLAN_HLEN) / 8;
H
hayeswang 已提交
2179 2180

	ocp_write_word(tp, MCU_TYPE_USB, USB_RX_EARLY_SIZE, ocp_data);
H
hayeswang 已提交
2181 2182 2183 2184
}

static int rtl8153_enable(struct r8152 *tp)
{
H
hayeswang 已提交
2185 2186 2187
	if (test_bit(RTL8152_UNPLUG, &tp->flags))
		return -ENODEV;

H
hayeswang 已提交
2188
	usb_disable_lpm(tp->udev);
H
hayeswang 已提交
2189 2190
	set_tx_qlen(tp);
	rtl_set_eee_plus(tp);
H
hayeswang 已提交
2191 2192
	r8153_set_rx_early_timeout(tp);
	r8153_set_rx_early_size(tp);
H
hayeswang 已提交
2193 2194 2195 2196

	return rtl_enable(tp);
}

H
hayeswang 已提交
2197
static void rtl_disable(struct r8152 *tp)
H
hayeswang 已提交
2198
{
H
hayeswang 已提交
2199 2200
	u32 ocp_data;
	int i;
H
hayeswang 已提交
2201

H
hayeswang 已提交
2202 2203 2204 2205 2206
	if (test_bit(RTL8152_UNPLUG, &tp->flags)) {
		rtl_drop_queued_tx(tp);
		return;
	}

H
hayeswang 已提交
2207 2208 2209 2210
	ocp_data = ocp_read_dword(tp, MCU_TYPE_PLA, PLA_RCR);
	ocp_data &= ~RCR_ACPT_ALL;
	ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RCR, ocp_data);

H
hayeswang 已提交
2211
	rtl_drop_queued_tx(tp);
H
hayeswang 已提交
2212 2213 2214

	for (i = 0; i < RTL8152_MAX_TX; i++)
		usb_kill_urb(tp->tx_info[i].urb);
H
hayeswang 已提交
2215

H
hayeswang 已提交
2216
	rxdy_gated_en(tp, true);
H
hayeswang 已提交
2217 2218 2219 2220 2221

	for (i = 0; i < 1000; i++) {
		ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL);
		if ((ocp_data & FIFO_EMPTY) == FIFO_EMPTY)
			break;
H
hayeswang 已提交
2222
		usleep_range(1000, 2000);
H
hayeswang 已提交
2223 2224 2225 2226 2227
	}

	for (i = 0; i < 1000; i++) {
		if (ocp_read_word(tp, MCU_TYPE_PLA, PLA_TCR0) & TCR0_TX_EMPTY)
			break;
H
hayeswang 已提交
2228
		usleep_range(1000, 2000);
H
hayeswang 已提交
2229 2230
	}

2231
	rtl_stop_rx(tp);
H
hayeswang 已提交
2232 2233 2234 2235

	rtl8152_nic_reset(tp);
}

H
hayeswang 已提交
2236 2237 2238 2239 2240 2241 2242 2243 2244 2245 2246 2247 2248 2249 2250 2251
static void r8152_power_cut_en(struct r8152 *tp, bool enable)
{
	u32 ocp_data;

	ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_UPS_CTRL);
	if (enable)
		ocp_data |= POWER_CUT;
	else
		ocp_data &= ~POWER_CUT;
	ocp_write_word(tp, MCU_TYPE_USB, USB_UPS_CTRL, ocp_data);

	ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_PM_CTRL_STATUS);
	ocp_data &= ~RESUME_INDICATE;
	ocp_write_word(tp, MCU_TYPE_USB, USB_PM_CTRL_STATUS, ocp_data);
}

H
hayeswang 已提交
2252 2253 2254 2255 2256 2257 2258 2259 2260 2261 2262 2263 2264 2265 2266 2267 2268
static void rtl_rx_vlan_en(struct r8152 *tp, bool enable)
{
	u32 ocp_data;

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_CPCR);
	if (enable)
		ocp_data |= CPCR_RX_VLAN;
	else
		ocp_data &= ~CPCR_RX_VLAN;
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_CPCR, ocp_data);
}

static int rtl8152_set_features(struct net_device *dev,
				netdev_features_t features)
{
	netdev_features_t changed = features ^ dev->features;
	struct r8152 *tp = netdev_priv(dev);
2269 2270 2271 2272 2273
	int ret;

	ret = usb_autopm_get_interface(tp->intf);
	if (ret < 0)
		goto out;
H
hayeswang 已提交
2274

H
hayeswang 已提交
2275 2276
	mutex_lock(&tp->control);

H
hayeswang 已提交
2277 2278 2279 2280 2281 2282 2283
	if (changed & NETIF_F_HW_VLAN_CTAG_RX) {
		if (features & NETIF_F_HW_VLAN_CTAG_RX)
			rtl_rx_vlan_en(tp, true);
		else
			rtl_rx_vlan_en(tp, false);
	}

H
hayeswang 已提交
2284 2285
	mutex_unlock(&tp->control);

2286 2287 2288 2289
	usb_autopm_put_interface(tp->intf);

out:
	return ret;
H
hayeswang 已提交
2290 2291
}

H
hayeswang 已提交
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
#define WAKE_ANY (WAKE_PHY | WAKE_MAGIC | WAKE_UCAST | WAKE_BCAST | WAKE_MCAST)

static u32 __rtl_get_wol(struct r8152 *tp)
{
	u32 ocp_data;
	u32 wolopts = 0;

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_CONFIG34);
	if (ocp_data & LINK_ON_WAKE_EN)
		wolopts |= WAKE_PHY;

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_CONFIG5);
	if (ocp_data & UWF_EN)
		wolopts |= WAKE_UCAST;
	if (ocp_data & BWF_EN)
		wolopts |= WAKE_BCAST;
	if (ocp_data & MWF_EN)
		wolopts |= WAKE_MCAST;

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_CFG_WOL);
	if (ocp_data & MAGIC_EN)
		wolopts |= WAKE_MAGIC;

	return wolopts;
}

static void __rtl_set_wol(struct r8152 *tp, u32 wolopts)
{
	u32 ocp_data;

	ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CRWECR, CRWECR_CONFIG);

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_CONFIG34);
	ocp_data &= ~LINK_ON_WAKE_EN;
	if (wolopts & WAKE_PHY)
		ocp_data |= LINK_ON_WAKE_EN;
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_CONFIG34, ocp_data);

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_CONFIG5);
2331
	ocp_data &= ~(UWF_EN | BWF_EN | MWF_EN);
H
hayeswang 已提交
2332 2333 2334 2335 2336 2337 2338 2339 2340 2341 2342 2343 2344 2345 2346 2347 2348 2349 2350 2351 2352 2353
	if (wolopts & WAKE_UCAST)
		ocp_data |= UWF_EN;
	if (wolopts & WAKE_BCAST)
		ocp_data |= BWF_EN;
	if (wolopts & WAKE_MCAST)
		ocp_data |= MWF_EN;
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_CONFIG5, ocp_data);

	ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CRWECR, CRWECR_NORAML);

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_CFG_WOL);
	ocp_data &= ~MAGIC_EN;
	if (wolopts & WAKE_MAGIC)
		ocp_data |= MAGIC_EN;
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_CFG_WOL, ocp_data);

	if (wolopts & WAKE_ANY)
		device_set_wakeup_enable(&tp->udev->dev, true);
	else
		device_set_wakeup_enable(&tp->udev->dev, false);
}

H
hayeswang 已提交
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 2390 2391 2392 2393
static void r8153_u1u2en(struct r8152 *tp, bool enable)
{
	u8 u1u2[8];

	if (enable)
		memset(u1u2, 0xff, sizeof(u1u2));
	else
		memset(u1u2, 0x00, sizeof(u1u2));

	usb_ocp_write(tp, USB_TOLERANCE, BYTE_EN_SIX_BYTES, sizeof(u1u2), u1u2);
}

static void r8153_u2p3en(struct r8152 *tp, bool enable)
{
	u32 ocp_data;

	ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_U2P3_CTRL);
	if (enable && tp->version != RTL_VER_03 && tp->version != RTL_VER_04)
		ocp_data |= U2P3_ENABLE;
	else
		ocp_data &= ~U2P3_ENABLE;
	ocp_write_word(tp, MCU_TYPE_USB, USB_U2P3_CTRL, ocp_data);
}

static void r8153_power_cut_en(struct r8152 *tp, bool enable)
{
	u32 ocp_data;

	ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_POWER_CUT);
	if (enable)
		ocp_data |= PWR_EN | PHASE2_EN;
	else
		ocp_data &= ~(PWR_EN | PHASE2_EN);
	ocp_write_word(tp, MCU_TYPE_USB, USB_POWER_CUT, ocp_data);

	ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_MISC_0);
	ocp_data &= ~PCUT_STATUS;
	ocp_write_word(tp, MCU_TYPE_USB, USB_MISC_0, ocp_data);
}

H
hayeswang 已提交
2394 2395 2396 2397 2398 2399 2400
static bool rtl_can_wakeup(struct r8152 *tp)
{
	struct usb_device *udev = tp->udev;

	return (udev->actconfig->desc.bmAttributes & USB_CONFIG_ATT_WAKEUP);
}

H
hayeswang 已提交
2401 2402 2403 2404 2405 2406 2407 2408 2409 2410 2411 2412 2413 2414 2415
static void rtl_runtime_suspend_enable(struct r8152 *tp, bool enable)
{
	if (enable) {
		u32 ocp_data;

		__rtl_set_wol(tp, WAKE_ANY);

		ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CRWECR, CRWECR_CONFIG);

		ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_CONFIG34);
		ocp_data |= LINK_OFF_WAKE_EN;
		ocp_write_word(tp, MCU_TYPE_PLA, PLA_CONFIG34, ocp_data);

		ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CRWECR, CRWECR_NORAML);
	} else {
2416 2417
		u32 ocp_data;

H
hayeswang 已提交
2418
		__rtl_set_wol(tp, tp->saved_wolopts);
2419 2420 2421 2422 2423 2424 2425 2426

		ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CRWECR, CRWECR_CONFIG);

		ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_CONFIG34);
		ocp_data &= ~LINK_OFF_WAKE_EN;
		ocp_write_word(tp, MCU_TYPE_PLA, PLA_CONFIG34, ocp_data);

		ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CRWECR, CRWECR_NORAML);
2427 2428
	}
}
2429

2430 2431 2432 2433 2434 2435 2436 2437
static void rtl8153_runtime_enable(struct r8152 *tp, bool enable)
{
	rtl_runtime_suspend_enable(tp, enable);

	if (enable) {
		r8153_u1u2en(tp, false);
		r8153_u2p3en(tp, false);
	} else {
H
hayeswang 已提交
2438 2439
		r8153_u2p3en(tp, true);
		r8153_u1u2en(tp, true);
H
hayeswang 已提交
2440 2441 2442
	}
}

2443 2444 2445 2446 2447 2448 2449 2450 2451 2452 2453 2454 2455 2456 2457 2458 2459 2460 2461 2462 2463
static void rtl_phy_reset(struct r8152 *tp)
{
	u16 data;
	int i;

	data = r8152_mdio_read(tp, MII_BMCR);

	/* don't reset again before the previous one complete */
	if (data & BMCR_RESET)
		return;

	data |= BMCR_RESET;
	r8152_mdio_write(tp, MII_BMCR, data);

	for (i = 0; i < 50; i++) {
		msleep(20);
		if ((r8152_mdio_read(tp, MII_BMCR) & BMCR_RESET) == 0)
			break;
	}
}

H
hayeswang 已提交
2464 2465 2466 2467 2468 2469 2470 2471 2472 2473 2474 2475 2476
static void r8153_teredo_off(struct r8152 *tp)
{
	u32 ocp_data;

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_TEREDO_CFG);
	ocp_data &= ~(TEREDO_SEL | TEREDO_RS_EVENT_MASK | OOB_TEREDO_EN);
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_TEREDO_CFG, ocp_data);

	ocp_write_word(tp, MCU_TYPE_PLA, PLA_WDT6_CTRL, WDT6_SET_MODE);
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_REALWOW_TIMER, 0);
	ocp_write_dword(tp, MCU_TYPE_PLA, PLA_TEREDO_TIMER, 0);
}

H
hayeswang 已提交
2477 2478 2479 2480 2481 2482 2483 2484 2485 2486 2487
static void rtl_reset_bmu(struct r8152 *tp)
{
	u32 ocp_data;

	ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_BMU_RESET);
	ocp_data &= ~(BMU_RESET_EP_IN | BMU_RESET_EP_OUT);
	ocp_write_byte(tp, MCU_TYPE_USB, USB_BMU_RESET, ocp_data);
	ocp_data |= BMU_RESET_EP_IN | BMU_RESET_EP_OUT;
	ocp_write_byte(tp, MCU_TYPE_USB, USB_BMU_RESET, ocp_data);
}

H
hayeswang 已提交
2488
static void r8152_aldps_en(struct r8152 *tp, bool enable)
H
hayeswang 已提交
2489
{
H
hayeswang 已提交
2490 2491 2492 2493 2494 2495 2496 2497
	if (enable) {
		ocp_reg_write(tp, OCP_ALDPS_CONFIG, ENPWRSAVE | ENPDNPS |
						    LINKENA | DIS_SDSAVE);
	} else {
		ocp_reg_write(tp, OCP_ALDPS_CONFIG, ENPDNPS | LINKENA |
						    DIS_SDSAVE);
		msleep(20);
	}
H
hayeswang 已提交
2498 2499
}

H
hayeswang 已提交
2500 2501
static void rtl8152_disable(struct r8152 *tp)
{
H
hayeswang 已提交
2502
	r8152_aldps_en(tp, false);
H
hayeswang 已提交
2503
	rtl_disable(tp);
H
hayeswang 已提交
2504
	r8152_aldps_en(tp, true);
H
hayeswang 已提交
2505 2506
}

H
hayeswang 已提交
2507 2508
static void r8152b_hw_phy_cfg(struct r8152 *tp)
{
H
hayeswang 已提交
2509 2510 2511 2512 2513 2514 2515 2516
	u16 data;

	data = r8152_mdio_read(tp, MII_BMCR);
	if (data & BMCR_PDOWN) {
		data &= ~BMCR_PDOWN;
		r8152_mdio_write(tp, MII_BMCR, data);
	}

2517
	set_bit(PHY_RESET, &tp->flags);
H
hayeswang 已提交
2518 2519
}

H
hayeswang 已提交
2520 2521
static void r8152b_exit_oob(struct r8152 *tp)
{
2522 2523
	u32 ocp_data;
	int i;
H
hayeswang 已提交
2524 2525 2526 2527 2528

	ocp_data = ocp_read_dword(tp, MCU_TYPE_PLA, PLA_RCR);
	ocp_data &= ~RCR_ACPT_ALL;
	ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RCR, ocp_data);

H
hayeswang 已提交
2529
	rxdy_gated_en(tp, true);
H
hayeswang 已提交
2530
	r8153_teredo_off(tp);
2531
	r8152b_hw_phy_cfg(tp);
H
hayeswang 已提交
2532 2533 2534 2535 2536 2537 2538 2539 2540 2541 2542 2543 2544 2545 2546 2547

	ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CRWECR, CRWECR_NORAML);
	ocp_write_byte(tp, MCU_TYPE_PLA, PLA_CR, 0x00);

	ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL);
	ocp_data &= ~NOW_IS_OOB;
	ocp_write_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL, ocp_data);

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7);
	ocp_data &= ~MCU_BORW_EN;
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7, ocp_data);

	for (i = 0; i < 1000; i++) {
		ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL);
		if (ocp_data & LINK_LIST_READY)
			break;
H
hayeswang 已提交
2548
		usleep_range(1000, 2000);
H
hayeswang 已提交
2549 2550 2551 2552 2553 2554 2555 2556 2557 2558
	}

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7);
	ocp_data |= RE_INIT_LL;
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7, ocp_data);

	for (i = 0; i < 1000; i++) {
		ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL);
		if (ocp_data & LINK_LIST_READY)
			break;
H
hayeswang 已提交
2559
		usleep_range(1000, 2000);
H
hayeswang 已提交
2560 2561 2562 2563 2564 2565 2566
	}

	rtl8152_nic_reset(tp);

	/* rx share fifo credit full threshold */
	ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL0, RXFIFO_THR1_NORMAL);

2567 2568
	if (tp->udev->speed == USB_SPEED_FULL ||
	    tp->udev->speed == USB_SPEED_LOW) {
H
hayeswang 已提交
2569 2570 2571 2572 2573 2574 2575 2576 2577 2578 2579 2580 2581 2582 2583 2584 2585
		/* rx share fifo credit near full threshold */
		ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL1,
				RXFIFO_THR2_FULL);
		ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL2,
				RXFIFO_THR3_FULL);
	} else {
		/* rx share fifo credit near full threshold */
		ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL1,
				RXFIFO_THR2_HIGH);
		ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL2,
				RXFIFO_THR3_HIGH);
	}

	/* TX share fifo free credit full threshold */
	ocp_write_dword(tp, MCU_TYPE_PLA, PLA_TXFIFO_CTRL, TXFIFO_THR_NORMAL);

	ocp_write_byte(tp, MCU_TYPE_USB, USB_TX_AGG, TX_AGG_MAX_THRESHOLD);
H
hayeswang 已提交
2586
	ocp_write_dword(tp, MCU_TYPE_USB, USB_RX_BUF_TH, RX_THR_HIGH);
H
hayeswang 已提交
2587 2588 2589
	ocp_write_dword(tp, MCU_TYPE_USB, USB_TX_DMA,
			TEST_MODE_DISABLE | TX_SIZE_ADJUST1);

H
hayeswang 已提交
2590
	rtl_rx_vlan_en(tp, tp->netdev->features & NETIF_F_HW_VLAN_CTAG_RX);
H
hayeswang 已提交
2591 2592 2593 2594 2595 2596 2597 2598 2599 2600

	ocp_write_word(tp, MCU_TYPE_PLA, PLA_RMS, RTL8152_RMS);

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_TCR0);
	ocp_data |= TCR0_AUTO_FIFO;
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_TCR0, ocp_data);
}

static void r8152b_enter_oob(struct r8152 *tp)
{
H
hayeswang 已提交
2601 2602
	u32 ocp_data;
	int i;
H
hayeswang 已提交
2603 2604 2605 2606 2607 2608 2609 2610 2611

	ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL);
	ocp_data &= ~NOW_IS_OOB;
	ocp_write_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL, ocp_data);

	ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL0, RXFIFO_THR1_OOB);
	ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL1, RXFIFO_THR2_OOB);
	ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL2, RXFIFO_THR3_OOB);

H
hayeswang 已提交
2612
	rtl_disable(tp);
H
hayeswang 已提交
2613 2614 2615 2616 2617

	for (i = 0; i < 1000; i++) {
		ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL);
		if (ocp_data & LINK_LIST_READY)
			break;
H
hayeswang 已提交
2618
		usleep_range(1000, 2000);
H
hayeswang 已提交
2619 2620 2621 2622 2623 2624 2625 2626 2627 2628
	}

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7);
	ocp_data |= RE_INIT_LL;
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7, ocp_data);

	for (i = 0; i < 1000; i++) {
		ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL);
		if (ocp_data & LINK_LIST_READY)
			break;
H
hayeswang 已提交
2629
		usleep_range(1000, 2000);
H
hayeswang 已提交
2630 2631 2632 2633
	}

	ocp_write_word(tp, MCU_TYPE_PLA, PLA_RMS, RTL8152_RMS);

H
hayeswang 已提交
2634
	rtl_rx_vlan_en(tp, true);
H
hayeswang 已提交
2635 2636 2637 2638 2639 2640 2641 2642 2643

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PAL_BDC_CR);
	ocp_data |= ALDPS_PROXY_MODE;
	ocp_write_word(tp, MCU_TYPE_PLA, PAL_BDC_CR, ocp_data);

	ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL);
	ocp_data |= NOW_IS_OOB | DIS_MCU_CLROOB;
	ocp_write_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL, ocp_data);

H
hayeswang 已提交
2644
	rxdy_gated_en(tp, false);
H
hayeswang 已提交
2645 2646 2647 2648 2649 2650

	ocp_data = ocp_read_dword(tp, MCU_TYPE_PLA, PLA_RCR);
	ocp_data |= RCR_APM | RCR_AM | RCR_AB;
	ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RCR, ocp_data);
}

H
hayeswang 已提交
2651 2652 2653 2654 2655
static void r8153_hw_phy_cfg(struct r8152 *tp)
{
	u32 ocp_data;
	u16 data;

H
hayeswang 已提交
2656 2657 2658 2659
	if (tp->version == RTL_VER_03 || tp->version == RTL_VER_04 ||
	    tp->version == RTL_VER_05)
		ocp_reg_write(tp, OCP_ADC_CFG, CKADSEL_L | ADC_EN | EN_EMI_L);

H
hayeswang 已提交
2660 2661 2662 2663 2664
	data = r8152_mdio_read(tp, MII_BMCR);
	if (data & BMCR_PDOWN) {
		data &= ~BMCR_PDOWN;
		r8152_mdio_write(tp, MII_BMCR, data);
	}
H
hayeswang 已提交
2665 2666 2667 2668 2669 2670 2671 2672 2673 2674 2675 2676 2677 2678 2679 2680 2681

	if (tp->version == RTL_VER_03) {
		data = ocp_reg_read(tp, OCP_EEE_CFG);
		data &= ~CTAP_SHORT_EN;
		ocp_reg_write(tp, OCP_EEE_CFG, data);
	}

	data = ocp_reg_read(tp, OCP_POWER_CFG);
	data |= EEE_CLKDIV_EN;
	ocp_reg_write(tp, OCP_POWER_CFG, data);

	data = ocp_reg_read(tp, OCP_DOWN_SPEED);
	data |= EN_10M_BGOFF;
	ocp_reg_write(tp, OCP_DOWN_SPEED, data);
	data = ocp_reg_read(tp, OCP_POWER_CFG);
	data |= EN_10M_PLLOFF;
	ocp_reg_write(tp, OCP_POWER_CFG, data);
H
hayeswang 已提交
2682
	sram_write(tp, SRAM_IMPEDANCE, 0x0b13);
H
hayeswang 已提交
2683 2684 2685 2686 2687

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_PHY_PWR);
	ocp_data |= PFM_PWM_SWITCH;
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_PHY_PWR, ocp_data);

H
hayeswang 已提交
2688 2689
	/* Enable LPF corner auto tune */
	sram_write(tp, SRAM_LPF_CFG, 0xf70f);
H
hayeswang 已提交
2690

H
hayeswang 已提交
2691 2692 2693
	/* Adjust 10M Amplitude */
	sram_write(tp, SRAM_10M_AMP1, 0x00af);
	sram_write(tp, SRAM_10M_AMP2, 0x0208);
2694 2695

	set_bit(PHY_RESET, &tp->flags);
H
hayeswang 已提交
2696 2697 2698 2699 2700 2701 2702
}

static void r8153_first_init(struct r8152 *tp)
{
	u32 ocp_data;
	int i;

H
hayeswang 已提交
2703
	rxdy_gated_en(tp, true);
H
hayeswang 已提交
2704 2705 2706 2707 2708 2709 2710 2711 2712
	r8153_teredo_off(tp);

	ocp_data = ocp_read_dword(tp, MCU_TYPE_PLA, PLA_RCR);
	ocp_data &= ~RCR_ACPT_ALL;
	ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RCR, ocp_data);

	r8153_hw_phy_cfg(tp);

	rtl8152_nic_reset(tp);
H
hayeswang 已提交
2713
	rtl_reset_bmu(tp);
H
hayeswang 已提交
2714 2715 2716 2717 2718 2719 2720 2721 2722 2723 2724 2725 2726

	ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL);
	ocp_data &= ~NOW_IS_OOB;
	ocp_write_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL, ocp_data);

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7);
	ocp_data &= ~MCU_BORW_EN;
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7, ocp_data);

	for (i = 0; i < 1000; i++) {
		ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL);
		if (ocp_data & LINK_LIST_READY)
			break;
H
hayeswang 已提交
2727
		usleep_range(1000, 2000);
H
hayeswang 已提交
2728 2729 2730 2731 2732 2733 2734 2735 2736 2737
	}

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7);
	ocp_data |= RE_INIT_LL;
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7, ocp_data);

	for (i = 0; i < 1000; i++) {
		ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL);
		if (ocp_data & LINK_LIST_READY)
			break;
H
hayeswang 已提交
2738
		usleep_range(1000, 2000);
H
hayeswang 已提交
2739 2740
	}

H
hayeswang 已提交
2741
	rtl_rx_vlan_en(tp, tp->netdev->features & NETIF_F_HW_VLAN_CTAG_RX);
H
hayeswang 已提交
2742

2743 2744
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_RMS, RTL8153_RMS);
	ocp_write_byte(tp, MCU_TYPE_PLA, PLA_MTPS, MTPS_JUMBO);
H
hayeswang 已提交
2745 2746 2747 2748 2749 2750 2751 2752 2753 2754 2755 2756 2757 2758

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_TCR0);
	ocp_data |= TCR0_AUTO_FIFO;
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_TCR0, ocp_data);

	rtl8152_nic_reset(tp);

	/* rx share fifo credit full threshold */
	ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL0, RXFIFO_THR1_NORMAL);
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL1, RXFIFO_THR2_NORMAL);
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_RXFIFO_CTRL2, RXFIFO_THR3_NORMAL);
	/* TX share fifo free credit full threshold */
	ocp_write_dword(tp, MCU_TYPE_PLA, PLA_TXFIFO_CTRL, TXFIFO_THR_NORMAL2);

2759
	/* rx aggregation */
H
hayeswang 已提交
2760
	ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_USB_CTRL);
2761
	ocp_data &= ~(RX_AGG_DISABLE | RX_ZERO_EN);
H
hayeswang 已提交
2762 2763 2764 2765 2766 2767 2768 2769 2770 2771 2772 2773
	ocp_write_word(tp, MCU_TYPE_USB, USB_USB_CTRL, ocp_data);
}

static void r8153_enter_oob(struct r8152 *tp)
{
	u32 ocp_data;
	int i;

	ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL);
	ocp_data &= ~NOW_IS_OOB;
	ocp_write_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL, ocp_data);

H
hayeswang 已提交
2774
	rtl_disable(tp);
H
hayeswang 已提交
2775
	rtl_reset_bmu(tp);
H
hayeswang 已提交
2776 2777 2778 2779 2780

	for (i = 0; i < 1000; i++) {
		ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL);
		if (ocp_data & LINK_LIST_READY)
			break;
H
hayeswang 已提交
2781
		usleep_range(1000, 2000);
H
hayeswang 已提交
2782 2783 2784 2785 2786 2787 2788 2789 2790 2791
	}

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7);
	ocp_data |= RE_INIT_LL;
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_SFF_STS_7, ocp_data);

	for (i = 0; i < 1000; i++) {
		ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL);
		if (ocp_data & LINK_LIST_READY)
			break;
H
hayeswang 已提交
2792
		usleep_range(1000, 2000);
H
hayeswang 已提交
2793 2794
	}

2795
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_RMS, RTL8153_RMS);
H
hayeswang 已提交
2796 2797 2798 2799 2800

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_TEREDO_CFG);
	ocp_data &= ~TEREDO_WAKE_MASK;
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_TEREDO_CFG, ocp_data);

H
hayeswang 已提交
2801
	rtl_rx_vlan_en(tp, true);
H
hayeswang 已提交
2802 2803 2804 2805 2806 2807 2808 2809 2810

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PAL_BDC_CR);
	ocp_data |= ALDPS_PROXY_MODE;
	ocp_write_word(tp, MCU_TYPE_PLA, PAL_BDC_CR, ocp_data);

	ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL);
	ocp_data |= NOW_IS_OOB | DIS_MCU_CLROOB;
	ocp_write_byte(tp, MCU_TYPE_PLA, PLA_OOB_CTRL, ocp_data);

H
hayeswang 已提交
2811
	rxdy_gated_en(tp, false);
H
hayeswang 已提交
2812 2813 2814 2815 2816 2817

	ocp_data = ocp_read_dword(tp, MCU_TYPE_PLA, PLA_RCR);
	ocp_data |= RCR_APM | RCR_AM | RCR_AB;
	ocp_write_dword(tp, MCU_TYPE_PLA, PLA_RCR, ocp_data);
}

H
hayeswang 已提交
2818
static void r8153_aldps_en(struct r8152 *tp, bool enable)
H
hayeswang 已提交
2819 2820 2821 2822
{
	u16 data;

	data = ocp_reg_read(tp, OCP_POWER_CFG);
H
hayeswang 已提交
2823 2824 2825 2826 2827 2828 2829 2830
	if (enable) {
		data |= EN_ALDPS;
		ocp_reg_write(tp, OCP_POWER_CFG, data);
	} else {
		data &= ~EN_ALDPS;
		ocp_reg_write(tp, OCP_POWER_CFG, data);
		msleep(20);
	}
H
hayeswang 已提交
2831 2832
}

H
hayeswang 已提交
2833 2834
static void rtl8153_disable(struct r8152 *tp)
{
H
hayeswang 已提交
2835
	r8153_aldps_en(tp, false);
H
hayeswang 已提交
2836
	rtl_disable(tp);
H
hayeswang 已提交
2837
	rtl_reset_bmu(tp);
H
hayeswang 已提交
2838
	r8153_aldps_en(tp, true);
H
hayeswang 已提交
2839
	usb_enable_lpm(tp->udev);
H
hayeswang 已提交
2840 2841
}

H
hayeswang 已提交
2842 2843
static int rtl8152_set_speed(struct r8152 *tp, u8 autoneg, u16 speed, u8 duplex)
{
H
hayeswang 已提交
2844
	u16 bmcr, anar, gbcr;
H
hayeswang 已提交
2845 2846 2847 2848 2849 2850
	int ret = 0;

	cancel_delayed_work_sync(&tp->schedule);
	anar = r8152_mdio_read(tp, MII_ADVERTISE);
	anar &= ~(ADVERTISE_10HALF | ADVERTISE_10FULL |
		  ADVERTISE_100HALF | ADVERTISE_100FULL);
H
hayeswang 已提交
2851 2852 2853 2854 2855 2856
	if (tp->mii.supports_gmii) {
		gbcr = r8152_mdio_read(tp, MII_CTRL1000);
		gbcr &= ~(ADVERTISE_1000FULL | ADVERTISE_1000HALF);
	} else {
		gbcr = 0;
	}
H
hayeswang 已提交
2857 2858 2859 2860 2861 2862 2863 2864

	if (autoneg == AUTONEG_DISABLE) {
		if (speed == SPEED_10) {
			bmcr = 0;
			anar |= ADVERTISE_10HALF | ADVERTISE_10FULL;
		} else if (speed == SPEED_100) {
			bmcr = BMCR_SPEED100;
			anar |= ADVERTISE_100HALF | ADVERTISE_100FULL;
H
hayeswang 已提交
2865 2866 2867
		} else if (speed == SPEED_1000 && tp->mii.supports_gmii) {
			bmcr = BMCR_SPEED1000;
			gbcr |= ADVERTISE_1000FULL | ADVERTISE_1000HALF;
H
hayeswang 已提交
2868 2869 2870 2871 2872 2873 2874 2875 2876 2877 2878 2879 2880 2881 2882 2883 2884 2885 2886 2887 2888
		} else {
			ret = -EINVAL;
			goto out;
		}

		if (duplex == DUPLEX_FULL)
			bmcr |= BMCR_FULLDPLX;
	} else {
		if (speed == SPEED_10) {
			if (duplex == DUPLEX_FULL)
				anar |= ADVERTISE_10HALF | ADVERTISE_10FULL;
			else
				anar |= ADVERTISE_10HALF;
		} else if (speed == SPEED_100) {
			if (duplex == DUPLEX_FULL) {
				anar |= ADVERTISE_10HALF | ADVERTISE_10FULL;
				anar |= ADVERTISE_100HALF | ADVERTISE_100FULL;
			} else {
				anar |= ADVERTISE_10HALF;
				anar |= ADVERTISE_100HALF;
			}
H
hayeswang 已提交
2889 2890 2891 2892 2893 2894 2895 2896 2897 2898
		} else if (speed == SPEED_1000 && tp->mii.supports_gmii) {
			if (duplex == DUPLEX_FULL) {
				anar |= ADVERTISE_10HALF | ADVERTISE_10FULL;
				anar |= ADVERTISE_100HALF | ADVERTISE_100FULL;
				gbcr |= ADVERTISE_1000FULL | ADVERTISE_1000HALF;
			} else {
				anar |= ADVERTISE_10HALF;
				anar |= ADVERTISE_100HALF;
				gbcr |= ADVERTISE_1000HALF;
			}
H
hayeswang 已提交
2899 2900 2901 2902 2903 2904 2905 2906
		} else {
			ret = -EINVAL;
			goto out;
		}

		bmcr = BMCR_ANENABLE | BMCR_ANRESTART;
	}

2907 2908 2909
	if (test_bit(PHY_RESET, &tp->flags))
		bmcr |= BMCR_RESET;

H
hayeswang 已提交
2910 2911 2912
	if (tp->mii.supports_gmii)
		r8152_mdio_write(tp, MII_CTRL1000, gbcr);

H
hayeswang 已提交
2913 2914 2915
	r8152_mdio_write(tp, MII_ADVERTISE, anar);
	r8152_mdio_write(tp, MII_BMCR, bmcr);

H
hayeswang 已提交
2916
	if (test_and_clear_bit(PHY_RESET, &tp->flags)) {
2917 2918 2919 2920 2921 2922 2923 2924 2925
		int i;

		for (i = 0; i < 50; i++) {
			msleep(20);
			if ((r8152_mdio_read(tp, MII_BMCR) & BMCR_RESET) == 0)
				break;
		}
	}

H
hayeswang 已提交
2926 2927 2928 2929
out:
	return ret;
}

H
hayeswang 已提交
2930 2931 2932 2933 2934
static void rtl8152_up(struct r8152 *tp)
{
	if (test_bit(RTL8152_UNPLUG, &tp->flags))
		return;

H
hayeswang 已提交
2935
	r8152_aldps_en(tp, false);
H
hayeswang 已提交
2936
	r8152b_exit_oob(tp);
H
hayeswang 已提交
2937
	r8152_aldps_en(tp, true);
H
hayeswang 已提交
2938 2939
}

H
hayeswang 已提交
2940 2941
static void rtl8152_down(struct r8152 *tp)
{
H
hayeswang 已提交
2942 2943 2944 2945 2946
	if (test_bit(RTL8152_UNPLUG, &tp->flags)) {
		rtl_drop_queued_tx(tp);
		return;
	}

H
hayeswang 已提交
2947
	r8152_power_cut_en(tp, false);
H
hayeswang 已提交
2948
	r8152_aldps_en(tp, false);
H
hayeswang 已提交
2949
	r8152b_enter_oob(tp);
H
hayeswang 已提交
2950
	r8152_aldps_en(tp, true);
H
hayeswang 已提交
2951 2952
}

H
hayeswang 已提交
2953 2954 2955 2956 2957
static void rtl8153_up(struct r8152 *tp)
{
	if (test_bit(RTL8152_UNPLUG, &tp->flags))
		return;

H
hayeswang 已提交
2958
	r8153_u1u2en(tp, false);
H
hayeswang 已提交
2959
	r8153_aldps_en(tp, false);
H
hayeswang 已提交
2960
	r8153_first_init(tp);
H
hayeswang 已提交
2961
	r8153_aldps_en(tp, true);
H
hayeswang 已提交
2962 2963 2964
	r8153_u2p3en(tp, true);
	r8153_u1u2en(tp, true);
	usb_enable_lpm(tp->udev);
H
hayeswang 已提交
2965 2966
}

H
hayeswang 已提交
2967 2968
static void rtl8153_down(struct r8152 *tp)
{
H
hayeswang 已提交
2969 2970 2971 2972 2973
	if (test_bit(RTL8152_UNPLUG, &tp->flags)) {
		rtl_drop_queued_tx(tp);
		return;
	}

2974
	r8153_u1u2en(tp, false);
H
hayeswang 已提交
2975
	r8153_u2p3en(tp, false);
2976
	r8153_power_cut_en(tp, false);
H
hayeswang 已提交
2977
	r8153_aldps_en(tp, false);
H
hayeswang 已提交
2978
	r8153_enter_oob(tp);
H
hayeswang 已提交
2979
	r8153_aldps_en(tp, true);
H
hayeswang 已提交
2980 2981
}

2982 2983 2984 2985 2986 2987 2988 2989 2990 2991 2992 2993 2994 2995 2996 2997 2998 2999 3000 3001 3002 3003 3004 3005 3006 3007
static bool rtl8152_in_nway(struct r8152 *tp)
{
	u16 nway_state;

	ocp_write_word(tp, MCU_TYPE_PLA, PLA_OCP_GPHY_BASE, 0x2000);
	tp->ocp_base = 0x2000;
	ocp_write_byte(tp, MCU_TYPE_PLA, 0xb014, 0x4c);		/* phy state */
	nway_state = ocp_read_word(tp, MCU_TYPE_PLA, 0xb01a);

	/* bit 15: TXDIS_STATE, bit 14: ABD_STATE */
	if (nway_state & 0xc000)
		return false;
	else
		return true;
}

static bool rtl8153_in_nway(struct r8152 *tp)
{
	u16 phy_state = ocp_reg_read(tp, OCP_PHY_STATE) & 0xff;

	if (phy_state == TXDIS_STATE || phy_state == ABD_STATE)
		return false;
	else
		return true;
}

H
hayeswang 已提交
3008 3009 3010 3011 3012 3013 3014 3015
static void set_carrier(struct r8152 *tp)
{
	struct net_device *netdev = tp->netdev;
	u8 speed;

	speed = rtl8152_get_speed(tp);

	if (speed & LINK_STATUS) {
3016
		if (!netif_carrier_ok(netdev)) {
H
hayeswang 已提交
3017
			tp->rtl_ops.enable(tp);
H
hayeswang 已提交
3018
			set_bit(RTL8152_SET_RX_MODE, &tp->flags);
3019
			napi_disable(&tp->napi);
H
hayeswang 已提交
3020
			netif_carrier_on(netdev);
3021
			rtl_start_rx(tp);
3022
			napi_enable(&tp->napi);
H
hayeswang 已提交
3023 3024
		}
	} else {
3025
		if (netif_carrier_ok(netdev)) {
H
hayeswang 已提交
3026
			netif_carrier_off(netdev);
H
hayeswang 已提交
3027
			napi_disable(&tp->napi);
H
hayeswang 已提交
3028
			tp->rtl_ops.disable(tp);
H
hayeswang 已提交
3029
			napi_enable(&tp->napi);
H
hayeswang 已提交
3030 3031 3032 3033 3034 3035 3036 3037
		}
	}
}

static void rtl_work_func_t(struct work_struct *work)
{
	struct r8152 *tp = container_of(work, struct r8152, schedule.work);

3038 3039 3040 3041 3042 3043
	/* If the device is unplugged or !netif_running(), the workqueue
	 * doesn't need to wake the device, and could return directly.
	 */
	if (test_bit(RTL8152_UNPLUG, &tp->flags) || !netif_running(tp->netdev))
		return;

H
hayeswang 已提交
3044 3045 3046
	if (usb_autopm_get_interface(tp->intf) < 0)
		return;

H
hayeswang 已提交
3047 3048 3049
	if (!test_bit(WORK_ENABLE, &tp->flags))
		goto out1;

H
hayeswang 已提交
3050 3051 3052 3053 3054
	if (!mutex_trylock(&tp->control)) {
		schedule_delayed_work(&tp->schedule, 0);
		goto out1;
	}

H
hayeswang 已提交
3055
	if (test_and_clear_bit(RTL8152_LINK_CHG, &tp->flags))
3056
		set_carrier(tp);
H
hayeswang 已提交
3057

H
hayeswang 已提交
3058
	if (test_and_clear_bit(RTL8152_SET_RX_MODE, &tp->flags))
H
hayeswang 已提交
3059 3060
		_rtl8152_set_rx_mode(tp->netdev);

H
hayeswang 已提交
3061
	/* don't schedule napi before linking */
H
hayeswang 已提交
3062 3063
	if (test_and_clear_bit(SCHEDULE_NAPI, &tp->flags) &&
	    netif_carrier_ok(tp->netdev))
H
hayeswang 已提交
3064
		napi_schedule(&tp->napi);
3065

H
hayeswang 已提交
3066
	if (test_and_clear_bit(PHY_RESET, &tp->flags))
3067 3068
		rtl_phy_reset(tp);

H
hayeswang 已提交
3069 3070
	mutex_unlock(&tp->control);

H
hayeswang 已提交
3071
out1:
H
hayeswang 已提交
3072
	usb_autopm_put_interface(tp->intf);
H
hayeswang 已提交
3073 3074
}

H
hayeswang 已提交
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
#ifdef CONFIG_PM_SLEEP
static int rtl_notifier(struct notifier_block *nb, unsigned long action,
			void *data)
{
	struct r8152 *tp = container_of(nb, struct r8152, pm_notifier);

	switch (action) {
	case PM_HIBERNATION_PREPARE:
	case PM_SUSPEND_PREPARE:
		usb_autopm_get_interface(tp->intf);
		break;

	case PM_POST_HIBERNATION:
	case PM_POST_SUSPEND:
		usb_autopm_put_interface(tp->intf);
		break;

	case PM_POST_RESTORE:
	case PM_RESTORE_PREPARE:
	default:
		break;
	}

	return NOTIFY_DONE;
}
#endif

H
hayeswang 已提交
3102 3103 3104 3105 3106
static int rtl8152_open(struct net_device *netdev)
{
	struct r8152 *tp = netdev_priv(netdev);
	int res = 0;

3107 3108 3109 3110
	res = alloc_all_mem(tp);
	if (res)
		goto out;

3111
	netif_carrier_off(netdev);
3112

H
hayeswang 已提交
3113 3114 3115 3116 3117 3118
	res = usb_autopm_get_interface(tp->intf);
	if (res < 0) {
		free_all_mem(tp);
		goto out;
	}

H
hayeswang 已提交
3119 3120
	mutex_lock(&tp->control);

3121 3122
	tp->rtl_ops.up(tp);

3123 3124 3125 3126 3127 3128
	rtl8152_set_speed(tp, AUTONEG_ENABLE,
			  tp->mii.supports_gmii ? SPEED_1000 : SPEED_100,
			  DUPLEX_FULL);
	netif_carrier_off(netdev);
	netif_start_queue(netdev);
	set_bit(WORK_ENABLE, &tp->flags);
3129

3130 3131 3132 3133
	res = usb_submit_urb(tp->intr_urb, GFP_KERNEL);
	if (res) {
		if (res == -ENODEV)
			netif_device_detach(tp->netdev);
H
Hayes Wang 已提交
3134 3135
		netif_warn(tp, ifup, netdev, "intr_urb submit failed: %d\n",
			   res);
3136
		free_all_mem(tp);
H
hayeswang 已提交
3137
	} else {
H
hayeswang 已提交
3138
		napi_enable(&tp->napi);
H
hayeswang 已提交
3139 3140
	}

H
hayeswang 已提交
3141 3142
	mutex_unlock(&tp->control);

H
hayeswang 已提交
3143
	usb_autopm_put_interface(tp->intf);
H
hayeswang 已提交
3144 3145 3146 3147
#ifdef CONFIG_PM_SLEEP
	tp->pm_notifier.notifier_call = rtl_notifier;
	register_pm_notifier(&tp->pm_notifier);
#endif
H
hayeswang 已提交
3148

3149
out:
H
hayeswang 已提交
3150 3151 3152 3153 3154 3155 3156 3157
	return res;
}

static int rtl8152_close(struct net_device *netdev)
{
	struct r8152 *tp = netdev_priv(netdev);
	int res = 0;

H
hayeswang 已提交
3158 3159 3160
#ifdef CONFIG_PM_SLEEP
	unregister_pm_notifier(&tp->pm_notifier);
#endif
H
hayeswang 已提交
3161
	napi_disable(&tp->napi);
H
hayeswang 已提交
3162
	clear_bit(WORK_ENABLE, &tp->flags);
3163
	usb_kill_urb(tp->intr_urb);
H
hayeswang 已提交
3164 3165
	cancel_delayed_work_sync(&tp->schedule);
	netif_stop_queue(netdev);
H
hayeswang 已提交
3166 3167

	res = usb_autopm_get_interface(tp->intf);
3168
	if (res < 0 || test_bit(RTL8152_UNPLUG, &tp->flags)) {
H
hayeswang 已提交
3169
		rtl_drop_queued_tx(tp);
H
hayeswang 已提交
3170
		rtl_stop_rx(tp);
H
hayeswang 已提交
3171
	} else {
H
hayeswang 已提交
3172 3173
		mutex_lock(&tp->control);

H
hayeswang 已提交
3174
		tp->rtl_ops.down(tp);
H
hayeswang 已提交
3175 3176 3177

		mutex_unlock(&tp->control);

H
hayeswang 已提交
3178 3179
		usb_autopm_put_interface(tp->intf);
	}
H
hayeswang 已提交
3180

3181 3182
	free_all_mem(tp);

H
hayeswang 已提交
3183 3184 3185
	return res;
}

H
hayeswang 已提交
3186 3187 3188 3189 3190 3191 3192 3193 3194 3195 3196 3197 3198 3199 3200 3201 3202 3203 3204
static inline void r8152_mmd_indirect(struct r8152 *tp, u16 dev, u16 reg)
{
	ocp_reg_write(tp, OCP_EEE_AR, FUN_ADDR | dev);
	ocp_reg_write(tp, OCP_EEE_DATA, reg);
	ocp_reg_write(tp, OCP_EEE_AR, FUN_DATA | dev);
}

static u16 r8152_mmd_read(struct r8152 *tp, u16 dev, u16 reg)
{
	u16 data;

	r8152_mmd_indirect(tp, dev, reg);
	data = ocp_reg_read(tp, OCP_EEE_DATA);
	ocp_reg_write(tp, OCP_EEE_AR, 0x0000);

	return data;
}

static void r8152_mmd_write(struct r8152 *tp, u16 dev, u16 reg, u16 data)
H
hayeswang 已提交
3205
{
H
hayeswang 已提交
3206 3207 3208 3209 3210 3211 3212 3213
	r8152_mmd_indirect(tp, dev, reg);
	ocp_reg_write(tp, OCP_EEE_DATA, data);
	ocp_reg_write(tp, OCP_EEE_AR, 0x0000);
}

static void r8152_eee_en(struct r8152 *tp, bool enable)
{
	u16 config1, config2, config3;
H
hayeswang 已提交
3214
	u32 ocp_data;
H
hayeswang 已提交
3215 3216

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_EEE_CR);
H
hayeswang 已提交
3217 3218 3219 3220 3221 3222 3223 3224 3225 3226 3227 3228 3229 3230 3231 3232 3233 3234 3235
	config1 = ocp_reg_read(tp, OCP_EEE_CONFIG1) & ~sd_rise_time_mask;
	config2 = ocp_reg_read(tp, OCP_EEE_CONFIG2);
	config3 = ocp_reg_read(tp, OCP_EEE_CONFIG3) & ~fast_snr_mask;

	if (enable) {
		ocp_data |= EEE_RX_EN | EEE_TX_EN;
		config1 |= EEE_10_CAP | EEE_NWAY_EN | TX_QUIET_EN | RX_QUIET_EN;
		config1 |= sd_rise_time(1);
		config2 |= RG_DACQUIET_EN | RG_LDVQUIET_EN;
		config3 |= fast_snr(42);
	} else {
		ocp_data &= ~(EEE_RX_EN | EEE_TX_EN);
		config1 &= ~(EEE_10_CAP | EEE_NWAY_EN | TX_QUIET_EN |
			     RX_QUIET_EN);
		config1 |= sd_rise_time(7);
		config2 &= ~(RG_DACQUIET_EN | RG_LDVQUIET_EN);
		config3 |= fast_snr(511);
	}

H
hayeswang 已提交
3236
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_EEE_CR, ocp_data);
H
hayeswang 已提交
3237 3238 3239
	ocp_reg_write(tp, OCP_EEE_CONFIG1, config1);
	ocp_reg_write(tp, OCP_EEE_CONFIG2, config2);
	ocp_reg_write(tp, OCP_EEE_CONFIG3, config3);
H
hayeswang 已提交
3240 3241
}

H
hayeswang 已提交
3242 3243 3244 3245 3246 3247 3248
static void r8152b_enable_eee(struct r8152 *tp)
{
	r8152_eee_en(tp, true);
	r8152_mmd_write(tp, MDIO_MMD_AN, MDIO_AN_EEE_ADV, MDIO_EEE_100TX);
}

static void r8153_eee_en(struct r8152 *tp, bool enable)
H
hayeswang 已提交
3249 3250
{
	u32 ocp_data;
H
hayeswang 已提交
3251
	u16 config;
H
hayeswang 已提交
3252 3253

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_EEE_CR);
H
hayeswang 已提交
3254 3255 3256 3257 3258 3259 3260 3261 3262 3263
	config = ocp_reg_read(tp, OCP_EEE_CFG);

	if (enable) {
		ocp_data |= EEE_RX_EN | EEE_TX_EN;
		config |= EEE10_EN;
	} else {
		ocp_data &= ~(EEE_RX_EN | EEE_TX_EN);
		config &= ~EEE10_EN;
	}

H
hayeswang 已提交
3264
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_EEE_CR, ocp_data);
H
hayeswang 已提交
3265 3266 3267 3268 3269 3270 3271
	ocp_reg_write(tp, OCP_EEE_CFG, config);
}

static void r8153_enable_eee(struct r8152 *tp)
{
	r8153_eee_en(tp, true);
	ocp_reg_write(tp, OCP_EEE_ADV, MDIO_EEE_1000T | MDIO_EEE_100TX);
H
hayeswang 已提交
3272 3273
}

H
hayeswang 已提交
3274 3275 3276 3277 3278 3279 3280 3281 3282
static void r8152b_enable_fc(struct r8152 *tp)
{
	u16 anar;

	anar = r8152_mdio_read(tp, MII_ADVERTISE);
	anar |= ADVERTISE_PAUSE_CAP | ADVERTISE_PAUSE_ASYM;
	r8152_mdio_write(tp, MII_ADVERTISE, anar);
}

3283 3284 3285 3286 3287 3288 3289 3290 3291
static void rtl_tally_reset(struct r8152 *tp)
{
	u32 ocp_data;

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_RSTTALLY);
	ocp_data |= TALLY_RESET;
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_RSTTALLY, ocp_data);
}

H
hayeswang 已提交
3292 3293
static void r8152b_init(struct r8152 *tp)
{
H
hayeswang 已提交
3294
	u32 ocp_data;
H
hayeswang 已提交
3295

H
hayeswang 已提交
3296 3297 3298
	if (test_bit(RTL8152_UNPLUG, &tp->flags))
		return;

H
hayeswang 已提交
3299
	r8152_aldps_en(tp, false);
H
hayeswang 已提交
3300

H
hayeswang 已提交
3301 3302 3303 3304 3305 3306
	if (tp->version == RTL_VER_01) {
		ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_LED_FEATURE);
		ocp_data &= ~LED_MODE_MASK;
		ocp_write_word(tp, MCU_TYPE_PLA, PLA_LED_FEATURE, ocp_data);
	}

H
hayeswang 已提交
3307
	r8152_power_cut_en(tp, false);
H
hayeswang 已提交
3308 3309 3310 3311 3312 3313 3314 3315 3316 3317 3318 3319 3320

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_PHY_PWR);
	ocp_data |= TX_10M_IDLE_EN | PFM_PWM_SWITCH;
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_PHY_PWR, ocp_data);
	ocp_data = ocp_read_dword(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL);
	ocp_data &= ~MCU_CLK_RATIO_MASK;
	ocp_data |= MCU_CLK_RATIO | D3_CLK_GATED_EN;
	ocp_write_dword(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL, ocp_data);
	ocp_data = GPHY_STS_MSK | SPEED_DOWN_MSK |
		   SPDWN_RXDV_MSK | SPDWN_LINKCHG_MSK;
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_GPHY_INTR_IMR, ocp_data);

	r8152b_enable_eee(tp);
H
hayeswang 已提交
3321
	r8152_aldps_en(tp, true);
H
hayeswang 已提交
3322
	r8152b_enable_fc(tp);
3323
	rtl_tally_reset(tp);
H
hayeswang 已提交
3324

H
hayeswang 已提交
3325
	/* enable rx aggregation */
H
hayeswang 已提交
3326
	ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_USB_CTRL);
3327
	ocp_data &= ~(RX_AGG_DISABLE | RX_ZERO_EN);
H
hayeswang 已提交
3328 3329 3330
	ocp_write_word(tp, MCU_TYPE_USB, USB_USB_CTRL, ocp_data);
}

H
hayeswang 已提交
3331 3332 3333 3334 3335
static void r8153_init(struct r8152 *tp)
{
	u32 ocp_data;
	int i;

H
hayeswang 已提交
3336 3337 3338
	if (test_bit(RTL8152_UNPLUG, &tp->flags))
		return;

H
hayeswang 已提交
3339
	r8153_aldps_en(tp, false);
3340
	r8153_u1u2en(tp, false);
H
hayeswang 已提交
3341 3342 3343 3344 3345 3346 3347 3348 3349 3350 3351 3352 3353 3354 3355

	for (i = 0; i < 500; i++) {
		if (ocp_read_word(tp, MCU_TYPE_PLA, PLA_BOOT_CTRL) &
		    AUTOLOAD_DONE)
			break;
		msleep(20);
	}

	for (i = 0; i < 500; i++) {
		ocp_data = ocp_reg_read(tp, OCP_PHY_STATUS) & PHY_STAT_MASK;
		if (ocp_data == PHY_STAT_LAN_ON || ocp_data == PHY_STAT_PWRDN)
			break;
		msleep(20);
	}

H
hayeswang 已提交
3356
	usb_disable_lpm(tp->udev);
3357
	r8153_u2p3en(tp, false);
H
hayeswang 已提交
3358

H
hayeswang 已提交
3359 3360 3361 3362 3363 3364 3365 3366 3367 3368 3369 3370 3371 3372
	if (tp->version == RTL_VER_04) {
		ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_SSPHYLINK2);
		ocp_data &= ~pwd_dn_scale_mask;
		ocp_data |= pwd_dn_scale(96);
		ocp_write_word(tp, MCU_TYPE_USB, USB_SSPHYLINK2, ocp_data);

		ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_USB2PHY);
		ocp_data |= USB2PHY_L1 | USB2PHY_SUSPEND;
		ocp_write_byte(tp, MCU_TYPE_USB, USB_USB2PHY, ocp_data);
	} else if (tp->version == RTL_VER_05) {
		ocp_data = ocp_read_byte(tp, MCU_TYPE_PLA, PLA_DMY_REG0);
		ocp_data &= ~ECM_ALDPS;
		ocp_write_byte(tp, MCU_TYPE_PLA, PLA_DMY_REG0, ocp_data);

H
hayeswang 已提交
3373 3374 3375 3376 3377 3378 3379
		ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_CSR_DUMMY1);
		if (ocp_read_word(tp, MCU_TYPE_USB, USB_BURST_SIZE) == 0)
			ocp_data &= ~DYNAMIC_BURST;
		else
			ocp_data |= DYNAMIC_BURST;
		ocp_write_byte(tp, MCU_TYPE_USB, USB_CSR_DUMMY1, ocp_data);
	} else if (tp->version == RTL_VER_06) {
H
hayeswang 已提交
3380 3381 3382 3383 3384 3385 3386 3387 3388 3389 3390 3391
		ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_CSR_DUMMY1);
		if (ocp_read_word(tp, MCU_TYPE_USB, USB_BURST_SIZE) == 0)
			ocp_data &= ~DYNAMIC_BURST;
		else
			ocp_data |= DYNAMIC_BURST;
		ocp_write_byte(tp, MCU_TYPE_USB, USB_CSR_DUMMY1, ocp_data);
	}

	ocp_data = ocp_read_byte(tp, MCU_TYPE_USB, USB_CSR_DUMMY2);
	ocp_data |= EP4_FULL_FC;
	ocp_write_byte(tp, MCU_TYPE_USB, USB_CSR_DUMMY2, ocp_data);

H
hayeswang 已提交
3392 3393 3394 3395 3396 3397 3398 3399
	ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_WDT11_CTRL);
	ocp_data &= ~TIMER11_EN;
	ocp_write_word(tp, MCU_TYPE_USB, USB_WDT11_CTRL, ocp_data);

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_LED_FEATURE);
	ocp_data &= ~LED_MODE_MASK;
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_LED_FEATURE, ocp_data);

H
hayeswang 已提交
3400
	ocp_data = FIFO_EMPTY_1FB | ROK_EXIT_LPM;
O
Oliver Neukum 已提交
3401
	if (tp->version == RTL_VER_04 && tp->udev->speed < USB_SPEED_SUPER)
H
hayeswang 已提交
3402
		ocp_data |= LPM_TIMER_500MS;
H
hayeswang 已提交
3403 3404
	else
		ocp_data |= LPM_TIMER_500US;
H
hayeswang 已提交
3405 3406 3407 3408 3409 3410 3411
	ocp_write_byte(tp, MCU_TYPE_USB, USB_LPM_CTRL, ocp_data);

	ocp_data = ocp_read_word(tp, MCU_TYPE_USB, USB_AFE_CTRL2);
	ocp_data &= ~SEN_VAL_MASK;
	ocp_data |= SEN_VAL_NORMAL | SEL_RXIDLE;
	ocp_write_word(tp, MCU_TYPE_USB, USB_AFE_CTRL2, ocp_data);

H
hayeswang 已提交
3412 3413
	ocp_write_word(tp, MCU_TYPE_USB, USB_CONNECT_TIMER, 0x0001);

3414 3415
	r8153_power_cut_en(tp, false);
	r8153_u1u2en(tp, true);
H
hayeswang 已提交
3416

H
hayeswang 已提交
3417 3418 3419 3420 3421
	/* MAC clock speed down */
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL, 0);
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL2, 0);
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL3, 0);
	ocp_write_word(tp, MCU_TYPE_PLA, PLA_MAC_PWR_CTRL4, 0);
H
hayeswang 已提交
3422 3423

	r8153_enable_eee(tp);
H
hayeswang 已提交
3424
	r8153_aldps_en(tp, true);
H
hayeswang 已提交
3425
	r8152b_enable_fc(tp);
3426
	rtl_tally_reset(tp);
H
hayeswang 已提交
3427
	r8153_u2p3en(tp, true);
H
hayeswang 已提交
3428 3429
}

H
hayeswang 已提交
3430 3431 3432 3433 3434 3435 3436 3437 3438 3439 3440 3441 3442 3443 3444 3445 3446 3447 3448 3449 3450 3451 3452 3453 3454 3455 3456 3457 3458 3459 3460 3461 3462 3463 3464 3465 3466 3467 3468 3469 3470 3471 3472 3473 3474 3475 3476 3477 3478 3479
static int rtl8152_pre_reset(struct usb_interface *intf)
{
	struct r8152 *tp = usb_get_intfdata(intf);
	struct net_device *netdev;

	if (!tp)
		return 0;

	netdev = tp->netdev;
	if (!netif_running(netdev))
		return 0;

	napi_disable(&tp->napi);
	clear_bit(WORK_ENABLE, &tp->flags);
	usb_kill_urb(tp->intr_urb);
	cancel_delayed_work_sync(&tp->schedule);
	if (netif_carrier_ok(netdev)) {
		netif_stop_queue(netdev);
		mutex_lock(&tp->control);
		tp->rtl_ops.disable(tp);
		mutex_unlock(&tp->control);
	}

	return 0;
}

static int rtl8152_post_reset(struct usb_interface *intf)
{
	struct r8152 *tp = usb_get_intfdata(intf);
	struct net_device *netdev;

	if (!tp)
		return 0;

	netdev = tp->netdev;
	if (!netif_running(netdev))
		return 0;

	set_bit(WORK_ENABLE, &tp->flags);
	if (netif_carrier_ok(netdev)) {
		mutex_lock(&tp->control);
		tp->rtl_ops.enable(tp);
		rtl8152_set_rx_mode(netdev);
		mutex_unlock(&tp->control);
		netif_wake_queue(netdev);
	}

	napi_enable(&tp->napi);

	return 0;
H
hayeswang 已提交
3480 3481
}

3482 3483 3484 3485 3486 3487 3488 3489 3490 3491 3492 3493 3494 3495 3496 3497 3498 3499 3500 3501 3502
static bool delay_autosuspend(struct r8152 *tp)
{
	bool sw_linking = !!netif_carrier_ok(tp->netdev);
	bool hw_linking = !!(rtl8152_get_speed(tp) & LINK_STATUS);

	/* This means a linking change occurs and the driver doesn't detect it,
	 * yet. If the driver has disabled tx/rx and hw is linking on, the
	 * device wouldn't wake up by receiving any packet.
	 */
	if (work_busy(&tp->schedule.work) || sw_linking != hw_linking)
		return true;

	/* If the linking down is occurred by nway, the device may miss the
	 * linking change event. And it wouldn't wake when linking on.
	 */
	if (!sw_linking && tp->rtl_ops.in_nway(tp))
		return true;
	else
		return false;
}

H
hayeswang 已提交
3503 3504 3505
static int rtl8152_suspend(struct usb_interface *intf, pm_message_t message)
{
	struct r8152 *tp = usb_get_intfdata(intf);
3506 3507
	struct net_device *netdev = tp->netdev;
	int ret = 0;
H
hayeswang 已提交
3508

H
hayeswang 已提交
3509 3510
	mutex_lock(&tp->control);

3511
	if (PMSG_IS_AUTO(message)) {
3512
		if (netif_running(netdev) && delay_autosuspend(tp)) {
3513 3514 3515 3516
			ret = -EBUSY;
			goto out1;
		}

H
hayeswang 已提交
3517
		set_bit(SELECTIVE_SUSPEND, &tp->flags);
3518 3519 3520
	} else {
		netif_device_detach(netdev);
	}
H
hayeswang 已提交
3521

3522
	if (netif_running(netdev) && test_bit(WORK_ENABLE, &tp->flags)) {
H
hayeswang 已提交
3523
		clear_bit(WORK_ENABLE, &tp->flags);
3524
		usb_kill_urb(tp->intr_urb);
H
hayeswang 已提交
3525
		napi_disable(&tp->napi);
H
hayeswang 已提交
3526
		if (test_bit(SELECTIVE_SUSPEND, &tp->flags)) {
3527
			rtl_stop_rx(tp);
3528
			tp->rtl_ops.autosuspend_en(tp, true);
H
hayeswang 已提交
3529
		} else {
3530
			cancel_delayed_work_sync(&tp->schedule);
H
hayeswang 已提交
3531 3532
			tp->rtl_ops.down(tp);
		}
H
hayeswang 已提交
3533
		napi_enable(&tp->napi);
H
hayeswang 已提交
3534
	}
3535
out1:
H
hayeswang 已提交
3536 3537
	mutex_unlock(&tp->control);

3538
	return ret;
H
hayeswang 已提交
3539 3540 3541 3542 3543 3544
}

static int rtl8152_resume(struct usb_interface *intf)
{
	struct r8152 *tp = usb_get_intfdata(intf);

H
hayeswang 已提交
3545 3546
	mutex_lock(&tp->control);

H
hayeswang 已提交
3547 3548 3549 3550 3551
	if (!test_bit(SELECTIVE_SUSPEND, &tp->flags)) {
		tp->rtl_ops.init(tp);
		netif_device_attach(tp->netdev);
	}

3552
	if (netif_running(tp->netdev) && tp->netdev->flags & IFF_UP) {
H
hayeswang 已提交
3553
		if (test_bit(SELECTIVE_SUSPEND, &tp->flags)) {
3554
			tp->rtl_ops.autosuspend_en(tp, false);
H
hayeswang 已提交
3555
			clear_bit(SELECTIVE_SUSPEND, &tp->flags);
3556
			napi_disable(&tp->napi);
3557
			set_bit(WORK_ENABLE, &tp->flags);
3558
			if (netif_carrier_ok(tp->netdev))
3559
				rtl_start_rx(tp);
3560
			napi_enable(&tp->napi);
H
hayeswang 已提交
3561 3562 3563
		} else {
			tp->rtl_ops.up(tp);
			rtl8152_set_speed(tp, AUTONEG_ENABLE,
H
hayeswang 已提交
3564 3565 3566
					  tp->mii.supports_gmii ?
					  SPEED_1000 : SPEED_100,
					  DUPLEX_FULL);
3567 3568
			netif_carrier_off(tp->netdev);
			set_bit(WORK_ENABLE, &tp->flags);
H
hayeswang 已提交
3569
		}
3570
		usb_submit_urb(tp->intr_urb, GFP_KERNEL);
3571
	} else if (test_bit(SELECTIVE_SUSPEND, &tp->flags)) {
3572
		if (tp->netdev->flags & IFF_UP)
3573
			tp->rtl_ops.autosuspend_en(tp, false);
3574
		clear_bit(SELECTIVE_SUSPEND, &tp->flags);
H
hayeswang 已提交
3575 3576
	}

H
hayeswang 已提交
3577 3578
	mutex_unlock(&tp->control);

H
hayeswang 已提交
3579 3580 3581
	return 0;
}

H
hayeswang 已提交
3582 3583 3584 3585 3586 3587 3588 3589
static int rtl8152_reset_resume(struct usb_interface *intf)
{
	struct r8152 *tp = usb_get_intfdata(intf);

	clear_bit(SELECTIVE_SUSPEND, &tp->flags);
	return rtl8152_resume(intf);
}

H
hayeswang 已提交
3590 3591 3592 3593
static void rtl8152_get_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
{
	struct r8152 *tp = netdev_priv(dev);

H
hayeswang 已提交
3594 3595 3596
	if (usb_autopm_get_interface(tp->intf) < 0)
		return;

H
hayeswang 已提交
3597 3598 3599 3600 3601 3602 3603 3604 3605
	if (!rtl_can_wakeup(tp)) {
		wol->supported = 0;
		wol->wolopts = 0;
	} else {
		mutex_lock(&tp->control);
		wol->supported = WAKE_ANY;
		wol->wolopts = __rtl_get_wol(tp);
		mutex_unlock(&tp->control);
	}
H
hayeswang 已提交
3606

H
hayeswang 已提交
3607
	usb_autopm_put_interface(tp->intf);
H
hayeswang 已提交
3608 3609 3610 3611 3612
}

static int rtl8152_set_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
{
	struct r8152 *tp = netdev_priv(dev);
H
hayeswang 已提交
3613 3614
	int ret;

H
hayeswang 已提交
3615 3616 3617
	if (!rtl_can_wakeup(tp))
		return -EOPNOTSUPP;

H
hayeswang 已提交
3618 3619 3620
	ret = usb_autopm_get_interface(tp->intf);
	if (ret < 0)
		goto out_set_wol;
H
hayeswang 已提交
3621

H
hayeswang 已提交
3622 3623
	mutex_lock(&tp->control);

H
hayeswang 已提交
3624 3625 3626
	__rtl_set_wol(tp, wol->wolopts);
	tp->saved_wolopts = wol->wolopts & WAKE_ANY;

H
hayeswang 已提交
3627 3628
	mutex_unlock(&tp->control);

H
hayeswang 已提交
3629 3630 3631 3632
	usb_autopm_put_interface(tp->intf);

out_set_wol:
	return ret;
H
hayeswang 已提交
3633 3634
}

3635 3636 3637 3638 3639 3640 3641 3642 3643 3644 3645 3646 3647 3648
static u32 rtl8152_get_msglevel(struct net_device *dev)
{
	struct r8152 *tp = netdev_priv(dev);

	return tp->msg_enable;
}

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

	tp->msg_enable = value;
}

H
hayeswang 已提交
3649 3650 3651 3652 3653
static void rtl8152_get_drvinfo(struct net_device *netdev,
				struct ethtool_drvinfo *info)
{
	struct r8152 *tp = netdev_priv(netdev);

H
hayeswang 已提交
3654 3655
	strlcpy(info->driver, MODULENAME, sizeof(info->driver));
	strlcpy(info->version, DRIVER_VERSION, sizeof(info->version));
H
hayeswang 已提交
3656 3657 3658 3659 3660 3661 3662
	usb_make_path(tp->udev, info->bus_info, sizeof(info->bus_info));
}

static
int rtl8152_get_settings(struct net_device *netdev, struct ethtool_cmd *cmd)
{
	struct r8152 *tp = netdev_priv(netdev);
H
hayeswang 已提交
3663
	int ret;
H
hayeswang 已提交
3664 3665 3666 3667

	if (!tp->mii.mdio_read)
		return -EOPNOTSUPP;

H
hayeswang 已提交
3668 3669 3670 3671
	ret = usb_autopm_get_interface(tp->intf);
	if (ret < 0)
		goto out;

H
hayeswang 已提交
3672 3673
	mutex_lock(&tp->control);

H
hayeswang 已提交
3674 3675
	ret = mii_ethtool_gset(&tp->mii, cmd);

H
hayeswang 已提交
3676 3677
	mutex_unlock(&tp->control);

H
hayeswang 已提交
3678 3679 3680 3681
	usb_autopm_put_interface(tp->intf);

out:
	return ret;
H
hayeswang 已提交
3682 3683 3684 3685 3686
}

static int rtl8152_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
{
	struct r8152 *tp = netdev_priv(dev);
H
hayeswang 已提交
3687 3688 3689 3690 3691
	int ret;

	ret = usb_autopm_get_interface(tp->intf);
	if (ret < 0)
		goto out;
H
hayeswang 已提交
3692

H
hayeswang 已提交
3693 3694
	mutex_lock(&tp->control);

H
hayeswang 已提交
3695 3696
	ret = rtl8152_set_speed(tp, cmd->autoneg, cmd->speed, cmd->duplex);

H
hayeswang 已提交
3697 3698
	mutex_unlock(&tp->control);

H
hayeswang 已提交
3699 3700 3701 3702
	usb_autopm_put_interface(tp->intf);

out:
	return ret;
H
hayeswang 已提交
3703 3704
}

3705 3706 3707 3708 3709 3710 3711 3712 3713 3714 3715 3716 3717 3718 3719 3720 3721 3722 3723 3724 3725 3726 3727 3728 3729 3730 3731 3732 3733 3734 3735 3736
static const char rtl8152_gstrings[][ETH_GSTRING_LEN] = {
	"tx_packets",
	"rx_packets",
	"tx_errors",
	"rx_errors",
	"rx_missed",
	"align_errors",
	"tx_single_collisions",
	"tx_multi_collisions",
	"rx_unicast",
	"rx_broadcast",
	"rx_multicast",
	"tx_aborted",
	"tx_underrun",
};

static int rtl8152_get_sset_count(struct net_device *dev, int sset)
{
	switch (sset) {
	case ETH_SS_STATS:
		return ARRAY_SIZE(rtl8152_gstrings);
	default:
		return -EOPNOTSUPP;
	}
}

static void rtl8152_get_ethtool_stats(struct net_device *dev,
				      struct ethtool_stats *stats, u64 *data)
{
	struct r8152 *tp = netdev_priv(dev);
	struct tally_counter tally;

3737 3738 3739
	if (usb_autopm_get_interface(tp->intf) < 0)
		return;

3740 3741
	generic_ocp_read(tp, PLA_TALLYCNT, sizeof(tally), &tally, MCU_TYPE_PLA);

3742 3743
	usb_autopm_put_interface(tp->intf);

3744 3745 3746 3747 3748 3749 3750 3751 3752 3753 3754 3755
	data[0] = le64_to_cpu(tally.tx_packets);
	data[1] = le64_to_cpu(tally.rx_packets);
	data[2] = le64_to_cpu(tally.tx_errors);
	data[3] = le32_to_cpu(tally.rx_errors);
	data[4] = le16_to_cpu(tally.rx_missed);
	data[5] = le16_to_cpu(tally.align_errors);
	data[6] = le32_to_cpu(tally.tx_one_collision);
	data[7] = le32_to_cpu(tally.tx_multi_collision);
	data[8] = le64_to_cpu(tally.rx_unicast);
	data[9] = le64_to_cpu(tally.rx_broadcast);
	data[10] = le32_to_cpu(tally.rx_multicast);
	data[11] = le16_to_cpu(tally.tx_aborted);
H
hayeswang 已提交
3756
	data[12] = le16_to_cpu(tally.tx_underrun);
3757 3758 3759 3760 3761 3762 3763 3764 3765 3766 3767
}

static void rtl8152_get_strings(struct net_device *dev, u32 stringset, u8 *data)
{
	switch (stringset) {
	case ETH_SS_STATS:
		memcpy(data, *rtl8152_gstrings, sizeof(rtl8152_gstrings));
		break;
	}
}

H
hayeswang 已提交
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 3793 3794 3795 3796 3797 3798 3799 3800 3801 3802 3803 3804 3805 3806 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 3854 3855 3856 3857
static int r8152_get_eee(struct r8152 *tp, struct ethtool_eee *eee)
{
	u32 ocp_data, lp, adv, supported = 0;
	u16 val;

	val = r8152_mmd_read(tp, MDIO_MMD_PCS, MDIO_PCS_EEE_ABLE);
	supported = mmd_eee_cap_to_ethtool_sup_t(val);

	val = r8152_mmd_read(tp, MDIO_MMD_AN, MDIO_AN_EEE_ADV);
	adv = mmd_eee_adv_to_ethtool_adv_t(val);

	val = r8152_mmd_read(tp, MDIO_MMD_AN, MDIO_AN_EEE_LPABLE);
	lp = mmd_eee_adv_to_ethtool_adv_t(val);

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_EEE_CR);
	ocp_data &= EEE_RX_EN | EEE_TX_EN;

	eee->eee_enabled = !!ocp_data;
	eee->eee_active = !!(supported & adv & lp);
	eee->supported = supported;
	eee->advertised = adv;
	eee->lp_advertised = lp;

	return 0;
}

static int r8152_set_eee(struct r8152 *tp, struct ethtool_eee *eee)
{
	u16 val = ethtool_adv_to_mmd_eee_adv_t(eee->advertised);

	r8152_eee_en(tp, eee->eee_enabled);

	if (!eee->eee_enabled)
		val = 0;

	r8152_mmd_write(tp, MDIO_MMD_AN, MDIO_AN_EEE_ADV, val);

	return 0;
}

static int r8153_get_eee(struct r8152 *tp, struct ethtool_eee *eee)
{
	u32 ocp_data, lp, adv, supported = 0;
	u16 val;

	val = ocp_reg_read(tp, OCP_EEE_ABLE);
	supported = mmd_eee_cap_to_ethtool_sup_t(val);

	val = ocp_reg_read(tp, OCP_EEE_ADV);
	adv = mmd_eee_adv_to_ethtool_adv_t(val);

	val = ocp_reg_read(tp, OCP_EEE_LPABLE);
	lp = mmd_eee_adv_to_ethtool_adv_t(val);

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_EEE_CR);
	ocp_data &= EEE_RX_EN | EEE_TX_EN;

	eee->eee_enabled = !!ocp_data;
	eee->eee_active = !!(supported & adv & lp);
	eee->supported = supported;
	eee->advertised = adv;
	eee->lp_advertised = lp;

	return 0;
}

static int r8153_set_eee(struct r8152 *tp, struct ethtool_eee *eee)
{
	u16 val = ethtool_adv_to_mmd_eee_adv_t(eee->advertised);

	r8153_eee_en(tp, eee->eee_enabled);

	if (!eee->eee_enabled)
		val = 0;

	ocp_reg_write(tp, OCP_EEE_ADV, val);

	return 0;
}

static int
rtl_ethtool_get_eee(struct net_device *net, struct ethtool_eee *edata)
{
	struct r8152 *tp = netdev_priv(net);
	int ret;

	ret = usb_autopm_get_interface(tp->intf);
	if (ret < 0)
		goto out;

H
hayeswang 已提交
3858 3859
	mutex_lock(&tp->control);

H
hayeswang 已提交
3860 3861
	ret = tp->rtl_ops.eee_get(tp, edata);

H
hayeswang 已提交
3862 3863
	mutex_unlock(&tp->control);

H
hayeswang 已提交
3864 3865 3866 3867 3868 3869 3870 3871 3872 3873 3874 3875 3876 3877 3878 3879
	usb_autopm_put_interface(tp->intf);

out:
	return ret;
}

static int
rtl_ethtool_set_eee(struct net_device *net, struct ethtool_eee *edata)
{
	struct r8152 *tp = netdev_priv(net);
	int ret;

	ret = usb_autopm_get_interface(tp->intf);
	if (ret < 0)
		goto out;

H
hayeswang 已提交
3880 3881
	mutex_lock(&tp->control);

H
hayeswang 已提交
3882
	ret = tp->rtl_ops.eee_set(tp, edata);
H
hayeswang 已提交
3883 3884
	if (!ret)
		ret = mii_nway_restart(&tp->mii);
H
hayeswang 已提交
3885

H
hayeswang 已提交
3886 3887
	mutex_unlock(&tp->control);

H
hayeswang 已提交
3888 3889 3890 3891 3892 3893
	usb_autopm_put_interface(tp->intf);

out:
	return ret;
}

H
hayeswang 已提交
3894 3895 3896 3897 3898 3899 3900 3901 3902 3903 3904 3905 3906 3907 3908 3909 3910 3911 3912 3913 3914
static int rtl8152_nway_reset(struct net_device *dev)
{
	struct r8152 *tp = netdev_priv(dev);
	int ret;

	ret = usb_autopm_get_interface(tp->intf);
	if (ret < 0)
		goto out;

	mutex_lock(&tp->control);

	ret = mii_nway_restart(&tp->mii);

	mutex_unlock(&tp->control);

	usb_autopm_put_interface(tp->intf);

out:
	return ret;
}

H
hayeswang 已提交
3915 3916 3917 3918 3919 3920 3921 3922 3923 3924 3925 3926 3927 3928 3929 3930 3931 3932 3933 3934 3935 3936 3937 3938 3939 3940 3941 3942 3943 3944 3945 3946 3947 3948 3949 3950 3951 3952 3953 3954 3955 3956 3957 3958 3959 3960 3961 3962 3963 3964 3965 3966 3967 3968 3969
static int rtl8152_get_coalesce(struct net_device *netdev,
				struct ethtool_coalesce *coalesce)
{
	struct r8152 *tp = netdev_priv(netdev);

	switch (tp->version) {
	case RTL_VER_01:
	case RTL_VER_02:
		return -EOPNOTSUPP;
	default:
		break;
	}

	coalesce->rx_coalesce_usecs = tp->coalesce;

	return 0;
}

static int rtl8152_set_coalesce(struct net_device *netdev,
				struct ethtool_coalesce *coalesce)
{
	struct r8152 *tp = netdev_priv(netdev);
	int ret;

	switch (tp->version) {
	case RTL_VER_01:
	case RTL_VER_02:
		return -EOPNOTSUPP;
	default:
		break;
	}

	if (coalesce->rx_coalesce_usecs > COALESCE_SLOW)
		return -EINVAL;

	ret = usb_autopm_get_interface(tp->intf);
	if (ret < 0)
		return ret;

	mutex_lock(&tp->control);

	if (tp->coalesce != coalesce->rx_coalesce_usecs) {
		tp->coalesce = coalesce->rx_coalesce_usecs;

		if (netif_running(tp->netdev) && netif_carrier_ok(netdev))
			r8153_set_rx_early_timeout(tp);
	}

	mutex_unlock(&tp->control);

	usb_autopm_put_interface(tp->intf);

	return ret;
}

H
hayeswang 已提交
3970 3971 3972 3973 3974
static struct ethtool_ops ops = {
	.get_drvinfo = rtl8152_get_drvinfo,
	.get_settings = rtl8152_get_settings,
	.set_settings = rtl8152_set_settings,
	.get_link = ethtool_op_get_link,
H
hayeswang 已提交
3975
	.nway_reset = rtl8152_nway_reset,
3976 3977
	.get_msglevel = rtl8152_get_msglevel,
	.set_msglevel = rtl8152_set_msglevel,
H
hayeswang 已提交
3978 3979
	.get_wol = rtl8152_get_wol,
	.set_wol = rtl8152_set_wol,
3980 3981 3982
	.get_strings = rtl8152_get_strings,
	.get_sset_count = rtl8152_get_sset_count,
	.get_ethtool_stats = rtl8152_get_ethtool_stats,
H
hayeswang 已提交
3983 3984
	.get_coalesce = rtl8152_get_coalesce,
	.set_coalesce = rtl8152_set_coalesce,
H
hayeswang 已提交
3985 3986
	.get_eee = rtl_ethtool_get_eee,
	.set_eee = rtl_ethtool_set_eee,
H
hayeswang 已提交
3987 3988 3989 3990 3991 3992
};

static int rtl8152_ioctl(struct net_device *netdev, struct ifreq *rq, int cmd)
{
	struct r8152 *tp = netdev_priv(netdev);
	struct mii_ioctl_data *data = if_mii(rq);
H
hayeswang 已提交
3993 3994
	int res;

H
hayeswang 已提交
3995 3996 3997
	if (test_bit(RTL8152_UNPLUG, &tp->flags))
		return -ENODEV;

H
hayeswang 已提交
3998 3999 4000
	res = usb_autopm_get_interface(tp->intf);
	if (res < 0)
		goto out;
H
hayeswang 已提交
4001 4002 4003 4004 4005 4006 4007

	switch (cmd) {
	case SIOCGMIIPHY:
		data->phy_id = R8152_PHY_ID; /* Internal PHY */
		break;

	case SIOCGMIIREG:
H
hayeswang 已提交
4008
		mutex_lock(&tp->control);
H
hayeswang 已提交
4009
		data->val_out = r8152_mdio_read(tp, data->reg_num);
H
hayeswang 已提交
4010
		mutex_unlock(&tp->control);
H
hayeswang 已提交
4011 4012 4013 4014 4015 4016 4017
		break;

	case SIOCSMIIREG:
		if (!capable(CAP_NET_ADMIN)) {
			res = -EPERM;
			break;
		}
H
hayeswang 已提交
4018
		mutex_lock(&tp->control);
H
hayeswang 已提交
4019
		r8152_mdio_write(tp, data->reg_num, data->val_in);
H
hayeswang 已提交
4020
		mutex_unlock(&tp->control);
H
hayeswang 已提交
4021 4022 4023 4024 4025 4026
		break;

	default:
		res = -EOPNOTSUPP;
	}

H
hayeswang 已提交
4027 4028 4029
	usb_autopm_put_interface(tp->intf);

out:
H
hayeswang 已提交
4030 4031 4032
	return res;
}

4033 4034 4035
static int rtl8152_change_mtu(struct net_device *dev, int new_mtu)
{
	struct r8152 *tp = netdev_priv(dev);
4036
	int ret;
4037 4038 4039 4040 4041 4042 4043 4044 4045 4046 4047 4048

	switch (tp->version) {
	case RTL_VER_01:
	case RTL_VER_02:
		return eth_change_mtu(dev, new_mtu);
	default:
		break;
	}

	if (new_mtu < 68 || new_mtu > RTL8153_MAX_MTU)
		return -EINVAL;

4049 4050 4051 4052 4053 4054
	ret = usb_autopm_get_interface(tp->intf);
	if (ret < 0)
		return ret;

	mutex_lock(&tp->control);

4055 4056
	dev->mtu = new_mtu;

4057 4058 4059 4060 4061 4062 4063 4064
	if (netif_running(dev) && netif_carrier_ok(dev))
		r8153_set_rx_early_size(tp);

	mutex_unlock(&tp->control);

	usb_autopm_put_interface(tp->intf);

	return ret;
4065 4066
}

H
hayeswang 已提交
4067 4068 4069 4070 4071 4072
static const struct net_device_ops rtl8152_netdev_ops = {
	.ndo_open		= rtl8152_open,
	.ndo_stop		= rtl8152_close,
	.ndo_do_ioctl		= rtl8152_ioctl,
	.ndo_start_xmit		= rtl8152_start_xmit,
	.ndo_tx_timeout		= rtl8152_tx_timeout,
H
hayeswang 已提交
4073
	.ndo_set_features	= rtl8152_set_features,
H
hayeswang 已提交
4074 4075
	.ndo_set_rx_mode	= rtl8152_set_rx_mode,
	.ndo_set_mac_address	= rtl8152_set_mac_address,
4076
	.ndo_change_mtu		= rtl8152_change_mtu,
H
hayeswang 已提交
4077
	.ndo_validate_addr	= eth_validate_addr,
H
hayeswang 已提交
4078
	.ndo_features_check	= rtl8152_features_check,
H
hayeswang 已提交
4079 4080 4081 4082 4083 4084 4085 4086 4087 4088 4089 4090 4091 4092 4093 4094 4095
};

static void r8152b_get_version(struct r8152 *tp)
{
	u32	ocp_data;
	u16	version;

	ocp_data = ocp_read_word(tp, MCU_TYPE_PLA, PLA_TCR1);
	version = (u16)(ocp_data & VERSION_MASK);

	switch (version) {
	case 0x4c00:
		tp->version = RTL_VER_01;
		break;
	case 0x4c10:
		tp->version = RTL_VER_02;
		break;
H
hayeswang 已提交
4096 4097 4098 4099 4100 4101 4102 4103 4104 4105 4106 4107
	case 0x5c00:
		tp->version = RTL_VER_03;
		tp->mii.supports_gmii = 1;
		break;
	case 0x5c10:
		tp->version = RTL_VER_04;
		tp->mii.supports_gmii = 1;
		break;
	case 0x5c20:
		tp->version = RTL_VER_05;
		tp->mii.supports_gmii = 1;
		break;
H
hayeswang 已提交
4108 4109 4110 4111
	case 0x5c30:
		tp->version = RTL_VER_06;
		tp->mii.supports_gmii = 1;
		break;
H
hayeswang 已提交
4112 4113 4114 4115 4116 4117 4118
	default:
		netif_info(tp, probe, tp->netdev,
			   "Unknown version 0x%04x\n", version);
		break;
	}
}

4119 4120
static void rtl8152_unload(struct r8152 *tp)
{
H
hayeswang 已提交
4121 4122 4123
	if (test_bit(RTL8152_UNPLUG, &tp->flags))
		return;

H
hayeswang 已提交
4124 4125
	if (tp->version != RTL_VER_01)
		r8152_power_cut_en(tp, true);
4126 4127
}

H
hayeswang 已提交
4128 4129
static void rtl8153_unload(struct r8152 *tp)
{
H
hayeswang 已提交
4130 4131 4132
	if (test_bit(RTL8152_UNPLUG, &tp->flags))
		return;

H
hayeswang 已提交
4133
	r8153_power_cut_en(tp, false);
H
hayeswang 已提交
4134 4135
}

H
hayeswang 已提交
4136
static int rtl_ops_init(struct r8152 *tp)
H
hayeswang 已提交
4137 4138
{
	struct rtl_ops *ops = &tp->rtl_ops;
H
hayeswang 已提交
4139 4140 4141 4142 4143 4144 4145 4146 4147 4148 4149 4150 4151
	int ret = 0;

	switch (tp->version) {
	case RTL_VER_01:
	case RTL_VER_02:
		ops->init		= r8152b_init;
		ops->enable		= rtl8152_enable;
		ops->disable		= rtl8152_disable;
		ops->up			= rtl8152_up;
		ops->down		= rtl8152_down;
		ops->unload		= rtl8152_unload;
		ops->eee_get		= r8152_get_eee;
		ops->eee_set		= r8152_set_eee;
4152
		ops->in_nway		= rtl8152_in_nway;
4153
		ops->autosuspend_en	= rtl_runtime_suspend_enable;
H
hayeswang 已提交
4154 4155
		break;

H
hayeswang 已提交
4156 4157 4158
	case RTL_VER_03:
	case RTL_VER_04:
	case RTL_VER_05:
H
hayeswang 已提交
4159
	case RTL_VER_06:
H
hayeswang 已提交
4160 4161 4162 4163 4164 4165 4166 4167
		ops->init		= r8153_init;
		ops->enable		= rtl8153_enable;
		ops->disable		= rtl8153_disable;
		ops->up			= rtl8153_up;
		ops->down		= rtl8153_down;
		ops->unload		= rtl8153_unload;
		ops->eee_get		= r8153_get_eee;
		ops->eee_set		= r8153_set_eee;
4168
		ops->in_nway		= rtl8153_in_nway;
4169
		ops->autosuspend_en	= rtl8153_runtime_enable;
H
hayeswang 已提交
4170 4171 4172
		break;

	default:
H
hayeswang 已提交
4173 4174
		ret = -ENODEV;
		netif_err(tp, probe, tp->netdev, "Unknown Device\n");
H
hayeswang 已提交
4175 4176 4177 4178 4179 4180
		break;
	}

	return ret;
}

H
hayeswang 已提交
4181 4182 4183 4184 4185 4186
static int rtl8152_probe(struct usb_interface *intf,
			 const struct usb_device_id *id)
{
	struct usb_device *udev = interface_to_usbdev(intf);
	struct r8152 *tp;
	struct net_device *netdev;
H
hayeswang 已提交
4187
	int ret;
H
hayeswang 已提交
4188

H
hayeswang 已提交
4189 4190 4191 4192 4193 4194
	if (udev->actconfig->desc.bConfigurationValue != 1) {
		usb_driver_set_configuration(udev, 1);
		return -ENODEV;
	}

	usb_reset_device(udev);
H
hayeswang 已提交
4195 4196
	netdev = alloc_etherdev(sizeof(struct r8152));
	if (!netdev) {
H
Hayes Wang 已提交
4197
		dev_err(&intf->dev, "Out of memory\n");
H
hayeswang 已提交
4198 4199 4200
		return -ENOMEM;
	}

H
hayeswang 已提交
4201
	SET_NETDEV_DEV(netdev, &intf->dev);
H
hayeswang 已提交
4202 4203 4204
	tp = netdev_priv(netdev);
	tp->msg_enable = 0x7FFF;

4205 4206 4207 4208
	tp->udev = udev;
	tp->netdev = netdev;
	tp->intf = intf;

H
hayeswang 已提交
4209
	r8152b_get_version(tp);
H
hayeswang 已提交
4210
	ret = rtl_ops_init(tp);
4211 4212
	if (ret)
		goto out;
H
hayeswang 已提交
4213

H
hayeswang 已提交
4214
	mutex_init(&tp->control);
H
hayeswang 已提交
4215 4216 4217 4218
	INIT_DELAYED_WORK(&tp->schedule, rtl_work_func_t);

	netdev->netdev_ops = &rtl8152_netdev_ops;
	netdev->watchdog_timeo = RTL8152_TX_TIMEOUT;
H
hayeswang 已提交
4219

H
hayeswang 已提交
4220
	netdev->features |= NETIF_F_RXCSUM | NETIF_F_IP_CSUM | NETIF_F_SG |
H
hayeswang 已提交
4221
			    NETIF_F_TSO | NETIF_F_FRAGLIST | NETIF_F_IPV6_CSUM |
H
hayeswang 已提交
4222 4223
			    NETIF_F_TSO6 | NETIF_F_HW_VLAN_CTAG_RX |
			    NETIF_F_HW_VLAN_CTAG_TX;
H
hayeswang 已提交
4224
	netdev->hw_features = NETIF_F_RXCSUM | NETIF_F_IP_CSUM | NETIF_F_SG |
H
hayeswang 已提交
4225
			      NETIF_F_TSO | NETIF_F_FRAGLIST |
H
hayeswang 已提交
4226
			      NETIF_F_IPV6_CSUM | NETIF_F_TSO6 |
4227
			      NETIF_F_HW_VLAN_CTAG_RX | NETIF_F_HW_VLAN_CTAG_TX;
H
hayeswang 已提交
4228 4229 4230
	netdev->vlan_features = NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_TSO |
				NETIF_F_HIGHDMA | NETIF_F_FRAGLIST |
				NETIF_F_IPV6_CSUM | NETIF_F_TSO6;
4231

4232
	netdev->ethtool_ops = &ops;
H
hayeswang 已提交
4233
	netif_set_gso_max_size(netdev, RTL_LIMITED_TSO_SIZE);
H
hayeswang 已提交
4234 4235 4236 4237 4238 4239 4240 4241

	tp->mii.dev = netdev;
	tp->mii.mdio_read = read_mii_word;
	tp->mii.mdio_write = write_mii_word;
	tp->mii.phy_id_mask = 0x3f;
	tp->mii.reg_num_mask = 0x1f;
	tp->mii.phy_id = R8152_PHY_ID;

H
hayeswang 已提交
4242 4243
	switch (udev->speed) {
	case USB_SPEED_SUPER:
O
Oliver Neukum 已提交
4244
	case USB_SPEED_SUPER_PLUS:
H
hayeswang 已提交
4245 4246 4247 4248 4249 4250 4251 4252 4253 4254
		tp->coalesce = COALESCE_SUPER;
		break;
	case USB_SPEED_HIGH:
		tp->coalesce = COALESCE_HIGH;
		break;
	default:
		tp->coalesce = COALESCE_SLOW;
		break;
	}

H
hayeswang 已提交
4255 4256
	intf->needs_remote_wakeup = 1;

H
hayeswang 已提交
4257
	tp->rtl_ops.init(tp);
H
hayeswang 已提交
4258 4259 4260
	set_ethernet_addr(tp);

	usb_set_intfdata(intf, tp);
H
hayeswang 已提交
4261
	netif_napi_add(netdev, &tp->napi, r8152_poll, RTL8152_NAPI_WEIGHT);
H
hayeswang 已提交
4262

H
hayeswang 已提交
4263 4264
	ret = register_netdev(netdev);
	if (ret != 0) {
H
Hayes Wang 已提交
4265
		netif_err(tp, probe, netdev, "couldn't register the device\n");
H
hayeswang 已提交
4266
		goto out1;
H
hayeswang 已提交
4267 4268
	}

H
hayeswang 已提交
4269 4270 4271
	if (!rtl_can_wakeup(tp))
		__rtl_set_wol(tp, 0);

H
hayeswang 已提交
4272 4273 4274 4275 4276 4277
	tp->saved_wolopts = __rtl_get_wol(tp);
	if (tp->saved_wolopts)
		device_set_wakeup_enable(&udev->dev, true);
	else
		device_set_wakeup_enable(&udev->dev, false);

H
Hayes Wang 已提交
4278
	netif_info(tp, probe, netdev, "%s\n", DRIVER_VERSION);
H
hayeswang 已提交
4279 4280 4281 4282

	return 0;

out1:
H
hayeswang 已提交
4283
	netif_napi_del(&tp->napi);
H
hayeswang 已提交
4284
	usb_set_intfdata(intf, NULL);
H
hayeswang 已提交
4285 4286
out:
	free_netdev(netdev);
H
hayeswang 已提交
4287
	return ret;
H
hayeswang 已提交
4288 4289 4290 4291 4292 4293 4294 4295
}

static void rtl8152_disconnect(struct usb_interface *intf)
{
	struct r8152 *tp = usb_get_intfdata(intf);

	usb_set_intfdata(intf, NULL);
	if (tp) {
H
hayeswang 已提交
4296 4297 4298 4299 4300
		struct usb_device *udev = tp->udev;

		if (udev->state == USB_STATE_NOTATTACHED)
			set_bit(RTL8152_UNPLUG, &tp->flags);

H
hayeswang 已提交
4301
		netif_napi_del(&tp->napi);
H
hayeswang 已提交
4302
		unregister_netdev(tp->netdev);
H
hayeswang 已提交
4303
		tp->rtl_ops.unload(tp);
H
hayeswang 已提交
4304 4305 4306 4307
		free_netdev(tp->netdev);
	}
}

H
hayeswang 已提交
4308 4309 4310 4311 4312 4313 4314 4315 4316 4317 4318 4319 4320 4321 4322 4323
#define REALTEK_USB_DEVICE(vend, prod)	\
	.match_flags = USB_DEVICE_ID_MATCH_DEVICE | \
		       USB_DEVICE_ID_MATCH_INT_CLASS, \
	.idVendor = (vend), \
	.idProduct = (prod), \
	.bInterfaceClass = USB_CLASS_VENDOR_SPEC \
}, \
{ \
	.match_flags = USB_DEVICE_ID_MATCH_INT_INFO | \
		       USB_DEVICE_ID_MATCH_DEVICE, \
	.idVendor = (vend), \
	.idProduct = (prod), \
	.bInterfaceClass = USB_CLASS_COMM, \
	.bInterfaceSubClass = USB_CDC_SUBCLASS_ETHERNET, \
	.bInterfaceProtocol = USB_CDC_PROTO_NONE

H
hayeswang 已提交
4324 4325
/* table of devices that work with this driver */
static struct usb_device_id rtl8152_table[] = {
H
hayeswang 已提交
4326 4327 4328
	{REALTEK_USB_DEVICE(VENDOR_ID_REALTEK, 0x8152)},
	{REALTEK_USB_DEVICE(VENDOR_ID_REALTEK, 0x8153)},
	{REALTEK_USB_DEVICE(VENDOR_ID_SAMSUNG, 0xa101)},
4329
	{REALTEK_USB_DEVICE(VENDOR_ID_LENOVO,  0x7205)},
4330
	{REALTEK_USB_DEVICE(VENDOR_ID_LENOVO,  0x304f)},
4331
	{REALTEK_USB_DEVICE(VENDOR_ID_NVIDIA,  0x09ff)},
H
hayeswang 已提交
4332 4333 4334 4335 4336 4337 4338
	{}
};

MODULE_DEVICE_TABLE(usb, rtl8152_table);

static struct usb_driver rtl8152_driver = {
	.name =		MODULENAME,
H
hayeswang 已提交
4339
	.id_table =	rtl8152_table,
H
hayeswang 已提交
4340 4341 4342
	.probe =	rtl8152_probe,
	.disconnect =	rtl8152_disconnect,
	.suspend =	rtl8152_suspend,
H
hayeswang 已提交
4343
	.resume =	rtl8152_resume,
H
hayeswang 已提交
4344
	.reset_resume =	rtl8152_reset_resume,
H
hayeswang 已提交
4345 4346
	.pre_reset =	rtl8152_pre_reset,
	.post_reset =	rtl8152_post_reset,
H
hayeswang 已提交
4347
	.supports_autosuspend = 1,
H
hayeswang 已提交
4348
	.disable_hub_initiated_lpm = 1,
H
hayeswang 已提交
4349 4350
};

4351
module_usb_driver(rtl8152_driver);
H
hayeswang 已提交
4352 4353 4354 4355

MODULE_AUTHOR(DRIVER_AUTHOR);
MODULE_DESCRIPTION(DRIVER_DESC);
MODULE_LICENSE("GPL");