Michael Steil 6 months ago
parent
commit
ab77d3e0c1
3 changed files with 36 additions and 0 deletions
  1. +12
    -0
      drv/drv1541.s
  2. +12
    -0
      drv/drv1571.s
  3. +12
    -0
      drv/drv1581.s

+ 12
- 0
drv/drv1541.s View File

@@ -571,7 +571,9 @@ __InitForIO:
sei
lda CPU_DATA
sta tmpCPU_DATA
.ifndef bsw128
LoadB CPU_DATA, KRNL_IO_IN
.endif
lda grirqen
sta tmpgrirqen
lda clkreg
@@ -585,11 +587,16 @@ __InitForIO:
sta cia2base+13
lda #>D_IRQHandler
sta irqvec+1
.ifdef bsw128
sta nmivec+1
.endif
lda #<D_IRQHandler
sta irqvec
.ifndef bsw128
lda #>D_NMIHandler
sta nmivec+1
lda #<D_NMIHandler
.endif
sta nmivec
lda #%00111111
sta cia2base+2
@@ -621,6 +628,9 @@ IniForIO0:
rts

D_IRQHandler:
.ifdef bsw128
PopB $ff00
.endif
pla
tay
pla
@@ -639,8 +649,10 @@ __DoneWithIO:
lda cia2base+13
lda tmpgrirqen
sta grirqen
.ifndef bsw128
lda tmpCPU_DATA
sta CPU_DATA
.endif
lda tmpPS
pha
plp

+ 12
- 0
drv/drv1571.s View File

@@ -671,7 +671,9 @@ __InitForIO:
sei
lda CPU_DATA
sta tmpCPU_DATA
.ifndef bsw128
LoadB CPU_DATA, KRNL_IO_IN
.endif
lda grirqen
sta tmpgrirqen
lda clkreg
@@ -685,11 +687,16 @@ __InitForIO:
sta cia2base+13
lda #>D_IRQHandler
sta irqvec+1
.ifdef bsw128
sta nmivec+1
.endif
lda #<D_IRQHandler
sta irqvec
.ifndef bsw128
lda #>D_NMIHandler
sta nmivec+1
lda #<D_NMIHandler
.endif
sta nmivec
lda #%00111111
sta cia2base+2
@@ -728,6 +735,9 @@ IniForIO1:
rts

D_IRQHandler:
.ifdef bsw128
PopB $ff00
.endif
pla
tay
pla
@@ -746,8 +756,10 @@ __DoneWithIO:
lda cia2base+13
lda tmpgrirqen
sta grirqen
.ifndef bsw128
lda tmpCPU_DATA
sta CPU_DATA
.endif
lda tmpPS
pha
plp

+ 12
- 0
drv/drv1581.s View File

@@ -670,7 +670,9 @@ __InitForIO:
sei
lda CPU_DATA
sta tmpCPU_DATA
.ifdef bsw128
LoadB CPU_DATA, KRNL_IO_IN
.endif
lda grirqen
sta tmpgrirqen
lda clkreg
@@ -684,11 +686,16 @@ __InitForIO:
sta cia2base+13
lda #>D_IRQHandler
sta irqvec+1
.ifdef bsw128
sta nmivec+1
.endif
lda #<D_IRQHandler
sta irqvec
.ifndef bsw128
lda #>D_NMIHandler
sta nmivec+1
lda #<D_NMIHandler
.endif
sta nmivec
lda #%00111111
sta cia2base+2
@@ -727,6 +734,9 @@ IniForIO1:
rts

D_IRQHandler:
.ifdef bsw128
PopB $ff00
.endif
pla
tay
pla
@@ -745,8 +755,10 @@ __DoneWithIO:
lda cia2base+13
lda tmpgrirqen
sta grirqen
.ifndef bsw128
lda tmpCPU_DATA
sta CPU_DATA
.endif
lda tmpPS
pha
plp

Loading…
Cancel
Save