WebSVN – Kolibri OS – Blame – /drivers/ethernet/RTL8169.asm

Rev	Author	Line No.	Line
3545	hidnplayr	1	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		2	;; ;;
8997	hidnplayr	3	;; Copyright (C) KolibriOS team 2004-2021. All rights reserved. ;;
3545	hidnplayr	4	;; Distributed under terms of the GNU General Public License ;;
		5	;; ;;
		6	;; RTL8169 driver for KolibriOS ;;
		7	;; ;;
		8	;; Copyright 2007 mike.dld, ;;
		9	;; mike.dld@gmail.com ;;
		10	;; ;;
6119	hidnplayr	11	;; Port to the new network stack by hidnplayr ;;
3545	hidnplayr	12	;; ;;
		13	;; References: ;;
6124	hidnplayr	14	;; r8169.c - linux driver ;;
3545	hidnplayr	15	;; ;;
		16	;; GNU GENERAL PUBLIC LICENSE ;;
		17	;; Version 2, June 1991 ;;
		18	;; ;;
		19	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		20
5050	hidnplayr	21	format PE DLL native
		22	entry START
3545	hidnplayr	23
5050	hidnplayr	24	CURRENT_API = 0x0200
		25	COMPATIBLE_API = 0x0100
		26	API_VERSION = (COMPATIBLE_API shl 16) + CURRENT_API
3545	hidnplayr	27
8997	hidnplayr	28	; configureable area
3545	hidnplayr	29
8997	hidnplayr	30	MAX_DEVICES = 16 ; Maximum number of devices this driver may handle
		31
		32	__DEBUG__ = 1 ; 1 = on, 0 = off
5050	hidnplayr	33	__DEBUG_LEVEL__ = 2 ; 1 = verbose, 2 = errors only
3545	hidnplayr	34
8997	hidnplayr	35	NUM_TX_DESC = 32 ; Number of packets in send ring buffer
		36	NUM_RX_DESC = 32 ; Number of packets in receive ring buffer
3545	hidnplayr	37
8997	hidnplayr	38	; end configureable area
		39
5050	hidnplayr	40	section '.flat' readable writable executable
		41
		42	include '../proc32.inc'
4467	hidnplayr	43	include '../struct.inc'
		44	include '../macros.inc'
3545	hidnplayr	45	include '../fdo.inc'
5074	hidnplayr	46	include '../netdrv.inc'
3545	hidnplayr	47
8997	hidnplayr	48	if (bsr NUM_TX_DESC)>(bsf NUM_TX_DESC)
		49	display 'NUM_TX_DESC must be a power of two'
		50	err
		51	end if
		52
		53	if (bsr NUM_RX_DESC)>(bsf NUM_RX_DESC)
		54	display 'NUM_RX_DESC must be a power of two'
		55	err
		56	end if
		57
3545	hidnplayr	58	REG_MAC0 = 0x0 ; Ethernet hardware address
		59	REG_MAR0 = 0x8 ; Multicast filter
		60	REG_TxDescStartAddr = 0x20
		61	REG_TxHDescStartAddr = 0x28
		62	REG_FLASH = 0x30
		63	REG_ERSR = 0x36
		64	REG_ChipCmd = 0x37
		65	REG_TxPoll = 0x38
		66	REG_IntrMask = 0x3C
		67	REG_IntrStatus = 0x3E
		68	REG_TxConfig = 0x40
		69	REG_RxConfig = 0x44
		70	REG_RxMissed = 0x4C
		71	REG_Cfg9346 = 0x50
		72	REG_Config0 = 0x51
		73	REG_Config1 = 0x52
		74	REG_Config2 = 0x53
		75	REG_Config3 = 0x54
		76	REG_Config4 = 0x55
		77	REG_Config5 = 0x56
		78	REG_MultiIntr = 0x5C
		79	REG_PHYAR = 0x60
		80	REG_TBICSR = 0x64
		81	REG_TBI_ANAR = 0x68
		82	REG_TBI_LPAR = 0x6A
		83	REG_PHYstatus = 0x6C
		84	REG_RxMaxSize = 0xDA
		85	REG_CPlusCmd = 0xE0
		86	REG_RxDescStartAddr = 0xE4
		87	REG_ETThReg = 0xEC
		88	REG_FuncEvent = 0xF0
		89	REG_FuncEventMask = 0xF4
		90	REG_FuncPresetState = 0xF8
		91	REG_FuncForceEvent = 0xFC
		92
		93	; InterruptStatusBits
		94	ISB_SYSErr = 0x8000
		95	ISB_PCSTimeout = 0x4000
		96	ISB_SWInt = 0x0100
		97	ISB_TxDescUnavail = 0x80
		98	ISB_RxFIFOOver = 0x40
		99	ISB_LinkChg = 0x20
		100	ISB_RxOverflow = 0x10
		101	ISB_TxErr = 0x08
		102	ISB_TxOK = 0x04
		103	ISB_RxErr = 0x02
		104	ISB_RxOK = 0x01
		105
		106	; RxStatusDesc
8997	hidnplayr	107	SD_RxBOVF = (1 shl 24)
		108	SD_RxFOVF = (1 shl 23)
		109	SD_RxRWT = (1 shl 22)
		110	SD_RxRES = (1 shl 21)
		111	SD_RxRUNT = (1 shl 20)
		112	SD_RxCRC = (1 shl 19)
3545	hidnplayr	113
		114	; ChipCmdBits
		115	CMD_Reset = 0x10
		116	CMD_RxEnb = 0x08
		117	CMD_TxEnb = 0x04
		118	CMD_RxBufEmpty = 0x01
		119
		120	; Cfg9346Bits
		121	CFG_9346_Lock = 0x00
		122	CFG_9346_Unlock = 0xC0
		123
		124	; rx_mode_bits
		125	RXM_AcceptErr = 0x20
		126	RXM_AcceptRunt = 0x10
		127	RXM_AcceptBroadcast = 0x08
		128	RXM_AcceptMulticast = 0x04
		129	RXM_AcceptMyPhys = 0x02
		130	RXM_AcceptAllPhys = 0x01
		131
		132	; RxConfigBits
		133	RXC_FIFOShift = 13
		134	RXC_DMAShift = 8
		135
		136	; TxConfigBits
		137	TXC_InterFrameGapShift = 24
		138	TXC_DMAShift = 8 ; DMA burst value (0-7) is shift this many bits
		139
		140	; PHYstatus
		141	PHYS_TBI_Enable = 0x80
		142	PHYS_TxFlowCtrl = 0x40
		143	PHYS_RxFlowCtrl = 0x20
		144	PHYS_1000bpsF = 0x10
		145	PHYS_100bps = 0x08
		146	PHYS_10bps = 0x04
		147	PHYS_LinkStatus = 0x02
		148	PHYS_FullDup = 0x01
		149
		150	; GIGABIT_PHY_registers
		151	PHY_CTRL_REG = 0
		152	PHY_STAT_REG = 1
		153	PHY_AUTO_NEGO_REG = 4
		154	PHY_1000_CTRL_REG = 9
		155
		156	; GIGABIT_PHY_REG_BIT
		157	PHY_Restart_Auto_Nego = 0x0200
		158	PHY_Enable_Auto_Nego = 0x1000
		159
		160	; PHY_STAT_REG = 1
		161	PHY_Auto_Neco_Comp = 0x0020
		162
		163	; PHY_AUTO_NEGO_REG = 4
		164	PHY_Cap_10_Half = 0x0020
		165	PHY_Cap_10_Full = 0x0040
		166	PHY_Cap_100_Half = 0x0080
		167	PHY_Cap_100_Full = 0x0100
		168
		169	; PHY_1000_CTRL_REG = 9
		170	PHY_Cap_1000_Full = 0x0200
		171	PHY_Cap_1000_Half = 0x0100
		172
		173	PHY_Cap_PAUSE = 0x0400
		174	PHY_Cap_ASYM_PAUSE = 0x0800
		175
		176	PHY_Cap_Null = 0x0
		177
		178	; _MediaType
		179	MT_10_Half = 0x01
		180	MT_10_Full = 0x02
		181	MT_100_Half = 0x04
		182	MT_100_Full = 0x08
		183	MT_1000_Full = 0x10
		184
		185	; _TBICSRBit
5567	hidnplayr	186	TBI_RESET = 0x80000000
		187	TBI_LOOPBACK = 0x40000000
		188	TBI_NW_ENABLE = 0x20000000
		189	TBI_NW_RESTART = 0x10000000
		190	TBI_LINK_OK = 0x02000000
		191	TBI_NW_COMPLETE = 0x01000000
3545	hidnplayr	192
		193	; _DescStatusBit
		194	DSB_OWNbit = 0x80000000
		195	DSB_EORbit = 0x40000000
		196	DSB_FSbit = 0x20000000
		197	DSB_LSbit = 0x10000000
		198
