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

Rev	Author	Line No.	Line
3545	hidnplayr	1	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		2	;; ;;
		3	;; Copyright (C) KolibriOS team 2004-2013. All rights reserved. ;;
		4	;; Distributed under terms of the GNU General Public License ;;
		5	;; ;;
		6	;; RTL8029/ne2000 driver for KolibriOS ;;
		7	;; ;;
		8	;; based on RTL8029.asm driver for menuetos ;;
		9	;; and realtek8029.asm for SolarOS by Eugen Brasoveanu ;;
		10	;; ;;
		11	;; Written by hidnplayr@kolibrios.org ;;
		12	;; with help from CleverMouse ;;
		13	;; ;;
		14	;; GNU GENERAL PUBLIC LICENSE ;;
		15	;; Version 2, June 1991 ;;
		16	;; ;;
		17	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		18
		19	format MS COFF
		20
		21	API_VERSION = 0x01000100
		22	DRIVER_VERSION = 5
		23
		24	MAX_DEVICES = 16
		25
		26	DEBUG = 1
		27	__DEBUG__ = 1
3856	hidnplayr	28	__DEBUG_LEVEL__ = 2 ; 1 = verbose, 2 = errors only
3545	hidnplayr	29
		30	include '../proc32.inc'
		31	include '../imports.inc'
		32	include '../fdo.inc'
		33	include '../netdrv.inc'
		34
		35	virtual at ebx
		36
		37	device:
		38
		39	ETH_DEVICE
		40
		41	.io_addr dd ?
		42	.irq_line db ?
		43	.pci_bus dd ?
		44	.pci_dev dd ?
		45
		46	.flags db ?
		47	.vendor db ?
		48
		49	.memsize db ?
		50	.rx_start db ?
		51	.tx_start db ?
		52	.bmem dd ?
		53	.rmem dd ?
		54
		55	.size = $ - device
		56
		57	end virtual
		58
		59
		60	public START
		61	public service_proc
		62	public version
		63
		64	P0_COMMAND = 0x00
		65	P0_PSTART = 0x01
		66	P0_PSTOP = 0x02
		67	P0_BOUND = 0x03
		68	P0_TSR = 0x04
		69	P0_TPSR = 0x04
		70	P0_TBCR0 = 0x05
		71	P0_TBCR1 = 0x06
		72	P0_ISR = 0x07
		73	P0_RSAR0 = 0x08
		74	P0_RSAR1 = 0x09
		75	P0_RBCR0 = 0x0A
		76	P0_RBCR1 = 0x0B
		77	P0_RSR = 0x0C
		78	P0_RCR = 0x0C
		79	P0_TCR = 0x0D
		80	P0_DCR = 0x0E
		81	P0_IMR = 0x0F
		82
		83	P1_COMMAND = 0x00
		84	P1_PAR0 = 0x01
		85	P1_PAR1 = 0x02
		86	P1_PAR2 = 0x03
		87	P1_PAR3 = 0x04
		88	P1_PAR4 = 0x05
		89	P1_PAR5 = 0x06
		90	P1_CURR = 0x07
		91	P1_MAR0 = 0x08
		92
		93	CMD_PS0 = 0x00 ; Page 0 select
		94	CMD_PS1 = 0x40 ; Page 1 select
		95	CMD_PS2 = 0x80 ; Page 2 select
		96	CMD_RD2 = 0x20 ; Remote DMA control
		97	CMD_RD1 = 0x10
		98	CMD_RD0 = 0x08
		99	CMD_TXP = 0x04 ; transmit packet
		100	CMD_STA = 0x02 ; start
		101	CMD_STP = 0x01 ; stop
		102
		103	CMD_RDMA_READ = 001b shl 3
		104	CMD_RDMA_WRITE = 010b shl 3
		105	CMD_RDMA_SEND_PACKET = 011b shl 3
		106	CMD_RDMA_ABORT = 100b shl 3 ; really is 1xx, Abort/Complete Remote DMA
		107	; RDMA_MASK = 111b shl 3 ; internal, mask
		108
		109	RCR_MON = 0x20 ; monitor mode
		110
		111	DCR_FT1 = 0x40
		112	DCR_LS = 0x08 ; Loopback select
		113	DCR_WTS = 0x01 ; Word transfer select
		114
		115	ISR_PRX = 0x01 ; successful recv
		116	ISR_PTX = 0x02 ; successful xmit
		117	ISR_RXE = 0x04 ; receive error
		118	ISR_TXE = 0x08 ; transmit error
		119	ISR_OVW = 0x10 ; Overflow
		120	ISR_CNT = 0x20 ; Counter overflow
		121	ISR_RDC = 0x40 ; Remote DMA complete
		122	ISR_RST = 0x80 ; reset
		123
		124	IRQ_MASK = ISR_PRX ;+ ISR_PTX ;+ ISR_RDC + ISR_PTX + ISR_TXE
		125
		126	RSTAT_PRX = 1 shl 0 ; successful recv
		127	RSTAT_CRC = 1 shl 1 ; CRC error
		128	RSTAT_FAE = 1 shl 2 ; Frame alignment error
		129	RSTAT_OVER = 1 shl 3 ; FIFO overrun
		130
		131	TXBUF_SIZE = 6
		132	RXBUF_END = 32
		133	PAGE_SIZE = 256
		134
		135	ETH_ZLEN = 60
		136	ETH_FRAME_LEN = 1514
		137
		138	FLAG_PIO = 1 shl 0
		139	FLAG_16BIT = 1 shl 1
		140
		141	VENDOR_NONE = 0
		142	VENDOR_WD = 1
		143	VENDOR_NOVELL = 2
		144	VENDOR_3COM = 3
		145
		146	NE_ASIC = 0x10
		147	NE_RESET = 0x0F ; Used to reset card
		148	NE_DATA = 0x00 ; Used to read/write NIC mem
		149
		150	MEM_8k = 32
		151	MEM_16k = 64
		152	MEM_32k = 128
		153
		154	ISA_MAX_ADDR = 0x400
		155
		156
		157
		158	section '.flat' code readable align 16
		159
		160	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		161	;;
		162	;; proc START
		163	;;
		164	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		165
		166	align 4
		167	proc START stdcall, state:dword
		168
		169	cmp [state], 1
		170	jne .exit
		171	.entry:
