Subversion Repositories Kolibri OS

;;                                                                 ;;

;;                                                                 ;;

;; Copyright (C) KolibriOS team 2004-2007. All rights reserved.    ;;

;; Copyright (C) KolibriOS team 2004-2007. All rights reserved.    ;;

;; Distributed under terms of the GNU General Public License       ;;

;; Distributed under terms of the GNU General Public License       ;;

;;                                                                 ;;

;;                                                                 ;;

;;  RTL8169.INC                                                    ;;

;;  RTL8169.INC                                                    ;;

;;                                                                 ;;

;;                                                                 ;;

;;  See file COPYING for details                                   ;;

;;  See file COPYING for details                                   ;;

;;                                                                 ;;

;;                                                                 ;;

;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;

;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;

$Revision: 593 $

$Revision: 914 $

align 256

align 256

rtl8169_txb rb NUM_TX_DESC * RX_BUF_SIZE

rtl8169_txb rb NUM_TX_DESC * RX_BUF_SIZE

; Define the RX Descriptor

; Define the RX Descriptor

rtl8169_rx_ring rb NUM_RX_DESC * sizeof.rtl8169_TxDesc

rtl8169_rx_ring rb NUM_RX_DESC * sizeof.rtl8169_RxDesc

; Create a static buffer of size RX_BUF_SZ for each

; Create a static buffer of size RX_BUF_SZ for each

; RX Descriptor   All descriptors point to a

; RX Descriptor   All descriptors point to a

; Set device to be a busmaster in case BIOS neglected to do so.

; Set device to be a busmaster in case BIOS neglected to do so.

; Also adjust PCI latency timer to a reasonable value, 32.

; Also adjust PCI latency timer to a reasonable value, 32.

	DEBUGF	1,"K : adjust_pci_device\n"

;        DEBUGF  1,"K : adjust_pci_device\n"

	stdcall pci_read_config_word,PCI_COMMAND

	stdcall pci_read_config_word,PCI_COMMAND

	mov	bx,ax

	mov	bx,ax

	cmp	ax,bx

	cmp	ax,bx

	je	@f

	je	@f

	DEBUGF	1,"K : adjust_pci_device: The PCI BIOS has not enabled this device!\nK :   Updating PCI command %x->%x. pci_bus %x pci_device_fn %x\n",ax,bx,[pci_bus]:2,[pci_dev]:2

;        DEBUGF  1,"K : adjust_pci_device: The PCI BIOS has not enabled this device!\nK :   Updating PCI command %x->%x. pci_bus %x pci_device_fn %x\n",ax,bx,[pci_bus]:2,[pci_dev]:2

	stdcall pci_write_config_word,PCI_COMMAND,ebx

	stdcall pci_write_config_word,PCI_COMMAND,ebx

    @@:

    @@:

	cmp	al,32

	cmp	al,32

	jae	@f

	jae	@f

	DEBUGF	1,"K : adjust_pci_device: PCI latency timer (CFLT) is unreasonably low at %d.\nK :   Setting to 32 clocks.\n",al

;        DEBUGF  1,"K : adjust_pci_device: PCI latency timer (CFLT) is unreasonably low at %d.\nK :   Setting to 32 clocks.\n",al

	stdcall pci_write_config_byte,PCI_LATENCY_TIMER,32

	stdcall pci_write_config_byte,PCI_LATENCY_TIMER,32

	mov	eax,[index]

	mov	eax,[index]

	add	eax,4

	add	eax,4

	stdcall pci_read_config_dword,eax

	stdcall pci_read_config_dword,eax

	or	eax,eax

	or	eax,eax

	jz	.not64

	jz	.not64

	add	esp,4

	add	esp,4

	or	eax,-1

	or	eax,-1

	ret

	ret

  .not64:

  .not64:

	pop	eax

	pop	eax

	ret

	ret

endp

endp

	DEBUGF	1,"K : rtl8169_init_board\n"