5522	hidnplayr	199	RX_BUF_SIZE = 1514 ; Rx Buffer size
3545	hidnplayr	200
		201	; max supported gigabit ethernet frame size -- must be at least (dev->mtu+14+4)
5522	hidnplayr	202	MAX_ETH_FRAME_SIZE = 1514
3545	hidnplayr	203
		204	TX_FIFO_THRESH = 256 ; In bytes
		205
		206	RX_FIFO_THRESH = 7 ; 7 means NO threshold, Rx buffer level before first PCI xfer
		207	RX_DMA_BURST = 7 ; Maximum PCI burst, '6' is 1024
		208	TX_DMA_BURST = 7 ; Maximum PCI burst, '6' is 1024
		209	ETTh = 0x3F ; 0x3F means NO threshold
		210
		211	EarlyTxThld = 0x3F ; 0x3F means NO early transmit
		212	RxPacketMaxSize = 0x0800 ; Maximum size supported is 16K-1
		213	InterFrameGap = 0x03 ; 3 means InterFrameGap = the shortest one
		214
		215	HZ = 1000
		216
		217	RTL_MIN_IO_SIZE = 0x80
		218	TX_TIMEOUT = (6*HZ)
		219
		220	TIMER_EXPIRE_TIME = 100
		221
		222	ETH_HDR_LEN = 14
		223	DEFAULT_MTU = 1500
5522	hidnplayr	224	DEFAULT_RX_BUF_LEN = 1514
3545	hidnplayr	225
		226
		227	;ifdef JUMBO_FRAME_SUPPORT
		228	; MAX_JUMBO_FRAME_MTU = 10000
		229	; MAX_RX_SKBDATA_SIZE = (MAX_JUMBO_FRAME_MTU + ETH_HDR_LEN )
		230	;else
		231	MAX_RX_SKBDATA_SIZE = 1600
		232	;end if
		233
		234	MCFG_METHOD_01 = 0x01
		235	MCFG_METHOD_02 = 0x02
		236	MCFG_METHOD_03 = 0x03
		237	MCFG_METHOD_04 = 0x04
		238	MCFG_METHOD_05 = 0x05
		239	MCFG_METHOD_11 = 0x0b
		240	MCFG_METHOD_12 = 0x0c
		241	MCFG_METHOD_13 = 0x0d
		242	MCFG_METHOD_14 = 0x0e
		243	MCFG_METHOD_15 = 0x0f
		244
		245	PCFG_METHOD_1 = 0x01 ; PHY Reg 0x03 bit0-3 == 0x0000
		246	PCFG_METHOD_2 = 0x02 ; PHY Reg 0x03 bit0-3 == 0x0001
		247	PCFG_METHOD_3 = 0x03 ; PHY Reg 0x03 bit0-3 == 0x0002
		248
5050	hidnplayr	249	struct tx_desc
		250	status dd ?
		251	vlan_tag dd ?
		252	buf_addr dq ?
		253	ends
		254	tx_desc.buf_soft_addr = NUM_TX_DESC*sizeof.tx_desc
3545	hidnplayr	255
5050	hidnplayr	256	struct rx_desc
		257	status dd ?
		258	vlan_tag dd ?
		259	buf_addr dq ?
		260	ends
		261	rx_desc.buf_soft_addr = NUM_RX_DESC*sizeof.rx_desc
3545	hidnplayr	262
5050	hidnplayr	263	struct device ETH_DEVICE
3545	hidnplayr	264
5050	hidnplayr	265	io_addr dd ?
		266	pci_bus dd ?
		267	pci_dev dd ?
		268	irq_line db ?
		269	rb 3 ; align 4
		270	pcfg dd ?
		271	mcfg dd ?
5498	hidnplayr	272
5050	hidnplayr	273	cur_rx dd ? ; Index into the Rx descriptor buffer of next Rx pkt
		274	cur_tx dd ? ; Index into the Tx descriptor buffer of next Rx pkt
5498	hidnplayr	275	last_tx dd ?
5494	hidnplayr	276	mac_version dd ?
3545	hidnplayr	277
5050	hidnplayr	278	rb 0x100-($ and 0xff) ; align 256
		279	tx_ring rb NUM_TX_DESC * sizeof.tx_desc * 2
3545	hidnplayr	280
5050	hidnplayr	281	rb 0x100-($ and 0xff) ; align 256
		282	rx_ring rb NUM_RX_DESC * sizeof.rx_desc * 2
3545	hidnplayr	283
5050	hidnplayr	284	ends
3545	hidnplayr	285
		286	intr_mask = ISB_LinkChg or ISB_RxOverflow or ISB_RxFIFOOver or ISB_TxErr or ISB_TxOK or ISB_RxErr or ISB_RxOK
		287	rx_config = (RX_FIFO_THRESH shl RXC_FIFOShift) or (RX_DMA_BURST shl RXC_DMAShift) or 0x0000000E
		288
		289
		290	macro udelay msec {
		291
4803	hidnplayr	292	push esi ecx
3545	hidnplayr	293	mov esi, msec
5050	hidnplayr	294	invoke Sleep
4803	hidnplayr	295	pop ecx esi
3545	hidnplayr	296
		297	}
		298
		299	macro WRITE_GMII_REG RegAddr, value {
		300
5050	hidnplayr	301	set_io [ebx + device.io_addr], REG_PHYAR
3545	hidnplayr	302	if value eq ax
		303	and eax, 0x0000ffff
		304	or eax, 0x80000000 + (RegAddr shl 16)
		305	else
		306	mov eax, 0x80000000 + (RegAddr shl 16) + value
		307	end if
		308	out dx, eax
		309
		310	call PHY_WAIT_WRITE
		311	}
		312
		313	macro READ_GMII_REG RegAddr {
		314
		315	local .error, .done
		316
5050	hidnplayr	317	set_io [ebx + device.io_addr], REG_PHYAR
3545	hidnplayr	318	mov eax, RegAddr shl 16
		319	out dx, eax
		320
		321	call PHY_WAIT_READ
		322	jz .error
		323
		324	in eax, dx
		325	and eax, 0xFFFF
		326	jmp .done
		327
		328	.error:
		329	or eax, -1
		330	.done:
		331	}
		332
		333	align 4
		334	PHY_WAIT_READ: ; io addr must already be set to REG_PHYAR
		335
		336	udelay 1 ;;;1000
		337
		338	push ecx
		339	mov ecx, 2000
		340	; Check if the RTL8169 has completed writing/reading to the specified MII register
		341	@@:
		342	in eax, dx
		343	test eax, 0x80000000
		344	jnz .exit
		345	udelay 1 ;;;100
		346	loop @b
		347	.exit:
		348	pop ecx
		349	ret
		350
		351	align 4
		352	PHY_WAIT_WRITE: ; io addr must already be set to REG_PHYAR
		353
		354	udelay 1 ;;;1000
		355
		356	push ecx
		357	mov ecx, 2000
		358	; Check if the RTL8169 has completed writing/reading to the specified MII register
		359	@@:
		360	in eax, dx
		361	test eax, 0x80000000
		362	jz .exit
		363	udelay 1 ;;;100
		364	loop @b
		365	.exit:
		366	pop ecx
		367	ret
		368
		369
		370
		371	;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		372	;; ;;
		373	;; proc START ;;
		374	;; ;;
		375	;; (standard driver proc) ;;
		376	;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		377
5050	hidnplayr	378	proc START c, reason:dword, cmdline:dword
3545	hidnplayr	379
5050	hidnplayr	380	cmp [reason], DRV_ENTRY
		381	jne .fail
3545	hidnplayr	382
5050	hidnplayr	383	DEBUGF 2,"Loading driver\n"
		384	invoke RegService, my_service, service_proc
3545	hidnplayr	385	ret
		386
		387	.fail:
5050	hidnplayr	388	xor eax, eax
3545	hidnplayr	389	ret
		390
		391	endp
		392
		393
		394	;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		395	;; ;;
		396	;; proc SERVICE_PROC ;;
		397	;; ;;
		398	;; (standard driver proc) ;;
		399	;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		400
		401	proc service_proc stdcall, ioctl:dword
		402
		403	mov edx, [ioctl]
4470	hidnplayr	404	mov eax, [edx + IOCTL.io_code]
3545	hidnplayr	405
		406	;------------------------------------------------------
		407
		408	cmp eax, 0 ;SRV_GETVERSION
		409	jne @F
		410
4470	hidnplayr	411	cmp [edx + IOCTL.out_size], 4
3545	hidnplayr	412	jb .fail
4470	hidnplayr	413	mov eax, [edx + IOCTL.output]
3545	hidnplayr	414	mov [eax], dword API_VERSION
		415
		416	xor eax, eax
		417	ret
		418
		419	;------------------------------------------------------
		420	@@:
		421	cmp eax, 1 ;SRV_HOOK
		422	jne .fail
		423
