[avrcpm.git] / avrcpm / avr / virt_ports.asm

;    Virtual Ports for the BIOS Interaction
;
;    Copyright (C) 2010 Leo C.
;
;    This file is part of avrcpm.
;
;    avrcpm is free software: you can redistribute it and/or modify it
;    under the terms of the GNU General Public License as published by
;    the Free Software Foundation, either version 3 of the License, or
;    (at your option) any later version.
;
;    avrcpm is distributed in the hope that it will be useful,
;    but WITHOUT ANY WARRANTY; without even the implied warranty of
;    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
;    GNU General Public License for more details.
;
;    You should have received a copy of the GNU General Public License
;    along with avrcpm.  If not, see <http://www.gnu.org/licenses/>.
;
;    $Id$
;


;
;   Port        Direction  Function
;hex	dez
;-------------------------------------------------------------------------
;00  	0 	in	- Con status. 
;			  Returns 0xFF if the UART has a byte, 0 otherwise.
;01  	1 	in/out	- Console input, aka UDR. / Console Output
;02  	2 	out	- Console Output (deprecated)
;03  	3	in	- "UART" status: bit 0 = rx, bit 1 = tx
;04  	4	in	- "UART" data register, no wait
;
;0D,0E	13,14	in/out	- Set address of Bios Controll Block
;0F  	15	in/out	- Disk select
;10,11  16,17 	in/out	- Track select
;12,13 	18,19 	in/out	- Sector select
;14,15 	20,21 	in/out	- Write addr
;   	 	
;16  	22 	out	- Trigger disk i/o operations
;			  Bit 7 = 1: Read sector
;			  Bit 6 = 1: Write sector
;			  Bit 5 = 1: BIOS WBOOT
;			  Bit 4 = 1: BIOS Home
;			  Only one of bits 4..7  may be set.
;			  If Write function (bit 6=1):
;			   Bits 0..2: 0 - write to allocated
;				      1 - write to directory
;				      2 - write unallocated
;				      3 - write to directory			 
;
;16  	22	in	- Result of last read/write operation.
;			  0x00 = ok, 0xff = error (--> Bad Sector)
;
;40  	64-71	in/out	- Timer/Clock controll.	
;46


; ---------------------------------------------- Start of Code Segment
	.cseg
vport_tbl:
	.db	00,1		;Port 0, length 1
	.dw	conStatus	;	in
	.dw	dbgOut		;	out
	.db	01,1
	.dw	uartgetc
	.dw	uartputc
	.db	02,1		;Port 2 (old console output)
	.dw	uartgetc	; filler
	.dw	uartputc	; deprecated
	.db	03,1
	.dw	uartstat
	.dw	vport_out_dummy
	.db	04,1
	.dw	uartin
	.dw	uartout

	.db	13,9		; Port 13-21, (lenth 9)
	.dw	dsk_param_rd
	.dw	dsk_param_wr
	.db	22,1
	.dw	dskErrorRet
	.dw	dskDoIt

	.db	TIMERPORT,7
	.dw	clockget
	.dw	clockput
	.db	0,0		; Stop mark

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

;Called with port in temp2 and value in temp.
portWrite:
	set
	rjmp	vprw_start

;Called with port in temp2. Should return value in temp.
portRead:
	clt

vprw_start:
.if PORT_DEBUG > 1
	tst	temp2
	brne	dvp_1		;don't debug console status
	brts	dvp_1
	rjmp	conStatus
dvp_1:
	printnewline
	brts	dvp_11
	printstring	"Port In:  "
	rjmp	dvp_12
dvp_11:	
	printstring	"Port Out: "
dvp_12:
	push	temp
	mov	temp,temp2
	rcall	printhex
	pop	temp
.endif
	ldiw	z,vport_tbl*2

vprw_loop:
	lpm	_tmp0,z+
	lpm	temp4,z+	;length
	cpi	temp4,0
	breq	vprw_exit	;no more ports

	mov	temp3,temp2	
	sub	temp3,_tmp0	;base port
	brcs	vprw_next	;port # too high
	cp	temp3,temp4     ;may be in range
	brcs	vprw_found	;
vprw_next:			;port # not in range, test next block.
	adiw	z,4
	rjmp	vprw_loop
vprw_found:
	brtc	PC+2
	adiw	z,2
	lpm	_tmp0,z+
	lpm	_tmp1,z+
	movw	z,_tmp0