3856	hidnplayr	172	DEBUGF 1, "Loading driver\n"
3545	hidnplayr	173	stdcall RegService, my_service, service_proc
		174	ret
		175	.fail:
		176	.exit:
		177	xor eax, eax
		178	ret
		179
		180	endp
		181
		182
		183	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		184	;;
		185	;; proc SERVICE_PROC
		186	;;
		187	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		188
		189	align 4
		190	proc service_proc stdcall, ioctl:dword
		191
		192	mov edx, [ioctl]
		193	mov eax, [IOCTL.io_code]
		194
		195	;------------------------------------------------------
		196	;---------------
		197	cmp eax, 0 ;SRV_GETVERSION
		198	jne @F ;---------------
		199
		200	cmp [IOCTL.out_size], 4
		201	jb .fail
		202	mov eax, [IOCTL.output]
		203	mov [eax], dword API_VERSION
		204
		205	xor eax, eax
		206	ret
		207
		208	;------------------------------------------------------
		209	@@: ;---------
		210	cmp eax, 1 ;SRV_HOOK
		211	jne @F ;---------
		212
3856	hidnplayr	213	DEBUGF 1, "Checking if device is already listed..\n"
3545	hidnplayr	214
		215	mov eax, [IOCTL.input]
		216
		217	cmp [IOCTL.inp_size], 3
		218	jb .fail
		219	cmp byte [eax], 1
		220	je .pci
		221
		222	cmp [IOCTL.inp_size], 4
		223	jb .fail
		224	cmp byte [eax], 0
		225	je .isa
		226
		227	jmp .fail
		228
		229	.pci:
		230
		231	; check if the device is already listed
		232
		233	mov esi, device_list
		234	mov ecx, [devices]
		235	test ecx, ecx
		236	jz .firstdevice_pci
		237
		238	mov ax, [eax+1] ; get the pci bus and device numbers
		239	.nextdevice:
		240	mov ebx, [esi]
		241	cmp al, byte[device.pci_bus]
		242	jne @f
		243	cmp ah, byte[device.pci_dev]
		244	je .find_devicenum ; Device is already loaded, let's find it's device number
		245	@@:
		246	add esi, 4
		247	loop .nextdevice
		248
		249	.firstdevice_pci:
		250	call create_new_struct
		251
		252	mov eax, [IOCTL.input]
		253	movzx ecx, byte[eax+1]
		254	mov [device.pci_bus], ecx
		255	movzx ecx, byte[eax+2]
		256	mov [device.pci_dev], ecx
		257
		258	; Now, it's time to find the base io addres of the PCI device
		259
		260	PCI_find_io
		261
		262	; We've found the io address, find IRQ now
		263
		264	PCI_find_irq
		265
		266	jmp .hook
		267
		268	.isa:
		269
		270	mov esi, device_list
		271	mov ecx, [devices]
		272	test ecx, ecx
		273	jz .firstdevice_isa
		274	mov al, [eax+3]
		275	movzx edi, word [eax+1]
		276	.nextdevice_isa:
		277	mov ebx, [esi]
		278	cmp edi, [device.io_addr]
		279	jne .maybenext
		280	cmp al, [device.irq_line]
		281	je find_device_num
		282	.maybenext:
		283	add esi, 4
		284	loop .nextdevice_isa
		285
		286
		287
		288	.firstdevice_isa:
		289	call create_new_struct
		290
		291	mov eax, [IOCTL.input]
		292	movzx ecx, word [eax+1]
		293	mov [device.io_addr], ecx
		294	mov cl, [eax+3]
		295	mov [device.irq_line], cl
		296
		297	.hook:
		298
