[avrcpm.git] / cpm / BIOS.MAC

;    CP/M BIOS for avrcpm\r
;    Copyright (C) 2010 Sprite_tm\r
;\r
;    This program is free software: you can redistribute it and/or modify\r
;    it under the terms of the GNU General Public License as published by\r
;    the Free Software Foundation, either version 3 of the License, or\r
;    (at your option) any later version.\r
;\r
;    This program is distributed in the hope that it will be useful,\r
;    but WITHOUT ANY WARRANTY; without even the implied warranty of\r
;    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the\r
;    GNU General Public License for more details.\r
;\r
;    You should have received a copy of the GNU General Public License\r
;    along with this program.  If not, see <http://www.gnu.org/licenses/>.\r
;\r
;    $Id: bios.asm 71 2010-08-06 19:38:10Z leo $\r
;\r
\r
	maclib	CFGACPM.LIB\r
\r
cr	equ	0dh\r
lf	equ	0ah\r
\r
	aseg\r
	org	100h\r
	.phase	bios\r
	.z80\r
\r
nsects	equ	($-ccp)/128	;warm start sector count\r
	\r
	jp	boot\r
wboote:	\r
	jp	wboot\r
	jp	const\r
	jp	conin\r
	jp	conout\r
	jp	list\r
	jp	punch\r
	jp	reader\r
	jp	home\r
	jp	seldsk\r
	jp	settrk\r
	jp	setsec\r
	jp	setdma\r
	jp	read\r
	jp	write\r
	jp	listst\r
	jp	sectran\r
	jp	0		;zsdos (?)\r
	jp	0		;zsdos (?)\r
	jp	0		;zsdos (?)\r
	jp	clock		;zsdos compatible clock set/get\r
\r
\r
	.8080\r
	maclib AVRCPM.LIB\r
	\r
	;Drive	 A    B    C    D    E F G H I    J    K    L\r
;drvtbl:dtbl	<dpha,dphb,dphc,dphd, , , , ,dphi,dphj,dphk,dphl>\r
;drvtbl:dtbl	<dpha,    ,    ,    , , , , ,dphi,dphj,dphk,dphl>\r
;drvtbl: dtbl	<    ,    ,    ,    , , , , ,dphi,dphj,dphk,dphl>\r
drvtbl:dtbl	<    ,    ,    ,    , , , , ,dphi>\r
\r
	;	Name   spt   bls  dks  dir  cks off\r
;	dpb	dpb243, 26, 1024, 243,  64,  64,  2\r
;	dpb	dp8192s,32, 4096,2046, 512, 512,  2\r
;	dpb	dp8192, 32, 4096,2046,1024,1024,  2\r
;	dpb	dpbrd,  32, 1024,  56,  32,   0,  2\r
	dpb	rd192,  32, 1024, 192,  32,   0,  0\r
;	dpb	rd1016, 32, 2048, 508, 192,   0,  2\r
;	dpb	rd1024, 32, 2048, 512, 192,   0,  0\r
;	dpb	rd0960, 32, 2048, 480, 192,   0,  0\r
\r
;dpha:	dph	dpb243\r
;dphb:	dph	dpb243\r
;dphc:	dph	dpb243\r
;dphd:	dph	dpb243\r
;dpha:	dph	dp8192s\r
;dphb:	dph	dp8192s\r
;dphc:	dph	dp8192\r
;dphd:	dph	dp8192\r
;dphi:	dph	rd1016\r
dphi:	dph	rd192\r
;dphj:	dph	rd1024\r
;dphk:	dph	rd1024\r
;dphl:	dph	rd0960\r
\r
	.z80\r
	\r
signon:\r
	db	cr,lf\r
	db	msize/10+'0'\r
	db	msize - (msize/10)*10 + '0'	;modulo doesn't work?\r
	db	"k cp/m vers 2.2"\r
msgnl:	db	cr,lf,0\r
\r
msgnodisk:\r
	db	"No disk!"\r
	db	cr,lf,0\r
