WebSVN – Kolibri OS – Diff – /kernel/branches/net/drivers/RTL8139.asm

 ;; Copyright (C) KolibriOS team 2004-2010. All rights reserved.    ;;
 ;; Distributed under terms of the GNU General Public License       ;;
 ;;                                                                 ;;
-;; Realtek 8139 driver for KolibriOS                               ;;
+;;  Realtek 8139 driver for KolibriOS                              ;;
 ;;                                                                 ;;
-;;    Written by hidnplayr@kolibrios.org                           ;;
+;;  based on RTL8139.asm driver for menuetos                       ;;
+;;  and realtek8139.asm for SolarOS by Eugen Brasoveanu            ;;
 ;;                                                                 ;;
-;;     0.1 - x march 2009                                          ;;
-;;     0.2 - 8 november 2009                                       ;;
+;;    Written by hidnplayr@kolibrios.org                           ;;
 ;;                                                                 ;;
 ;;          GNU GENERAL PUBLIC LICENSE                             ;;
 ;;             Version 2, June 1991                                ;;
 ;;                                                                 ;;
 ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
 format MS COFF
+	API_VERSION		equ 0x01000100
+	DRIVER_VERSION		equ 5
-	API_VERSION		equ 0x01000100
+	MAX_DEVICES		equ 16
 	DEBUG			equ 1
 	__DEBUG__		equ 1
 	__DEBUG_LEVEL__ 	equ 2
-include 'proc32.inc'
-include 'imports.inc'
-include 'fdo.inc'
-include 'netdrv.inc'
 include 'proc32.inc'
-OS_BASE 	equ 0
+include 'imports.inc'
-new_app_base	equ 0x60400000
+include 'fdo.inc'
-PROC_BASE	equ OS_BASE+0x0080000
-public START
-public service_proc
-public version
-virtual at ebx
-      device:
-      ETH_DEVICE
-      .rx_buffer	dd ?
-      .tx_buffer	dd ?
-      .rx_data_offset	dd ?
-      .io_addr		dd ?
-      .curr_tx_desc	db ?
-      .pci_bus		db ?
-      .pci_dev		db ?
-      .irq_line 	db ?
-      .hw_ver_id	db ?
-      .size = $ - device
-end virtual
-; RTL8139 specific defines
-	MAX_RTL8139		equ 16	 ; Max number of devices this driver may handle
-	TX_TIMEOUT		equ 30	 ; 300 milliseconds timeout
 include 'netdrv.inc'
 	PCI_REG_CMD		equ 0x04 ; command register
-	PCI_BIT_PIO		equ 0	 ; bit0: io space control
+public START
-	PCI_BIT_MMIO		equ 1	 ; bit1: memory space control
+public service_proc
-	PCI_BIT_MASTER		equ 2	 ; bit2: device acts as a PCI master
+public version
 				    (1 shl BIT_AR) or \ 		; Accept Runt packets (smaller then 64 bytes)
 				    (1 shl BIT_AM)			; Accept multicast packets
 	RX_BUFFER_SIZE		equ (8192 shl RBLEN);+16
+	MAX_ETH_FRAME_SIZE	equ 1516 ; exactly 1514 wthout CRC
 	MAX_ETH_FRAME_SIZE	equ 1516 ; exactly 1514 wthout CRC
