A2osX/DRV/UTHER2.AI.DRV.S.txt

835 lines
15 KiB
Plaintext
Raw Normal View History

2017-12-22 21:24:30 +00:00
NEW
2019-05-02 09:52:32 +00:00
AUTO 3,1
2016-04-04 20:48:20 +00:00
.LIST OFF
2020-05-14 11:47:46 +00:00
.OP 65C02
.OR $2000
.TF drv/uther2.ai.drv
2016-04-04 20:48:20 +00:00
*--------------------------------------
2020-05-23 18:45:32 +00:00
.INB inc/macros.i
.INB inc/a2osx.i
.INB inc/mli.e.i
.INB inc/nic.i
.INB inc/nic.w5100.i
.INB inc/eth.i
.INB inc/libtcpip.i
*--------------------------------------
2020-05-14 11:47:46 +00:00
ZPArgPtr .EQ ZPBIN
DEVSLOT0x .EQ ZPBIN+2
*--------------------------------------
* 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 0
.DA 0
.DA 0
*--------------------------------------
* 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.DRV.CS.START .DA DRV.CS.START
L.FD.DEV .DA FD.DEV
L.FD.DEV.NAME .DA FD.DEV.NAME
L.SSCANF.MAC .DA SSCANF.MAC
L.MAC0 .DA DCB+S.DCB.NIC.MAC
L.MAC1 .DA DCB+S.DCB.NIC.MAC+1
L.MAC2 .DA DCB+S.DCB.NIC.MAC+2
L.MAC3 .DA DCB+S.DCB.NIC.MAC+3
L.MAC4 .DA DCB+S.DCB.NIC.MAC+4
L.MAC5 .DA DCB+S.DCB.NIC.MAC+5
.DA 0 End Of Reloc Table
*--------------------------------------
Dev.Detect >STYA ARGS
>LDYA L.MSG.DETECT
>SYSCALL PutS
ldx #$70+$88
ldy #7
.1 lda A2osX.S,y IO based detection, avoid scanning in Disk Controller IO!!!!
bne .2
lda #W5100.MR.RST
sta W5100.MR,x
lda #0
.10 dec give some time....
bne .10
lda #W5100.MR.PB+W5100.MR.AI+W5100.MR.IND
sta W5100.MR,x
pha
pla
lda W5100.MR,x
cmp #W5100.MR.PB+W5100.MR.AI+W5100.MR.IND
bne .2
>AR.SELECT RTR
lda W5100.DR,x Get RTR HI
cmp /2000
bne .2
lda W5100.DR,x Get RTR LO
cmp #2000
beq .3
.2 dec FD.DEV.NAME+3
txa
sec
sbc #$10
tax
dey
bne .1
>LDYA L.MSG.DETECT.KO
>SYSCALL PutS
lda #MLI.E.NODEV
sec
rts
.3 stx DEVSLOTx0
sty DEVSLOT0x
jsr Dev.ParseArgs
bcs .99
>PUSHW L.MSG.DETECT.OK
>PUSHW L.FD.DEV.NAME
>PUSHBI 2
>SYSCALL PrintF
>PUSHWI DRV.END
>PUSHWI DRV.CS.END-DRV.CS.START
>PUSHWI DRV.CS.START
>LDYA L.DRV.CS.START
>SYSCALL InsDrv
.99 bcs .9
>STYA FD.DEV+S.FD.DEV.DRVPTR
>PUSHW L.FD.DEV
>PUSHW L.FD.DEV.NAME
>SYSCALL MKDEV
bcs .9
ldx DEVSLOT0x
lda #A2osX.S.NIC
sta A2osX.S,x
* clc
.9 rts
*--------------------------------------
Dev.ParseArgs >LDYA ARGS
>STYA ZPArgPTR
lda (ZPArgPTR)
bne .1
lda A2osX.RANDOM16
eor A2osX.TIMER16
sta DCB+S.DCB.NIC.MAC+3
eor A2osX.RANDOM16+1
sta DCB+S.DCB.NIC.MAC+4
eor A2osX.TIMER16+1
sta DCB+S.DCB.NIC.MAC+5
clc
rts
.1 >PUSHW ZPArgPtr
>PUSHW L.SSCANF.MAC
ldx #0
.2 >PUSHW L.MAC0,x
inx
inx
cpx #12
bne .2
>PUSHBI 12 6 x byte PTRs
>SYSCALL sscanf
bcc .8
lda #E.SYN
* sec
.8 rts
*--------------------------------------
CS.END
ARGS .BS 2
MSG.DETECT .AZ "UtherNet2/W5100 Driver (ARP/IP Offload)."
MSG.DETECT.OK .AZ "UtherNet2/W5100 Installed As Device : %s\r\n"
MSG.DETECT.KO .AZ "Hardware Not Found."
SSCANF.MAC .AZ "%h:%h:%h:%h:%h:%h"
*--------------------------------------
FD.DEV .DA #S.FD.T.CDEV
.DA #0 HANDLER
.DA #0 BUSID
.DA #0 DEVID
.DA 0 BUSPTR
.BS 2 DRVPTR
.DA 0 DCBPTR
.DA 0 BUFPTR
FD.DEV.NAME .AZ "eth7"
*--------------------------------------
* Driver Code
*--------------------------------------
ZPIOCTL .EQ ZPDRV
ZPBufPtr .EQ ZPDRV+2
Counter .EQ ZPDRV+4
Offset .EQ ZPDRV+6
RXTX.Size .EQ ZPDRV+8
BUF.Size .EQ ZPDRV+10
2020-06-11 21:04:56 +00:00
RX.IP .EQ ZPDRV+12 (4)
Sn.IO .EQ ZPDRV+16
Sn.BASE .EQ ZPDRV+17
Sn.MASK .EQ ZPDRV+18
2020-05-14 11:47:46 +00:00
*--------------------------------------
DRV.CS.START cld
jmp (.1,x)
.1 .DA STATUS
.DA A2osX.BADCALL
.DA A2osX.BADCALL
.DA A2osX.BADCALL
.DA CONTROL
.DA A2osX.BADCALL
.DA OPEN
.DA CLOSE
.DA READ
.DA WRITE
.DA 0 end or relocation
*--------------------------------------
STATUS jsr GET.IOCTLBUFPTR
ldy #S.IOCTL.STATCODE
lda (ZPIOCTL),y
beq .1
cmp #S.IOCTL.STATCODE.GETDIB
bne STATUS.DCB
ldy #S.DIB-1
.HS 2C bit abs
.1 ldy #3
.2 lda DIB,y
sta (ZPBufPtr),y
dey
bpl .2
clc
rts
STATUS.DCB cmp #S.IOCTL.STATCODE.GETDCB
bne STATUS.9
ldy #S.DCB.NIC-1
.1 lda DCB,y
sta (ZPBufPtr),y
dey
bpl .1
clc
rts
STATUS.9 lda #MLI.E.BADCTL
sec
rts
*--------------------------------------
CONTROL jsr GET.IOCTLBUFPTR
ldy #S.IOCTL.CTRLCODE
lda (ZPIOCTL),y
cmp #S.IOCTL.CTRLCODE.SETDCB
bne STATUS.9
ldy #S.DCB.NIC-1
.2 lda (ZPBufPtr),y
sta DCB,y
dey
bpl .2
bra OPEN.I
*--------------------------------------
OPEN lda #S.DIB.S.OPENED
bit DIB+S.DIB.S
beq OPEN.I
lda #MLI.E.OPEN
sec
rts
OPEN.I jsr CLOSE
* ldx DEVSLOTx0 Done by CLOSE
lda #W5100.MR.PB+W5100.MR.AI+W5100.MR.IND
sta W5100.MR,x
>AR.SELECT GAR
ldy #0
.2 lda DCB+S.DCB.NIC.GW,y
sta W5100.DR,x
iny
cpy #4
bne .2
* >AR.SELECT SUBR Implicit, next to GAR
ldy #0
.3 lda DCB+S.DCB.NIC.MASK,y
sta W5100.DR,x
iny
cpy #4
bne .3
2020-06-10 20:04:13 +00:00
* >AR.SELECT SHAR
ldy #0
.1 lda DCB+S.DCB.NIC.MAC,y
sta W5100.DR,x
iny
cpy #6
bne .1
* >AR.SELECT SIPR
2020-05-14 11:47:46 +00:00
ldy #0
.4 lda DCB+S.DCB.NIC.IP,y
sta W5100.DR,x
iny
cpy #4
bne .4
2020-05-17 17:34:32 +00:00
2020-06-10 20:04:13 +00:00
>AR.SELECT RMSR
2020-06-11 21:04:56 +00:00
lda #%01010101 RAW=2k,ICMP=2k,UDP=2k,TCP=2k
2020-06-10 20:04:13 +00:00
sta W5100.DR,x ...for Socket RX Buffers
sta W5100.DR,x ...for Socket TX Buffers
2020-06-11 21:04:56 +00:00
>AR.SELECT S0.MR
lda #W5100.AR.Sn.MR.MACRAW+W5100.AR.Sn.MR.MF
sta W5100.DR,x
>AR.SELECT S0.CR
lda #W5100.AR.Sn.CR.OPEN
sta W5100.DR,x
lda /W5100.AR.S1.MR
2020-05-17 17:34:32 +00:00
sta Sn.IO
2020-06-11 21:04:56 +00:00
ldy #S.IP.PROTOCOL.ICMP
2020-05-17 17:34:32 +00:00
jsr OPEN.SnY
inc Sn.IO
2020-06-11 21:04:56 +00:00
ldy #S.IP.PROTOCOL.UDP
2020-05-17 17:34:32 +00:00
jsr OPEN.SnY
inc Sn.IO
ldy #S.IP.PROTOCOL.TCP
jsr OPEN.SnY
lda #S.DIB.S.OPENED
tsb DIB+S.DIB.S
clc
rts
2020-05-14 11:47:46 +00:00
*--------------------------------------
2020-05-17 17:34:32 +00:00
OPEN.SnY >AR.Sn.SELECT S0.MR
2020-05-14 11:47:46 +00:00
lda #W5100.AR.Sn.MR.IPRAW+W5100.AR.Sn.MR.MF
sta W5100.DR,x
2020-05-17 17:34:32 +00:00
>AR.Sn.SELECT S0.PROTO
tya
2020-05-14 11:47:46 +00:00
sta W5100.DR,x
2020-05-17 17:34:32 +00:00
* >AR.Sn.SELECT Sn.TOS
2020-05-14 11:47:46 +00:00
stz W5100.DR,x
2020-05-17 17:34:32 +00:00
* >AR.Sn.SELECT Sn.TTL
2020-05-14 11:47:46 +00:00
lda #K.IP.TTL
sta W5100.DR,x
2020-05-17 17:34:32 +00:00
>AR.Sn.SELECT S0.CR
2020-05-14 11:47:46 +00:00
lda #W5100.AR.Sn.CR.OPEN
sta W5100.DR,x
rts
*--------------------------------------
CLOSE ldx DEVSLOTx0
lda #W5100.MR.RST
sta W5100.MR,x
lda $C019 we can use VBL as we are not on //c
.1 eor $C019
bpl .1
lda $C019
.2 eor $C019
bpl .2
lda #S.DIB.S.OPENED
trb DIB+S.DIB.S
clc
rts
*--------------------------------------
READ php
sei
>STYA ZPIOCTL
2020-05-20 13:14:28 +00:00
ldx DEVSLOTx0
2020-06-11 21:04:56 +00:00
lda /W5100.AR.S1.MR
2020-05-17 17:34:32 +00:00
sta Sn.IO
sta W5100.AR,x
lda #W5100.AR.S0.RX.RSR
sta W5100.AR+1,x
2020-05-14 11:47:46 +00:00
lda W5100.DR,x get the received size HI
ora W5100.DR,x LO
2020-06-11 21:04:56 +00:00
bne READ.ICMP
2020-05-14 11:47:46 +00:00
2020-06-11 21:04:56 +00:00
lda /W5100.AR.S0.RX.RSR
sta Sn.IO
sta W5100.AR,x
lda #W5100.AR.S0.RX.RSR
sta W5100.AR+1,x
2020-05-14 11:47:46 +00:00
2020-06-11 21:04:56 +00:00
lda W5100.DR,x get the received size HI
ora W5100.DR,x LO
beq .9
jmp READ.RAW
.9 jmp READWRITE.NODATA
2020-05-14 11:47:46 +00:00
2020-06-11 21:04:56 +00:00
READ.ICMP lda #S.IP.PROTOCOL.ICMP
2020-06-10 20:04:13 +00:00
sta FRM.HDR.PROTO
2020-06-11 21:04:56 +00:00
lda Sn.RX.BASE+1
2020-05-17 17:34:32 +00:00
sta Sn.BASE
2020-06-11 21:04:56 +00:00
lda Sn.RXTX.MASK+1
2020-05-17 17:34:32 +00:00
sta Sn.MASK
>AR.Sn.SELECT S0.RX.RD
2020-05-14 11:47:46 +00:00
lda W5100.DR,x get the received ptr HI
sta offset+1
ldy W5100.DR,x get the received ptr LO
sty offset
2020-05-17 17:34:32 +00:00
and Sn.MASK
ora Sn.BASE
2020-05-14 11:47:46 +00:00
sta W5100.AR,x
tya
sta W5100.AR+1,x
ldy #0
.10 lda W5100.DR,x IPRAW:Get Source IP
sta RX.IP,y
iny
cpy #4
bne .10
lda W5100.DR,x get RX.Size HI (not including 6 bytes Header)
sta RXTX.Size+1
eor #$ff
sta Counter+1
2020-05-17 17:34:32 +00:00
2020-05-14 11:47:46 +00:00
lda W5100.DR,x get RX.Size LO
sta RXTX.Size
eor #$ff
sta Counter
eor #$ff
clc
adc #S.IP
sta BUF.Size
ldy #S.IOCTL.BYTECNT
sta (ZPIOCTL),y
iny
lda RXTX.Size+1
adc /S.IP
sta BUF.Size+1
lda RXTX.Size
clc
adc #6 IPRAW: Add 6 bytes to Total Size
sta RXTX.Size
bcc .11
inc RXTX.Size+1
2020-06-10 20:04:13 +00:00
.11 lda RXTX.Size
clc
adc #S.IP-S.ETH.EII
sta FRM.HDR.IPLEN+1
lda RXTX.Size+1
adc /S.IP-S.ETH.EII
sta FRM.HDR.IPLEN
>LDYA BUF.Size
2020-05-14 11:47:46 +00:00
>SYSCALL2 getmem
bcc .14
jmp READWRITE.9
.14 >STYA ZPBufPtr
phx
phy
ldy #S.IOCTL.BUFPTR+1
sta (ZPIOCTL),y
dey
pla
sta (ZPIOCTL),y
2020-06-10 20:04:13 +00:00
ldy #S.ETH.EII.TYPE
.15 lda FRM.HDR-S.ETH.EII.TYPE,y
sta (ZPBufPtr),y
iny
cpy #S.ETH.EII.TYPE+FRM.HDR.LEN
bne .15
2020-05-14 11:47:46 +00:00
2020-06-10 20:04:13 +00:00
ldx #3
ldy #S.IP.SRC+3
2020-06-09 13:40:21 +00:00
2020-06-10 20:04:13 +00:00
.12 lda RX.IP,x
sta (ZPBufPtr),y
dey
dex
bpl .12
2020-06-09 13:40:21 +00:00
2020-06-10 20:04:13 +00:00
ldx #3
ldy #S.IP.DST+3
2020-06-09 13:40:21 +00:00
2020-06-10 20:04:13 +00:00
.13 lda DCB+S.DCB.NIC.IP,x
sta (ZPBufPtr),y
dey
dex
bpl .13
2020-05-14 11:47:46 +00:00
ldy #S.IP
ldx DEVSLOTx0
.2 inc Counter
bne .3
inc Counter+1
beq .4
.3 lda W5100.DR,x
sta (ZPBufPtr),y
iny
bne .2
inc ZPBufPtr+1
bra .2
.4 >AR.Sn.SELECT S0.RX.RD
lda Offset
clc
adc RXTX.Size
pha save LO
lda Offset+1
adc RXTX.Size+1
sta W5100.DR,x write HI
pla
sta W5100.DR,x write LO
>AR.Sn.SELECT S0.CR
lda #W5100.AR.Sn.CR.RCVD
sta W5100.DR,x
pla hMem
plp
clc
rts
*--------------------------------------
2020-06-11 21:04:56 +00:00
READ.RAW >AR.SELECT S0.RX.RD
lda W5100.DR,x get the received ptr HI
sta offset+1
ldy W5100.DR,x get the received ptr LO
sty offset
and /$7FF
ora /RX.BASE
sta W5100.AR,x
tya
sta W5100.AR+1,x
lda W5100.DR,x get RX.Size HI (Frame size + 2)
sta RXTX.Size+1
lda W5100.DR,x get RX.Size LO
sta RXTX.Size
ldy #S.IOCTL.BYTECNT
sec
sbc #2 MACRAW:strip 2 bytes Header from Size
sta (ZPIOCTL),y
sta BUF.Size
eor #$ff
sta Counter
iny
lda RXTX.Size+1
sbc #0
sta (ZPIOCTL),y
sta BUF.Size+1
eor #$ff
sta Counter+1
>LDYA BUF.Size
>SYSCALL2 getmem
bcc .14
jmp READWRITE.9
.14 >STYA ZPBufPtr
phx
phy
ldy #S.IOCTL.BUFPTR+1
sta (ZPIOCTL),y
dey
pla
sta (ZPIOCTL),y
ldy #0
ldx DEVSLOTx0
.2 inc Counter
bne .3
inc Counter+1
beq .4
.3 lda W5100.DR,x
sta (ZPBufPtr),y
iny
bne .2
inc ZPBufPtr+1
bra .2
.4 >AR.SELECT S0.RX.RD
lda Offset
clc
adc RXTX.Size
pha save LO
lda Offset+1
adc RXTX.Size+1
sta W5100.DR,x write HI
pla
sta W5100.DR,x write LO
>AR.SELECT S0.CR
lda #W5100.AR.Sn.CR.RCVD
sta W5100.DR,x
pla hMem
plp
clc
rts
*--------------------------------------
2020-05-14 11:47:46 +00:00
READWRITE.NODATA
lda #E.NODATA
READWRITE.9 plp
sec
rts
*--------------------------------------
WRITE php
sei
jsr GET.IOCTLBUFPTR
ldy #S.IOCTL.BYTECNT
lda (ZPIOCTL),y
sec
sbc #S.IP
sta RXTX.Size
eor #$ff
sta Counter
iny
lda (ZPIOCTL),y
sbc /S.IP
sta RXTX.Size+1
eor #$ff
sta Counter+1
ldy #S.IP.PROTOCOL
lda (ZPBufPtr),y
2020-05-17 17:34:32 +00:00
ldx #Sn.cnt-1
.10 cmp Sn.IP.PROTOCOL,x
beq .11
dex
2020-06-11 21:04:56 +00:00
bne .10
2020-05-17 17:34:32 +00:00
plp
lda #MLI.E.IO
sec
rts
.11 lda Sn.IO.BASE,x
sta Sn.IO
lda Sn.TX.BASE,x
sta Sn.BASE
lda Sn.RXTX.MASK,x
sta Sn.MASK
2020-05-14 11:47:46 +00:00
ldx DEVSLOTx0
>AR.Sn.SELECT S0.TX.FSR
lda W5100.DR,x get send size HI
ldy W5100.DR,x LO
cpy RXTX.Size
sbc RXTX.Size+1
bcc READWRITE.NODATA
>AR.Sn.SELECT S0.DIPR
ldy #S.IP.DST
2020-05-23 18:45:32 +00:00
.1 lda (ZPBufPtr),y
2020-05-14 11:47:46 +00:00
sta W5100.DR,x
iny
cpy #S.IP.DST+4
bne .1
>AR.Sn.SELECT S0.TX.WR
lda W5100.DR,x Get HI
ldy W5100.DR,x Get LO
2020-05-17 17:34:32 +00:00
and Sn.MASK
ora Sn.BASE
2020-05-14 11:47:46 +00:00
sta W5100.AR,x Write HI
sta Offset+1
tya
sta W5100.AR+1,x Write LO
sta Offset
ldy #S.IP
.2 inc Counter
bne .3
inc Counter+1
beq .8
.3 lda (ZPBufPtr),y
sta W5100.DR,x
iny
bne .2
inc ZPBufPtr+1
bra .2
.8 >AR.Sn.SELECT S0.TX.WR
lda Offset
clc
adc RXTX.Size
pha save LO
lda Offset+1
adc RXTX.Size+1
sta W5100.DR,x write HI
pla
sta W5100.DR,x write LO
>AR.Sn.SELECT S0.CR
lda #W5100.AR.Sn.CR.SEND
sta W5100.DR,x
plp
clc
rts
*--------------------------------------
GET.IOCTLBUFPTR >STYA ZPIOCTL
ldy #S.IOCTL.BUFPTR
lda (ZPIOCTL),y
sta ZPBufPtr
iny
lda (ZPIOCTL),y
sta ZPBufPtr+1
rts
*--------------------------------------
DRV.CS.END
2020-06-11 21:04:56 +00:00
Sn.cnt .EQ 4
Sn.IP.PROTOCOL .DA #0,#S.IP.PROTOCOL.ICMP,#S.IP.PROTOCOL.UDP,#S.IP.PROTOCOL.TCP
Sn.IO.BASE .DA /W5100.AR.S0.MR,/W5100.AR.S1.MR,/W5100.AR.S2.MR,/W5100.AR.S3.MR
Sn.TX.BASE .DA /TX.BASE,/TX.BASE+$800,/TX.BASE+$1000,/TX.BASE+$1800
Sn.RX.BASE .DA /RX.BASE,/RX.BASE+$800,/RX.BASE+$1000,/RX.BASE+$1800
Sn.RXTX.MASK .DA /$7FF,/$7FF,/$7FF,/$7FF
2020-05-14 11:47:46 +00:00
DEVSLOTx0 .BS 1
*--------------------------------------
DIB .DA #0
.DA #0,#0,#0 size
>PSTR "UtherNetII/W5100"
.DA #S.DIB.T.NIC
.BS 1 Subtype
.DA K.VER Version
*--------------------------------------
DCB .DA #S.DCB.T.NIC
.DA #S.DCB.NIC.FLAGS.ARPOFFLOAD+S.DCB.NIC.FLAGS.IPOFFLOAD
.DA #S.DCB.NIC.LINK.OK+S.DCB.NIC.LINK.FD
.DA #S.DCB.NIC.SPEED.100
.HS 0008DC123456 MAC
.DA #0,#0,#0,#0 IP
.DA #255,#255,#255,#255 MASK
.DA #0,#0,#0,#0 GW
*--------------------------------------
2020-06-10 20:04:13 +00:00
FRM.HDR .HS 0800 S.ETH.EII.TYPE
.HS 4500
FRM.HDR.IPLEN .BS 2 TOTAL LEN
.DA 0 ID
.DA 0 FLAGS
.DA #64 TTL
FRM.HDR.PROTO .BS 1 IP.PROTO
.DA 0 CHECKSUM
FRM.HDR.LEN .EQ *-FRM.HDR
*FRM.HDR.SRC .BS 4 IP.SRC
* .BS 4 IP.DST
*--------------------------------------
2020-05-14 11:47:46 +00:00
DRV.END
2016-04-04 20:48:20 +00:00
MAN
2020-05-23 18:45:32 +00:00
SAVE usr/src/drv/uther2.ai.drv.s
2016-04-04 20:48:20 +00:00
ASM