.if PORT_DEBUG > 1
	push	temp2
	push	temp
	printstring ", exec: "
	movw	temp,z
	rcall	printhexw
	printstring ", rel port: "
	mov	temp,temp3
	rcall	printhex
	pop	temp
	pop	temp2
	printstring ", val: "
	brts	dvp_2
	icall
	rcall	printhex
	printstring " "
	ret
dvp_2:
	rcall	printhex
	printstring " "
	ijmp			; relative port # in temp3
.else
	ijmp
.endif

vprw_exit:
				; trap for nonexistent port?
.if PORT_DEBUG > 1
	printstring ", not found!"
.endif	
vport_in_dummy:
	ldi	temp,0xff
vport_out_dummy:
	ret
	

uartstat:
	clr	temp
	lds	temp2,rxcount
	cpse	temp2,_0
	 sbr	temp,0x01		
	lds	temp2,txcount
	cpi	temp2,TXBUFSIZE
	breq	uartst_1
	 sbr	temp,0x02
uartst_1:
	ret

uartin:
	clr	temp
	lds	temp2,rxcount
	cpse	temp2,_0
	 rjmp	uartgetc
	ret

uartout:
	lds	temp2,txcount
	cpi	temp2,TXBUFSIZE
	breq	uartout_1
	rjmp uartputc
uartout_1:
	ret


conStatus:
	lds	temp,rxcount
	cpse	temp,_0
	 ldi	temp,0xff
	ret


dbgOut:
	printnewline
	printstring "Debug: "
	rcall printhex
	ret


;---------------------------------------------------------------------
; vim:set ts=8 noet nowrap
Commit	Line	Data
64219415 FZ	1	; Virtual Ports for the BIOS Interaction
64219415 FZ	2	;
29ce189c	3	; Copyright (C) 2010 Leo C.
64219415 FZ	4	;
	5	; This file is part of avrcpm.
	6	;
	7	; avrcpm is free software: you can redistribute it and/or modify it
	8	; under the terms of the GNU General Public License as published by
	9	; the Free Software Foundation, either version 3 of the License, or
	10	; (at your option) any later version.
	11	;
	12	; avrcpm is distributed in the hope that it will be useful,
	13	; but WITHOUT ANY WARRANTY; without even the implied warranty of
	14	; MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	15	; GNU General Public License for more details.
	16	;
	17	; You should have received a copy of the GNU General Public License
	18	; along with avrcpm. If not, see <http://www.gnu.org/licenses/>.
	19	;
	20	; $Id$
29ce189c L	21	;
	22
	23
	24	;
	25	; Port Direction Function
	26	;hex dez
	27	;-------------------------------------------------------------------------
	28	;00 0 in - Con status.
	29	; Returns 0xFF if the UART has a byte, 0 otherwise.
	30	;01 1 in/out - Console input, aka UDR. / Console Output
	31	;02 2 out - Console Output (deprecated)
	32	;03 3 in - "UART" status: bit 0 = rx, bit 1 = tx
	33	;04 4 in - "UART" data register, no wait
	34	;
	35	;0D,0E 13,14 in/out - Set address of Bios Controll Block
	36	;0F 15 in/out - Disk select
	37	;10,11 16,17 in/out - Track select
	38	;12,13 18,19 in/out - Sector select
	39	;14,15 20,21 in/out - Write addr
	40	;
	41	;16 22 out - Trigger disk i/o operations
	42	; Bit 7 = 1: Read sector
	43	; Bit 6 = 1: Write sector
	44	; Bit 5 = 1: BIOS WBOOT
	45	; Bit 4 = 1: BIOS Home
	46	; Only one of bits 4..7 may be set.
	47	; If Write function (bit 6=1):
	48	; Bits 0..2: 0 - write to allocated
	49	; 1 - write to directory
	50	; 2 - write unallocated
	51	; 3 - write to directory
	52	;
	53	;16 22 in - Result of last read/write operation.
	54	; 0x00 = ok, 0xff = error (--> Bad Sector)
	55	;
	56	;40 64-71 in/out - Timer/Clock controll.
	57	;46
	58
	59
