Fix POP AF test (from blargg's CPU tests)

[fpgaboy.git] / flashdiag.asm

diff --git a/flashdiag.asm b/flashdiag.asm
new file mode 100644 (file)
index 0000000..2d0738c
--- /dev/null
+++ b/flashdiag.asm
@@ -0,0 +1,65 @@
+       SECTION "wee",HOME[$0]
+       ld sp, $CFFF
+       ld hl, $FF60
+       ld a, $FF
+       ld [hli], a
+       ld [hli], a
+       ld [hli], a
+       ld a, $90       ; device info
+       ld [$FF65], a
+       
+       call rn+$FF80
+       
+       ld a, [$FF65]   ; 0000
+       call puthex + $FF80
+       
+       call rn+$FF80
+       
+       ld a, [$FF65]   ; 0000
+       call puthex + $FF80
+       
+       call rn+$FF80
+       
+       jp $0000
+
+puthex:
+       push af
+       swap a
+       and $0F
+       ld hl, hexdig+$FF80
+       add l
+       ld l, a
+       ld a, [hl]
+       call putc+$FF80
+       pop af
+       and $0F
+       ld hl, hexdig+$FF80
+       add l
+       ld l, a
+       ld a, [hl]
+       call putc+$FF80
+       ret
+
+hexdig:
+       db "0123456789ABCDEF"
+
+putc:
+       ld c, $53
+       push af
+.waitport:
+       ld a,[c]
+       and $01
+       jr nz,.waitport
+       pop af
+       ld [$FF52],a
+       ret
+
+rn:
+       ld a, 13
+       call putc+$FF80
+       ld a, 10
+       jr putc
+
+
+       section "a", HOME[$7E]
+       nop