added MEGA65 floppy engine handling
This commit is contained in:
1 parent
eac99c755c
commit
3a80867854
2 files changed
+58
-31
No files matched your search
@@ -0,0 +1,49 @@
|
|||||||
|
|
||||||
|
; Helper routines for low-level disk operations
|
||||||
|
|
||||||
|
|
||||||
|
lowlevel_ensure_presence:
|
||||||
|
|
||||||
|
lda FDC_STATUS_B ; $D083 ; check if disk is inserted XXX this is probably not enough!
|
||||||
|
and #$08
|
||||||
|
beq @not_present
|
||||||
|
rts
|
||||||
|
|
||||||
|
@not_present:
|
||||||
|
|
||||||
|
pla
|
||||||
|
pla
|
||||||
|
|
||||||
|
jsr lowlevel_motor_off ; if disk not present, disable drive motor
|
||||||
|
|
||||||
|
; XXX set error code, invalidate buffers, etc.
|
||||||
|
|
||||||
|
sec
|
||||||
|
rts
|
||||||
|
|
||||||
|
lowlevel_motor_on:
|
||||||
|
|
||||||
|
lda #%00100000 ; enable drive motor and LED
|
||||||
|
tsb FDC_CONTROL ; $D080
|
||||||
|
bra lowlevel_wait_clr_BUSY
|
||||||
|
|
||||||
|
lowlevel_motor_off:
|
||||||
|
|
||||||
|
lda #%00100000 ; disable drive motor and LED
|
||||||
|
trb FDC_CONTROL ; $D080
|
||||||
|
|
||||||
|
; FALLTROUGH
|
||||||
|
|
||||||
|
lowlevel_wait_clr_BUSY:
|
||||||
|
|
||||||
|
bit FDC_STATUS_A ; $D082
|
||||||
|
bmi lowlevel_wait_clr_BUSY
|
||||||
|
|
||||||
|
rts
|
||||||
|
|
||||||
|
lowlevel_wait_set_RDREQ:
|
||||||
|
|
||||||
|
bit FDC_STATUS_B ; $D083
|
||||||
|
bpl lowlevel_wait_set_RDREQ
|
||||||
|
|
||||||
|
rts
|
||||||
@@ -4,21 +4,12 @@
|
|||||||
|
|
||||||
lowlevel_readsector:
|
lowlevel_readsector:
|
||||||
|
|
||||||
; Set drive, check if disk is present
|
; Set drive, ensure disk is present
|
||||||
|
|
||||||
lda #%00001111 ; set drive 0 (internal) and side 0
|
lda #%00001111 ; set drive 0 (internal) and side 0
|
||||||
trb FDC_CONTROL ; $D080
|
trb FDC_CONTROL ; $D080
|
||||||
|
|
||||||
lda FDC_STATUS_B ; $D083 ; check if disk is inserted XXX this is probably not enough!
|
jsr lowlevel_ensure_presence
|
||||||
and #$08
|
|
||||||
bne @disk_present
|
|
||||||
|
|
||||||
; XXX set error code
|
|
||||||
|
|
||||||
sec
|
|
||||||
rts
|
|
||||||
|
|
||||||
@disk_present:
|
|
||||||
|
|
||||||
; Check if buffer contains data from given track
|
; Check if buffer contains data from given track
|
||||||
; XXX compare device and unit too
|
; XXX compare device and unit too
|
||||||
@@ -41,6 +32,9 @@ lowlevel_readsector:
|
|||||||
|
|
||||||
lowlevel_readsector_force:
|
lowlevel_readsector_force:
|
||||||
|
|
||||||
|
jsr lowlevel_motor_on ; enable drive motor and LED
|
||||||
|
jsr lowlevel_ensure_presence
|
||||||
|
|
||||||
lda #%10000000 ; select floppy buffer
|
lda #%10000000 ; select floppy buffer
|
||||||
trb SD_BUFCTL ; $D689
|
trb SD_BUFCTL ; $D689
|
||||||
|
|
||||||
@@ -85,11 +79,13 @@ lowlevel_readsector_force:
|
|||||||
|
|
||||||
; Wait for DRQ and EQ flags to go high
|
; Wait for DRQ and EQ flags to go high
|
||||||
|
|
||||||
@lp3:
|
@lp1:
|
||||||
lda FDC_STATUS_A ; $D082
|
lda FDC_STATUS_A ; $D082
|
||||||
and #%01100000
|
and #%01100000
|
||||||
cmp #%01000000 ; XXX is this correct? .A seems to stay at $40 at this point
|
cmp #%01000000 ; XXX is this correct? .A seems to stay at $40 at this point
|
||||||
bne @lp3
|
bne @lp1
|
||||||
|
|
||||||
|
jsr lowlevel_motor_off ; disable drive motor
|
||||||
|
|
||||||
; Copy sector to buffer in RAM
|
; Copy sector to buffer in RAM
|
||||||
|
|
||||||
@@ -116,21 +112,3 @@ lowlevel_readsector_force:
|
|||||||
|
|
||||||
clc
|
clc
|
||||||
rts
|
rts
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
; XXX consider moving these to a separate file
|
|
||||||
|
|
||||||
lowlevel_wait_clr_BUSY:
|
|
||||||
|
|
||||||
bit FDC_STATUS_A ; $D082
|
|
||||||
bmi lowlevel_wait_clr_BUSY
|
|
||||||
|
|
||||||
rts
|
|
||||||
|
|
||||||
lowlevel_wait_set_RDREQ:
|
|
||||||
|
|
||||||
bit FDC_STATUS_B ; $D083
|
|
||||||
bpl lowlevel_wait_set_RDREQ
|
|
||||||
|
|
||||||
rts
|
|
||||||
Reference in new issue
Block a user