64219415	60	; ---------------------------------------------- Start of Code Segment
29ce189c L	61	.cseg
	62	vport_tbl:
	63	.db 00,1 ;Port 0, length 1
	64	.dw conStatus ; in
	65	.dw dbgOut ; out
	66	.db 01,1
	67	.dw uartgetc
	68	.dw uartputc
	69	.db 02,1 ;Port 2 (old console output)
	70	.dw uartgetc ; filler
	71	.dw uartputc ; deprecated
	72	.db 03,1
	73	.dw uartstat
	74	.dw vport_out_dummy
	75	.db 04,1
	76	.dw uartin
	77	.dw uartout
	78
	79	.db 13,9 ; Port 13-21, (lenth 9)
	80	.dw dsk_param_rd
	81	.dw dsk_param_wr
	82	.db 22,1
	83	.dw dskErrorRet
	84	.dw dskDoIt
	85
	86	.db TIMERPORT,7
	87	.dw clockget
	88	.dw clockput
	89	.db 0,0 ; Stop mark
	90
	91	;---------------------------------------------------------------------
	92
	93	;Called with port in temp2 and value in temp.
	94	portWrite:
	95	set
	96	rjmp vprw_start
	97
	98	;Called with port in temp2. Should return value in temp.
	99	portRead:
	100	clt
	101
	102	vprw_start:
	103	.if PORT_DEBUG > 1
	104	tst temp2
	105	brne dvp_1 ;don't debug console status
	106	brts dvp_1
	107	rjmp conStatus
	108	dvp_1:
	109	printnewline
	110	brts dvp_11
	111	printstring "Port In: "
	112	rjmp dvp_12
	113	dvp_11:
	114	printstring "Port Out: "
	115	dvp_12:
	116	push temp
	117	mov temp,temp2
	118	rcall printhex
	119	pop temp
	120	.endif
	121	ldiw z,vport_tbl*2
	122
	123	vprw_loop:
	124	lpm _tmp0,z+
125	lpm temp4,z+ ;length
126	cpi temp4,0
127	breq vprw_exit ;no more ports
128
129	mov temp3,temp2
130	sub temp3,_tmp0 ;base port
131	brcs vprw_next ;port # too high
132	cp temp3,temp4 ;may be in range
133	brcs vprw_found ;
134	vprw_next: ;port # not in range, test next block.
135	adiw z,4
136	rjmp vprw_loop
137	vprw_found:
138	brtc PC+2
139	adiw z,2
140	lpm _tmp0,z+
141	lpm _tmp1,z+
142	movw z,_tmp0
143
144	.if PORT_DEBUG > 1
145	push temp2
146	push temp
147	printstring ", exec: "
148	movw temp,z
149	rcall printhexw
150	printstring ", rel port: "
151	mov temp,temp3
152	rcall printhex
153	pop temp
154	pop temp2
155	printstring ", val: "
156	brts dvp_2
157	icall
158	rcall printhex
159	printstring " "
160	ret
161	dvp_2:
162	rcall printhex
163	printstring " "
164	ijmp ; relative port # in temp3
165	.else
166	ijmp
167	.endif
168
169	vprw_exit:
170	; trap for nonexistent port?
171	.if PORT_DEBUG > 1
172	printstring ", not found!"
173	.endif
174	vport_in_dummy:
175	ldi temp,0xff
176	vport_out_dummy:
177	ret
178
179
64219415 FZ	180	uartstat:
	181	clr temp
	182	lds temp2,rxcount
	183	cpse temp2,_0
	184	sbr temp,0x01
	185	lds temp2,txcount
	186	cpi temp2,TXBUFSIZE
	187	breq uartst_1
	188	sbr temp,0x02
	189	uartst_1:
	190	ret
	191
29ce189c L	192	uartin:
	193	clr temp
	194	lds temp2,rxcount
	195	cpse temp2,_0
	196	rjmp uartgetc
	197	ret
	198
64219415 FZ	199	uartout:
	200	lds temp2,txcount
	201	cpi temp2,TXBUFSIZE
	202	breq uartout_1
	203	rjmp uartputc
	204	uartout_1:
	205	ret
	206
29ce189c	207
64219415 FZ	208	conStatus:
	209	lds temp,rxcount
	210	cpse temp,_0
	211	ldi temp,0xff
	212	ret
	213
64219415 FZ	214
	215	dbgOut:
	216	printnewline
	217	printstring "Debug: "
	218	rcall printhex
	219	ret
	220
64219415 FZ	221
64219415 FZ	222	;---------------------------------------------------------------------
29ce189c L	223	; vim:set ts=8 noet nowrap
29ce189c L	224