4470	hidnplayr	424	cmp [edx + IOCTL.inp_size], 3 ; Data input must be at least 3 bytes
3545	hidnplayr	425	jb .fail
		426
4470	hidnplayr	427	mov eax, [edx + IOCTL.input]
3545	hidnplayr	428	cmp byte [eax], 1 ; 1 means device number and bus number (pci) are given
		429	jne .fail ; other types arent supported for this card yet
		430
		431	; check if the device is already listed
		432
		433	mov esi, device_list
		434	mov ecx, [devices]
		435	test ecx, ecx
		436	jz .firstdevice
		437
4470	hidnplayr	438	; mov eax, [edx + IOCTL.input] ; get the pci bus and device numbers
		439	mov ax, [eax+1] ;
3545	hidnplayr	440	.nextdevice:
		441	mov ebx, [esi]
5050	hidnplayr	442	cmp al, byte[ebx + device.pci_bus]
3545	hidnplayr	443	jne @f
5050	hidnplayr	444	cmp ah, byte[ebx + device.pci_dev]
3545	hidnplayr	445	je .find_devicenum ; Device is already loaded, let's find it's device number
		446	@@:
		447	add esi, 4
		448	loop .nextdevice
		449
		450
		451	; This device doesnt have its own eth_device structure yet, lets create one
		452	.firstdevice:
		453	cmp [devices], MAX_DEVICES ; First check if the driver can handle one more card
		454	jae .fail
		455
5050	hidnplayr	456	allocate_and_clear ebx, sizeof.device, .fail ; Allocate memory to put the device structure in
3545	hidnplayr	457
		458	; Fill in the direct call addresses into the struct
		459
5050	hidnplayr	460	mov [ebx + device.reset], reset
		461	mov [ebx + device.transmit], transmit
		462	mov [ebx + device.unload], unload
		463	mov [ebx + device.name], my_service
3545	hidnplayr	464
		465	; save the pci bus and device numbers
		466
4470	hidnplayr	467	mov eax, [edx + IOCTL.input]
3545	hidnplayr	468	movzx ecx, byte[eax+1]
5050	hidnplayr	469	mov [ebx + device.pci_bus], ecx
3545	hidnplayr	470	movzx ecx, byte[eax+2]
5050	hidnplayr	471	mov [ebx + device.pci_dev], ecx
3545	hidnplayr	472
		473	; Now, it's time to find the base io addres of the PCI device
		474
5050	hidnplayr	475	stdcall PCI_find_io, [ebx + device.pci_bus], [ebx + device.pci_dev]
		476	mov [ebx + device.io_addr], eax
3545	hidnplayr	477
		478	; We've found the io address, find IRQ now
		479
5050	hidnplayr	480	invoke PciRead8, [ebx + device.pci_bus], [ebx + device.pci_dev], PCI_header00.interrupt_line
		481	mov [ebx + device.irq_line], al
3545	hidnplayr	482
		483	DEBUGF 2,"Hooking into device, dev:%x, bus:%x, irq:%x, addr:%x\n",\
5050	hidnplayr	484	[ebx + device.pci_dev]:1,[ebx + device.pci_bus]:1,[ebx + device.irq_line]:1,[ebx + device.io_addr]:8
3545	hidnplayr	485
		486	; Ok, the eth_device structure is ready, let's probe the device
		487	; Because initialization fires IRQ, IRQ handler must be aware of this device
		488	mov eax, [devices] ; Add the device structure to our device list
		489	mov [device_list + 4*eax], ebx ; (IRQ handler uses this list to find device)
		490	inc [devices] ;
		491
		492	call probe ; this function will output in eax
		493	test eax, eax
		494	jnz .err2 ; If an error occured, exit
		495
5050	hidnplayr	496	mov [ebx + device.type], NET_TYPE_ETH
		497	invoke NetRegDev
3545	hidnplayr	498
		499	cmp eax, -1
		500	je .destroy
		501
		502	ret
		503
		504	; If the device was already loaded, find the device number and return it in eax
		505
		506	.find_devicenum:
		507	DEBUGF 2,"Trying to find device number of already registered device\n"
5050	hidnplayr	508	invoke NetPtrToNum ; This kernel procedure converts a pointer to device struct in ebx
3545	hidnplayr	509	; into a device number in edi
		510	mov eax, edi ; Application wants it in eax instead
		511	DEBUGF 2,"Kernel says: %u\n", eax
		512	ret
		513
		514	; If an error occured, remove all allocated data and exit (returning -1 in eax)
		515
		516	.destroy:
		517	; todo: reset device into virgin state
		518
		519	.err2:
		520	dec [devices]
		521	.err:
		522	DEBUGF 2,"removing device structure\n"
5050	hidnplayr	523	invoke KernelFree, ebx
3545	hidnplayr	524	.fail:
		525	or eax, -1
		526	ret
		527
		528	;------------------------------------------------------
		529	endp
		530
		531
		532	align 4
		533	unload:
		534
		535	ret
		536
		537
		538	align 4
		539	init_board:
		540
		541	DEBUGF 1,"init_board\n"
		542
5050	hidnplayr	543	; Make the device a bus master
		544	invoke PciRead32, [ebx + device.pci_bus], [ebx + device.pci_dev], PCI_header00.command
7299	hidnplayr	545	or al, PCI_CMD_MASTER or PCI_CMD_PIO
5050	hidnplayr	546	invoke PciWrite32, [ebx + device.pci_bus], [ebx + device.pci_dev], PCI_header00.command, eax
3545	hidnplayr	547
		548	; Soft reset the chip
5050	hidnplayr	549	set_io [ebx + device.io_addr], 0
		550	set_io [ebx + device.io_addr], REG_ChipCmd
3545	hidnplayr	551	mov al, CMD_Reset
		552	out dx, al
		553
		554	; Check that the chip has finished the reset
		555	mov ecx, 1000
5050	hidnplayr	556	set_io [ebx + device.io_addr], REG_ChipCmd
5494	hidnplayr	557	@@:
		558	in al, dx
3545	hidnplayr	559	test al, CMD_Reset
		560	jz @f
		561	udelay 10
		562	loop @b
7299	hidnplayr	563	DEBUGF 2,"chip reset timeout\n"
		564	or eax, -1
		565	ret
5494	hidnplayr	566	@@:
3545	hidnplayr	567
		568
5050	hidnplayr	569	set_io [ebx + device.io_addr], REG_TxConfig
3545	hidnplayr	570	in eax, dx
5494	hidnplayr	571	mov esi, MAC_VERSION_LIST
		572	@@:
		573	mov ecx, eax
		574	and ecx, dword[esi]
		575	cmp ecx, dword[esi+4]
		576	je @f
		577	add esi, 4*4
		578	jmp @r
		579	@@:
3545	hidnplayr	580
6119	hidnplayr	581	mov ecx, [esi+8]
		582	mov [ebx + device.mac_version], ecx
		583	mov ecx, [esi+12]
		584	mov [ebx + device.name], ecx
		585	DEBUGF 2, "Detected chip: %s\n", ecx
		586	cmp dword[esi], 0
		587	jne @f
7299	hidnplayr	588	DEBUGF 1, "TxConfig = 0x%x\n", eax
6119	hidnplayr	589	@@:
3545	hidnplayr	590
		591	xor eax, eax
		592	ret
		593
		594
		595
		596	;***************************************************************************
		597	; Function
		598	; probe
		599	; Description
		600	; Searches for an ethernet card, enables it and clears the rx buffer
		601	; If a card was found, it enables the ethernet -> TCPIP link
		602	; Destroyed registers
		603	; eax, ebx, ecx, edx
		604	;
		605	;***************************************************************************
		606	align 4
		607	probe:
		608
		609	DEBUGF 1,"probe\n"
		610
		611	call init_board
		612	call read_mac
		613	call PHY_config
		614
4334	hidnplayr	615	DEBUGF 1,"Set MAC Reg C+CR Offset 0x82h = 0x01h\n"
5050	hidnplayr	616	set_io [ebx + device.io_addr], 0
		617	set_io [ebx + device.io_addr], 0x82
3545	hidnplayr	618	mov al, 0x01
		619	out dx, al
5050	hidnplayr	620	cmp [ebx + device.mcfg], MCFG_METHOD_03
3545	hidnplayr	621	jae @f
4334	hidnplayr	622	DEBUGF 1,"Set PCI Latency=0x40\n"
5050	hidnplayr	623	; Adjust PCI latency to be at least 64
		624	invoke PciRead8, [ebx + device.pci_bus], [ebx + device.pci_dev], PCI_header00.max_latency
		625	cmp al, 64
		626	jae @f
		627	mov al, 64
		628	invoke PciWrite8, [ebx + device.pci_bus], [ebx + device.pci_dev], PCI_header00.max_latency, eax
		629	@@:
		630	cmp [ebx + device.mcfg], MCFG_METHOD_02
