Apple-2-HW/micro-sci-a2-controller
1
0
Fork 0
mirror of https://codeberg.org/cryu/micro-sci-a2-controller synced 2024-11-28 11:51:11 +00:00
Code Issues Packages Projects Releases Wiki Activity

Reformat for readability.

Browse Source
This commit is contained in:
Christopher RYU 2023-07-29 06:08:13 +09:00
parent def53563b0
commit 61dc141610
1 changed files with 22 additions and 19 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

41
firmware/util.s
View File

@ -43,7 +43,7 @@ LC604: jsr BELL
LC607: jsr GETLNZ ; start new line and take input LC607: jsr GETLNZ ; start new line and take input
lda #$00 lda #$00
sta $F2 sta $F2
LC60E: sta KBDSTRB ; clear keyboard strobe PARSER: sta KBDSTRB ; clear keyboard strobe
sta $F3 sta $F3
ldy $F2 ldy $F2
jsr GETNUM ; parse hex into A2, A has last char xor $b0 jsr GETNUM ; parse hex into A2, A has last char xor $b0
@ -70,13 +70,13 @@ LC60E: sta KBDSTRB ; clear keyboard strobe
bne LC604 ; BEEP and prompt for new input bne LC604 ; BEEP and prompt for new input
brk ; 'Q' exits out brk ; 'Q' exits out
; 'R': recalibrate by seeking track $00 from track $50 ; 'R': recalibrate by seeking track 0 from track 80
CMD_R: lda #$50 ; set starting track to #$50 CMD_R: lda #80 ; set starting track
sta $FC ; store accumulator as 'current' track at $FC sta $FC ; store accumulator as 'current' track at $FC
txa ; set accumulator to 0 txa ; set accumulator to 0
adc #$00 ; inc A (carry still set from CMP #$EB) adc #$00 ; inc A (carry still set from CMP #$EB)
sta $F3 ; set ($F3)=01 sta $F3 ; set ($F3)=01
lda #$00 ; pass target track #$00 through accumulator lda #$00 ; pass target track 0 through accumulator
beq LC651 ; branch to end of 'S' command to finish beq LC651 ; branch to end of 'S' command to finish
; 'S': seek logical-track index in A2L ('22S' seeks logical track $22) ; 'S': seek logical-track index in A2L ('22S' seeks logical track $22)
@ -92,8 +92,9 @@ CMD_Z: lda A2L ; load logical track-index from A2L
sta $F1 ; store as target track in $F1 sta $F1 ; store as target track in $F1
ldy #$00 ; value to stored at $09 = #$00 ldy #$00 ; value to stored at $09 = #$00
beq CMD_MX ; branch to 'M' command for next step beq CMD_MX ; branch to 'M' command for next step
; temporarily stop motor, then branch to turn it on again ; temporarily stop motor, then branch to turn it on again
LC660: lda #$50 STOP_MOTOR: lda #$50
jsr MON_WAIT jsr MON_WAIT
sta MOTOROFF,x sta MOTOROFF,x
ldy A2L ldy A2L
@ -103,11 +104,11 @@ LC66A: jsr MON_WAIT
bmi LC68E bmi LC68E
; EXIT THRU GIFT SHOP, current command finished, go back to parser ; EXIT THRU GIFT SHOP, current command finished, go back to parser
LC672: lda #$00 DONE: lda #$00
beq LC60E beq PARSER
; 'W' command, write nibble-pattern in A2L (eg: "96W" writes 96 96 96...) ; 'W' command, write nibble-pattern in A2L (eg: "96W" writes 96 96 96...)
CMD_W: lda A2L CMD_W: lda A2L ; pattern to write
sta $FF sta $FF
ldy #$0F ldy #$0F
@ -134,27 +135,29 @@ LC68E: sta MOTORON,x
sta Q7ON,x ; start writing/erasing sta Q7ON,x ; start writing/erasing
LC69D: lda $09 ; [3 cycles] reload saved Y byte LC69D: lda $09 ; [3 cycles] reload saved Y byte
asl a ; [2] shift-left to test second bit asl a ; [2] shift-left to test second bit
bmi LC660 ; [2] branch to stop motor for 'M' and 'X' and 'S' commands bmi STOP_MOTOR ; [2] branch to stop motor for M/X/S commands
nop nop
nop nop
lda $FF ; byte value to be written lda $FF ; byte value to be written
sta Q6ON,x ; store into data register (wrong timing for Disk II, it would probably write $DD instead) sta Q6ON,x ; store into data register
; (wrong timing for Disk II, it would probably
; write $DD instead)
cmp Q6OFF,x ; [4] shift data-out cmp Q6OFF,x ; [4] shift data-out
LC6AC: lda KBD ; get keypress LC6AC: lda KBD ; get keypress
eor #$9B ; ESC? eor #$9B ; ESC?
bne LC69D ; if not, continue loop bne LC69D ; if not, continue loop
ldx SLOTx16 ldx SLOTx16
sta Q7OFF,x sta Q7OFF,x
LC6B8: beq LC672 ; all done, branch to branch-to-parser LC6B8: beq DONE ; all done, branch to branch-to-parser
LC6BA: ldx SLOTx16 LC6BA: ldx SLOTx16
sta MOTORON,x sta MOTORON,x
LC6BF: ldy $FC LC6BF: ldy $FC
LC6C1: cpy $F0 ; compare track index in Y to target track (result in carry flag) LC6C1: cpy $F0 ; compare track index in Y to target track (result in carry flag)
bne LC6E3 ; track doesn't match, go to stepper routine bne LC6E3 ; track doesn't match, go to stepper routine
lda $F0 ; load current track into accumulator (redundant, same value is already in Y reg) lda $F0 ; load current track into A (why not tya?)
sta $FC ; store current track sta $FC ; store current track
lda $09 lda $09
bne LC672 ; Y=00, branch for 'Z' bne DONE ; Y=00, branch for 'Z'
lda $F0 ; exchange target track indexes in $F0 vs $F1 lda $F0 ; exchange target track indexes in $F0 vs $F1
ldy $F1 ldy $F1
sta $F1 sta $F1
@ -172,14 +175,14 @@ LC6E7: dey
tya tya
and #$03 ; mask track to just 4 low bits, numbers 00-01-02-03 and #$03 ; mask track to just 4 low bits, numbers 00-01-02-03
asl a ; shift left, convert to stepper-motor phases 02-04-06-08 asl a ; shift left, convert to stepper-motor phases 02-04-06-08
ora SLOTx16 ; bitwise-OR to make it into a DEVSEL-relative IO address ora SLOTx16 ; bitwise-OR for DEVSEL-relative IO address
tax ; move it into X reg for IO tax ; move it into X for IO
lsr a ; shift right to make track number again lsr a ; shift right to make track number again
lsr a ; now shift low-bit into carry flag (odd vs even) lsr a ; shift low-bit into carry flag (odd vs even)
sta STEPON,x ; turn on stepper motor phase indicated in X reg sta STEPON,x ; turn on stepper motor phase indicated in X
nop ; dead code nop ; dead code
nop nop
lda #$56 lda #$56
jsr MON_WAIT ; wait stepper delay (returns with A=00, carry set) jsr MON_WAIT ; wait stepper delay (returns A=00, carry set)
sta STEPOFF,x ; turn off stepper motor phase indicated in X reg sta STEPOFF,x ; turn off stepper motor phase indicated in X
bcs LC6C1 ; branch always bcs LC6C1 ; branch always