\r
const:\r
	in	a,(UARTCSR)\r
	and	UARTRXRDY\r
	ret	z\r
	or	0ffh\r
	ret\r
\r
conin:\r
	in	a,(UARTCSR)\r
	rra\r
	jp	nc,conin\r
\r
	in	a,(UARTDR)\r
	ret\r
\r
conout:\r
	ld	a,c\r
	out	(UARTDR),a\r
	ret\r
\r
list:\r
	ret\r
\r
listst:\r
	ld	a,0\r
	ret\r
\r
punch:\r
	ret\r
\r
reader:\r
	ld	a,01Fh\r
	ret\r
\r
prmsg:\r
	ld	a,(hl)\r
	or	a\r
	ret	z\r
	push	hl\r
	ld	c,a\r
	call	conout\r
	pop	hl\r
	inc	hl\r
	jp	prmsg\r
	\r
prhex:\r
	ld	a,c\r
	push	af\r
	rra	\r
	rra	\r
	rra	\r
	rra	\r
	call	prhexdigit\r
	pop	af\r
	;	fall thru\r
\r
prhexdigit:\r
	and	00fh\r
	cp	10\r
	jp	c,prd1\r
	add	a,7\r
prd1:\r
	add	a,'0'\r
	ld	c,a\r
	jp	conout\r
\r
boot:\r
	ld	sp,buff\r
	ld	hl,signon\r
	call	prmsg\r
	\r
	ld	a,low bcb\r
	out	(13),a\r
	ld	a, high bcb\r
	out	(14),a\r
\r
	xor	a\r
	ld	(bootdsk),a\r
	ld	e,a\r
	ld	c,a\r
	call	seldsk\r
	jp	nz,boot0\r
	ld	hl,msgnodisk\r
	call	prmsg\r
	halt\r
boot0:\r
	call	getdpb\r
	ld	a,(de)			;dpb[0] is sectors_per_track\r
	ld	(bootspt),a\r
	ld	e,0\r
	ld	c,'I'-'A'\r
	call	seldsk\r
	jp	z,boot1		;no ram disk\r
\r
	call	getdpb		;de = dpb of first ram disk\r
	\r
; Check, if we have reserved tracks.\r
\r
	ld	hl,13\r
	add	hl,de\r
	\r
	ld	a,(hl)		;# of reserved tracks \r
	inc	hl\r
	or	(hl)\r
	jp	z,boot1		;Skip if not.\r
\r
; Save CPM to ram disk.\r
\r
	ld	a,(de)		;sectors per track\r
	ld	(bootspt),a\r
	ld	a,'I'-'A'\r
	ld	(bootdsk),a\r
	call	home\r
	ld	b,nsects\r
	ld	c,0		;track\r
	ld	d,1		;sektor (0 based, skip ipl)\r
	ld	hl,ccp\r
store1:\r
	push	bc\r
	push	de\r
	push	hl\r
	ld	c,d\r
	ld	b,0\r
	call	setsec\r
	pop	bc		;dma\r
	push	bc\r
	call	setdma\r
	ld	c,0\r
	call	write\r
	\r
	pop	hl		;dma\r
	ld	de,128\r
	add	hl,de\r
	pop	de		;d = sec\r
	pop	bc		;b = # of secs, c = track\r
	dec	b\r
	jp	z,boot1\r
	\r
	inc	d\r
	ld	a,(bootspt)\r
	dec	a\r
	cp	d		;if sector >= spt then change tracks\r
	jp	nc,store1\r
	\r
	ld	d,0\r
	inc	c\r
	push	bc\r
	push	de\r
	push	hl\r
	ld	b,0\r
	call	settrk	\r
	pop	hl\r
	pop	de\r
	pop	bc\r
	jp	store1\r
\r
boot1:	\r
	xor	a\r
	ld	(iobyte),a\r
	ld	(cdisk),a\r
	jp	gocpm \r
