X-Git-Url: http://cloudbase.mooo.com/gitweb/avrcpm.git/blobdiff_plain/4c92af0d7006b40de787e340ea63d64eedfd48df..e7a0f4030d1a41cb3e95ce226ba3ab0fc73c158f:/avr/virt_ports.asm

diff --git a/avr/virt_ports.asm b/avr/virt_ports.asm
index 460f30c..1fa8154 100644
--- a/avr/virt_ports.asm
+++ b/avr/virt_ports.asm
@@ -104,6 +104,8 @@ portRead:
 	clt
 
 vprw_start:
+	push	yh
+	push	yl
 .if PORT_DEBUG > 1
 	tst	temp2
 	brne	dvp_1		;don't debug console status
@@ -161,13 +163,22 @@ vprw_found:
 	icall
 	rcall	printhex
 	printstring " "
+	pop	yl
+	pop	yh
 	ret
 dvp_2:
 	rcall	printhex
 	printstring " "
-	ijmp			; relative port # in temp3
+				; relative port # in temp3
+	icall
+	pop	yl
+	pop	yh
+	ret
 .else
-	ijmp
+	icall
+	pop	yl
+	pop	yh
+	ret
 .endif
 
 vprw_exit:
@@ -178,6 +189,8 @@ vprw_exit:
 vport_in_dummy:
 	ldi	temp,0xff
 vport_out_dummy:
+	pop	yl
+	pop	yh
 	ret