3856	hidnplayr	299	DEBUGF 1, "Hooking into device, dev:%x, bus:%x, irq:%x, addr:%x\n",\
3545	hidnplayr	300	[device.pci_dev]:1,[device.pci_bus]:1,[device.irq_line]:1,[device.io_addr]:4
		301
		302	call probe ; this function will output in eax
		303	test eax, eax
		304	jnz .err ; If an error occured, exit
		305
		306	mov eax, [devices]
		307	mov [device_list+4*eax], ebx
		308	inc [devices]
		309
		310	mov [device.type], NET_TYPE_ETH
		311	call NetRegDev
		312
		313	cmp eax, -1
		314	jz .err
		315	ret
		316
		317
		318	; If the device was already loaded, find the device number and return it in eax
		319
		320	.find_devicenum:
3856	hidnplayr	321	DEBUGF 1, "Trying to find device number of already registered device\n"
3545	hidnplayr	322	call NetPtrToNum ; This kernel procedure converts a pointer to device struct in ebx
		323	; into a device number in edi
		324	mov eax, edi ; Application wants it in eax instead
3856	hidnplayr	325	DEBUGF 1, "Kernel says: %u\n", eax
3545	hidnplayr	326	ret
		327
		328	.err:
3856	hidnplayr	329	DEBUGF 2, "Failed, removing device structure\n"
3545	hidnplayr	330	stdcall KernelFree, ebx
		331
		332	jmp .fail
		333
		334	;------------------------------------------------------
		335	@@:
		336	.fail:
		337	or eax, -1
		338	ret
		339
		340	;------------------------------------------------------
		341	endp
		342
		343
		344	create_new_struct:
		345
		346	cmp [devices], MAX_DEVICES
		347	jae .fail
		348
		349	allocate_and_clear ebx, device.size, .fail ; Allocate the buffer for device structure
		350
		351	mov [device.reset], reset
		352	mov [device.transmit], transmit
		353	mov [device.unload], unload
		354	mov [device.name], my_service
		355
		356	ret
		357
		358	.fail:
		359	add esp, 4 ; return to caller of 'hook'
		360	or eax, -1
		361	ret
		362
		363	find_device_num:
		364
3856	hidnplayr	365	DEBUGF 1, "Trying to find device number of already registered device\n"
3545	hidnplayr	366	mov ebx, eax
		367	call NetPtrToNum ; This kernel procedure converts a pointer to device struct in ebx
		368	; into a device number in edi
		369	mov eax, edi ; Application wants it in eax instead
3856	hidnplayr	370	DEBUGF 1, "Kernel says: %u\n", eax
3545	hidnplayr	371	ret
		372
		373
		374	;;/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\;;
		375	;; ;;
		376	;; Actual Hardware dependent code starts here ;;
		377	;; ;;
		378	;;/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\;;
		379
		380
		381	unload: ; TODO
		382	or eax, -1
		383	ret
		384
		385
		386
		387	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		388	;;
		389	;; probe: enables the device and clears the rx buffer
		390	;;
		391	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		392
		393	probe:
		394	mov [device.vendor], VENDOR_NONE
		395	mov [device.bmem], 0
		396
3856	hidnplayr	397	DEBUGF 1, "Trying 16-bit mode\n"
3545	hidnplayr	398
		399	mov [device.flags], FLAG_16BIT + FLAG_PIO
		400	mov [device.memsize], MEM_32k
		401	mov [device.tx_start], 64
		402	mov [device.rx_start], TXBUF_SIZE + 64
		403
		404	set_io 0
		405	set_io P0_DCR
		406	mov al, DCR_WTS + DCR_FT1 + DCR_LS ; word transfer select +
		407	out dx, al
		408
		409	set_io P0_PSTART
		410	mov al, MEM_16k
		411	out dx, al
		412
		413	set_io P0_PSTOP
		414	mov al, MEM_32k
		415	out dx, al
		416
		417	mov esi, my_service
		418	mov di, 16384
		419	mov cx, 14
		420	call PIO_write
		421
		422	mov si, 16384
		423	mov cx, 14
		424	sub esp, 16
		425	mov edi, esp
		426	call PIO_read
		427
		428	mov esi, esp
		429	add esp, 16
		430	mov edi, my_service
		431	mov ecx, 13
		432	repe cmpsb
		433	je ep_set_vendor
		434
