84 lines
1.6 KiB
ArmAsm
84 lines
1.6 KiB
ArmAsm
|
.define _printf, _putchar, _getal, _char
|
||
|
|
.sect .text
|
||
|
|
.sect .rom
|
||
|
|
.sect .data
|
||
|
|
.sect .bss
|
||
|
|
.sect .bss
|
||
|
|
_getal:
|
||
|
|
.space 12
|
||
|
|
_char:
|
||
|
|
.space 1
|
||
|
|
.align 2
|
||
|
|
.sect .data
|
||
|
|
hexs:
|
||
|
|
.ascii "0123456789abcdef"
|
||
|
|
.align 2
|
||
|
|
.sect .text
|
||
|
|
_printf:
|
||
|
|
movem.l d0/d1/d2/a0/a1/a2/a3/a4/a5/a6, -(sp)
|
||
|
|
lea (44, sp), a6 ! a6 <- address of arguments
|
||
|
|
move.l (a6)+, a5 ! a5 <- address of format
|
||
|
|
next: move.b (a5)+, d0
|
||
|
|
beq out
|
||
|
|
cmp.b #'%', d0
|
||
|
|
beq procnt
|
||
|
|
put: move.l d0, -(sp)
|
||
|
|
jsr (_putchar) ! long argument on stack
|
||
|
|
tst.l (sp)+
|
||
|
|
bra next
|
||
|
|
|
||
|
|
procnt: move.b (a5)+, d0
|
||
|
|
cmp.b #'d', d0 ! NOTE: %d means unsigned.
|
||
|
|
beq digit
|
||
|
|
cmp.b #'x', d0
|
||
|
|
beq hex
|
||
|
|
cmp.b #'s', d0
|
||
|
|
beq string
|
||
|
|
cmp.b #'%', d0 ! second % has to be printed.
|
||
|
|
beq put
|
||
|
|
tst.b -(a5) ! normal char should be printed
|
||
|
|
bra next
|
||
|
|
|
||
|
|
string: move.l (a6)+, a2 ! a2 <- address of string
|
||
|
|
sloop: move.b (a2)+, d0
|
||
|
|
beq next
|
||
|
|
move.l d0, -(sp)
|
||
|
|
jsr (_putchar) ! long argument on stack
|
||
|
|
tst.l (sp)+
|
||
|
|
bra sloop
|
||
|
|
|
||
|
|
digit: move.l (a6)+, d1 ! d1 <- integer
|
||
|
|
move.l #_getal+12, a2 ! a2 <- ptr to last part of buf
|
||
|
|
clr.b -(a2) ! stringterminator
|
||
|
|
1: divul.l #10, d2:d1 ! d1 <- qotient; d2 <- remainder
|
||
|
|
add.l #'0', d2
|
||
|
|
move.b d2, -(a2)
|
||
|
|
tst.l d1 ! if quotient = 0 then ready
|
||
|
|
bne 1b
|
||
|
|
bra sloop ! print digitstring.
|
||
|
|
|
||
|
|
hex: move.l (a6)+, d1 ! d1 <- integer
|
||
|
|
move.l #_getal+12, a2 ! a2 <- ptr to last part of buf
|
||
|
|
clr.b -(a2) ! stringterminator
|
||
|
|
move.l #7, d2 ! loop control
|
||
|
|
1: move.l d1, d0
|
||
|
|
and.l #15, d0
|
||
|
|
move.b (hexs,d0.w), -(a2) ! hex digit
|
||
|
|
asr.l #4, d1
|
||
|
|
dbf d2, 1b
|
||
|
|
bra sloop
|
||
|
|
|
||
|
|
out:
|
||
|
|
movem.l (sp)+, d0/d1/d2/a0/a1/a2/a3/a4/a5/a6
|
||
|
|
rts
|
||
|
|
|
||
|
|
|
||
|
|
_putchar:
|
||
|
|
move.l #1, -(sp)
|
||
|
|
pea (11,sp)
|
||
|
|
move.l #1, -(sp)
|
||
|
|
jsr (_write)
|
||
|
|
lea (12, sp), sp
|
||
|
|
rts
|
||
|
|
.align 2
|