Subversion Repositories Kolibri OS

; assume dx is CSR9

macro MDIO_Delay {

	push	eax

	in	eax, dx

	pop	eax

}

	status

;----------------------------------------------------

; send setup packet to notify the board about the MAC

; clear packet/byte counters

	lea	edi, [device.bytes_tx]

	mov	ecx, 6

	rep	stosd

	DEBUGF	1,"Reset done\n"

; Update stats

	inc	[device.packets_tx]

	mov	eax, [esp+8]

	ret

;<<<<<<<<<<<<<<<<<<<<<<<<<<<<

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

;* Media Descriptor Code                                             *

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

; MII transceiver control section.

; Read and write the MII registers using software-generated serial

; MDIO protocol.  See the MII specifications or DP83840A data sheet

; for details.

; The maximum data clock rate is 2.5 Mhz.  The minimum timing is usually

; met by back-to-back PCI I/O cycles, but we insert a delay to avoid

; "overclocking" issues or future 66Mhz PCI.

; Read and write the MII registers using software-generated serial

; MDIO protocol.  It is just different enough from the EEPROM protocol

; to not share code.  The maxium data clock rate is 2.5 Mhz.

MDIO_SHIFT_CLK		equ	0x10000

MDIO_DATA_WRITE0	equ	0x00000

MDIO_DATA_WRITE1	equ	0x20000

MDIO_ENB		equ	0x00000 	; Ignore the 0x02000 databook setting.

MDIO_ENB_IN		equ	0x40000

MDIO_DATA_READ		equ	0x80000

; MII transceiver control section.

; Read and write the MII registers using software-generated serial

; MDIO protocol.  See the MII specifications or DP83840A data sheet

; for details.

align 4

mdio_read:	; phy_id:edx, location:esi

	DEBUGF	1,"mdio read, phy=%x, location=%x", edx, esi

	shl	edx, 5

	or	esi, edx

	or	esi, 0xf6 shl 10

	set_io	0

	set_io	CSR9

;    if (tp->chip_id == LC82C168) {

;        int i = 1000;

;        outl(0x60020000 + (phy_id<<23) + (location<<18), ioaddr + 0xA0);

;        inl(ioaddr + 0xA0);

;        inl(ioaddr + 0xA0);

;        while (--i > 0)

;            if ( ! ((retval = inl(ioaddr + 0xA0)) & 0x80000000))

;                return retval & 0xffff;

;        return 0xffff;

;    }

;

;    if (tp->chip_id == COMET) {

;        if (phy_id == 1) {

;            if (location < 7)

;                return inl(ioaddr + 0xB4 + (location<<2));

;            else if (location == 17)

;                return inl(ioaddr + 0xD0);

;            else if (location >= 29 && location <= 31)

;                return inl(ioaddr + 0xD4 + ((location-29)<<2));

;        }

;        return 0xffff;

;    }

; Establish sync by sending at least 32 logic ones.

	mov	ecx, 32

  .loop:

	mov	eax, MDIO_ENB or MDIO_DATA_WRITE1

	out	dx, eax

	MDIO_Delay

	or	eax, MDIO_SHIFT_CLK

	out	dx, eax

	MDIO_Delay

	dec	ecx

	jnz	.loop

; Shift the read command bits out.

	mov	ecx, 1 shl 15

  .loop2:

	mov	eax, MDIO_ENB

	test	esi, ecx

	jz	@f

	or	eax, MDIO_DATA_WRITE1

       @@:

	out	dx, eax

	MDIO_Delay

	or	eax, MDIO_SHIFT_CLK

	out	dx, eax

	MDIO_Delay

	shr	ecx, 1

	jnz	.loop2

; Read the two transition, 16 data, and wire-idle bits.

	xor	esi, esi

	mov	ecx, 19

  .loop3:

	mov	eax, MDIO_ENB_IN

	out	dx, eax

	MDIO_Delay

	shl	esi, 1

	in	eax, dx

	test	eax, MDIO_DATA_READ

	jz	@f

	inc	esi

       @@:

	mov	eax, MDIO_ENB_IN or MDIO_SHIFT_CLK

	out	dx, eax

	MDIO_Delay

	dec	ecx

	jnz	.loop3

	shr	esi, 1

	movzx	eax, si

	DEBUGF	1,", data=%x\n", ax

	ret

align 4

mdio_write:	;int phy_id: edx, int location: edi, int value: ax)

	DEBUGF	1,"mdio write, phy=%x, location=%x, data=%x\n", edx, edi, ax

	shl	edi, 18

	or	edi, 0x5002 shl 16

	shl	edx, 23

	or	edi, edx

	mov	di, ax

	set_io	0

	set_io	CSR9

;    if (tp->chip_id == LC82C168) {

;        int i = 1000;

;        outl(cmd, ioaddr + 0xA0);

;        do

;            if ( ! (inl(ioaddr + 0xA0) & 0x80000000))

;                break;

;        while (--i > 0);

;        return;

;    }

;    if (tp->chip_id == COMET) {

;        if (phy_id != 1)

;            return;

;        if (location < 7)

;            outl(value, ioaddr + 0xB4 + (location<<2));

;        else if (location == 17)

;            outl(value, ioaddr + 0xD0);

;        else if (location >= 29 && location <= 31)

;            outl(value, ioaddr + 0xD4 + ((location-29)<<2));

;        return;

;    }

; Establish sync by sending at least 32 logic ones.

	mov	ecx, 32

  .loop:

	mov	eax, MDIO_ENB or MDIO_DATA_WRITE1

	out	dx, eax

	MDIO_Delay

	or	eax, MDIO_SHIFT_CLK

	out	dx, eax

	MDIO_Delay

	dec	ecx

	jnz	.loop

; Shift the command bits out.

	mov	ecx, 1 shl 31

  .loop2:

	mov	eax, MDIO_ENB

	test	edi, ecx

	jz	@f

	or	eax, MDIO_DATA_WRITE1

       @@:

	out	dx, eax

	MDIO_Delay

	or	eax, MDIO_SHIFT_CLK

	out	dx, eax

	MDIO_Delay

	shr	ecx, 1

	jnz	.loop2

; Clear out extra bits.

	mov	ecx, 2

  .loop3:

	mov	eax, MDIO_ENB

	out	dx, eax

	MDIO_Delay

	or	eax, MDIO_SHIFT_CLK

	out	dx, eax

	MDIO_Delay

	dec	ecx

	jnz	.loop3