\r
wboot:	;re-load CP/M\r
	ld	sp,buff\r
	ld	a,1 shl BOOT_FUNC	;init (de)blocking\r
	out	(22),a\r
	ld	a,(bootdsk)\r
	ld	c,a\r
	ld	e,0		;clear reselection flag\r
	call	seldsk\r
	call	home\r
	ld	b,nsects\r
	ld	c,0		;track\r
	ld	d,1		;sektor (0 based)\r
	ld	hl,ccp\r
load1:\r
	push	bc\r
	push	de\r
	push	hl\r
	ld	c,d\r
	ld	b,0\r
	call	setsec\r
	pop	bc\r
	push	bc\r
	call	setdma\r
	call	read\r
	cp	0		;read error?\r
	jp	nz,wboot\r
	\r
	pop	hl\r
	ld	de,128\r
	add	hl,de\r
	pop	de\r
	pop	bc\r
	dec	b\r
	jp	z,gocpm\r
	\r
	inc	d\r
	ld	a,(bootspt)\r
	dec	a\r
	cp	d		;if sector >= spt then change tracks\r
	jp	nc,load1\r
	\r
	ld	d,0\r
	inc	c\r
	push	bc\r
	push	de\r
	push	hl\r
	ld	b,0\r
	call	settrk	\r
	pop	hl\r
	pop	de\r
	pop	bc\r
	jp	load1\r
	\r
gocpm:\r
	ld	a,0c3h\r
	ld	(0),a\r
	ld	hl,wboote\r
	ld	(1),hl\r
	ld	(5),a\r
	ld	hl,bdos\r
	ld	(6),hl\r
		\r
	ld	bc,buff\r
	call	setdma\r
	ld	a,(cdisk)\r
	ld	c,a\r
	jp	ccp\r
	\r
msgSel:	db	13,10,"Sel: ",0\r
\r
getdpb:\r
	ld	de,10\r
	add	hl,de\r
	ld	e,(hl)\r
	inc	hl\r
	ld	d,(hl)		;de = dpb\r
	ret\r
	\r
seldsk:\r
	ld	a,c\r
	out	(15),a\r
\r
	ld	a,e		;reselection bit\r
	rrca\r
	jp	c,getdph	;skip, if disk already active\r
	ld	hl,0\r
	in	a,(15)		;querry, if disk exists\r
	or	a\r
	ret	z\r
getdph:\r
	ld	hl,drvtbl\r
	ld	b,0\r
	add	hl,bc\r
	add	hl,bc\r
	ld	a,(hl)		;get table entry for selected disk\r
	inc	hl\r
	ld	h,(hl)\r
	ld	l,a		\r
	or	h		;return zero, if no entry (no disk)\r
	ret\r
	\r
\r
home:\r
	ld	a,1 shl HOME_FUNC\r
	out	(22),a\r
	\r
	ld	bc,0		; same as seek to track 0\r
settrk:\r
	ld	a,c\r
	out	(16),a\r
	ld	a,b\r
	out	(17),a\r
	ret\r
\r
setsec:\r
	ld	a,c\r
	out	(18),a\r
	ret\r
\r
setdma:\r
	ld	a,c\r
	out	(20),a\r
	ld	a,b\r
	out	(21),a\r
	ret\r
\r
read:\r
	ld	a,1 shl READ_FUNC\r
	out	(22),a\r
	in	a,(22)\r
	and	1\r
	ret\r
\r
write:\r
	ld	a,c\r
	and	3		;mask write type\r
	or	1 shl WRITE_FUNC\r
	out	(22),a\r
	in	a,(22)\r
	and	1\r
	ret\r
\r
sectran:\r
	;translate sector bc using table at de, res into hl\r
	ld	h,b\r
	ld	l,c\r
	ld	a,d\r
	or	e\r
	ret	z\r
	ex	de,hl\r
	add	hl,bc\r
	ld	l,(hl)\r
	ld	h,0\r
	ret\r
