* avr/Z80int-jmp.asm

[avrcpm.git] / avr / virt_ports.asm

diff --git a/avr/virt_ports.asm b/avr/virt_ports.asm
index 460f30cdd70630552c8de340980a5bba37fe0d13..1fa815497808d2955e1d64480f24ec9881c5239f 100644 (file)
--- 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