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
		28	__DEBUG_LEVEL__ = 2
		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:
		172	DEBUGF 2,"Registering %s driver\n", my_service
		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
		213	DEBUGF 2,"Checking if device is already listed..\n"
		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
		299	DEBUGF 2,"Hooking into device, dev:%x, bus:%x, irq:%x, addr:%x\n",\
		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:
		321	DEBUGF 1,"Trying to find device number of already registered device\n"
		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
		325	DEBUGF 1,"Kernel says: %u\n", eax
		326	ret
		327
		328	.err:
		329	DEBUGF 1,"Failed, removing device structure\n"
		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
		365	DEBUGF 1,"Trying to find device number of already registered device\n"
		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
		370	DEBUGF 1,"Kernel says: %u\n", eax
		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
		397	DEBUGF 2,"Trying 16-bit mode\n"
		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
		435	DEBUGF 2,"16-bit mode failed\n"
		436	DEBUGF 2,"Trying 8-bit mode\n"
		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
		487	DEBUGF 2,"This is not a valid ne2000 device!\n"
		488	or eax, -1
		489	ret
		490
		491
		492	ep_set_vendor:
		493
		494	DEBUGF 2,"Mode ok\n"
		495
		496	cmp [device.io_addr], ISA_MAX_ADDR
		497	jbe .isa
		498
		499	DEBUGF 2,"Card is using PCI bus\n"
		500
		501	mov [device.vendor], VENDOR_NOVELL ;;; FIXME
		502	jmp ep_check_have_vendor
		503
		504	.isa:
		505	DEBUGF 2,"Card is using ISA bus\n"
		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:
		529	DEBUGF 2,"Resetting device\n"
		530
		531	; attach int handler
		532	movzx eax, [device.irq_line]
		533	DEBUGF 1,"Attaching int handler to irq %x\n", eax:1
		534	stdcall AttachIntHandler, eax, int_handler, dword 0
		535
		536	; Stop card + DMA
		537	set_io 0
		538	; set_io P0_COMMAND
		539	mov al, CMD_PS0 + CMD_RDMA_ABORT + CMD_STP
		540	out dx, al
		541
		542	; initialize DCR
		543	set_io P0_DCR
		544	mov al, DCR_FT1 + DCR_LS
		545	test [device.flags], FLAG_16BIT
		546	jz @f
		547	or al, DCR_WTS ; word transfer select
		548	@@:
		549	out dx, al
		550
		551	; clear remote bytes count
		552	set_io P0_RBCR0
		553	xor al, al
		554	out dx, al
		555
		556	set_io P0_RBCR1
		557	out dx, al
		558
		559	; initialize Receive configuration register (until all init is done)
		560	set_io P0_RCR
		561	mov al, 0x20 ; monitor mode
		562	out dx, al
		563
		564	; transmit configuration register to monitor mode (until all ini is done)
		565	set_io P0_TCR
		566	mov al, 2 ; internal loopback
		567	out dx, al
		568
		569	; clear interupt status
		570	set_io P0_ISR
		571	mov al, 0xff
		572	out dx, al
		573
		574	; clear IRQ mask ;;;;; CHECKME ;;;;;
		575	set_io P0_IMR
		576	xor al, al
		577	out dx, al
		578
		579	; set transmit pointer
		580	set_io P0_TPSR
		581	mov al, [device.tx_start]
		582	out dx, al
		583
		584	; set pagestart pointer
		585	set_io P0_PSTART
		586	mov al, [device.rx_start]
		587	out dx, al
		588
		589	; set pagestop pointer
		590	set_io P0_PSTOP
		591	mov al, [device.memsize]
		592	out dx, al
		593
		594	; set boundary pointer
		595	set_io P0_BOUND
		596	mov al, [device.memsize]
		597	dec al
		598	out dx, al
		599
		600	; set curr pointer
		601	set_io P0_COMMAND
		602	mov al, CMD_PS1 ;+ CMD_RD2 + CMD_STP ; page 1, stop mode
		603	out dx, al
		604
		605	set_io P1_CURR
		606	mov al, [device.rx_start]
		607	out dx, al
		608
		609	set_io P0_COMMAND
		610	mov al, CMD_PS0 ;+ CMD_RD2 + CMD_STA ; go to page 0, start mode
		611	out dx, al
		612
		613	; Read MAC address and set it to registers
		614	call read_mac
		615	push .macret
		616	sub esp, 6
		617	lea esi, [device.mac]
		618	mov edi, esp
		619	movsd
		620	movsw
		621	jmp write_mac
		622	.macret:
		623
		624	; set IRQ mask
		625	set_io 0
		626	set_io P0_IMR
		627	mov al, IRQ_MASK
		628	out dx, al
		629
		630	; start mode
		631	set_io P0_COMMAND
		632	mov al, CMD_STA
		633	out dx, al
		634
		635	; clear transmit control register
		636	set_io P0_TCR
		637	xor al, al ; no loopback
		638	out dx, al
		639
		640	; set receive control register ;;;;
		641	set_io P0_RCR
		642	mov al, 4 ; accept broadcast
		643	out dx, al
		644
		645	; clear packet/byte counters
		646	xor eax, eax
		647	lea edi, [device.bytes_tx]
		648	mov ecx, 6
		649	rep stosd
		650
		651	; Set the mtu, kernel will be able to send now
		652	mov [device.mtu], ETH_FRAME_LEN
		653
		654	; Set link state to unknown
		655	mov [device.state], ETH_LINK_UNKOWN
		656
		657	; Indicate that we have successfully reset the card
		658	xor eax, eax
		659	DEBUGF 2,"Done!\n"
		660
		661	ret
		662
		663
		664
		665	;***************************************************************************
		666	; Function
		667	; transmit
		668	; buffer in [esp+4], size in [esp+8], pointer to device struct in ebx
		669	;***************************************************************************
		670
		671	align 4
		672	transmit:
		673
		674	mov esi, [esp + 4]
		675	mov ecx, [esp + 8]
		676	DEBUGF 2,"Transmitting packet, buffer:%x, size:%u\n",esi, ecx
		677	DEBUGF 2,"To: %x-%x-%x-%x-%x-%x From: %x-%x-%x-%x-%x-%x Type:%x%x\n",\
		678	[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
		679
		680	cmp ecx, ETH_FRAME_LEN
		681	ja .err ; packet is too long
		682	cmp ecx, ETH_ZLEN
		683	jb .err ; packet is too short
		684
		685	movzx edi, [device.tx_start]
		686	shl edi, 8
		687	push cx
		688	call PIO_write
		689	pop cx
		690
		691	set_io 0
		692	; set_io P0_COMMAND
		693	mov al, CMD_PS0 + CMD_RD2 + CMD_STA
		694	out dx, al
		695
		696	set_io P0_TPSR
		697	mov al, [device.tx_start]
		698	out dx, al
		699
		700	set_io P0_TBCR0
		701	mov al, cl
		702	out dx, al
		703
		704	set_io P0_TBCR1
		705	mov al, ch
		706	out dx, al
		707
		708	set_io P0_COMMAND
		709	mov al, CMD_PS0 + CMD_TXP + CMD_RD2 + CMD_STA
		710	out dx, al
		711
		712	DEBUGF 2," - Packet Sent!\n"
		713
		714	inc [device.packets_tx]
		715	mov eax, [esp + 8] ; Get packet size in eax
		716
		717	add dword [device.bytes_tx], eax
		718	adc dword [device.bytes_tx + 4], 0
		719
		720	stdcall KernelFree, [esp+4]
		721	xor eax, eax
		722	ret 8
		723
		724	.err:
		725	DEBUGF 2," - Error!\n"
		726
		727	or eax, -1
		728	stdcall KernelFree, [esp+4]
		729	ret 8
		730
		731
		732
		733	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		734	;
		735	; Interrupt handler
		736	;
		737	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
		738
		739	align 4
		740	int_handler:
		741
		742	push ebx esi edi
		743
		744	DEBUGF 1,"\n%s int\n", my_service
		745
		746	; find pointer of device wich made INT occur
		747
		748	mov ecx, [devices]
		749	test ecx, ecx
		750	jz .nothing
		751	mov esi, device_list
		752	.nextdevice:
		753	mov ebx, [esi]
		754
		755	set_io 0
		756	; set_io P0_COMMAND
		757	mov al, CMD_PS0
		758	out dx, al
		759
		760	set_io P0_ISR
		761	in al, dx
		762	test al, al
		763	jnz .got_it
		764	.continue:
		765	add esi, 4
		766	dec ecx
		767	jnz .nextdevice
		768	.nothing:
		769	pop edi esi ebx
		770	xor eax, eax
		771
		772	ret
		773
		774	.got_it:
		775
		776	DEBUGF 1,"Device=%x status=%x\n", ebx, eax:2
		777
		778	push ebx
		779
		780	test al, ISR_PRX ; packet received ok ?
		781	jz .no_rx
		782
		783	test [device.flags], FLAG_PIO
		784	jz .no_rx ; FIXME: Only PIO mode supported for now
		785
		786	;
		787
		788	pushd .no_rx
		789
		790	; allocate a buffer
		791
		792	stdcall KernelAlloc, ETH_FRAME_LEN
		793	test eax, eax
		794	jz .fail_2
		795	pushd 0
		796	push eax
		797
		798	; read offset for current packet from device
		799
		800	set_io 0
		801	set_io P0_BOUND ; boundary ptr is offset to next packet we need to read.
		802	in al, dx
		803	inc al
		804
		805	cmp al, [device.memsize]
		806	jb @f
		807	mov al, [device.rx_start]
		808	@@:
		809	mov ch, al
		810
		811	set_io P0_COMMAND
		812	mov al, CMD_PS1
		813	out dx, al
		814
		815	set_io P1_CURR
		816	in al, dx ; get current page in cl
		817	mov cl, al
		818
		819	set_io P1_COMMAND
		820	mov al, CMD_PS0
		821	out dx, al
		822
		823	cmp cl, [device.memsize]
		824	jb @f
		825	mov cl, [device.rx_start]
		826	@@:
		827
		828	cmp cl, ch
		829	je .fail
		830
		831	movzx esi, ch ; we are using 256 byte pages
		832	shl esi, 8 ; esi now holds the offset for current packet
		833
		834	; Get packet header in eax
		835
		836	sub esp, 4 ; reserve 4 bytes on stack to put packet header in
		837	mov edi, esp
		838	mov cx, 4
		839	call PIO_read
		840
		841	mov ecx, [esp] ; ecx now contains packet header
		842
		843	; check if packet is ok
		844
		845	test ecx, RSTAT_PRX
		846	jz .fail_3
		847
		848	; calculate packet length in ecx
		849
		850	shr ecx, 16
		851	sub ecx, 4 ; CRC doesnt count as data byte
		852	mov [esp + 4 + 4], ecx
		853
		854	; check if packet size is ok
		855
		856	cmp ecx, ETH_ZLEN
		857	jb .fail_3
		858	cmp ecx, ETH_FRAME_LEN
		859	ja .fail_3
		860
		861	; update stats
		862
		863	DEBUGF 2,"Received %u bytes\n", ecx
		864
		865	add dword[device.bytes_rx], ecx
		866	adc dword[device.bytes_rx + 4], 0
		867	inc [device.packets_rx]
		868
		869	; update read and write pointers
		870
		871	add esi, 4
		872	mov edi, [esp + 4]
		873
		874	; now check if we can read all data at once (if we cross the end boundary, we need to wrap back to the beginning)
		875
		876	xor eax, eax
		877	mov ah, [device.memsize]
		878	sub eax, esi
		879	cmp ecx, eax ; eax = number of bytes till end of buffer, ecx = bytes we need to read
		880	jbe .no_wrap
		881
		882	DEBUGF 2,"WRAP!\n"
		883
		884	; Read first part
		885
		886	sub ecx, eax
		887	push ecx
		888	mov ecx, eax
		889
		890	call PIO_read ; Read the data
		891
		892	; update pointers
		893
		894	add edi, ecx
		895	pop ecx
		896
		897	movzx esi, [device.rx_start]
		898	shl esi, 8
		899
		900	; now read second part (or only part)
		901
		902	.no_wrap:
		903	call PIO_read ; Read the data
		904
		905	; update boundary pointer
		906
		907	pop eax
		908	mov al, ah
		909	cmp al, [device.rx_start]
		910	jne @f
		911	mov al, [device.memsize]
		912	@@:
		913
		914	set_io 0
		915	set_io P0_BOUND
		916	dec al
		917	out dx, al
		918
		919	; now send the data to the kernel
		920
		921	jmp Eth_input
		922
		923	.fail_3:
		924	add esp, 4
		925	.fail:
		926	add esp, 8
		927	.fail_2:
		928
		929
		930	.no_rx:
		931	pop ebx
		932	DEBUGF 2,"done\n"
		933
		934	set_io 0
		935	set_io P0_ISR
		936	mov al, 0xff
		937	out dx, al
		938
		939	pop edi esi ebx
		940
		941	ret
		942
		943
		944
		945
		946
		947	;;;;;;;;;;;;;;;;;;;;;;;
		948	;; ;;
		949	;; Write MAC address ;;
		950	;; ;;
		951	;;;;;;;;;;;;;;;;;;;;;;;
		952
		953	align 4
		954	write_mac: ; in: mac on stack (6 bytes)
		955
		956	DEBUGF 1,"Writing MAC\n"
		957
		958	set_io 0
		959	mov al, CMD_PS1; + CMD_RD2 + CMD_STP
		960	out dx, al
		961
		962	set_io P1_PAR0
		963	mov esi, esp
		964	mov cx, 6
		965	@@:
		966	lodsb
		967	out dx, al
		968	inc dx
		969	loopw @r
		970
		971	add esp, 6
		972
		973	; Notice this procedure does not ret, but continues to read_mac instead.
		974
		975	;;;;;;;;;;;;;;;;;;;;;;
		976	;; ;;
		977	;; Read MAC address ;;
		978	;; ;;
		979	;;;;;;;;;;;;;;;;;;;;;;
		980
		981	read_mac:
		982
		983	DEBUGF 1,"Reading MAC\n"
		984
		985	xor esi, esi
		986	mov cx, 16
		987	sub esp, 16
		988	mov edi, esp
		989	call PIO_read
		990
		991	mov esi, esp
		992	add esp, 16
		993	lea edi, [device.mac]
		994	mov ecx, 6
		995	.loop:
		996	movsb
		997	test [device.flags], FLAG_16BIT
		998	jz .8bit
		999	inc esi
		1000	.8bit:
		1001	loop .loop
		1002
		1003	DEBUGF 1,"MAC=%x-%x-%x-%x-%x-%x\n",\
		1004	[device.mac]:2,[device.mac+1]:2,[device.mac+2]:2,[device.mac+3]:2,[device.mac+4]:2,[device.mac+5]:2
		1005
		1006	ret
		1007
		1008
		1009	;***************************************************************************
		1010	;
		1011	; PIO_read
		1012	;
		1013	; Description
		1014	; Read a frame from the ethernet card via Programmed I/O
		1015	; src in si
		1016	; cnt in cx
		1017	; dst in edi
		1018	;***************************************************************************
		1019	PIO_read:
		1020
		1021	DEBUGF 1,"PIO Read from %x to %x, %u bytes ", si, edi, cx
		1022
		1023	; start DMA
		1024	set_io 0
		1025	; set_io P0_COMMAND
		1026	mov al, CMD_RD2 + CMD_STA
		1027	out dx, al
		1028
		1029	; set length of data we're interested in
		1030	set_io P0_RBCR0
		1031	mov al, cl
		1032	out dx, al
		1033
		1034	set_io P0_RBCR1
		1035	mov al, ch
		1036	out dx, al
		1037
		1038	; set offset of what we want to read
		1039	set_io P0_RSAR0
		1040	mov ax, si
		1041	out dx, al
		1042
		1043	set_io P0_RSAR1
		1044	shr ax, 8
		1045	out dx, al
		1046
		1047	; start DMA read
		1048	set_io P0_COMMAND
		1049	mov al, CMD_RD0 + CMD_STA
		1050	out dx, al
		1051
		1052	set_io NE_ASIC
		1053
		1054	test [device.flags], FLAG_16BIT
		1055	jz .8bits
		1056
		1057	DEBUGF 1,"(16-bit mode)\n"
		1058
		1059	shr cx, 1 ; note that if the number was odd, carry flag will be set
		1060	pushf
		1061
		1062	.16bits:
		1063	in ax, dx
		1064	stosw
		1065	loopw .16bits
		1066
		1067	inc cx
		1068	popf
		1069	jnc .done
		1070	jmp .8bits_
		1071
		1072	.8bits:
		1073	DEBUGF 1,"(8-bit mode)\n"
		1074
		1075	.8bits_:
		1076	in al, dx
		1077	stosb
		1078	loopw .8bits_
		1079
		1080
		1081	.done:
		1082	; set_io 0
		1083	; set_io P0_ISR
		1084	;
		1085	; .dmawait: ; Wait for Remote DMA Complete
		1086	; in al, dx
		1087	; test al, ISR_RDC
		1088	; jz .dmawait
		1089	; and al, not ISR_RDC
		1090	; out dx, al ; clear the bit
		1091
		1092	ret
		1093
		1094
		1095
		1096
		1097	;***************************************************************************
		1098	;
		1099	; PIO_write
		1100	;
		1101	; Description
		1102	; writes a frame to the ethernet card via Programmed I/O
		1103	; dst in di
		1104	; cnt in cx
		1105	; src in esi
		1106	;***************************************************************************
		1107	PIO_write:
		1108
		1109	DEBUGF 1,"Eth PIO Write from %x to %x, %u bytes ", esi, di, cx
		1110
		1111	set_io 0
		1112	; set_io P0_COMMAND
		1113	mov al, CMD_RD2 + CMD_STA
		1114	out dx, al
		1115
		1116	set_io P0_ISR
		1117	mov al, ISR_RDC
		1118	out dx, al
		1119
		1120	set_io P0_RBCR0
		1121	mov al, cl
		1122	out dx, al
		1123
		1124	set_io P0_RBCR1
		1125	mov al, ch
		1126	out dx, al
		1127
		1128	mov ax, di
		1129	set_io P0_RSAR0
		1130	out dx, al
		1131	shr ax, 8
		1132	set_io P0_RSAR1
		1133	out dx, al
		1134
		1135	set_io P0_COMMAND
		1136	mov al, CMD_RD1 + CMD_STA
		1137	out dx, al
		1138
		1139	set_io NE_ASIC
		1140	test [device.flags], FLAG_16BIT
		1141	jz .8_bit
		1142
		1143	DEBUGF 1,"(16-bit mode)\n"
		1144
		1145	shr cx, 1 ; note that if the number was odd, carry flag will be set
		1146	pushf ; save the flags for later
		1147
		1148	.16bit:
		1149	lodsw
		1150	out dx, ax
		1151	loopw .16bit
		1152
		1153	popf
		1154	jnc .done
		1155	inc cx
		1156	jmp .8_bit_
		1157
		1158	.8_bit:
		1159
		1160	DEBUGF 1,"(8-bit mode)\n"
		1161
		1162	.8_bit_:
		1163	lodsb
		1164	out dx, al
		1165	loopw .8_bit_
		1166
		1167	.done:
		1168	; set_io 0
		1169	; set_io P0_ISR
		1170	; .dmawait: ; Wait for Remote DMA Complete
		1171	; in al, dx
		1172	; test al, ISR_RDC
		1173	; jz .dmawait
		1174	; and al, not ISR_RDC
		1175	; out dx, al ; clear the bit
		1176
		1177	ret
		1178
		1179
		1180
		1181	;all initialized data place here
		1182	align 4
		1183
		1184	devices dd 0
		1185	version dd (DRIVER_VERSION shl 16) or (API_VERSION and 0xFFFF)
		1186	my_service db 'RTL8029/ne2000',0 ;max 16 chars include zero
		1187
		1188	;device_1 db 'Realtek 8029',0
		1189	;device_2 db 'Realtek 8019',0
		1190	;device_3 db 'Realtek 8019AS',0
		1191	;device_4 db 'ne2000',0
		1192	;device_5 db 'DP8390',0
		1193
		1194	include_debug_strings
		1195
		1196	section '.data' data readable writable align 16 ;place all uninitialized data place here
		1197
		1198	device_list rd MAX_DEVICES
		1199

Subversion Repositories Kolibri OS

(root)/drivers/ethernet/RTL8029.asm – Rev 3545