;        DEBUGF  1,"K : rtl8169_init_board\n"

	loop	@b

	loop	@b

    @@:

    @@:

	; identify config method

	; identify config method

	RTL_R32 RTL8169_REG_TxConfig

	RTL_R32 RTL8169_REG_TxConfig

	and	eax,0x7c800000

	and	eax,0x7c800000

	mov	esi,mac_info-8

	mov	esi,mac_info-8

    @@: add	esi,8

    @@: add	esi,8

	mov	ecx,eax

	mov	ecx,eax

	and	ecx,[esi]

	and	ecx,[esi]

	cmp	ecx,[esi]

	cmp	ecx,[esi]

	jne	@b

	jne	@b

	mov	[rtl8169_tpc.chipset],ecx

	mov	[rtl8169_tpc.chipset],ecx

	jmp	.match

	jmp	.match

    @@:

    @@:

	; if unknown chip, assume array element #0, original RTL-8169 in this case

	; if unknown chip, assume array element #0, original RTL-8169 in this case

	RTL_R32 RTL8169_REG_TxConfig

	RTL_R32 RTL8169_REG_TxConfig

	mov	[rtl8169_tpc.chipset],0

	mov	[rtl8169_tpc.chipset],0

	ret

	ret

endp

endp

	DEBUGF	1,"K : rtl8169_hw_PHY_config: priv.mcfg=%d, priv.pcfg=%d\n",[rtl8169_tpc.mcfg],[rtl8169_tpc.pcfg]

;        DEBUGF  1,"K : rtl8169_hw_PHY_config: priv.mcfg=%d, priv.pcfg=%d\n",[rtl8169_tpc.mcfg],[rtl8169_tpc.pcfg]

	stdcall RTL8169_WRITE_GMII_REG,0x1F,0x0000

	stdcall RTL8169_WRITE_GMII_REG,0x1F,0x0000

	stdcall RTL8169_WRITE_GMII_REG,0x0B,0x0000

	stdcall RTL8169_WRITE_GMII_REG,0x0B,0x0000

	jmp	.exit

	jmp	.exit

  .not_2_or_3:

  .not_2_or_3:

;       DBG_PRINT("tpc->mcfg=%d. Discard hw PHY config.\n", tpc->mcfg);

;       DBG_PRINT("tpc->mcfg=%d. Discard hw PHY config.\n", tpc->mcfg);

  .exit:

  .exit:

	ret

	ret

endp

endp

;proc pci_write_config_byte

;proc pci_write_config_byte

;       ret

;       ret

;endp

;endp

proc RTL8169_WRITE_GMII_REG,RegAddr:byte,value:dword

proc RTL8169_WRITE_GMII_REG,RegAddr:byte,value:dword

	DEBUGF	1,"K : RTL8169_WRITE_GMII_REG: 0x%x 0x%x\n",[RegAddr]:2,[value]

;;;     DEBUGF  1,"K : RTL8169_WRITE_GMII_REG: 0x%x 0x%x\n",[RegAddr]:2,[value]

	movzx	eax,[RegAddr]

	movzx	eax,[RegAddr]

	or	eax,[value]

	or	eax,[value]

	or	eax,0x80000000

	or	eax,0x80000000

	RTL_W32 RTL8169_REG_PHYAR,eax

	RTL_W32 RTL8169_REG_PHYAR,eax

	stdcall udelay,1000

	stdcall udelay,1	;;;1000

	; Check if the RTL8169 has completed writing to the specified MII register

	; Check if the RTL8169 has completed writing to the specified MII register

    @@: RTL_R32 RTL8169_REG_PHYAR

    @@: RTL_R32 RTL8169_REG_PHYAR

	test	eax,0x80000000

	test	eax,0x80000000

	jz	.exit

	jz	.exit

	stdcall udelay,100

	stdcall udelay,1	;;;100

  .exit:

  .exit:

	ret

	ret

endp

endp

proc RTL8169_READ_GMII_REG,RegAddr:byte

proc RTL8169_READ_GMII_REG,RegAddr:byte

	DEBUGF	1,"K : RTL8169_READ_GMII_REG: 0x%x\n",[RegAddr]:2

;;;     DEBUGF  1,"K : RTL8169_READ_GMII_REG: 0x%x\n",[RegAddr]:2

	push	ecx

	push	ecx

	movzx	eax,[RegAddr]

	movzx	eax,[RegAddr]

	shl	eax,16

	shl	eax,16

	RTL_W32 RTL8169_REG_PHYAR,eax

	RTL_W32 RTL8169_REG_PHYAR,eax

	stdcall udelay,1000

	stdcall udelay,1	;;;1000

	mov	ecx,2000

	mov	ecx,2000

	ret

	ret

