From 30ef1ae0e1d60f55aee401ad9741cb8d5a0feef0 Mon Sep 17 00:00:00 2001
From: Joshua Wise <joshua@rebirth.joshuawise.com>
Date: Sun, 6 Apr 2008 22:51:14 -0400
Subject: [PATCH] It works.

---
 diag.asm | 44 ++++++++++++++++++++++++++++++++++++++++++++
 rom.asm  | 52 +++++++++++++++++++++++++++-------------------------
 2 files changed, 71 insertions(+), 25 deletions(-)

diff --git a/diag.asm b/diag.asm
index 68ea3f8..004935a 100644
--- a/diag.asm
+++ b/diag.asm
@@ -7,20 +7,64 @@ main:
 	
 	ld sp, $DFF0
 	
+	ld c, $07
+	ld a, $04	;start timer, 4.096KHz
+	ld [c], a
+
+	ld hl, $DF81
+	xor a
+	ld [hl], a
+	
 	ld hl, signon
 	call puts
+	
+	ei
 
 	call memtest
 
 	call insntest
 
 	call waitsw
+	
+	di
 
 	jr main
 
 signon:
 	db $0D,$0A,$1B,"[1mFPGABoy Diagnostic ROM",$1B,"[0m",$0D,$0A,0
 
+	section "fuq",HOME[$100]
+irqhand:
+	PUSH AF
+	PUSH BC
+	PUSH DE
+	PUSH HL
+	
+	xor a
+	ld c, $0F	; ack the irq
+	ld [c], a
+	
+	ld a, $41	; print A
+	call putc
+	
+	ld hl, $DF81
+	ld a, [hl]
+	ld b, 1
+	add b
+	ld c, $51
+	ld [c], a
+	ld [hl], a
+
+
+	POP HL
+	POP DE
+	POP BC
+	POP AF
+	RETI
+	db $18,$FE,$18,$FE,$18,$FE,$18,$FE,$18,$FE,$18,$FE,$18,$FE,$18,$FE
+	db $18,$FE,$18,$FE,$18,$FE,$18,$FE,$18,$FE,$18,$FE,$18,$FE,$18,$FE
+	db $18,$FE,$18,$FE,$18,$FE,$18,$FE,$18,$FE,$18,$FE,$18,$FE,$18,$FE
+
 ; Memory tester: writes h ^ l to all addresses from C000 to DF80.
 memtest:
 	ld hl,memteststr
diff --git a/rom.asm b/rom.asm
index 6989b2d..0c25fab 100644
--- a/rom.asm
+++ b/rom.asm
@@ -7,19 +7,20 @@ main:
 	
 	ld sp, $DFF0
 	
-;	ld hl, $DF81
-;	ld a, $80
-;	ld [hl], a
+	ld hl, $DF81
+	ld a, $80
+	ld [hl], a
 
-;	ld c, $07
-;	ld a, $07	;start timer, 4.096KHz
-;	ld [c], a
+	ld c, $07
+	ld a, $04	;start timer, 4.096KHz
+	ld [c], a
 ;diqs:	ei
 ;	ld a, $80
 ;	ld c, $51
 ;	ld [c], a
 ;	jr diqs
 	call irqhand
+	ei
 coqs: jr coqs
 
 	section "Diq", HOME[$38]
@@ -34,33 +35,22 @@ irqhand:
 	PUSH DE
 	PUSH HL
 	
-;	ld c, $51
-;	ld a, $F0
-;	ld [c], a
-	
 	xor a
 	ld c, $0F	; ack the irq
 	ld [c], a
 	
-	;ld a, $41	; print A
-	;call putc
+	ld a, $41	; print A
+	call putc
 	
-;	ld hl, $DF81
-;	ld a, [hl]
-;	ld b, 1
-;	add b
-	ld a, $08
-	ld hl, $FF51
-;	ld c, $51
-	nop
-	nop
+	ld hl, $DF81
+	ld a, [hl]
+	ld b, 1
+	add b
+	ld c, $51
+	ld [c], a
 	ld [hl], a
 
 
-;	ld c, $51
-;	ld a, $0F
-;	ld [c], a
-	
 	POP HL
 	POP DE
 	POP BC
@@ -69,3 +59,15 @@ irqhand:
 	db $18,$FE,$18,$FE,$18,$FE,$18,$FE,$18,$FE,$18,$FE,$18,$FE,$18,$FE
 	db $18,$FE,$18,$FE,$18,$FE,$18,$FE,$18,$FE,$18,$FE,$18,$FE,$18,$FE
 	db $18,$FE,$18,$FE,$18,$FE,$18,$FE,$18,$FE,$18,$FE,$18,$FE,$18,$FE
+
+putc:
+	ld b, 0
+	ld c, $50
+	push af
+.waitport:
+	ld a,[c]
+	cp b
+	jr nz,.waitport
+	pop af
+	ld [c],a
+	ret
-- 
2.39.2