-	NUM_TX_DESC		equ 4
-	TX_BUF_SIZE		equ 4096 ; size of one tx buffer (set to 4kb because of KolibriOS's page size)
+	NUM_TX_DESC		equ 4
 	EE_93C46_REG_ETH_ID	equ 7 ; MAC offset
 	EE_93C46_READ_CMD	equ (6 shl 6) ; 110b + 6bit address
 	TSR_OWC 		equ 1 SHL 29
 	TSR_TABT		equ 1 SHL 30
 	TSR_CRS 		equ 1 SHL 31
+virtual at ebx
+	device:
+	ETH_DEVICE
+	.rx_buffer	dd ?
+	.tx_buffer	dd ?
+	.rx_data_offset dd ?
+	.io_addr	dd ?
+	.curr_tx_desc	db ?
+	.last_tx_desc	db ?
+	.pci_bus	db ?
+	.pci_dev	db ?
+	.irq_line	db ?
+	.hw_ver_id	db ?
+	.TX_DESC	rd NUM_TX_DESC
+	.size = $ - device
+end virtual
 	cmp	byte [eax], 1				; 1 means device number and bus number (pci) are given
 	jne	.fail					; other types arent supported for this card yet
 ; check if the device is already listed
-	mov	esi, RTL8139_LIST
+	mov	esi, device_list
-	mov	ecx, [RTL8139_DEV]
+	mov	ecx, [devices]
 	test	ecx, ecx
 	jz	.firstdevice
 	loop	.nextdevice
 ; This device doesnt have its own eth_device structure yet, lets create one
   .firstdevice:
-	cmp	[RTL8139_DEV], MAX_RTL8139		; First check if the driver can handle one more card
+	cmp	[devices], MAX_DEVICES			; First check if the driver can handle one more card
 	jge	.fail
 	DEBUGF	2,"Hooking into device, dev:%x, bus:%x, irq:%x, addr:%x\n",\
 	[device.pci_dev]:1,[device.pci_bus]:1,[device.irq_line]:1,[device.io_addr]:4
 	allocate_and_clear [device.rx_buffer], (RX_BUFFER_SIZE+MAX_ETH_FRAME_SIZE), .err
-	allocate_and_clear [device.tx_buffer], (TX_BUF_SIZE*NUM_TX_DESC), .err
+   ;;     allocate_and_clear [device.tx_buffer], (TX_BUF_SIZE*NUM_TX_DESC), .err
 ; Ok, the eth_device structure is ready, let's probe the device
 	call	probe							; this function will output in eax
 	test	eax, eax
-	jnz	.err							; If an error occured, exit
 	jnz	.err							; If an error occured, exit
 	mov	eax, [RTL8139_DEV]					; Add the device structure to our device list
-	mov	[RTL8139_LIST+4*eax], ebx				; (IRQ handler uses this list to find device)
+	mov	eax, [devices]						; Add the device structure to our device list
   .destroy:
 	; todo: reset device into virgin state
   .err:
 	stdcall KernelFree, dword [device.rx_buffer]
-	stdcall KernelFree, dword [device.tx_buffer]
+     ;;   stdcall KernelFree, dword [device.tx_buffer]
 	stdcall KernelFree, ebx
 ; init RX/TX pointers
+	mov	[device.rx_data_offset], eax
-	mov	[device.rx_data_offset], eax
+	mov	[device.curr_tx_desc], al
-	mov	[device.curr_tx_desc], al
+	mov	[device.last_tx_desc], al
 ; clear missing packet counter
 	set_io	REG_MPC
-	out	dx , eax
-; Set up the 4 Txbuffer descriptors
-	set_io	REG_TSAD0
-	mov	eax, [device.tx_buffer]
-	mov	ecx, 4
-  .loop:
-	push	eax
-	call	GetPgAddr
-	DEBUGF	1,"Desc: %x ", eax
-	out	dx , eax
-	add	dx , 4
-	pop	eax
-	add	eax, TX_BUF_SIZE
-	loop	.loop
+	out	dx , eax
 ; set RxBuffer address, init RX buffer offset
 ; Read MAC address
+	call	read_mac
 ; Set the mtu, kernel will be able to send now
-	call	read_mac
+	mov	[device.mtu], 1514
 ;; In: buffer pointer in [esp+4]           ;;
 ;;     size of buffer in [esp+8]           ;;
 ;;     pointer to device structure in ebx  ;;
 ;;                                         ;;
 ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
 align 4
 transmit:
 	DEBUGF	1,"Transmitting packet, buffer:%x, size:%u\n",[esp+4],[esp+8]
 	mov	eax, [esp+4]
 	DEBUGF	1,"To: %x-%x-%x-%x-%x-%x From: %x-%x-%x-%x-%x-%x Type:%x%x\n",\
 	[eax+00]:2,[eax+01]:2,[eax+02]:2,[eax+03]:2,[eax+04]:2,[eax+05]:2,\
 	[eax+06]:2,[eax+07]:2,[eax+08]:2,[eax+09]:2,[eax+10]:2,[eax+11]:2,\
 	[eax+13]:2,[eax+12]:2
 	cmp	dword [esp+8], MAX_ETH_FRAME_SIZE
-	jg	.finish 			; packet is too long
+	jg	.fail
 	cmp	dword [esp+8], 60
-	jl	.finish 			; packet is too short
+	jl	.fail
-; check descriptor
+; check if we own the discriptor
-	DEBUGF	1,"Checking descriptor, "
+	set_io	0
 	movzx	ecx, [device.curr_tx_desc]
-	mov	edx, [device.io_addr]
+	shl	ecx, 2
-	lea	edx, [edx+ecx*4+REG_TSD0]
-	in	ax, dx
-	test	ax, 0x1fff ; or no size given
-	jz	.send_packet
+	lea	edx, [edx+ecx+REG_TSD0]
-	and	ax, (1 shl BIT_TOK) or (1 shl BIT_OWN)
+	in	ax, dx
-	cmp	ax, (1 shl BIT_TOK) or (1 shl BIT_OWN)
-	jz	.send_packet
-; wait for timeout
-	DEBUGF	1,"Waiting for timeout, "
-	push	edx ebx 			 ; TODO : rtl8139 internal timer should be used instead
-	stdcall Sleep, TX_TIMEOUT		 ; ? What registers does this destroy ?
-	pop	ebx edx
-	in	ax, dx
-	and	ax, (1 shl BIT_TOK) or (1 shl BIT_OWN)
-	cmp	ax, (1 shl BIT_TOK) or (1 shl BIT_OWN)
-	jz	.send_packet			 ; if chip hung, reset it
-	push	dx
+	test	ax, (1 shl BIT_OWN)
-	call	reset				 ; reset the card
+	jz	.wait_to_send
-	pop	dx
-.send_packet:
-	DEBUGF	1,"Sending packet, "
-	push	edx
-	movzx	eax, [device.curr_tx_desc]   ; calculate the current tx_buffer address
+  .send_packet:
-	mov	edx, TX_BUF_SIZE ;MAX_ETH_FRAME_SIZE          ;
-	mul	edx				 ;
-	mov	edi, [device.tx_buffer]      ;
-	add	edi, eax			 ; Store it in edi
-	pop	edx
+; Set the buffer address
+	set_io	0
-	mov	esi, [esp+4]			 ; Copy data to that address
+	lea	edx, [edx+ecx+REG_TSAD0]
-	mov	ecx, [esp+8]			 ;
-	shr	ecx, 2				 ;
+	mov	eax, [esp+4]
-	rep	movsd				 ;
+	mov	[device.TX_DESC+ecx], eax
+	GetRealAddr
-	mov	ecx, [esp+8]			 ;
+	out	dx, eax
-	and	ecx, 3				 ;
+; And the size of the buffer
+	set_io	0
+	lea	edx, [edx+ecx+REG_TSD0]
+	mov	eax, [esp+8]
-	rep	movsb				 ;
+;        or      eax, (ERTXTH shl BIT_ERTXTH)    ; Early threshold
 	out	dx , eax
-	inc	[device.packets_tx]	     ;
-	mov	eax, [esp+8]			 ; Get packet size in eax
-	add	dword [device.bytes_tx], eax
-	adc	dword [device.bytes_tx + 4], 0
+; Update stats
 	inc	[device.packets_tx]
-;        or      eax, (ERTXTH shl BIT_ERTXTH)     ; Set descriptor size and the early tx treshold into the correct Transmission status register (TSD0, TSD1, TSD2 or TSD3)
+	add	dword [device.bytes_tx], eax
+	adc	dword [device.bytes_tx + 4], 0
+; get next descriptor
+	inc	[device.curr_tx_desc]
+	and	[device.curr_tx_desc], 3
+	DEBUGF	1,"Packet Sent! "
+	xor	eax, eax
+	ret	8
+  .wait_to_send:
+	DEBUGF	1,"Waiting for timeout\n"
+	mov	esi, 30
+	stdcall Sleep
+	in	ax, dx
+	test	ax, (1 shl BIT_OWN)
+	jnz	.send_packet
-	out	dx , eax			 ;
+	pusha
+	call	reset				 ; if chip hung, reset it
-; get next descriptor 0, 1, 2, 3, 0, 1, 2, 3, 0, 1, ...
+	popa
 	inc	[device.curr_tx_desc]
-	and	[device.curr_tx_desc], 3
+	jmp	.send_packet
-	DEBUGF	1," - Packet Sent! "
+  .fail:
-.finish:
+	DEBUGF	1,"failed!\n"
-	DEBUGF	1," - Done!\n"
-	ret
+	or	eax, -1
 	ret	8
 ;;;;;;;;;;;;;;;;;;;;;;;
-;;                   ;;
+;;;;;;;;;;;;;;;;;;;;;;;
-;; Interrupt handler ;;
+;;                   ;;
-;;                   ;;
+;; Interrupt handler ;;
 ; Lets found out why the irq occured then..
-;----------------------------------------------------
-; Received packet ok?
+;----------------------------------------------------
 ; Received packet ok?
 	test	ax, ISR_ROK
 	jz	@f
 	stdcall KernelAlloc, ecx		    ; Allocate a buffer to put packet into
 	pop	ecx
 	test	eax, eax			    ; Test if we allocated succesfully
 	jz	.abort
 	mov	edi, eax			    ; Where we will copy too
   .finish:
 	pop	ax
 ;----------------------------------------------------
-; Transmit error ?
 ; Transmit error ?
   @@:
 	test	ax, ISR_TER
 	jz	@f
-	push	ax
-	cmp	[device.curr_tx_desc], 4
-	jz	.notxd
-	set_io	0
-	movzx	ecx, [device.curr_tx_desc]
-	lea	edx, [edx+ecx*4+REG_TSD0]
-	in	eax, dx
-  .notxd:
-	test	eax, TSR_TUN
-	jz	.nobun
-	DEBUGF	2, "TX: FIFO Buffer underrun!\n"
-  .nobun:
-	test	eax, TSR_OWC
-	jz	.noowc
-	DEBUGF	2, "TX: OWC!\n"
-  .noowc:
-	test	eax, TSR_TABT
-	jz	.notabt
-	DEBUGF	2, "TX: TABT!\n"
-  .notabt:
-	test	eax, TSR_CRS
-	jz	.nocsl
-	DEBUGF	2, "TX: Carrier Sense Lost!\n"
-  .nocsl:
+;        push    ax
-;                test    eax, TSR_OWN or TSR_TOK
-;                jz      .nofd
+;        cmp     [device.curr_tx_desc], 4
+;        jz      .notxd
+;
+;        set_io  0
+;        movzx   ecx, [device.curr_tx_desc]
+;        lea     edx, [edx+ecx*4+REG_TSD0]
+;        in      eax, dx
+;
-;                DEBUGF  1, "TX: Transmit OK (desc: %u)\n", ecx
+;  .notxd:
+;        test    eax, TSR_TUN
+;        jz      .nobun
-;
+;        DEBUGF  2, "TX: FIFO Buffer underrun!\n"
+;
+;  .nobun:
+;        test    eax, TSR_OWC
+;        jz      .noowc
+;        DEBUGF  2, "TX: OWC!\n"
+;
+;  .noowc:
+;        test    eax, TSR_TABT
+;        jz      .notabt
+;        DEBUGF  2, "TX: TABT!\n"
+;
+;  .notabt:
+;        test    eax, TSR_CRS
+;        jz      .nocsl
+;        DEBUGF  2, "TX: Carrier Sense Lost!\n"
+;
-;               .nofd:
+;  .nocsl:
-	pop	ax
+;        pop     ax
 ;----------------------------------------------------
-; Transmit ok ?
+;----------------------------------------------------
 ; Transmit ok ?
+  @@:
+	test	ax, ISR_TOK
+	jz	@f
+	push	ax
+	mov	si, 4
+  .txdesloop:
+	movzx	ecx, [device.last_tx_desc]
+	shl	ecx, 2
+	set_io	0
+	set_io	REG_TSD0
+	add	edx, ecx
+	in	eax, dx
-  @@:
+	test	eax, TSR_TOK
+	jz	.notthisone
+	mov	eax, TSR_OWN
+	out	dx , eax
+	DEBUGF	1,"TX OK: free buffer %x\n", [device.TX_DESC+ecx]:8
+	stdcall KernelFree, [device.TX_DESC+ecx]
+  .notthisone:
+	inc	[device.last_tx_desc]
+	and	[device.last_tx_desc], 3
+	dec	si
-	test	ax, ISR_TOK
+	jnz	.txdesloop
 	jz	@f
-	DEBUGF	1, "TX: Transmit OK (desc: %u)\n", [device.curr_tx_desc]:1
+  .done:
 	pop	ax
 ;----------------------------------------------------
-; Rx buffer overflow ?
+;----------------------------------------------------
 ; Rx buffer overflow ?
   @@:
 	test	ax, ISR_RXOVW
 	jz	@f
 	push	ax
 	DEBUGF	2,"RX-buffer overflow!\n"
-	mov	edx, [device.io_addr]
-	add	edx, REG_ISR
-	mov	ax , ISR_FIFOOVW or ISR_RXOVW
+	set_io	0
-	out	dx , ax
+	set_io	REG_ISR
-	pop	ax
+	mov	ax , ISR_FIFOOVW or ISR_RXOVW
 	out	dx , ax
-;----------------------------------------------------
+	pop	ax
 ; Packet underrun? ?
 ;----------------------------------------------------
-  @@:
+; Packet underrun?
-	test	ax, ISR_PUN
+  @@:
-	jz	@f
+	test	ax, ISR_PUN
+	jz	@f
-	DEBUGF	2,"Packet underrun!\n"
+	DEBUGF	2,"Packet underrun!\n"
 ;----------------------------------------------------
-; Receive FIFO overflow ?
+;----------------------------------------------------
 ; Receive FIFO overflow ?
   @@:
 	test	ax, ISR_FIFOOVW
-	jz	@f
 	jz	@f
 	push	ax
-	DEBUGF	2,"RX fifo overflox!\n"
+	push	ax
 	DEBUGF	2,"RX fifo overflow!\n"
 	mov	edx, [device.io_addr]
-	add	edx, REG_ISR
-	mov	ax , ISR_FIFOOVW or ISR_RXOVW
-	out	dx , ax
+	set_io	0
-	pop	ax
-;----------------------------------------------------
+	set_io	REG_ISR
 	ret
 ; End of code
-; End of code
+section '.data' data readable writable align 16 ; place all uninitialized data place here
 align 4 					; Place all initialised data here
-RTL8139_DEV   dd 0
+devices 	dd 0
-version       dd (5 shl 16) or (API_VERSION and 0xFFFF)
+version 	dd (DRIVER_VERSION shl 16) or (API_VERSION and 0xFFFF)
-device_6      db 'Realtek 8139D',0
+device_6	db 'Realtek 8139D',0
-device_7      db 'Realtek 8139CP',0
+device_7	db 'Realtek 8139CP',0
-device_8      db 'Realtek 8101',0
+device_8	db 'Realtek 8101',0
-device_unknown db 'Unknown RTL8139 clone', 0
+device_unknown	db 'Unknown RTL8139 clone', 0
+crosslist:
-crosslist     dd device_1
+	dd device_1
-	      dd device_2
+	dd device_2
-	      dd device_3
+	dd device_3
-	      dd device_4
+	dd device_4
-	      dd device_5
+	dd device_5
-	      dd device_6
+	dd device_6
-	      dd device_7
+	dd device_7
-	      dd device_8
+	dd device_8
-	      dd device_unknown
+	dd device_unknown
 hw_ver_array:			 ; This array is used by the probe routine to find out wich version of the RTL8139 we are working with
-hw_ver_array  db VER_RTL8139			; This array is used by the probe routine to find out wich version of the RTL8139 we are working with
+	db VER_RTL8139
-	      db VER_RTL8139A
+	db VER_RTL8139A
-	      db VER_RTL8139B
+	db VER_RTL8139B
-	      db VER_RTL8139C
+	db VER_RTL8139C
 HW_VER_ARRAY_SIZE = $-hw_ver_array
-include_debug_strings				; All data wich FDO uses will be included here

Subversion Repositories Kolibri OS

(root)/kernel/branches/net/drivers/RTL8139.asm – Rev 1514 → 1519