endp

endp

	DEBUGF	1,"K : rtl8169_set_rx_mode\n"

;        DEBUGF  1,"K : rtl8169_set_rx_mode\n"

	; IFF_ALLMULTI

	; IFF_ALLMULTI

	ret

	ret

endp

endp

	DEBUGF	1,"K : rtl8169_init_ring\n"

;        DEBUGF  1,"K : rtl8169_init_ring\n"

	mov	edi,[rtl8169_tpc.RxDescArray]

	mov	edi,[rtl8169_tpc.RxDescArray]

	mov	eax,rtl8169_rxb

	mov	eax,rtl8169_rxb

	mov	ecx,NUM_RX_DESC

	mov	ecx,NUM_RX_DESC

    @@: mov	[esi],eax

    @@: mov	[esi],eax

	mov	[edi+rtl8169_RxDesc.buf_addr],eax

	mov	[edi+rtl8169_RxDesc.buf_addr],eax

	mov	[edi+rtl8169_RxDesc.status],RTL8169_DSB_OWNbit or RX_BUF_SIZE

	mov	[edi+rtl8169_RxDesc.status],RTL8169_DSB_OWNbit or RX_BUF_SIZE

	add	esi,4

	add	esi,4

	add	edi,sizeof.rtl8169_RxDesc

	add	edi,sizeof.rtl8169_RxDesc

	add	eax,RX_BUF_SIZE

	add	eax,RX_BUF_SIZE

	loop	@b

	loop	@b

	ret

	ret

endp

endp

	DEBUGF	1,"K : rtl8169_hw_start\n"

;        DEBUGF  1,"K : rtl8169_hw_start\n"

	; Soft reset the chip

	; Soft reset the chip

;       RTL_W16 0xE2,0x152a

;       RTL_W16 0xE2,0x152a

;       RTL_W16 0xE2,0x282a

;       RTL_W16 0xE2,0x282a

	RTL_W16 0xE2,0x0000

	RTL_W16 0xE2,0x0000

	RTL_W32 RTL8169_REG_RxDescStartAddr,[rtl8169_tpc.RxDescArray]

	pop	eax								; shurf 28.09.2008

	RTL_W8	RTL8169_REG_Cfg9346,RTL8169_CFG_9346_Lock

	RTL_W8	RTL8169_REG_Cfg9346,RTL8169_CFG_9346_Lock

	stdcall udelay,10

	stdcall udelay,10

	RTL_W32 RTL8169_REG_RxMissed,0

	RTL_W32 RTL8169_REG_RxMissed,0

	call	rtl8169_set_rx_mode

	call	rtl8169_set_rx_mode

;      eax, ebx, ecx, edx

;      eax, ebx, ecx, edx

;

;

;***************************************************************************

;***************************************************************************

proc rtl8169_probe

proc rtl8169_probe

	DEBUGF	1,"K : rtl8169_probe: 0x%x : 0x%x 0x%x\n",[io_addr]:8,[pci_bus]:2,[pci_dev]:2

;        DEBUGF  1,"K : rtl8169_probe: 0x%x : 0x%x 0x%x\n",[io_addr]:8,[pci_bus]:2,[pci_dev]:2

	call	rtl8169_init_board

	call	rtl8169_init_board

	mov	[node_addr+ebx],al

	mov	[node_addr+ebx],al

	inc	edx

	inc	edx

	inc	ebx

	inc	ebx

	loop	@b

	loop	@b

	DEBUGF	1,"K : rtl8169_probe: MAC = %x-%x-%x-%x-%x-%x\n",[node_addr+0]:2,[node_addr+1]:2,[node_addr+2]:2,[node_addr+3]:2,[node_addr+4]:2,[node_addr+5]:2

;        DEBUGF  1,"K : rtl8169_probe: MAC = %x-%x-%x-%x-%x-%x\n",[node_addr+0]:2,[node_addr+1]:2,[node_addr+2]:2,[node_addr+3]:2,[node_addr+4]:2,[node_addr+5]:2

	; Config PHY

	; Config PHY

	stdcall rtl8169_hw_PHY_config

	stdcall rtl8169_hw_PHY_config

;      eax, ebx, ecx, edx

;      eax, ebx, ecx, edx