3545	hidnplayr	631	jne @f
4334	hidnplayr	632	DEBUGF 1,"Set MAC Reg C+CR Offset 0x82h = 0x01h\n"
5050	hidnplayr	633	set_io [ebx + device.io_addr], 0
		634	set_io [ebx + device.io_addr], 0x82
3545	hidnplayr	635	mov al, 0x01
		636	out dx, al
4334	hidnplayr	637	DEBUGF 1,"Set PHY Reg 0x0bh = 0x00h\n"
3545	hidnplayr	638	WRITE_GMII_REG 0x0b, 0x0000 ; w 0x0b 15 0 0
		639	@@:
		640	; if TBI is not enabled
5050	hidnplayr	641	set_io [ebx + device.io_addr], 0
		642	set_io [ebx + device.io_addr], REG_PHYstatus
3545	hidnplayr	643	in al, dx
		644	test al, PHYS_TBI_Enable
		645	jz .tbi_dis
		646	READ_GMII_REG PHY_AUTO_NEGO_REG
		647
		648	; enable 10/100 Full/Half Mode, leave PHY_AUTO_NEGO_REG bit4:0 unchanged
		649	and eax, 0x0C1F
		650	or eax, PHY_Cap_10_Half or PHY_Cap_10_Full or PHY_Cap_100_Half or PHY_Cap_100_Full
		651	WRITE_GMII_REG PHY_AUTO_NEGO_REG, ax
		652
		653	; enable 1000 Full Mode
		654	WRITE_GMII_REG PHY_1000_CTRL_REG, PHY_Cap_1000_Full or PHY_Cap_1000_Half ; rtl8168
		655
		656	; Enable auto-negotiation and restart auto-nigotiation
		657	WRITE_GMII_REG PHY_CTRL_REG, PHY_Enable_Auto_Nego or PHY_Restart_Auto_Nego
		658
4803	hidnplayr	659	udelay 1 ; 100
		660	mov ecx, 200 ; 10000
		661	DEBUGF 1, "Waiting for auto-negotiation to complete\n"
3545	hidnplayr	662	; wait for auto-negotiation process
		663	@@: dec ecx
		664	jz @f
5050	hidnplayr	665	set_io [ebx + device.io_addr], 0
3545	hidnplayr	666	READ_GMII_REG PHY_STAT_REG
4803	hidnplayr	667	udelay 1 ; 100
3545	hidnplayr	668	test eax, PHY_Auto_Neco_Comp
		669	jz @b
5050	hidnplayr	670	set_io [ebx + device.io_addr], REG_PHYstatus
3545	hidnplayr	671	in al, dx
		672	jmp @f
		673	.tbi_dis:
4803	hidnplayr	674	udelay 1 ; 100
3545	hidnplayr	675	@@:
4803	hidnplayr	676	DEBUGF 1, "auto-negotiation complete\n"
3545	hidnplayr	677
		678	;***************************************************************************
		679	; Function
		680	; rt8169_reset
		681	; Description
		682	; Place the chip (ie, the ethernet card) into a virgin state
		683	; Destroyed registers
		684	; eax, ebx, ecx, edx
		685	;
		686	;***************************************************************************
		687	align 4
		688	reset:
		689
4803	hidnplayr	690	DEBUGF 1,"resetting\n"
3545	hidnplayr	691
		692	call init_ring
5522	hidnplayr	693	test eax, eax
		694	jnz .err
		695
3545	hidnplayr	696	call hw_start
		697
		698	; clear packet/byte counters
		699
		700	xor eax, eax
5050	hidnplayr	701	lea edi, [ebx + device.bytes_tx]
3545	hidnplayr	702	mov ecx, 6
		703	rep stosd
		704
5050	hidnplayr	705	mov [ebx + device.mtu], 1500
5498	hidnplayr	706	call detect_link
3545	hidnplayr	707
4803	hidnplayr	708	DEBUGF 2,"init OK!\n"
3545	hidnplayr	709	xor eax, eax
		710	ret
		711
5522	hidnplayr	712	.err:
7299	hidnplayr	713	DEBUGF 2,"reset failed!\n"
5522	hidnplayr	714	or eax, -1
		715	ret
3545	hidnplayr	716
		717
		718
		719	align 4
		720	PHY_config:
		721
5050	hidnplayr	722	DEBUGF 1,"hw_PHY_config: priv.mcfg=%d, priv.pcfg=%d\n", [ebx + device.mcfg], [ebx + device.pcfg]
3545	hidnplayr	723
5050	hidnplayr	724	cmp [ebx + device.mcfg], MCFG_METHOD_04
3545	hidnplayr	725	jne .not_4
5050	hidnplayr	726	set_io [ebx + device.io_addr], 0
3545	hidnplayr	727	; WRITE_GMII_REG 0x1F, 0x0001
		728	; WRITE_GMII_REG 0x1b, 0x841e
		729	; WRITE_GMII_REG 0x0e, 0x7bfb
		730	; WRITE_GMII_REG 0x09, 0x273a
		731	WRITE_GMII_REG 0x1F, 0x0002
		732	WRITE_GMII_REG 0x01, 0x90D0
		733	WRITE_GMII_REG 0x1F, 0x0000
		734	jmp .exit
		735	.not_4:
5050	hidnplayr	736	cmp [ebx + device.mcfg], MCFG_METHOD_02
3545	hidnplayr	737	je @f
5050	hidnplayr	738	cmp [ebx + device.mcfg], MCFG_METHOD_03
3545	hidnplayr	739	jne .not_2_or_3
		740	@@:
5050	hidnplayr	741	set_io [ebx + device.io_addr], 0
3545	hidnplayr	742	WRITE_GMII_REG 0x1F, 0x0001
		743	WRITE_GMII_REG 0x15, 0x1000
		744	WRITE_GMII_REG 0x18, 0x65C7
		745	WRITE_GMII_REG 0x04, 0x0000
		746	WRITE_GMII_REG 0x03, 0x00A1
		747	WRITE_GMII_REG 0x02, 0x0008
		748	WRITE_GMII_REG 0x01, 0x1020
		749	WRITE_GMII_REG 0x00, 0x1000
		750	WRITE_GMII_REG 0x04, 0x0800
		751	WRITE_GMII_REG 0x04, 0x0000
		752	WRITE_GMII_REG 0x04, 0x7000
		753	WRITE_GMII_REG 0x03, 0xFF41
		754	WRITE_GMII_REG 0x02, 0xDE60
		755	WRITE_GMII_REG 0x01, 0x0140
		756	WRITE_GMII_REG 0x00, 0x0077
		757	WRITE_GMII_REG 0x04, 0x7800
		758	WRITE_GMII_REG 0x04, 0x7000
		759	WRITE_GMII_REG 0x04, 0xA000
		760	WRITE_GMII_REG 0x03, 0xDF01
		761	WRITE_GMII_REG 0x02, 0xDF20
		762	WRITE_GMII_REG 0x01, 0xFF95
		763	WRITE_GMII_REG 0x00, 0xFA00
		764	WRITE_GMII_REG 0x04, 0xA800
		765	WRITE_GMII_REG 0x04, 0xA000
		766	WRITE_GMII_REG 0x04, 0xB000
		767	WRITE_GMII_REG 0x03, 0xFF41
		768	WRITE_GMII_REG 0x02, 0xDE20
		769	WRITE_GMII_REG 0x01, 0x0140
		770	WRITE_GMII_REG 0x00, 0x00BB
		771	WRITE_GMII_REG 0x04, 0xB800
		772	WRITE_GMII_REG 0x04, 0xB000
		773	WRITE_GMII_REG 0x04, 0xF000
		774	WRITE_GMII_REG 0x03, 0xDF01
		775	WRITE_GMII_REG 0x02, 0xDF20
		776	WRITE_GMII_REG 0x01, 0xFF95
		777	WRITE_GMII_REG 0x00, 0xBF00
		778	WRITE_GMII_REG 0x04, 0xF800
		779	WRITE_GMII_REG 0x04, 0xF000
		780	WRITE_GMII_REG 0x04, 0x0000
		781	WRITE_GMII_REG 0x1F, 0x0000
		782	WRITE_GMII_REG 0x0B, 0x0000
		783	jmp .exit
		784	.not_2_or_3:
