[fpgaboy.git] / diag.asm

	section "end",HOME[1024]
	nop

	SECTION "a",HOME[$00]

start: jp main
	
	section "vbl",HOME[$40]
	jp vbl
	
	section "lcdc",HOME[$48]
	jp lcdc
	
	section "tmro",HOME[$50]
	jp tmro

main:
	ld a, $FF
	ld c, $51
	ld [c], a

	ld sp, $DFF0
	
	ld a, $04	;start timer, 4.096KHz
	ld c, $07
	ld [c], a
	
	ld hl, $DF81
	xor a
	ld [hli], a
	ld [hli], a
	
	ld hl, signon
	call puts

	call putscreen
	
	ei

	call memtest

	call insntest

	call waitsw
	
	di

	jr main

signon:
	db $0D,$0A,$1B,"[1mFPGABoy Diagnostic ROM",$1B,"[0m",$0D,$0A,0

putscreen:
	; Wait for vblank
;.stat:	ld a, [$FF41]	; STAT
;	and $03		; mode
;	cp $01		; VBLANK
;'	jp nz, .stat

	ld hl, $8000	; Copy two tiles.
	ld a, $AA
	ld [hli], a
	ld [hli], a
	ld a, $55
	ld [hli], a
	ld [hli], a
	ld a, $AA
	ld [hli], a
	ld [hli], a
	ld a, $55
	ld [hli], a
	ld [hli], a
	ld a, $AA
	ld [hli], a
	ld [hli], a
	ld a, $55
	ld [hli], a
	ld [hli], a
	ld a, $AA
	ld [hli], a
	ld [hli], a
	ld a, $55
	ld [hli], a
	ld [hli], a
	xor a
	ld [hli], a
	ld [hli], a
	ld [hli], a
	ld [hli], a
	ld [hli], a
	ld [hli], a
	ld [hli], a
	ld [hli], a
	ld [hli], a
	ld [hli], a
	ld [hli], a
	ld [hli], a
	ld [hli], a
	ld [hli], a
	ld [hli], a
	ld [hli], a
	
	ld hl, $9800
.loop:	ld a, $01
	ld [hli], a
	xor a
	ld [hli], a
	ld a, h
	cp $9C
	jp nz,.loop
	ret

vbl:
	PUSH AF
	PUSH BC
	PUSH DE
	PUSH HL
	
	xor a
	ld [$FF0F], a

	ld c, $42	; SCY
	ld a, [c]
	inc a
	ld [c], a
	
	ld c, $43	; SCX
	ld a, [c]
	inc a
	ld [c], a

	POP HL
	POP DE
	POP BC
	POP AF

	RETI

lcdc:
	PUSH AF
	PUSH BC
	
	xor a
	ld [$FF0F], a
	
	POP BC
	POP AF
	
	reti
	
tmro:
	PUSH AF
	PUSH BC
	PUSH DE
	PUSH HL
	
	xor a
	ld [$FF0F], a
	
	ld c, $45	; LYC
	ld a, [c]
	inc a
	ld [c], a
	
	ld a, [$DF82]
	cp 0
	jr z, .noprint
	ld a, $41	; print A
	call putc
.noprint:
	ld a, [$DF81]
	inc a
	ld [$DF81], a
	ld [$FF51], a

	POP HL
	POP DE
	POP BC
	POP AF
	RETI

; Memory tester: writes h ^ l to all addresses from C000 to DF80.
memtest:
	ld hl,memteststr
	call puts
	
	ld hl, $C000		; Write loop
.wr:
	ld a,h
	xor l
	ld [hli],a
	ld a, h
	cp $DF
	jr nz, .wr
	ld a, l
	cp $80
	jr nz, .wr

	ld hl, $C000		; Read loop
.rd:
	ld a,h
	xor l
	ld b,a
	ld a, [hli]
	cp b
	jr nz, .memfail
	
	ld a, h
	cp $DF
	jr nz, .rd
	ld a, l
	cp $80
	jr nz, .rd
	
	ld hl, testokstr	; Say we're OK
	call puts
	ret
.memfail:			; Say we failed (sadface)
	; decrement hl the easy way
	dec [hl]
	push hl
	ld hl, failatstr
	call puts
	pop hl
	ld a, h
	call puthex
	ld a, l
	call puthex
	ld a, $0A
	call putc
	ld a, $0D
	call putc
	ret