3856	hidnplayr	435	DEBUGF 1, "16-bit mode failed\n"
		436	DEBUGF 1, "Trying 8-bit mode\n"
3545	hidnplayr	437
		438	mov [device.flags], FLAG_PIO
		439	mov [device.memsize], MEM_16k
		440	mov [device.tx_start], 32
		441	mov [device.rx_start], TXBUF_SIZE + 32
		442
		443	set_io NE_ASIC + NE_RESET
		444	in al, dx
		445	out dx, al
		446
		447	in al, 0x84
		448
		449	set_io P0_COMMAND
		450	mov al, CMD_RD2 + CMD_STP
		451	out dx, al
		452
		453	set_io P0_RCR
		454	mov al, RCR_MON
		455	out dx, al
		456
		457	set_io P0_DCR
		458	mov al, DCR_FT1 + DCR_LS
		459	out dx, al
		460
		461	set_io P0_PSTART
		462	mov al, MEM_8k
		463	out dx, al
		464
		465	set_io P0_PSTOP
		466	mov al, MEM_16k
		467	out dx, al
		468
		469	mov esi, my_service
		470	mov di, 8192
		471	mov cx, 14
		472	call PIO_write
		473
		474	mov si, 8192
		475	mov cx, 14
		476	sub esp, 16
		477	mov edi, esp
		478	call PIO_read
		479
		480	mov esi, my_service
		481	mov edi, esp
		482	add esp, 16
		483	mov ecx, 13
		484	repe cmpsb
		485	je ep_set_vendor
		486
3856	hidnplayr	487	DEBUGF 2, "This is not a valid ne2000 device!\n"
3545	hidnplayr	488	or eax, -1
		489	ret
		490
		491
		492	ep_set_vendor:
		493
3856	hidnplayr	494	DEBUGF 1, "Mode ok\n"
3545	hidnplayr	495
		496	cmp [device.io_addr], ISA_MAX_ADDR
		497	jbe .isa
		498
3856	hidnplayr	499	DEBUGF 1, "Card is using PCI bus\n"
3545	hidnplayr	500
		501	mov [device.vendor], VENDOR_NOVELL ;;; FIXME
		502	jmp ep_check_have_vendor
		503
		504	.isa:
3856	hidnplayr	505	DEBUGF 1, "Card is using ISA bus\n"
3545	hidnplayr	506
		507	mov [device.vendor], VENDOR_NOVELL
		508
		509	ep_check_have_vendor:
		510
		511
		512	mov al, [device.vendor]
		513	cmp al, VENDOR_NONE
		514	; je exit
		515
		516	cmp al, VENDOR_3COM
		517	je reset
		518
		519	mov eax, [device.bmem]
		520	mov [device.rmem], eax
		521
		522	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		523	;;
		524	;; reset: Place the chip into a virgin state
		525	;;
		526	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		527
		528	reset:
3856	hidnplayr	529	DEBUGF 1, "Resetting device\n"
3545	hidnplayr	530
		531	; attach int handler
		532	movzx eax, [device.irq_line]
3856	hidnplayr	533	DEBUGF 1, "Attaching int handler to irq %x\n", eax:1
3545	hidnplayr	534	stdcall AttachIntHandler, eax, int_handler, dword 0
3856	hidnplayr	535	test eax, eax
		536	jnz @f
		537	DEBUGF 2, "Could not attach int handler!\n"
		538	; or eax, -1
		539	; ret
		540	@@:
3545	hidnplayr	541
		542	; Stop card + DMA
		543	set_io 0
		544	; set_io P0_COMMAND
		545	mov al, CMD_PS0 + CMD_RDMA_ABORT + CMD_STP
		546	out dx, al
		547
		548	; initialize DCR
		549	set_io P0_DCR
		550	mov al, DCR_FT1 + DCR_LS
		551	test [device.flags], FLAG_16BIT
		552	jz @f
		553	or al, DCR_WTS ; word transfer select
		554	@@:
		555	out dx, al
		556
		557	; clear remote bytes count
		558	set_io P0_RBCR0
		559	xor al, al
		560	out dx, al
		561
		562	set_io P0_RBCR1
		563	out dx, al
		564
		565	; initialize Receive configuration register (until all init is done)
		566	set_io P0_RCR
		567	mov al, 0x20 ; monitor mode
		568	out dx, al
		569
		570	; transmit configuration register to monitor mode (until all ini is done)
		571	set_io P0_TCR
		572	mov al, 2 ; internal loopback
		573	out dx, al
		574
		575	; clear interupt status
		576	set_io P0_ISR
		577	mov al, 0xff
		578	out dx, al
		579
		580	; clear IRQ mask ;;;;; CHECKME ;;;;;
		581	set_io P0_IMR
		582	xor al, al
		583	out dx, al
		584
		585	; set transmit pointer
		586	set_io P0_TPSR
		587	mov al, [device.tx_start]
		588	out dx, al
		589
		590	; set pagestart pointer
		591	set_io P0_PSTART
		592	mov al, [device.rx_start]
		593	out dx, al
		594
		595	; set pagestop pointer
		596	set_io P0_PSTOP
		597	mov al, [device.memsize]
		598	out dx, al
		599
		600	; set boundary pointer
		601	set_io P0_BOUND
		602	mov al, [device.memsize]
		603	dec al
		604	out dx, al
		605
		606	; set curr pointer
		607	set_io P0_COMMAND
		608	mov al, CMD_PS1 ;+ CMD_RD2 + CMD_STP ; page 1, stop mode
		609	out dx, al
		610
		611	set_io P1_CURR
		612	mov al, [device.rx_start]
		613	out dx, al
		614
		615	set_io P0_COMMAND
		616	mov al, CMD_PS0 ;+ CMD_RD2 + CMD_STA ; go to page 0, start mode
		617	out dx, al
		618
		619	; Read MAC address and set it to registers
		620	call read_mac
		621	push .macret
		622	sub esp, 6
		623	lea esi, [device.mac]
		624	mov edi, esp
		625	movsd
		626	movsw
		627	jmp write_mac
		628	.macret:
		629
		630	; set IRQ mask
		631	set_io 0
		632	set_io P0_IMR
		633	mov al, IRQ_MASK
		634	out dx, al
		635
		636	; start mode
		637	set_io P0_COMMAND
		638	mov al, CMD_STA
		639	out dx, al
		640
		641	; clear transmit control register
		642	set_io P0_TCR
		643	xor al, al ; no loopback
		644	out dx, al
		645
		646	; set receive control register ;;;;
		647	set_io P0_RCR
		648	mov al, 4 ; accept broadcast
		649	out dx, al
		650
		651	; clear packet/byte counters
		652	xor eax, eax
		653	lea edi, [device.bytes_tx]
		654	mov ecx, 6
		655	rep stosd
		656
		657	; Set the mtu, kernel will be able to send now
		658	mov [device.mtu], ETH_FRAME_LEN
		659
		660	; Set link state to unknown
		661	mov [device.state], ETH_LINK_UNKOWN
		662
		663	; Indicate that we have successfully reset the card
		664	xor eax, eax
3856	hidnplayr	665	DEBUGF 1, "Done!\n"
3545	hidnplayr	666
		667	ret
		668
		669
		670
		671	;***************************************************************************
		672	; Function
		673	; transmit
		674	; buffer in [esp+4], size in [esp+8], pointer to device struct in ebx
		675	;***************************************************************************
		676
		677	align 4
		678	transmit:
		679
		680	mov esi, [esp + 4]
		681	mov ecx, [esp + 8]
3856	hidnplayr	682	DEBUGF 1, "Transmitting packet, buffer:%x, size:%u\n",esi, ecx
		683	DEBUGF 1, "To: %x-%x-%x-%x-%x-%x From: %x-%x-%x-%x-%x-%x Type:%x%x\n",\
3545	hidnplayr	684	[esi+0]:2,[esi+1]:2,[esi+2]:2,[esi+3]:2,[esi+4]:2,[esi+5]:2,[esi+6]:2,[esi+7]:2,[esi+8]:2,[esi+9]:2,[esi+10]:2,[esi+11]:2,[esi+13]:2,[esi+12]:2
		685
		686	cmp ecx, ETH_FRAME_LEN
		687	ja .err ; packet is too long
		688	cmp ecx, ETH_ZLEN
		689	jb .err ; packet is too short
		690
		691	movzx edi, [device.tx_start]
		692	shl edi, 8
		693	push cx
		694	call PIO_write
		695	pop cx
		696
		697	set_io 0
		698	; set_io P0_COMMAND
		699	mov al, CMD_PS0 + CMD_RD2 + CMD_STA
		700	out dx, al
		701
		702	set_io P0_TPSR
		703	mov al, [device.tx_start]
		704	out dx, al
		705
		706	set_io P0_TBCR0
		707	mov al, cl
		708	out dx, al
		709
		710	set_io P0_TBCR1
		711	mov al, ch
		712	out dx, al
		713
		714	set_io P0_COMMAND
		715	mov al, CMD_PS0 + CMD_TXP + CMD_RD2 + CMD_STA
		716	out dx, al
		717