5050	hidnplayr	785	DEBUGF 1,"mcfg=%d, discard hw PHY config\n", [ebx + device.mcfg]
3545	hidnplayr	786	.exit:
		787	ret
		788
		789
		790
		791	align 4
		792	set_rx_mode:
		793
		794	DEBUGF 1,"set_rx_mode\n"
		795
		796	; IFF_ALLMULTI
		797	; Too many to filter perfectly -- accept all multicasts
5050	hidnplayr	798	set_io [ebx + device.io_addr], 0
		799	set_io [ebx + device.io_addr], REG_RxConfig
3545	hidnplayr	800	in eax, dx
5494	hidnplayr	801	and eax, 0xff7e1880
3545	hidnplayr	802	or eax, rx_config or (RXM_AcceptBroadcast or RXM_AcceptMulticast or RXM_AcceptMyPhys)
		803	out dx, eax
		804
		805	; Multicast hash filter
5050	hidnplayr	806	set_io [ebx + device.io_addr], REG_MAR0 + 0
3545	hidnplayr	807	or eax, -1
		808	out dx, eax
5050	hidnplayr	809	set_io [ebx + device.io_addr], REG_MAR0 + 4
3545	hidnplayr	810	out dx, eax
		811
		812	ret
		813
		814
		815	align 4
		816	init_ring:
		817
		818	DEBUGF 1,"init_ring\n"
		819
		820	xor eax, eax
5050	hidnplayr	821	mov [ebx + device.cur_rx], eax
		822	mov [ebx + device.cur_tx], eax
5498	hidnplayr	823	mov [ebx + device.last_tx], eax
3545	hidnplayr	824
5050	hidnplayr	825	lea edi, [ebx + device.tx_ring]
5498	hidnplayr	826	mov ecx, (NUM_TX_DESC * sizeof.tx_desc) / 4 * 2
3545	hidnplayr	827	rep stosd
		828
5050	hidnplayr	829	lea edi, [ebx + device.rx_ring]
		830	mov ecx, (NUM_RX_DESC * sizeof.rx_desc) / 4
3545	hidnplayr	831	rep stosd
		832
5498	hidnplayr	833	lea edi, [ebx + device.rx_ring]
3545	hidnplayr	834	mov ecx, NUM_RX_DESC
		835	.loop:
		836	push ecx
5522	hidnplayr	837	invoke NetAlloc, RX_BUF_SIZE+NET_BUFF.data
		838	test eax, eax
		839	jz .err
5050	hidnplayr	840	mov dword [edi + rx_desc.buf_soft_addr], eax
5498	hidnplayr	841	invoke GetPhysAddr
5522	hidnplayr	842	add eax, NET_BUFF.data
3545	hidnplayr	843	mov dword [edi + rx_desc.buf_addr], eax
		844	mov [edi + rx_desc.status], DSB_OWNbit or RX_BUF_SIZE
5050	hidnplayr	845	add edi, sizeof.rx_desc
3545	hidnplayr	846	pop ecx
5050	hidnplayr	847	dec ecx
		848	jnz .loop
		849	or [edi - sizeof.rx_desc + rx_desc.status], DSB_EORbit
3545	hidnplayr	850
5522	hidnplayr	851	xor eax, eax
3545	hidnplayr	852	ret
		853
5522	hidnplayr	854	.err:
		855	pop eax
		856	or eax, -1
		857	ret
3545	hidnplayr	858
		859	align 4
		860	hw_start:
		861
		862	DEBUGF 1,"hw_start\n"
		863
		864	; attach int handler
5050	hidnplayr	865	movzx eax, [ebx + device.irq_line]
3545	hidnplayr	866	DEBUGF 1,"Attaching int handler to irq %x\n", eax:1
5050	hidnplayr	867	invoke AttachIntHandler, eax, int_handler, ebx
		868	test eax, eax
		869	jnz @f
		870	DEBUGF 2,"Could not attach int handler!\n"
		871	or eax, -1
		872	ret
		873	@@:
3545	hidnplayr	874
		875	; Soft reset the chip
5050	hidnplayr	876	set_io [ebx + device.io_addr], 0
		877	set_io [ebx + device.io_addr], REG_ChipCmd
3545	hidnplayr	878	mov al, CMD_Reset
		879	out dx, al
		880
		881	DEBUGF 1,"Waiting for chip to reset... "
		882	; Check that the chip has finished the reset
		883	mov ecx, 1000
5050	hidnplayr	884	set_io [ebx + device.io_addr], REG_ChipCmd
3545	hidnplayr	885	@@: in al, dx
		886	test al, CMD_Reset
		887	jz @f
		888	udelay 10
		889	loop @b
		890	@@:
		891	DEBUGF 1,"done!\n"
		892
5050	hidnplayr	893	set_io [ebx + device.io_addr], REG_Cfg9346
3545	hidnplayr	894	mov al, CFG_9346_Unlock
		895	out dx, al
		896
5050	hidnplayr	897	set_io [ebx + device.io_addr], REG_ChipCmd
3545	hidnplayr	898	mov al, CMD_TxEnb or CMD_RxEnb
		899	out dx, al
		900
5050	hidnplayr	901	set_io [ebx + device.io_addr], REG_ETThReg
3545	hidnplayr	902	mov al, ETTh
		903	out dx, al
		904
		905	; For gigabit rtl8169
5050	hidnplayr	906	set_io [ebx + device.io_addr], REG_RxMaxSize
3545	hidnplayr	907	mov ax, RxPacketMaxSize
		908	out dx, ax
		909
		910	; Set Rx Config register
5050	hidnplayr	911	set_io [ebx + device.io_addr], REG_RxConfig
3545	hidnplayr	912	in ax, dx
5494	hidnplayr	913	and eax, 0xff7e1880
3545	hidnplayr	914	or eax, rx_config
		915	out dx, eax
		916
		917	; Set DMA burst size and Interframe Gap Time
5050	hidnplayr	918	set_io [ebx + device.io_addr], REG_TxConfig
3545	hidnplayr	919	mov eax, (TX_DMA_BURST shl TXC_DMAShift) or (InterFrameGap shl TXC_InterFrameGapShift)
		920	out dx, eax
		921
5050	hidnplayr	922	set_io [ebx + device.io_addr], REG_CPlusCmd
3545	hidnplayr	923	in ax, dx
		924	out dx, ax
		925
		926	in ax, dx
		927	or ax, 1 shl 3
5050	hidnplayr	928	cmp [ebx + device.mcfg], MCFG_METHOD_02
3545	hidnplayr	929	jne @f
5050	hidnplayr	930	cmp [ebx + device.mcfg], MCFG_METHOD_03
3545	hidnplayr	931	jne @f
		932	or ax,1 shl 14
		933	DEBUGF 1,"Set MAC Reg C+CR Offset 0xE0: bit-3 and bit-14\n"
		934	jmp .set
		935	@@:
		936	DEBUGF 1,"Set MAC Reg C+CR Offset 0xE0: bit-3\n"
		937	.set:
5050	hidnplayr	938	set_io [ebx + device.io_addr], REG_CPlusCmd
3545	hidnplayr	939	out dx, ax
		940
5050	hidnplayr	941	set_io [ebx + device.io_addr], 0xE2
3545	hidnplayr	942	; mov ax, 0x1517
		943	; out dx, ax
		944	; mov ax, 0x152a
		945	; out dx, ax
		946	; mov ax, 0x282a
		947	; out dx, ax
		948	xor ax, ax
		949	out dx, ax
		950
		951	xor eax, eax
5050	hidnplayr	952	mov [ebx + device.cur_rx], eax
		953	lea eax, [ebx + device.tx_ring]
		954	invoke GetPhysAddr
		955	set_io [ebx + device.io_addr], REG_TxDescStartAddr
3545	hidnplayr	956	out dx, eax
5050	hidnplayr	957	set_io [ebx + device.io_addr], REG_TxDescStartAddr + 4
4301	clevermous	958	xor eax, eax
		959	out dx, eax
3545	hidnplayr	960
5050	hidnplayr	961	lea eax, [ebx + device.rx_ring]
		962	invoke GetPhysAddr
		963	set_io [ebx + device.io_addr], REG_RxDescStartAddr
3545	hidnplayr	964	out dx, eax
4301	clevermous	965	xor eax, eax
5050	hidnplayr	966	set_io [ebx + device.io_addr], REG_RxDescStartAddr + 4
4301	clevermous	967	out dx, eax
3545	hidnplayr	968
5050	hidnplayr	969	set_io [ebx + device.io_addr], REG_Cfg9346
3545	hidnplayr	970	mov al, CFG_9346_Lock
		971	out dx, al
		972
		973	udelay 10
		974
		975	xor eax, eax
5050	hidnplayr	976	set_io [ebx + device.io_addr], REG_RxMissed
3545	hidnplayr	977	out dx, eax
		978
		979	call set_rx_mode
		980