memteststr:
	db "Testing memory from $C000 to $DF80...",0
testokstr:
	db " OK!",$0D,$0A,0
failatstr:
	db " Test failed at $",0

puthex:				; Put two hex nibbles to the serial console.
	push af
	rra
	rra
	rra
	rra
	and $0F
	add $30
	call putc
	pop af
	and $0F
	add $30
	call putc
	ret

; Wait for switches to be flipped on and off again.
waitsw:
	ld hl,waitswstr
	call puts
	
	ld hl,$DF82
	ld a, 1
	ld [hl], a

	ld c, $51
	xor a
	ld [c],a
	
.loop1:
	ld a,[c]
	cp $0
	jr z,.loop1
.loop2:
	ld a,[c]
	cp $0
	jr nz,.loop2
	ret

waitswstr:
	db "Diagnostic ROM complete; flip switches to nonzero and then to zero to reset. Expect A.",$0D,$0A,0

; Core instruction basic acceptance tests.
insntest:
	ld hl, .insnteststr
	call puts
	
	; Test PUSH and POP.
	ld b, $12
	ld c, $34
	ld d, $56
	ld e, $78
	push bc
	pop de
	ld hl, .pushpopfail
	ld a, d
	cp b
	jr nz,.fail
	ld a, e
	cp c
	jr nz,.fail
	
	; Test ALU (HL).
	ld hl, .ff
	ld a, $FF
	xor [hl]
	ld hl, .xorhlfail
	jr nz, .fail
	
	; Test JP (HL)
	ld hl, .jphl
	jp [hl]
	ld hl, .jphlfail
	jr .fail
	rst $00
.jphl:

	; Test JR
	ld a, $FF
	cp $0
	jr nz,.jr
	ld hl, .jrfail
	jr .fail
	rst $00
.jr:

	; Test inc16
	ld d, $12
	ld e, $FF
	ld hl, .inc16fail
	inc de
	ld a, $13
	cp d
	jr nz, .fail
	ld a, $00
	cp e
	jr nz, .fail
	
	; Test CP.
	ld hl, .cpfail
	ld a, $10
	cp $20
	jr nc,.fail
	ld a, $20
	cp $10
	jr c,.fail
	
	; Test CPL
	ld hl, .cplfail
	ld a, $55
	cpl
	cp $AA
	jr nz,.fail

	; Test DI/EI delay
	di
	ld hl, .dinocausefail
	ld c, $0F	; First, wait until an interrupt happens...
.wait:	ld a, [c]
	and $04
	cp 0
	jr z, .wait
	ei		; Now make sure that an IRQ didn't happen on EI/DI
	di
	ld a, [c]
	and $04
	cp 0
	jr z, .fail
	ld hl, .dicausefail
	ei		; Make sure that an IRQ does happen on EI/NOP/DI
	nop
	nop
	di
	ld a, [c]
	and $04
	cp 0
	jr nz, .fail
	ei
	
	ld hl, .ok
	call puts
	ret
.fail:
	ei
	call puts
	ld hl, .testfailed
	call puts
	ret
.insnteststr:
	db "Testing instructions... ",0
.pushpopfail:
	db "PUSH/POP",0
.ff:
	db $FF
.xorhlfail:
	db "XOR [HL]",0
.jphlfail:
	db "JP [HL]",0
.jrfail:
	db "JR",0
.cpfail:
	db "CP",0
.cplfail:
	db "CPL",0
.inc16fail:
	db "INC16",0
.dinocausefail:
	db "DI/EI does not cause interrupt",0
.dicausefail:
	db "DI/NOP/EI cause interrupt",0
.testfailed:
	db " test failed.",$0D,$0A,0
.ok:
	db "OK!",$0D,$0A,0

; Serial port manipulation functions.
putc:
	ld c, $50
	push af
.waitport:
	ld a,[c]
	cp $00
	jr nz,.waitport
	pop af
	ld [c],a
	ret

puts:
	ld a, [hli]
	cp $00
	ret z
	call putc
	jr puts
Commit	Line	Data
fe3dc890 JW	1	section "end",HOME[1024]
	2	nop
	3
00573fd5 JW	4	SECTION "a",HOME[$00]
	5
	6	start: jp main
	7
	8	section "vbl",HOME[$40]
	9	jp vbl
	10
	11	section "lcdc",HOME[$48]
	12	jp lcdc
	13
	14	section "tmro",HOME[$50]
	15	jp tmro
