Extended drive table for use with DRIVE.COM, a dynamic drive re-assignment utility.

[z180-stamp-cpm3.git] / cbios / msgbuf.180

	page	255\r
	.z80\r
\r
\r
	global	msginit\r
;	global	msg.ist,msg.in,msg.ost,msg.out\r
;	global	msg.sout\r
	global	msg.sm,msg.recv\r
\r
	extrn	bufinit,hwl2phy,phy2log\r
	extrn	fifolst\r
\r
	maclib z180reg.inc\r
	maclib config.inc\r
\r
\r
	dseg\r
	mkbuf	0,mtx.fifo,mtx.fifo_len\r
	mkbuf	1,mrx.fifo,mrx.fifo_len\r
\r
itx	equ	0*2\r
irx	equ	1*2\r
\r
;--------------------------------------------------------------\r
;\r
; Init message fifos\r
;\r
	dseg\r
msginit:\r
	ld	a,(043h)\r
\r
;TODO: value should be 0\r
\r
	ld	ix,mtx.fifo\r
	call	bufinit\r
	push	ix\r
	pop	hl\r
	call	hwl2phy\r
	ld	(040h),hl\r
	ld	(040h+2),a\r
	ld	a,0ffh\r
	ld	(043h),a\r
	out	(AVRINT5),a\r
wait:\r
	ld	a,(043h)\r
	or	a\r
	jr	nz,wait\r
\r
	ld	ix,mrx.fifo\r
	jp	bufinit\r
\r
\r
;--------------------------------------------------------------\r
\r
	dseg\r
msgi.st:\r
	push	ix\r
	ld	ix,(fifolst+irx)	;\r
\r
buf.empty:\r
	ld	a,(ix+o.in_idx)		;\r
	sub	(ix+o.out_idx)		;\r
	pop	ix\r
	ret	z\r
	or	0ffh\r
	ret\r
\r
;--------------------------------------------------------------\r
\r
msg.in:\r
	push	ix\r
	ld	ix,(fifolst+irx)		;\r
\r
buf.get:\r
	ld	a,(ix+o.out_idx)	;\r
bg.wait:\r
	cp	(ix+o.in_idx)		;\r
	jr	z,bg.wait\r
\r
	push	ix			;\r
	ex	(sp),hl			;\r
	add	a,l\r
	ld	l,a\r
	jr	nc,bg.nc\r
	inc	h\r
bg.nc:\r
	ld	l,(hl)\r
\r
	ld	a,(ix+o.out_idx)	;\r
	inc	a\r
	and	(ix+o.mask)\r
	ld	(ix+o.out_idx),a\r
\r
	ld	a,l\r
	pop	hl\r
	pop	ix\r
	ret\r
\r
\r
;----------------------------------------------------------------------\r
; Receive message\r
;\r
;     hl: pointer to receive buffer\r
;     b: receive buffer size\r
;   return:\r
;     data in buffer, buffer[0] has len\r
;     bc, a: destroyed\r
\r
; TODO: time out\r
; TODO: return number of stored chars\r
; TODO: result code\r
\r
msg.recv:\r
	call 	msg.in\r
	cp	0AEh\r
	jr	nz,msg.recv\r
	call 	msg.in		; get message length\r
	ld	c,a\r
	inc	c\r
	jr	mr_do\r
mr_next:\r
	dec	c		; while chars in input buffer\r
	ret	z\r
	call 	msg.in		;    get next\r
mr_do:\r
	dec	b\r
	jp	p,mr_store\r
	inc	b\r
	jr	mr_next\r
mr_store:\r
	ld	(hl),a		;       store char\r
	inc	hl\r
	jr	mr_next		;\r
\r
;--------------------------------------------------------------\r
\r
msgo.st:\r
	push	ix\r
	ld	ix,(fifolst+itx)		;\r
\r
buf.full:\r
	ld	a,(ix+o.in_idx)		;\r
	inc	a\r
	and	(ix+o.mask)\r
	sub	(ix+o.out_idx)		;\r
	pop	ix\r
	ret	z\r
	or	0ffh\r
	ret\r
\r
;--------------------------------------------------------------\r
\r
    if 0\r
\r
msg.out:\r
	push	ix\r
	ld	ix,(fifolst+itx)		;\r