5050	hidnplayr	981	set_io [ebx + device.io_addr], 0
3545	hidnplayr	982	; no early-rx interrupts
5050	hidnplayr	983	set_io [ebx + device.io_addr], REG_MultiIntr
3545	hidnplayr	984	in ax, dx
		985	and ax, 0xF000
		986	out dx, ax
		987
		988	; set interrupt mask
5050	hidnplayr	989	set_io [ebx + device.io_addr], REG_IntrMask
3545	hidnplayr	990	mov ax, intr_mask
		991	out dx, ax
		992
		993	xor eax, eax
		994	ret
		995
		996
		997	align 4
		998	read_mac:
		999
5050	hidnplayr	1000	set_io [ebx + device.io_addr], 0
		1001	set_io [ebx + device.io_addr], REG_MAC0
3545	hidnplayr	1002	xor ecx, ecx
5050	hidnplayr	1003	lea edi, [ebx + device.mac]
3545	hidnplayr	1004	mov ecx, 6
		1005
		1006	; Get MAC address. FIXME: read EEPROM
5498	hidnplayr	1007	@@:
		1008	in al, dx
3545	hidnplayr	1009	stosb
		1010	inc edx
		1011	loop @r
		1012
		1013	DEBUGF 1,"MAC = %x-%x-%x-%x-%x-%x\n",\
5050	hidnplayr	1014	[ebx + device.mac+0]:2,[ebx + device.mac+1]:2,[ebx + device.mac+2]:2,[ebx + device.mac+3]:2,[ebx + device.mac+4]:2,[ebx + device.mac+5]:2
3545	hidnplayr	1015
		1016	ret
		1017
		1018	align 4
		1019	write_mac:
		1020
		1021	ret 6
		1022
		1023
		1024	;***************************************************************************
		1025	; Function
		1026	; transmit
		1027	; Description
		1028	; Transmits a packet of data via the ethernet card
		1029	;
		1030	; Destroyed registers
		1031	; eax, edx, esi, edi
		1032	;
		1033	;***************************************************************************
		1034
5522	hidnplayr	1035	proc transmit stdcall bufferptr
5050	hidnplayr	1036
		1037	pushf
		1038	cli
		1039
5522	hidnplayr	1040	mov esi, [bufferptr]
		1041	DEBUGF 1,"Transmitting packet, buffer:%x, size:%u\n", [bufferptr], [esi + NET_BUFF.length]
		1042	lea eax, [esi + NET_BUFF.data]
3545	hidnplayr	1043	DEBUGF 1,"To: %x-%x-%x-%x-%x-%x From: %x-%x-%x-%x-%x-%x Type:%x%x\n",\
		1044	[eax+00]:2,[eax+01]:2,[eax+02]:2,[eax+03]:2,[eax+04]:2,[eax+05]:2,\
		1045	[eax+06]:2,[eax+07]:2,[eax+08]:2,[eax+09]:2,[eax+10]:2,[eax+11]:2,\
		1046	[eax+13]:2,[eax+12]:2
		1047
5522	hidnplayr	1048	cmp [esi + NET_BUFF.length], 1514
8997	hidnplayr	1049	ja .error
5522	hidnplayr	1050	cmp [esi + NET_BUFF.length], 60
8997	hidnplayr	1051	jb .error
3545	hidnplayr	1052
		1053	;----------------------------------
		1054	; Find currentTX descriptor address
		1055
5050	hidnplayr	1056	mov eax, sizeof.tx_desc
		1057	mul [ebx + device.cur_tx]
		1058	lea esi, [ebx + device.tx_ring + eax]
3545	hidnplayr	1059
		1060	DEBUGF 1,"Using TX desc: %x\n", esi
		1061
5498	hidnplayr	1062	;----------------------------------
		1063	; Check if the descriptor is in use
		1064
		1065	test [esi + tx_desc.status], DSB_OWNbit
8997	hidnplayr	1066	jnz .overrun
5498	hidnplayr	1067
3545	hidnplayr	1068	;---------------------------
		1069	; Program the packet pointer
		1070
5050	hidnplayr	1071	mov eax, [bufferptr]
5522	hidnplayr	1072	mov ecx, [eax + NET_BUFF.length]
3545	hidnplayr	1073	mov [esi + tx_desc.buf_soft_addr], eax
5522	hidnplayr	1074	add eax, [eax + NET_BUFF.offset]
5050	hidnplayr	1075	invoke GetPhysAddr
3545	hidnplayr	1076	mov dword [esi + tx_desc.buf_addr], eax
		1077
		1078	;------------------------
		1079	; Program the packet size
		1080
5522	hidnplayr	1081	mov eax, ecx
5498	hidnplayr	1082	or eax, DSB_OWNbit or DSB_FSbit or DSB_LSbit
5050	hidnplayr	1083	cmp [ebx + device.cur_tx], NUM_TX_DESC - 1
3545	hidnplayr	1084	jne @f
		1085	or eax, DSB_EORbit
5498	hidnplayr	1086	@@:
		1087	mov [esi + tx_desc.status], eax
3545	hidnplayr	1088
		1089	;-----------------------------------------
		1090	; Set the polling bit (start transmission)
		1091
5050	hidnplayr	1092	set_io [ebx + device.io_addr], 0
		1093	set_io [ebx + device.io_addr], REG_TxPoll
3545	hidnplayr	1094	mov al, 0x40 ; set polling bit
		1095	out dx, al
		1096
		1097	;-----------------------
		1098	; Update TX descriptor
		1099
5050	hidnplayr	1100	inc [ebx + device.cur_tx]
		1101	and [ebx + device.cur_tx], NUM_TX_DESC - 1
3545	hidnplayr	1102
		1103	;-------------
		1104	; Update stats
		1105
5050	hidnplayr	1106	inc [ebx + device.packets_tx]
5522	hidnplayr	1107	add dword [ebx + device.bytes_tx], ecx
5050	hidnplayr	1108	adc dword [ebx + device.bytes_tx + 4], 0
3545	hidnplayr	1109
5126	hidnplayr	1110	popf
3545	hidnplayr	1111	xor eax, eax
5050	hidnplayr	1112	ret
3545	hidnplayr	1113
8997	hidnplayr	1114	.error:
		1115	DEBUGF 2, "TX packet error\n"
		1116	inc [ebx + device.packets_tx_err]
5522	hidnplayr	1117	invoke NetFree, [bufferptr]
8997	hidnplayr	1118
5050	hidnplayr	1119	popf
3545	hidnplayr	1120	or eax, -1
5050	hidnplayr	1121	ret
3545	hidnplayr	1122
8997	hidnplayr	1123	.overrun:
		1124	DEBUGF 2, "TX overrun\n"
		1125	inc [ebx + device.packets_tx_ovr]
		1126	invoke NetFree, [bufferptr]
		1127
		1128	popf
		1129	or eax, -1
		1130	ret
		1131
5050	hidnplayr	1132	endp
3545	hidnplayr	1133
5050	hidnplayr	1134
3545	hidnplayr	1135
		1136	;;;;;;;;;;;;;;;;;;;;;;;
		1137	;; ;;
		1138	;; Interrupt handler ;;
		1139	;; ;;
		1140	;;;;;;;;;;;;;;;;;;;;;;;
		1141
		1142	align 4
		1143	int_handler:
		1144
		1145	push ebx esi edi
		1146
4334	hidnplayr	1147	DEBUGF 1,"INT\n"
3545	hidnplayr	1148
		1149	; find pointer of device wich made IRQ occur
		1150
		1151	mov ecx, [devices]
		1152	test ecx, ecx
		1153	jz .nothing
		1154	mov esi, device_list
		1155	.nextdevice:
		1156	mov ebx, [esi]
		1157
5050	hidnplayr	1158	set_io [ebx + device.io_addr], 0
		1159	set_io [ebx + device.io_addr], REG_IntrStatus
3545	hidnplayr	1160	in ax, dx
5498	hidnplayr	1161	out dx, ax ; ACK all interrupts
		1162	cmp ax, 0xffff ; if so, hardware is no longer present
		1163	je .nothing
3545	hidnplayr	1164	test ax, ax
		1165	jnz .got_it
		1166	.continue:
		1167	add esi, 4
		1168	dec ecx
		1169	jnz .nextdevice
		1170	.nothing:
		1171	pop edi esi ebx
		1172	xor eax, eax
		1173
		1174	ret ; If no device was found, abort (The irq was probably for a device, not registered to this driver)
		1175
		1176	.got_it:
5050	hidnplayr	1177	DEBUGF 1,"Device: %x Status: %x\n", ebx, ax
3545	hidnplayr	1178
		1179	;--------
		1180	; Receive
		1181	test ax, ISB_RxOK
		1182	jz .no_rx
		1183
		1184	push ax
		1185	push ebx
		1186