3856	hidnplayr	718	DEBUGF 1, "Packet Sent!\n"
3545	hidnplayr	719
		720	inc [device.packets_tx]
		721	mov eax, [esp + 8] ; Get packet size in eax
		722
		723	add dword [device.bytes_tx], eax
		724	adc dword [device.bytes_tx + 4], 0
		725
		726	stdcall KernelFree, [esp+4]
		727	xor eax, eax
		728	ret 8
		729
3619	hidnplayr	730	.err:
3856	hidnplayr	731	DEBUGF 2, "Transmit error!\n"
3545	hidnplayr	732
		733	or eax, -1
		734	stdcall KernelFree, [esp+4]
		735	ret 8
		736
		737
		738
		739	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		740	;
		741	; Interrupt handler
		742	;
		743	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		744
		745	align 4
		746	int_handler:
		747
		748	push ebx esi edi
		749
3856	hidnplayr	750	DEBUGF 1, "INT\n"
3545	hidnplayr	751
		752	; find pointer of device wich made INT occur
		753
		754	mov ecx, [devices]
		755	test ecx, ecx
		756	jz .nothing
		757	mov esi, device_list
		758	.nextdevice:
		759	mov ebx, [esi]
		760
		761	set_io 0
		762	; set_io P0_COMMAND
		763	mov al, CMD_PS0
		764	out dx, al
		765
		766	set_io P0_ISR
		767	in al, dx
		768	test al, al
		769	jnz .got_it
		770	.continue:
		771	add esi, 4
		772	dec ecx
		773	jnz .nextdevice
		774	.nothing:
		775	pop edi esi ebx
		776	xor eax, eax
		777
		778	ret
		779
		780	.got_it:
		781
3856	hidnplayr	782	DEBUGF 1, "Device=%x status=%x\n", ebx, eax:2
3545	hidnplayr	783
		784	push ebx
		785
		786	test al, ISR_PRX ; packet received ok ?
		787	jz .no_rx
		788
		789	test [device.flags], FLAG_PIO
		790	jz .no_rx ; FIXME: Only PIO mode supported for now
		791
		792	;
		793
		794	pushd .no_rx
		795
		796	; allocate a buffer
		797
		798	stdcall KernelAlloc, ETH_FRAME_LEN
		799	test eax, eax
		800	jz .fail_2
		801	pushd 0
		802	push eax
		803
		804	; read offset for current packet from device
		805
		806	set_io 0
		807	set_io P0_BOUND ; boundary ptr is offset to next packet we need to read.
		808	in al, dx
		809	inc al
		810
		811	cmp al, [device.memsize]
		812	jb @f
		813	mov al, [device.rx_start]
		814	@@:
		815	mov ch, al
		816
		817	set_io P0_COMMAND
		818	mov al, CMD_PS1
		819	out dx, al
		820
		821	set_io P1_CURR
		822	in al, dx ; get current page in cl
		823	mov cl, al
		824
		825	set_io P1_COMMAND
		826	mov al, CMD_PS0
		827	out dx, al
		828
		829	cmp cl, [device.memsize]
		830	jb @f
		831	mov cl, [device.rx_start]
		832	@@:
		833
		834	cmp cl, ch
		835	je .fail
		836
		837	movzx esi, ch ; we are using 256 byte pages
		838	shl esi, 8 ; esi now holds the offset for current packet
		839
		840	; Get packet header in eax
		841
		842	sub esp, 4 ; reserve 4 bytes on stack to put packet header in
		843	mov edi, esp
		844	mov cx, 4
		845	call PIO_read
		846
		847	mov ecx, [esp] ; ecx now contains packet header
		848
		849	; check if packet is ok
		850
		851	test ecx, RSTAT_PRX
		852	jz .fail_3
		853
		854	; calculate packet length in ecx
		855
		856	shr ecx, 16
		857	sub ecx, 4 ; CRC doesnt count as data byte
		858	mov [esp + 4 + 4], ecx
		859
		860	; check if packet size is ok
		861
		862	cmp ecx, ETH_ZLEN
		863	jb .fail_3
		864	cmp ecx, ETH_FRAME_LEN
		865	ja .fail_3
		866
		867	; update stats
		868
