head align tool starts working
This commit is contained in:
FeralChild64 committed
1 parent
839e67ab8e
commit
175465f6c7
3 files changed
+375
-17
No files matched your search
@@ -26,7 +26,7 @@ tape_common_get_pulse:
|
||||
ldx #%01010001 // start timer, force latch reload, count timer A underflows
|
||||
stx CIA2_CRB // $DD0F
|
||||
|
||||
cmp __pulse_threshold // sdefault pulse check
|
||||
cmp __pulse_threshold // default pulse check
|
||||
rts
|
||||
|
||||
|
||||
|
||||
@@ -42,6 +42,11 @@ tape_common_prepare_cia:
|
||||
// Setup CIA #2 timers
|
||||
|
||||
ldx #$03 // set timer A to 4 ticks
|
||||
|
||||
// FALLTROUGH
|
||||
|
||||
tape_common_prepare_cia_by_x: // entry point for head align tool
|
||||
|
||||
stx CIA2_TIMALO // $DD04
|
||||
ldx #$00
|
||||
stx CIA2_TIMAHI // $DD05
|
||||
|
||||
@@ -12,6 +12,18 @@
|
||||
#if CONFIG_TAPE_HEAD_ALIGN
|
||||
|
||||
|
||||
.label __ha_start = 3 // starting row of the chart
|
||||
|
||||
// Helper tables
|
||||
|
||||
.label __ha_offsets = $1000;
|
||||
.label __ha_masks = $1100;
|
||||
|
||||
// Helper variables
|
||||
|
||||
.label __ha_counter = $1200; // 3 bytes
|
||||
|
||||
|
||||
tape_head_align:
|
||||
|
||||
#if (ROM_LAYOUT_M65 && SEGMENT_KERNAL_0)
|
||||
@@ -22,24 +34,24 @@ tape_head_align:
|
||||
|
||||
#else
|
||||
|
||||
// Start by asking for tape playback
|
||||
// Start by asking for playback
|
||||
|
||||
// jsr tape_ask_play
|
||||
// XXX jsr tape_ask_play
|
||||
|
||||
// Disable interrupts
|
||||
// Disable interrupts, set proper I/O values
|
||||
|
||||
sei
|
||||
|
||||
// Set IO to default values
|
||||
|
||||
jsr IOINIT
|
||||
jsr cint_legacy
|
||||
jsr tape_motor_on
|
||||
ldx #$02 // set timer A to 3 ticks
|
||||
jsr tape_common_prepare_cia_by_x
|
||||
|
||||
// Clear color data ($0800)
|
||||
|
||||
ldy #$00
|
||||
!:
|
||||
lda #($10 + $06) // XXX synchronize colors with setup_vicii
|
||||
lda #($01 * $10 + $06) // XXX synchronize colors with setup_vicii
|
||||
|
||||
sta $0800, y
|
||||
sta $0900, y
|
||||
@@ -49,6 +61,15 @@ tape_head_align:
|
||||
iny
|
||||
bne !-
|
||||
|
||||
// Make sure the row where the chart is created is not visible
|
||||
|
||||
lda #($06 * $10 + $06) // XXX synchronize colors with setup_vicii
|
||||
ldy #$28
|
||||
!:
|
||||
sta $0800 + __ha_start * 40 - 1, y
|
||||
dey
|
||||
bne !-
|
||||
|
||||
// Clear bitmap data ($2000)
|
||||
|
||||
lda #$20
|
||||
@@ -73,23 +94,92 @@ tape_head_align:
|
||||
lda #$3B // set bit 5 to enable graphic mode
|
||||
sta VIC_SCROLY
|
||||
|
||||
// Set tape timing
|
||||
// Prepare lookup tables - to speed drawing, we are going to use two of them:
|
||||
// - byte offset table will tell us which byte in memory to alter
|
||||
// - mask will allow us to quickly put the pixel
|
||||
|
||||
// XXX
|
||||
ldx #$00 // loop index
|
||||
ldy #$00 // temporary value for mask calculation
|
||||
!:
|
||||
// Byte offset is simple, just zero the 3 least significant bits
|
||||
|
||||
txa
|
||||
and #%11111000
|
||||
sta __ha_offsets, x
|
||||
|
||||
// Mask changes with each iteration, use our temporary value in .Y
|
||||
|
||||
tya
|
||||
clc
|
||||
ror
|
||||
bne !+
|
||||
lda #%10000000
|
||||
!:
|
||||
tay
|
||||
sta __ha_masks, x
|
||||
|
||||
// Next iteration
|
||||
|
||||
inx
|
||||
bne !--
|
||||
|
||||
tape_head_align_loop_1:
|
||||
|
||||
// XXX waste pulse
|
||||
// XXX check for STOP key, possibly terminate
|
||||
|
||||
// Scroll the whole chart one line down
|
||||
|
||||
ldx #$00
|
||||
!:
|
||||
jsr tape_head_align_scroll_column
|
||||
|
||||
txa
|
||||
clc
|
||||
adc #$08
|
||||
tax
|
||||
bne !-
|
||||
|
||||
// XXX draw helper lines
|
||||
|
||||
// Initialize counter
|
||||
|
||||
lda #$80
|
||||
sta __ha_counter + 1
|
||||
lda #$00
|
||||
sta __ha_counter + 0
|
||||
sta __ha_counter + 2
|
||||
|
||||
// Skip 2 pulses, these measurements will be too imprecise
|
||||
|
||||
jsr tape_head_align_get_pulse
|
||||
jsr tape_head_align_get_pulse
|
||||
|
||||
tape_head_align_loop_2:
|
||||
|
||||
// XXX get pulse
|
||||
// XXX put pulse
|
||||
// XXX check time; if not enough passed - next iteration tape_head_align_loop2
|
||||
// XXX check for STOP key; if pressed, quit
|
||||
// XXX scroll
|
||||
// Retrieve actual pulse length
|
||||
|
||||
jmp tape_head_align_loop_1
|
||||
jsr tape_head_align_get_pulse
|
||||
cmp #$FF
|
||||
beq tape_head_align_drawn // skip drawing for too long pulses
|
||||
|
||||
// Put pulse on the screen; center the chart horizontaly, with some margin from top
|
||||
|
||||
.label __ha_chart = $2000 + 8 * (40 * __ha_start + 4)
|
||||
|
||||
tax
|
||||
lda __ha_offsets, x
|
||||
tay
|
||||
lda __ha_masks, x
|
||||
ora __ha_chart + 7, y
|
||||
sta __ha_chart + 7, y
|
||||
|
||||
// FALLTROUGH
|
||||
|
||||
tape_head_align_drawn:
|
||||
|
||||
lda __ha_counter + 2
|
||||
beq tape_head_align_loop_2
|
||||
bne tape_head_align_loop_1
|
||||
|
||||
tape_head_align_quit:
|
||||
|
||||
@@ -102,6 +192,269 @@ tape_head_align_quit:
|
||||
cli
|
||||
rts // XXX perform new after quit
|
||||
|
||||
tape_head_align_get_pulse:
|
||||
|
||||
// This routine differs a lot from the one used to read pulse during tape reading:
|
||||
// - it is not as precise
|
||||
// - it terminates when timer reaches $FF
|
||||
// - it updates
|
||||
|
||||
lda #$10
|
||||
!:
|
||||
// Loop to detect signal
|
||||
|
||||
ldy CIA2_TIMBLO // $DD06
|
||||
bit CIA1_ICR // $DC0D
|
||||
bne !+
|
||||
|
||||
cpy #$FF
|
||||
bne !-
|
||||
!:
|
||||
// Start timer again, force latch reload, count timer A underflows
|
||||
|
||||
ldx #%01010001
|
||||
stx CIA2_CRB // $DD0F
|
||||
|
||||
// Update time counter
|
||||
|
||||
tya
|
||||
clc
|
||||
adc __ha_counter + 0
|
||||
sta __ha_counter + 0
|
||||
bcc !+
|
||||
inc __ha_counter + 1
|
||||
bne !+
|
||||
inc __ha_counter + 2
|
||||
!:
|
||||
// Return with time elapsed
|
||||
|
||||
tya
|
||||
rts
|
||||
|
||||
tape_head_align_scroll_column:
|
||||
|
||||
// XXX autogenerate this code somewhere
|
||||
|
||||
lda __ha_chart + 9 * (8 * 40) + 6, x
|
||||
sta __ha_chart + 9 * (8 * 40) + 7, x
|
||||
|
||||
lda __ha_chart + 9 * (8 * 40) + 5, x
|
||||
sta __ha_chart + 9 * (8 * 40) + 6, x
|
||||
|
||||
lda __ha_chart + 9 * (8 * 40) + 4, x
|
||||
sta __ha_chart + 9 * (8 * 40) + 5, x
|
||||
|
||||
lda __ha_chart + 9 * (8 * 40) + 3, x
|
||||
sta __ha_chart + 9 * (8 * 40) + 4, x
|
||||
|
||||
lda __ha_chart + 9 * (8 * 40) + 2, x
|
||||
sta __ha_chart + 9 * (8 * 40) + 3, x
|
||||
|
||||
lda __ha_chart + 9 * (8 * 40) + 1, x
|
||||
sta __ha_chart + 9 * (8 * 40) + 2, x
|
||||
|
||||
lda __ha_chart + 9 * (8 * 40) + 0, x
|
||||
sta __ha_chart + 9 * (8 * 40) + 1, x
|
||||
|
||||
lda __ha_chart + 8 * (8 * 40) + 7, x
|
||||
sta __ha_chart + 9 * (8 * 40) + 0, x
|
||||
|
||||
lda __ha_chart + 8 * (8 * 40) + 6, x
|
||||
sta __ha_chart + 8 * (8 * 40) + 7, x
|
||||
|
||||
lda __ha_chart + 8 * (8 * 40) + 5, x
|
||||
sta __ha_chart + 8 * (8 * 40) + 6, x
|
||||
|
||||
lda __ha_chart + 8 * (8 * 40) + 4, x
|
||||
sta __ha_chart + 8 * (8 * 40) + 5, x
|
||||
|
||||
lda __ha_chart + 8 * (8 * 40) + 3, x
|
||||
sta __ha_chart + 8 * (8 * 40) + 4, x
|
||||
|
||||
lda __ha_chart + 8 * (8 * 40) + 2, x
|
||||
sta __ha_chart + 8 * (8 * 40) + 3, x
|
||||
|
||||
lda __ha_chart + 8 * (8 * 40) + 1, x
|
||||
sta __ha_chart + 8 * (8 * 40) + 2, x
|
||||
|
||||
lda __ha_chart + 8 * (8 * 40) + 0, x
|
||||
sta __ha_chart + 8 * (8 * 40) + 1, x
|
||||
|
||||
lda __ha_chart + 7 * (8 * 40) + 7, x
|
||||
sta __ha_chart + 8 * (8 * 40) + 0, x
|
||||
|
||||
lda __ha_chart + 7 * (8 * 40) + 6, x
|
||||
sta __ha_chart + 7 * (8 * 40) + 7, x
|
||||
|
||||
lda __ha_chart + 7 * (8 * 40) + 5, x
|
||||
sta __ha_chart + 7 * (8 * 40) + 6, x
|
||||
|
||||
lda __ha_chart + 7 * (8 * 40) + 4, x
|
||||
sta __ha_chart + 7 * (8 * 40) + 5, x
|
||||
|
||||
lda __ha_chart + 7 * (8 * 40) + 3, x
|
||||
sta __ha_chart + 7 * (8 * 40) + 4, x
|
||||
|
||||
lda __ha_chart + 7 * (8 * 40) + 2, x
|
||||
sta __ha_chart + 7 * (8 * 40) + 3, x
|
||||
|
||||
lda __ha_chart + 7 * (8 * 40) + 1, x
|
||||
sta __ha_chart + 7 * (8 * 40) + 2, x
|
||||
|
||||
lda __ha_chart + 7 * (8 * 40) + 0, x
|
||||
sta __ha_chart + 7 * (8 * 40) + 1, x
|
||||
|
||||
lda __ha_chart + 6 * (8 * 40) + 7, x
|
||||
sta __ha_chart + 7 * (8 * 40) + 0, x
|
||||
|
||||
lda __ha_chart + 6 * (8 * 40) + 6, x
|
||||
sta __ha_chart + 6 * (8 * 40) + 7, x
|
||||
|
||||
lda __ha_chart + 6 * (8 * 40) + 5, x
|
||||
sta __ha_chart + 6 * (8 * 40) + 6, x
|
||||
|
||||
lda __ha_chart + 6 * (8 * 40) + 4, x
|
||||
sta __ha_chart + 6 * (8 * 40) + 5, x
|
||||
|
||||
lda __ha_chart + 6 * (8 * 40) + 3, x
|
||||
sta __ha_chart + 6 * (8 * 40) + 4, x
|
||||
|
||||
lda __ha_chart + 6 * (8 * 40) + 2, x
|
||||
sta __ha_chart + 6 * (8 * 40) + 3, x
|
||||
|
||||
lda __ha_chart + 6 * (8 * 40) + 1, x
|
||||
sta __ha_chart + 6 * (8 * 40) + 2, x
|
||||
|
||||
lda __ha_chart + 6 * (8 * 40) + 0, x
|
||||
sta __ha_chart + 6 * (8 * 40) + 1, x
|
||||
|
||||
lda __ha_chart + 5 * (8 * 40) + 7, x
|
||||
sta __ha_chart + 6 * (8 * 40) + 0, x
|
||||
|
||||
lda __ha_chart + 5 * (8 * 40) + 6, x
|
||||
sta __ha_chart + 5 * (8 * 40) + 7, x
|
||||
|
||||
lda __ha_chart + 5 * (8 * 40) + 5, x
|
||||
sta __ha_chart + 5 * (8 * 40) + 6, x
|
||||
|
||||
lda __ha_chart + 5 * (8 * 40) + 4, x
|
||||
sta __ha_chart + 5 * (8 * 40) + 5, x
|
||||
|
||||
lda __ha_chart + 5 * (8 * 40) + 3, x
|
||||
sta __ha_chart + 5 * (8 * 40) + 4, x
|
||||
|
||||
lda __ha_chart + 5 * (8 * 40) + 2, x
|
||||
sta __ha_chart + 5 * (8 * 40) + 3, x
|
||||
|
||||
lda __ha_chart + 5 * (8 * 40) + 1, x
|
||||
sta __ha_chart + 5 * (8 * 40) + 2, x
|
||||
|
||||
lda __ha_chart + 5 * (8 * 40) + 0, x
|
||||
sta __ha_chart + 5 * (8 * 40) + 1, x
|
||||
|
||||
lda __ha_chart + 4 * (8 * 40) + 7, x
|
||||
sta __ha_chart + 5 * (8 * 40) + 0, x
|
||||
|
||||
lda __ha_chart + 4 * (8 * 40) + 6, x
|
||||
sta __ha_chart + 4 * (8 * 40) + 7, x
|
||||
|
||||
lda __ha_chart + 4 * (8 * 40) + 5, x
|
||||
sta __ha_chart + 4 * (8 * 40) + 6, x
|
||||
|
||||
lda __ha_chart + 4 * (8 * 40) + 4, x
|
||||
sta __ha_chart + 4 * (8 * 40) + 5, x
|
||||
|
||||
lda __ha_chart + 4 * (8 * 40) + 3, x
|
||||
sta __ha_chart + 4 * (8 * 40) + 4, x
|
||||
|
||||
lda __ha_chart + 4 * (8 * 40) + 2, x
|
||||
sta __ha_chart + 4 * (8 * 40) + 3, x
|
||||
|
||||
lda __ha_chart + 4 * (8 * 40) + 1, x
|
||||
sta __ha_chart + 4 * (8 * 40) + 2, x
|
||||
|
||||
lda __ha_chart + 4 * (8 * 40) + 0, x
|
||||
sta __ha_chart + 4 * (8 * 40) + 1, x
|
||||
|
||||
lda __ha_chart + 3 * (8 * 40) + 7, x
|
||||
sta __ha_chart + 4 * (8 * 40) + 0, x
|
||||
|
||||
lda __ha_chart + 3 * (8 * 40) + 6, x
|
||||
sta __ha_chart + 3 * (8 * 40) + 7, x
|
||||
|
||||
lda __ha_chart + 3 * (8 * 40) + 5, x
|
||||
sta __ha_chart + 3 * (8 * 40) + 6, x
|
||||
|
||||
lda __ha_chart + 3 * (8 * 40) + 4, x
|
||||
sta __ha_chart + 3 * (8 * 40) + 5, x
|
||||
|
||||
lda __ha_chart + 3 * (8 * 40) + 3, x
|
||||
sta __ha_chart + 3 * (8 * 40) + 4, x
|
||||
|
||||
lda __ha_chart + 3 * (8 * 40) + 2, x
|
||||
sta __ha_chart + 3 * (8 * 40) + 3, x
|
||||
|
||||
lda __ha_chart + 3 * (8 * 40) + 1, x
|
||||
sta __ha_chart + 3 * (8 * 40) + 2, x
|
||||
|
||||
lda __ha_chart + 3 * (8 * 40) + 0, x
|
||||
sta __ha_chart + 3 * (8 * 40) + 1, x
|
||||
|
||||
lda __ha_chart + 2 * (8 * 40) + 7, x
|
||||
sta __ha_chart + 3 * (8 * 40) + 0, x
|
||||
|
||||
lda __ha_chart + 2 * (8 * 40) + 6, x
|
||||
sta __ha_chart + 2 * (8 * 40) + 7, x
|
||||
|
||||
lda __ha_chart + 2 * (8 * 40) + 5, x
|
||||
sta __ha_chart + 2 * (8 * 40) + 6, x
|
||||
|
||||
lda __ha_chart + 2 * (8 * 40) + 4, x
|
||||
sta __ha_chart + 2 * (8 * 40) + 5, x
|
||||
|
||||
lda __ha_chart + 2 * (8 * 40) + 3, x
|
||||
sta __ha_chart + 2 * (8 * 40) + 4, x
|
||||
|
||||
lda __ha_chart + 2 * (8 * 40) + 2, x
|
||||
sta __ha_chart + 2 * (8 * 40) + 3, x
|
||||
|
||||
lda __ha_chart + 2 * (8 * 40) + 1, x
|
||||
sta __ha_chart + 2 * (8 * 40) + 2, x
|
||||
|
||||
lda __ha_chart + 2 * (8 * 40) + 0, x
|
||||
sta __ha_chart + 2 * (8 * 40) + 1, x
|
||||
|
||||
lda __ha_chart + 1 * (8 * 40) + 7, x
|
||||
sta __ha_chart + 2 * (8 * 40) + 0, x
|
||||
|
||||
lda __ha_chart + 1 * (8 * 40) + 6, x
|
||||
sta __ha_chart + 1 * (8 * 40) + 7, x
|
||||
|
||||
lda __ha_chart + 1 * (8 * 40) + 5, x
|
||||
sta __ha_chart + 1 * (8 * 40) + 6, x
|
||||
|
||||
lda __ha_chart + 1 * (8 * 40) + 4, x
|
||||
sta __ha_chart + 1 * (8 * 40) + 5, x
|
||||
|
||||
lda __ha_chart + 1 * (8 * 40) + 3, x
|
||||
sta __ha_chart + 1 * (8 * 40) + 4, x
|
||||
|
||||
lda __ha_chart + 1 * (8 * 40) + 2, x
|
||||
sta __ha_chart + 1 * (8 * 40) + 3, x
|
||||
|
||||
lda __ha_chart + 1 * (8 * 40) + 1, x
|
||||
sta __ha_chart + 1 * (8 * 40) + 2, x
|
||||
|
||||
lda __ha_chart + 1 * (8 * 40) + 0, x
|
||||
sta __ha_chart + 1 * (8 * 40) + 1, x
|
||||
|
||||
lda __ha_chart + 0 * (8 * 40) + 7, x
|
||||
sta __ha_chart + 1 * (8 * 40) + 0, x
|
||||
|
||||
lda #$00
|
||||
sta __ha_chart + 0 * (8 * 40) + 7, x
|
||||
|
||||
rts
|
||||
|
||||
#endif // ROM layout
|
||||
|
||||
|
||||
Reference in new issue
Block a user