5567	hidnplayr	1187	.rx_loop:
3545	hidnplayr	1188	pop ebx
5050	hidnplayr	1189	mov eax, sizeof.rx_desc
		1190	mul [ebx + device.cur_rx]
		1191	lea esi, [ebx + device.rx_ring + eax]
3545	hidnplayr	1192
		1193	DEBUGF 1,"RxDesc.status = 0x%x\n", [esi + rx_desc.status]
5522	hidnplayr	1194	mov ecx, [esi + rx_desc.status]
5567	hidnplayr	1195	test ecx, DSB_OWNbit
8997	hidnplayr	1196	jnz .rx_done
3545	hidnplayr	1197
5050	hidnplayr	1198	DEBUGF 1,"cur_rx = %u\n", [ebx + device.cur_rx]
8997	hidnplayr	1199
5522	hidnplayr	1200	test ecx, SD_RxRES
8997	hidnplayr	1201	jnz .rx_error
3545	hidnplayr	1202
		1203	push ebx
5567	hidnplayr	1204	push .rx_loop
5522	hidnplayr	1205	and ecx, 0x00001FFF
		1206	add ecx, -4 ; we dont need CRC
		1207	DEBUGF 1,"data length = %u\n", ecx
		1208	mov eax, [esi + rx_desc.buf_soft_addr]
3545	hidnplayr	1209	push eax
5522	hidnplayr	1210	mov [eax + NET_BUFF.length], ecx
		1211	mov [eax + NET_BUFF.device], ebx
		1212	mov [eax + NET_BUFF.offset], NET_BUFF.data
3545	hidnplayr	1213
5522	hidnplayr	1214	;-------------
		1215	; Update stats
3545	hidnplayr	1216
6480	hidnplayr	1217	add dword [ebx + device.bytes_rx], ecx
5050	hidnplayr	1218	adc dword [ebx + device.bytes_rx + 4], 0
		1219	inc [ebx + device.packets_rx]
3545	hidnplayr	1220
5522	hidnplayr	1221	;----------------------
		1222	; Allocate a new buffer
3545	hidnplayr	1223
5567	hidnplayr	1224	mov [esi + rx_desc.status], 0
5522	hidnplayr	1225	invoke NetAlloc, RX_BUF_SIZE+NET_BUFF.data
5567	hidnplayr	1226	test eax, eax
8997	hidnplayr	1227	jz .rx_overrun
3545	hidnplayr	1228	mov [esi + rx_desc.buf_soft_addr], eax
5050	hidnplayr	1229	invoke GetPhysAddr
5522	hidnplayr	1230	add eax, NET_BUFF.data
3545	hidnplayr	1231	mov dword [esi + rx_desc.buf_addr], eax
		1232
5522	hidnplayr	1233	;---------------
		1234	; re set OWN bit
3545	hidnplayr	1235
		1236	mov eax, DSB_OWNbit or RX_BUF_SIZE
5050	hidnplayr	1237	cmp [ebx + device.cur_rx], NUM_RX_DESC - 1
3545	hidnplayr	1238	jne @f
		1239	or eax, DSB_EORbit
5050	hidnplayr	1240	@@:
		1241	mov [esi + rx_desc.status], eax
3545	hidnplayr	1242
5522	hidnplayr	1243	;--------------
		1244	; Update rx ptr
3545	hidnplayr	1245
5050	hidnplayr	1246	inc [ebx + device.cur_rx]
		1247	and [ebx + device.cur_rx], NUM_RX_DESC - 1
3545	hidnplayr	1248
5522	hidnplayr	1249	jmp [EthInput]
5567	hidnplayr	1250
8997	hidnplayr	1251	.rx_overrun:
		1252	DEBUGF 2,"RX FIFO overrun\n"
		1253	inc [ebx + device.packets_rx_ovr]
		1254	jmp .rx_next
		1255
		1256	.rx_error:
		1257	inc [ebx + device.packets_rx_err]
		1258	test ecx, SD_RxRWT or SD_RxRUNT
		1259	jz @f
		1260	DEBUGF 2,"RX length error"
		1261	@@:
		1262	test ecx, SD_RxCRC
		1263	jz @f
		1264	DEBUGF 2,"RX CRC error"
		1265	@@:
		1266	test ecx, SD_RxFOVF
		1267	jz @f
		1268	DEBUGF 2,"RX FIFO error"
		1269	@@:
		1270
		1271	.rx_next:
5567	hidnplayr	1272	mov eax, DSB_OWNbit or RX_BUF_SIZE
		1273	cmp [ebx + device.cur_rx], NUM_RX_DESC - 1
		1274	jne @f
		1275	or eax, DSB_EORbit
		1276	@@:
		1277	mov [esi + rx_desc.status], eax
		1278	push ebx
		1279	jmp .rx_loop
		1280
8997	hidnplayr	1281	.rx_done:
3545	hidnplayr	1282	pop ax
		1283	.no_rx:
		1284
5498	hidnplayr	1285	;-----------------
		1286	; Transmit cleanup
3545	hidnplayr	1287
5498	hidnplayr	1288	test ax, ISB_TxOK or ISB_TxErr or ISB_TxDescUnavail
3545	hidnplayr	1289	jz .no_tx
5522	hidnplayr	1290	push ax
3545	hidnplayr	1291
5498	hidnplayr	1292	DEBUGF 1,"TX done!\n"
5522	hidnplayr	1293
		1294	mov ecx, NUM_TX_DESC
		1295	lea esi, [ebx + device.tx_ring]
5498	hidnplayr	1296	.txloop:
5050	hidnplayr	1297	cmp dword [esi + tx_desc.buf_soft_addr], 0
5522	hidnplayr	1298	jz .maybenext
3545	hidnplayr	1299
		1300	test [esi + tx_desc.status], DSB_OWNbit
5522	hidnplayr	1301	jnz .maybenext
3545	hidnplayr	1302
5522	hidnplayr	1303	push ecx
		1304	DEBUGF 1,"Freeing up TX desc: %x\n", esi
		1305	invoke NetFree, [esi + tx_desc.buf_soft_addr]
		1306	pop ecx
5050	hidnplayr	1307	and dword [esi + tx_desc.buf_soft_addr], 0
3545	hidnplayr	1308
5522	hidnplayr	1309	.maybenext:
		1310	add esi, sizeof.tx_desc
		1311	dec ecx
		1312	jnz .txloop
		1313
		1314	pop ax
3545	hidnplayr	1315	.no_tx:
		1316
5498	hidnplayr	1317	test ax, ISB_LinkChg
		1318	jz .no_linkchange
		1319	DEBUGF 2, "Link change detected\n"
		1320	call detect_link
		1321	.no_linkchange:
3545	hidnplayr	1322
		1323	pop edi esi ebx
		1324	xor eax, eax
		1325	inc eax
		1326
		1327	ret
		1328
		1329
		1330
5498	hidnplayr	1331	align 4
		1332	detect_link:
		1333
		1334	set_io [ebx + device.io_addr], 0
		1335
		1336	; set_io [ebx + device.io_addr], REG_TBICSR
		1337	; in eax, dx
		1338	; test eax, TBI_LinkOK
		1339	; jz .down
		1340
		1341	; mov [ebx + device.state], ETH_LINK_UNKNOWN
		1342	; invoke NetLinkChanged
		1343	; ret
		1344
		1345	set_io [ebx + device.io_addr], REG_PHYstatus
		1346	in al, dx
		1347	test al, PHYS_LinkStatus
		1348	jz .down
		1349	DEBUGF 2, "Link is up, phystatus=0x%x\n", al
		1350	xor ecx, ecx
		1351	test al, PHYS_10bps
		1352	jz @f
		1353	or cl, ETH_LINK_10M
		1354	@@:
		1355	test al, PHYS_100bps
		1356	jz @f
		1357	or cl, ETH_LINK_100M
		1358	@@:
		1359	test al, PHYS_1000bpsF
		1360	jz @f
		1361	or cl, ETH_LINK_1G ;or ETH_LINK_FD
		1362	@@:
		1363	test al, PHYS_FullDup
		1364	jz @f
		1365	or cl, ETH_LINK_FD
		1366	@@:
		1367	mov [ebx + device.state], ecx
		1368	invoke NetLinkChanged
		1369	ret
		1370
		1371	.down:
		1372	DEBUGF 2, "Link is down\n"
		1373	mov [ebx + device.state], ETH_LINK_DOWN
		1374	invoke NetLinkChanged
		1375	ret
		1376
		1377
		1378
5050	hidnplayr	1379	; End of code
3545	hidnplayr	1380
5050	hidnplayr	1381	data fixups
		1382	end data