\r
	push	bc\r
	push	ix\r
	ex	(sp),hl			;\r
	ld	c,(ix+o.in_idx)		;\r
	ld	b,0\r
	add	hl,bc\r
	ld	b,a\r
\r
	ld	a,c			;\r
	inc	a\r
	and	(ix+o.mask)\r
bp.wait:\r
	cp	(ix+o.out_idx)		;\r
	jr	z,bp.wait\r
	ld	(hl),b\r
	ld	(ix+o.in_idx),a\r
\r
	ld	a,b\r
	out	(AVRINT5),a\r
	pop	hl\r
	pop	bc\r
	pop	ix\r
	ret\r
\r
    endif\r
\r
;--------------------------------------------------------------\r
\r
    if 0\r
\r
msg.out:\r
	push	ix\r
	ld	ix,(fifolst+itx)		;\r
\r
	push	bc\r
	ld	c,(ix+o.in_idx)		;\r
	ld	b,0\r
	push	ix			;14\r
	add	ix,bc			;10\r
	ld	(ix+0),a		;15\r
	pop	ix			;12=51\r
	ld	b,a			; 4\r
	ld	a,c			;\r
	inc	a			;\r
	and	(ix+o.mask)		;\r
bp.wait:\r
	cp	(ix+o.out_idx)		;\r
	jr	z,bp.wait		;\r
	ld	(ix+o.in_idx),a		;\r
\r
	ld	a,b\r
	out	(AVRINT5),a\r
	pop	bc\r
	pop	ix\r
	ret\r
\r
    endif\r
;--------------------------------------------------------------\r
\r
    if 0\r
    	; Works only, if buffer size < (128 - 3)\r
    	; 	--> mask must be 03fh or less\r
\r
msg.out:\r
	push	ix\r
	ld	ix,(fifolst+itx)		;\r
\r
	push	bc\r
   	ld	b,a			; 4\r
	ld	a,(ix+o.in_idx)		;14\r
	ld	($ + 3 + 2),a		;15\r
	ld	(ix+0),b		;15\r
	inc	a			;\r
	and	(ix+o.mask)		;\r
bp.wait:\r
	cp	(ix+o.out_idx)		;\r
	jr	z,bp.wait		;\r
	ld	(ix+o.in_idx),a		;\r
\r
	ld	a,b\r
	out	(AVRINT5),a\r
	pop	bc\r
	pop	ix\r
	ret\r
\r
    endif\r
\r
;--------------------------------------------------------------\r
;\r
; (hl): data\r
\r
    if 0\r
\r
msg.sout:\r
	push	ix			;14\r
	ld	ix,(fifolst+itx)		;12\r
	push	bc			;11\r
	push	de			;11\r
	ld	c,(hl)			; 6\r
	ld	b,0			; 6\r
	inc	hl			; 7\r
ms.ol:					;	\\r
TODO:	ld	a,low mtx.fifo		; 6  does not work with DR LINK-80\r
-->		(fifolst+itx+0)\r
	add	a,(ix+o.in_idx)		;14\r
	ld	e,a			; 4\r
	ld	a,high mtx.fifo		; 6  does not work with DR LINK-80\r
-->		(fifolst+itx+1)\r
	adc	a,b			; 4\r
	ld	d,a			; 4\r
\r
	ld	a,(ix+o.in_idx)		;14\r
	inc	a			; 4\r
	and	(ix+o.mask)		;14\r
ms.wait:\r
	cp	(ix+o.out_idx)		;14\r
	jr	z,ms.wait		; 6/8\r
\r
	ldi				;12\r
	ld	(ix+o.in_idx),a		;15\r
	jp	pe,ms.ol		; 6/9    -- 126\r
\r
	out	(AVRINT5),a		;10\r
	pop	de			; 9\r
	pop	bc			; 9\r
	pop	ix			;12\r
	ret				; 9\r
\r
    endif\r
\r
;--------------------------------------------------------------\r
;\r
; (hl): data\r
\r
    if 1\r
\r
msg.sout:\r
	push	ix			;14\r
	ld	ix,(fifolst+itx)		;12\r
	push	bc			;11\r
	push	de			;11\r
	ld	b,(hl)			; 6\r
	inc	hl			; 4\r
	ex	de,hl			; 3\r
