hkzlab/TK2000_floppicator
1
0
Fork 0
mirror of https://codeberg.org/hkzlab/TK2000_floppicator.git synced 2025-12-25 09:02:28 +11:00
Code Issues Projects Releases Packages Wiki Activity

Add sound

Browse source
This commit is contained in:
hkz 2025-09-01 16:52:00 +02:00
commit dd7e765732
1 changed files with 11 additions and 1 deletions
Download patch file Download diff file Expand all files Collapse all files

12
src/main.c
View file

@ -113,6 +113,8 @@ __task int main(void) {
dii_power_on(DEFAULT_DRIVE_CONTROLLER_OFFSET, 0);
for(uint8_t cur_trk = 0; cur_trk < TRACKS_AT_ONCE; cur_trk++) {
SND_TAP();
dii_head_reposition(DEFAULT_DRIVE_CONTROLLER_OFFSET, trk_pos_1 << 1, (start_track + cur_trk) << 1);
trk_pos_1 = (start_track + cur_trk);
@ -123,6 +125,7 @@ __task int main(void) {
if(!read_res) {
errors++;
snd_mod_button();
draw_number(errors, 3, 8, CHAR_HEIGHT * (MAP_TOP_OFFSET + 19));
}
}
@ -133,6 +136,8 @@ __task int main(void) {
dii_power_on(DEFAULT_DRIVE_CONTROLLER_OFFSET, 1);
for(uint8_t cur_trk = 0; cur_trk < TRACKS_AT_ONCE; cur_trk++) {
SND_TAP();
dii_head_reposition(DEFAULT_DRIVE_CONTROLLER_OFFSET, trk_pos_2 << 1, (start_track + cur_trk) << 1);
trk_pos_2 = (start_track + cur_trk);
@ -143,6 +148,7 @@ __task int main(void) {
if(write_res) {
errors++;
snd_mod_button();
draw_number(errors, 3, 8, CHAR_HEIGHT * (MAP_TOP_OFFSET + 19));
}
}
@ -158,10 +164,12 @@ __task int main(void) {
// Now, time to check that we wrote things that make sense...
temp_crc_buf = crc_buffer;
for(uint8_t cur_trk = 0; cur_trk < TOT_FLOPPY_TRACKS; cur_trk++) {
SND_TAP();
dii_head_reposition(DEFAULT_DRIVE_CONTROLLER_OFFSET, trk_pos_2 << 1, cur_trk << 1);
trk_pos_2 = cur_trk;
for(uint8_t sec = 0; sec < SECTORS_PER_TRACK; sec++) {
for(uint8_t sec = 0; sec < SECTORS_PER_TRACK; sec++) {
uint8_t read_res = dii_read_sector(DEFAULT_DRIVE_CONTROLLER_OFFSET, trk_pos_2, sec, track_buffer, 0);
draw_char(cur_trk + 1, CHAR_HEIGHT * (MAP_TOP_OFFSET + 2 + sec), 0, read_res ? 102 : 24);
uint8_t crc_check = (calculate_crc8(track_buffer, SECTOR_SIZE) == *(temp_crc_buf++));
@ -169,11 +177,13 @@ __task int main(void) {
if(!read_res) {
errors++;
snd_mod_button();
draw_number(errors, 3, 8, CHAR_HEIGHT * (MAP_TOP_OFFSET + 19));
}
if(!crc_check) {
errors++;
snd_mod_button();
draw_number(errors, 3, 8, CHAR_HEIGHT * (MAP_TOP_OFFSET + 19));
}
}