X-Git-Url: http://git.joshuawise.com/fpgaboy.git/blobdiff_plain/31b9962d02cae0e935e392b688370504fd4125ff..efc8cc5dd78c9126c9e3ced9be2c99c6b962703a:/flashdiag.asm

diff --git a/flashdiag.asm b/flashdiag.asm
new file mode 100644
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