3545	hidnplayr	1383
5050	hidnplayr	1384	include '../peimport.inc'
3545	hidnplayr	1385
		1386	my_service db 'RTL8169',0 ; max 16 chars include zero
		1387
		1388	include_debug_strings ; All data wich FDO uses will be included here
		1389
5494	hidnplayr	1390	MAC_VERSION_LIST:
3545	hidnplayr	1391
7299	hidnplayr	1392	; 8168E+ family
		1393	dd 0x7cf00000, 0x50200000, 51, sz_rtl8168ep
		1394	dd 0x7cf00000, 0x50100000, 50, sz_rtl8168ep
		1395	dd 0x7cf00000, 0x50000000, 49, sz_rtl8168ep
3545	hidnplayr	1396
7299	hidnplayr	1397	; 8168H family
		1398	dd 0x7cf00000, 0x54100000, 46, sz_rtl8168h
		1399	dd 0x7cf00000, 0x54000000, 45, sz_rtl8168h
3545	hidnplayr	1400
7299	hidnplayr	1401	; 8168G family
		1402	dd 0x7cf00000, 0x5c800000, 44, sz_rtl8411
		1403	dd 0x7cf00000, 0x50900000, 42, sz_rtl8168g
		1404	dd 0x7cf00000, 0x4c100000, 41, sz_rtl8168g
		1405	dd 0x7cf00000, 0x4c000000, 40, sz_rtl8168g
5494	hidnplayr	1406
7299	hidnplayr	1407	; 8168F family
		1408	dd 0x7c800000, 0x48800000, 38, sz_rtl8411
		1409	dd 0x7cf00000, 0x48100000, 36, sz_rtl8168f
		1410	dd 0x7cf00000, 0x48000000, 35, sz_rtl8168f
5494	hidnplayr	1411
7299	hidnplayr	1412	; 8168E family
		1413	dd 0x7c800000, 0x2c800000, 34, sz_rtl8168evl
		1414	dd 0x7cf00000, 0x2c200000, 33, sz_rtl8168e
		1415	dd 0x7cf00000, 0x2c100000, 32, sz_rtl8168e
		1416	dd 0x7c800000, 0x2c000000, 33, sz_rtl8168e
5494	hidnplayr	1417
7299	hidnplayr	1418	; 8168D family
		1419	dd 0x7cf00000, 0x28300000, 26, sz_rtl8168d
		1420	dd 0x7cf00000, 0x28100000, 25, sz_rtl8168d
		1421	dd 0x7c800000, 0x28000000, 26, sz_rtl8168d
5494	hidnplayr	1422
7299	hidnplayr	1423	; 8168D+ family
		1424	dd 0x7cf00000, 0x28800000, 27, sz_rtl8168dp
		1425	dd 0x7cf00000, 0x28a00000, 28, sz_rtl8168dp
5494	hidnplayr	1426
7299	hidnplayr	1427	; 8168C family
		1428	dd 0x7cf00000, 0x3cb00000, 24, sz_rtl8168p
		1429	dd 0x7cf00000, 0x3c900000, 23, sz_rtl8168p
		1430	dd 0x7cf00000, 0x3c800000, 18, sz_rtl8168p
		1431	dd 0x7c800000, 0x3c800000, 24, sz_rtl8168p
		1432	dd 0x7cf00000, 0x3c000000, 19, sz_rtl8168c
		1433	dd 0x7cf00000, 0x3c200000, 20, sz_rtl8168c
		1434	dd 0x7cf00000, 0x3c300000, 21, sz_rtl8168c
		1435	dd 0x7cf00000, 0x3c400000, 22, sz_rtl8168c
		1436	dd 0x7c800000, 0x3c000000, 22, sz_rtl8168c
5494	hidnplayr	1437
7299	hidnplayr	1438	; 8168B family
		1439	dd 0x7cf00000, 0x38000000, 12, sz_rtl8168b
		1440	dd 0x7cf00000, 0x38500000, 17, sz_rtl8101e
		1441	dd 0x7c800000, 0x38000000, 17, sz_rtl8101e
		1442	dd 0x7c800000, 0x30000000, 11, sz_rtl8168b
5494	hidnplayr	1443
7299	hidnplayr	1444	; 8101 family
		1445	dd 0x7cf00000, 0x44900000, 39, sz_rtl8106e
		1446	dd 0x7c800000, 0x44800000, 39, sz_rtl8106e
		1447	dd 0x7c800000, 0x44000000, 37, sz_rtl8402
		1448	dd 0x7cf00000, 0x40b00000, 30, sz_rtl8105e
		1449	dd 0x7cf00000, 0x40a00000, 30, sz_rtl8105e
		1450	dd 0x7cf00000, 0x40900000, 29, sz_rtl8105e
		1451	dd 0x7c800000, 0x40800000, 30, sz_rtl8105e
		1452	dd 0x7cf00000, 0x34a00000, 09, sz_rtl8102e
		1453	dd 0x7cf00000, 0x24a00000, 09, sz_rtl8102e
		1454	dd 0x7cf00000, 0x34900000, 08, sz_rtl8102e
		1455	dd 0x7cf00000, 0x24900000, 08, sz_rtl8102e
		1456	dd 0x7cf00000, 0x34800000, 07, sz_rtl8102e
		1457	dd 0x7cf00000, 0x24800000, 07, sz_rtl8102e
		1458	dd 0x7cf00000, 0x34000000, 13, sz_rtl8101e
		1459	dd 0x7cf00000, 0x34300000, 10, sz_rtl8101e
		1460	dd 0x7cf00000, 0x34200000, 16, sz_rtl8168b
		1461	dd 0x7c800000, 0x34800000, 09, sz_rtl8102e
		1462	dd 0x7c800000, 0x24800000, 09, sz_rtl8102e
		1463	dd 0x7c800000, 0x34000000, 16, sz_rtl8168b
		1464	dd 0xfc800000, 0x38800000, 15, sz_rtl8100e
		1465	dd 0xfc800000, 0x30800000, 14, sz_rtl8100e
5494	hidnplayr	1466
7299	hidnplayr	1467	; 8110 family
		1468	dd 0xfc800000, 0x98000000, 06, sz_rtl8169sc
		1469	dd 0xfc800000, 0x18000000, 05, sz_rtl8169sc
		1470	dd 0xfc800000, 0x10000000, 04, sz_rtl8169sb
		1471	dd 0xfc800000, 0x04000000, 03, sz_rtl8110s
		1472	dd 0xfc800000, 0x00800000, 02, sz_rtl8169s
		1473	dd 0xfc800000, 0x00000000, 01, sz_rtl8169
5494	hidnplayr	1474
		1475	; Catch-all
7299	hidnplayr	1476	dd 0x00000000, 0x00000000, 0, sz_unknown
5494	hidnplayr	1477
7299	hidnplayr	1478	sz_rtl8169 db "Realtek 8169",0
		1479	sz_rtl8169s db "Realtek 8169s",0
		1480	sz_rtl8110s db "Realtek 8110s",0
		1481	sz_rtl8169sb db "Realtek 8169sb/8110sb",0
		1482	sz_rtl8169sc db "Realtek 8169sc/8110sc",0
		1483	sz_rtl8102e db "Realtek 8102e",0
		1484	sz_rtl8101e db "Realtek 8101e",0
		1485	sz_rtl8168b db "Realtek 8168b/8111b",0
		1486	sz_rtl8100e db "Realtek 8100e",0
		1487	sz_rtl8168p db "Realtek 8168c+/8111c+",0
		1488	sz_rtl8168c db "Realtek 8168c/8111c",0
		1489	sz_rtl8168d db "Realtek 8168d/8111d",0
		1490	sz_rtl8168dp db "Realtek 8168d+/8111d+",0
		1491	sz_rtl8105e db "Realtek 8105e",0
		1492	sz_rtl8168e db "Realtek 8168e/8111e",0
		1493	sz_rtl8168evl db "Realtek 8168evl/8111evl",0
		1494	sz_rtl8168f db "Realtek 8168f/8111f",0
		1495	sz_rtl8402 db "Realtek 8402",0
		1496	sz_rtl8411 db "Realtek 8411",0
		1497	sz_rtl8106e db "Realtek 8106e",0
		1498	sz_rtl8168ep db "Realtek 8168e+",0
		1499	sz_rtl8168g db "Realtek 8168g/8111g",0
		1500	sz_rtl8168h db "Realtek 8168h/8111h",0
		1501	sz_unknown db "unknown RTL8169 rev",0
5494	hidnplayr	1502
5050	hidnplayr	1503	align 4
		1504	devices dd 0
3545	hidnplayr	1505	device_list rd MAX_DEVICES ; This list contains all pointers to device structures the driver is handling
		1506

Subversion Repositories Kolibri OS

(root)/drivers/ethernet/RTL8169.asm @ 6947 – Rev 8997