[fpgaboy.git] / flashprog.asm

	SECTION "wee",HOME[$0]
	ld hl, $D000
	ld sp, hl
	
	xor a
	ld [$FF60], a
	ld [$FF61], a
	ld [$FF62], a
	
	ld a, $50	; Clear SR
	ld [$FF65], a
	
	call unlock+$D800
	xor a
	ld d, a
	ld e, a
	call erase+$D800
	
	xor a
	ld d, a
	ld e, a
	
loop:	ld a, $04
	cp d
	jr z,done
	
	xor a
	ld c, a			; Count

ifl:	call program+$D800
	xor a
	cp c
	jr nz, ifl
ifldone:

	ld a, $70
	ld [$FF65], a
	ld a, [$FF65]		; Load from the status register
	call puthex+$D800
		
;	ld a, $2E	;.
;	call putc+$D800
	
	inc de
	jr loop
done:	
	rst $00

putc:
	push af
.wport:
	ld a,[$FF53]
	and $01
	jr nz,.wport
	pop af
	ld [$FF52],a
	ret

puthex:
	push hl
	ld hl, hexdig+$D800
	push hl
	push af
	swap a
	and $0F
	add l
	ld l, a
	ld a, [hl]
	call putc+$D800
	pop af
	and $0F
	pop hl
	add l
	ld l, a
	ld a, [hl]
	pop hl
	jr putc

hexdig:
	db "0123456789ABCDEF"
	
unlock:
	ld a, $55
	call putc+$D800
	ld a, $60	; Unlock the device
	ld [$FF65], a
	ld a, $D0
	ld [$FF65], a
	call waitrdy+$D800
	ld a, [$FF65]
	call puthex+$D800
	ret

erase:
	ld a, $45
	call putc+$D800
	ld a, d
	ld [$FF60], a
	ld a, e
	ld [$FF61], a
	xor a
	ld [$FF62], a
	ld a, $20	; Unlock the device
	ld [$FF65], a
	ld a, $D0
	ld [$FF65], a
	call waitrdy+$D800
	ld a, [$FF65]
	call puthex+$D800
	ret

; need to save d, e, and c
program:
	ld a, d
	ld [$FF60], a
	ld a, e
	ld [$FF61], a
	ld a, c
	ld [$FF62], a
	ld a, $40
	ld [$FF65], a
	ld a, d
	ld [$FF60], a
	ld a, e
	ld [$FF61], a
	ld a, c
	ld [$FF62], a
	ld a, [$FF63]
	ld b, a
	ld a, d
	ld [$FF60], a
	ld a, e
	ld [$FF61], a
	ld a, c
	ld [$FF62], a
	ld a, b
	ld [$FF65], a
	call waitrdy+$D800
	inc c
	ret

waitrdy:
	ld a, $70	; Wait status register.
	ld [$FF65], a
.wrl:	ld a, [$FF65]	; Wait for bit 7 to come back on again.
	bit 7,a
	jr z, .wrl
	ret

	section "a", HOME[$FF]
	nop
Commit	Line	Data
efc8cc5d JW	1	SECTION "wee",HOME[$0]
	2	ld hl, $D000
	3	ld sp, hl
	4
	5	xor a
	6	ld [$FF60], a
	7	ld [$FF61], a
	8	ld [$FF62], a
	9
	10	ld a, $50 ; Clear SR
	11	ld [$FF65], a
	12
	13	call unlock+$D800
	14	xor a
	15	ld d, a
	16	ld e, a
	17	call erase+$D800
	18
	19	xor a
	20	ld d, a
	21	ld e, a
	22
	23	loop: ld a, $04
	24	cp d
	25	jr z,done
	26
	27	xor a
	28	ld c, a ; Count
	29
	30	ifl: call program+$D800
	31	xor a
	32	cp c
	33	jr nz, ifl
	34	ifldone:
	35
	36	ld a, $70
	37	ld [$FF65], a
	38	ld a, [$FF65] ; Load from the status register
	39	call puthex+$D800
	40
	41	; ld a, $2E ;.
	42	; call putc+$D800
	43
	44	inc de
	45	jr loop
	46	done:
	47	rst $00
	48
	49	putc:
	50	push af
	51	.wport:
	52	ld a,[$FF53]
	53	and $01
	54	jr nz,.wport
	55	pop af
	56	ld [$FF52],a
	57	ret
	58
	59	puthex:
	60	push hl
	61	ld hl, hexdig+$D800
	62	push hl
	63	push af
	64	swap a
65	and $0F
66	add l
67	ld l, a
68	ld a, [hl]
69	call putc+$D800
70	pop af
71	and $0F
72	pop hl
73	add l
74	ld l, a
75	ld a, [hl]
76	pop hl
77	jr putc
78
79	hexdig:
80	db "0123456789ABCDEF"
81
82	unlock:
83	ld a, $55
84	call putc+$D800
85	ld a, $60 ; Unlock the device
86	ld [$FF65], a
87	ld a, $D0
88	ld [$FF65], a
89	call waitrdy+$D800
90	ld a, [$FF65]
91	call puthex+$D800
92	ret
93
94	erase:
95	ld a, $45
96	call putc+$D800
97	ld a, d
98	ld [$FF60], a
99	ld a, e
100	ld [$FF61], a
101	xor a
102	ld [$FF62], a
103	ld a, $20 ; Unlock the device
104	ld [$FF65], a
105	ld a, $D0
106	ld [$FF65], a
107	call waitrdy+$D800
108	ld a, [$FF65]
109	call puthex+$D800
110	ret
111
112	; need to save d, e, and c
113	program:
114	ld a, d
115	ld [$FF60], a
116	ld a, e
117	ld [$FF61], a
118	ld a, c
119	ld [$FF62], a
120	ld a, $40
121	ld [$FF65], a
122	ld a, d
123	ld [$FF60], a
124	ld a, e
125	ld [$FF61], a
126	ld a, c
127	ld [$FF62], a
128	ld a, [$FF63]
129	ld b, a
130	ld a, d
131	ld [$FF60], a
132	ld a, e
133	ld [$FF61], a
134	ld a, c
135	ld [$FF62], a
136	ld a, b
137	ld [$FF65], a
138	call waitrdy+$D800
139	inc c
140	ret
141
142	waitrdy:
143	ld a, $70 ; Wait status register.
144	ld [$FF65], a
145	.wrl: ld a, [$FF65] ; Wait for bit 7 to come back on again.
146	bit 7,a
147	jr z, .wrl
148	ret
149
150	section "a", HOME[$FF]
151	nop