print hex/string functions for debugging.

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

	global add_hla
	global ioiniml,ioini1l
	global intinit
	global bufinit

	global fifolst

	extrn ?pmsg
	extrn msg.sm,hwl2phy

	include config.inc
	include	z180reg.inc

;--------------------------------------------------------------
;
; add a to hl
;
;    return:
;       hl = hl + a
;       Flags undefined

	cseg	; (common. TODO: check for banked)
	
add_hla:
	add a,l
	ld l,a
	ret nc
	inc h
	ret

;----------------------------------------------------------------------

	; output bytes to consecutive portaddresses
	;
	;     hl: table with following structure:
	;        db n, port1, val1, val2,... valn
	;        db m, port1, val1, val2,... valm
	;        ...
	;        db 0 ; Terminate table


	cseg	; (common for now)

ioiniml:
	push	bc
	xor	a
ioml_lp:
	ld	b,(hl)
	inc	hl
	cp	b
	jr	z,ioml_e

	ld	c,(hl)
	inc	hl
	otimr
	jr	ioml_lp
ioml_e:
	pop	bc
	ret

;----------------------------------------------------------------------

	; output bytes to ports
	;
	;     hl: tables of port,value pairs:
	;         db n, port1,val1, port2,val2,... portn,valn
	;         ...
	;         db 0 ; Terminate table

	cseg	; (common for now)

ioini1l:
	push	bc
	jr	io1_nxt
io1_lp:
	ld	c,(hl)		;port address
	inc	hl
	otim
	jr	nz,io1_lp
io1_nxt:
	ld	b,(hl)		;count
	inc	hl
	inc	b
	djnz	io1_lp

	pop	bc
	ret

;----------------------------------------------------------------------

	dseg

intinit:
	ld	hl,ivtab	;
	ld	a,h		;
	ld	i,a		;
	out0	(il),l		;
	im	2

; Let all vectors point to spurious int routines.

	ld	de,sp.int0
	ld	bc,sp.int.len
	ld	a,9
ivt_i1:
	ld	(hl),e
	inc	l
	ld	(hl),d
	inc	l
	ex	de,hl
	add	hl,bc
	ex	de,hl
	dec	a
	jr	nz,ivt_i1
	ret


;--------------------------------------------------------------------
; Spurious interrupt handler

	cseg	; common area
sp.int0:
	ld	a,00h
	jr	sp.i.1
sp.int.len equ	$-sp.int0
	ld	a,01h
	jr	sp.i.1
	ld	a,02h
	jr	sp.i.1
	ld	a,03h
	jr	sp.i.1
	ld	a,04h
	jr	sp.i.1
	ld	a,05h
	jr	sp.i.1
	ld	a,06h
	jr	sp.i.1
	ld	a,07h
	jr	sp.i.1
	ld	a,08h
sp.i.1:
;	out	(80h),a

	add	a,'0'
	ld	(spi$nr),a
	ld	hl,spi$msg
	call	?pmsg
sp.i.2:
	halt
	jr	sp.i.2

spi$msg:
	db	13,10,'Spurious Int: '
spi$nr:	db	'0'
	db	0


;--------------------------------------------------------------------

	cseg

fifolst:
	rept 4
	 dw	0
	 db	0
	endm

;--------------------------------------------------------------------

	dseg

bufinit:
	ld	c,a
	ld	a,(ix+o.id)
	cp	4
	jr	nc,bfi_doit2

	ld	hl,fifolst
	ld	e,a
	ld	d,0
	add	hl,de
	add	hl,de
	add	hl,de

   if 0
	ld	e,(hl)
	inc	hl
	ld	d,(hl)
	dec	hl
	ld	a,e
	or	d
	jr	z,bfi_doit

; TODO: address translation
	push	de
	pop	ix
	ret
   endif

bfi_doit:
	push	ix
	pop	de
; TODO: address translation
	ld	(hl),e
	inc	hl
	ld	(hl),d
	ld	a,(ix+o.id)
	or	a
	jr	nz,bfi_doit2

	ld	hl,fifolst
	ld	(040h),hl
	ld	(040h+2),a

bfi_doit2:
	ld	(ix+o.in_idx),0		;reset pointers
	ld	(ix+o.out_idx),0
	ld	(ix+o.mask),c		;reset "size"

	push	ix			;get phys. address of fifo
	pop	hl
	call	hwl2phy
	ex	de,hl
	ld	c,a
	ld	a,(ix+o.id)		;fifo id
	or	a			;test if fifo 0
	jr	nz,bfi_1

	out	(AVRINT5),a
	ret

bfi_1:
	ld	hl,bfi_msg_end
	ld	(hl),c
	dec	hl
	ld	(hl),d
	dec	hl
	ld	(hl),e
	dec	hl
	ld	(hl),a
	dec	hl
	ld	b,bfi_msg_len
	call	msg.sm
	ret

bfi_msg:
	db	0			;function: 0
	db	0			;subfunc: gets overwritten with buf id
	dw	0			;physical
	db	0			;   address
bfi_msg_len	equ $ - bfi_msg
bfi_msg_end	equ $ - 1

;----------------------------------------------------------------------


	end