463 lines
9.5 KiB
ArmAsm
463 lines
9.5 KiB
ArmAsm
// #LAYOUT# STD * #TAKE
|
|
// #LAYOUT# M65 KERNAL_1 #TAKE
|
|
// #LAYOUT# * * #IGNORE
|
|
|
|
//
|
|
// Tape (normal) helper routine - reading speed calibration
|
|
//
|
|
// Needs pulse length in .A
|
|
//
|
|
|
|
|
|
#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)
|
|
|
|
jsr map_KERNAL_1
|
|
jsr_ind VK1__tape_head_align
|
|
jmp map_NORMAL
|
|
|
|
#else
|
|
|
|
// Start by asking for playback
|
|
|
|
// XXX jsr tape_ask_play
|
|
|
|
// Disable interrupts, set proper I/O values
|
|
|
|
sei
|
|
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 #($01 * $10 + $06) // XXX synchronize colors with setup_vicii
|
|
|
|
sta $0800, y
|
|
sta $0900, y
|
|
sta $0A00, y
|
|
sta $0B00, y
|
|
|
|
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
|
|
sta SAL+1
|
|
tya // put 0 to .A
|
|
sta SAL+0
|
|
!:
|
|
sta (SAL), y
|
|
iny
|
|
bne !-
|
|
|
|
inc SAL+1
|
|
ldx SAL+1
|
|
cpx #$40
|
|
bne !-
|
|
|
|
// Set graphics mode
|
|
|
|
lda #$28 // graphic memory start at $2000, color at $0800
|
|
sta VIC_YMCSB
|
|
|
|
lda #$3B // set bit 5 to enable graphic mode
|
|
sta VIC_SCROLY
|
|
|
|
// 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
|
|
|
|
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 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:
|
|
|
|
// Retrieve actual pulse length
|
|
|
|
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:
|
|
|
|
// Clear screen, restore old display settings
|
|
|
|
jsr cint_legacy
|
|
|
|
// XXX restore COLOR, VIC_EXTCOL, VIC_BGCOL0, CIA2_PRA
|
|
|
|
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
|
|
|
|
|
|
#endif // CONFIG_TAPE_HEAD_ALIGN
|