3856	hidnplayr	869	DEBUGF 1, "Received %u bytes\n", ecx
3545	hidnplayr	870
		871	add dword[device.bytes_rx], ecx
		872	adc dword[device.bytes_rx + 4], 0
		873	inc [device.packets_rx]
		874
		875	; update read and write pointers
		876
		877	add esi, 4
		878	mov edi, [esp + 4]
		879
		880	; now check if we can read all data at once (if we cross the end boundary, we need to wrap back to the beginning)
		881
		882	xor eax, eax
		883	mov ah, [device.memsize]
		884	sub eax, esi
		885	cmp ecx, eax ; eax = number of bytes till end of buffer, ecx = bytes we need to read
		886	jbe .no_wrap
		887
		888	; Read first part
		889
		890	sub ecx, eax
		891	push ecx
		892	mov ecx, eax
		893
		894	call PIO_read ; Read the data
		895
		896	; update pointers
		897
		898	add edi, ecx
		899	pop ecx
		900
		901	movzx esi, [device.rx_start]
		902	shl esi, 8
		903
		904	; now read second part (or only part)
		905
		906	.no_wrap:
		907	call PIO_read ; Read the data
		908
		909	; update boundary pointer
		910
		911	pop eax
		912	mov al, ah
		913	cmp al, [device.rx_start]
		914	jne @f
		915	mov al, [device.memsize]
		916	@@:
		917
		918	set_io 0
		919	set_io P0_BOUND
		920	dec al
		921	out dx, al
		922
		923	; now send the data to the kernel
		924
		925	jmp Eth_input
		926
		927	.fail_3:
		928	add esp, 4
		929	.fail:
		930	add esp, 8
		931	.fail_2:
		932
		933
		934	.no_rx:
		935	pop ebx
3856	hidnplayr	936	DEBUGF 1, "done\n"
3545	hidnplayr	937
		938	set_io 0
		939	set_io P0_ISR
		940	mov al, 0xff
		941	out dx, al
		942
		943	pop edi esi ebx
		944
		945	ret
		946
		947
		948
		949
		950
		951	;;;;;;;;;;;;;;;;;;;;;;;
		952	;; ;;
		953	;; Write MAC address ;;
		954	;; ;;
		955	;;;;;;;;;;;;;;;;;;;;;;;
		956
		957	align 4
		958	write_mac: ; in: mac on stack (6 bytes)
		959
3856	hidnplayr	960	DEBUGF 1, "Writing MAC\n"
3545	hidnplayr	961
		962	set_io 0
		963	mov al, CMD_PS1; + CMD_RD2 + CMD_STP
		964	out dx, al
		965
		966	set_io P1_PAR0
		967	mov esi, esp
		968	mov cx, 6
		969	@@:
		970	lodsb
		971	out dx, al
		972	inc dx
		973	loopw @r
		974
		975	add esp, 6
		976
		977	; Notice this procedure does not ret, but continues to read_mac instead.
		978
		979	;;;;;;;;;;;;;;;;;;;;;;
		980	;; ;;
		981	;; Read MAC address ;;
		982	;; ;;
		983	;;;;;;;;;;;;;;;;;;;;;;
		984
		985	read_mac:
		986
3856	hidnplayr	987	DEBUGF 1, "Reading MAC\n"
3545	hidnplayr	988
		989	xor esi, esi
		990	mov cx, 16
		991	sub esp, 16
		992	mov edi, esp
		993	call PIO_read
		994
		995	mov esi, esp
		996	add esp, 16
		997	lea edi, [device.mac]
		998	mov ecx, 6
		999	.loop:
		1000	movsb
		1001	test [device.flags], FLAG_16BIT
		1002	jz .8bit
		1003	inc esi
		1004	.8bit:
		1005	loop .loop
		1006
3856	hidnplayr	1007	DEBUGF 1, "MAC=%x-%x-%x-%x-%x-%x\n",\
3545	hidnplayr	1008	[device.mac]:2,[device.mac+1]:2,[device.mac+2]:2,[device.mac+3]:2,[device.mac+4]:2,[device.mac+5]:2
		1009
		1010	ret
		1011
		1012
		1013	;***************************************************************************
		1014	;
		1015	; PIO_read
		1016	;
		1017	; Description
		1018	; Read a frame from the ethernet card via Programmed I/O
		1019	; src in si
		1020	; cnt in cx
		1021	; dst in edi
		1022	;***************************************************************************
		1023	PIO_read:
		1024
3856	hidnplayr	1025	DEBUGF 1, "PIO Read from %x to %x, %u bytes ", si, edi, cx
3545	hidnplayr	1026
		1027	; start DMA
		1028	set_io 0
		1029	; set_io P0_COMMAND
		1030	mov al, CMD_RD2 + CMD_STA
		1031	out dx, al
		1032
		1033	; set length of data we're interested in
		1034	set_io P0_RBCR0
		1035	mov al, cl
		1036	out dx, al
		1037
		1038	set_io P0_RBCR1
		1039	mov al, ch
		1040	out dx, al
		1041
		1042	; set offset of what we want to read
		1043	set_io P0_RSAR0
		1044	mov ax, si
		1045	out dx, al
		1046
		1047	set_io P0_RSAR1
		1048	shr ax, 8
		1049	out dx, al
		1050
		1051	; start DMA read
		1052	set_io P0_COMMAND
		1053	mov al, CMD_RD0 + CMD_STA
		1054	out dx, al
		1055
		1056	set_io NE_ASIC
		1057
		1058	test [device.flags], FLAG_16BIT
		1059	jz .8bits
		1060