5bac4cf0 JW	16
5bac4cf0 JW	17	main:
5bac4cf0	18	ld a, $FF
fe3dc890 JW	19	ld c, $51
fe3dc890 JW	20	ld [c], a
00573fd5	21
5bac4cf0 JW	22	ld sp, $DFF0
5bac4cf0 JW	23
30ef1ae0	24	ld a, $04 ;start timer, 4.096KHz
00573fd5 JW	25	ld c, $07
00573fd5 JW	26	ld [c], a
03202f62	27
30ef1ae0 JW	28	ld hl, $DF81
30ef1ae0 JW	29	xor a
7e4f4505 JW	30	ld [hli], a
7e4f4505 JW	31	ld [hli], a
30ef1ae0	32
5bac4cf0 JW	33	ld hl, signon
5bac4cf0 JW	34	call puts
39a68cde JW	35
39a68cde JW	36	call putscreen
30ef1ae0 JW	37
30ef1ae0 JW	38	ei
5bac4cf0 JW	39
	40	call memtest
	41
	42	call insntest
	43
	44	call waitsw
30ef1ae0 JW	45
30ef1ae0 JW	46	di
5bac4cf0 JW	47
	48	jr main
	49
	50	signon:
	51	db $0D,$0A,$1B,"[1mFPGABoy Diagnostic ROM",$1B,"[0m",$0D,$0A,0
	52
39a68cde	53	putscreen:
4d90f272 JW	54	; Wait for vblank
	55	;.stat: ld a, [$FF41] ; STAT
	56	; and $03 ; mode
	57	; cp $01 ; VBLANK
	58	;' jp nz, .stat
	59
	60	ld hl, $8000 ; Copy two tiles.
	61	ld a, $AA
	62	ld [hli], a
	63	ld [hli], a
	64	ld a, $55
	65	ld [hli], a
	66	ld [hli], a
	67	ld a, $AA
	68	ld [hli], a
	69	ld [hli], a
	70	ld a, $55
	71	ld [hli], a
	72	ld [hli], a
	73	ld a, $AA
	74	ld [hli], a
	75	ld [hli], a
	76	ld a, $55
	77	ld [hli], a
	78	ld [hli], a
	79	ld a, $AA
	80	ld [hli], a
	81	ld [hli], a
	82	ld a, $55
39a68cde JW	83	ld [hli], a
	84	ld [hli], a
	85	xor a
	86	ld [hli], a
	87	ld [hli], a
4d90f272 JW	88	ld [hli], a
	89	ld [hli], a
	90	ld [hli], a
	91	ld [hli], a
	92	ld [hli], a
	93	ld [hli], a
	94	ld [hli], a
	95	ld [hli], a
	96	ld [hli], a
	97	ld [hli], a
	98	ld [hli], a
	99	ld [hli], a
	100	ld [hli], a
	101	ld [hli], a
39a68cde JW	102
39a68cde JW	103	ld hl, $9800
4d90f272	104	.loop: ld a, $01
39a68cde JW	105	ld [hli], a
	106	xor a
	107	ld [hli], a
	108	ld a, h
	109	cp $9C
	110	jp nz,.loop
	111	ret
	112
00573fd5	113	vbl:
03202f62 JW	114	PUSH AF
	115	PUSH BC
	116	PUSH DE
	117	PUSH HL
	118
	119	xor a
f6fa1d6e JW	120	ld [$FF0F], a
f6fa1d6e JW	121
03202f62 JW	122	ld c, $42 ; SCY
	123	ld a, [c]
	124	inc a
	125	ld [c], a
4d90f272 JW	126
	127	ld c, $43 ; SCX
	128	ld a, [c]
	129	inc a
	130	ld [c], a
03202f62 JW	131
	132	POP HL
	133	POP DE
	134	POP BC
	135	POP AF
	136
	137	RETI
	138
00573fd5 JW	139	lcdc:
00573fd5 JW	140	PUSH AF
fe3dc890	141	PUSH BC
00573fd5 JW	142
00573fd5 JW	143	xor a
f6fa1d6e	144	ld [$FF0F], a
00573fd5	145
fe3dc890	146	POP BC
00573fd5 JW	147	POP AF
	148
	149	reti
	150
	151	tmro:
30ef1ae0 JW	152	PUSH AF
	153	PUSH BC
	154	PUSH DE
	155	PUSH HL
	156
	157	xor a
f6fa1d6e	158	ld [$FF0F], a
30ef1ae0	159
03202f62 JW	160	ld c, $45 ; LYC
	161	ld a, [c]
	162	inc a
	163	ld [c], a
	164
f6fa1d6e	165	ld a, [$DF82]
7e4f4505 JW	166	cp 0
7e4f4505 JW	167	jr z, .noprint
30ef1ae0 JW	168	ld a, $41 ; print A
30ef1ae0 JW	169	call putc
7e4f4505	170	.noprint:
f6fa1d6e JW	171	ld a, [$DF81]
	172	inc a
	173	ld [$DF81], a
	174	ld [$FF51], a
30ef1ae0	175
30ef1ae0 JW	176	POP HL
	177	POP DE
	178	POP BC
	179	POP AF
	180	RETI
30ef1ae0	181
5bac4cf0 JW	182	; Memory tester: writes h ^ l to all addresses from C000 to DF80.
	183	memtest:
	184	ld hl,memteststr
	185	call puts
	186
f6fa1d6e	187	ld hl, $C000 ; Write loop
5bac4cf0 JW	188	.wr:
	189	ld a,h
	190	xor l
	191	ld [hli],a
f888201b JW	192	ld a, h
f888201b JW	193	cp $DF
5bac4cf0	194	jr nz, .wr
f888201b JW	195	ld a, l
f888201b JW	196	cp $80
5bac4cf0 JW	197	jr nz, .wr
5bac4cf0 JW	198
f6fa1d6e	199	ld hl, $C000 ; Read loop
5bac4cf0 JW	200	.rd:
	201	ld a,h
	202	xor l
	203	ld b,a
	204	ld a, [hli]
	205	cp b
	206	jr nz, .memfail
	207
f888201b JW	208	ld a, h
f888201b JW	209	cp $DF
5bac4cf0	210	jr nz, .rd
f888201b JW	211	ld a, l
f888201b JW	212	cp $80
5bac4cf0 JW	213	jr nz, .rd
	214
	215	ld hl, testokstr ; Say we're OK
	216	call puts
	217	ret
	218	.memfail: ; Say we failed (sadface)
	219	; decrement hl the easy way
f6fa1d6e	220	dec [hl]
5bac4cf0 JW	221	push hl
	222	ld hl, failatstr
	223	call puts
	224	pop hl
	225	ld a, h
	226	call puthex
	227	ld a, l
	228	call puthex
	229	ld a, $0A
	230	call putc
	231	ld a, $0D
	232	call putc
	233	ret
	234	memteststr:
	235	db "Testing memory from $C000 to $DF80...",0
	236	testokstr:
	237	db " OK!",$0D,$0A,0
	238	failatstr:
	239	db " Test failed at $",0
	240
	241	puthex: ; Put two hex nibbles to the serial console.
	242	push af
	243	rra
	244	rra
	245	rra
	246	rra
f888201b JW	247	and $0F
f888201b JW	248	add $30
5bac4cf0 JW	249	call putc
5bac4cf0 JW	250	pop af
f888201b JW	251	and $0F
f888201b JW	252	add $30
5bac4cf0 JW	253	call putc
	254	ret
	255
	256	; Wait for switches to be flipped on and off again.
	257	waitsw:
	258	ld hl,waitswstr
	259	call puts
7e4f4505 JW	260
	261	ld hl,$DF82
	262	ld a, 1
	263	ld [hl], a
5bac4cf0 JW	264
	265	ld c, $51
	266	xor a
	267	ld [c],a
	268
5bac4cf0 JW	269	.loop1:
5bac4cf0 JW	270	ld a,[c]
f888201b	271	cp $0
5bac4cf0 JW	272	jr z,.loop1
	273	.loop2:
	274	ld a,[c]
