mirror of
https://github.com/A2osX/A2osX.git
synced 2024-06-01 07:41:51 +00:00
562 lines
10 KiB
Plaintext
562 lines
10 KiB
Plaintext
PR#3
|
||
PREFIX /A2OSX.BUILD
|
||
LOMEM $A00
|
||
INC 1
|
||
AUTO 6
|
||
*/--------------------------------------
|
||
* # SScanF
|
||
* Scan a PStr (in progress)
|
||
* ## In:
|
||
* PUSHW PTR to target buffer
|
||
* PUSHW PSTR pattern (ex: "%d.%d.%d.%d")
|
||
* %d : byte
|
||
* PUSHW PSTR to scan (ex: "192.168.1.5")
|
||
* ## Out:
|
||
*\--------------------------------------
|
||
K.SScanF jsr PullPtr1Ptr2Ptr3
|
||
|
||
ldy #0 Y = PTR in pattern
|
||
|
||
lda (ZPPtr1)
|
||
beq .9
|
||
tax X = COUNT to scan
|
||
inc ZPPtr1
|
||
bne .1
|
||
inc ZPPtr1+1
|
||
|
||
.1 txa End Of String?
|
||
beq .8
|
||
tya
|
||
cmp (ZPPtr2) End of pattern?
|
||
beq .8
|
||
iny
|
||
lda (ZPPtr2),y
|
||
cmp #'%' Escape?
|
||
beq .2
|
||
cmp (ZPPtr1) Same char?
|
||
bne .9
|
||
jsr K.SScanF.IncPtr1
|
||
bne .1
|
||
clc
|
||
rts
|
||
|
||
.2 tya
|
||
cmp (ZPPtr2) unexpected End of pattern after "%" ?
|
||
beq .9
|
||
|
||
iny
|
||
lda (ZPPtr2),y
|
||
cmp #'d' BYTE ?
|
||
bne .3
|
||
|
||
stz ASCBUF
|
||
.20 lda (ZPPtr1)
|
||
jsr K.SScanF.IsDigit
|
||
bcs .21
|
||
phx
|
||
inc ASCBUF
|
||
ldx ASCBUF
|
||
sta ASCBUF,x
|
||
plx
|
||
jsr K.SScanF.IncPtr1
|
||
bne .20 end of string ?
|
||
|
||
.21 jsr DEC2HEX
|
||
lda HEXBUF
|
||
sta (ZPPtr3)
|
||
inc ZPPtr3
|
||
bne .1
|
||
inc ZPPtr3+1
|
||
bra .1
|
||
|
||
.3 cmp #'D' WORD ?
|
||
bne .4
|
||
|
||
bra .1
|
||
|
||
.4 cmp #'s' STRING ?
|
||
bne .9
|
||
|
||
bra .1
|
||
|
||
.8 clc
|
||
rts
|
||
|
||
.9 sec
|
||
rts
|
||
*--------------------------------------
|
||
K.SScanF.IncPtr1
|
||
dex
|
||
beq .1
|
||
inc ZPPtr1
|
||
bne .1
|
||
inc ZPPtr1+1 never Zero
|
||
.1 rts
|
||
*--------------------------------------
|
||
K.SScanF.IsDigit
|
||
cmp #'0'
|
||
bcc .1
|
||
cmp #'9'+1
|
||
bcs .1
|
||
rts
|
||
.1 sec
|
||
rts
|
||
*/--------------------------------------
|
||
* # PrintFYA/SPrintFYA/FPrintFYA
|
||
* Prints C-Style String
|
||
* ## In:
|
||
* PrintFYA :
|
||
* Y,A = PTR to CStr
|
||
* SPrintFYA :
|
||
* Y,A = PTR to CStr
|
||
* PULLW = Ptr to Dst Buffer
|
||
* FPrintFYA :
|
||
* Y,A = PTR to CStr
|
||
* PULLB = hNode
|
||
* ## Out:
|
||
* CC : success
|
||
* CS : error code from Output
|
||
* Specifiers :
|
||
* %a : pull 2 bytes to Print Access right String 'drwxrwxrwx'
|
||
* %b : pull 1 byte to Print BIN
|
||
* %B : pull 2 bytes to Print BIN
|
||
* %d : pull 1 byte unsigned DEC 0..255
|
||
* %D : pull 2 bytes unsigned DEC 0..65535
|
||
* %u : pull 2 bytes PTR to 4 bytes long unsigned DEC 0..4294967295
|
||
* %e : pull 2 bytes PTR to 6 Bytes Real +1.23456789e+12
|
||
* %f : pull 2 bytes PTR to 6 Bytes Real 3.1415
|
||
* %h : pull 1 byte to Print HEX
|
||
* %H : pull 2 bytes to Print HEX
|
||
* %i : pull 1 byte to Print signed DEC -128..127
|
||
* %I : pull 2 bytes to Print signed DEC -32768..32767
|
||
* %L : pull 2 bytes PTR to 4 bytes signed DEC -2147483648..2147483647
|
||
* %n : pull 1 byte to Print low Nibble HEX
|
||
* %N : pull 1 byte to Print high Nibble HEX
|
||
* %s : pull 2 bytes ptr to C-Style String
|
||
* %S : pull 2 bytes ptr to P-Style String
|
||
* \b : Print 'BS' (08)
|
||
* \e : Print 'ESC' ($1B,27)
|
||
* \f : Print 'FF' ($0C,12)
|
||
* \n : Print 'LF' ($0A,10)
|
||
* \r : Print 'CR' ($0D,13)
|
||
* \\\\ : Print \
|
||
* \% : Print %
|
||
* Modifiers for len and padding :
|
||
* %d : '9' '12'
|
||
* %2d : ' 9' '12'
|
||
* %02d : '09' '12'
|
||
* %11s : 'ABCDEFGH '
|
||
* %011s : 'ABCDEFGH000'
|
||
* %2f : '3.14'
|
||
*\--------------------------------------
|
||
K.SPrintFYA >STYA ZPPtr1
|
||
>PULLW Printf.Cout.Ptr+1
|
||
|
||
K.FPrintFYA >STYA ZPPtr1
|
||
|
||
K.PrintFYA >STYA ZPPtr1
|
||
|
||
ldy #0
|
||
|
||
.1 lda (ZPPtr1),y
|
||
beq .99
|
||
iny
|
||
cmp #'%'
|
||
bne .10
|
||
|
||
stz PADLEN
|
||
lda #' '
|
||
sta PADCHAR
|
||
|
||
.2 ldx #PrintFTBL2-PrintFTBL1-1
|
||
lda (ZPPtr1),y
|
||
beq .99
|
||
iny
|
||
|
||
.3 cmp PrintFTBL1,x do we have a %x command?
|
||
beq .8 yes, jmp to it!
|
||
dex
|
||
bpl .3 no valid letter...
|
||
|
||
cmp #'0' ...a 0...mmm... padding char?
|
||
bne .4
|
||
|
||
ldx PADLEN PADLEN is not nul, so this 0 is second digit
|
||
bne .5
|
||
|
||
lda #'0'
|
||
sta PADCHAR no, this is the first 0, so make it PADCHAR
|
||
bra .2
|
||
|
||
.4 bcc .99 less than '0'....error
|
||
cmp #'9'+1
|
||
bcs .99 more than '9' ....error
|
||
|
||
.5 and #$0F we have a digit
|
||
pha save it...
|
||
lda PADLEN starts PADLEN * 10
|
||
asl
|
||
asl A=times 4
|
||
adc PADLEN CC by ASL, A=times 5
|
||
asl times 10
|
||
sta PADLEN
|
||
|
||
pla get back digit
|
||
adc PADLEN
|
||
sta PADLEN
|
||
bra .2 go get next char...
|
||
|
||
.8 phy
|
||
txa
|
||
asl
|
||
tax
|
||
jsr PrintFESC
|
||
ply
|
||
bcc .1
|
||
rts
|
||
|
||
.10 cmp #'\'
|
||
bne .20
|
||
|
||
ldx #PrintFTBL2.OUT-PrintFTBL2-1
|
||
lda (ZPPtr1),y
|
||
beq .99
|
||
iny
|
||
|
||
.12 cmp PrintFTBL2,x
|
||
beq .13
|
||
dex
|
||
bpl .12
|
||
bra .1
|
||
|
||
.13 lda PrintFTBL2.OUT,x
|
||
|
||
.20 jsr Printf.Cout
|
||
bcc .1
|
||
.99 rts
|
||
*--------------------------------------
|
||
PrintFESC jmp (PrintFJMP,x)
|
||
*--------------------------------------
|
||
PrintFTBL1 .AS "abBdDuefhHiILnNsS"
|
||
PrintFTBL2 .AS "befnr\%"
|
||
PrintFTBL2.OUT .HS 08.1B.0C.0A.0D \b\e\f\n\r
|
||
.DA #'\' \\
|
||
.DA #'%' \%
|
||
PrintFJMP .DA PrintF.A
|
||
.DA PrintF.B,PrintF.BB
|
||
.DA PrintF.D,PrintF.DD,PrintF.U
|
||
.DA PrintF.E,PrintF.F
|
||
.DA PrintF.H,PrintF.HH
|
||
.DA PrintF.I,PrintF.II,PrintF.L
|
||
.DA PrintF.N,PrintF.NN
|
||
.DA PrintF.S,PrintF.SS
|
||
*--------------------------------------
|
||
PrintF.A >PULLW HEXBUF
|
||
|
||
lda HEXBUF+1
|
||
lsr
|
||
lsr
|
||
lsr
|
||
lsr
|
||
tax
|
||
lda TYPES,x
|
||
jsr Printf.Cout
|
||
bcs .9
|
||
|
||
ldx #0
|
||
|
||
.1 lda #'-'
|
||
lsr HEXBUF
|
||
bcc .2
|
||
lda ACCESS,x
|
||
|
||
.2 jsr Printf.Cout
|
||
bcs .9
|
||
|
||
inx
|
||
cpx #8
|
||
bne .1
|
||
|
||
.3 lda #'-'
|
||
lsr HEXBUF+1
|
||
bcc .4
|
||
lda ACCESS,x
|
||
|
||
.4 jmp Printf.Cout
|
||
|
||
.9 rts
|
||
*--------------------------------------
|
||
PrintF.BB >PULLA
|
||
pha
|
||
jsr PrintF.B
|
||
pla
|
||
bcc PrintF.B.1
|
||
PrintF.BB.RTS rts
|
||
*--------------------------------------
|
||
PrintF.B >PULLA
|
||
|
||
PrintF.B.1 ldx #8
|
||
|
||
.1 asl
|
||
pha
|
||
lda #'0'
|
||
adc #0 add Carry
|
||
jsr Printf.Cout
|
||
pla
|
||
bcs PrintF.BB.RTS
|
||
dex
|
||
bne .1
|
||
rts
|
||
*--------------------------------------
|
||
PrintF.D >PULLB HEXBUF
|
||
stz HEXBUF+1
|
||
bra PrintF.DD.1
|
||
|
||
PrintF.DD >PULLW HEXBUF
|
||
PrintF.DD.1 stz HEXBUF+2
|
||
stz HEXBUF+3
|
||
bra PrintF.U.1
|
||
|
||
PrintF.U >PULLW ZPPtr2
|
||
ldy #3
|
||
|
||
.1 lda (ZPPtr2),y
|
||
sta HEXBUF,y
|
||
dey
|
||
bpl .1
|
||
|
||
PrintF.U.1 stz SIGN
|
||
jsr HEX2DEC
|
||
jmp PrintDEC
|
||
*--------------------------------------
|
||
PrintF.E >PULLW ZPPtr2
|
||
rts
|
||
*--------------------------------------
|
||
PrintF.F >PULLW ZPPtr2
|
||
rts
|
||
*--------------------------------------
|
||
PrintF.HH >PULLA
|
||
pha
|
||
jsr PrintF.H
|
||
pla
|
||
bra PrintF.H.1
|
||
*--------------------------------------
|
||
PrintF.H >PULLA
|
||
PrintF.H.1 pha
|
||
jsr PrintF.NN.1
|
||
pla
|
||
jmp PrintF.N.1
|
||
*--------------------------------------
|
||
PrintF.I >PULLB HEXBUF
|
||
eor #$ff if positive, it becomes neg so branch if....minus!
|
||
clc
|
||
bmi .1
|
||
sec
|
||
inc 2s complement...
|
||
sta HEXBUF
|
||
|
||
|
||
.1 stz HEXBUF+1
|
||
bra PrintF.II.1
|
||
|
||
PrintF.II >PULLW HEXBUF A=HI
|
||
eor #$ff
|
||
clc
|
||
bmi PrintF.II.1
|
||
sec
|
||
tax
|
||
lda HEXBUF
|
||
eor #$ff
|
||
inc 2s complement...
|
||
sta HEXBUF
|
||
bne .1
|
||
inx
|
||
.1 sta HEXBUF
|
||
stx HEXBUF+1
|
||
|
||
PrintF.II.1 stz HEXBUF+2
|
||
stz HEXBUF+3
|
||
bra PrintF.L.1
|
||
|
||
PrintF.L >PULLW ZPPtr2
|
||
ldy #3
|
||
|
||
.1 lda (ZPPtr2),y
|
||
sta HEXBUF,y
|
||
dey
|
||
bpl .1
|
||
|
||
|
||
PrintF.L.1 ror SIGN
|
||
jsr HEX2DEC
|
||
*--------------------------------------
|
||
PRINTDEC lda PADLEN any Len format ?
|
||
beq .1 no
|
||
|
||
lda #10
|
||
sec yes, Print only digits starting at pos 10-padlen
|
||
sbc PADLEN
|
||
|
||
.1 tax x=0 if no padlen, or x=10-padlen
|
||
|
||
.2 lda ASCBUF,x
|
||
cmp #'0' a zero?
|
||
beq .3
|
||
|
||
inc PADLEN found a non zero, Print all digits, even if 0, next time
|
||
ldy #'0'
|
||
sty PADCHAR
|
||
bra .4
|
||
|
||
.3 cpx #9 last digit ?
|
||
beq .4 Print always
|
||
|
||
ldy PADLEN no pad to fill, do not Print 0
|
||
beq .6
|
||
|
||
lda PADCHAR fill with PADCHAR
|
||
|
||
.4 bit SIGN a sign to print before digits ?
|
||
bpl .5
|
||
pha yes, save whatever we have to print....
|
||
lda #'-'
|
||
jsr Printf.Cout
|
||
stz SIGN reset flag for next char...
|
||
pla
|
||
|
||
.5 jsr Printf.Cout
|
||
bcs .9
|
||
|
||
.6 inx
|
||
cpx #10
|
||
bne .2
|
||
|
||
clc
|
||
.9 rts
|
||
*--------------------------------------
|
||
PrintF.N >PULLA
|
||
PrintF.N.1 and #$0F
|
||
bra PrintF.NN.2
|
||
|
||
PrintF.NN >PULLA
|
||
PrintF.NN.1 lsr
|
||
lsr
|
||
lsr
|
||
lsr
|
||
|
||
PrintF.NN.2 ora #$30
|
||
cmp #$3A
|
||
bcc .1
|
||
adc #6
|
||
.1 jmp Printf.Cout
|
||
*--------------------------------------
|
||
PrintF.S ldy #$ff CSTR
|
||
.HS 2C bit abs
|
||
PrintF.SS ldy #$00 PSTR
|
||
|
||
>PULLW ZPPtr2
|
||
|
||
lda (ZPPtr2) if CSTR:last char=0, if PSTR:len=0
|
||
beq .8
|
||
|
||
sty .1+1
|
||
|
||
.1 lda #$ff Self Modified
|
||
bne .11 CSTR
|
||
|
||
tya PSTR
|
||
cmp (ZPPtr2) len check
|
||
beq .2
|
||
|
||
.11 iny
|
||
|
||
lda (ZPPtr2),y
|
||
beq .2
|
||
|
||
jsr Printf.Cout
|
||
bcs .9
|
||
|
||
lda PADLEN
|
||
beq .1
|
||
|
||
cpy PADLEN
|
||
bne .1
|
||
clc
|
||
rts
|
||
|
||
.2 lda PADLEN
|
||
beq .8
|
||
|
||
.3 lda PADCHAR
|
||
jsr Printf.Cout
|
||
bcs .9
|
||
iny
|
||
cpy PADLEN
|
||
bne .3
|
||
|
||
.8 clc
|
||
.9 rts
|
||
*--------------------------------------
|
||
Printf.Cout jmp K.PutCharA
|
||
|
||
Printf.Cout.Ptr sta $ffff Self modified
|
||
|
||
*/--------------------------------------
|
||
* # AToI
|
||
* Convert String to 32 bit int
|
||
* ## In:
|
||
* PUSHW PTR to target buffer DWORD
|
||
* PUSHW Source String (PSTR)
|
||
* ## Out:
|
||
*\--------------------------------------
|
||
K.AToI jsr PullPtr1Ptr2 PSTR in Ptr1,buffer in Ptr2
|
||
|
||
stz ASCBUF
|
||
|
||
ldx #0
|
||
|
||
lda (ZPPtr1)
|
||
beq .2
|
||
|
||
ldy #0
|
||
|
||
.1 iny
|
||
lda (ZPPtr1),y
|
||
|
||
cmp #'0'
|
||
bcc .2
|
||
cmp #'9'+1
|
||
bcs .2
|
||
|
||
inx
|
||
sta ASCBUF,x
|
||
cpx #10
|
||
beq .2
|
||
tya
|
||
cmp (ZPPtr1)
|
||
bne .1
|
||
|
||
.2 stx ASCBUF
|
||
jsr DEC2HEX
|
||
|
||
ldy #3
|
||
|
||
.3 lda HEXBUF,y
|
||
sta (ZPPtr2),y
|
||
dey
|
||
bpl .3
|
||
|
||
clc
|
||
rts
|
||
*--------------------------------------
|
||
TYPES .AS "-dbclssp"
|
||
ACCESS .AS "rwxrwxrwx"
|
||
SIGN .BS 1
|
||
PADLEN .BS 1
|
||
PADCHAR .BS 1
|
||
*--------------------------------------
|
||
MAN
|
||
SAVE /A2OSX.SRC/SYS/KERNEL.S.CIO
|
||
LOAD /A2OSX.SRC/SYS/KERNEL.S
|
||
ASM
|