X-Git-Url: http://cloudbase.mooo.com/gitweb/avrcpm.git/blobdiff_plain/de15c768141e7d7c3f34e6a4260d1c7a55cece4f..bb5256eea0dbc764f2f447362e37d62ec060a5dc:/cpm/BIOS.MAC

diff --git a/cpm/BIOS.MAC b/cpm/BIOS.MAC
index a260ec8..813e813 100644
--- a/cpm/BIOS.MAC
+++ b/cpm/BIOS.MAC
@@ -436,26 +436,34 @@ clock:
 	inc	c
 	ret	nz
 
-clk_read:
-	ex	de,hl
-	ld	bc,5*256 + CLOCKPORT-1
-clkg_l:
-	inc	c
-	ini
-	jr	nz,clkg_l
+clk_get:
+	ld	hl,5
+	add	hl,de
+	push	hl
+	ld	bc,6*256 + CLOCKPORT-1
 	ld	e,(hl)
-	in	a,(CLOCKPORT+5)
-	ld	(hl),a
+clk_gl:
+	inc	c
+	ind
+	jr	nz,clk_gl
+	pop	hl
 	jr	clk_e
 
+
 clk_set:
-	ld	hl,5
-	add	hl,de
+	ld	a,(hl)
+	cp	78h
+	ld	a,19h
+	jr	nc,clk_s1
+	ld	a,20h
+clk_s1:
+	out	(CLOCKPORT+6),a
 	ld	bc,6*256 + CLOCKPORT+6
-clks_l:
+clk_sl:
 	dec	c
-	outd
-	jr	nz,clks_l
+	outi
+	jr	nz,clk_sl
+	dec	hl
 clk_e:
 	ld	a,1
 	ret