ms.ol:					;\r
	push	ix			;14\r
	pop	hl			; 9\r
	ld	c,(ix+o.in_idx)		;14\r
	ld	a,c			; 4\r
	add	l			; 4\r
	ld	l,a			; 4\r
	jr	nc,ms.on		; 6/8\r
	inc	h			; 4\r
ms.on:\r
	ld	a,c			; 4\r
	inc	a			; 4\r
	and	(ix+o.mask)		;14\r
ms.wait:\r
	cp	(ix+o.out_idx)		;14\r
	jr	z,ms.wait		; 6/8\r
	ld	c,a			; 4\r
	ld	a,(de)			; 6\r
	inc	de			; 4\r
	ld	(hl),a			; 7\r
	ld	(ix+o.in_idx),c		;15\r
	djnz	ms.ol			; 7/9	-- 130\r
\r
	out	(AVRINT5),a		;10\r
	ex	de,hl			; 3\r
	pop	de			; 9\r
	pop	bc			; 9\r
	pop	ix			;12\r
	ret				; 9\r
\r
    endif\r
\r
;----------------------------------------------------------------------\r
\r
\r
\r
	; Send message\r
	;     b: msg length\r
	;     hl: pointer to message (netto)\r
\r
msg.snd:\r
	push	ix\r
	ld	ix,(fifolst+itx)\r
	ld	c,0AEh\r
	call	buf.put\r
msnd_l:\r
	ld	c,(hl)\r
	inc	hl\r
	call	buf.put\r
	djnz	msnd_l\r
	pop	ix\r
	ret\r
\r
\r
;----------------------------------------------------------------------\r
;\r
; Put char in message buffer:\r
;     ix: buffer to put into\r
;     c:  char\r
\r
buf.put:\r
	push	ix			;15\r
	ex	(sp),hl			;16\r
	ld	a,(ix+o.in_idx)		;19\r
	add	a,l			; 4\r
	ld	l,a			; 4\r
	jr	nc,bufp.1		;12/7\r
	inc	h			; 4\r
bufp.1:\r
	ld	(hl),c			; 7\r
	pop	hl			;10\r
\r
	ld	a,(ix+o.in_idx)		;19\r
	inc	a			;4\r
	and	(ix+o.mask)		;19	=129\r
bufp.wait:\r
	cp	(ix+o.out_idx)		;19\r
	jr	z,bufp.wait		;12/7\r
	ld	(ix+o.in_idx),a		;19\r
\r
	out	(AVRINT5),a		;11\r
	ld	a,c			;4\r
	ret				;10	=199\r
\r
;----------------------------------------------------------------------\r
; Send message MEMORY\r
;\r
;     hl: pointer to message (netto)\r
;     b: msg length\r
\r
msg.sm:\r
	push	ix\r
	ld	ix,(fifolst+itx)\r
	ld	c,0AEh\r
	call	buf.put\r
	ld	c,b\r
	call	buf.put\r
msm_l:\r
	ld	c,(hl)\r
	inc	hl\r
	call	buf.put\r
	djnz	msm_l\r
	pop	ix\r
	ret\r
\r
\r
;----------------------------------------------------------------------\r
; Send message INLINE\r
;\r
;     h: function\r
;     l: subfunction\r
;     b: msg length\r
\r
    if 0\r
\r
msg.sil:\r
	ex	(sp),hl\r
	push	ix\r
	ld	ix,(fifolst+itx)\r
	ld	c,0AEh\r
	call	buf.put\r
	ld	b,(hl)\r
msnd_pl:\r
	ld	c,(hl)\r
	inc	hl\r
	call	puf.put\r
	djnz	msnd_pl\r
	ex	(sp),hl\r
	pop	ix\r
	ret\r
\r
    endif\r
\r
;--------------------------------------------------------------\r
\r
    if 0\r
\r
msg.co:\r
	push	af\r
	push	hl\r
	ld	(buf_char),a\r
	ld	hl,buf\r
	call	msg.sout\r
	pop	hl\r
	pop	af\r
	ret\r
\r
buf:\r
	db	buf_end - $ - 1		;output string length\r
	db	0AEh			; message start token\r
	db	buf_end - $ - 1		; message length\r
	db	1			; command\r
	db	1			; subcommand\r
buf_char:\r
	db	0			; pay load\r
buf_end:\r
\r
    endif\r
\r
;--------------------------------------------------------------\r
\r
\r
\r
	end\r