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
|
2017-04-25 15:44:21 +00:00
|
|
|
|
*--------------------------------------
|
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
|
