Add polling driver for ASCI0/1

[z180-stamp.git] / z180 / init.180

diff --git a/z180/init.180 b/z180/init.180
index 0bd37c1d68bbb2874fea672c3563e0d81dc4a6fa..39b03fcdb6a5cf98dbfe7d89f94904862317498f 100644 (file)
--- a/z180/init.180
+++ b/z180/init.180
@@ -5,7 +5,6 @@
        extrn $stack\r
        extrn charini,?const,?conin\r
        extrn ?cono,?conos\r
-\r
        extrn romend\r
 \r
 \r
@@ -75,14 +74,12 @@ start:
 \r
 hwini0:\r
     if CPU_Z180\r
-\r
        db      3               ;count\r
        db      rcr,CREFSH      ;configure DRAM refresh\r
        db      dcntl,INIWAITS  ;wait states\r
        db      cbar,SYS$CBAR\r
-    else\r
-       db     0\r
     endif\r
+       db     0\r
 \r
     if CPU_Z180\r
 dmclrt:                                ;clear ram per dma\r
@@ -95,6 +92,7 @@ nullbyte:
        db      00h             ;dst\r
        dw      0-romend        ;count (64k)\r
 dmct_e:\r
+       db      0\r
     endif\r
 \r
 \r
@@ -165,7 +163,7 @@ kstart:
      if 0\r
        \r
        ld      hl,dmclrt       ;load DMA registers\r
-       call    io.ini.m\r
+       call    ioiniml\r
        ld      a,0cbh          ;01ef   dst +1, src fixed, burst\r
        out0    (dmode),a       ;01f1\r
 \r
@@ -434,7 +432,7 @@ prt0_init:
        inc     hl\r
        ld      (hl),high iprt0\r
        ld      hl,prt0itab\r
-       call    io.ini.m\r
+       call    ioiniml\r
        ret\r
 \r
 prt0itab:\r
@@ -444,6 +442,7 @@ prt0itab:
        dw      PRT_TC10MS\r
        db      M_TIE0+M_TDE0   ;enable timer 0 interrupt and down count.\r
 prt0it_e:\r
+       db      0\r
     endif\r
 \r
 \r
@@ -451,24 +450,55 @@ prt0it_e:
 ;----------------------------------------------------------------------\r
 ;\r
 \r
+    if CPU_Z180\r
 io.ini:\r
+     if 0\r
        push    bc\r
-    if CPU_Z180\r
-\r
        ld      b,0             ;high byte port adress\r
+ioi_nxt:\r
        ld      a,(hl)          ;count\r
        inc     hl\r
        or      a\r
        jr      z,ioi_e\r
-ioi_1:\r
+\r
        ld      c,(hl)          ;port address\r
        inc     hl\r
+ioi_r:\r
        outi\r
        inc     b               ;outi decrements b\r
        dec     a\r
-       jr      nz,ioi_1\r
+       jr      nz,ioi_r\r
+       jr      ioi_nxt\r
 ioi_e: \r
+       pop     bc\r
+       ret\r
+       \r
+     else ;(if 1/0)\r
+     \r
+       push    bc\r
+       jr      ioi_nxt\r
+ioi_l:\r
+       ld      c,(hl)          ;port address\r
+       inc     hl\r
+       inc     c\r
+ioi_r:\r
+       dec     c               ;otim increments c\r
+       otim\r
+       jr      z,ioi_r\r
+ioi_nxt:\r
+       ld      b,(hl)          ;count\r
+       inc     hl\r
+       inc     b               ;stop if count == 0\r
+       djnz    ioi_l\r
+       pop     bc\r
+       ret\r
+       \r
+     endif ;(1/0)\r
+\r
     else\r
+\r
+io.ini:\r
+       push    bc\r
        jr      ioi_nxt\r
 ioi_l:\r
        ld      c,(hl)          ;port address\r
@@ -483,16 +513,28 @@ ioi_nxt:
        pop     bc\r
        ret\r
 \r
+;----------------------------------------------------------------------\r
+\r
     if CPU_Z180\r
-io.ini.m:\r
+\r
+       global ioiniml\r
+\r
+ioiniml:\r
        push    bc\r
+       xor     a\r
+ioml_lp:\r
        ld      b,(hl)\r
        inc     hl\r
+       cp      b\r
+       jr      z,ioml_e\r
+       \r
        ld      c,(hl)\r
        inc     hl\r
        otimr\r
+       jr      ioml_lp\r
+ioml_e:\r
        pop     bc\r
-       ret\r
+       ret     z\r
     endif\r
 \r
 io.ini.l:\r