;

;

;***************************************************************************

;***************************************************************************

proc rtl8169_reset

proc rtl8169_reset

	DEBUGF	1,"K : rtl8169_reset: 0x%x : 0x%x 0x%x\n",[io_addr]:8,[pci_bus]:2,[pci_dev]:2

;        DEBUGF  1,"K : rtl8169_reset: 0x%x : 0x%x 0x%x\n",[io_addr]:8,[pci_bus]:2,[pci_dev]:2

	mov	[rtl8169_tpc.TxDescArrays],rtl8169_tx_ring

	mov	[rtl8169_tpc.TxDescArrays],rtl8169_tx_ring

;      eax, edx, esi, edi

;      eax, edx, esi, edi

;

;

;***************************************************************************

;***************************************************************************

proc rtl8169_transmit

proc rtl8169_transmit

	DEBUGF	1,"K : rtl8169_transmit\n" ;: 0x%x : 0x%x 0x%x 0x%x 0x%x\n",[io_addr]:8,edi,bx,ecx,esi

;        DEBUGF  1,"K : rtl8169_transmit\n" ;: 0x%x : 0x%x 0x%x 0x%x 0x%x\n",[io_addr]:8,edi,bx,ecx,esi

	push	ecx edx esi

	push	ecx edx esi

	mov	eax,MAX_ETH_FRAME_SIZE

	mov	eax,MAX_ETH_FRAME_SIZE

	mov	eax,sizeof.rtl8169_TxDesc

	mov	eax,sizeof.rtl8169_TxDesc

	mul	[rtl8169_tpc.cur_tx]

	mul	[rtl8169_tpc.cur_tx]

	add	eax,[rtl8169_tpc.TxDescArray]

	add	eax,[rtl8169_tpc.TxDescArray]

	xchg	eax,ebx

	xchg	eax,ebx

	mov	[ebx + rtl8169_TxDesc.buf_addr],eax

	mov	[ebx + rtl8169_TxDesc.buf_addr],eax

	mov	eax,ecx

	mov	eax,ecx

	cmp	eax,ETH_ZLEN

	cmp	eax,ETH_ZLEN

	jae	@f

	jae	@f

	mov	ecx,TX_TIMEOUT / 10

	mov	ecx,TX_TIMEOUT / 10

    @@: test	[ebx + rtl8169_TxDesc.status],RTL8169_DSB_OWNbit

    @@: test	[ebx + rtl8169_TxDesc.status],RTL8169_DSB_OWNbit

	jnz	@f

	jnz	@f

	stdcall udelay,10

	stdcall udelay,10

	loop	@b

	loop	@b

    @@:

    @@:

	ret

	ret

	and	eax,0x00001FFF

	and	eax,0x00001FFF

;       jz      .exit.pop

;       jz      .exit.pop

	add	eax,-4

	add	eax,-4

	mov	[eth_rx_data_len],ax

	mov	[eth_rx_data_len],ax

	DEBUGF	1,"K : rtl8169_poll: data length = %u\n",ax

;        DEBUGF  1,"K : rtl8169_poll: data length = %u\n",ax

	push	eax

	push	eax

	mov	ecx,eax

	mov	ecx,eax

	jne	@f

	jne	@f

	or	eax,RTL8169_DSB_EORbit

	or	eax,RTL8169_DSB_EORbit

    @@: mov	[ebx + rtl8169_RxDesc.status],eax

    @@: mov	[ebx + rtl8169_RxDesc.status],eax

	mov	[ebx + rtl8169_RxDesc.buf_addr],edx

	sub	[ebx + rtl8169_RxDesc.buf_addr],OS_BASE 				; shurf 28.09.2008

	jmp	@f

	jmp	@f

	DEBUGF	1,"K : rtl8169_poll: Rx Error\n"

;        DEBUGF  1,"K : rtl8169_poll: Rx Error\n"

	; FIXME: shouldn't I reset the status on an error

	; FIXME: shouldn't I reset the status on an error

    @@:

    @@:

	inc	[rtl8169_tpc.cur_rx]

	inc	[rtl8169_tpc.cur_rx]

	and	[rtl8169_tpc.cur_rx],NUM_RX_DESC - 1

	and	[rtl8169_tpc.cur_rx],NUM_RX_DESC - 1