///////////////////////////////////////////////////////////////////////// // $Id$ ///////////////////////////////////////////////////////////////////////// // // Copyright (C) 2001-2021 The Bochs Project // // This library is free software; you can redistribute it and/or // modify it under the terms of the GNU Lesser General Public // License as published by the Free Software Foundation; either // version 2 of the License, or (at your option) any later version. // // This library is distributed in the hope that it will be useful, // but WITHOUT ANY WARRANTY; without even the implied warranty of // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU // Lesser General Public License for more details. // // You should have received a copy of the GNU Lesser General Public // License along with this library; if not, write to the Free Software // Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA ///////////////////////////////////////////////////////////////////////// // Useful docs: // AT Attachment with Packet Interface // working draft by T13 at www.t13.org // Define BX_PLUGGABLE in files that can be compiled into plugins. For // platforms that require a special tag on exported symbols, BX_PLUGGABLE // is used to know when we are exporting symbols and when we are importing. #define BX_PLUGGABLE #include "iodev.h" #include "harddrv.h" #include "hdimage/hdimage.h" #include "hdimage/cdrom.h" #define LOG_THIS theHardDrive-> #define BX_DEBUG_ATAPI(x) (atapilog->ldebug) x #define INDEX_PULSE_CYCLE 10 #define PACKET_SIZE 12 // some packet handling macros #define EXTRACT_FIELD(arr,byte,start,num_bits) (((arr)[(byte)] >> (start)) & ((1 << (num_bits)) - 1)) #define get_packet_field(controller,b,s,n) (EXTRACT_FIELD((controller->buffer),(b),(s),(n))) #define get_packet_byte(controller,b) (controller->buffer[(b)]) #define get_packet_word(controller,b) (((Bit16u)controller->buffer[(b)] << 8) | controller->buffer[(b)+1]) #define BX_CONTROLLER(c,a) (BX_HD_THIS channels[(c)].drives[(a)]).controller #define BX_DRIVE(c,a) (BX_HD_THIS channels[(c)].drives[(a)]) #define BX_DRIVE_IS_PRESENT(c,a) (BX_HD_THIS channels[(c)].drives[(a)].device_type != IDE_NONE) #define BX_DRIVE_IS_HD(c,a) (BX_HD_THIS channels[(c)].drives[(a)].device_type == IDE_DISK) #define BX_DRIVE_IS_CD(c,a) (BX_HD_THIS channels[(c)].drives[(a)].device_type == IDE_CDROM) #define BX_MASTER_IS_PRESENT(c) BX_DRIVE_IS_PRESENT((c),0) #define BX_SLAVE_IS_PRESENT(c) BX_DRIVE_IS_PRESENT((c),1) #define BX_ANY_IS_PRESENT(c) (BX_DRIVE_IS_PRESENT((c),0) || BX_DRIVE_IS_PRESENT((c),1)) #define BX_SELECTED_CONTROLLER(c) (BX_CONTROLLER((c),BX_HD_THIS channels[(c)].drive_select)) #define BX_SELECTED_DRIVE(c) (BX_DRIVE((c),BX_HD_THIS channels[(c)].drive_select)) #define BX_MASTER_SELECTED(c) (!BX_HD_THIS channels[(c)].drive_select) #define BX_SLAVE_SELECTED(c) (BX_HD_THIS channels[(c)].drive_select) #define BX_SELECTED_IS_PRESENT(c) (BX_DRIVE_IS_PRESENT((c),BX_SLAVE_SELECTED((c)))) #define BX_SELECTED_IS_HD(c) (BX_DRIVE_IS_HD((c),BX_SLAVE_SELECTED((c)))) #define BX_SELECTED_IS_CD(c) (BX_DRIVE_IS_CD((c),BX_SLAVE_SELECTED((c)))) #define BX_SELECTED_MODEL(c) (BX_HD_THIS channels[(c)].drives[BX_HD_THIS channels[(c)].drive_select].model_no) #define BX_SELECTED_TYPE_STRING(channel) ((BX_SELECTED_IS_CD(channel)) ? "CD-ROM" : "DISK") #define WRITE_FEATURES(c,a) do { Bit8u _a = a; \ BX_CONTROLLER((c),0).hob.feature = BX_CONTROLLER((c),0).features; \ BX_CONTROLLER((c),1).hob.feature = BX_CONTROLLER((c),1).features; \ BX_CONTROLLER((c),0).features = _a; BX_CONTROLLER((c),1).features = _a; } while(0) #define WRITE_SECTOR_COUNT(c,a) do { Bit8u _a = a; \ BX_CONTROLLER((c),0).hob.nsector = BX_CONTROLLER((c),0).sector_count; \ BX_CONTROLLER((c),1).hob.nsector = BX_CONTROLLER((c),1).sector_count; \ BX_CONTROLLER((c),0).sector_count = _a; BX_CONTROLLER((c),1).sector_count = _a; } while(0) #define WRITE_SECTOR_NUMBER(c,a) do { Bit8u _a = a; \ BX_CONTROLLER((c),0).hob.sector = BX_CONTROLLER((c),0).sector_no; \ BX_CONTROLLER((c),1).hob.sector = BX_CONTROLLER((c),1).sector_no; \ BX_CONTROLLER((c),0).sector_no = _a; BX_CONTROLLER((c),1).sector_no = _a; } while(0) #define WRITE_CYLINDER_LOW(c,a) do { Bit8u _a = a; \ BX_CONTROLLER((c),0).hob.lcyl = (Bit8u)(BX_CONTROLLER((c),0).cylinder_no & 0xff); \ BX_CONTROLLER((c),1).hob.lcyl = (Bit8u)(BX_CONTROLLER((c),1).cylinder_no & 0xff); \ BX_CONTROLLER((c),0).cylinder_no = (BX_CONTROLLER((c),0).cylinder_no & 0xff00) | _a; \ BX_CONTROLLER((c),1).cylinder_no = (BX_CONTROLLER((c),1).cylinder_no & 0xff00) | _a; } while(0) #define WRITE_CYLINDER_HIGH(c,a) do { Bit16u _a = a; \ BX_CONTROLLER((c),0).hob.hcyl = (Bit8u)(BX_CONTROLLER((c),0).cylinder_no >> 8); \ BX_CONTROLLER((c),1).hob.hcyl = (Bit8u)(BX_CONTROLLER((c),1).cylinder_no >> 8); \ BX_CONTROLLER((c),0).cylinder_no = (_a << 8) | (BX_CONTROLLER((c),0).cylinder_no & 0xff); \ BX_CONTROLLER((c),1).cylinder_no = (_a << 8) | (BX_CONTROLLER((c),1).cylinder_no & 0xff); } while(0) #define WRITE_HEAD_NO(c,a) do { Bit8u _a = a; BX_CONTROLLER((c),0).head_no = _a; BX_CONTROLLER((c),1).head_no = _a; } while(0) #define WRITE_LBA_MODE(c,a) do { Bit8u _a = a; BX_CONTROLLER((c),0).lba_mode = _a; BX_CONTROLLER((c),1).lba_mode = _a; } while(0) BX_CPP_INLINE Bit16u read_16bit(const Bit8u* buf) { return (buf[0] << 8) | buf[1]; } BX_CPP_INLINE Bit32u read_32bit(const Bit8u* buf) { return (buf[0] << 24) | (buf[1] << 16) | (buf[2] << 8) | buf[3]; } bx_hard_drive_c *theHardDrive = NULL; logfunctions *atapilog = NULL; PLUGIN_ENTRY_FOR_MODULE(harddrv) { if (mode == PLUGIN_INIT) { theHardDrive = new bx_hard_drive_c(); bx_devices.pluginHardDrive = theHardDrive; BX_REGISTER_DEVICE_DEVMODEL(plugin, type, theHardDrive, BX_PLUGIN_HARDDRV); } else if (mode == PLUGIN_FINI) { delete theHardDrive; } else { return (int)PLUGTYPE_STANDARD; } return(0); // Success } bx_hard_drive_c::bx_hard_drive_c() { put("harddrv", "HD"); atapilog = new logfunctions(); atapilog->put("atapi", "ATAPI"); for (Bit8u channel=0; channelunregister_runtime_config_handler(rt_conf_id); for (Bit8u channel=0; channelclose(); delete channels[channel].drives[device].hdimage; channels[channel].drives[device].hdimage = NULL; } if (channels[channel].drives[device].cdrom.cd != NULL) { delete channels[channel].drives[device].cdrom.cd; channels[channel].drives[device].cdrom.cd = NULL; } if (channels[channel].drives[device].controller.buffer != NULL) { delete [] channels[channel].drives[device].controller.buffer; } sprintf(ata_name, "ata.%d.%s", channel, (device==0)?"master":"slave"); base = (bx_list_c*) SIM->get_param(ata_name); SIM->get_param_string("path", base)->set_handler(NULL); SIM->get_param_enum("status", base)->set_handler(NULL); } } ((bx_list_c*)SIM->get_param(BXPN_MENU_RUNTIME_CDROM))->clear(); SIM->get_bochs_root()->remove("hard_drive"); delete atapilog; BX_DEBUG(("Exit")); } void bx_hard_drive_c::init(void) { Bit8u channel; char string[5]; char sbtext[8]; char ata_name[20]; char pname[10]; const char *image_mode; bx_list_c *base; BX_DEBUG(("Init $Id$")); for (channel=0; channelget_param(ata_name); if (SIM->get_param_bool("enabled", base)->get() == 1) { BX_HD_THIS channels[channel].ioaddr1 = SIM->get_param_num("ioaddr1", base)->get(); BX_HD_THIS channels[channel].ioaddr2 = SIM->get_param_num("ioaddr2", base)->get(); BX_HD_THIS channels[channel].irq = SIM->get_param_num("irq", base)->get(); // Coherency check if ((BX_HD_THIS channels[channel].ioaddr1 == 0) || (BX_HD_THIS channels[channel].ioaddr2 == 0) || (BX_HD_THIS channels[channel].irq == 0)) { BX_PANIC(("incoherency for ata channel %d: io1=0x%x, io2=%x, irq=%d", channel, BX_HD_THIS channels[channel].ioaddr1, BX_HD_THIS channels[channel].ioaddr2, BX_HD_THIS channels[channel].irq)); } } else { BX_HD_THIS channels[channel].ioaddr1 = 0; BX_HD_THIS channels[channel].ioaddr2 = 0; BX_HD_THIS channels[channel].irq = 0; } } for (channel=0; channelget_param(ata_name); // Initialize controller state, even if device is not present BX_CONTROLLER(channel,device).status.busy = 0; BX_CONTROLLER(channel,device).status.drive_ready = 1; BX_CONTROLLER(channel,device).status.write_fault = 0; BX_CONTROLLER(channel,device).status.seek_complete = 1; BX_CONTROLLER(channel,device).status.drq = 0; BX_CONTROLLER(channel,device).status.corrected_data = 0; BX_CONTROLLER(channel,device).status.index_pulse = 0; BX_CONTROLLER(channel,device).status.index_pulse_count = 0; BX_CONTROLLER(channel,device).status.err = 0; BX_CONTROLLER(channel,device).error_register = 0x01; // diagnostic code: no error BX_CONTROLLER(channel,device).head_no = 0; BX_CONTROLLER(channel,device).sector_count = 1; BX_CONTROLLER(channel,device).sector_no = 1; BX_CONTROLLER(channel,device).cylinder_no = 0; BX_CONTROLLER(channel,device).current_command = 0x00; BX_CONTROLLER(channel,device).buffer_total_size = 0; BX_CONTROLLER(channel,device).buffer_index = 0; BX_CONTROLLER(channel,device).control.reset = 0; BX_CONTROLLER(channel,device).control.disable_irq = 0; BX_CONTROLLER(channel,device).reset_in_progress = 0; BX_CONTROLLER(channel,device).multiple_sectors = 0; BX_CONTROLLER(channel,device).lba_mode = 0; BX_CONTROLLER(channel,device).features = 0; BX_CONTROLLER(channel,device).mdma_mode = 0; BX_CONTROLLER(channel,device).udma_mode = 0; // If not present BX_HD_THIS channels[channel].drives[device].device_type = IDE_NONE; BX_HD_THIS channels[channel].drives[device].identify_set = 0; if (SIM->get_param_enum("type", base)->get() == BX_ATA_DEVICE_NONE) continue; // Make model string strncpy((char*)BX_HD_THIS channels[channel].drives[device].model_no, SIM->get_param_string("model", base)->getptr(), 40); while (strlen((char *)BX_HD_THIS channels[channel].drives[device].model_no) < 40) { strcat((char*)BX_HD_THIS channels[channel].drives[device].model_no, " "); } BX_HD_THIS channels[channel].drives[device].model_no[40] = 0; if (SIM->get_param_enum("type", base)->get() == BX_ATA_DEVICE_DISK) { BX_DEBUG(("Hard-Disk on target %d/%d",channel,device)); BX_HD_THIS channels[channel].drives[device].device_type = IDE_DISK; sprintf(sbtext, "HD:%d-%s", channel, device?"S":"M"); BX_HD_THIS channels[channel].drives[device].statusbar_id = bx_gui->register_statusitem(sbtext, 1); int cyl = SIM->get_param_num("cylinders", base)->get(); int heads = SIM->get_param_num("heads", base)->get(); int spt = SIM->get_param_num("spt", base)->get(); int sect_size = atoi(SIM->get_param_enum("sect_size", base)->get_selected()); Bit64u disk_size = (Bit64u)cyl * heads * spt * sect_size; image_mode = SIM->get_param_enum("mode", base)->get_selected(); channels[channel].drives[device].hdimage = DEV_hdimage_init_image(image_mode, disk_size, SIM->get_param_string("journal", base)->getptr()); if (channels[channel].drives[device].hdimage != NULL) { BX_INFO(("HD on ata%d-%d: '%s', '%s' mode", channel, device, SIM->get_param_string("path", base)->getptr(), image_mode)); } else { // it's safe to return here on failure return; } BX_HD_THIS channels[channel].drives[device].hdimage->cylinders = cyl; BX_HD_THIS channels[channel].drives[device].hdimage->heads = heads; BX_HD_THIS channels[channel].drives[device].hdimage->spt = spt; BX_HD_THIS channels[channel].drives[device].hdimage->sect_size = sect_size; /* open hard drive image file */ if ((BX_HD_THIS channels[channel].drives[device].hdimage->open(SIM->get_param_string("path", base)->getptr())) < 0) { BX_PANIC(("ata%d-%d: could not open hard drive image file '%s'", channel, device, SIM->get_param_string("path", base)->getptr())); return; } Bit32u image_caps = BX_HD_THIS channels[channel].drives[device].hdimage->get_capabilities(); if ((image_caps & HDIMAGE_HAS_GEOMETRY) != 0) { // If the image provides a geometry, always use it. cyl = BX_HD_THIS channels[channel].drives[device].hdimage->cylinders; heads = BX_HD_THIS channels[channel].drives[device].hdimage->heads; spt = BX_HD_THIS channels[channel].drives[device].hdimage->spt; sect_size = BX_HD_THIS channels[channel].drives[device].hdimage->sect_size; BX_INFO(("ata%d-%d: image geometry: CHS=%d/%d/%d (sector size=%d)", channel, device, cyl, heads, spt, sect_size)); } else { if ((cyl == 0) && (image_caps & HDIMAGE_AUTO_GEOMETRY)) { // Autodetect number of cylinders if ((heads == 0) || (spt == 0)) { BX_PANIC(("ata%d-%d cannot have zero heads, or sectors/track", channel, device)); } cyl = (int)(BX_HD_THIS channels[channel].drives[device].hdimage->hd_size / (heads * spt * sect_size)); disk_size = ((Bit64u)cyl * heads * spt * sect_size); BX_HD_THIS channels[channel].drives[device].hdimage->cylinders = cyl; BX_INFO(("ata%d-%d: autodetect geometry: CHS=%d/%d/%d (sector size=%d)", channel, device, cyl, heads, spt, sect_size)); } else { // Default method: use CHS from configuration. if (cyl == 0 || heads == 0 || spt == 0) { BX_PANIC(("ata%d-%d cannot have zero cylinders, heads, or sectors/track", channel, device)); } BX_INFO(("ata%d-%d: using specified geometry: CHS=%d/%d/%d (sector size=%d)", channel, device, cyl, heads, spt, sect_size)); } if (disk_size > BX_HD_THIS channels[channel].drives[device].hdimage->hd_size) { BX_PANIC(("ata%d-%d: specified geometry doesn't fit on disk image", channel, device)); } else if (disk_size < BX_HD_THIS channels[channel].drives[device].hdimage->hd_size) { BX_INFO(("ata%d-%d: extra data outside of CHS address range", channel, device)); } } BX_HD_THIS channels[channel].drives[device].next_lsector = 0; BX_HD_THIS channels[channel].drives[device].curr_lsector = BX_HD_THIS channels[channel].drives[device].hdimage->hd_size / sect_size; BX_HD_THIS channels[channel].drives[device].controller.buffer_total_size = MAX_MULTIPLE_SECTORS * sect_size; BX_HD_THIS channels[channel].drives[device].sect_size = sect_size; } else if (SIM->get_param_enum("type", base)->get() == BX_ATA_DEVICE_CDROM) { bx_list_c *cdrom_rt = (bx_list_c*)SIM->get_param(BXPN_MENU_RUNTIME_CDROM); sprintf(pname, "cdrom%d", BX_HD_THIS cdrom_count + 1); bx_list_c *menu = new bx_list_c(cdrom_rt, pname, base->get_title()); menu->set_options(menu->SERIES_ASK | menu->USE_BOX_TITLE); menu->add(SIM->get_param("path", base)); menu->add(SIM->get_param("status", base)); SIM->get_param_string("path", base)->set_handler(cdrom_path_handler); SIM->get_param_enum("status", base)->set_handler(cdrom_status_handler); BX_DEBUG(("CDROM on target %d/%d", channel, device)); BX_HD_THIS channels[channel].drives[device].device_type = IDE_CDROM; BX_HD_THIS channels[channel].drives[device].cdrom.locked = 0; BX_HD_THIS channels[channel].drives[device].sense.sense_key = SENSE_NONE; BX_HD_THIS channels[channel].drives[device].sense.asc = 0; BX_HD_THIS channels[channel].drives[device].sense.ascq = 0; sprintf(sbtext, "CD:%d-%s", channel, device?"S":"M"); BX_HD_THIS channels[channel].drives[device].statusbar_id = bx_gui->register_statusitem(sbtext, 1); BX_HD_THIS cdrom_count++; BX_HD_THIS channels[channel].drives[device].device_num = BX_HD_THIS cdrom_count + 48; // Check bit fields BX_CONTROLLER(channel,device).sector_count = 0; BX_CONTROLLER(channel,device).interrupt_reason.c_d = 1; if (BX_CONTROLLER(channel,device).sector_count != 0x01) BX_FATAL(("interrupt reason bit field error")); BX_CONTROLLER(channel,device).sector_count = 0; BX_CONTROLLER(channel,device).interrupt_reason.i_o = 1; if (BX_CONTROLLER(channel,device).sector_count != 0x02) BX_FATAL(("interrupt reason bit field error")); BX_CONTROLLER(channel,device).sector_count = 0; BX_CONTROLLER(channel,device).interrupt_reason.rel = 1; if (BX_CONTROLLER(channel,device).sector_count != 0x04) BX_FATAL(("interrupt reason bit field error")); BX_CONTROLLER(channel,device).sector_count = 0; BX_CONTROLLER(channel,device).interrupt_reason.tag = 3; if (BX_CONTROLLER(channel,device).sector_count != 0x18) BX_FATAL(("interrupt reason bit field error")); BX_CONTROLLER(channel,device).sector_count = 0; // allocate low level driver BX_HD_THIS channels[channel].drives[device].cdrom.cd = DEV_hdimage_init_cdrom(SIM->get_param_string("path", base)->getptr()); BX_INFO(("CD on ata%d-%d: '%s'",channel, device, SIM->get_param_string("path", base)->getptr())); if (SIM->get_param_enum("status", base)->get() == BX_INSERTED) { if (BX_HD_THIS channels[channel].drives[device].cdrom.cd->insert_cdrom()) { BX_INFO(("Media present in CD-ROM drive")); BX_HD_THIS channels[channel].drives[device].cdrom.ready = 1; Bit32u capacity = BX_HD_THIS channels[channel].drives[device].cdrom.cd->capacity(); BX_HD_THIS channels[channel].drives[device].cdrom.max_lba = capacity - 1; BX_HD_THIS channels[channel].drives[device].cdrom.curr_lba = capacity - 1; BX_INFO(("Capacity is %d sectors (%.2f MB)", capacity, (float)capacity / 512.0)); } else { BX_INFO(("Could not locate CD-ROM, continuing with media not present")); BX_HD_THIS channels[channel].drives[device].cdrom.ready = 0; SIM->get_param_enum("status", base)->set(BX_EJECTED); } } else { BX_INFO(("Media not present in CD-ROM drive")); BX_HD_THIS channels[channel].drives[device].cdrom.ready = 0; } BX_HD_THIS channels[channel].drives[device].controller.buffer_total_size = 2352; } if (SIM->get_param_enum("type", base)->get() != BX_ATA_DEVICE_NONE) { BX_HD_THIS channels[channel].drives[device].controller.buffer = new Bit8u[BX_HD_THIS channels[channel].drives[device].controller.buffer_total_size + 4]; // register timer for HD/CD seek emulation if (BX_DRIVE(channel,device).seek_timer_index == BX_NULL_TIMER_HANDLE) { BX_DRIVE(channel,device).seek_timer_index = DEV_register_timer(this, seek_timer_handler, 1000, 0, 0, "HD/CD seek"); bx_pc_system.setTimerParam(BX_DRIVE(channel,device).seek_timer_index, (channel << 1) | device); } } } } // generate CMOS values for hard drive if not using a CMOS image if (!SIM->get_param_bool(BXPN_CMOSIMAGE_ENABLED)->get()) { DEV_cmos_set_reg(0x12, 0x00); // start out with: no drive 0, no drive 1 if (BX_DRIVE_IS_HD(0,0)) { // Flag drive type as Fh, use extended CMOS location as real type DEV_cmos_set_reg(0x12, (DEV_cmos_get_reg(0x12) & 0x0f) | 0xf0); DEV_cmos_set_reg(0x19, 47); // user definable type // AMI BIOS: 1st hard disk #cyl low byte DEV_cmos_set_reg(0x1b, (BX_DRIVE(0,0).hdimage->cylinders & 0x00ff)); // AMI BIOS: 1st hard disk #cyl high byte DEV_cmos_set_reg(0x1c, (BX_DRIVE(0,0).hdimage->cylinders & 0xff00) >> 8); // AMI BIOS: 1st hard disk #heads DEV_cmos_set_reg(0x1d, BX_DRIVE(0,0).hdimage->heads); // AMI BIOS: 1st hard disk write precompensation cylinder, low byte DEV_cmos_set_reg(0x1e, 0xff); // -1 // AMI BIOS: 1st hard disk write precompensation cylinder, high byte DEV_cmos_set_reg(0x1f, 0xff); // -1 // AMI BIOS: 1st hard disk control byte DEV_cmos_set_reg(0x20, (0xc0 | ((BX_DRIVE(0,0).hdimage->heads > 8) << 3))); // AMI BIOS: 1st hard disk landing zone, low byte DEV_cmos_set_reg(0x21, DEV_cmos_get_reg(0x1b)); // AMI BIOS: 1st hard disk landing zone, high byte DEV_cmos_set_reg(0x22, DEV_cmos_get_reg(0x1c)); // AMI BIOS: 1st hard disk sectors/track DEV_cmos_set_reg(0x23, BX_DRIVE(0,0).hdimage->spt); } //set up cmos for second hard drive if (BX_DRIVE_IS_HD(0,1)) { // fill in lower 4 bits of 0x12 for second HD DEV_cmos_set_reg(0x12, (DEV_cmos_get_reg(0x12) & 0xf0) | 0x0f); DEV_cmos_set_reg(0x1a, 47); // user definable type // AMI BIOS: 2nd hard disk #cyl low byte DEV_cmos_set_reg(0x24, (BX_DRIVE(0,1).hdimage->cylinders & 0x00ff)); // AMI BIOS: 2nd hard disk #cyl high byte DEV_cmos_set_reg(0x25, (BX_DRIVE(0,1).hdimage->cylinders & 0xff00) >> 8); // AMI BIOS: 2nd hard disk #heads DEV_cmos_set_reg(0x26, BX_DRIVE(0,1).hdimage->heads); // AMI BIOS: 2nd hard disk write precompensation cylinder, low byte DEV_cmos_set_reg(0x27, 0xff); // -1 // AMI BIOS: 2nd hard disk write precompensation cylinder, high byte DEV_cmos_set_reg(0x28, 0xff); // -1 // AMI BIOS: 2nd hard disk, 0x80 if heads>8 DEV_cmos_set_reg(0x29, (BX_DRIVE(0,1).hdimage->heads > 8) ? 0x80 : 0x00); // AMI BIOS: 2nd hard disk landing zone, low byte DEV_cmos_set_reg(0x2a, DEV_cmos_get_reg(0x24)); // AMI BIOS: 2nd hard disk landing zone, high byte DEV_cmos_set_reg(0x2b, DEV_cmos_get_reg(0x25)); // AMI BIOS: 2nd hard disk sectors/track DEV_cmos_set_reg(0x2c, BX_DRIVE(0,1).hdimage->spt); } DEV_cmos_set_reg(0x39, 0); DEV_cmos_set_reg(0x3a, 0); for (channel=0; channelget_param(ata_name); if (SIM->get_param_enum("type", base)->get() != BX_ATA_DEVICE_NONE) { if (BX_DRIVE_IS_HD(channel,device)) { Bit16u cylinders = BX_DRIVE(channel,device).hdimage->cylinders; Bit16u heads = BX_DRIVE(channel,device).hdimage->heads; Bit16u spt = BX_DRIVE(channel,device).hdimage->spt; Bit8u translation = SIM->get_param_enum("translation", base)->get(); Bit8u bd = (SIM->get_param_enum("biosdetect", base)->get() & 0x03); Bit8u treg = 0x39 + channel/2; Bit8u breg = 0x3b + channel/2; Bit8u bitshift = 2 * (device+(2 * (channel%2))); // Find the right translation if autodetect if (translation == BX_ATA_TRANSLATION_AUTO) { if((cylinders <= 1024) && (heads <= 16) && (spt <= 63)) { translation = BX_ATA_TRANSLATION_NONE; } else if (((Bit32u)cylinders * (Bit32u)heads) <= 131072) { translation = BX_ATA_TRANSLATION_LARGE; } else translation = BX_ATA_TRANSLATION_LBA; BX_INFO(("translation on ata%d-%d set to '%s'",channel, device, translation==BX_ATA_TRANSLATION_NONE?"none": translation==BX_ATA_TRANSLATION_LARGE?"large": "lba")); } // FIXME we should test and warn // - if LBA and spt != 63 // - if RECHS and heads != 16 // - if NONE and size > 1024*16*SPT blocks // - if LARGE and size > 8192*16*SPT blocks // - if RECHS and size > 1024*240*SPT blocks // - if LBA and size > 1024*255*63, not that we can do much about it switch(translation) { case BX_ATA_TRANSLATION_NONE: DEV_cmos_set_reg(treg, DEV_cmos_get_reg(treg) | (0 << bitshift)); break; case BX_ATA_TRANSLATION_LBA: DEV_cmos_set_reg(treg, DEV_cmos_get_reg(treg) | (1 << bitshift)); break; case BX_ATA_TRANSLATION_LARGE: DEV_cmos_set_reg(treg, DEV_cmos_get_reg(treg) | (2 << bitshift)); break; case BX_ATA_TRANSLATION_RECHS: DEV_cmos_set_reg(treg, DEV_cmos_get_reg(treg) | (3 << bitshift)); break; } // TODO: biosdetect flag not yet handled by Bochs BIOS DEV_cmos_set_reg(breg, DEV_cmos_get_reg(breg) | (bd << bitshift)); } } } } } BX_HD_THIS pci_enabled = SIM->get_param_bool(BXPN_PCI_ENABLED)->get(); // register handler for correct cdrom parameter handling after runtime config BX_HD_THIS rt_conf_id = SIM->register_runtime_config_handler(BX_HD_THIS_PTR, runtime_config_handler); } void bx_hard_drive_c::reset(unsigned type) { for (unsigned channel=0; channelget_bochs_root(), "hard_drive", "Hard Drive State"); for (i=0; iregister_state(drive); } if (BX_DRIVE_IS_CD(i, j)) { cdrom = new bx_list_c(drive, "cdrom"); BXRS_PARAM_BOOL(cdrom, locked, BX_HD_THIS channels[i].drives[j].cdrom.locked); new bx_shadow_num_c(cdrom, "curr_lba", &BX_HD_THIS channels[i].drives[j].cdrom.curr_lba); new bx_shadow_num_c(cdrom, "next_lba", &BX_HD_THIS channels[i].drives[j].cdrom.next_lba); new bx_shadow_num_c(cdrom, "remaining_blocks", &BX_HD_THIS channels[i].drives[j].cdrom.remaining_blocks); atapi = new bx_list_c(drive, "atapi"); new bx_shadow_num_c(atapi, "command", &BX_HD_THIS channels[i].drives[j].atapi.command, BASE_HEX); new bx_shadow_num_c(atapi, "drq_bytes", &BX_HD_THIS channels[i].drives[j].atapi.drq_bytes); new bx_shadow_num_c(atapi, "total_bytes_remaining", &BX_HD_THIS channels[i].drives[j].atapi.total_bytes_remaining); } else { new bx_shadow_num_c(drive, "curr_lsector", &BX_HD_THIS channels[i].drives[j].curr_lsector); new bx_shadow_num_c(drive, "next_lsector", &BX_HD_THIS channels[i].drives[j].next_lsector); } new bx_shadow_data_c(drive, "buffer", BX_CONTROLLER(i, j).buffer, BX_CONTROLLER(i, j).buffer_total_size); status = new bx_list_c(drive, "status"); BXRS_PARAM_BOOL(status, busy, BX_CONTROLLER(i, j).status.busy); BXRS_PARAM_BOOL(status, drive_ready, BX_CONTROLLER(i, j).status.drive_ready); BXRS_PARAM_BOOL(status, write_fault, BX_CONTROLLER(i, j).status.write_fault); BXRS_PARAM_BOOL(status, seek_complete, BX_CONTROLLER(i, j).status.seek_complete); BXRS_PARAM_BOOL(status, drq, BX_CONTROLLER(i, j).status.drq); BXRS_PARAM_BOOL(status, corrected_data, BX_CONTROLLER(i, j).status.corrected_data); BXRS_PARAM_BOOL(status, index_pulse, BX_CONTROLLER(i, j).status.index_pulse); new bx_shadow_num_c(status, "index_pulse_count", &BX_CONTROLLER(i, j).status.index_pulse_count); BXRS_PARAM_BOOL(status, err, BX_CONTROLLER(i, j).status.err); new bx_shadow_num_c(drive, "error_register", &BX_CONTROLLER(i, j).error_register, BASE_HEX); new bx_shadow_num_c(drive, "head_no", &BX_CONTROLLER(i, j).head_no, BASE_HEX); new bx_shadow_num_c(drive, "sector_count", &BX_CONTROLLER(i, j).sector_count, BASE_HEX); new bx_shadow_num_c(drive, "sector_no", &BX_CONTROLLER(i, j).sector_no, BASE_HEX); new bx_shadow_num_c(drive, "cylinder_no", &BX_CONTROLLER(i, j).cylinder_no, BASE_HEX); new bx_shadow_num_c(drive, "buffer_size", &BX_CONTROLLER(i, j).buffer_size, BASE_HEX); new bx_shadow_num_c(drive, "buffer_index", &BX_CONTROLLER(i, j).buffer_index, BASE_HEX); new bx_shadow_num_c(drive, "drq_index", &BX_CONTROLLER(i, j).drq_index, BASE_HEX); new bx_shadow_num_c(drive, "current_command", &BX_CONTROLLER(i, j).current_command, BASE_HEX); new bx_shadow_num_c(drive, "multiple_sectors", &BX_CONTROLLER(i, j).multiple_sectors, BASE_HEX); BXRS_PARAM_BOOL(drive, lba_mode, BX_CONTROLLER(i, j).lba_mode); BXRS_PARAM_BOOL(drive, packet_dma, BX_CONTROLLER(i, j).packet_dma); BXRS_PARAM_BOOL(drive, control_reset, BX_CONTROLLER(i, j).control.reset); BXRS_PARAM_BOOL(drive, control_disable_irq, BX_CONTROLLER(i, j).control.disable_irq); new bx_shadow_num_c(drive, "reset_in_progress", &BX_CONTROLLER(i, j).reset_in_progress, BASE_HEX); new bx_shadow_num_c(drive, "features", &BX_CONTROLLER(i, j).features, BASE_HEX); new bx_shadow_num_c(drive, "mdma_mode", &BX_CONTROLLER(i, j).mdma_mode, BASE_HEX); new bx_shadow_num_c(drive, "udma_mode", &BX_CONTROLLER(i, j).udma_mode, BASE_HEX); new bx_shadow_num_c(drive, "hob_feature", &BX_CONTROLLER(i, j).hob.feature, BASE_HEX); new bx_shadow_num_c(drive, "hob_nsector", &BX_CONTROLLER(i, j).hob.nsector, BASE_HEX); new bx_shadow_num_c(drive, "hob_sector", &BX_CONTROLLER(i, j).hob.sector, BASE_HEX); new bx_shadow_num_c(drive, "hob_lcyl", &BX_CONTROLLER(i, j).hob.lcyl, BASE_HEX); new bx_shadow_num_c(drive, "hob_hcyl", &BX_CONTROLLER(i, j).hob.hcyl, BASE_HEX); new bx_shadow_num_c(drive, "num_sectors", &BX_CONTROLLER(i, j).num_sectors, BASE_HEX); } } new bx_shadow_num_c(chan, "drive_select", &BX_HD_THIS channels[i].drive_select); } } void bx_hard_drive_c::seek_timer_handler(void *this_ptr) { bx_hard_drive_c *class_ptr = (bx_hard_drive_c *) this_ptr; class_ptr->seek_timer(); } void bx_hard_drive_c::seek_timer() { Bit8u param = bx_pc_system.triggeredTimerParam(); Bit8u channel = param >> 1; Bit8u device = param & 1; controller_t *controller = &BX_CONTROLLER(channel, device); if (BX_DRIVE_IS_HD(channel, device)) { switch (controller->current_command) { case 0x24: // READ SECTORS EXT case 0x29: // READ MULTIPLE EXT case 0x20: // READ SECTORS, with retries case 0x21: // READ SECTORS, without retries case 0xC4: // READ MULTIPLE SECTORS controller->error_register = 0; controller->status.busy = 0; controller->status.drive_ready = 1; controller->status.seek_complete = 1; controller->status.drq = 1; controller->status.corrected_data = 0; controller->buffer_index = 0; raise_interrupt(channel); break; case 0x25: // READ DMA EXT case 0xC8: // READ DMA controller->error_register = 0; controller->status.busy = 0; controller->status.drive_ready = 1; controller->status.seek_complete = 1; controller->status.drq = 1; controller->status.corrected_data = 0; #if BX_SUPPORT_PCI DEV_ide_bmdma_start_transfer(channel); #endif break; case 0x70: // SEEK BX_SELECTED_DRIVE(channel).curr_lsector = BX_SELECTED_DRIVE(channel).next_lsector; controller->error_register = 0; controller->status.busy = 0; controller->status.drive_ready = 1; controller->status.seek_complete = 1; controller->status.drq = 0; controller->status.corrected_data = 0; controller->buffer_index = 0; BX_DEBUG(("ata%d-%d: SEEK completed (IRQ %sabled)", channel, BX_SLAVE_SELECTED(channel), controller->control.disable_irq?"dis":"en")); raise_interrupt(channel); break; default: BX_ERROR(("seek_timer(): ATA command 0x%02x not supported", controller->current_command)); } } else { switch (BX_DRIVE(channel, device).atapi.command) { case 0x28: // read (10) case 0xa8: // read (12) case 0xbe: // read cd ready_to_send_atapi(channel); break; default: BX_ERROR(("seek_timer(): ATAPI command 0x%02x not supported", BX_DRIVE(channel, device).atapi.command)); } } } void bx_hard_drive_c::runtime_config_handler(void *this_ptr) { bx_hard_drive_c *class_ptr = (bx_hard_drive_c *) this_ptr; class_ptr->runtime_config(); } void bx_hard_drive_c::runtime_config(void) { char pname[16]; int handle; bool status; for (Bit8u channel=0; channelget_param(pname); status = SIM->get_param_enum("status", base)->get(); BX_HD_THIS set_cd_media_status(handle, 0); if (status == BX_INSERTED) { BX_HD_THIS set_cd_media_status(handle, 1); } BX_HD_THIS channels[channel].drives[device].status_changed = 0; } } } } #define GOTO_RETURN_VALUE if(io_len==4) { \ goto return_value32; \ } \ else if(io_len==2) { \ value16=(Bit16u)value32; \ goto return_value16; \ } \ else { \ value8=(Bit8u)value32; \ goto return_value8; \ } // static IO port read callback handler // redirects to non-static class handler to avoid virtual functions Bit32u bx_hard_drive_c::read_handler(void *this_ptr, Bit32u address, unsigned io_len) { #if !BX_USE_HD_SMF bx_hard_drive_c *class_ptr = (bx_hard_drive_c *) this_ptr; return class_ptr->read(address, io_len); } Bit32u bx_hard_drive_c::read(Bit32u address, unsigned io_len) { #else UNUSED(this_ptr); #endif // !BX_USE_HD_SMF Bit8u value8; Bit16u value16; Bit32u value32; Bit8u channel = BX_MAX_ATA_CHANNEL; Bit32u port = 0xff; // undefined for (channel=0; channel 0x03f7)) { BX_PANIC(("read: unable to find ATA channel, ioport=0x%04x", address)); } else { port = address - 0x03e0; } } controller_t *controller = &BX_SELECTED_CONTROLLER(channel); unsigned sect_size = BX_SELECTED_DRIVE(channel).sect_size; switch (port) { case 0x00: // hard disk data (16bit) 0x1f0 if (controller->status.drq == 0) { BX_ERROR(("IO read(0x%04x) with drq == 0: last command was %02xh", address, (unsigned) controller->current_command)); return(0); } BX_DEBUG(("IO read(0x%04x): current command is %02xh", address, (unsigned) controller->current_command)); switch (controller->current_command) { case 0x20: // READ SECTORS, with retries case 0x21: // READ SECTORS, without retries case 0xC4: // READ MULTIPLE SECTORS case 0x24: // READ SECTORS EXT case 0x29: // READ MULTIPLE EXT if (controller->buffer_index >= controller->buffer_size) BX_PANIC(("IO read(0x%04x): buffer_index >= %d", address, controller->buffer_size)); #if BX_SUPPORT_REPEAT_SPEEDUPS if (DEV_bulk_io_quantum_requested()) { unsigned transferLen, quantumsMax; quantumsMax = (controller->buffer_size - controller->buffer_index) / io_len; if (quantumsMax == 0) BX_PANIC(("IO read(0x%04x): not enough space for read", address)); DEV_bulk_io_quantum_transferred() = DEV_bulk_io_quantum_requested(); if (quantumsMax < DEV_bulk_io_quantum_transferred()) DEV_bulk_io_quantum_transferred() = quantumsMax; transferLen = io_len * DEV_bulk_io_quantum_transferred(); memcpy((Bit8u*) DEV_bulk_io_host_addr(), &controller->buffer[controller->buffer_index], transferLen); DEV_bulk_io_host_addr() += transferLen; controller->buffer_index += transferLen; value32 = 0; // Value returned not important; } else #endif { value32 = 0L; switch(io_len){ case 4: value32 |= (controller->buffer[controller->buffer_index+3] << 24); value32 |= (controller->buffer[controller->buffer_index+2] << 16); case 2: value32 |= (controller->buffer[controller->buffer_index+1] << 8); value32 |= controller->buffer[controller->buffer_index]; } controller->buffer_index += io_len; } // if buffer completely read if (controller->buffer_index >= controller->buffer_size) { // update sector count, sector number, cylinder, // drive, head, status // if there are more sectors, read next one in... // if ((controller->current_command == 0xC4) || (controller->current_command == 0x29)) { if (controller->num_sectors > controller->multiple_sectors) { controller->buffer_size = controller->multiple_sectors * sect_size; } else { controller->buffer_size = controller->num_sectors * sect_size; } } controller->status.busy = 0; controller->status.drive_ready = 1; controller->status.write_fault = 0; controller->status.seek_complete = 1; controller->status.corrected_data = 0; controller->status.err = 0; if (controller->num_sectors==0) { controller->status.drq = 0; BX_SELECTED_DRIVE(channel).curr_lsector = BX_SELECTED_DRIVE(channel).next_lsector; } else { /* read next one into controller buffer */ controller->status.drq = 1; controller->status.seek_complete = 1; if (ide_read_sector(channel, controller->buffer, controller->buffer_size)) { controller->buffer_index = 0; raise_interrupt(channel); } } } GOTO_RETURN_VALUE; break; case 0xec: // IDENTIFY DEVICE case 0xa1: unsigned index; controller->status.busy = 0; controller->status.drive_ready = 1; controller->status.write_fault = 0; controller->status.seek_complete = 1; controller->status.corrected_data = 0; controller->status.err = 0; index = controller->buffer_index; value32 = controller->buffer[index]; index++; if (io_len >= 2) { value32 |= (controller->buffer[index] << 8); index++; } if (io_len == 4) { value32 |= (controller->buffer[index] << 16); value32 |= (controller->buffer[index+1] << 24); index += 2; } controller->buffer_index = index; if (controller->buffer_index >= 512) { // we only want to send 512 bytes for Identify controller->status.drq = 0; BX_DEBUG(("Read all drive ID Bytes ...")); } GOTO_RETURN_VALUE; break; case 0xa0: { unsigned index = controller->buffer_index; unsigned increment = 0; // Load block if necessary if (index >= controller->buffer_size) { if (index > controller->buffer_size) BX_PANIC(("index > %d : %d", controller->buffer_size, index)); switch (BX_SELECTED_DRIVE(channel).atapi.command) { case 0x28: // read (10) case 0xa8: // read (12) case 0xbe: // read cd if (!BX_SELECTED_DRIVE(channel).cdrom.ready) { BX_PANIC(("Read with CDROM not ready")); } /* set status bar conditions for device */ bx_gui->statusbar_setitem(BX_SELECTED_DRIVE(channel).statusbar_id, 1); if (!BX_SELECTED_DRIVE(channel).cdrom.cd->read_block(controller->buffer, BX_SELECTED_DRIVE(channel).cdrom.next_lba, controller->buffer_size)) { BX_PANIC(("CDROM: read block %d failed", BX_SELECTED_DRIVE(channel).cdrom.next_lba)); } BX_SELECTED_DRIVE(channel).cdrom.next_lba++; BX_SELECTED_DRIVE(channel).cdrom.remaining_blocks--; if (!BX_SELECTED_DRIVE(channel).cdrom.remaining_blocks) { BX_SELECTED_DRIVE(channel).cdrom.curr_lba = BX_SELECTED_DRIVE(channel).cdrom.next_lba; BX_DEBUG(("CDROM: last READ block loaded")); } else { BX_DEBUG(("CDROM: READ block loaded (%d remaining)", BX_SELECTED_DRIVE(channel).cdrom.remaining_blocks)); } // one block transfered, start at beginning index = 0; break; default: // no need to load a new block break; } } value32 = controller->buffer[index+increment]; increment++; if (io_len >= 2) { value32 |= (controller->buffer[index+increment] << 8); increment++; } if (io_len == 4) { value32 |= (controller->buffer[index+increment] << 16); value32 |= (controller->buffer[index+increment+1] << 24); increment += 2; } controller->buffer_index = index + increment; controller->drq_index += increment; if (controller->drq_index >= (unsigned)BX_SELECTED_DRIVE(channel).atapi.drq_bytes) { controller->status.drq = 0; controller->drq_index = 0; BX_SELECTED_DRIVE(channel).atapi.total_bytes_remaining -= BX_SELECTED_DRIVE(channel).atapi.drq_bytes; if (BX_SELECTED_DRIVE(channel).atapi.total_bytes_remaining > 0) { // one or more blocks remaining (works only for single block commands) BX_DEBUG(("PACKET drq bytes read")); controller->interrupt_reason.i_o = 1; controller->status.busy = 0; controller->status.drq = 1; controller->interrupt_reason.c_d = 0; // set new byte count if last block if (BX_SELECTED_DRIVE(channel).atapi.total_bytes_remaining < controller->byte_count) { controller->byte_count = BX_SELECTED_DRIVE(channel).atapi.total_bytes_remaining; } BX_SELECTED_DRIVE(channel).atapi.drq_bytes = controller->byte_count; raise_interrupt(channel); } else { // all bytes read BX_DEBUG(("PACKET all bytes read")); controller->interrupt_reason.i_o = 1; controller->interrupt_reason.c_d = 1; controller->status.drive_ready = 1; controller->interrupt_reason.rel = 0; controller->status.busy = 0; controller->status.drq = 0; controller->status.err = 0; raise_interrupt(channel); } } GOTO_RETURN_VALUE; } break; default: BX_ERROR(("read from 0x%04x: current command is 0x%02x", address, controller->current_command)); } break; case 0x01: // hard disk error register 0x1f1 // -- WARNING : On real hardware the controller registers are shared between drives. // So we must respond even if the select device is not present. Some OS uses this fact // to detect the disks.... minix2 for example value8 = (!BX_ANY_IS_PRESENT(channel)) ? 0 : controller->error_register; goto return_value8; case 0x02: // hard disk sector count / interrupt reason 0x1f2 value8 = (!BX_ANY_IS_PRESENT(channel)) ? 0 : controller->sector_count; goto return_value8; case 0x03: // sector number 0x1f3 value8 = (!BX_ANY_IS_PRESENT(channel)) ? 0 : controller->sector_no; goto return_value8; case 0x04: // cylinder low 0x1f4 value8 = (!BX_ANY_IS_PRESENT(channel)) ? 0 : (controller->cylinder_no & 0x00ff); goto return_value8; case 0x05: // cylinder high 0x1f5 value8 = (!BX_ANY_IS_PRESENT(channel)) ? 0 : controller->cylinder_no >> 8; goto return_value8; case 0x06: // hard disk drive and head register 0x1f6 // b7 Extended data field for ECC // b6/b5: Used to be sector size. 00=256,01=512,10=1024,11=128 // Since 512 was always used, bit 6 was taken to mean LBA mode: // b6 1=LBA mode, 0=CHS mode // b5 1 // b4: DRV // b3..0 HD3..HD0 value8 = (1 << 7) | (controller->lba_mode << 6) | (1 << 5) | // 01b = 512 sector size (BX_HD_THIS channels[channel].drive_select << 4) | (controller->head_no << 0); goto return_value8; case 0x07: // Hard Disk Status 0x1f7 case 0x16: // Hard Disk Alternate Status 0x3f6 if (!BX_SELECTED_IS_PRESENT(channel)) { // (mch) Just return zero for these registers value8 = 0; } else { value8 = ( (controller->status.busy << 7) | (controller->status.drive_ready << 6) | (controller->status.write_fault << 5) | (controller->status.seek_complete << 4) | (controller->status.drq << 3) | (controller->status.corrected_data << 2) | (controller->status.index_pulse << 1) | (Bit8u)controller->status.err); controller->status.index_pulse_count++; controller->status.index_pulse = 0; if (controller->status.index_pulse_count >= INDEX_PULSE_CYCLE) { controller->status.index_pulse = 1; controller->status.index_pulse_count = 0; } } if (port == 0x07) { DEV_pic_lower_irq(BX_HD_THIS channels[channel].irq); } goto return_value8; case 0x17: // Hard Disk Address Register 0x3f7 // Obsolete and unsupported register. Not driven by hard // disk controller. Report all 1's. If floppy controller // is handling this address, it will call this function // set/clear D7 (the only bit it handles), then return // the combined value value8 = 0xff; goto return_value8; default: BX_PANIC(("hard drive: io read to address %x unsupported", (unsigned) address)); } BX_PANIC(("hard drive: shouldn't get here!")); return(0); return_value32: BX_DEBUG(("32-bit read from %04x = %08x {%s}", (unsigned) address, value32, BX_SELECTED_TYPE_STRING(channel))); return value32; return_value16: BX_DEBUG(("16-bit read from %04x = %04x {%s}", (unsigned) address, value16, BX_SELECTED_TYPE_STRING(channel))); return value16; return_value8: BX_DEBUG(("8-bit read from %04x = %02x {%s}", (unsigned) address, value8, BX_SELECTED_TYPE_STRING(channel))); return value8; } // static IO port write callback handler // redirects to non-static class handler to avoid virtual functions void bx_hard_drive_c::write_handler(void *this_ptr, Bit32u address, Bit32u value, unsigned io_len) { #if !BX_USE_HD_SMF bx_hard_drive_c *class_ptr = (bx_hard_drive_c *) this_ptr; class_ptr->write(address, value, io_len); } void bx_hard_drive_c::write(Bit32u address, Bit32u value, unsigned io_len) { #else UNUSED(this_ptr); #endif // !BX_USE_HD_SMF Bit64s logical_sector; bool prev_control_reset; bool lba48 = 0; Bit8u channel = BX_MAX_ATA_CHANNEL; Bit32u port = 0xff; // undefined int i; for (channel=0; channelcurrent_command) { case 0x30: // WRITE SECTORS case 0xC5: // WRITE MULTIPLE SECTORS case 0x34: // WRITE SECTORS EXT case 0x39: // WRITE MULTIPLE EXT if (controller->buffer_index >= controller->buffer_size) BX_PANIC(("IO write(0x%04x): buffer_index >= %d", address, controller->buffer_size)); #if BX_SUPPORT_REPEAT_SPEEDUPS if (DEV_bulk_io_quantum_requested()) { unsigned transferLen, quantumsMax; quantumsMax = (controller->buffer_size - controller->buffer_index) / io_len; if (quantumsMax == 0) BX_PANIC(("IO write(0x%04x): not enough space for write", address)); DEV_bulk_io_quantum_transferred() = DEV_bulk_io_quantum_requested(); if (quantumsMax < DEV_bulk_io_quantum_transferred()) DEV_bulk_io_quantum_transferred() = quantumsMax; transferLen = io_len * DEV_bulk_io_quantum_transferred(); memcpy(&controller->buffer[controller->buffer_index], (Bit8u*) DEV_bulk_io_host_addr(), transferLen); DEV_bulk_io_host_addr() += transferLen; controller->buffer_index += transferLen; } else #endif { switch(io_len) { case 4: controller->buffer[controller->buffer_index+3] = (Bit8u)(value >> 24); controller->buffer[controller->buffer_index+2] = (Bit8u)(value >> 16); case 2: controller->buffer[controller->buffer_index+1] = (Bit8u)(value >> 8); controller->buffer[controller->buffer_index] = (Bit8u) value; } controller->buffer_index += io_len; } /* if buffer completely writtten */ if (controller->buffer_index >= controller->buffer_size) { if (ide_write_sector(channel, controller->buffer, controller->buffer_size)) { if ((controller->current_command == 0xC5) || (controller->current_command == 0x39)) { if (controller->num_sectors > controller->multiple_sectors) { controller->buffer_size = controller->multiple_sectors * sect_size; } else { controller->buffer_size = controller->num_sectors * sect_size; } } controller->buffer_index = 0; /* When the write is complete, controller clears the DRQ bit and * sets the BSY bit. * If at least one more sector is to be written, controller sets DRQ bit, * clears BSY bit, and issues IRQ */ if (controller->num_sectors != 0) { controller->status.busy = 0; controller->status.drive_ready = 1; controller->status.drq = 1; controller->status.corrected_data = 0; controller->status.err = 0; } else { /* no more sectors to write */ controller->status.busy = 0; controller->status.drive_ready = 1; controller->status.drq = 0; controller->status.err = 0; controller->status.corrected_data = 0; BX_SELECTED_DRIVE(channel).curr_lsector = BX_SELECTED_DRIVE(channel).next_lsector; } raise_interrupt(channel); } } break; case 0xa0: // PACKET if (controller->buffer_index >= PACKET_SIZE) BX_PANIC(("IO write(0x%04x): buffer_index >= PACKET_SIZE", address)); switch (io_len) { case 4: controller->buffer[controller->buffer_index+3] = (Bit8u)(value >> 24); controller->buffer[controller->buffer_index+2] = (Bit8u)(value >> 16); case 2: controller->buffer[controller->buffer_index+1] = (Bit8u)(value >> 8); controller->buffer[controller->buffer_index] = (Bit8u) value; } controller->buffer_index += io_len; /* if packet completely writtten */ if (controller->buffer_index >= PACKET_SIZE) { // complete command received Bit8u atapi_command = controller->buffer[0]; controller->buffer_size = 2048; BX_DEBUG_ATAPI(("ata%d-%d: ATAPI command 0x%02x started", channel, BX_SLAVE_SELECTED(channel), atapi_command)); switch (atapi_command) { case 0x00: // test unit ready if (BX_SELECTED_DRIVE(channel).cdrom.ready) { atapi_cmd_nop(controller); } else { atapi_cmd_error(channel, SENSE_NOT_READY, ASC_MEDIUM_NOT_PRESENT, 0); } raise_interrupt(channel); break; case 0x03: // request sense { int alloc_length = controller->buffer[4]; init_send_atapi_command(channel, atapi_command, 18, alloc_length); // sense data controller->buffer[0] = 0x70 | (1 << 7); controller->buffer[1] = 0; controller->buffer[2] = BX_SELECTED_DRIVE(channel).sense.sense_key; controller->buffer[3] = BX_SELECTED_DRIVE(channel).sense.information.arr[0]; controller->buffer[4] = BX_SELECTED_DRIVE(channel).sense.information.arr[1]; controller->buffer[5] = BX_SELECTED_DRIVE(channel).sense.information.arr[2]; controller->buffer[6] = BX_SELECTED_DRIVE(channel).sense.information.arr[3]; controller->buffer[7] = 17-7; controller->buffer[8] = BX_SELECTED_DRIVE(channel).sense.specific_inf.arr[0]; controller->buffer[9] = BX_SELECTED_DRIVE(channel).sense.specific_inf.arr[1]; controller->buffer[10] = BX_SELECTED_DRIVE(channel).sense.specific_inf.arr[2]; controller->buffer[11] = BX_SELECTED_DRIVE(channel).sense.specific_inf.arr[3]; controller->buffer[12] = BX_SELECTED_DRIVE(channel).sense.asc; controller->buffer[13] = BX_SELECTED_DRIVE(channel).sense.ascq; controller->buffer[14] = BX_SELECTED_DRIVE(channel).sense.fruc; controller->buffer[15] = BX_SELECTED_DRIVE(channel).sense.key_spec.arr[0]; controller->buffer[16] = BX_SELECTED_DRIVE(channel).sense.key_spec.arr[1]; controller->buffer[17] = BX_SELECTED_DRIVE(channel).sense.key_spec.arr[2]; if (BX_SELECTED_DRIVE(channel).sense.sense_key == SENSE_UNIT_ATTENTION) { BX_SELECTED_DRIVE(channel).sense.sense_key = SENSE_NONE; } ready_to_send_atapi(channel); } break; case 0x1b: // start stop unit { char ata_name[20]; //bool Immed = (controller->buffer[1] >> 0) & 1; bool LoEj = (controller->buffer[4] >> 1) & 1; bool Start = (controller->buffer[4] >> 0) & 1; if (!LoEj && !Start) { // stop the disc BX_ERROR(("FIXME: Stop disc not implemented")); atapi_cmd_nop(controller); raise_interrupt(channel); } else if (!LoEj && Start) { // start (spin up) the disc BX_SELECTED_DRIVE(channel).cdrom.cd->start_cdrom(); BX_ERROR(("FIXME: ATAPI start disc not reading TOC")); atapi_cmd_nop(controller); raise_interrupt(channel); } else if (LoEj && !Start) { // Eject the disc atapi_cmd_nop(controller); if (BX_SELECTED_DRIVE(channel).cdrom.ready) { BX_SELECTED_DRIVE(channel).cdrom.cd->eject_cdrom(); BX_SELECTED_DRIVE(channel).cdrom.ready = 0; sprintf(ata_name, "ata.%d.%s", channel, BX_SLAVE_SELECTED(channel)?"slave":"master"); bx_list_c *base = (bx_list_c*) SIM->get_param(ata_name); SIM->get_param_enum("status", base)->set(BX_EJECTED); bx_gui->update_drive_status_buttons(); } raise_interrupt(channel); } else { // Load the disc // My guess is that this command only closes the tray, that's a no-op for us atapi_cmd_nop(controller); raise_interrupt(channel); } } break; case 0xbd: // mechanism status { Bit16u alloc_length = read_16bit(controller->buffer + 8); if (alloc_length == 0) BX_PANIC(("Zero allocation length to MECHANISM STATUS not impl.")); init_send_atapi_command(channel, atapi_command, 8, alloc_length); controller->buffer[0] = 0; // reserved for non changers controller->buffer[1] = 0; // reserved for non changers controller->buffer[2] = 0; // Current LBA (TODO!) controller->buffer[3] = 0; // Current LBA (TODO!) controller->buffer[4] = 0; // Current LBA (TODO!) controller->buffer[5] = 1; // one slot controller->buffer[6] = 0; // slot table length controller->buffer[7] = 0; // slot table length ready_to_send_atapi(channel); } break; case 0x1a: // mode sense (6) case 0x5a: // mode sense (10) { Bit16u alloc_length; if (atapi_command == 0x5a) { alloc_length = read_16bit(controller->buffer + 7); } else { alloc_length = controller->buffer[4]; } Bit8u PC = controller->buffer[2] >> 6; Bit8u PageCode = controller->buffer[2] & 0x3f; switch (PC) { case 0x0: // current values switch (PageCode) { case 0x01: // error recovery init_send_atapi_command(channel, atapi_command, sizeof(error_recovery_t) + 8, alloc_length); init_mode_sense_single(channel, &BX_SELECTED_DRIVE(channel).cdrom.current.error_recovery, sizeof(error_recovery_t)); ready_to_send_atapi(channel); break; case 0x2a: // CD-ROM capabilities & mech. status init_send_atapi_command(channel, atapi_command, 28, alloc_length); init_mode_sense_single(channel, &controller->buffer[8], 28); controller->buffer[8] = 0x2a; controller->buffer[9] = 0x12; controller->buffer[10] = 0x03; controller->buffer[11] = 0x00; // Multisession, Mode 2 Form 2, Mode 2 Form 1, Audio controller->buffer[12] = 0x71; controller->buffer[13] = (3 << 5); controller->buffer[14] = (unsigned char) (1 | (BX_SELECTED_DRIVE(channel).cdrom.locked ? (1 << 1) : 0) | (1 << 3) | (1 << 5)); controller->buffer[15] = 0x00; controller->buffer[16] = ((16 * 176) >> 8) & 0xff; controller->buffer[17] = (16 * 176) & 0xff; controller->buffer[18] = 0; controller->buffer[19] = 2; controller->buffer[20] = (512 >> 8) & 0xff; controller->buffer[21] = 512 & 0xff; controller->buffer[22] = ((16 * 176) >> 8) & 0xff; controller->buffer[23] = (16 * 176) & 0xff; controller->buffer[24] = 0; controller->buffer[25] = 0; controller->buffer[26] = 0; controller->buffer[27] = 0; ready_to_send_atapi(channel); break; case 0x0d: // CD-ROM case 0x0e: // CD-ROM audio control case 0x3f: // all BX_ERROR(("cdrom: MODE SENSE (curr), code=%x not implemented yet", PageCode)); atapi_cmd_error(channel, SENSE_ILLEGAL_REQUEST, ASC_INV_FIELD_IN_CMD_PACKET, 1); raise_interrupt(channel); break; default: // not implemeted by this device BX_INFO(("cdrom: MODE SENSE PC=%x, PageCode=%x, not implemented by device", PC, PageCode)); atapi_cmd_error(channel, SENSE_ILLEGAL_REQUEST, ASC_INV_FIELD_IN_CMD_PACKET, 1); raise_interrupt(channel); break; } break; case 0x1: // changeable values switch (PageCode) { case 0x01: // error recovery case 0x0d: // CD-ROM case 0x0e: // CD-ROM audio control case 0x2a: // CD-ROM capabilities & mech. status case 0x3f: // all BX_ERROR(("cdrom: MODE SENSE (chg), code=%x not implemented yet", PageCode)); atapi_cmd_error(channel, SENSE_ILLEGAL_REQUEST, ASC_INV_FIELD_IN_CMD_PACKET, 1); raise_interrupt(channel); break; default: // not implemeted by this device BX_INFO(("cdrom: MODE SENSE PC=%x, PageCode=%x, not implemented by device", PC, PageCode)); atapi_cmd_error(channel, SENSE_ILLEGAL_REQUEST, ASC_INV_FIELD_IN_CMD_PACKET, 1); raise_interrupt(channel); break; } break; case 0x2: // default values switch (PageCode) { case 0x2a: // CD-ROM capabilities & mech. status, copied from current values init_send_atapi_command(channel, atapi_command, 28, alloc_length); init_mode_sense_single(channel, &controller->buffer[8], 28); controller->buffer[8] = 0x2a; controller->buffer[9] = 0x12; controller->buffer[10] = 0x03; controller->buffer[11] = 0x00; // Multisession, Mode 2 Form 2, Mode 2 Form 1, Audio controller->buffer[12] = 0x71; controller->buffer[13] = (3 << 5); controller->buffer[14] = (unsigned char) (1 | (BX_SELECTED_DRIVE(channel).cdrom.locked ? (1 << 1) : 0) | (1 << 3) | (1 << 5)); controller->buffer[15] = 0x00; controller->buffer[16] = ((16 * 176) >> 8) & 0xff; controller->buffer[17] = (16 * 176) & 0xff; controller->buffer[18] = 0; controller->buffer[19] = 2; controller->buffer[20] = (512 >> 8) & 0xff; controller->buffer[21] = 512 & 0xff; controller->buffer[22] = ((16 * 176) >> 8) & 0xff; controller->buffer[23] = (16 * 176) & 0xff; controller->buffer[24] = 0; controller->buffer[25] = 0; controller->buffer[26] = 0; controller->buffer[27] = 0; ready_to_send_atapi(channel); break; case 0x01: // error recovery case 0x0d: // CD-ROM case 0x0e: // CD-ROM audio control case 0x3f: // all BX_ERROR(("cdrom: MODE SENSE (dflt), code=%x not implemented", PageCode)); atapi_cmd_error(channel, SENSE_ILLEGAL_REQUEST, ASC_INV_FIELD_IN_CMD_PACKET, 1); raise_interrupt(channel); break; default: // not implemeted by this device BX_INFO(("cdrom: MODE SENSE PC=%x, PageCode=%x, not implemented by device", PC, PageCode)); atapi_cmd_error(channel, SENSE_ILLEGAL_REQUEST, ASC_INV_FIELD_IN_CMD_PACKET, 1); raise_interrupt(channel); break; } break; default: case 0x3: // saved values not implemented atapi_cmd_error(channel, SENSE_ILLEGAL_REQUEST, ASC_SAVING_PARAMETERS_NOT_SUPPORTED, 1); raise_interrupt(channel); break; } } break; case 0x12: // inquiry { Bit8u alloc_length = controller->buffer[4]; init_send_atapi_command(channel, atapi_command, 36, alloc_length); controller->buffer[0] = 0x05; // CD-ROM controller->buffer[1] = 0x80; // Removable controller->buffer[2] = 0x00; // ISO, ECMA, ANSI version controller->buffer[3] = 0x21; // ATAPI-2, as specified controller->buffer[4] = 31; // additional length (total 36) controller->buffer[5] = 0x00; // reserved controller->buffer[6] = 0x00; // reserved controller->buffer[7] = 0x00; // reserved // Vendor ID const char* vendor_id = "BOCHS "; for (i = 0; i < 8; i++) controller->buffer[8+i] = vendor_id[i]; // Product ID const char* product_id = "Generic CD-ROM "; for (i = 0; i < 16; i++) controller->buffer[16+i] = product_id[i]; if (BX_HD_THIS cdrom_count > 1) { controller->buffer[31] = BX_SELECTED_DRIVE(channel).device_num; } // Product Revision level const char* rev_level = "1.0 "; for (i = 0; i < 4; i++) controller->buffer[32+i] = rev_level[i]; ready_to_send_atapi(channel); } break; case 0x25: // read cd-rom capacity { // no allocation length??? init_send_atapi_command(channel, atapi_command, 8, 8); if (BX_SELECTED_DRIVE(channel).cdrom.ready) { Bit32u capacity = BX_SELECTED_DRIVE(channel).cdrom.max_lba; controller->buffer[0] = (capacity >> 24) & 0xff; controller->buffer[1] = (capacity >> 16) & 0xff; controller->buffer[2] = (capacity >> 8) & 0xff; controller->buffer[3] = (capacity >> 0) & 0xff; controller->buffer[4] = (2048 >> 24) & 0xff; controller->buffer[5] = (2048 >> 16) & 0xff; controller->buffer[6] = (2048 >> 8) & 0xff; controller->buffer[7] = (2048 >> 0) & 0xff; ready_to_send_atapi(channel); } else { atapi_cmd_error(channel, SENSE_NOT_READY, ASC_MEDIUM_NOT_PRESENT, 1); raise_interrupt(channel); } } break; case 0xbe: // read cd { if (BX_SELECTED_DRIVE(channel).cdrom.ready) { Bit32u lba = read_32bit(controller->buffer + 2); Bit32u transfer_length = controller->buffer[8] | (controller->buffer[7] << 8) | (controller->buffer[6] << 16); Bit8u transfer_req = controller->buffer[9]; if (transfer_length == 0) { atapi_cmd_nop(controller); raise_interrupt(channel); break; } switch (transfer_req & 0xf8) { case 0x00: atapi_cmd_nop(controller); raise_interrupt(channel); break; case 0xf8: controller->buffer_size = 2352; case 0x10: { init_send_atapi_command(channel, atapi_command, transfer_length * controller->buffer_size, transfer_length * controller->buffer_size, 1); BX_SELECTED_DRIVE(channel).cdrom.remaining_blocks = transfer_length; BX_SELECTED_DRIVE(channel).cdrom.next_lba = lba; start_seek(channel); } break; default: BX_ERROR(("Read CD: unknown format")); atapi_cmd_error(channel, SENSE_ILLEGAL_REQUEST, ASC_INV_FIELD_IN_CMD_PACKET, 1); raise_interrupt(channel); } } else { atapi_cmd_error(channel, SENSE_NOT_READY, ASC_MEDIUM_NOT_PRESENT, 1); raise_interrupt(channel); } } break; case 0x43: // read toc if (BX_SELECTED_DRIVE(channel).cdrom.ready) { bool msf = (controller->buffer[1] >> 1) & 1; Bit8u starting_track = controller->buffer[6]; int toc_length = 0; Bit16u alloc_length = read_16bit(controller->buffer + 7); Bit8u format = (controller->buffer[9] >> 6); switch (format) { // Win32: I just read the TOC using Win32's IOCTRL functions (Ben) #if BX_SUPPORT_CDROM && defined(WIN32) case 2: case 3: case 4: if (msf != 1) BX_ERROR(("READ_TOC_EX: msf not set for format %i", format)); case 0: case 1: case 5: if (!(BX_SELECTED_DRIVE(channel).cdrom.cd->read_toc(controller->buffer, &toc_length, msf, starting_track, format))) { atapi_cmd_error(channel, SENSE_ILLEGAL_REQUEST, ASC_INV_FIELD_IN_CMD_PACKET, 1); raise_interrupt(channel); } else { init_send_atapi_command(channel, atapi_command, toc_length, alloc_length); ready_to_send_atapi(channel); } break; #else case 0: case 1: case 2: if (!(BX_SELECTED_DRIVE(channel).cdrom.cd->read_toc(controller->buffer, &toc_length, msf, starting_track, format))) { atapi_cmd_error(channel, SENSE_ILLEGAL_REQUEST, ASC_INV_FIELD_IN_CMD_PACKET, 1); raise_interrupt(channel); } else { init_send_atapi_command(channel, atapi_command, toc_length, alloc_length); ready_to_send_atapi(channel); } break; #endif default: BX_ERROR(("(READ TOC) format %d not supported", format)); atapi_cmd_error(channel, SENSE_ILLEGAL_REQUEST, ASC_INV_FIELD_IN_CMD_PACKET, 1); raise_interrupt(channel); } } else { atapi_cmd_error(channel, SENSE_NOT_READY, ASC_MEDIUM_NOT_PRESENT, 1); raise_interrupt(channel); } break; case 0x28: // read (10) case 0xa8: // read (12) { Bit32s transfer_length; if (atapi_command == 0x28) transfer_length = read_16bit(controller->buffer + 7); else transfer_length = read_32bit(controller->buffer + 6); Bit32u lba = read_32bit(controller->buffer + 2); if (!BX_SELECTED_DRIVE(channel).cdrom.ready) { atapi_cmd_error(channel, SENSE_NOT_READY, ASC_MEDIUM_NOT_PRESENT, 1); raise_interrupt(channel); break; } if (lba > BX_SELECTED_DRIVE(channel).cdrom.max_lba) { atapi_cmd_error(channel, SENSE_ILLEGAL_REQUEST, ASC_LOGICAL_BLOCK_OOR, 1); raise_interrupt(channel); break; } // Ben: see comment below if ((lba + transfer_length - 1) > BX_SELECTED_DRIVE(channel).cdrom.max_lba) { transfer_length = (BX_SELECTED_DRIVE(channel).cdrom.max_lba - lba + 1); } if (transfer_length <= 0) { atapi_cmd_nop(controller); raise_interrupt(channel); BX_INFO(("READ(%d) with transfer length <= 0, ok (%i)", atapi_command==0x28?10:12, transfer_length)); break; } /* Ben: I commented this out and added the three lines above. I am not sure this is the correct thing to do, but it seems to work. FIXME: I think that if the transfer_length is more than we can transfer, we should return some sort of flag/error/bitrep stating so. I haven't read the atapi specs enough to know what needs to be done though. if ((lba + transfer_length - 1) > BX_SELECTED_DRIVE(channel).cdrom.max_lba) { atapi_cmd_error(channel, SENSE_ILLEGAL_REQUEST, ASC_LOGICAL_BLOCK_OOR, 1); raise_interrupt(channel); break; } */ BX_DEBUG_ATAPI(("cdrom: READ (%d) LBA=%d LEN=%d DMA=%d", atapi_command==0x28?10:12, lba, transfer_length, controller->packet_dma)); // handle command init_send_atapi_command(channel, atapi_command, transfer_length * 2048, transfer_length * 2048, 1); BX_SELECTED_DRIVE(channel).cdrom.remaining_blocks = transfer_length; BX_SELECTED_DRIVE(channel).cdrom.next_lba = lba; start_seek(channel); } break; case 0x2b: // seek { Bit32u lba = read_32bit(controller->buffer + 2); if (!BX_SELECTED_DRIVE(channel).cdrom.ready) { atapi_cmd_error(channel, SENSE_NOT_READY, ASC_MEDIUM_NOT_PRESENT, 1); raise_interrupt(channel); break; } if (lba > BX_SELECTED_DRIVE(channel).cdrom.max_lba) { atapi_cmd_error(channel, SENSE_ILLEGAL_REQUEST, ASC_LOGICAL_BLOCK_OOR, 1); raise_interrupt(channel); break; } BX_SELECTED_DRIVE(channel).cdrom.cd->seek(lba); BX_SELECTED_DRIVE(channel).cdrom.curr_lba = lba; atapi_cmd_nop(controller); raise_interrupt(channel); // TODO: DSC bit must be cleared here and set after completion } break; case 0x1e: // prevent/allow medium removal if (BX_SELECTED_DRIVE(channel).cdrom.ready) { BX_SELECTED_DRIVE(channel).cdrom.locked = controller->buffer[4] & 1; atapi_cmd_nop(controller); } else { atapi_cmd_error(channel, SENSE_NOT_READY, ASC_MEDIUM_NOT_PRESENT, 1); } raise_interrupt(channel); break; case 0x42: // read sub-channel { bool msf = get_packet_field(controller,1, 1, 1); bool sub_q = get_packet_field(controller,2, 6, 1); Bit8u data_format = get_packet_byte(controller, 3); Bit8u track_number = get_packet_byte(controller, 6); Bit16u alloc_length = get_packet_word(controller, 7); int ret_len = 4; // header size UNUSED(msf); UNUSED(track_number); if (!BX_SELECTED_DRIVE(channel).cdrom.ready) { atapi_cmd_error(channel, SENSE_NOT_READY, ASC_MEDIUM_NOT_PRESENT, 1); raise_interrupt(channel); } else { controller->buffer[0] = 0; controller->buffer[1] = 0; // audio not supported controller->buffer[2] = 0; controller->buffer[3] = 0; if (sub_q) { // !sub_q == header only if ((data_format == 2) || (data_format == 3)) { // UPC or ISRC ret_len = 24; controller->buffer[4] = data_format; if (data_format == 3) { controller->buffer[5] = 0x14; controller->buffer[6] = 1; } controller->buffer[8] = 0; // no UPC, no ISRC } else { BX_ERROR(("Read sub-channel with SubQ not implemented (format=%d)", data_format)); atapi_cmd_error(channel, SENSE_ILLEGAL_REQUEST, ASC_INV_FIELD_IN_CMD_PACKET, 1); raise_interrupt(channel); break; } } init_send_atapi_command(channel, atapi_command, ret_len, alloc_length); ready_to_send_atapi(channel); } } break; case 0x51: // read disc info // no-op to keep the Linux CD-ROM driver happy atapi_cmd_error(channel, SENSE_ILLEGAL_REQUEST, ASC_INV_FIELD_IN_CMD_PACKET, 1); raise_interrupt(channel); break; case 0x4a: // get event status notification { bool polled = (controller->buffer[1] & (1<<0)) > 0; int event_length, request = controller->buffer[4]; Bit16u alloc_length = read_16bit(controller->buffer + 7); bool inserted = BX_SELECTED_DRIVE(channel).cdrom.ready; if (polled) { // we currently only support the MEDIA event (bit 4) if (request == (1<<4)) { controller->buffer[0] = 0; controller->buffer[1] = 4; // MEDIA event is 4 bytes long controller->buffer[2] = (0<<7) | 4; // 4 = MEDIA event controller->buffer[3] = (1<<4); // we only support the MEDIA event (bit 4) controller->buffer[4] = (!BX_SELECTED_DRIVE(channel).status_changed) ? 0 : // Event code: 0 = no change (inserted) ? 4 : 3; // Event code: 4 = media changed, 3 = removed controller->buffer[5] = (inserted) ? (1<<1) : 0; // Media Status (bit 1 = Media Present) controller->buffer[6] = 0; controller->buffer[7] = 0; event_length = (alloc_length <= 4) ? 4 : 8; } else { controller->buffer[0] = 0; controller->buffer[1] = 0; controller->buffer[2] = (1<<7) | (Bit8u) request; controller->buffer[3] = (1<<4); // we only support the MEDIA event (bit 4) event_length = 4; } init_send_atapi_command(channel, atapi_command, event_length, event_length); ready_to_send_atapi(channel); } else { BX_ERROR(("Event Status: Polled only supported")); atapi_cmd_error(channel, SENSE_ILLEGAL_REQUEST, ASC_INV_FIELD_IN_CMD_PACKET, 1); raise_interrupt(channel); } } break; case 0x55: // mode select case 0xa6: // load/unload cd case 0x4b: // pause/resume case 0x45: // play audio case 0x47: // play audio msf case 0xbc: // play cd case 0xb9: // read cd msf case 0x44: // read header case 0xba: // scan case 0xbb: // set cd speed case 0x4e: // stop play/scan case 0x46: // get configuration BX_DEBUG_ATAPI(("ATAPI command 0x%x not implemented yet", atapi_command)); atapi_cmd_error(channel, SENSE_ILLEGAL_REQUEST, ASC_ILLEGAL_OPCODE, 0); raise_interrupt(channel); break; default: BX_ERROR(("Unknown ATAPI command 0x%x (%d)", atapi_command, atapi_command)); atapi_cmd_error(channel, SENSE_ILLEGAL_REQUEST, ASC_ILLEGAL_OPCODE, 1); raise_interrupt(channel); break; } } break; default: BX_PANIC(("IO write(0x%04x): current command is %02xh", address, (unsigned) controller->current_command)); } break; case 0x01: // hard disk write precompensation 0x1f1 WRITE_FEATURES(channel,value); if (value == 0xff) BX_DEBUG(("no precompensation {%s}", BX_SELECTED_TYPE_STRING(channel))); else BX_DEBUG(("precompensation value %02x {%s}", value, BX_SELECTED_TYPE_STRING(channel))); break; case 0x02: // hard disk sector count 0x1f2 WRITE_SECTOR_COUNT(channel,value); BX_DEBUG(("sector count = %u {%s}", value, BX_SELECTED_TYPE_STRING(channel))); break; case 0x03: // hard disk sector number 0x1f3 WRITE_SECTOR_NUMBER(channel,value); BX_DEBUG(("sector number = %u {%s}", value, BX_SELECTED_TYPE_STRING(channel))); break; case 0x04: // hard disk cylinder low 0x1f4 WRITE_CYLINDER_LOW(channel,value); BX_DEBUG(("cylinder low = %02xh {%s}", value, BX_SELECTED_TYPE_STRING(channel))); break; case 0x05: // hard disk cylinder high 0x1f5 WRITE_CYLINDER_HIGH(channel,value); BX_DEBUG(("cylinder high = %02xh {%s}", value, BX_SELECTED_TYPE_STRING(channel))); break; case 0x06: // hard disk drive and head register 0x1f6 // b7 Extended data field for ECC // b6/b5: Used to be sector size. 00=256,01=512,10=1024,11=128 // Since 512 was always used, bit 6 was taken to mean LBA mode: // b6 1=LBA mode, 0=CHS mode // b5 1 // b4: DRV // b3..0 HD3..HD0 { if ((value & 0xa0) != 0xa0) // 1x1xxxxx BX_DEBUG(("IO write 0x%04x (%02x): not 1x1xxxxxb", address, (unsigned) value)); Bit32u drvsel = BX_HD_THIS channels[channel].drive_select = (value >> 4) & 0x01; WRITE_HEAD_NO(channel,value & 0xf); if (!controller->lba_mode && ((value >> 6) & 1) == 1) BX_DEBUG(("enabling LBA mode")); WRITE_LBA_MODE(channel,(value >> 6) & 1); if (!BX_SELECTED_IS_PRESENT(channel)) { BX_DEBUG(("ata%d: device set to %d which does not exist", channel, drvsel)); } } break; case 0x07: // hard disk command 0x1f7 // (mch) Writes to the command register with drive_select != 0 // are ignored if no secondary device is present if ((BX_SLAVE_SELECTED(channel)) && (!BX_SLAVE_IS_PRESENT(channel))) break; // Writes to the command register clear the IRQ DEV_pic_lower_irq(BX_HD_THIS channels[channel].irq); if (controller->status.busy) { BX_ERROR(("ata%d: command 0x%02x sent, controller BSY bit set", channel, value)); break; } if ((value & 0xf0) == 0x10) value = 0x10; controller->status.err = 0; switch (value) { case 0x10: // CALIBRATE DRIVE if (!BX_SELECTED_IS_HD(channel)) { BX_INFO(("ata%d-%d: calibrate drive issued to non-disk", channel, BX_SLAVE_SELECTED(channel))); command_aborted(channel, value); break; } if (!BX_SELECTED_IS_PRESENT(channel)) { controller->error_register = 0x02; // Track 0 not found controller->status.busy = 0; controller->status.drive_ready = 1; controller->status.seek_complete = 0; controller->status.drq = 0; controller->status.err = 1; raise_interrupt(channel); BX_INFO(("calibrate drive: disk ata%d-%d not present", channel, BX_SLAVE_SELECTED(channel))); break; } /* move head to cylinder 0, issue IRQ */ controller->error_register = 0; controller->cylinder_no = 0; controller->status.busy = 0; controller->status.drive_ready = 1; controller->status.seek_complete = 1; controller->status.drq = 0; raise_interrupt(channel); break; case 0x24: // READ SECTORS EXT case 0x29: // READ MULTIPLE EXT lba48 = 1; case 0x20: // READ SECTORS, with retries case 0x21: // READ SECTORS, without retries case 0xC4: // READ MULTIPLE SECTORS /* update sector_no, always points to current sector * after each sector is read to buffer, DRQ bit set and issue IRQ * if interrupt handler transfers all data words into main memory, * and more sectors to read, then set BSY bit again, clear DRQ and * read next sector into buffer * sector count of 0 means 256 sectors */ if (!BX_SELECTED_IS_HD(channel)) { BX_INFO(("ata%d-%d: read sectors issued to non-disk", channel, BX_SLAVE_SELECTED(channel))); command_aborted(channel, value); break; } // Lose98 accesses 0/0/0 in CHS mode if (!controller->lba_mode && !controller->head_no && !controller->cylinder_no && !controller->sector_no) { BX_INFO(("ata%d-%d: : read from 0/0/0, aborting command", channel, BX_SLAVE_SELECTED(channel))); command_aborted(channel, value); break; } lba48_transform(controller, lba48); if ((value == 0xC4) || (value == 0x29)) { if (controller->multiple_sectors == 0) { command_aborted(channel, value); break; } if (controller->num_sectors > controller->multiple_sectors) { controller->buffer_size = controller->multiple_sectors * sect_size; } else { controller->buffer_size = controller->num_sectors * sect_size; } } else { controller->buffer_size = sect_size; } if (!calculate_logical_address(channel, &logical_sector)) { command_aborted(channel, value); break; } BX_SELECTED_DRIVE(channel).next_lsector = logical_sector; controller->current_command = value; controller->error_register = 0; controller->status.busy = 1; controller->status.drive_ready = 1; controller->status.seek_complete = 0; controller->status.drq = 0; controller->status.corrected_data = 0; controller->buffer_index = 0; start_seek(channel); if (!ide_read_sector(channel, controller->buffer, controller->buffer_size)) { bx_pc_system.deactivate_timer( BX_SELECTED_DRIVE(channel).seek_timer_index); command_aborted(channel, value); } break; case 0x34: // WRITE SECTORS EXT case 0x39: // WRITE MULTIPLE EXT lba48 = 1; case 0x30: // WRITE SECTORS, with retries case 0xC5: // WRITE MULTIPLE SECTORS /* update sector_no, always points to current sector * after each sector is read to buffer, DRQ bit set and issue IRQ * if interrupt handler transfers all data words into main memory, * and more sectors to read, then set BSY bit again, clear DRQ and * read next sector into buffer * sector count of 0 means 256 sectors */ if (!BX_SELECTED_IS_HD(channel)) { BX_INFO(("ata%d-%d: write sectors issued to non-disk", channel, BX_SLAVE_SELECTED(channel))); command_aborted(channel, value); break; } lba48_transform(controller, lba48); if ((value == 0xC5) || (value ==0x39)) { if (controller->multiple_sectors == 0) { command_aborted(channel, value); break; } if (controller->num_sectors > controller->multiple_sectors) { controller->buffer_size = controller->multiple_sectors * sect_size; } else { controller->buffer_size = controller->num_sectors * sect_size; } } else { controller->buffer_size = sect_size; } if (!calculate_logical_address(channel, &logical_sector)) { command_aborted(channel, value); break; } BX_SELECTED_DRIVE(channel).next_lsector = logical_sector; controller->current_command = value; // implicit seek done :^) controller->error_register = 0; controller->status.busy = 0; // controller->status.drive_ready = 1; controller->status.seek_complete = 1; controller->status.drq = 1; controller->buffer_index = 0; break; case 0x90: // EXECUTE DEVICE DIAGNOSTIC set_signature(channel, BX_SLAVE_SELECTED(channel)); controller->error_register = 0x01; controller->status.drq = 0; raise_interrupt(channel); break; case 0x91: // INITIALIZE DRIVE PARAMETERS if (!BX_SELECTED_IS_HD(channel)) { BX_INFO(("ata%d-%d: initialize drive parameters issued to non-disk", channel, BX_SLAVE_SELECTED(channel))); command_aborted(channel, value); break; } // sets logical geometry of specified drive BX_DEBUG(("ata%d-%d: init drive params: sec=%u, drive sel=%u, head=%u", channel, BX_SLAVE_SELECTED(channel), (unsigned) controller->sector_count, (unsigned) BX_HD_THIS channels[channel].drive_select, (unsigned) controller->head_no)); if (!BX_SELECTED_IS_PRESENT(channel)) { BX_PANIC(("init drive params: disk ata%d-%d not present", channel, BX_SLAVE_SELECTED(channel))); //controller->error_register = 0x12; controller->status.busy = 0; controller->status.drive_ready = 1; controller->status.drq = 0; raise_interrupt(channel); break; } if (controller->sector_count != BX_SELECTED_DRIVE(channel).hdimage->spt) { BX_ERROR(("ata%d-%d: init drive params: logical sector count %d not supported", channel, BX_SLAVE_SELECTED(channel), controller->sector_count)); command_aborted(channel, value); break; } if (controller->head_no == 0) { // Linux 2.6.x kernels use this value and don't like aborting here BX_ERROR(("ata%d-%d: init drive params: max. logical head number 0 not supported", channel, BX_SLAVE_SELECTED(channel))); } else if (controller->head_no != (BX_SELECTED_DRIVE(channel).hdimage->heads-1)) { BX_ERROR(("ata%d-%d: init drive params: max. logical head number %d not supported", channel, BX_SLAVE_SELECTED(channel), controller->head_no)); command_aborted(channel, value); break; } controller->status.busy = 0; controller->status.drive_ready = 1; controller->status.drq = 0; raise_interrupt(channel); break; case 0xec: // IDENTIFY DEVICE { BX_DEBUG(("Drive ID Command issued : 0xec ")); if (!BX_SELECTED_IS_PRESENT(channel)) { BX_INFO(("disk ata%d-%d not present, aborting",channel,BX_SLAVE_SELECTED(channel))); command_aborted(channel, value); break; } if (BX_SELECTED_IS_CD(channel)) { set_signature(channel, BX_SLAVE_SELECTED(channel)); command_aborted(channel, 0xec); } else { controller->current_command = value; controller->error_register = 0; // See ATA/ATAPI-4, 8.12 controller->status.busy = 0; controller->status.drive_ready = 1; controller->status.write_fault = 0; controller->status.drq = 1; controller->status.seek_complete = 1; controller->status.corrected_data = 0; controller->buffer_index = 0; if (!BX_SELECTED_DRIVE(channel).identify_set) { identify_drive(channel); } // now convert the id_drive array (native 256 word format) to // the controller buffer (512 bytes) for (i=0; i<=255; i++) { Bit16u temp16 = BX_SELECTED_DRIVE(channel).id_drive[i]; controller->buffer[i*2] = temp16 & 0x00ff; controller->buffer[i*2+1] = temp16 >> 8; } raise_interrupt(channel); } } break; case 0xef: // SET FEATURES switch(controller->features) { case 0x03: // Set Transfer Mode { Bit8u type = (controller->sector_count >> 3); Bit8u mode = controller->sector_count & 0x07; switch (type) { case 0x00: // PIO default case 0x01: // PIO mode BX_INFO(("ata%d-%d: set transfer mode to PIO", channel, BX_SLAVE_SELECTED(channel))); controller->mdma_mode = 0x00; controller->udma_mode = 0x00; controller->status.drive_ready = 1; controller->status.seek_complete = 1; raise_interrupt(channel); break; case 0x04: // MDMA mode BX_INFO(("ata%d-%d: set transfer mode to MDMA%d", channel, BX_SLAVE_SELECTED(channel), mode)); controller->mdma_mode = (1 << mode); controller->udma_mode = 0x00; controller->status.drive_ready = 1; controller->status.seek_complete = 1; raise_interrupt(channel); break; case 0x08: // UDMA mode controller->mdma_mode = 0x00; controller->udma_mode = (1 << mode); controller->status.drive_ready = 1; controller->status.seek_complete = 1; raise_interrupt(channel); break; default: BX_ERROR(("ata%d-%d: unknown transfer mode type 0x%02x", channel, BX_SLAVE_SELECTED(channel), type)); command_aborted(channel, value); } BX_SELECTED_DRIVE(channel).identify_set = 0; } break; case 0x02: // Enable and case 0x82: // Disable write cache. case 0xAA: // Enable and case 0x55: // Disable look-ahead cache. case 0xCC: // Enable and case 0x66: // Disable reverting to power-on default BX_INFO(("ata%d-%d: SET FEATURES subcommand 0x%02x not supported, but returning success", channel,BX_SLAVE_SELECTED(channel),(unsigned) controller->features)); controller->status.drive_ready = 1; controller->status.seek_complete = 1; raise_interrupt(channel); break; default: BX_ERROR(("ata%d-%d: SET FEATURES with unknown subcommand: 0x%02x", channel,BX_SLAVE_SELECTED(channel),(unsigned) controller->features)); command_aborted(channel, value); } break; case 0x42: // READ VERIFY SECTORS EXT lba48 = 1; case 0x40: // READ VERIFY SECTORS case 0x41: // READ VERIFY SECTORS NO RETRY if (!BX_SELECTED_IS_HD(channel)) { BX_INFO(("ata%d-%d: read verify issued to non-disk", channel,BX_SLAVE_SELECTED(channel))); command_aborted(channel, value); break; } lba48_transform(controller, lba48); BX_INFO(("ata%d-%d: verify command : 0x%02x !", channel,BX_SLAVE_SELECTED(channel), value)); controller->status.busy = 0; controller->status.drive_ready = 1; controller->status.drq = 0; raise_interrupt(channel); break; case 0xc6: // SET MULTIPLE MODE if (!BX_SELECTED_IS_HD(channel)) { BX_INFO(("set multiple mode issued to non-disk")); command_aborted(channel, value); } else if ((controller->sector_count > MAX_MULTIPLE_SECTORS) || ((controller->sector_count & (controller->sector_count - 1)) != 0) || (controller->sector_count == 0)) { command_aborted(channel, value); } else { BX_DEBUG(("set multiple mode: sectors=%d", controller->sector_count)); controller->multiple_sectors = controller->sector_count; controller->status.busy = 0; controller->status.drive_ready = 1; controller->status.write_fault = 0; controller->status.drq = 0; raise_interrupt(channel); } break; // ATAPI commands case 0xa1: // IDENTIFY PACKET DEVICE { if (BX_SELECTED_IS_CD(channel)) { controller->current_command = value; controller->error_register = 0; controller->status.busy = 0; controller->status.drive_ready = 1; controller->status.write_fault = 0; controller->status.drq = 1; controller->status.seek_complete = 1; controller->status.corrected_data = 0; controller->buffer_index = 0; if (!BX_SELECTED_DRIVE(channel).identify_set) { identify_ATAPI_drive(channel); } // now convert the id_drive array (native 256 word format) to // the controller buffer (512 bytes) for (i = 0; i <= 255; i++) { Bit16u temp16 = BX_SELECTED_DRIVE(channel).id_drive[i]; controller->buffer[i*2] = temp16 & 0x00ff; controller->buffer[i*2+1] = temp16 >> 8; } raise_interrupt(channel); } else { command_aborted(channel, 0xa1); } } break; case 0x08: // DEVICE RESET (atapi) if (BX_SELECTED_IS_CD(channel)) { set_signature(channel, BX_SLAVE_SELECTED(channel)); controller->status.busy = 1; controller->error_register &= ~(1 << 7); controller->status.write_fault = 0; controller->status.drq = 0; controller->status.corrected_data = 0; controller->status.busy = 0; } else { BX_DEBUG_ATAPI(("ATAPI Device Reset on non-cd device")); command_aborted(channel, 0x08); } break; case 0xa0: // SEND PACKET (atapi) if (BX_SELECTED_IS_CD(channel)) { // PACKET controller->packet_dma = (controller->features & 1); if (controller->features & (1 << 1)) { BX_ERROR(("PACKET-overlapped not supported")); command_aborted (channel, 0xa0); } else { // We're already ready! controller->sector_count = 1; controller->status.busy = 0; controller->status.write_fault = 0; // serv bit?? controller->status.drq = 1; // NOTE: no interrupt here controller->current_command = value; controller->buffer_index = 0; } } else { command_aborted (channel, 0xa0); } break; case 0xa2: // SERVICE (atapi), optional if (BX_SELECTED_IS_CD(channel)) { BX_PANIC(("ATAPI SERVICE not implemented")); command_aborted(channel, 0xa2); } else { command_aborted(channel, 0xa2); } break; // power management & flush cache stubs case 0xE0: // STANDBY NOW case 0xE1: // IDLE IMMEDIATE case 0xE7: // FLUSH CACHE case 0xEA: // FLUSH CACHE EXT controller->status.busy = 0; controller->status.drive_ready = 1; controller->status.write_fault = 0; controller->status.drq = 0; raise_interrupt(channel); break; case 0xe5: // CHECK POWER MODE controller->status.busy = 0; controller->status.drive_ready = 1; controller->status.write_fault = 0; controller->status.drq = 0; controller->sector_count = 0xff; // Active or Idle mode raise_interrupt(channel); break; case 0x70: // SEEK (cgs) if (BX_SELECTED_IS_HD(channel)) { BX_DEBUG(("write cmd 0x70 (SEEK) executing")); if (!calculate_logical_address(channel, &logical_sector)) { command_aborted(channel, value); break; } BX_SELECTED_DRIVE(channel).next_lsector = logical_sector; controller->current_command = value; controller->error_register = 0; controller->status.busy = 1; controller->status.drive_ready = 1; controller->status.seek_complete = 0; controller->status.drq = 0; controller->status.corrected_data = 0; start_seek(channel); } else { BX_INFO(("write cmd 0x70 (SEEK) not supported for non-disk")); command_aborted(channel, 0x70); } break; case 0x25: // READ DMA EXT lba48 = 1; case 0xC8: // READ DMA if (BX_SELECTED_IS_HD(channel) && BX_HD_THIS bmdma_present()) { lba48_transform(controller, lba48); if (!calculate_logical_address(channel, &logical_sector)) { command_aborted(channel, value); break; } BX_SELECTED_DRIVE(channel).next_lsector = logical_sector; controller->current_command = value; controller->error_register = 0; controller->status.busy = 1; controller->status.drive_ready = 1; controller->status.seek_complete = 0; controller->status.drq = 0; controller->status.corrected_data = 0; start_seek(channel); } else { BX_ERROR(("write cmd 0x%02x (READ DMA) not supported", value)); command_aborted(channel, value); } break; case 0x35: // WRITE DMA EXT lba48 = 1; case 0xCA: // WRITE DMA if (BX_SELECTED_IS_HD(channel) && BX_HD_THIS bmdma_present()) { lba48_transform(controller, lba48); if (!calculate_logical_address(channel, &logical_sector)) { command_aborted(channel, value); break; } BX_SELECTED_DRIVE(channel).next_lsector = logical_sector; controller->status.drive_ready = 1; controller->status.seek_complete = 1; controller->status.drq = 1; controller->current_command = value; } else { BX_ERROR(("write cmd 0x%02x (WRITE DMA) not supported", value)); command_aborted(channel, value); } break; case 0x27: // READ NATIVE MAX ADDRESS EXT lba48 = 1; case 0xF8: // READ NATIVE MAX ADDRESS if (BX_SELECTED_IS_HD(channel)) { lba48_transform(controller, lba48); Bit64s max_sector = BX_SELECTED_DRIVE(channel).hdimage->hd_size / sect_size - 1; if (controller->lba_mode) { if (!controller->lba48) { controller->head_no = (Bit8u)((max_sector >> 24) & 0xf); controller->cylinder_no = (Bit16u)((max_sector >> 8) & 0xffff); controller->sector_no = (Bit8u)((max_sector) & 0xff); } else { controller->hob.hcyl = (Bit8u)((max_sector >> 40) & 0xff); controller->hob.lcyl = (Bit8u)((max_sector >> 32) & 0xff); controller->hob.sector = (Bit8u)((max_sector >> 24) & 0xff); controller->cylinder_no = (Bit16u)((max_sector >> 8) & 0xffff); controller->sector_no = (Bit8u)((max_sector) & 0xff); } controller->status.drive_ready = 1; controller->status.seek_complete = 1; raise_interrupt(channel); } else { command_aborted(channel, value); } } else { command_aborted(channel, value); } break; // List all the write operations that are defined in the ATA/ATAPI spec // that we don't support. Commands that are listed here will cause a // BX_ERROR, which is non-fatal, and the command will be aborted. case 0x22: BX_ERROR(("write cmd 0x22 (READ LONG) not supported")); command_aborted(channel, 0x22); break; case 0x23: BX_ERROR(("write cmd 0x23 (READ LONG NO RETRY) not supported")); command_aborted(channel, 0x23); break; case 0x26: BX_ERROR(("write cmd 0x26 (READ DMA QUEUED EXT) not supported"));command_aborted(channel, 0x26); break; case 0x2A: BX_ERROR(("write cmd 0x2A (READ STREAM DMA) not supported"));command_aborted(channel, 0x2A); break; case 0x2B: BX_ERROR(("write cmd 0x2B (READ STREAM PIO) not supported"));command_aborted(channel, 0x2B); break; case 0x2F: BX_ERROR(("write cmd 0x2F (READ LOG EXT) not supported"));command_aborted(channel, 0x2F); break; case 0x31: BX_ERROR(("write cmd 0x31 (WRITE SECTORS NO RETRY) not supported")); command_aborted(channel, 0x31); break; case 0x32: BX_ERROR(("write cmd 0x32 (WRITE LONG) not supported")); command_aborted(channel, 0x32); break; case 0x33: BX_ERROR(("write cmd 0x33 (WRITE LONG NO RETRY) not supported")); command_aborted(channel, 0x33); break; case 0x36: BX_ERROR(("write cmd 0x36 (WRITE DMA QUEUED EXT) not supported"));command_aborted(channel, 0x36); break; case 0x37: BX_ERROR(("write cmd 0x37 (SET MAX ADDRESS EXT) not supported"));command_aborted(channel, 0x37); break; case 0x38: BX_ERROR(("write cmd 0x38 (CFA WRITE SECTORS W/OUT ERASE) not supported"));command_aborted(channel, 0x38); break; case 0x3A: BX_ERROR(("write cmd 0x3A (WRITE STREAM DMA) not supported"));command_aborted(channel, 0x3A); break; case 0x3B: BX_ERROR(("write cmd 0x3B (WRITE STREAM PIO) not supported"));command_aborted(channel, 0x3B); break; case 0x3F: BX_ERROR(("write cmd 0x3F (WRITE LOG EXT) not supported"));command_aborted(channel, 0x3F); break; case 0x50: BX_ERROR(("write cmd 0x50 (FORMAT TRACK) not supported")); command_aborted(channel, 0x50); break; case 0x51: BX_ERROR(("write cmd 0x51 (CONFIGURE STREAM) not supported"));command_aborted(channel, 0x51); break; case 0x87: BX_ERROR(("write cmd 0x87 (CFA TRANSLATE SECTOR) not supported"));command_aborted(channel, 0x87); break; case 0x92: BX_ERROR(("write cmd 0x92 (DOWNLOAD MICROCODE) not supported"));command_aborted(channel, 0x92); break; case 0x94: BX_ERROR(("write cmd 0x94 (STANDBY IMMEDIATE) not supported")); command_aborted(channel, 0x94); break; case 0x95: BX_ERROR(("write cmd 0x95 (IDLE IMMEDIATE) not supported")); command_aborted(channel, 0x95); break; case 0x96: BX_ERROR(("write cmd 0x96 (STANDBY) not supported")); command_aborted(channel, 0x96); break; case 0x97: BX_ERROR(("write cmd 0x97 (IDLE) not supported")); command_aborted(channel, 0x97); break; case 0x98: BX_ERROR(("write cmd 0x98 (CHECK POWER MODE) not supported")); command_aborted(channel, 0x98); break; case 0x99: BX_ERROR(("write cmd 0x99 (SLEEP) not supported")); command_aborted(channel, 0x99); break; case 0xB0: BX_ERROR(("write cmd 0xB0 (SMART commands) not supported"));command_aborted(channel, 0xB0); break; case 0xB1: BX_ERROR(("write cmd 0xB1 (DEVICE CONFIGURATION commands) not supported"));command_aborted(channel, 0xB1); break; case 0xC0: BX_ERROR(("write cmd 0xC0 (CFA ERASE SECTORS) not supported"));command_aborted(channel, 0xC0); break; case 0xC7: BX_ERROR(("write cmd 0xC7 (READ DMA QUEUED) not supported"));command_aborted(channel, 0xC7); break; case 0xC9: BX_ERROR(("write cmd 0xC9 (READ DMA NO RETRY) not supported")); command_aborted(channel, 0xC9); break; case 0xCC: BX_ERROR(("write cmd 0xCC (WRITE DMA QUEUED) not supported"));command_aborted(channel, 0xCC); break; case 0xCD: BX_ERROR(("write cmd 0xCD (CFA WRITE MULTIPLE W/OUT ERASE) not supported"));command_aborted(channel, 0xCD); break; case 0xD1: BX_ERROR(("write cmd 0xD1 (CHECK MEDIA CARD TYPE) not supported"));command_aborted(channel, 0xD1); break; case 0xDA: BX_ERROR(("write cmd 0xDA (GET MEDIA STATUS) not supported"));command_aborted(channel, 0xDA); break; case 0xDE: BX_ERROR(("write cmd 0xDE (MEDIA LOCK) not supported"));command_aborted(channel, 0xDE); break; case 0xDF: BX_ERROR(("write cmd 0xDF (MEDIA UNLOCK) not supported"));command_aborted(channel, 0xDF); break; case 0xE2: BX_ERROR(("write cmd 0xE2 (STANDBY) not supported"));command_aborted(channel, 0xE2); break; case 0xE3: BX_ERROR(("write cmd 0xE3 (IDLE) not supported"));command_aborted(channel, 0xE3); break; case 0xE4: BX_ERROR(("write cmd 0xE4 (READ BUFFER) not supported"));command_aborted(channel, 0xE4); break; case 0xE6: BX_ERROR(("write cmd 0xE6 (SLEEP) not supported"));command_aborted(channel, 0xE6); break; case 0xE8: BX_ERROR(("write cmd 0xE8 (WRITE BUFFER) not supported"));command_aborted(channel, 0xE8); break; case 0xED: BX_ERROR(("write cmd 0xED (MEDIA EJECT) not supported"));command_aborted(channel, 0xED); break; case 0xF1: BX_ERROR(("write cmd 0xF1 (SECURITY SET PASSWORD) not supported"));command_aborted(channel, 0xF1); break; case 0xF2: BX_ERROR(("write cmd 0xF2 (SECURITY UNLOCK) not supported"));command_aborted(channel, 0xF2); break; case 0xF3: BX_ERROR(("write cmd 0xF3 (SECURITY ERASE PREPARE) not supported"));command_aborted(channel, 0xF3); break; case 0xF4: BX_ERROR(("write cmd 0xF4 (SECURITY ERASE UNIT) not supported"));command_aborted(channel, 0xF4); break; case 0xF5: BX_ERROR(("write cmd 0xF5 (SECURITY FREEZE LOCK) not supported"));command_aborted(channel, 0xF5); break; case 0xF6: BX_ERROR(("write cmd 0xF6 (SECURITY DISABLE PASSWORD) not supported"));command_aborted(channel, 0xF6); break; case 0xF9: BX_ERROR(("write cmd 0xF9 (SET MAX ADDRESS) not supported"));command_aborted(channel, 0xF9); break; default: BX_ERROR(("IO write to 0x%04x: unknown command 0x%02x", address, value)); command_aborted(channel, value); } break; case 0x16: // hard disk adapter control 0x3f6 // (mch) Even if device 1 was selected, a write to this register // goes to device 0 (if device 1 is absent) prev_control_reset = controller->control.reset; BX_HD_THIS channels[channel].drives[0].controller.control.reset = value & 0x04; BX_HD_THIS channels[channel].drives[1].controller.control.reset = value & 0x04; BX_HD_THIS channels[channel].drives[0].controller.control.disable_irq = value & 0x02; BX_HD_THIS channels[channel].drives[1].controller.control.disable_irq = value & 0x02; BX_DEBUG(("ata%d: adapter control reg: reset controller = %d", channel, (unsigned) (controller->control.reset) ? 1 : 0)); BX_DEBUG(("ata%d: adapter control reg: disable irq = %d", channel, (unsigned) (controller->control.disable_irq) ? 1 : 0)); if (!prev_control_reset && controller->control.reset) { // transition from 0 to 1 causes all drives to reset BX_DEBUG(("Enter RESET mode")); // (mch) Set BSY, drive not ready for (int id = 0; id < 2; id++) { BX_CONTROLLER(channel,id).status.busy = 1; BX_CONTROLLER(channel,id).status.drive_ready = 0; BX_CONTROLLER(channel,id).reset_in_progress = 1; BX_CONTROLLER(channel,id).status.write_fault = 0; BX_CONTROLLER(channel,id).status.seek_complete = 1; BX_CONTROLLER(channel,id).status.drq = 0; BX_CONTROLLER(channel,id).status.corrected_data = 0; BX_CONTROLLER(channel,id).status.err = 0; BX_CONTROLLER(channel,id).error_register = 0x01; // diagnostic code: no error BX_CONTROLLER(channel,id).current_command = 0x00; BX_CONTROLLER(channel,id).buffer_index = 0; BX_CONTROLLER(channel,id).multiple_sectors = 0; BX_CONTROLLER(channel,id).lba_mode = 0; BX_CONTROLLER(channel,id).control.disable_irq = 0; DEV_pic_lower_irq(BX_HD_THIS channels[channel].irq); } } else if (controller->reset_in_progress && !controller->control.reset) { // Clear BSY and DRDY BX_DEBUG(("Reset complete {%s}", BX_SELECTED_TYPE_STRING(channel))); for (int id = 0; id < 2; id++) { BX_CONTROLLER(channel,id).status.busy = 0; BX_CONTROLLER(channel,id).status.drive_ready = 1; BX_CONTROLLER(channel,id).reset_in_progress = 0; set_signature(channel, id); } } BX_DEBUG(("ata%d: adapter control reg: disable irq = %d", channel, (unsigned) (controller->control.disable_irq) ? 1 : 0)); break; default: BX_PANIC(("hard drive: io write to address %x = %02x", (unsigned) address, (unsigned) value)); } } bool BX_CPP_AttrRegparmN(2) bx_hard_drive_c::calculate_logical_address(Bit8u channel, Bit64s *sector) { Bit64s logical_sector; controller_t *controller = &BX_SELECTED_CONTROLLER(channel); if (controller->lba_mode) { if (!controller->lba48) { logical_sector = ((Bit32u)controller->head_no) << 24 | ((Bit32u)controller->cylinder_no) << 8 | (Bit32u)controller->sector_no; } else { logical_sector = ((Bit64u)controller->hob.hcyl) << 40 | ((Bit64u)controller->hob.lcyl) << 32 | ((Bit64u)controller->hob.sector) << 24 | ((Bit64u)controller->cylinder_no) << 8 | (Bit64u)controller->sector_no; } } else { logical_sector = ((Bit32u)controller->cylinder_no * BX_SELECTED_DRIVE(channel).hdimage->heads * BX_SELECTED_DRIVE(channel).hdimage->spt) + (Bit32u)(controller->head_no * BX_SELECTED_DRIVE(channel).hdimage->spt) + (controller->sector_no - 1); } Bit64s sector_count = BX_SELECTED_DRIVE(channel).hdimage->hd_size / BX_SELECTED_DRIVE(channel).sect_size; if (logical_sector >= sector_count) { BX_ERROR (("logical address out of bounds (" FMT_LL "d/" FMT_LL "d) - aborting command", logical_sector, sector_count)); return 0; } *sector = logical_sector; return 1; } void BX_CPP_AttrRegparmN(2) bx_hard_drive_c::increment_address(Bit8u channel, Bit64s *sector) { controller_t *controller = &BX_SELECTED_CONTROLLER(channel); controller->sector_count--; controller->num_sectors--; if (controller->lba_mode) { Bit64s logical_sector = *sector; logical_sector++; if (!controller->lba48) { controller->head_no = (Bit8u)((logical_sector >> 24) & 0xf); controller->cylinder_no = (Bit16u)((logical_sector >> 8) & 0xffff); controller->sector_no = (Bit8u)((logical_sector) & 0xff); } else { controller->hob.hcyl = (Bit8u)((logical_sector >> 40) & 0xff); controller->hob.lcyl = (Bit8u)((logical_sector >> 32) & 0xff); controller->hob.sector = (Bit8u)((logical_sector >> 24) & 0xff); controller->cylinder_no = (Bit16u)((logical_sector >> 8) & 0xffff); controller->sector_no = (Bit8u)((logical_sector) & 0xff); } *sector = logical_sector; } else { controller->sector_no++; if (controller->sector_no > BX_SELECTED_DRIVE(channel).hdimage->spt) { controller->sector_no = 1; controller->head_no++; if (controller->head_no >= BX_SELECTED_DRIVE(channel).hdimage->heads) { controller->head_no = 0; controller->cylinder_no++; if (controller->cylinder_no >= BX_SELECTED_DRIVE(channel).hdimage->cylinders) { controller->cylinder_no = BX_SELECTED_DRIVE(channel).hdimage->cylinders - 1; } } } } } void bx_hard_drive_c::identify_ATAPI_drive(Bit8u channel) { unsigned i; char serial_number[21]; memset(&BX_SELECTED_DRIVE(channel).id_drive, 0, 512); BX_SELECTED_DRIVE(channel).id_drive[0] = (2 << 14) | (5 << 8) | (1 << 7) | (2 << 5) | (0 << 0); // Removable CDROM, 50us response, 12 byte packets for (i = 1; i <= 9; i++) BX_SELECTED_DRIVE(channel).id_drive[i] = 0; strcpy(serial_number, "BXCD00000 "); serial_number[8] = BX_SELECTED_DRIVE(channel).device_num; for (i = 0; i < 10; i++) { BX_SELECTED_DRIVE(channel).id_drive[10+i] = (serial_number[i*2] << 8) | serial_number[i*2 + 1]; } for (i = 20; i <= 22; i++) BX_SELECTED_DRIVE(channel).id_drive[i] = 0; const char* firmware = "ALPHA1 "; for (i = 0; i < strlen(firmware)/2; i++) { BX_SELECTED_DRIVE(channel).id_drive[23+i] = (firmware[i*2] << 8) | firmware[i*2 + 1]; } BX_ASSERT((23+i) == 27); for (i = 0; i < strlen((char *) BX_SELECTED_MODEL(channel))/2; i++) { BX_SELECTED_DRIVE(channel).id_drive[27+i] = (BX_SELECTED_MODEL(channel)[i*2] << 8) | BX_SELECTED_MODEL(channel)[i*2 + 1]; } BX_ASSERT((27+i) == 47); BX_SELECTED_DRIVE(channel).id_drive[47] = 0; BX_SELECTED_DRIVE(channel).id_drive[48] = 1; // 32 bits access if (BX_HD_THIS bmdma_present()) { BX_SELECTED_DRIVE(channel).id_drive[49] = (1<<9) | (1<<8); // LBA and DMA } else { BX_SELECTED_DRIVE(channel).id_drive[49] = (1<<9); // LBA only supported } BX_SELECTED_DRIVE(channel).id_drive[50] = 0; BX_SELECTED_DRIVE(channel).id_drive[51] = 0; BX_SELECTED_DRIVE(channel).id_drive[52] = 0; BX_SELECTED_DRIVE(channel).id_drive[53] = 3; // words 64-70, 54-58 valid for (i = 54; i <= 62; i++) BX_SELECTED_DRIVE(channel).id_drive[i] = 0; if (BX_HD_THIS bmdma_present()) { BX_SELECTED_DRIVE(channel).id_drive[63] = 0x07 | (BX_SELECTED_CONTROLLER(channel).mdma_mode << 8); } else { BX_SELECTED_DRIVE(channel).id_drive[63] = 0x0; } BX_SELECTED_DRIVE(channel).id_drive[64] = 0x0001; // PIO BX_SELECTED_DRIVE(channel).id_drive[65] = 0x00b4; BX_SELECTED_DRIVE(channel).id_drive[66] = 0x00b4; BX_SELECTED_DRIVE(channel).id_drive[67] = 0x012c; BX_SELECTED_DRIVE(channel).id_drive[68] = 0x00b4; BX_SELECTED_DRIVE(channel).id_drive[69] = 0; BX_SELECTED_DRIVE(channel).id_drive[70] = 0; BX_SELECTED_DRIVE(channel).id_drive[71] = 30; // faked BX_SELECTED_DRIVE(channel).id_drive[72] = 30; // faked BX_SELECTED_DRIVE(channel).id_drive[73] = 0; BX_SELECTED_DRIVE(channel).id_drive[74] = 0; BX_SELECTED_DRIVE(channel).id_drive[75] = 0; for (i = 76; i <= 79; i++) BX_SELECTED_DRIVE(channel).id_drive[i] = 0; BX_SELECTED_DRIVE(channel).id_drive[80] = 0x1e; // supports up to ATA/ATAPI-4 BX_SELECTED_DRIVE(channel).id_drive[81] = 0; BX_SELECTED_DRIVE(channel).id_drive[82] = 0; BX_SELECTED_DRIVE(channel).id_drive[83] = 0; BX_SELECTED_DRIVE(channel).id_drive[84] = 0; BX_SELECTED_DRIVE(channel).id_drive[85] = 0; BX_SELECTED_DRIVE(channel).id_drive[86] = 0; BX_SELECTED_DRIVE(channel).id_drive[87] = 0; BX_SELECTED_DRIVE(channel).id_drive[88] = 0; BX_SELECTED_DRIVE(channel).identify_set = 1; } void bx_hard_drive_c::identify_drive(Bit8u channel) { unsigned i; char serial_number[21]; Bit32u temp32; Bit64u num_sects; memset(&BX_SELECTED_DRIVE(channel).id_drive, 0, 512); // Identify Drive command return values definition // // This code is rehashed from some that was donated. // I'm using ANSI X3.221-1994, AT Attachment Interface for Disk Drives // and X3T10 2008D Working Draft for ATA-3 // Word 0: general config bit-significant info // Note: bits 1-5 and 8-14 are now "Vendor specific (obsolete)" // bit 15: 0=ATA device // 1=ATAPI device // bit 14: 1=format speed tolerance gap required // bit 13: 1=track offset option available // bit 12: 1=data strobe offset option available // bit 11: 1=rotational speed tolerance is > 0,5% (typo?) // bit 10: 1=disk transfer rate > 10Mbs // bit 9: 1=disk transfer rate > 5Mbs but <= 10Mbs // bit 8: 1=disk transfer rate <= 5Mbs // bit 7: 1=removable cartridge drive // bit 6: 1=fixed drive // bit 5: 1=spindle motor control option implemented // bit 4: 1=head switch time > 15 usec // bit 3: 1=not MFM encoded // bit 2: 1=soft sectored // bit 1: 1=hard sectored // bit 0: 0=reserved BX_SELECTED_DRIVE(channel).id_drive[0] = 0x0040; // Word 1: number of user-addressable cylinders in // default translation mode. If the value in words 60-61 // exceed 16,515,072, this word shall contain 16,383. if (BX_SELECTED_DRIVE(channel).hdimage->cylinders > 16383) { BX_SELECTED_DRIVE(channel).id_drive[1] = 16383; } else { BX_SELECTED_DRIVE(channel).id_drive[1] = BX_SELECTED_DRIVE(channel).hdimage->cylinders; } // Word 2: reserved // Word 3: number of user-addressable heads in default // translation mode BX_SELECTED_DRIVE(channel).id_drive[3] = BX_SELECTED_DRIVE(channel).hdimage->heads; // Word 4: # unformatted bytes per translated track in default xlate mode // Word 5: # unformatted bytes per sector in default xlated mode // Word 6: # user-addressable sectors per track in default xlate mode // Note: words 4,5 are now "Vendor specific (obsolete)" BX_SELECTED_DRIVE(channel).id_drive[4] = (BX_SELECTED_DRIVE(channel).sect_size * BX_SELECTED_DRIVE(channel).hdimage->spt); BX_SELECTED_DRIVE(channel).id_drive[5] = BX_SELECTED_DRIVE(channel).sect_size; BX_SELECTED_DRIVE(channel).id_drive[6] = BX_SELECTED_DRIVE(channel).hdimage->spt; // Word 7-9: Vendor specific // Word 10-19: Serial number (20 ASCII characters, 0000h=not specified) // This field is right justified and padded with spaces (20h). strcpy(serial_number, "BXHD00000 "); serial_number[7] = channel + 49; serial_number[8] = BX_HD_THIS channels[channel].drive_select + 49; for (i = 0; i < 10; i++) { BX_SELECTED_DRIVE(channel).id_drive[10+i] = (serial_number[i*2] << 8) | serial_number[i*2 + 1]; } // Word 20: buffer type // 0000h = not specified // 0001h = single ported single sector buffer which is // not capable of simulataneous data xfers to/from // the host and the disk. // 0002h = dual ported multi-sector buffer capable of // simulatenous data xfers to/from the host and disk. // 0003h = dual ported mutli-sector buffer capable of // simulatenous data xfers with a read caching // capability. // 0004h-ffffh = reserved BX_SELECTED_DRIVE(channel).id_drive[20] = 3; // Word 21: buffer size in 512 byte increments, 0000h = not specified BX_SELECTED_DRIVE(channel).id_drive[21] = 512; // 512 Sectors = 256kB cache // Word 22: # of ECC bytes available on read/write long cmds // 0000h = not specified BX_SELECTED_DRIVE(channel).id_drive[22] = 4; // Word 23..26: Firmware revision (8 ascii chars, 0000h=not specified) // This field is left justified and padded with spaces (20h) for (i=23; i<=26; i++) BX_SELECTED_DRIVE(channel).id_drive[i] = 0; // Word 27..46: Model number (40 ascii chars, 0000h=not specified) // This field is left justified and padded with spaces (20h) for (i=0; i<20; i++) { BX_SELECTED_DRIVE(channel).id_drive[27+i] = (BX_SELECTED_MODEL(channel)[i*2] << 8) | BX_SELECTED_MODEL(channel)[i*2 + 1]; } // Word 47: 15-8 Vendor unique // 7-0 00h= read/write multiple commands not implemented // xxh= maximum # of sectors that can be transferred // per interrupt on read and write multiple commands BX_SELECTED_DRIVE(channel).id_drive[47] = MAX_MULTIPLE_SECTORS; // Word 48: 0000h = cannot perform dword IO // 0001h = can perform dword IO BX_SELECTED_DRIVE(channel).id_drive[48] = 1; // Word 49: Capabilities // 15-10: 0 = reserved // 9: 1 = LBA supported // 8: 1 = DMA supported // 7-0: Vendor unique if (BX_HD_THIS bmdma_present()) { BX_SELECTED_DRIVE(channel).id_drive[49] = (1<<9) | (1<<8); } else { BX_SELECTED_DRIVE(channel).id_drive[49] = 1<<9; } // Word 50: Reserved // Word 51: 15-8 PIO data transfer cycle timing mode // 7-0 Vendor unique BX_SELECTED_DRIVE(channel).id_drive[51] = 0x200; // Word 52: 15-8 DMA data transfer cycle timing mode // 7-0 Vendor unique BX_SELECTED_DRIVE(channel).id_drive[52] = 0x200; // Word 53: 15-1 Reserved // 2 1=the fields reported in word 88 are valid // 1 1=the fields reported in words 64-70 are valid // 0 1=the fields reported in words 54-58 are valid BX_SELECTED_DRIVE(channel).id_drive[53] = 0x07; // Word 54: # of user-addressable cylinders in curr xlate mode // Word 55: # of user-addressable heads in curr xlate mode // Word 56: # of user-addressable sectors/track in curr xlate mode if (BX_SELECTED_DRIVE(channel).hdimage->cylinders > 16383) { BX_SELECTED_DRIVE(channel).id_drive[54] = 16383; } else { BX_SELECTED_DRIVE(channel).id_drive[54] = BX_SELECTED_DRIVE(channel).hdimage->cylinders; } BX_SELECTED_DRIVE(channel).id_drive[55] = BX_SELECTED_DRIVE(channel).hdimage->heads; BX_SELECTED_DRIVE(channel).id_drive[56] = BX_SELECTED_DRIVE(channel).hdimage->spt; // Word 57-58: Current capacity in sectors // Excludes all sectors used for device specific purposes. temp32 = BX_SELECTED_DRIVE(channel).hdimage->cylinders * BX_SELECTED_DRIVE(channel).hdimage->heads * BX_SELECTED_DRIVE(channel).hdimage->spt; BX_SELECTED_DRIVE(channel).id_drive[57] = (temp32 & 0xffff); // LSW BX_SELECTED_DRIVE(channel).id_drive[58] = (temp32 >> 16); // MSW // Word 59: 15-9 Reserved // 8 1=multiple sector setting is valid // 7-0 current setting for number of sectors that can be // transferred per interrupt on R/W multiple commands if (BX_SELECTED_CONTROLLER(channel).multiple_sectors > 0) BX_SELECTED_DRIVE(channel).id_drive[59] = 0x0100 | BX_SELECTED_CONTROLLER(channel).multiple_sectors; else BX_SELECTED_DRIVE(channel).id_drive[59] = 0x0000; // Word 60-61: // If drive supports LBA Mode, these words reflect total # of user // addressable sectors. This value does not depend on the current // drive geometry. If the drive does not support LBA mode, these // words shall be set to 0. if (BX_SELECTED_DRIVE(channel).hdimage->hd_size > 0) num_sects = (BX_SELECTED_DRIVE(channel).hdimage->hd_size / BX_SELECTED_DRIVE(channel).sect_size); else num_sects = BX_SELECTED_DRIVE(channel).hdimage->cylinders * BX_SELECTED_DRIVE(channel).hdimage->heads * BX_SELECTED_DRIVE(channel).hdimage->spt; BX_SELECTED_DRIVE(channel).id_drive[60] = (Bit16u)(num_sects & 0xffff); // LSW BX_SELECTED_DRIVE(channel).id_drive[61] = (Bit16u)(num_sects >> 16); // MSW // Word 62: 15-8 single word DMA transfer mode active // 7-0 single word DMA transfer modes supported // The low order byte identifies by bit, all the Modes which are // supported e.g., if Mode 0 is supported bit 0 is set. // The high order byte contains a single bit set to indiciate // which mode is active. BX_SELECTED_DRIVE(channel).id_drive[62] = 0x0; // Word 63: 15-8 multiword DMA transfer mode active // 7-0 multiword DMA transfer modes supported // The low order byte identifies by bit, all the Modes which are // supported e.g., if Mode 0 is supported bit 0 is set. // The high order byte contains a single bit set to indiciate // which mode is active. if (BX_HD_THIS bmdma_present()) { BX_SELECTED_DRIVE(channel).id_drive[63] = 0x07 | (BX_SELECTED_CONTROLLER(channel).mdma_mode << 8); } else { BX_SELECTED_DRIVE(channel).id_drive[63] = 0x0; } // Word 64 PIO modes supported BX_SELECTED_DRIVE(channel).id_drive[64] = 0x00; // Word 65-68 PIO/DMA cycle time (nanoseconds) for (i=65; i<=68; i++) BX_SELECTED_DRIVE(channel).id_drive[i] = 120; // Word 69-79 Reserved // Word 80: 15-9 reserved // 8 supports ATA/ATAPI-8 // 7 supports ATA/ATAPI-7 // 6 supports ATA/ATAPI-6 // 5 supports ATA/ATAPI-5 // 4 supports ATA/ATAPI-4 // 3 supports ATA-3 // 2 supports ATA-2 // 1 supports ATA-1 // 0 reserved BX_SELECTED_DRIVE(channel).id_drive[80] = 0x7E; // Word 81: Minor version number BX_SELECTED_DRIVE(channel).id_drive[81] = 0x00; // Word 82: 15 obsolete // 14 NOP command supported // 13 READ BUFFER command supported // 12 WRITE BUFFER command supported // 11 obsolete // 10 Host protected area feature set supported // 9 DEVICE RESET command supported // 8 SERVICE interrupt supported // 7 release interrupt supported // 6 look-ahead supported // 5 write cache supported // 4 supports PACKET command feature set // 3 supports power management feature set // 2 supports removable media feature set // 1 supports securite mode feature set // 0 support SMART feature set BX_SELECTED_DRIVE(channel).id_drive[82] = 1 << 14; // Word 83: 15 shall be ZERO // 14 shall be ONE // 13 FLUSH CACHE EXT command supported // 12 FLUSH CACHE command supported // 11 Device configuration overlay supported // 10 48-bit Address feature set supported // 9 Automatic acoustic management supported // 8 SET MAX security supported // 7 reserved for 1407DT PARTIES // 6 SetF sub-command Power-Up supported // 5 Power-Up in standby feature set supported // 4 Removable media notification supported // 3 APM feature set supported // 2 CFA feature set supported // 1 READ/WRITE DMA QUEUED commands supported // 0 Download MicroCode supported BX_SELECTED_DRIVE(channel).id_drive[83] = (1 << 14) | (1 << 13) | (1 << 12) | (1 << 10); BX_SELECTED_DRIVE(channel).id_drive[84] = 1 << 14; BX_SELECTED_DRIVE(channel).id_drive[85] = 1 << 14; // Word 86: 15 shall be ZERO // 14 shall be ONE // 13 FLUSH CACHE EXT command enabled // 12 FLUSH CACHE command enabled // 11 Device configuration overlay enabled // 10 48-bit Address feature set enabled // 9 Automatic acoustic management enabled // 8 SET MAX security enabled // 7 reserved for 1407DT PARTIES // 6 SetF sub-command Power-Up enabled // 5 Power-Up in standby feature set enabled // 4 Removable media notification enabled // 3 APM feature set enabled // 2 CFA feature set enabled // 1 READ/WRITE DMA QUEUED commands enabled // 0 Download MicroCode enabled BX_SELECTED_DRIVE(channel).id_drive[86] = (1 << 14) | (1 << 13) | (1 << 12) | (1 << 10); BX_SELECTED_DRIVE(channel).id_drive[87] = 1 << 14; if (BX_HD_THIS bmdma_present()) { BX_SELECTED_DRIVE(channel).id_drive[88] = 0x3f | (BX_SELECTED_CONTROLLER(channel).udma_mode << 8); } else { BX_SELECTED_DRIVE(channel).id_drive[88] = 0x0; } BX_SELECTED_DRIVE(channel).id_drive[93] = 1 | (1 << 14) | 0x2000; // Word 100-103: 48-bit total number of sectors BX_SELECTED_DRIVE(channel).id_drive[100] = (Bit16u)(num_sects & 0xffff); BX_SELECTED_DRIVE(channel).id_drive[101] = (Bit16u)(num_sects >> 16); BX_SELECTED_DRIVE(channel).id_drive[102] = (Bit16u)(num_sects >> 32); BX_SELECTED_DRIVE(channel).id_drive[103] = (Bit16u)(num_sects >> 48); // Word 106: Physical/Logical Sector Size (ATAPI 7+) (Optional) // 15 shall be ZERO // 14 shall be ONE // 13 1 = Device has multiple logical sectors per physical sector // 12 1 = Device Logical sector greater than 256 words // 11 - 4 reserved // 3 - 0 x where 2^x = logical sectors per physical sector // Words 117-118: Words per Logical Sector // // We do not emulate 512-byte logical sectors on 1k and 4k drives. Why would we? // Therefore, we tell the guest that we are physical sectors with one logical sector per physical sector. if ((BX_SELECTED_DRIVE(channel).sect_size == 512) || (BX_SELECTED_DRIVE(channel).sect_size == 1048)) { BX_SELECTED_DRIVE(channel).id_drive[106] = 0; BX_SELECTED_DRIVE(channel).id_drive[117] = 0; BX_SELECTED_DRIVE(channel).id_drive[118] = 0; } else if ((BX_SELECTED_DRIVE(channel).sect_size == 1024) || (BX_SELECTED_DRIVE(channel).sect_size == 4096)) { // A value of 0x6000 seems odd to me. The ATAPI7/8 specification states // that this value should actually be 0x5000 // bit 15 = 0 // bit 14 = 1 // bit 13 = 0 = has single logical sector per physical sector // 1 = has multiple logical sectors per physical sector // bit 12 = 0 = logical sector is 256 words // 1 = logical sector is greater than 256 words // However, Annex E of the ATA/ATAPI Command Set-2 specification states that // we should have a value of 0x6000 for fixed sized physical sectors with // logical sectors the same size as the physical sector. // The ATAPI-7 specs say that if bit 12 is not set, words 117-118 are not valid. // However, ACS-2:Annex E doesn't set bit 12 and specifies to use words 117-118 BX_SELECTED_DRIVE(channel).id_drive[106] = 0x6000; // bit 14 set, bit 13 set BX_SELECTED_DRIVE(channel).id_drive[117] = BX_SELECTED_DRIVE(channel).sect_size >> 1; // words per logical sector BX_SELECTED_DRIVE(channel).id_drive[118] = 0; // .... BX_SELECTED_DRIVE(channel).id_drive[80] = 0xFE; // we need to report at least ATAPI-7 } else BX_PANIC(("Identify: Sector Size of %i is in error", BX_SELECTED_DRIVE(channel).sect_size)); // Word 128-159 Vendor unique // Word 160-255 Reserved BX_SELECTED_DRIVE(channel).identify_set = 1; } void bx_hard_drive_c::init_send_atapi_command(Bit8u channel, Bit8u command, int req_length, int alloc_length, bool lazy) { controller_t *controller = &BX_SELECTED_CONTROLLER(channel); // byte_count is a union of cylinder_no; // lazy is used to force a data read in the buffer at the next read. if (controller->byte_count == 0xffff) controller->byte_count = 0xfffe; if ((controller->byte_count & 1) && !(alloc_length <= controller->byte_count)) { BX_INFO(("Odd byte count (0x%04x) to ATAPI command 0x%02x, using 0x%04x", controller->byte_count, command, controller->byte_count - 1)); controller->byte_count--; } if (!controller->packet_dma) { if (controller->byte_count == 0) BX_PANIC(("ATAPI command 0x%02x with zero byte count", command)); } if (alloc_length < 0) BX_PANIC(("Allocation length < 0")); if (alloc_length == 0) alloc_length = controller->byte_count; controller->status.busy = 1; controller->status.drive_ready = 1; controller->status.drq = 0; controller->status.err = 0; // no bytes transfered yet if (lazy) controller->buffer_index = controller->buffer_size; else controller->buffer_index = 0; controller->drq_index = 0; if (controller->byte_count > req_length) controller->byte_count = req_length; if (controller->byte_count > alloc_length) controller->byte_count = alloc_length; BX_SELECTED_DRIVE(channel).atapi.command = command; BX_SELECTED_DRIVE(channel).atapi.drq_bytes = controller->byte_count; BX_SELECTED_DRIVE(channel).atapi.total_bytes_remaining = (req_length < alloc_length) ? req_length : alloc_length; } void bx_hard_drive_c::atapi_cmd_error(Bit8u channel, sense_t sense_key, asc_t asc, bool show) { if (show) { BX_ERROR(("ata%d-%d: atapi_cmd_error: key=%02x asc=%02x", channel, BX_SLAVE_SELECTED(channel), sense_key, asc)); } else { BX_DEBUG_ATAPI(("ata%d-%d: atapi_cmd_error: key=%02x asc=%02x", channel, BX_SLAVE_SELECTED(channel), sense_key, asc)); } controller_t *controller = &BX_SELECTED_CONTROLLER(channel); controller->error_register = sense_key << 4; controller->interrupt_reason.i_o = 1; controller->interrupt_reason.c_d = 1; controller->interrupt_reason.rel = 0; controller->status.busy = 0; controller->status.drive_ready = 1; controller->status.write_fault = 0; controller->status.drq = 0; controller->status.err = 1; BX_SELECTED_DRIVE(channel).sense.sense_key = sense_key; BX_SELECTED_DRIVE(channel).sense.asc = asc; BX_SELECTED_DRIVE(channel).sense.ascq = 0; } void BX_CPP_AttrRegparmN(1) bx_hard_drive_c::atapi_cmd_nop(controller_t *controller) { controller->interrupt_reason.i_o = 1; controller->interrupt_reason.c_d = 1; controller->interrupt_reason.rel = 0; controller->status.busy = 0; controller->status.drive_ready = 1; controller->status.drq = 0; controller->status.err = 0; } void bx_hard_drive_c::init_mode_sense_single(Bit8u channel, const void* src, int size) { controller_t *controller = &BX_SELECTED_CONTROLLER(channel); // Header controller->buffer[0] = (size+6) >> 8; controller->buffer[1] = (size+6) & 0xff; if (BX_SELECTED_DRIVE(channel).cdrom.ready) controller->buffer[2] = 0x12; // media present 120mm CD-ROM (CD-R) data/audio door closed else controller->buffer[2] = 0x70; // no media present controller->buffer[3] = 0; // reserved controller->buffer[4] = 0; // reserved controller->buffer[5] = 0; // reserved controller->buffer[6] = 0; // reserved controller->buffer[7] = 0; // reserved // Data memmove(controller->buffer + 8, src, size); } void BX_CPP_AttrRegparmN(1) bx_hard_drive_c::ready_to_send_atapi(Bit8u channel) { controller_t *controller = &BX_SELECTED_CONTROLLER(channel); controller->interrupt_reason.i_o = 1; controller->interrupt_reason.c_d = 0; controller->status.busy = 0; controller->status.drq = 1; controller->status.err = 0; if (BX_SELECTED_CONTROLLER(channel).packet_dma) { #if BX_SUPPORT_PCI DEV_ide_bmdma_start_transfer(channel); #endif } else { raise_interrupt(channel); } } void BX_CPP_AttrRegparmN(1) bx_hard_drive_c::raise_interrupt(Bit8u channel) { if (!BX_SELECTED_CONTROLLER(channel).control.disable_irq) { Bit32u irq = BX_HD_THIS channels[channel].irq; BX_DEBUG(("raising interrupt %d {%s}", irq, BX_SELECTED_TYPE_STRING(channel))); #if BX_SUPPORT_PCI DEV_ide_bmdma_set_irq(channel); #endif DEV_pic_raise_irq(irq); } else { BX_DEBUG(("not raising interrupt {%s}", BX_SELECTED_TYPE_STRING(channel))); } } void bx_hard_drive_c::command_aborted(Bit8u channel, unsigned value) { controller_t *controller = &BX_SELECTED_CONTROLLER(channel); BX_DEBUG(("aborting on command 0x%02x {%s}", value, BX_SELECTED_TYPE_STRING(channel))); controller->current_command = 0; controller->status.busy = 0; controller->status.drive_ready = 1; controller->status.err = 1; controller->error_register = 0x04; // command ABORTED controller->status.drq = 0; controller->status.corrected_data = 0; controller->buffer_index = 0; raise_interrupt(channel); } bool bx_hard_drive_c::set_cd_media_status(Bit32u handle, bool status) { char ata_name[22]; if (handle >= BX_MAX_ATA_CHANNEL*2) return 0; Bit8u channel = handle / 2; Bit8u device = handle % 2; BX_DEBUG_ATAPI(("ata%d-%d: set_cd_media_status(): status=%d", channel, device, status)); sprintf(ata_name, "ata.%d.%s", channel, (device==0)?"master":"slave"); bx_list_c *base = (bx_list_c*) SIM->get_param(ata_name); // if setting to the current value, nothing to do if (status == BX_HD_THIS channels[channel].drives[device].cdrom.ready) return(status); // return 0 if selected drive is not a cdrom if (!BX_DRIVE_IS_CD(channel,device)) return(0); if (status == 0) { // eject cdrom if not locked by guest OS if (!BX_HD_THIS channels[channel].drives[device].cdrom.locked) { BX_HD_THIS channels[channel].drives[device].cdrom.cd->eject_cdrom(); BX_HD_THIS channels[channel].drives[device].cdrom.ready = 0; SIM->get_param_enum("status", base)->set(BX_EJECTED); } else { return(1); } } else { // insert cdrom if (BX_HD_THIS channels[channel].drives[device].cdrom.cd->insert_cdrom(SIM->get_param_string("path", base)->getptr())) { BX_INFO(("Media present in CD-ROM drive")); BX_HD_THIS channels[channel].drives[device].cdrom.ready = 1; Bit32u capacity = BX_HD_THIS channels[channel].drives[device].cdrom.cd->capacity(); BX_HD_THIS channels[channel].drives[device].cdrom.max_lba = capacity - 1; BX_HD_THIS channels[channel].drives[device].cdrom.curr_lba = capacity - 1; BX_INFO(("Capacity is %d sectors (%.2f MB)", capacity, (float)capacity / 512.0)); SIM->get_param_enum("status", base)->set(BX_INSERTED); BX_SELECTED_DRIVE(channel).sense.sense_key = SENSE_UNIT_ATTENTION; BX_SELECTED_DRIVE(channel).sense.asc = ASC_MEDIUM_MAY_HAVE_CHANGED; BX_SELECTED_DRIVE(channel).sense.ascq = 0; raise_interrupt(channel); } else { BX_INFO(("Could not locate CD-ROM, continuing with media not present")); BX_HD_THIS channels[channel].drives[device].cdrom.ready = 0; SIM->get_param_enum("status", base)->set(BX_EJECTED); } } return (BX_HD_THIS channels[channel].drives[device].cdrom.ready); } bool bx_hard_drive_c::bmdma_present(void) { #if BX_SUPPORT_PCI if (BX_HD_THIS pci_enabled) { #ifndef ANDROID // DMA emulation works very bad under Android return DEV_ide_bmdma_present(); #endif } #endif return 0; } #if BX_SUPPORT_PCI bool bx_hard_drive_c::bmdma_read_sector(Bit8u channel, Bit8u *buffer, Bit32u *sector_size) { controller_t *controller = &BX_SELECTED_CONTROLLER(channel); if ((controller->current_command == 0xC8) || (controller->current_command == 0x25)) { *sector_size = BX_SELECTED_DRIVE(channel).hdimage->sect_size; if (controller->num_sectors == 0) return 0; if (!ide_read_sector(channel, buffer, *sector_size)) { return 0; } } else if (controller->current_command == 0xA0) { if (controller->packet_dma) { switch (BX_SELECTED_DRIVE(channel).atapi.command) { case 0x28: // read (10) case 0xa8: // read (12) case 0xbe: // read cd *sector_size = controller->buffer_size; if (!BX_SELECTED_DRIVE(channel).cdrom.ready) { BX_PANIC(("Read with CDROM not ready")); return 0; } /* set status bar conditions for device */ bx_gui->statusbar_setitem(BX_SELECTED_DRIVE(channel).statusbar_id, 1); if (!BX_SELECTED_DRIVE(channel).cdrom.cd->read_block(buffer, BX_SELECTED_DRIVE(channel).cdrom.next_lba, controller->buffer_size)) { BX_PANIC(("CDROM: read block %d failed", BX_SELECTED_DRIVE(channel).cdrom.next_lba)); return 0; } BX_SELECTED_DRIVE(channel).cdrom.next_lba++; BX_SELECTED_DRIVE(channel).cdrom.remaining_blocks--; if (!BX_SELECTED_DRIVE(channel).cdrom.remaining_blocks) { BX_SELECTED_DRIVE(channel).cdrom.curr_lba = BX_SELECTED_DRIVE(channel).cdrom.next_lba; } break; default: BX_DEBUG_ATAPI(("ata%d-%d: bmdma_read_sector(): ATAPI cmd = 0x%02x, size = %d", channel, BX_SLAVE_SELECTED(channel), BX_SELECTED_DRIVE(channel).atapi.command, *sector_size)); if (*sector_size > (Bit32u)BX_SELECTED_DRIVE(channel).atapi.total_bytes_remaining) { memcpy(buffer, controller->buffer, BX_SELECTED_DRIVE(channel).atapi.total_bytes_remaining); } else { memcpy(buffer, controller->buffer, *sector_size); } break; } } else { BX_ERROR(("PACKET-DMA not active")); command_aborted(channel, controller->current_command); return 0; } } else { BX_ERROR(("DMA read not active")); command_aborted(channel, controller->current_command); return 0; } return 1; } bool bx_hard_drive_c::bmdma_write_sector(Bit8u channel, Bit8u *buffer) { controller_t *controller = &BX_SELECTED_CONTROLLER(channel); if ((controller->current_command != 0xCA) && (controller->current_command != 0x35)) { BX_ERROR(("DMA write not active")); command_aborted(channel, controller->current_command); return 0; } if (controller->num_sectors == 0) return 0; if (!ide_write_sector(channel, buffer, BX_SELECTED_DRIVE(channel).sect_size)) { return 0; } return 1; } void bx_hard_drive_c::bmdma_complete(Bit8u channel) { controller_t *controller = &BX_SELECTED_CONTROLLER(channel); controller->status.busy = 0; controller->status.drive_ready = 1; controller->status.drq = 0; controller->status.err = 0; if (BX_SELECTED_IS_CD(channel)) { controller->interrupt_reason.i_o = 1; controller->interrupt_reason.c_d = 1; controller->interrupt_reason.rel = 0; } else { controller->status.write_fault = 0; controller->status.seek_complete = 1; controller->status.corrected_data = 0; BX_SELECTED_DRIVE(channel).curr_lsector = BX_SELECTED_DRIVE(channel).next_lsector; } raise_interrupt(channel); } #endif void bx_hard_drive_c::set_signature(Bit8u channel, Bit8u id) { // Device signature BX_CONTROLLER(channel,id).head_no = 0; BX_CONTROLLER(channel,id).sector_count = 1; BX_CONTROLLER(channel,id).sector_no = 1; if (BX_DRIVE_IS_HD(channel,id)) { BX_CONTROLLER(channel,id).cylinder_no = 0; BX_HD_THIS channels[channel].drive_select = 0; } else if (BX_DRIVE_IS_CD(channel,id)) { BX_CONTROLLER(channel,id).cylinder_no = 0xeb14; } else { BX_CONTROLLER(channel,id).cylinder_no = 0xffff; } } bool bx_hard_drive_c::ide_read_sector(Bit8u channel, Bit8u *buffer, Bit32u buffer_size) { controller_t *controller = &BX_SELECTED_CONTROLLER(channel); Bit64s logical_sector = 0; Bit64s ret; unsigned sect_size = BX_SELECTED_DRIVE(channel).sect_size; int sector_count = (buffer_size / sect_size); Bit8u *bufptr = buffer; do { if (!calculate_logical_address(channel, &logical_sector)) { command_aborted(channel, controller->current_command); return 0; } ret = BX_SELECTED_DRIVE(channel).hdimage->lseek(logical_sector * sect_size, SEEK_SET); if (ret < 0) { BX_ERROR(("could not lseek() hard drive image file")); command_aborted(channel, controller->current_command); return 0; } /* set status bar conditions for device */ bx_gui->statusbar_setitem(BX_SELECTED_DRIVE(channel).statusbar_id, 1); ret = BX_SELECTED_DRIVE(channel).hdimage->read((bx_ptr_t)bufptr, sect_size); if (ret < sect_size) { BX_ERROR(("could not read() hard drive image file at byte %lu", (unsigned long)logical_sector*sect_size)); command_aborted(channel, controller->current_command); return 0; } increment_address(channel, &logical_sector); BX_SELECTED_DRIVE(channel).next_lsector = logical_sector; bufptr += sect_size; } while (--sector_count > 0); return 1; } bool bx_hard_drive_c::ide_write_sector(Bit8u channel, Bit8u *buffer, Bit32u buffer_size) { controller_t *controller = &BX_SELECTED_CONTROLLER(channel); Bit64s logical_sector = 0; Bit64s ret; unsigned sect_size = BX_SELECTED_DRIVE(channel).sect_size; int sector_count = (buffer_size / sect_size); Bit8u *bufptr = buffer; do { if (!calculate_logical_address(channel, &logical_sector)) { command_aborted(channel, controller->current_command); return 0; } ret = BX_SELECTED_DRIVE(channel).hdimage->lseek(logical_sector * sect_size, SEEK_SET); if (ret < 0) { BX_ERROR(("could not lseek() hard drive image file at byte %lu", (unsigned long)logical_sector * sect_size)); command_aborted(channel, controller->current_command); return 0; } /* set status bar conditions for device */ bx_gui->statusbar_setitem(BX_SELECTED_DRIVE(channel).statusbar_id, 1, 1 /* write */); ret = BX_SELECTED_DRIVE(channel).hdimage->write((bx_ptr_t)bufptr, sect_size); if (ret < sect_size) { BX_ERROR(("could not write() hard drive image file at byte %lu", (unsigned long)logical_sector*sect_size)); command_aborted(channel, controller->current_command); return 0; } increment_address(channel, &logical_sector); BX_SELECTED_DRIVE(channel).next_lsector = logical_sector; bufptr += sect_size; } while (--sector_count > 0); return 1; } void bx_hard_drive_c::lba48_transform(controller_t *controller, bool lba48) { controller->lba48 = lba48; if (!controller->lba48) { if (!controller->sector_count) controller->num_sectors = 256; else controller->num_sectors = controller->sector_count; } else { if (!controller->sector_count && !controller->hob.nsector) controller->num_sectors = 65536; else controller->num_sectors = (controller->hob.nsector << 8) | controller->sector_count; } } void bx_hard_drive_c::start_seek(Bit8u channel) { Bit64s new_pos, prev_pos, max_pos; Bit32u seek_time; double fSeekBase, fSeekTime; if (BX_SELECTED_IS_CD(channel)) { max_pos = BX_SELECTED_DRIVE(channel).cdrom.max_lba; prev_pos = BX_SELECTED_DRIVE(channel).cdrom.curr_lba; new_pos = BX_SELECTED_DRIVE(channel).cdrom.next_lba; fSeekBase = 80000.0; } else { max_pos = (BX_SELECTED_DRIVE(channel).hdimage->hd_size / BX_SELECTED_DRIVE(channel).hdimage->sect_size) - 1; prev_pos = BX_SELECTED_DRIVE(channel).curr_lsector; new_pos = BX_SELECTED_DRIVE(channel).next_lsector; fSeekBase = 5000.0; } fSeekTime = fSeekBase * (double)abs((int)(new_pos - prev_pos + 1)) / (max_pos + 1); seek_time = (fSeekTime > 10.0) ? (Bit32u)fSeekTime : 10; bx_pc_system.activate_timer( BX_SELECTED_DRIVE(channel).seek_timer_index, seek_time, 0); } error_recovery_t::error_recovery_t() { if (sizeof(error_recovery_t) != 8) { BX_PANIC(("error_recovery_t has size != 8")); } data[0] = 0x01; data[1] = 0x06; data[2] = 0x00; data[3] = 0x05; // Try to recover 5 times data[4] = 0x00; data[5] = 0x00; data[6] = 0x00; data[7] = 0x00; } // cdrom runtime parameter handling // helper function int get_device_handle_from_param(bx_param_c *param) { char pname[BX_PATHNAME_LEN]; bx_list_c *base = (bx_list_c*) param->get_parent(); base->get_param_path(pname, BX_PATHNAME_LEN); if (!strncmp(pname, "ata.", 4)) { int handle = (pname[4] - '0') << 1; if (!strcmp(base->get_name(), "slave")) { handle |= 1; } return handle; } else { return -1; } } Bit64s bx_hard_drive_c::cdrom_status_handler(bx_param_c *param, int set, Bit64s val) { if (set) { int handle = get_device_handle_from_param(param); if (handle >= 0) { if (!strcmp(param->get_name(), "status")) { bool locked = BX_HD_THIS channels[handle/2].drives[handle%2].cdrom.locked; if ((val == 1) || !locked) { BX_HD_THIS channels[handle/2].drives[handle%2].status_changed = 1; } else if (locked) { BX_ERROR(("cdrom tray locked: eject failed")); return BX_INSERTED; } } } else { BX_PANIC(("cdrom_status_handler called with unexpected parameter '%s'", param->get_name())); } } return val; } const char *bx_hard_drive_c::cdrom_path_handler(bx_param_string_c *param, int set, const char *oldval, const char *val, int maxlen) { if (set) { if (strlen(val) < 1) { val = "none"; } int handle = get_device_handle_from_param(param); if (handle >= 0) { if (!strcmp(param->get_name(), "path")) { if (!BX_HD_THIS channels[handle/2].drives[handle%2].cdrom.locked) { BX_HD_THIS channels[handle/2].drives[handle%2].status_changed = 1; } else { val = oldval; BX_ERROR(("cdrom tray locked: path change failed")); } } } else { BX_PANIC(("cdrom_path_handler called with unexpected parameter '%s'", param->get_name())); } } return val; }