PR#3 PREFIX /A2OSX.SRC LOMEM $C00 INC 1 AUTO 6 .LIST OFF .OP 65C02 .OR $2000 .TF /A2OSX.BOOT/DRV/UTHER2.AI.DRV *-------------------------------------- .INB INC/MACROS.I .INB INC/A2OSX.I .INB INC/LIBTCPIP.I *-------------------------------------- ZPTmpPTR .EQ ZPDRV *-------------------------------------- .MA AR.SELECT lda /W5100.AR.]1 sta W5100.AR,x lda #W5100.AR.]1 sta W5100.AR+1,x .EM *-------------------------------------- * WIZnet W5100 IO Registers *-------------------------------------- W5100.MR .EQ $C084-$88 Mode Register W5100.MR.RST .EQ %10000000 W5100.MR.PB .EQ %00010000 W5100.MR.PPPOE .EQ %00001000 W5100.MR.AI .EQ %00000010 W5100.MR.IND .EQ %00000001 W5100.AR .EQ $C085-$88 Memory Pointer W5100.AR.GAR .EQ $0001 W5100.AR.SUBR .EQ $0005 W5100.AR.SHAR .EQ $0009 W5100.AR.SIPR .EQ $000F W5100.AR.IR .EQ $0015 W5100.AR.IMR .EQ $0016 W5100.AR.RTR .EQ $0017 W5100.AR.RCR .EQ $0019 W5100.AR.RMSR .EQ $001A W5100.AR.TMSR .EQ $001B W5100.AR.PATR .EQ $001C *W5100.AR.PTIMER .EQ $0028 *W5100.AR.PMAGIC .EQ $0029 *W5100.AR.UIPR .EQ $002A *W5100.AR.UPORT .EQ $002E W5100.AR.S0.MR .EQ $0400 W5100.AR.S0.MR.MULTI .EQ $80 W5100.AR.S0.MR.MF .EQ $40 W5100.AR.S0.MR.NDMC .EQ $20 W5100.AR.S0.MR.TCP .EQ $01 W5100.AR.S0.MR.UDP .EQ $02 W5100.AR.S0.MR.IPRAW .EQ $03 W5100.AR.S0.MR.MACRAW .EQ $04 W5100.AR.S0.MR.PPPOE .EQ $05 W5100.AR.S0.CR .EQ $0401 W5100.AR.S0.IR .EQ $0402 W5100.AR.S0.SR .EQ $0403 W5100.AR.S0.PORT .EQ $0404 W5100.AR.S0.DHAR .EQ $0406 W5100.AR.S0.DIPR .EQ $040C W5100.AR.S0.DPORT .EQ $0410 W5100.AR.S0.MSSR .EQ $0412 W5100.AR.S0.PROTO .EQ $0414 W5100.AR.S0.TOS .EQ $0415 W5100.AR.S0.TTL .EQ $0416 W5100.AR.S0.TX.FSR .EQ $0420 W5100.AR.S0.TX.RD .EQ $0422 W5100.AR.S0.TX.WR .EQ $0424 W5100.AR.S0.RX.RSR .EQ $0426 W5100.AR.S0.RX.RD .EQ $0428 W5100.DR .EQ $C087-$88 *-------------------------------------- TX.BASE .EQ $4000 RX.BASE .EQ $6000 RXTX.MASK .EQ $1FFF *-------------------------------------- * 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 sta hArgs >LDYA L.MSG.DETECT >SYSCALL SYS.PStrOutYA ldx #$10+$88 .1 lda #W5100.MR.RST sta W5100.MR,x lda #W5100.MR.AI+W5100.MR.IND sta W5100.MR,x lda W5100.MR,x cmp #W5100.MR.AI+W5100.MR.IND bne .2 >AR.SELECT RTR Double Check with RTR default value... lda W5100.DR,x Get RTR HI cmp /2000 bne .2 lda W5100.DR,x Get RTR LO cmp #2000 beq .3 .2 inc DEV.HEADER.NAME+4 txa clc adc #$10 tax bcc .1 #$108 ? >LDYA L.MSG.DETECT.KO >SYSCALL SYS.PStrOutYA lda #DEVMGR.ERRNOHW sec rts .3 stx DEVSLOTx8 lda hARGS bne .4 lda #$00 sta MAC lda #$08 sta MAC+1 lda #$DC sta MAC+2 lda A2osX.RANDOM16 eor A2osX.TIMER16 sta MAC+3 eor A2osX.RANDOM16+1 sta MAC+4 eor A2osX.TIMER16+1 sta MAC+5 bra .8 .4 >SYSCALL SYS.GetMemPtrA >STYA ZPTmpPTR jsr DecodeMac bcc .8 lda #DEVMGR.ERRICL sec rts .8 >LDYA L.MSG.DETECT.OK >SYSCALL SYS.PStrOutYA >LDYA L.DEV.HEADER.NAME >SYSCALL SYS.PStrOutYA lda #13 >SYSCALL SYS.COutA clc rts *-------------------------------------- .INB DRV/X.NET.DRV.S *-------------------------------------- CS.END MSG.DETECT >PSTRING "UtherNet2/W5100 Driver (ARP OffLoad).\n" MSG.DETECT.OK >PSTRING "UtherNet2/W5100 Installed As Device : " MSG.DETECT.KO >PSTRING "Hardware Not Found.\n" hArgs .BS 1 *-------------------------------------- * Device Header (16 Bytes) *-------------------------------------- DEV.HEADER cld jmp (DRV.CS.START,x) .HS 00 .DA #S.DEV.F.SHARE+S.DEV.F.EVENT DEV.HEADER.NAME >PSTRING "ETH1" NAME .HS 00 .HS 00.00.00.00 *-------------------------------------- * Driver Code *-------------------------------------- DRV.CS.START .DA OPEN .DA GETEVENT .DA COUT .DA CLOSE .DA GETINFO .DA IRQ .DA SEND .DA SETIPCFG L.DEVINFO .DA DEVINFO .DA 0 end or relocation *-------------------------------------- OPEN jsr Reset lda #W5100.MR.AI+W5100.MR.IND sta W5100.MR,x >AR.SELECT GAR ldy #8 GAR,SUBR .1 stz W5100.DR,x dey bne .1 * >AR.SELECT SHAR ldy #0 .2 lda MAC,y sta W5100.DR,x iny cpy #6 bne .2 * >AR.SELECT SIPR ldy #4 .3 stz W5100.DR,x dey bne .3 >AR.SELECT RMSR lda #3 8k,0k,0k,0k sta W5100.DR,x ...for Socket RX Buffers sta W5100.DR,x ...for Socket TX Buffers clc rts *-------------------------------------- GETEVENT ldx DEVSLOTx8 >AR.SELECT S0.RX.RSR lda W5100.DR,x get the received size HI ora W5100.DR,x LO bne GETEVENT.RxOK lda #ERR.DEV.NOFRAME COUT IRQ GETEVENT.Err sec rts GETEVENT.RxOK >AR.SELECT S0.RX.RD lda W5100.DR,x get the received ptr HI ldy W5100.DR,x get the received ptr LO and /RXTX.MASK ora /RX.BASE sta W5100.AR,x tya sta W5100.AR+1,x ldy #0 .10 lda W5100.DR,x sta RX.IP,y iny cpy #4 bne .10 ldy W5100.DR,x get RX.Size HI sty RXTX.Size+1 lda W5100.DR,x get RX.Size LO sta RXTX.Size clc adc #S.IP pha tya adc /S.IP ply >PUSHYA >PUSHBI 0 >SYSCALL SYS.GetMem bcs GETEVENT.Err >STYA ZPTmpPTR txa ldy #S.EVT.DATALO sta (pEvent),y lda #S.EVT.F.NET+S.EVT.F.hMEM1 sta (pEvent) lda RXTX.Size sta (ZPTmpPTR) eor #$ff sta Counter ldy #1 lda RXTX.Size+1 sta (ZPTmpPTR),y eor #$ff sta Counter+1 lda RXTX.Size clc adc #6 Header Size sta Offset lda RXTX.Size+1 adc #0 sta Offset+1 ldy #S.IP.DST+3 ldx #3 .1 lda RX.IP,x sta (ZPTmpPTR),y dey dex bpl .1 ldx DEVSLOTx8 ldy #S.IP .2 inc Counter bne .3 inc Counter+1 beq .8 .3 lda W5100.DR,x sta (ZPTmpPTR),y iny bne .2 inc ZPTmpPTR+1 bne .2 .8 >AR.SELECT S0.RX.RD ldy W5100.DR,x Get HI lda W5100.DR,x Get LO clc adc Offset pha save LO tya adc Offset+1 pha >AR.SELECT S0.RX.RD pla sta W5100.DR,x write HI pla sta W5100.DR,x write LO >AR.SELECT S0.CR lda #$40 RECV sta W5100.DR,x ldy #S.IP.DST lda (ZPTmpPTR),y .81 iny and (ZPTmpPTR),y cpy #S.IP.DST+3 bne .81 if EQ, CS inc $ff = Broadcast ?? beq .82 clc not a broadcast .82 lda #$00 ror ldy #S.EVT.DATAHI sta (pEvent),y * clc cleared by ROR rts *-------------------------------------- CLOSE jsr Reset clc rts *-------------------------------------- GETINFO >LDYA L.DEVINFO clc rts *-------------------------------------- SEND >PULLW ZPTmpPTR lda (ZPTmpPTR) sec sbc #S.IP-2 sta RXTX.Size eor #$ff sta Counter ldy #1 lda (ZPTmpPTR),y sbc /S.IP-2 sta RXTX.Size+1 eor #$ff sta Counter+1 ldx DEVSLOTx8 >AR.SELECT S0.TX.FSR lda W5100.DR,x get send size HI ldy W5100.DR,x LO cpy RXTX.Size sbc RXTX.Size+1 bcs SEND.READY lda #ERR.DEV.NOBUFFER sec rts SEND.READY >AR.SELECT S0.DIPR ldy #S.IP.DST .1 lda (ZPTmpPTR),y sta W5100.DR,x iny cpy #S.IP.DST+4 bne .1 >AR.SELECT S0.PROTO ldy #S.IP.PROTOCOL lda (ZPTmpPTR),y sta W5100.DR,x * >AR.SELECT S0.TOS stz W5100.DR,x * >AR.SELECT S0.TTL lda #K.IP.TTL sta W5100.DR,x >AR.SELECT S0.TX.WR lda W5100.DR,x Get HI ldy W5100.DR,x Get LO and /RXTX.MASK ora /TX.BASE 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 (ZPTmpPTR),y sta W5100.DR,x iny bne .2 inc ZPTmpPTR+1 bne .2 .8 >AR.SELECT S0.TX.WR clc lda Offset 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 #$20 SEND sta W5100.DR,x clc rts *-------------------------------------- SETIPCFG >STYA ZPTmpPTR ldx DEVSLOTx8 >AR.SELECT S0.CR lda #$10 CLOSE sta W5100.DR,x .10 >AR.SELECT S0.SR lda W5100.DR,x bne .10 CLOSED ??? >AR.SELECT GAR ldy #S.IPCFG.GW .1 lda (ZPTmpPTR),y sta W5100.DR,x iny cpy #S.IPCFG.GW+4 bne .1 * >AR.SELECT SUBR Implicit, next to GAR ldy #S.IPCFG.MASK .2 lda (ZPTmpPTR),y sta W5100.DR,x iny cpy #S.IPCFG.MASK+4 bne .2 >AR.SELECT SIPR ldy #S.IPCFG.IP .3 lda (ZPTmpPTR),y sta W5100.DR,x iny cpy #S.IPCFG.IP+4 bne .3 >AR.SELECT S0.MR lda #W5100.AR.S0.MR.IPRAW+W5100.AR.S0.MR.MF sta W5100.DR,x * >AR.SELECT S0.CR Implicit, next to S0.MR lda #1 OPEN sta W5100.DR,x clc rts *-------------------------------------- Reset ldx DEVSLOTx8 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 rts *-------------------------------------- DRV.CS.END DEVSLOTx8 .BS 1 RX.IP .BS 4 RXTX.Size .BS 2 Counter .BS 2 Offset .BS 2 *-------------------------------------- DEVINFO .DA #S.DEVINFO.TYPE.NET DEVFLAGS .DA #S.DEVINFO.NET.FLAGS.ARPOFFLOAD+S.DEVINFO.NET.FLAGS.IPOFFLOAD MAC .BS 6 LINK.STATUS .DA #S.DEVINFO.NET.STATUS.OK+S.DEVINFO.NET.STATUS.FD+S.DEVINFO.NET.STATUS.100 MAN SAVE DRV/UTHER2.AI.DRV.S ASM