From 2555d7fdf0b766935f421df20d8e30b6121ff321 Mon Sep 17 00:00:00 2001
From: matsutsuka <matsutsuka>
Date: Wed, 28 Nov 2007 09:39:30 +0000
Subject: [PATCH] Added experimental logging support for debug.

---
 platform/pc-6001/dev/rs232-asm.S | 132 +++++++++++++++++++++++++++++--
 1 file changed, 124 insertions(+), 8 deletions(-)

diff --git a/platform/pc-6001/dev/rs232-asm.S b/platform/pc-6001/dev/rs232-asm.S
index 9a17db01c..ff91e01e2 100644
--- a/platform/pc-6001/dev/rs232-asm.S
+++ b/platform/pc-6001/dev/rs232-asm.S
@@ -7,15 +7,18 @@
 ;;; 
 ;;; @author Takahide Matsutsuka <markn@markn.org>
 ;;; 
-;;; $Id: rs232-asm.S,v 1.2 2007/09/19 12:47:19 matsutsuka Exp $
+;;; $Id: rs232-asm.S,v 1.3 2007/11/28 09:39:30 matsutsuka Exp $
 ;;; 
 	
 	;; definitions of PC-6001 BIOS routines
 _rs232c_initialize	= 0x19bf
-_rs232c_char_output	= 0x19e8
+_buffer_out		= 0x2627
 _char_input_sub		= 0x2642
-_rs232c_interrupt_sub	= 0x0f64
-	
+_count_buffer		= 0x26a2
+_rs232c_intr_vector	= 0xfa04
+_subcpu_handshake_out	= 0x0e8f	
+LOG = 0
+CTK = 0
 	;; export symbols
 	.globl	_rs232_arch_writeb
 	.globl	_rs232_arch_poll
@@ -23,17 +26,111 @@ _rs232c_interrupt_sub	= 0x0f64
 
 	.area	_CODE
 
+.if LOG
+_hex:
+	.ascii	"0123456789ABCDEF"
+.if CTK
+ 	.globl	_cputc_arch_asm
+.else
+	.globl	_libputc_asm
+	.globl	_screen_offset
+.endif
+_rs232_arch_putc:		; a = data
+ 	ld	hl, #0
+ 	ld	(#_screen_offset), hl
+	push	af
+	srl	a
+	srl	a
+	srl	a
+	srl	a
+	call	_rs232_arch_putc_next1
+	pop	af
+	and	a, #0x0f
+_rs232_arch_putc_next1:
+	ld	hl, #_hex
+_rs232_arch_putc_loop:
+	or	a
+	jr	z, _rs232_arch_putc_next2
+	inc	hl
+	dec	a
+	jr	_rs232_arch_putc_loop
+_rs232_arch_putc_next2:
+	ld	a, (hl)
+.if CTK
+ 	call	_cputc_arch_asm
+.else
+	call	_libputc_asm
+.endif
+	ret
+.endif
+	
 	;; ---------------------------------
 	;; void rs232_writeb(u8_t c)
 	;; Stack; retl reth c
-	;; AFBC__HL____
+	;; AF__D_HL____
 	;; return void
 	;; ---------------------------------
 _rs232_arch_writeb:
 	ld	hl, #2
 	add	hl, sp
-	ld	a, (hl)
-	call	_rs232c_char_output
+	ld	d, (hl)
+.if LOG
+	push	de
+ 	ld	a, #0x77	; 'w'
+.if CTK	
+ 	call	_cputc_arch_asm
+.else	
+	call	_libputc_asm
+.endif
+	pop	de
+	;; 	ld	a, d
+	;; 	push	de
+	;;  	call	_rs232_arch_putc
+	;; 	pop	de
+.endif
+_rs232_arch_writeb_loop:
+	in	a, (#0x81)
+	and	a, #0x01
+	cp	#0x01		; TxRDY? 0x01/0x81/0x85
+	jr	nz, _rs232_arch_writeb_loop
+	ld	a, d
+	out	(#0x80), a
+	ret
+
+	;; RS-232C interrupt routine
+	;; receive a byte and put it into the buffer
+_rs232_arch_intr:
+	push	bc
+	push	af
+	push	de
+	push	hl
+	in	a, (#0x81)
+	and	a, #0x02	; RxRDY?
+	jr	z, _rs232_arch_intr_next	; no input
+	in	a, (#0x80)
+	ld	e, a
+	ld	a, #0x01
+	call	_buffer_out		; buffer output A=bufno, e=data
+_rs232_arch_intr_next:
+	ld	a, #0x0c
+	call	_subcpu_handshake_out	; sub CPU handshake output A
+	call	_rs232_arch_bufchk
+	pop	hl
+	pop	de
+	pop	af
+	pop	bc
+	ei
+	ret
+	
+_rs232_arch_bufchk:
+	ld      a, #0x01
+	call    _count_buffer	; count buffer available bytes -> A
+	cp      #0x02		; A >= 2?
+	ld      a, #0x37	; Rx enable
+	jr      nc, _rs232_arch_bufchk_next	; buffer available bytes >= 2
+	ld      a, #0x33	; Rx disable
+_rs232_arch_bufchk_next:
+	out     (#0x81),a	; buf available=0x37, buf full=0x33
 	ret
 
 	;; ---------------------------------
@@ -51,12 +148,22 @@ _rs232_arch_poll:
 	ld	a, #0x01
 	ld	(de), a
 	di
-	call	#_char_input_sub	; read from buffer
+	call	_char_input_sub		; read from buffer
 	ei
+	push	af
+	call	_rs232_arch_bufchk	; buffer check
+	pop	af
 	jr	nz, _rs232_arch_poll_ret
 	xor	a			; we have no data in the buffer
 	ld	(de), a
+	jr	_rs232_arch_poll_ret2
 _rs232_arch_poll_ret:
+.if LOG
+	call	_libputc_asm
+	;;  	call	_rs232_arch_putc
+.endif
+_rs232_arch_poll_ret2:
+	pop	af
 	ld	l, a
 	ret
 
@@ -67,6 +174,15 @@ _rs232_arch_poll_ret:
 	;; return void
 	;; ---------------------------------
 _rs232_arch_init:
+	ld	hl, #_rs232_arch_intr
+	di
+	ld	(#_rs232c_intr_vector), hl
+	ei
+	;; S2 S1 PE P  L2 L1 B2 B1
+	;;  0  1  0  0  1  1  1  1
+	;; 8-N-1 64x clock
 	ld	b, #0x4f
 	call	_rs232c_initialize
+	ld	a, #0x37
+	out	(#0x81), a
 	ret