A2osX/DRV/LANCEGS.DRV.S.txt

452 lines
8.9 KiB
Plaintext
Raw Normal View History

2016-01-10 22:16:07 +00:00
PR#3
PREFIX /A2OSX.BUILD
LOMEM $A00
2016-01-10 22:16:07 +00:00
INC 1
AUTO 6
.LIST OFF
.OP 65C02
.OR $2000
.TF /A2OSX.BUILD/DRV/LANCEGS.DRV
2016-01-10 22:16:07 +00:00
*--------------------------------------
.INB /A2OSX.BUILD/INC/MACROS.I
.INB /A2OSX.BUILD/INC/A2OSX.I
.INB /A2OSX.BUILD/INC/MLI.ERR.I
.INB /A2OSX.BUILD/INC/NET.I
.INB /A2OSX.BUILD/INC/NET.91C96.I
.INB /A2OSX.BUILD/INC/LIBTCPIP.I
2016-01-10 22:16:07 +00:00
*--------------------------------------
ZPTmpPTR .EQ ZPDRV
Size .EQ ZPDRV+2
Counter .EQ ZPDRV+4
2016-01-10 22:16:07 +00:00
*--------------------------------------
* File Header (16 Bytes)
*--------------------------------------
CS.START cld
jmp Dev.Detect cld,jmp abs=DRV
.DA #$61 6502,Level 1 (65c02)
.DA #1 DRV Layout Version 1
.DA 0
.DA CS.END-CS.START Code Length
.DA DEV.HEADER-CS.START Device Header Offset
.DA DRV.CS.START-CS.START Driver Code Offset
.DA DRV.CS.END-DRV.CS.START Drv Code Length
*--------------------------------------
* Relocation Table
*--------------------------------------
L.MSG.DETECT .DA MSG.DETECT
L.MSG.DETECT.OK .DA MSG.DETECT.OK
L.MSG.DETECT.KO .DA MSG.DETECT.KO
L.DEV.HEADER.NAME .DA DEV.HEADER.NAME
.DA 0 End Of Reloc Table
*--------------------------------------
Dev.Detect >STYA Args
2016-01-10 22:16:07 +00:00
>LDYA L.MSG.DETECT
>SYSCALL CPrintFYA
2016-01-10 22:16:07 +00:00
ldx #$70
ldy #7
.1 lda A2osX.SLOTS,y IO based detection, avoid scanning in Disk Controller IO!!!!
bne .2
lda L91C96.BSR+1,x
2016-01-10 22:16:07 +00:00
cmp #DEVID
2016-03-30 15:54:47 +00:00
beq .3
2016-01-10 22:16:07 +00:00
.2 dec DEV.HEADER.NAME+4
2016-01-10 22:16:07 +00:00
txa
sec
sbc #$10
2016-01-10 22:16:07 +00:00
tax
dey
bne .1
2016-01-10 22:16:07 +00:00
>LDYA L.MSG.DETECT.KO
>SYSCALL CPrintFYA
2016-01-10 22:16:07 +00:00
lda #MLI.ERR.NODEV
2016-01-10 22:16:07 +00:00
sec
rts
.3 stx DEVSLOTx0
lda #A2osX.SLOTS.NET
sta A2osX.SLOTS,y
>LDYA ARGS
>STYA ZPTmpPTR
lda (ZPTmpPTR)
2016-01-10 22:16:07 +00:00
beq .4
2016-03-13 22:07:01 +00:00
sec
ror USERMAC
>SYSCALL GetMemPtrA
2016-01-10 22:16:07 +00:00
>STYA ZPTmpPTR
jsr DecodeMac
bcc .4
lda #DEVMGR.ERRICL
sec
rts
.4 >PUSHW L.DEV.HEADER.NAME
>LDYA L.MSG.DETECT.OK
>SYSCALL CPrintFYA
2016-01-10 22:16:07 +00:00
clc
rts
*--------------------------------------
.INB /A2OSX.SRC/DRV/X.NET.DRV.S
2016-01-10 22:16:07 +00:00
*--------------------------------------
CS.END
MSG.DETECT >CSTR "LanCeGS/SMSC91C96 Driver.\r\n"
MSG.DETECT.OK >CSTR "LanCeGS/SMSC91C96 Installed As Device : %S\r\n"
MSG.DETECT.KO >CSTR "Hardware Not Found.\r\n"
Args .BS 2
2016-01-10 22:16:07 +00:00
*--------------------------------------
* Device Header (16 Bytes)
*--------------------------------------
DEV.HEADER cld
jmp (DRV.CS.START,x)
.DA #0
.BS 6
DEV.HEADER.NAME >PSTR "ETH7"
2016-01-10 22:16:07 +00:00
*--------------------------------------
* Driver Code
*--------------------------------------
DRV.CS.START .DA STATUS
.DA READBLOCK
.DA WRITEBLOCK
.DA A2osX.BADCALL
.DA A2osX.BADCALL
.DA A2osX.BADCALL
.DA OPEN
2016-01-10 22:16:07 +00:00
.DA CLOSE
.DA A2osX.BADCALL
.DA A2osX.BADCALL
L.DEVSTAT .DA DEVSTAT
2016-01-10 22:16:07 +00:00
.DA 0 end or relocation
*--------------------------------------
STATUS lda #S.DEVSTAT.NET.STATUS.10
sta LINK.STATUS
2016-03-13 22:07:01 +00:00
ldx DEVSLOTx0
2016-03-13 22:07:01 +00:00
stz L91C96.BSR,x
lda L91C96.0.EPHSR,x
lda L91C96.0.EPHSR+1,x
and /L91C96.0.EPHSR.LINK
beq .1
lda LINK.STATUS
ora #S.DEVSTAT.NET.STATUS.OK
sta LINK.STATUS
2016-03-13 22:07:01 +00:00
.1 lda L91C96.0.TCR,x
lda L91C96.0.TCR+1,x
and /L91C96.0.TCR.FDSE
2016-03-13 22:07:01 +00:00
bne .2
lda LINK.STATUS
ora #S.DEVSTAT.NET.STATUS.FD
sta LINK.STATUS
2016-03-13 22:07:01 +00:00
.2 >LDYA L.DEVSTAT
2016-01-10 22:16:07 +00:00
clc
rts
*--------------------------------------
READBLOCK ldx DEVSLOTx0
2016-03-13 22:07:01 +00:00
lda #2
sta L91C96.BSR,x
lda L91C96.2.IST,x
and #L91C96.2.IST.RCV
bne READBLOCK.RxOK
2016-03-20 22:12:57 +00:00
lda #ERR.DEV.NOFRAME
2016-03-13 22:07:01 +00:00
sec
2016-01-10 22:16:07 +00:00
rts
READBLOCK.RxOK lda #L91C96.2.PTR.RCVD+L91C96.2.PTR.AUTOI+L91C96.2.PTR.READ
2016-03-13 22:07:01 +00:00
sta L91C96.2.PTR,x
lda /L91C96.2.PTR.RCVD+L91C96.2.PTR.AUTOI+L91C96.2.PTR.READ
sta L91C96.2.PTR+1,x
2016-03-30 15:54:47 +00:00
lda L91C96.2.DATA,x Get Frame Status Word (lo)
lda L91C96.2.DATA,x Get Frame Status Word (HI)
asl
2016-03-30 15:54:47 +00:00
asl
asl #$10 = odd?
asl if odd, CS
lda L91C96.2.DATA,x get lo byte count
sbc #5 compute Size
sta Size
eor #$ff
sta Counter
2016-03-13 22:07:01 +00:00
tay
2016-03-30 15:54:47 +00:00
lda L91C96.2.DATA,x get hi byte count
sbc #0
sta Size+1
eor #$ff
sta Counter+1
eor #$ff
2016-03-13 22:07:01 +00:00
2016-03-30 15:54:47 +00:00
iny
bne .1
2016-03-30 15:54:47 +00:00
inc
.1 iny
bne .11
2016-03-30 15:54:47 +00:00
inc
.11 >SYSCALL GetMemYA
2016-03-13 22:07:01 +00:00
bcs .99
>STYA ZPTmpPTR
stx .8+1
sty .8+3
sta .8+5
2016-03-13 22:07:01 +00:00
lda Size
2016-03-30 15:54:47 +00:00
sta (ZPTmpPTR)
ldy #1
lda Size+1
2016-03-13 22:07:01 +00:00
sta (ZPTmpPTR),y
2016-03-30 15:54:47 +00:00
2016-03-13 22:07:01 +00:00
iny
ldx DEVSLOTx0
.2 inc Counter
bne .21
inc Counter+1
beq .4
.21 lda L91C96.2.DATA,x
2016-03-13 22:07:01 +00:00
sta (ZPTmpPTR),y
iny
bne .3
inc ZPTmpPTR+1
.3 inc Counter
bne .31
inc Counter+1
beq .4
.31 lda L91C96.2.DATA,x
2016-03-13 22:07:01 +00:00
sta (ZPTmpPTR),y
iny
bne .2
inc ZPTmpPTR+1
bra .2
.4 lda #L91C96.2.MMUCR.REMREL
2016-03-13 22:07:01 +00:00
sta L91C96.2.MMUCR,x
.8 ldx #$ff hMem
ldy #$ff PtrLO
lda #$ff PtrHI
2016-01-10 22:16:07 +00:00
clc
.99 rts
2016-01-10 22:16:07 +00:00
*--------------------------------------
WRITEBLOCK >STYA ZPTmpPTR
2016-03-13 22:07:01 +00:00
ldx DEVSLOTx0
lda #2
sta L91C96.BSR,x
lda (ZPTmpPTR)
sta Size
eor #$ff
sta Counter
eor #$ff
2016-01-10 22:16:07 +00:00
clc
2016-03-13 22:07:01 +00:00
adc #6 3 WORDs more Status, len & Control
2016-03-31 20:07:47 +00:00
bne .10
clc LO byte is 0, no need for an extra empty page
2016-03-31 20:07:47 +00:00
.10 ldy #1
2016-03-13 22:07:01 +00:00
lda (ZPTmpPTR),y
sta Size+1
eor #$ff
sta Counter+1
eor #$ff
2016-03-13 22:07:01 +00:00
adc #0
.1 ora #L91C96.2.MMUCR.ALLOC
sta L91C96.2.MMUCR,x
ldy #0
.2 lda L91C96.2.IST,x
and #L91C96.2.IST.ALLOC
bne .3
dey
bne .2
2016-03-20 22:12:57 +00:00
lda #ERR.DEV.NOBUFFER
2016-03-13 22:07:01 +00:00
sec
rts
.3 lda L91C96.2.AAR,x
sta L91C96.2.PNR,x
2016-03-30 06:30:41 +00:00
lda #L91C96.2.PTR.AUTOI
2016-03-13 22:07:01 +00:00
sta L91C96.2.PTR,x
2016-03-30 06:30:41 +00:00
lda /L91C96.2.PTR.AUTOI
2016-03-13 22:07:01 +00:00
sta L91C96.2.PTR+1,x
2016-03-30 06:30:41 +00:00
ldy #S.ETH.SRCMAC+5 Add Src MAC Address
2016-03-13 22:07:01 +00:00
ldx #5
.4 lda MAC,x
sta (ZPTmpPTR),y
dey
dex
bpl .4
ldx DEVSLOTx0
2016-03-30 15:54:47 +00:00
stz L91C96.2.DATA,x write fake status word
2016-03-30 06:30:41 +00:00
stz L91C96.2.DATA,x
2016-03-13 22:07:01 +00:00
lda Size
2016-03-13 22:07:01 +00:00
pha
2016-03-30 15:54:47 +00:00
eor #$01
2016-03-13 22:07:01 +00:00
lsr
pla
2016-03-30 15:54:47 +00:00
adc #$05 add 5 if odd, 6 if even
2016-03-13 22:07:01 +00:00
sta L91C96.2.DATA,x
lda Size+1
2016-03-30 15:54:47 +00:00
adc #$00
2016-03-30 06:30:41 +00:00
sta L91C96.2.DATA,x
2016-03-13 22:07:01 +00:00
ldy #2
.5 inc Counter
bne .51
inc Counter+1
2016-03-13 22:07:01 +00:00
beq .70
.51 lda (ZPTmpPTR),y
2016-03-13 22:07:01 +00:00
iny
bne .6
inc ZPTmpPTR+1
.6 inc Counter
bne .61
inc Counter+1
2016-03-13 22:07:01 +00:00
beq .71
.61 sta L91C96.2.DATA,x
2016-03-13 22:07:01 +00:00
lda (ZPTmpPTR),y
2016-03-30 06:30:41 +00:00
sta L91C96.2.DATA,x
2016-03-13 22:07:01 +00:00
iny
bne .5
inc ZPTmpPTR+1
bra .5
.70 lda #0
sta L91C96.2.DATA,x
2016-03-30 06:30:41 +00:00
sta L91C96.2.DATA,x
2016-03-13 22:07:01 +00:00
bra .8
.71 sta L91C96.2.DATA,x
2016-03-30 15:54:47 +00:00
lda #%00100000 signal an extra (odd) byte
2016-03-30 06:30:41 +00:00
sta L91C96.2.DATA,x
2016-03-13 22:07:01 +00:00
.8 lda #L91C96.2.MMUCR.NQPKT
sta L91C96.2.MMUCR,x
clc
rts
.9 sec
rts
2016-01-10 22:16:07 +00:00
*--------------------------------------
OPEN jsr CLOSE
lda #L91C96.0.TCR.FDSE+L91C96.0.TCR.FUDPLX+L91C96.0.TCR.PADEN+L91C96.0.TCR.TXENA
sta L91C96.0.TCR,x
lda /L91C96.0.TCR.FDSE+L91C96.0.TCR.FUDPLX+L91C96.0.TCR.PADEN+L91C96.0.TCR.TXENA
sta L91C96.0.TCR+1,x
lda #L91C96.0.RCR.NOCRC+L91C96.0.RCR.RXENA+L91C96.0.RCR.ALLMUL
sta L91C96.0.RCR,x
lda /L91C96.0.RCR.NOCRC+L91C96.0.RCR.RXENA+L91C96.0.RCR.ALLMUL
sta L91C96.0.RCR+1,x
lda #1
sta L91C96.BSR,x
lda #L91C96.1.CR.NOWAIT
sta L91C96.1.CR,x
lda /L91C96.1.CR.NOWAIT
sta L91C96.1.CR+1,x
ldy #0
bit USERMAC
bmi .2
.1 lda L91C96.1.IAR,x
sta MAC,y
inx
iny
cpy #6
bne .1
bra .3
.2 lda MAC,y
sta L91C96.1.IAR,x
inx
iny
cpy #6
bne .2
.3 ldx DEVSLOTx0
lda #L91C96.1.CTR.DEFAULT+L91C96.1.CTR.AUTOREL
sta L91C96.1.CTR,x
lda /L91C96.1.CTR.DEFAULT+L91C96.1.CTR.AUTOREL
sta L91C96.1.CTR+1,x
clc
rts
2016-01-10 22:16:07 +00:00
*--------------------------------------
CLOSE ldx DEVSLOTx0
2016-03-30 15:54:47 +00:00
stz L91C96.BSR,x
2016-03-13 22:07:01 +00:00
lda #L91C96.0.RCR.RESET
sta L91C96.0.RCR,x
lda /L91C96.0.RCR.RESET
sta L91C96.0.RCR+1,x
lda $C019 we can use VBL as we are not on //c
.1 eor $C019
bpl .1
2016-03-30 15:54:47 +00:00
lda $C019
2016-03-13 22:07:01 +00:00
.2 eor $C019
bpl .2
2016-03-30 15:54:47 +00:00
stz L91C96.0.RCR,x
stz L91C96.0.RCR+1,x
clc
2016-01-10 22:16:07 +00:00
rts
*--------------------------------------
DRV.CS.END
DEVSLOTx0 .BS 1
2016-03-13 22:07:01 +00:00
USERMAC .BS 1
*--------------------------------------
DEVSTAT .DA #0
.BS 3 size
>PSTR "LanCEGS/L91C96"
.BS 1
.DA #S.DEVSTAT.T.NET
.BS 1 Subtype
.BS 2 Version
2016-01-10 22:16:07 +00:00
*--------------------------------------
FLAGS .DA #0
2016-03-13 22:07:01 +00:00
LINK.STATUS .BS 1 OK/DUPLEX/SPEED
MAC .BS 6
2016-01-10 22:16:07 +00:00
*--------------------------------------
MAN
SAVE /A2OSX.SRC/DRV/LANCEGS.DRV.S
2016-01-10 22:16:07 +00:00
ASM