void drive_set_last_read(unsigned int track, unsigned int sector, BYTE *buffer,
struct drive_context_s *drv)
{
drive_t *drive;
int side = 0;
drive = drv->drive;
drive_gcr_data_writeback(drive);
if (drive->type == DRIVE_TYPE_1570
|| drive->type == DRIVE_TYPE_1571
|| drive->type == DRIVE_TYPE_1571CR) {
if (track > 35) {
track -= 35;
side = 1;
}
}
drive_set_half_track(track * 2, side, drive);
if (drive->type == DRIVE_TYPE_1540
|| drive->type == DRIVE_TYPE_1541
|| drive->type == DRIVE_TYPE_1541II
|| drive->type == DRIVE_TYPE_1570
|| drive->type == DRIVE_TYPE_1571
|| drive->type == DRIVE_TYPE_1571CR) {
memcpy(&(drv->drive->drive_ram[0x0400]), buffer, 256);
}
}
/* Disable full drive emulation. */
void drive_disable(drive_context_t *drv)
{
int drive_true_emulation = 0;
drive_t *drive;
drive = drv->drive;
/* This must come first, because this might be called before the true
drive initialization. */
drive->enable = 0;
resources_get_int("DriveTrueEmulation", &drive_true_emulation);
if (rom_loaded) {
if (drive->type == DRIVE_TYPE_2000 || drive->type == DRIVE_TYPE_4000) {
drivecpu65c02_sleep(drv);
} else {
drivecpu_sleep(drv);
}
machine_drive_port_default(drv);
drive_gcr_data_writeback(drive);
}
/* Make sure the UI is updated. */
drive_enable_update_ui(drv);
}
/* Increment the head position by `step' half-tracks. Valid values
for `step' are `+1' and `-1'. */
void drive_move_head(int step, drive_t *drive)
{
drive_gcr_data_writeback(drive);
if (drive->type == DRIVE_TYPE_1571
|| drive->type == DRIVE_TYPE_1571CR) {
if (drive->current_half_track + step == 71)
return;
}
drive_set_half_track(drive->current_half_track + step, drive);
}
void drive_gcr_data_writeback_all(void)
{
drive_t *drive;
unsigned int i;
for (i = 0; i < DRIVE_NUM; i++)
{
drive = drive_context[i]->drive;
drive_gcr_data_writeback(drive);
}
}
/* Disable full drive emulation. */
void drive_disable(drive_context_t *drv)
{
int i, drive_true_emulation = 0;
unsigned int dnr;
drive_t *drive;
unsigned int enabled_drives = 0;
dnr = drv->mynumber;
drive = drv->drive;
/* This must come first, because this might be called before the true
drive initialization. */
drive->enable = 0;
resources_get_int("DriveTrueEmulation", &drive_true_emulation);
if (rom_loaded) {
drivecpu_sleep(drv);
machine_drive_port_default(drv);
drive_gcr_data_writeback(drive);
}
/* Make sure the UI is updated. */
for (i = 0; i < DRIVE_NUM; i++) {
unsigned int the_drive;
the_drive = 1 << i;
if (drive_context[i]->drive->enable) {
enabled_drives |= the_drive;
drive_context[i]->drive->old_led_status = -1;
drive_context[i]->drive->old_half_track = -1;
}
}
ui_enable_drive_status(enabled_drives,
drive_led_color);
#if 0
ui_enable_drive_status((drive_context[0]->drive->enable
? UI_DRIVE_ENABLE_0 : 0)
| ((drive_context[1]->drive->enable
|| (drive_context[0]->drive->enable
&& drive_check_dual(drive_context[0]->drive->type))
) ? UI_DRIVE_ENABLE_1 : 0),
drive_led_color);
/*
ui_enable_drive_status((drive_context[0]->drive->enable
? UI_DRIVE_ENABLE_0 : 0)
| (drive_context[1]->drive->enable
? UI_DRIVE_ENABLE_1 : 0),
drive_led_color);
*/
#endif
}
/* Detach a disk image from the true drive emulation. */
int drive_image_detach(disk_image_t *image, unsigned int unit)
{
unsigned int dnr, i;
drive_t *drive;
if (unit < 8 || unit >= 8 + DRIVE_NUM) {
return -1;
}
dnr = unit - 8;
drive = drive_context[dnr]->drive;
if (drive->image != NULL) {
switch (image->type) {
case DISK_IMAGE_TYPE_D64:
case DISK_IMAGE_TYPE_D67:
case DISK_IMAGE_TYPE_D71:
case DISK_IMAGE_TYPE_G64:
case DISK_IMAGE_TYPE_P64:
case DISK_IMAGE_TYPE_X64:
disk_image_detach_log(image, driveimage_log, unit);
break;
default:
return -1;
}
}
if (drive->P64_image_loaded && drive->P64_dirty) {
drive->P64_dirty = 0;
if (disk_image_write_p64_image(drive->image) < 0) {
log_error(drive->log, "Cannot write disk image back.");
}
} else {
drive_gcr_data_writeback(drive);
}
for (i = 0; i < MAX_GCR_TRACKS; i++) {
if (drive->gcr->tracks[i].data) {
lib_free(drive->gcr->tracks[i].data);
drive->gcr->tracks[i].data = NULL;
drive->gcr->tracks[i].size = 0;
}
}
drive->detach_clk = drive_clk[dnr];
drive->GCR_image_loaded = 0;
drive->P64_image_loaded = 0;
drive->read_only = 0;
drive->image = NULL;
drive_set_half_track(drive->current_half_track, drive->side, drive);
return 0;
}
void drive_gcr_data_writeback_all(void)
{
drive_t *drive;
unsigned int i;
for (i = 0; i < DRIVE_NUM; i++) {
drive = drive_context[i]->drive;
drive_gcr_data_writeback(drive);
if (drive->P64_image_loaded && drive->image && drive->image->p64) {
if (drive->image->type == DISK_IMAGE_TYPE_P64) {
if (drive->P64_dirty) {
drive->P64_dirty = 0;
disk_image_write_p64_image(drive->image);
}
}
}
}
}
/* Detach a disk image from the true drive emulation. */
int drive_image_detach(disk_image_t *image, unsigned int unit)
{
unsigned int dnr;
drive_t *drive;
if (unit < 8 || unit >= 8 + DRIVE_NUM)
return -1;
dnr = unit - 8;
drive = drive_context[dnr]->drive;
if (drive->image != NULL)
{
switch(image->type)
{
case DISK_IMAGE_TYPE_D64:
case DISK_IMAGE_TYPE_D67:
case DISK_IMAGE_TYPE_D71:
case DISK_IMAGE_TYPE_G64:
case DISK_IMAGE_TYPE_X64:
disk_image_detach_log(image, 0, unit);
break;
default:
return -1;
}
}
drive_gcr_data_writeback(drive);
memset(drive->gcr->data, 0, MAX_GCR_TRACKS * NUM_MAX_BYTES_TRACK);
drive->detach_clk = drive_clk[dnr];
drive->GCR_image_loaded = 0;
drive->read_only = 0;
drive->image = NULL;
return 0;
}
/* Increment the head position by `step' half-tracks. Valid values
for `step' are `+1', '+2' and `-1'. */
void drive_move_head(int step, drive_t *drive)
{
drive_gcr_data_writeback(drive);
drive_sound_head(drive->current_half_track, step, drive->mynumber);
drive_set_half_track(drive->current_half_track + step, drive->side, drive);
}