3856	hidnplayr	1061	DEBUGF 1, "(16-bit mode)\n"
3545	hidnplayr	1062
		1063	shr cx, 1 ; note that if the number was odd, carry flag will be set
		1064	pushf
		1065
		1066	.16bits:
		1067	in ax, dx
		1068	stosw
		1069	loopw .16bits
		1070
		1071	inc cx
		1072	popf
		1073	jnc .done
		1074	jmp .8bits_
		1075
		1076	.8bits:
3856	hidnplayr	1077	DEBUGF 1, "(8-bit mode)\n"
3545	hidnplayr	1078
		1079	.8bits_:
		1080	in al, dx
		1081	stosb
		1082	loopw .8bits_
		1083
		1084
		1085	.done:
		1086	; set_io 0
		1087	; set_io P0_ISR
		1088	;
		1089	; .dmawait: ; Wait for Remote DMA Complete
		1090	; in al, dx
		1091	; test al, ISR_RDC
		1092	; jz .dmawait
		1093	; and al, not ISR_RDC
		1094	; out dx, al ; clear the bit
		1095
		1096	ret
		1097
		1098
		1099
		1100
		1101	;***************************************************************************
		1102	;
		1103	; PIO_write
		1104	;
		1105	; Description
		1106	; writes a frame to the ethernet card via Programmed I/O
		1107	; dst in di
		1108	; cnt in cx
		1109	; src in esi
		1110	;***************************************************************************
		1111	PIO_write:
		1112
3856	hidnplayr	1113	DEBUGF 1, "Eth PIO Write from %x to %x, %u bytes ", esi, di, cx
3545	hidnplayr	1114
		1115	set_io 0
		1116	; set_io P0_COMMAND
		1117	mov al, CMD_RD2 + CMD_STA
		1118	out dx, al
		1119
		1120	set_io P0_ISR
		1121	mov al, ISR_RDC
		1122	out dx, al
		1123
		1124	set_io P0_RBCR0
		1125	mov al, cl
		1126	out dx, al
		1127
		1128	set_io P0_RBCR1
		1129	mov al, ch
		1130	out dx, al
		1131
		1132	mov ax, di
		1133	set_io P0_RSAR0
		1134	out dx, al
		1135	shr ax, 8
		1136	set_io P0_RSAR1
		1137	out dx, al
		1138
		1139	set_io P0_COMMAND
		1140	mov al, CMD_RD1 + CMD_STA
		1141	out dx, al
		1142
		1143	set_io NE_ASIC
		1144	test [device.flags], FLAG_16BIT
		1145	jz .8_bit
		1146
3856	hidnplayr	1147	DEBUGF 1, "(16-bit mode)\n"
3545	hidnplayr	1148
		1149	shr cx, 1 ; note that if the number was odd, carry flag will be set
		1150	pushf ; save the flags for later
		1151
		1152	.16bit:
		1153	lodsw
		1154	out dx, ax
		1155	loopw .16bit
		1156
		1157	popf
		1158	jnc .done
		1159	inc cx
		1160	jmp .8_bit_
		1161
		1162	.8_bit:
		1163
3856	hidnplayr	1164	DEBUGF 1, "(8-bit mode)\n"
3545	hidnplayr	1165
		1166	.8_bit_:
		1167	lodsb
		1168	out dx, al
		1169	loopw .8_bit_
		1170
		1171	.done:
		1172	; set_io 0
		1173	; set_io P0_ISR
		1174	; .dmawait: ; Wait for Remote DMA Complete
		1175	; in al, dx
		1176	; test al, ISR_RDC
		1177	; jz .dmawait
		1178	; and al, not ISR_RDC
		1179	; out dx, al ; clear the bit
		1180
		1181	ret
		1182
		1183
		1184
		1185	;all initialized data place here
		1186	align 4
		1187
		1188	devices dd 0
		1189	version dd (DRIVER_VERSION shl 16) or (API_VERSION and 0xFFFF)
		1190	my_service db 'RTL8029/ne2000',0 ;max 16 chars include zero
		1191
		1192	;device_1 db 'Realtek 8029',0
		1193	;device_2 db 'Realtek 8019',0
		1194	;device_3 db 'Realtek 8019AS',0
		1195	;device_4 db 'ne2000',0
		1196	;device_5 db 'DP8390',0
		1197
		1198	include_debug_strings
		1199
		1200	section '.data' data readable writable align 16 ;place all uninitialized data place here
		1201
		1202	device_list rd MAX_DEVICES
		1203

Subversion Repositories Kolibri OS

(root)/drivers/ethernet/RTL8029.asm @ 4103 – Rev 3856