\r
;------------------------------------------------------------------------\r
; ZSDOS clock drivers may use registers BC and D without restoring  them, \r
; but must preserve the Z80's alternate and index registers.  \r
; Other registers must be used exactly as follows:\r
;\r
;   Enter:     C = 00H to Read the Clock, 01H to Set the Clock\r
;             DE = Address of a 6-byte field to Receive or from which \r
;                  to Set time in DateStamper format (BCD digits as: \r
;                  YY MM DD HH MM SS).  24-hour operation is assumed.\r
;\r
;   Exit :     A = 01H for a successful operation,\r
;                  0FFH for a failure of any sort (Can't set, etc.)\r
;\r
;            When Reading the Clock:\r
;              E = Original contents of Entry value of DE plus 5\r
;             HL = Entry value of DE plus 5 (Seconds field)\r
\r
clock:\r
	dec	c\r
	jr	z,clk_set\r
	inc	c\r
	ret	nz\r
\r
clk_get:\r
	ld	hl,5\r
	add	hl,de\r
	push	hl\r
	ld	bc,6*256 + CLOCKPORT-1\r
	ld	e,(hl)\r
clk_gl:\r
	inc	c\r
	ind\r
	jr	nz,clk_gl\r
	pop	hl\r
	jr	clk_e\r
\r
\r
clk_set:\r
	ld	a,(hl)\r
	cp	78h\r
	ld	a,19h\r
	jr	nc,clk_s1\r
	ld	a,20h\r
clk_s1:\r
	out	(CLOCKPORT+6),a\r
	ld	bc,6*256 + CLOCKPORT+6\r
clk_sl:\r
	dec	c\r
	outi\r
	jr	nz,clk_sl\r
	dec	hl\r
clk_e:\r
	ld	a,1\r
	ret\r
\r
;------------------------------------------------------------------------\r
\r
bcb:	dw	drvtbl\r
	dw	dirbuf\r
	dw	enddat\r
	\r
bootdsk:ds	1\r
bootspt:ds	1\r
\r
	.8080\r
	endef\r
	\r
	end\r
\r
Commit	Line	Data
072e0f3b L	1	; CP/M BIOS for avrcpm\r
	2	; Copyright (C) 2010 Sprite_tm\r
	3	;\r
	4	; This program is free software: you can redistribute it and/or modify\r
	5	; it under the terms of the GNU General Public License as published by\r
	6	; the Free Software Foundation, either version 3 of the License, or\r
	7	; (at your option) any later version.\r
	8	;\r
	9	; This program is distributed in the hope that it will be useful,\r
	10	; but WITHOUT ANY WARRANTY; without even the implied warranty of\r
	11	; MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the\r
	12	; GNU General Public License for more details.\r
	13	;\r
	14	; You should have received a copy of the GNU General Public License\r
	15	; along with this program. If not, see <http://www.gnu.org/licenses/>.\r
	16	;\r
	17	; $Id: bios.asm 71 2010-08-06 19:38:10Z leo $\r
	18	;\r
	19	\r
2396f399	20	maclib CFGACPM.LIB\r
072e0f3b	21	\r
d8fa6a36 L	22	cr equ 0dh\r
	23	lf equ 0ah\r
	24	\r
072e0f3b L	25	aseg\r
	26	org 100h\r
	27	.phase bios\r
	28	.z80\r
	29	\r
d8fa6a36	30	nsects equ ($-ccp)/128 ;warm start sector count\r
072e0f3b	31	\r
d8fa6a36	32	jp boot\r
072e0f3b	33	wboote: \r
d8fa6a36 L	34	jp wboot\r
	35	jp const\r
	36	jp conin\r
	37	jp conout\r
	38	jp list\r
	39	jp punch\r
	40	jp reader\r
	41	jp home\r
	42	jp seldsk\r
	43	jp settrk\r
	44	jp setsec\r
	45	jp setdma\r
	46	jp read\r
	47	jp write\r
	48	jp listst\r
	49	jp sectran\r
	50	jp 0 ;zsdos (?)\r
	51	jp 0 ;zsdos (?)\r
	52	jp 0 ;zsdos (?)\r
	53	jp clock ;zsdos compatible clock set/get\r
	54	\r
072e0f3b L	55	\r
	56	.8080\r
	57	maclib AVRCPM.LIB\r
	58	\r
	59	;Drive A B C D E F G H I J K L\r
abeec861 L	60	;drvtbl:dtbl <dpha,dphb,dphc,dphd, , , , ,dphi,dphj,dphk,dphl>\r
abeec861 L	61	;drvtbl:dtbl <dpha, , , , , , , ,dphi,dphj,dphk,dphl>\r
fb050095 L	62	;drvtbl: dtbl < , , , , , , , ,dphi,dphj,dphk,dphl>\r
fb050095 L	63	drvtbl:dtbl < , , , , , , , ,dphi>\r
072e0f3b L	64	\r
072e0f3b L	65	; Name spt bls dks dir cks off\r
5482d75f L	66	; dpb dpb243, 26, 1024, 243, 64, 64, 2\r
	67	; dpb dp8192s,32, 4096,2046, 512, 512, 2\r
	68	; dpb dp8192, 32, 4096,2046,1024,1024, 2\r
072e0f3b	69	; dpb dpbrd, 32, 1024, 56, 32, 0, 2\r
abeec861	70	dpb rd192, 32, 1024, 192, 32, 0, 0\r
fb050095 L	71	; dpb rd1016, 32, 2048, 508, 192, 0, 2\r
	72	; dpb rd1024, 32, 2048, 512, 192, 0, 0\r
	73	; dpb rd0960, 32, 2048, 480, 192, 0, 0\r
072e0f3b	74	\r
5482d75f	75	;dpha: dph dpb243\r
072e0f3b L	76	;dphb: dph dpb243\r
	77	;dphc: dph dpb243\r
	78	;dphd: dph dpb243\r
2396f399 L	79	;dpha: dph dp8192s\r
	80	;dphb: dph dp8192s\r
	81	;dphc: dph dp8192\r
	82	;dphd: dph dp8192\r
abeec861 L	83	;dphi: dph rd1016\r
abeec861 L	84	dphi: dph rd192\r
fb050095 L	85	;dphj: dph rd1024\r
	86	;dphk: dph rd1024\r
	87	;dphl: dph rd0960\r
072e0f3b L	88	\r
	89	.z80\r
	90	\r
	91	signon:\r
	92	db cr,lf\r
	93	db msize/10+'0'\r
	94	db msize - (msize/10)*10 + '0' ;modulo doesn't work?\r
	95	db "k cp/m vers 2.2"\r
	96	msgnl: db cr,lf,0\r
	97	\r
2396f399 L	98	msgnodisk:\r
	99	db "No disk!"\r
	100	db cr,lf,0\r
	101	\r
072e0f3b	102	const:\r
e8384f88 L	103	in a,(UARTCSR)\r
	104	and UARTRXRDY\r
	105	ret z\r
	106	or 0ffh\r
072e0f3b L	107	ret\r
	108	\r
	109	conin:\r
e8384f88 L	110	in a,(UARTCSR)\r
	111	rra\r
	112	jp nc,conin\r
072e0f3b	113	\r
e8384f88	114	in a,(UARTDR)\r
072e0f3b L	115	ret\r
	116	\r
	117	conout:\r
d8fa6a36	118	ld a,c\r
e8384f88	119	out (UARTDR),a\r
072e0f3b L	120	ret\r
	121	\r
	122	list:\r
	123	ret\r
	124	\r
	125	listst:\r
d8fa6a36	126	ld a,0\r
072e0f3b L	127	ret\r
	128	\r
	129	punch:\r
	130	ret\r
	131	\r
	132	reader:\r
d8fa6a36	133	ld a,01Fh\r
072e0f3b L	134	ret\r
	135	\r
	136	prmsg:\r
	137	ld a,(hl)\r
	138	or a\r
	139	ret z\r
	140	push hl\r
	141	ld c,a\r
	142	call conout\r
	143	pop hl\r
	144	inc hl\r
	145	jp prmsg\r
	146	\r
	147	prhex:\r
	148	ld a,c\r
	149	push af\r
	150	rra \r
	151	rra \r
	152	rra \r
	153	rra \r
	154	call prhexdigit\r
	155	pop af\r
	156	; fall thru\r
	157	\r
	158	prhexdigit:\r
	159	and 00fh\r
	160	cp 10\r
	161	jp c,prd1\r
	162	add a,7\r
	163	prd1:\r
	164	add a,'0'\r
	165	ld c,a\r
	166	jp conout\r
	167	\r
072e0f3b L	168	boot:\r
	169	ld sp,buff\r
	170	ld hl,signon\r
	171	call prmsg\r
	172	\r
2396f399 L	173	ld a,low bcb\r
	174	out (13),a\r
	175	ld a, high bcb\r
	176	out (14),a\r
	177	\r
072e0f3b L	178	xor a\r
	179	ld (bootdsk),a\r
	180	ld e,a\r
2396f399 L	181	ld c,a\r
	182	call seldsk\r
	183	jp nz,boot0\r
	184	ld hl,msgnodisk\r
	185	call prmsg\r
	186	halt\r
	187	boot0:\r
	188	call getdpb\r
	189	ld a,(de) ;dpb[0] is sectors_per_track\r
072e0f3b	190	ld (bootspt),a\r
2396f399	191	ld e,0\r
072e0f3b L	192	ld c,'I'-'A'\r
072e0f3b L	193	call seldsk\r
92202636	194	jp z,boot1 ;no ram disk\r
072e0f3b	195	\r
2396f399	196	call getdpb ;de = dpb of first ram disk\r
072e0f3b L	197	\r
	198	; Check, if we have reserved tracks.\r
	199	\r
	200	ld hl,13\r
	201	add hl,de\r
	202	\r
	203	ld a,(hl) ;# of reserved tracks \r
	204	inc hl\r
	205	or (hl)\r
	206	jp z,boot1 ;Skip if not.\r
	207	\r
	208	; Save CPM to ram disk.\r
	209	\r
	210	ld a,(de) ;sectors per track\r
	211	ld (bootspt),a\r
	212	ld a,'I'-'A'\r
	213	ld (bootdsk),a\r
	214	call home\r
	215	ld b,nsects\r
	216	ld c,0 ;track\r
	217	ld d,1 ;sektor (0 based, skip ipl)\r
	218	ld hl,ccp\r
	219	store1:\r
	220	push bc\r
	221	push de\r
	222	push hl\r
	223	ld c,d\r
	224	ld b,0\r
	225	call setsec\r
	226	pop bc ;dma\r
	227	push bc\r
	228	call setdma\r
	229	ld c,0\r
	230	call write\r
	231	\r
	232	pop hl ;dma\r
	233	ld de,128\r
	234	add hl,de\r
	235	pop de ;d = sec\r
	236	pop bc ;b = # of secs, c = track\r
	237	dec b\r
	238	jp z,boot1\r
	239	\r
	240	inc d\r
	241	ld a,(bootspt)\r
	242	dec a\r
	243	cp d ;if sector >= spt then change tracks\r
	244	jp nc,store1\r
	245	\r
	246	ld d,0\r
	247	inc c\r
	248	push bc\r
	249	push de\r
	250	push hl\r
	251	ld b,0\r
	252	call settrk \r
	253	pop hl\r
	254	pop de\r
	255	pop bc\r
	256	jp store1\r
	257	\r
	258	boot1: \r
	259	xor a\r
	260	ld (iobyte),a\r
261	ld (cdisk),a\r
262	jp gocpm \r
263	\r
264	wboot: ;re-load CP/M\r
265	ld sp,buff\r
266	ld a,1 shl BOOT_FUNC ;init (de)blocking\r
267	out (22),a\r
268	ld a,(bootdsk)\r
269	ld c,a\r
4cde2182	270	ld e,0 ;clear reselection flag\r
072e0f3b L	271	call seldsk\r
	272	call home\r
	273	ld b,nsects\r
	274	ld c,0 ;track\r
	275	ld d,1 ;sektor (0 based)\r
	276	ld hl,ccp\r
	277	load1:\r
	278	push bc\r
	279	push de\r
	280	push hl\r
	281	ld c,d\r
	282	ld b,0\r
	283	call setsec\r
	284	pop bc\r
	285	push bc\r
	286	call setdma\r
	287	call read\r
	288	cp 0 ;read error?\r
	289	jp nz,wboot\r
	290	\r
	291	pop hl\r
	292	ld de,128\r
	293	add hl,de\r
	294	pop de\r
	295	pop bc\r
	296	dec b\r
	297	jp z,gocpm\r
	298	\r
	299	inc d\r
	300	ld a,(bootspt)\r
	301	dec a\r
	302	cp d ;if sector >= spt then change tracks\r
	303	jp nc,load1\r
	304	\r
	305	ld d,0\r
	306	inc c\r
	307	push bc\r
	308	push de\r
	309	push hl\r
	310	ld b,0\r
	311	call settrk \r
	312	pop hl\r
	313	pop de\r
	314	pop bc\r
	315	jp load1\r
	316	\r
	317	gocpm:\r
	318	ld a,0c3h\r
	319	ld (0),a\r
	320	ld hl,wboote\r
	321	ld (1),hl\r
	322	ld (5),a\r
	323	ld hl,bdos\r
	324	ld (6),hl\r
	325	\r
	326	ld bc,buff\r
	327	call setdma\r
	328	ld a,(cdisk)\r
	329	ld c,a\r
	330	jp ccp\r
	331	\r
	332	msgSel: db 13,10,"Sel: ",0\r
	333	\r
2396f399 L	334	getdpb:\r
	335	ld de,10\r
	336	add hl,de\r
	337	ld e,(hl)\r
	338	inc hl\r
	339	ld d,(hl) ;de = dpb\r
	340	ret\r
	341	\r
072e0f3b	342	seldsk:\r
2396f399 L	343	ld a,c\r
	344	out (15),a\r
	345	\r
	346	ld a,e ;reselection bit\r
	347	rrca\r
	348	jp c,getdph ;skip, if disk already active\r
2396f399	349	ld hl,0\r
92202636	350	in a,(15) ;querry, if disk exists\r
2396f399	351	or a\r
92202636	352	ret z\r
2396f399 L	353	getdph:\r
2396f399 L	354	ld hl,drvtbl\r
072e0f3b L	355	ld b,0\r
	356	add hl,bc\r
	357	add hl,bc\r
	358	ld a,(hl) ;get table entry for selected disk\r
	359	inc hl\r
	360	ld h,(hl)\r
	361	ld l,a \r
2396f399	362	or h ;return zero, if no entry (no disk)\r
072e0f3b	363	ret\r
2396f399	364	\r
072e0f3b L	365	\r
072e0f3b L	366	home:\r
e8384f88 L	367	ld a,1 shl HOME_FUNC\r
e8384f88 L	368	out (22),a\r
072e0f3b	369	\r
e8384f88	370	ld bc,0 ; same as seek to track 0\r
072e0f3b	371	settrk:\r
e8384f88 L	372	ld a,c\r
	373	out (16),a\r
	374	ld a,b\r
	375	out (17),a\r
072e0f3b L	376	ret\r
	377	\r
	378	setsec:\r
e8384f88 L	379	ld a,c\r
e8384f88 L	380	out (18),a\r
072e0f3b L	381	ret\r
	382	\r
	383	setdma:\r
e8384f88 L	384	ld a,c\r
	385	out (20),a\r
	386	ld a,b\r
	387	out (21),a\r
072e0f3b L	388	ret\r
	389	\r
	390	read:\r
e8384f88 L	391	ld a,1 shl READ_FUNC\r
	392	out (22),a\r
	393	in a,(22)\r
	394	and 1\r
072e0f3b L	395	ret\r
	396	\r
	397	write:\r
	398	ld a,c\r
e8384f88	399	and 3 ;mask write type\r
072e0f3b L	400	or 1 shl WRITE_FUNC\r
072e0f3b L	401	out (22),a\r
e8384f88 L	402	in a,(22)\r
e8384f88 L	403	and 1\r
072e0f3b L	404	ret\r
	405	\r
	406	sectran:\r
	407	;translate sector bc using table at de, res into hl\r
e8384f88 L	408	ld h,b\r
	409	ld l,c\r
	410	ld a,d\r
	411	or e\r
	412	ret z\r
	413	ex de,hl\r
	414	add hl,bc\r
	415	ld l,(hl)\r
	416	ld h,0\r
072e0f3b L	417	ret\r
072e0f3b L	418	\r
d8fa6a36 L	419	;------------------------------------------------------------------------\r
	420	; ZSDOS clock drivers may use registers BC and D without restoring them, \r
	421	; but must preserve the Z80's alternate and index registers. \r
	422	; Other registers must be used exactly as follows:\r
	423	;\r
	424	; Enter: C = 00H to Read the Clock, 01H to Set the Clock\r
	425	; DE = Address of a 6-byte field to Receive or from which \r
	426	; to Set time in DateStamper format (BCD digits as: \r
	427	; YY MM DD HH MM SS). 24-hour operation is assumed.\r
	428	;\r
	429	; Exit : A = 01H for a successful operation,\r
	430	; 0FFH for a failure of any sort (Can't set, etc.)\r
	431	;\r
	432	; When Reading the Clock:\r
	433	; E = Original contents of Entry value of DE plus 5\r
	434	; HL = Entry value of DE plus 5 (Seconds field)\r
	435	\r
	436	clock:\r
	437	dec c\r
	438	jr z,clk_set\r
	439	inc c\r
	440	ret nz\r
	441	\r
bb5256ee L	442	clk_get:\r
	443	ld hl,5\r
	444	add hl,de\r
	445	push hl\r
	446	ld bc,6*256 + CLOCKPORT-1\r
d8fa6a36	447	ld e,(hl)\r
bb5256ee L	448	clk_gl:\r
	449	inc c\r
	450	ind\r
	451	jr nz,clk_gl\r
	452	pop hl\r
d8fa6a36 L	453	jr clk_e\r
d8fa6a36 L	454	\r
bb5256ee	455	\r
d8fa6a36	456	clk_set:\r
bb5256ee L	457	ld a,(hl)\r
	458	cp 78h\r
	459	ld a,19h\r
	460	jr nc,clk_s1\r
	461	ld a,20h\r
	462	clk_s1:\r
	463	out (CLOCKPORT+6),a\r
d8fa6a36	464	ld bc,6*256 + CLOCKPORT+6\r
bb5256ee	465	clk_sl:\r
d8fa6a36	466	dec c\r
bb5256ee L	467	outi\r
	468	jr nz,clk_sl\r
	469	dec hl\r
d8fa6a36 L	470	clk_e:\r
	471	ld a,1\r
	472	ret\r
	473	\r
	474	;------------------------------------------------------------------------\r
	475	\r
2396f399 L	476	bcb: dw drvtbl\r
	477	dw dirbuf\r
	478	dw enddat\r
	479	\r
072e0f3b L	480	bootdsk:ds 1\r
	481	bootspt:ds 1\r
	482	\r
	483	.8080\r
	484	endef\r
	485	\r
	486	end\r
	487	\r