new fifos msg in, msg out, console in, console out

[z180-stamp.git] / z180 / conbuf-a.180

	page	255\r
	.z80\r
	\r
;\r
; FIFO channels for communication with avr\r
;\r
	global	ff.init,ff.in,ff.out,ff.i.st\r
\r
	extrn	buf.init\r
\r
	include config.inc\r
	include	z180reg.inc\r
\r
\r
;--------------------------------------------------------------\r
\r
	dseg\r
	\r
\r
	mkbuf	co.fifo,co.fifo_len\r
	mkbuf	ci.fifo,ci.fifo_len\r
\r
\r
;--------------------------------------------------------------\r
\r
	cseg\r
\r
; Init Serial I/O for console input and output\r
;\r
\r
ff.init:\r
	ld	ix,ci.fifo\r
	ld	a,ci.fifo.mask\r
	call	buf.init\r
	ld	ix,co.fifo\r
	ld	a,co.fifo.mask\r
	jp	buf.init\r
\r
\r
ff.i.st:\r
	push	ix\r
	ld	ix,ci.fifo		;\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
ff.in:\r
	push	ix\r
	ld	ix,ci.fifo		;\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	hl			;\r
	push	ix\r
	pop	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
ff.o.st:\r
	push	ix\r
	ld	ix,co.fifo		;\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
ff.out:\r
	push	ix\r
	ld	ix,co.fifo		;\r
\r
buf.put:\r
	push	hl			;\r
	push	bc\r
	push	ix\r
	pop	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
	out	(AVRINT6),a\r
	ld	a,b\r
	pop	bc\r
	pop	hl\r
	pop	ix\r
	ret\r
\r
	end\r
\r