f888201b	275	cp $0
5bac4cf0 JW	276	jr nz,.loop2
	277	ret
	278
	279	waitswstr:
	280	db "Diagnostic ROM complete; flip switches to nonzero and then to zero to reset. Expect A.",$0D,$0A,0
	281
	282	; Core instruction basic acceptance tests.
	283	insntest:
	284	ld hl, .insnteststr
	285	call puts
	286
	287	; Test PUSH and POP.
	288	ld b, $12
	289	ld c, $34
	290	ld d, $56
	291	ld e, $78
	292	push bc
	293	pop de
	294	ld hl, .pushpopfail
	295	ld a, d
	296	cp b
	297	jr nz,.fail
	298	ld a, e
	299	cp c
	300	jr nz,.fail
	301
	302	; Test ALU (HL).
	303	ld hl, .ff
	304	ld a, $FF
	305	xor [hl]
	306	ld hl, .xorhlfail
	307	jr nz, .fail
	308
	309	; Test JP (HL)
	310	ld hl, .jphl
	311	jp [hl]
	312	ld hl, .jphlfail
	313	jr .fail
	314	rst $00
	315	.jphl:
	316
	317	; Test JR
	318	ld a, $FF
f888201b	319	cp $0
5bac4cf0 JW	320	jr nz,.jr
	321	ld hl, .jrfail
	322	jr .fail
	323	rst $00
	324	.jr:
	325
	326	; Test inc16
	327	ld d, $12
	328	ld e, $FF
	329	ld hl, .inc16fail
	330	inc de
	331	ld a, $13
	332	cp d
	333	jr nz, .fail
	334	ld a, $00
	335	cp e
	336	jr nz, .fail
	337
	338	; Test CP.
	339	ld hl, .cpfail
	340	ld a, $10
f888201b	341	cp $20
5bac4cf0 JW	342	jr nc,.fail
5bac4cf0 JW	343	ld a, $20
f888201b	344	cp $10
5bac4cf0 JW	345	jr c,.fail
	346
	347	; Test CPL
	348	ld hl, .cplfail
	349	ld a, $55
5bac4cf0	350	cpl
f888201b	351	cp $AA
5bac4cf0	352	jr nz,.fail
f9000d73 JW	353
	354	; Test DI/EI delay
	355	di
00573fd5	356	ld hl, .dinocausefail
f9000d73 JW	357	ld c, $0F ; First, wait until an interrupt happens...
f9000d73 JW	358	.wait: ld a, [c]
00573fd5	359	and $04
f9000d73 JW	360	cp 0
	361	jr z, .wait
	362	ei ; Now make sure that an IRQ didn't happen on EI/DI
	363	di
	364	ld a, [c]
00573fd5	365	and $04
f9000d73 JW	366	cp 0
f9000d73 JW	367	jr z, .fail
00573fd5	368	ld hl, .dicausefail
f9000d73 JW	369	ei ; Make sure that an IRQ does happen on EI/NOP/DI
f9000d73 JW	370	nop
00573fd5	371	nop
f9000d73 JW	372	di
f9000d73 JW	373	ld a, [c]
00573fd5	374	and $04
f9000d73 JW	375	cp 0
	376	jr nz, .fail
	377	ei
5bac4cf0 JW	378
	379	ld hl, .ok
	380	call puts
	381	ret
	382	.fail:
f9000d73	383	ei
5bac4cf0 JW	384	call puts
	385	ld hl, .testfailed
	386	call puts
	387	ret
	388	.insnteststr:
	389	db "Testing instructions... ",0
	390	.pushpopfail:
	391	db "PUSH/POP",0
	392	.ff:
	393	db $FF
	394	.xorhlfail:
	395	db "XOR [HL]",0
	396	.jphlfail:
	397	db "JP [HL]",0
	398	.jrfail:
	399	db "JR",0
	400	.cpfail:
	401	db "CP",0
	402	.cplfail:
	403	db "CPL",0
	404	.inc16fail:
	405	db "INC16",0
00573fd5 JW	406	.dinocausefail:
	407	db "DI/EI does not cause interrupt",0
	408	.dicausefail:
	409	db "DI/NOP/EI cause interrupt",0
5bac4cf0 JW	410	.testfailed:
	411	db " test failed.",$0D,$0A,0
	412	.ok:
	413	db "OK!",$0D,$0A,0
	414
	415	; Serial port manipulation functions.
	416	putc:
5bac4cf0 JW	417	ld c, $50
	418	push af
	419	.waitport:
	420	ld a,[c]
f888201b	421	cp $00
5bac4cf0 JW	422	jr nz,.waitport
	423	pop af
	424	ld [c],a
	425	ret
	426
	427	puts:
	428	ld a, [hli]
f888201b	429	cp $00
5bac4cf0 JW	430	ret z
	431	call putc
	432	jr puts
fe3dc890	433