Change message start token from 0x81 to 0xAE

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

	page	255\r
	.z80\r
	\r
	global	mrx.fifo,mtx.fifo\r
\r
	global	msginit,msgi.st,msg.in,msgo.st,msg.out\r
	global	msg.sout\r
	\r
	extrn	buf.init\r
\r
	include config.inc\r
	include	z180reg.inc\r
\r
;--------------------------------------------------------------\r
\r
	dseg\r
\r
	mkbuf	mrx.fifo,mrx.fifo_len\r
	mkbuf	mtx.fifo,mtx.fifo_len\r
\r
;--------------------------------------------------------------\r
\r
	cseg\r
\r
;\r
; Init buffer\r
;\r
	\r
msginit:\r
	ld	ix,mrx.fifo\r
	ld	a,mrx.fifo.mask\r
	call	buf.init\r
	ld	ix,mtx.fifo\r
	ld	a,mtx.fifo.mask\r
	jp	buf.init\r
\r
;--------------------------------------------------------------\r
\r
msgi.st:\r
	push	ix\r
	ld	ix,mrx.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
\r
msg.in:\r
	push	ix\r
	ld	ix,mrx.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
\r
msgo.st:\r
	push	ix\r
	ld	ix,mtx.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
\r
msg.out:\r
	push	ix\r
	ld	ix,mtx.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
	ld	a,b\r
	out0	(AVRINT5),a\r
	pop	bc\r
	pop	hl\r
	pop	ix\r
	ret\r
\r
\r
;--------------------------------------------------------------\r
;\r
; (hl): data\r
\r
msg.sout:\r
	push	ix\r
	ld	ix,mtx.fifo		;\r
\r
	push	bc\r
	push	de\r
	ld	b,(hl)			;\r
	inc	hl\r
	ex	de,hl\r
	\r
ms.ol:\r
	push	ix\r
	pop	hl\r
	ld	c,(ix+o.in_idx)		;\r
	ld	a,c\r
	add	l\r
	ld	l,a\r
	jr	nc,ms.on\r
	inc	h\r
ms.on:\r
	ld	a,c			;\r
	inc	a\r
	and	(ix+o.mask)\r
ms.wait:\r
	cp	(ix+o.out_idx)		;\r
	jr	z,ms.wait\r
	ld	c,a\r
	ld	a,(de)\r
	inc	de\r
	ld	(hl),a\r
	ld	(ix+o.in_idx),c\r
	djnz	ms.ol\r
	out0	(AVRINT5),a\r
	ex	de,hl\r
	pop	de\r
	pop	bc\r
	pop	ix\r
	ret\r
\r
;--------------------------------------------------------------\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
	\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
;----------------------------------------------------------------------\r
\r
	end\r
\r