2001-10-03 17:10:38 +04:00
|
|
|
/////////////////////////////////////////////////////////////////////////
|
2011-02-25 01:05:47 +03:00
|
|
|
// $Id$
|
2001-10-03 17:10:38 +04:00
|
|
|
/////////////////////////////////////////////////////////////////////////
|
|
|
|
//
|
2014-01-18 20:16:42 +04:00
|
|
|
// Copyright (C) 2001-2014 The Bochs Project
|
2001-04-10 05:04:59 +04:00
|
|
|
//
|
|
|
|
// 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
|
2009-02-08 12:05:52 +03:00
|
|
|
// Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
2008-02-16 01:05:43 +03:00
|
|
|
/////////////////////////////////////////////////////////////////////////
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2001-09-28 11:14:50 +04:00
|
|
|
// Useful docs:
|
|
|
|
// AT Attachment with Packet Interface
|
|
|
|
// working draft by T13 at www.t13.org
|
|
|
|
|
2002-10-25 01:07:56 +04:00
|
|
|
// Define BX_PLUGGABLE in files that can be compiled into plugins. For
|
2003-05-03 20:37:18 +04:00
|
|
|
// platforms that require a special tag on exported symbols, BX_PLUGGABLE
|
2002-10-25 01:07:56 +04:00
|
|
|
// is used to know when we are exporting symbols and when we are importing.
|
|
|
|
#define BX_PLUGGABLE
|
|
|
|
|
2004-06-19 19:20:15 +04:00
|
|
|
#include "iodev.h"
|
2008-12-29 23:16:08 +03:00
|
|
|
#include "harddrv.h"
|
2012-08-05 22:13:38 +04:00
|
|
|
#include "hdimage/hdimage.h"
|
|
|
|
#include "hdimage/cdrom.h"
|
2002-10-25 01:07:56 +04:00
|
|
|
|
|
|
|
#define LOG_THIS theHardDrive->
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
#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))
|
2012-05-06 23:19:00 +04:00
|
|
|
#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])
|
2002-09-23 00:56:12 +04:00
|
|
|
|
|
|
|
|
|
|
|
#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)
|
2003-03-05 13:43:52 +03:00
|
|
|
#define BX_ANY_IS_PRESENT(c) (BX_DRIVE_IS_PRESENT((c),0) || BX_DRIVE_IS_PRESENT((c),1))
|
2002-09-23 00:56:12 +04:00
|
|
|
|
|
|
|
#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)
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
#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))))
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
#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")
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2006-12-25 12:34:32 +03:00
|
|
|
#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)
|
2005-06-26 14:54:49 +04:00
|
|
|
#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)
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2007-11-13 00:04:17 +03:00
|
|
|
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];
|
|
|
|
}
|
|
|
|
|
2002-10-25 01:07:56 +04:00
|
|
|
bx_hard_drive_c *theHardDrive = NULL;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2006-09-10 21:18:44 +04:00
|
|
|
int libharddrv_LTX_plugin_init(plugin_t *plugin, plugintype_t type, int argc, char *argv[])
|
2002-10-25 01:07:56 +04:00
|
|
|
{
|
2006-09-10 21:18:44 +04:00
|
|
|
theHardDrive = new bx_hard_drive_c();
|
2002-10-25 01:07:56 +04:00
|
|
|
bx_devices.pluginHardDrive = theHardDrive;
|
|
|
|
BX_REGISTER_DEVICE_DEVMODEL(plugin, type, theHardDrive, BX_PLUGIN_HARDDRV);
|
|
|
|
return(0); // Success
|
|
|
|
}
|
|
|
|
|
2006-09-10 21:18:44 +04:00
|
|
|
void libharddrv_LTX_plugin_fini(void)
|
2002-10-25 01:07:56 +04:00
|
|
|
{
|
2006-09-10 21:18:44 +04:00
|
|
|
delete theHardDrive;
|
2002-10-25 01:07:56 +04:00
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2006-03-07 21:16:41 +03:00
|
|
|
bx_hard_drive_c::bx_hard_drive_c()
|
2001-04-10 05:04:59 +04:00
|
|
|
{
|
2011-12-29 23:51:54 +04:00
|
|
|
put("harddrv", "HD");
|
2006-09-10 21:18:44 +04:00
|
|
|
for (Bit8u channel=0; channel<BX_MAX_ATA_CHANNEL; channel++) {
|
|
|
|
for (Bit8u device=0; device<2; device ++) {
|
2010-12-22 00:47:41 +03:00
|
|
|
channels[channel].drives[device].hdimage = NULL;
|
2006-09-10 21:18:44 +04:00
|
|
|
channels[channel].drives[device].cdrom.cd = NULL;
|
2014-01-18 20:16:42 +04:00
|
|
|
channels[channel].drives[device].seek_timer_index = BX_NULL_TIMER_HANDLE;
|
2003-05-03 20:37:18 +04:00
|
|
|
}
|
2006-09-10 21:18:44 +04:00
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
}
|
|
|
|
|
2006-03-07 21:16:41 +03:00
|
|
|
bx_hard_drive_c::~bx_hard_drive_c()
|
2001-04-10 05:04:59 +04:00
|
|
|
{
|
2012-08-15 12:30:22 +04:00
|
|
|
char ata_name[20];
|
|
|
|
bx_list_c *base;
|
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
for (Bit8u channel=0; channel<BX_MAX_ATA_CHANNEL; channel++) {
|
2006-09-10 21:18:44 +04:00
|
|
|
for (Bit8u device=0; device<2; device ++) {
|
2010-12-22 00:47:41 +03:00
|
|
|
if (channels[channel].drives[device].hdimage != NULL) {
|
|
|
|
channels[channel].drives[device].hdimage->close();
|
|
|
|
delete channels[channel].drives[device].hdimage;
|
|
|
|
channels[channel].drives[device].hdimage = NULL;
|
2006-09-10 21:18:44 +04:00
|
|
|
}
|
|
|
|
if (channels[channel].drives[device].cdrom.cd != NULL) {
|
|
|
|
delete channels[channel].drives[device].cdrom.cd;
|
|
|
|
channels[channel].drives[device].cdrom.cd = NULL;
|
|
|
|
}
|
2012-08-15 12:30:22 +04:00
|
|
|
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);
|
2013-01-22 22:26:49 +04:00
|
|
|
SIM->get_param_enum("status", base)->set_handler(NULL);
|
2002-09-23 00:56:12 +04:00
|
|
|
}
|
2001-12-21 22:33:18 +03:00
|
|
|
}
|
2012-08-19 12:16:20 +04:00
|
|
|
SIM->get_bochs_root()->remove("hard_drive");
|
2006-09-10 21:18:44 +04:00
|
|
|
BX_DEBUG(("Exit"));
|
2001-04-10 05:04:59 +04:00
|
|
|
}
|
|
|
|
|
2006-03-07 21:16:41 +03:00
|
|
|
void bx_hard_drive_c::init(void)
|
2001-04-10 05:04:59 +04:00
|
|
|
{
|
2006-06-05 01:49:17 +04:00
|
|
|
Bit8u channel, image_mode;
|
2002-09-23 00:56:12 +04:00
|
|
|
char string[5];
|
2004-02-08 21:38:26 +03:00
|
|
|
char sbtext[8];
|
2006-02-26 22:11:20 +03:00
|
|
|
char ata_name[20];
|
2013-12-22 12:11:35 +04:00
|
|
|
char pname[8];
|
2006-02-26 22:11:20 +03:00
|
|
|
bx_list_c *base;
|
2002-09-23 00:56:12 +04:00
|
|
|
|
2011-02-25 01:05:47 +03:00
|
|
|
BX_DEBUG(("Init $Id$"));
|
2002-09-23 00:56:12 +04:00
|
|
|
|
|
|
|
for (channel=0; channel<BX_MAX_ATA_CHANNEL; channel++) {
|
2006-02-26 22:11:20 +03:00
|
|
|
sprintf(ata_name, "ata.%d.resources", channel);
|
|
|
|
base = (bx_list_c*) SIM->get_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();
|
2002-09-23 00:56:12 +04:00
|
|
|
|
|
|
|
// Coherency check
|
2008-02-16 01:05:43 +03:00
|
|
|
if ((BX_HD_THIS channels[channel].ioaddr1 == 0) ||
|
|
|
|
(BX_HD_THIS channels[channel].ioaddr2 == 0) ||
|
|
|
|
(BX_HD_THIS channels[channel].irq == 0))
|
|
|
|
{
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_PANIC(("incoherency for ata channel %d: io1=0x%x, io2=%x, irq=%d",
|
2011-10-01 01:02:09 +04:00
|
|
|
channel,
|
|
|
|
BX_HD_THIS channels[channel].ioaddr1,
|
|
|
|
BX_HD_THIS channels[channel].ioaddr2,
|
|
|
|
BX_HD_THIS channels[channel].irq));
|
2002-09-23 00:56:12 +04:00
|
|
|
}
|
2013-12-22 12:11:35 +04:00
|
|
|
} else {
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_HD_THIS channels[channel].ioaddr1 = 0;
|
|
|
|
BX_HD_THIS channels[channel].ioaddr2 = 0;
|
|
|
|
BX_HD_THIS channels[channel].irq = 0;
|
|
|
|
}
|
2006-03-07 21:16:41 +03:00
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
for (channel=0; channel<BX_MAX_ATA_CHANNEL; channel++) {
|
|
|
|
sprintf(string ,"ATA%d", channel);
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2008-01-27 01:24:03 +03:00
|
|
|
if (BX_HD_THIS channels[channel].irq != 0)
|
2006-09-13 22:51:25 +04:00
|
|
|
DEV_register_irq(BX_HD_THIS channels[channel].irq, string);
|
2002-09-23 00:56:12 +04:00
|
|
|
|
|
|
|
if (BX_HD_THIS channels[channel].ioaddr1 != 0) {
|
2003-07-31 23:51:42 +04:00
|
|
|
DEV_register_ioread_handler(this, read_handler,
|
2006-09-20 22:24:17 +04:00
|
|
|
BX_HD_THIS channels[channel].ioaddr1, string, 6);
|
2003-07-31 23:51:42 +04:00
|
|
|
DEV_register_iowrite_handler(this, write_handler,
|
2006-09-20 22:24:17 +04:00
|
|
|
BX_HD_THIS channels[channel].ioaddr1, string, 6);
|
2003-07-31 23:51:42 +04:00
|
|
|
for (unsigned addr=0x1; addr<=0x7; addr++) {
|
2002-10-25 01:07:56 +04:00
|
|
|
DEV_register_ioread_handler(this, read_handler,
|
2006-09-20 22:24:17 +04:00
|
|
|
BX_HD_THIS channels[channel].ioaddr1+addr, string, 1);
|
2002-10-25 01:07:56 +04:00
|
|
|
DEV_register_iowrite_handler(this, write_handler,
|
2006-09-20 22:24:17 +04:00
|
|
|
BX_HD_THIS channels[channel].ioaddr1+addr, string, 1);
|
2002-09-23 00:56:12 +04:00
|
|
|
}
|
2006-03-07 21:16:41 +03:00
|
|
|
}
|
2002-09-23 00:56:12 +04:00
|
|
|
|
|
|
|
// We don't want to register addresses 0x3f6 and 0x3f7 as they are handled by the floppy controller
|
|
|
|
if ((BX_HD_THIS channels[channel].ioaddr2 != 0) && (BX_HD_THIS channels[channel].ioaddr2 != 0x3f0)) {
|
|
|
|
for (unsigned addr=0x6; addr<=0x7; addr++) {
|
2002-10-25 01:07:56 +04:00
|
|
|
DEV_register_ioread_handler(this, read_handler,
|
2006-09-20 22:24:17 +04:00
|
|
|
BX_HD_THIS channels[channel].ioaddr2+addr, string, 1);
|
2002-10-25 01:07:56 +04:00
|
|
|
DEV_register_iowrite_handler(this, write_handler,
|
2006-09-20 22:24:17 +04:00
|
|
|
BX_HD_THIS channels[channel].ioaddr2+addr, string, 1);
|
2002-09-23 00:56:12 +04:00
|
|
|
}
|
2001-05-04 01:08:42 +04:00
|
|
|
}
|
2008-01-27 01:24:03 +03:00
|
|
|
|
2006-03-07 21:16:41 +03:00
|
|
|
BX_HD_THIS channels[channel].drive_select = 0;
|
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
channel = 0;
|
2006-08-05 11:49:31 +04:00
|
|
|
BX_HD_THIS cdrom_count = 0;
|
2002-09-23 00:56:12 +04:00
|
|
|
for (channel=0; channel<BX_MAX_ATA_CHANNEL; channel++) {
|
|
|
|
for (Bit8u device=0; device<2; device ++) {
|
2006-02-26 22:11:20 +03:00
|
|
|
sprintf(ata_name, "ata.%d.%s", channel, (device==0)?"master":"slave");
|
|
|
|
base = (bx_list_c*) SIM->get_param(ata_name);
|
2004-02-07 01:28:00 +03:00
|
|
|
|
2006-02-26 22:11:20 +03:00
|
|
|
// Initialize controller state, even if device is not present
|
2004-02-07 01:28:00 +03:00
|
|
|
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_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;
|
|
|
|
|
2006-07-19 23:18:42 +04:00
|
|
|
BX_CONTROLLER(channel,device).multiple_sectors = 0;
|
2004-02-07 01:28:00 +03:00
|
|
|
BX_CONTROLLER(channel,device).lba_mode = 0;
|
2005-08-06 22:29:36 +04:00
|
|
|
|
|
|
|
BX_CONTROLLER(channel,device).features = 0;
|
2006-07-19 23:18:42 +04:00
|
|
|
BX_CONTROLLER(channel,device).mdma_mode = 0;
|
2006-12-29 14:57:04 +03:00
|
|
|
BX_CONTROLLER(channel,device).udma_mode = 0;
|
2005-08-06 22:29:36 +04:00
|
|
|
|
|
|
|
// If not present
|
2014-01-18 20:16:42 +04:00
|
|
|
BX_HD_THIS channels[channel].drives[device].device_type = IDE_NONE;
|
2004-02-08 21:38:26 +03:00
|
|
|
BX_HD_THIS channels[channel].drives[device].statusbar_id = -1;
|
2006-12-26 20:08:12 +03:00
|
|
|
BX_HD_THIS channels[channel].drives[device].identify_set = 0;
|
2013-01-22 22:26:49 +04:00
|
|
|
if (SIM->get_param_enum("type", base)->get() == BX_ATA_DEVICE_NONE) continue;
|
2002-09-23 00:56:12 +04:00
|
|
|
|
|
|
|
// Make model string
|
2008-01-27 01:24:03 +03:00
|
|
|
strncpy((char*)BX_HD_THIS channels[channel].drives[device].model_no,
|
2006-02-26 22:11:20 +03:00
|
|
|
SIM->get_param_string("model", base)->getptr(), 40);
|
2002-09-23 00:56:12 +04:00
|
|
|
while (strlen((char *)BX_HD_THIS channels[channel].drives[device].model_no) < 40) {
|
2008-03-29 20:44:13 +03:00
|
|
|
strcat((char*)BX_HD_THIS channels[channel].drives[device].model_no, " ");
|
2006-02-26 22:11:20 +03:00
|
|
|
}
|
2008-07-27 12:06:52 +04:00
|
|
|
BX_HD_THIS channels[channel].drives[device].model_no[40] = 0;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2006-02-26 22:11:20 +03:00
|
|
|
if (SIM->get_param_enum("type", base)->get() == BX_ATA_DEVICE_DISK) {
|
2008-02-16 01:05:43 +03:00
|
|
|
BX_DEBUG(("Hard-Disk on target %d/%d",channel,device));
|
2005-08-06 22:29:36 +04:00
|
|
|
BX_HD_THIS channels[channel].drives[device].device_type = IDE_DISK;
|
2004-02-08 21:38:26 +03:00
|
|
|
sprintf(sbtext, "HD:%d-%s", channel, device?"S":"M");
|
|
|
|
BX_HD_THIS channels[channel].drives[device].statusbar_id =
|
2011-12-28 15:51:42 +04:00
|
|
|
bx_gui->register_statusitem(sbtext, 1);
|
2003-05-03 20:37:18 +04:00
|
|
|
|
2006-02-26 22:11:20 +03:00
|
|
|
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();
|
2003-05-03 20:37:18 +04:00
|
|
|
Bit64u disk_size = (Bit64u)cyl * heads * spt * 512;
|
|
|
|
|
2006-06-05 01:49:17 +04:00
|
|
|
image_mode = SIM->get_param_enum("mode", base)->get();
|
2011-01-13 01:34:42 +03:00
|
|
|
channels[channel].drives[device].hdimage = DEV_hdimage_init_image(image_mode,
|
2010-12-10 20:02:18 +03:00
|
|
|
disk_size, SIM->get_param_string("journal", base)->getptr());
|
2003-05-03 20:37:18 +04:00
|
|
|
|
2010-12-22 00:47:41 +03:00
|
|
|
if (channels[channel].drives[device].hdimage != NULL) {
|
2010-12-27 21:37:25 +03:00
|
|
|
BX_INFO(("HD on ata%d-%d: '%s', '%s' mode", channel, device,
|
2010-12-10 20:02:18 +03:00
|
|
|
SIM->get_param_string("path", base)->getptr(),
|
|
|
|
hdimage_mode_names[image_mode]));
|
|
|
|
} else {
|
|
|
|
// it's safe to return here on failure
|
|
|
|
return;
|
2003-05-03 20:37:18 +04:00
|
|
|
}
|
2010-12-22 00:47:41 +03:00
|
|
|
BX_HD_THIS channels[channel].drives[device].hdimage->cylinders = cyl;
|
|
|
|
BX_HD_THIS channels[channel].drives[device].hdimage->heads = heads;
|
2011-11-26 19:09:00 +04:00
|
|
|
BX_HD_THIS channels[channel].drives[device].hdimage->spt = spt;
|
2011-01-21 19:00:38 +03:00
|
|
|
|
|
|
|
/* 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;
|
|
|
|
}
|
2010-12-22 00:47:41 +03:00
|
|
|
Bit32u image_caps = BX_HD_THIS channels[channel].drives[device].hdimage->get_capabilities();
|
2002-10-21 15:22:26 +04:00
|
|
|
|
2011-11-22 00:58:35 +04:00
|
|
|
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;
|
2011-11-26 19:09:00 +04:00
|
|
|
spt = BX_HD_THIS channels[channel].drives[device].hdimage->spt;
|
2011-11-22 00:58:35 +04:00
|
|
|
BX_INFO(("ata%d-%d: image geometry: CHS=%d/%d/%d", channel, device, cyl, heads, spt));
|
2005-08-06 22:29:36 +04:00
|
|
|
} else {
|
2011-11-22 00:58:35 +04:00
|
|
|
if ((cyl == 0) && (image_caps & HDIMAGE_AUTO_GEOMETRY)) {
|
2006-06-16 11:29:33 +04:00
|
|
|
// Autodetect number of cylinders
|
2011-11-22 00:58:35 +04:00
|
|
|
if ((heads == 0) || (spt == 0)) {
|
|
|
|
BX_PANIC(("ata%d-%d cannot have zero heads, or sectors/track", channel, device));
|
2006-06-17 11:45:27 +04:00
|
|
|
}
|
2011-11-22 00:58:35 +04:00
|
|
|
cyl = (int)(BX_HD_THIS channels[channel].drives[device].hdimage->hd_size / (heads * spt * 512));
|
|
|
|
disk_size = ((Bit64u)cyl * heads * spt * 512);
|
|
|
|
BX_HD_THIS channels[channel].drives[device].hdimage->cylinders = cyl;
|
|
|
|
BX_INFO(("ata%d-%d: autodetect geometry: CHS=%d/%d/%d", channel, device, cyl, heads, spt));
|
2006-06-16 11:29:33 +04:00
|
|
|
} else {
|
2011-11-22 00:58:35 +04:00
|
|
|
// 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));
|
2006-06-16 11:29:33 +04:00
|
|
|
}
|
2011-11-22 00:58:35 +04:00
|
|
|
BX_INFO(("ata%d-%d: using specified geometry: CHS=%d/%d/%d", channel, device, cyl, heads, spt));
|
|
|
|
}
|
|
|
|
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) {
|
2011-11-26 19:09:00 +04:00
|
|
|
BX_INFO(("ata%d-%d: extra data outside of CHS address range", channel, device));
|
2002-09-23 00:56:12 +04:00
|
|
|
}
|
|
|
|
}
|
2014-02-24 00:06:02 +04:00
|
|
|
BX_HD_THIS channels[channel].drives[device].curr_lsector = 0;
|
|
|
|
BX_HD_THIS channels[channel].drives[device].next_lsector = 0;
|
|
|
|
BX_HD_THIS channels[channel].drives[device].last_lsector = BX_HD_THIS channels[channel].drives[device].hdimage->hd_size / 512;
|
2006-02-26 22:11:20 +03:00
|
|
|
} else if (SIM->get_param_enum("type", base)->get() == BX_ATA_DEVICE_CDROM) {
|
2009-03-30 00:48:17 +04:00
|
|
|
bx_list_c *cdrom_rt = (bx_list_c*)SIM->get_param(BXPN_MENU_RUNTIME_CDROM);
|
2013-12-22 12:11:35 +04:00
|
|
|
sprintf(pname, "cdrom%d", BX_HD_THIS cdrom_count + 1);
|
|
|
|
bx_list_c *menu = new bx_list_c(cdrom_rt, pname, base->get_title());
|
2013-11-26 01:07:39 +04:00
|
|
|
menu->set_options(menu->SERIES_ASK | menu->USE_BOX_TITLE);
|
|
|
|
menu->add(SIM->get_param("path", base));
|
|
|
|
menu->add(SIM->get_param("status", base));
|
2011-06-13 13:32:39 +04:00
|
|
|
SIM->get_param_string("path", base)->set_handler(cdrom_path_handler);
|
2013-01-22 22:26:49 +04:00
|
|
|
SIM->get_param_enum("status", base)->set_handler(cdrom_status_handler);
|
2013-12-22 12:11:35 +04:00
|
|
|
BX_DEBUG(("CDROM on target %d/%d", channel, device));
|
2002-09-23 00:56:12 +04:00
|
|
|
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;
|
2004-02-08 21:38:26 +03:00
|
|
|
sprintf(sbtext, "CD:%d-%s", channel, device?"S":"M");
|
|
|
|
BX_HD_THIS channels[channel].drives[device].statusbar_id =
|
2011-12-28 15:51:42 +04:00
|
|
|
bx_gui->register_statusitem(sbtext, 1);
|
2009-03-21 03:50:53 +03:00
|
|
|
BX_HD_THIS cdrom_count++;
|
2006-08-05 11:49:31 +04:00
|
|
|
BX_HD_THIS channels[channel].drives[device].device_num = BX_HD_THIS cdrom_count + 48;
|
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
// 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)
|
2009-03-21 03:50:53 +03:00
|
|
|
BX_PANIC(("interrupt reason bit field error"));
|
2002-09-23 00:56:12 +04:00
|
|
|
|
|
|
|
BX_CONTROLLER(channel,device).sector_count = 0;
|
|
|
|
BX_CONTROLLER(channel,device).interrupt_reason.i_o = 1;
|
|
|
|
if (BX_CONTROLLER(channel,device).sector_count != 0x02)
|
2009-03-21 03:50:53 +03:00
|
|
|
BX_PANIC(("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_PANIC(("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_PANIC(("interrupt reason bit field error"));
|
|
|
|
BX_CONTROLLER(channel,device).sector_count = 0;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2011-06-13 13:32:39 +04:00
|
|
|
// allocate low level driver
|
2011-07-17 21:23:12 +04:00
|
|
|
BX_HD_THIS channels[channel].drives[device].cdrom.cd = DEV_hdimage_init_cdrom(SIM->get_param_string("path", base)->getptr());
|
2006-02-26 22:11:20 +03:00
|
|
|
BX_INFO(("CD on ata%d-%d: '%s'",channel, device, SIM->get_param_string("path", base)->getptr()));
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2013-01-22 22:26:49 +04:00
|
|
|
if (SIM->get_param_enum("status", base)->get() == BX_INSERTED) {
|
2005-11-01 22:10:24 +03:00
|
|
|
if (BX_HD_THIS channels[channel].drives[device].cdrom.cd->insert_cdrom()) {
|
2008-02-16 01:05:43 +03:00
|
|
|
BX_INFO(("Media present in CD-ROM drive"));
|
2005-11-01 22:10:24 +03:00
|
|
|
BX_HD_THIS channels[channel].drives[device].cdrom.ready = 1;
|
|
|
|
Bit32u capacity = BX_HD_THIS channels[channel].drives[device].cdrom.cd->capacity();
|
2014-02-10 00:28:42 +04:00
|
|
|
BX_HD_THIS channels[channel].drives[device].cdrom.max_lba = capacity - 1;
|
2014-02-14 22:27:36 +04:00
|
|
|
BX_HD_THIS channels[channel].drives[device].cdrom.curr_lba = capacity - 1;
|
2005-11-01 22:10:24 +03:00
|
|
|
BX_INFO(("Capacity is %d sectors (%.2f MB)", capacity, (float)capacity / 512.0));
|
2008-01-27 01:24:03 +03:00
|
|
|
} else {
|
2008-02-16 01:05:43 +03:00
|
|
|
BX_INFO(("Could not locate CD-ROM, continuing with media not present"));
|
2005-11-01 22:10:24 +03:00
|
|
|
BX_HD_THIS channels[channel].drives[device].cdrom.ready = 0;
|
2013-01-22 22:26:49 +04:00
|
|
|
SIM->get_param_enum("status", base)->set(BX_EJECTED);
|
2005-11-01 22:10:24 +03:00
|
|
|
}
|
2013-11-10 15:14:42 +04:00
|
|
|
} else {
|
2008-02-16 01:05:43 +03:00
|
|
|
BX_INFO(("Media not present in CD-ROM drive"));
|
2005-11-01 22:10:24 +03:00
|
|
|
BX_HD_THIS channels[channel].drives[device].cdrom.ready = 0;
|
|
|
|
}
|
2002-09-23 00:56:12 +04:00
|
|
|
}
|
2014-01-18 20:16:42 +04:00
|
|
|
if (SIM->get_param_enum("type", base)->get() != BX_ATA_DEVICE_NONE) {
|
|
|
|
// 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);
|
|
|
|
}
|
|
|
|
}
|
2002-09-23 00:56:12 +04:00
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
// generate CMOS values for hard drive if not using a CMOS image
|
2006-02-19 18:43:03 +03:00
|
|
|
if (!SIM->get_param_bool(BXPN_CMOSIMAGE_ENABLED)->get()) {
|
2002-10-25 01:07:56 +04:00
|
|
|
DEV_cmos_set_reg(0x12, 0x00); // start out with: no drive 0, no drive 1
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
if (BX_DRIVE_IS_HD(0,0)) {
|
2001-05-04 01:08:42 +04:00
|
|
|
// Flag drive type as Fh, use extended CMOS location as real type
|
2002-10-25 01:07:56 +04:00
|
|
|
DEV_cmos_set_reg(0x12, (DEV_cmos_get_reg(0x12) & 0x0f) | 0xf0);
|
|
|
|
DEV_cmos_set_reg(0x19, 47); // user definable type
|
2001-05-04 01:08:42 +04:00
|
|
|
// AMI BIOS: 1st hard disk #cyl low byte
|
2010-12-27 21:37:25 +03:00
|
|
|
DEV_cmos_set_reg(0x1b, (BX_DRIVE(0,0).hdimage->cylinders & 0x00ff));
|
2001-05-04 01:08:42 +04:00
|
|
|
// AMI BIOS: 1st hard disk #cyl high byte
|
2010-12-27 21:37:25 +03:00
|
|
|
DEV_cmos_set_reg(0x1c, (BX_DRIVE(0,0).hdimage->cylinders & 0xff00) >> 8);
|
2001-05-04 01:08:42 +04:00
|
|
|
// AMI BIOS: 1st hard disk #heads
|
2010-12-27 21:37:25 +03:00
|
|
|
DEV_cmos_set_reg(0x1d, BX_DRIVE(0,0).hdimage->heads);
|
2001-05-04 01:08:42 +04:00
|
|
|
// AMI BIOS: 1st hard disk write precompensation cylinder, low byte
|
2002-10-25 01:07:56 +04:00
|
|
|
DEV_cmos_set_reg(0x1e, 0xff); // -1
|
2001-05-04 01:08:42 +04:00
|
|
|
// AMI BIOS: 1st hard disk write precompensation cylinder, high byte
|
2002-10-25 01:07:56 +04:00
|
|
|
DEV_cmos_set_reg(0x1f, 0xff); // -1
|
2001-05-04 01:08:42 +04:00
|
|
|
// AMI BIOS: 1st hard disk control byte
|
2010-12-27 21:37:25 +03:00
|
|
|
DEV_cmos_set_reg(0x20, (0xc0 | ((BX_DRIVE(0,0).hdimage->heads > 8) << 3)));
|
2001-05-04 01:08:42 +04:00
|
|
|
// AMI BIOS: 1st hard disk landing zone, low byte
|
2002-10-25 01:07:56 +04:00
|
|
|
DEV_cmos_set_reg(0x21, DEV_cmos_get_reg(0x1b));
|
2001-05-04 01:08:42 +04:00
|
|
|
// AMI BIOS: 1st hard disk landing zone, high byte
|
2002-10-25 01:07:56 +04:00
|
|
|
DEV_cmos_set_reg(0x22, DEV_cmos_get_reg(0x1c));
|
2001-05-04 01:08:42 +04:00
|
|
|
// AMI BIOS: 1st hard disk sectors/track
|
2011-11-26 19:09:00 +04:00
|
|
|
DEV_cmos_set_reg(0x23, BX_DRIVE(0,0).hdimage->spt);
|
2001-05-04 01:08:42 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
//set up cmos for second hard drive
|
2002-09-23 00:56:12 +04:00
|
|
|
if (BX_DRIVE_IS_HD(0,1)) {
|
2001-05-04 01:08:42 +04:00
|
|
|
// fill in lower 4 bits of 0x12 for second HD
|
2002-10-25 01:07:56 +04:00
|
|
|
DEV_cmos_set_reg(0x12, (DEV_cmos_get_reg(0x12) & 0xf0) | 0x0f);
|
|
|
|
DEV_cmos_set_reg(0x1a, 47); // user definable type
|
2001-05-04 01:08:42 +04:00
|
|
|
// AMI BIOS: 2nd hard disk #cyl low byte
|
2010-12-27 21:37:25 +03:00
|
|
|
DEV_cmos_set_reg(0x24, (BX_DRIVE(0,1).hdimage->cylinders & 0x00ff));
|
2001-05-04 01:08:42 +04:00
|
|
|
// AMI BIOS: 2nd hard disk #cyl high byte
|
2010-12-27 21:37:25 +03:00
|
|
|
DEV_cmos_set_reg(0x25, (BX_DRIVE(0,1).hdimage->cylinders & 0xff00) >> 8);
|
2001-05-04 01:08:42 +04:00
|
|
|
// AMI BIOS: 2nd hard disk #heads
|
2010-12-27 21:37:25 +03:00
|
|
|
DEV_cmos_set_reg(0x26, BX_DRIVE(0,1).hdimage->heads);
|
2001-05-04 01:08:42 +04:00
|
|
|
// AMI BIOS: 2nd hard disk write precompensation cylinder, low byte
|
2002-10-25 01:07:56 +04:00
|
|
|
DEV_cmos_set_reg(0x27, 0xff); // -1
|
2001-05-04 01:08:42 +04:00
|
|
|
// AMI BIOS: 2nd hard disk write precompensation cylinder, high byte
|
2002-10-25 01:07:56 +04:00
|
|
|
DEV_cmos_set_reg(0x28, 0xff); // -1
|
2001-05-04 01:08:42 +04:00
|
|
|
// AMI BIOS: 2nd hard disk, 0x80 if heads>8
|
2010-12-27 21:37:25 +03:00
|
|
|
DEV_cmos_set_reg(0x29, (BX_DRIVE(0,1).hdimage->heads > 8) ? 0x80 : 0x00);
|
2001-05-04 01:08:42 +04:00
|
|
|
// AMI BIOS: 2nd hard disk landing zone, low byte
|
2002-10-25 01:07:56 +04:00
|
|
|
DEV_cmos_set_reg(0x2a, DEV_cmos_get_reg(0x24));
|
2001-05-04 01:08:42 +04:00
|
|
|
// AMI BIOS: 2nd hard disk landing zone, high byte
|
2002-10-25 01:07:56 +04:00
|
|
|
DEV_cmos_set_reg(0x2b, DEV_cmos_get_reg(0x25));
|
2001-05-04 01:08:42 +04:00
|
|
|
// AMI BIOS: 2nd hard disk sectors/track
|
2011-11-26 19:09:00 +04:00
|
|
|
DEV_cmos_set_reg(0x2c, BX_DRIVE(0,1).hdimage->spt);
|
2001-05-04 01:08:42 +04:00
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2002-10-28 00:25:33 +03:00
|
|
|
DEV_cmos_set_reg(0x39, 0);
|
|
|
|
DEV_cmos_set_reg(0x3a, 0);
|
|
|
|
for (channel=0; channel<BX_MAX_ATA_CHANNEL; channel++) {
|
|
|
|
for (Bit8u device=0; device<2; device ++) {
|
2006-02-26 22:11:20 +03:00
|
|
|
sprintf(ata_name, "ata.%d.%s", channel, (device==0)?"master":"slave");
|
|
|
|
base = (bx_list_c*) SIM->get_param(ata_name);
|
2013-01-22 22:26:49 +04:00
|
|
|
if (SIM->get_param_enum("type", base)->get() != BX_ATA_DEVICE_NONE) {
|
2002-10-28 00:25:33 +03:00
|
|
|
if (BX_DRIVE_IS_HD(channel,device)) {
|
2010-12-27 21:37:25 +03:00
|
|
|
Bit16u cylinders = BX_DRIVE(channel,device).hdimage->cylinders;
|
|
|
|
Bit16u heads = BX_DRIVE(channel,device).hdimage->heads;
|
2011-11-26 19:09:00 +04:00
|
|
|
Bit16u spt = BX_DRIVE(channel,device).hdimage->spt;
|
2006-02-26 22:11:20 +03:00
|
|
|
Bit8u translation = SIM->get_param_enum("translation", base)->get();
|
2002-10-28 00:25:33 +03:00
|
|
|
|
|
|
|
Bit8u reg = 0x39 + channel/2;
|
|
|
|
Bit8u bitshift = 2 * (device+(2 * (channel%2)));
|
2008-01-27 01:24:03 +03:00
|
|
|
|
2002-10-28 00:25:33 +03:00
|
|
|
// Find the right translation if autodetect
|
|
|
|
if (translation == BX_ATA_TRANSLATION_AUTO) {
|
|
|
|
if((cylinders <= 1024) && (heads <= 16) && (spt <= 63)) {
|
|
|
|
translation = BX_ATA_TRANSLATION_NONE;
|
2008-01-27 01:24:03 +03:00
|
|
|
}
|
2002-10-28 00:25:33 +03:00
|
|
|
else if (((Bit32u)cylinders * (Bit32u)heads) <= 131072) {
|
|
|
|
translation = BX_ATA_TRANSLATION_LARGE;
|
2008-01-27 01:24:03 +03:00
|
|
|
}
|
2002-10-28 00:25:33 +03:00
|
|
|
else translation = BX_ATA_TRANSLATION_LBA;
|
|
|
|
|
2008-01-27 01:24:03 +03:00
|
|
|
BX_INFO(("translation on ata%d-%d set to '%s'",channel, device,
|
2002-10-28 00:25:33 +03:00
|
|
|
translation==BX_ATA_TRANSLATION_NONE?"none":
|
|
|
|
translation==BX_ATA_TRANSLATION_LARGE?"large":
|
|
|
|
"lba"));
|
|
|
|
}
|
|
|
|
|
2008-01-27 01:24:03 +03:00
|
|
|
// FIXME we should test and warn
|
2002-10-28 00:25:33 +03:00
|
|
|
// - 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(reg, DEV_cmos_get_reg(reg) | (0 << bitshift));
|
|
|
|
break;
|
|
|
|
case BX_ATA_TRANSLATION_LBA:
|
|
|
|
DEV_cmos_set_reg(reg, DEV_cmos_get_reg(reg) | (1 << bitshift));
|
|
|
|
break;
|
|
|
|
case BX_ATA_TRANSLATION_LARGE:
|
|
|
|
DEV_cmos_set_reg(reg, DEV_cmos_get_reg(reg) | (2 << bitshift));
|
|
|
|
break;
|
|
|
|
case BX_ATA_TRANSLATION_RECHS:
|
|
|
|
DEV_cmos_set_reg(reg, DEV_cmos_get_reg(reg) | (3 << bitshift));
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2002-01-30 13:30:52 +03:00
|
|
|
// Set the "non-extended" boot device. This will default to DISKC if cdrom
|
2006-02-24 01:48:57 +03:00
|
|
|
if (SIM->get_param_enum(BXPN_BOOTDRIVE1)->get() != BX_BOOT_FLOPPYA) {
|
2001-04-10 05:04:59 +04:00
|
|
|
// system boot sequence C:, A:
|
2002-10-25 01:07:56 +04:00
|
|
|
DEV_cmos_set_reg(0x2d, DEV_cmos_get_reg(0x2d) & 0xdf);
|
2006-02-24 01:48:57 +03:00
|
|
|
} else { // 'a'
|
2001-04-10 05:04:59 +04:00
|
|
|
// system boot sequence A:, C:
|
2002-10-25 01:07:56 +04:00
|
|
|
DEV_cmos_set_reg(0x2d, DEV_cmos_get_reg(0x2d) | 0x20);
|
2006-02-24 01:48:57 +03:00
|
|
|
}
|
2002-01-30 13:30:52 +03:00
|
|
|
|
2004-10-16 19:44:00 +04:00
|
|
|
// Set the "extended" boot sequence, bytes 0x38 and 0x3D (needed for cdrom booting)
|
|
|
|
BX_INFO(("Using boot sequence %s, %s, %s",
|
2006-02-24 01:48:57 +03:00
|
|
|
SIM->get_param_enum(BXPN_BOOTDRIVE1)->get_selected(),
|
|
|
|
SIM->get_param_enum(BXPN_BOOTDRIVE2)->get_selected(),
|
2008-02-16 01:05:43 +03:00
|
|
|
SIM->get_param_enum(BXPN_BOOTDRIVE3)->get_selected()));
|
2006-02-24 01:48:57 +03:00
|
|
|
DEV_cmos_set_reg(0x3d, SIM->get_param_enum(BXPN_BOOTDRIVE1)->get() |
|
|
|
|
(SIM->get_param_enum(BXPN_BOOTDRIVE2)->get() << 4));
|
2004-10-16 19:44:00 +04:00
|
|
|
|
2002-05-04 20:00:40 +04:00
|
|
|
// Set the signature check flag in cmos, inverted for compatibility
|
2006-02-24 01:48:57 +03:00
|
|
|
DEV_cmos_set_reg(0x38, SIM->get_param_bool(BXPN_FLOPPYSIGCHECK)->get() |
|
|
|
|
(SIM->get_param_enum(BXPN_BOOTDRIVE3)->get() << 4));
|
|
|
|
BX_INFO(("Floppy boot signature check is %sabled",
|
|
|
|
SIM->get_param_bool(BXPN_FLOPPYSIGCHECK)->get() ? "dis" : "en"));
|
2005-09-12 00:03:56 +04:00
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2012-11-11 12:11:17 +04:00
|
|
|
BX_HD_THIS pci_enabled = SIM->get_param_bool(BXPN_PCI_ENABLED)->get();
|
2012-01-20 19:56:17 +04:00
|
|
|
|
2011-07-24 18:11:10 +04:00
|
|
|
// register handler for correct cdrom parameter handling after runtime config
|
|
|
|
SIM->register_runtime_config_handler(BX_HD_THIS_PTR, runtime_config_handler);
|
2001-04-10 05:04:59 +04:00
|
|
|
}
|
|
|
|
|
2006-03-07 21:16:41 +03:00
|
|
|
void bx_hard_drive_c::reset(unsigned type)
|
2002-08-27 23:54:46 +04:00
|
|
|
{
|
2002-10-05 23:40:51 +04:00
|
|
|
for (unsigned channel=0; channel<BX_MAX_ATA_CHANNEL; channel++) {
|
|
|
|
if (BX_HD_THIS channels[channel].irq)
|
2002-10-25 01:07:56 +04:00
|
|
|
DEV_pic_lower_irq(BX_HD_THIS channels[channel].irq);
|
2002-10-05 23:40:51 +04:00
|
|
|
}
|
2002-08-27 23:54:46 +04:00
|
|
|
}
|
|
|
|
|
2006-05-27 19:54:49 +04:00
|
|
|
void bx_hard_drive_c::register_state(void)
|
|
|
|
{
|
|
|
|
unsigned i, j;
|
|
|
|
char cname[4], dname[8];
|
2014-02-14 22:27:36 +04:00
|
|
|
bx_list_c *cdrom, *chan, *drive, *status;
|
2006-05-27 19:54:49 +04:00
|
|
|
|
2012-02-12 22:43:20 +04:00
|
|
|
bx_list_c *list = new bx_list_c(SIM->get_bochs_root(), "hard_drive", "Hard Drive State");
|
2006-05-27 19:54:49 +04:00
|
|
|
for (i=0; i<BX_MAX_ATA_CHANNEL; i++) {
|
|
|
|
sprintf(cname, "%d", i);
|
2012-02-12 22:43:20 +04:00
|
|
|
chan = new bx_list_c(list, cname);
|
2006-05-27 19:54:49 +04:00
|
|
|
for (j=0; j<2; j++) {
|
|
|
|
if (BX_DRIVE_IS_PRESENT(i, j)) {
|
2012-02-14 00:58:26 +04:00
|
|
|
sprintf(dname, "drive%d", j);
|
2012-02-12 22:43:20 +04:00
|
|
|
drive = new bx_list_c(chan, dname);
|
2012-09-16 23:51:30 +04:00
|
|
|
if (channels[i].drives[j].hdimage != NULL) {
|
|
|
|
channels[i].drives[j].hdimage->register_state(drive);
|
|
|
|
}
|
2014-02-14 22:27:36 +04:00
|
|
|
if (BX_DRIVE_IS_CD(i, j)) {
|
|
|
|
cdrom = new bx_list_c(drive, "cdrom");
|
|
|
|
new bx_shadow_bool_c(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);
|
2014-02-24 00:06:02 +04:00
|
|
|
} else {
|
|
|
|
new bx_shadow_num_c(drive, "curr_lsector", &BX_HD_THIS channels[i].drives[j].curr_lsector);
|
|
|
|
new bx_shadow_num_c(drive, "last_lsector", &BX_HD_THIS channels[i].drives[j].last_lsector);
|
|
|
|
new bx_shadow_num_c(drive, "next_lsector", &BX_HD_THIS channels[i].drives[j].next_lsector);
|
2014-02-14 22:27:36 +04:00
|
|
|
}
|
2006-07-19 23:18:42 +04:00
|
|
|
new bx_shadow_data_c(drive, "buffer", BX_CONTROLLER(i, j).buffer, MAX_MULTIPLE_SECTORS * 512);
|
2012-02-12 22:43:20 +04:00
|
|
|
status = new bx_list_c(drive, "status");
|
2006-05-27 19:54:49 +04:00
|
|
|
new bx_shadow_bool_c(status, "busy", &BX_CONTROLLER(i, j).status.busy);
|
|
|
|
new bx_shadow_bool_c(status, "drive_ready", &BX_CONTROLLER(i, j).status.drive_ready);
|
|
|
|
new bx_shadow_bool_c(status, "write_fault", &BX_CONTROLLER(i, j).status.write_fault);
|
|
|
|
new bx_shadow_bool_c(status, "seek_complete", &BX_CONTROLLER(i, j).status.seek_complete);
|
|
|
|
new bx_shadow_bool_c(status, "drq", &BX_CONTROLLER(i, j).status.drq);
|
|
|
|
new bx_shadow_bool_c(status, "corrected_data", &BX_CONTROLLER(i, j).status.corrected_data);
|
|
|
|
new bx_shadow_bool_c(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);
|
|
|
|
new bx_shadow_bool_c(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);
|
2006-07-13 21:34:44 +04:00
|
|
|
new bx_shadow_num_c(drive, "multiple_sectors", &BX_CONTROLLER(i, j).multiple_sectors, BASE_HEX);
|
2011-04-02 17:19:52 +04:00
|
|
|
new bx_shadow_bool_c(drive, "lba_mode", &BX_CONTROLLER(i, j).lba_mode);
|
2006-05-27 19:54:49 +04:00
|
|
|
new bx_shadow_num_c(drive, "packet_dma", &BX_CONTROLLER(i, j).packet_dma, BASE_HEX);
|
|
|
|
new bx_shadow_bool_c(drive, "control_reset", &BX_CONTROLLER(i, j).control.reset);
|
|
|
|
new bx_shadow_bool_c(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);
|
2006-07-19 23:18:42 +04:00
|
|
|
new bx_shadow_num_c(drive, "mdma_mode", &BX_CONTROLLER(i, j).mdma_mode, BASE_HEX);
|
2006-12-29 14:57:04 +03:00
|
|
|
new bx_shadow_num_c(drive, "udma_mode", &BX_CONTROLLER(i, j).udma_mode, BASE_HEX);
|
2006-12-25 12:34:32 +03:00
|
|
|
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);
|
2006-05-27 19:54:49 +04:00
|
|
|
}
|
|
|
|
}
|
|
|
|
new bx_shadow_num_c(chan, "drive_select", &BX_HD_THIS channels[i].drive_select);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2011-12-28 15:51:42 +04:00
|
|
|
void bx_hard_drive_c::seek_timer_handler(void *this_ptr)
|
2004-02-09 21:59:50 +03:00
|
|
|
{
|
|
|
|
bx_hard_drive_c *class_ptr = (bx_hard_drive_c *) this_ptr;
|
2011-12-28 15:51:42 +04:00
|
|
|
class_ptr->seek_timer();
|
2004-02-09 21:59:50 +03:00
|
|
|
}
|
|
|
|
|
2011-12-28 15:51:42 +04:00
|
|
|
void bx_hard_drive_c::seek_timer()
|
2004-02-09 21:59:50 +03:00
|
|
|
{
|
2014-01-18 20:16:42 +04:00
|
|
|
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;
|
2014-01-19 22:13:12 +04:00
|
|
|
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;
|
|
|
|
DEV_ide_bmdma_start_transfer(channel);
|
|
|
|
break;
|
2014-02-22 01:37:33 +04:00
|
|
|
case 0x70: // SEEK
|
2014-02-24 00:06:02 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).last_lsector = BX_SELECTED_DRIVE(channel).next_lsector;
|
2014-02-22 01:37:33 +04:00
|
|
|
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;
|
2014-01-18 20:16:42 +04:00
|
|
|
default:
|
2014-01-19 22:13:12 +04:00
|
|
|
BX_ERROR(("seek_timer(): ATA command 0x%02x not supported",
|
|
|
|
controller->current_command));
|
2014-01-18 20:16:42 +04:00
|
|
|
}
|
|
|
|
} else {
|
|
|
|
switch (BX_DRIVE(channel, device).atapi.command) {
|
|
|
|
case 0x28: // read (10)
|
|
|
|
case 0xa8: // read (12)
|
2014-01-19 22:13:12 +04:00
|
|
|
case 0xbe: // read cd
|
2014-01-18 20:16:42 +04:00
|
|
|
ready_to_send_atapi(channel);
|
|
|
|
break;
|
|
|
|
default:
|
2014-01-19 22:13:12 +04:00
|
|
|
BX_ERROR(("seek_timer(): ATAPI command 0x%02x not supported",
|
|
|
|
BX_DRIVE(channel, device).atapi.command));
|
2004-02-09 21:59:50 +03:00
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2011-07-24 18:11:10 +04:00
|
|
|
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;
|
|
|
|
bx_bool status;
|
|
|
|
|
|
|
|
for (Bit8u channel=0; channel<BX_MAX_ATA_CHANNEL; channel++) {
|
|
|
|
for (Bit8u device=0; device<2; device++) {
|
|
|
|
if (BX_HD_THIS channels[channel].drives[device].status_changed) {
|
|
|
|
handle = (channel << 1) | device;
|
|
|
|
sprintf(pname, "ata.%d.%s", channel, device ? "slave":"master");
|
|
|
|
bx_list_c *base = (bx_list_c*) SIM->get_param(pname);
|
2013-01-22 22:26:49 +04:00
|
|
|
status = SIM->get_param_enum("status", base)->get();
|
2011-07-24 18:11:10 +04:00
|
|
|
BX_HD_THIS set_cd_media_status(handle, 0);
|
2013-01-22 22:26:49 +04:00
|
|
|
if (status == BX_INSERTED) {
|
|
|
|
BX_HD_THIS set_cd_media_status(handle, 1);
|
2011-07-24 18:11:10 +04:00
|
|
|
}
|
|
|
|
BX_HD_THIS channels[channel].drives[device].status_changed = 0;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2007-04-04 02:38:49 +04:00
|
|
|
#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; \
|
|
|
|
}
|
2008-01-27 01:24:03 +03:00
|
|
|
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2007-04-04 02:38:49 +04:00
|
|
|
// static IO port read callback handler
|
|
|
|
// redirects to non-static class handler to avoid virtual functions
|
2006-03-07 21:16:41 +03:00
|
|
|
Bit32u bx_hard_drive_c::read_handler(void *this_ptr, Bit32u address, unsigned io_len)
|
2001-04-10 05:04:59 +04:00
|
|
|
{
|
|
|
|
#if !BX_USE_HD_SMF
|
|
|
|
bx_hard_drive_c *class_ptr = (bx_hard_drive_c *) this_ptr;
|
2006-03-07 21:16:41 +03:00
|
|
|
return class_ptr->read(address, io_len);
|
2001-04-10 05:04:59 +04:00
|
|
|
}
|
|
|
|
|
2006-03-07 21:16:41 +03:00
|
|
|
Bit32u bx_hard_drive_c::read(Bit32u address, unsigned io_len)
|
2001-04-10 05:04:59 +04:00
|
|
|
{
|
|
|
|
#else
|
|
|
|
UNUSED(this_ptr);
|
|
|
|
#endif // !BX_USE_HD_SMF
|
2008-01-27 01:24:03 +03:00
|
|
|
Bit8u value8;
|
2001-04-10 05:04:59 +04:00
|
|
|
Bit16u value16;
|
|
|
|
Bit32u value32;
|
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
Bit8u channel = BX_MAX_ATA_CHANNEL;
|
2003-02-01 15:21:43 +03:00
|
|
|
Bit32u port = 0xff; // undefined
|
2002-09-23 00:56:12 +04:00
|
|
|
|
|
|
|
for (channel=0; channel<BX_MAX_ATA_CHANNEL; channel++) {
|
2003-02-01 15:21:43 +03:00
|
|
|
if ((address & 0xfff8) == BX_HD_THIS channels[channel].ioaddr1) {
|
2002-09-23 00:56:12 +04:00
|
|
|
port = address - BX_HD_THIS channels[channel].ioaddr1;
|
|
|
|
break;
|
2008-01-27 01:24:03 +03:00
|
|
|
}
|
2003-02-01 15:21:43 +03:00
|
|
|
else if ((address & 0xfff8) == BX_HD_THIS channels[channel].ioaddr2) {
|
2002-09-23 00:56:12 +04:00
|
|
|
port = address - BX_HD_THIS channels[channel].ioaddr2 + 0x10;
|
|
|
|
break;
|
2008-03-29 20:44:13 +03:00
|
|
|
}
|
|
|
|
}
|
2002-09-23 00:56:12 +04:00
|
|
|
|
|
|
|
if (channel == BX_MAX_ATA_CHANNEL) {
|
2012-11-26 22:43:19 +04:00
|
|
|
channel = 0;
|
2003-07-28 22:52:14 +04:00
|
|
|
if ((address < 0x03f6) || (address > 0x03f7)) {
|
|
|
|
BX_PANIC(("read: unable to find ATA channel, ioport=0x%04x", address));
|
|
|
|
} else {
|
|
|
|
port = address - 0x03e0;
|
|
|
|
}
|
2003-07-29 20:08:54 +04:00
|
|
|
}
|
2002-09-23 00:56:12 +04:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
controller_t *controller = &BX_SELECTED_CONTROLLER(channel);
|
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
switch (port) {
|
|
|
|
case 0x00: // hard disk data (16bit) 0x1f0
|
2012-05-06 23:19:00 +04:00
|
|
|
if (controller->status.drq == 0) {
|
2011-10-01 01:02:09 +04:00
|
|
|
BX_ERROR(("IO read(0x%04x) with drq == 0: last command was %02xh",
|
2012-05-06 23:19:00 +04:00
|
|
|
address, (unsigned) controller->current_command));
|
2002-06-29 12:54:11 +04:00
|
|
|
return(0);
|
2001-04-10 05:04:59 +04:00
|
|
|
}
|
2003-02-01 15:21:43 +03:00
|
|
|
BX_DEBUG(("IO read(0x%04x): current command is %02xh",
|
2012-05-06 23:19:00 +04:00
|
|
|
address, (unsigned) controller->current_command));
|
|
|
|
switch (controller->current_command) {
|
2001-09-28 11:14:50 +04:00
|
|
|
case 0x20: // READ SECTORS, with retries
|
|
|
|
case 0x21: // READ SECTORS, without retries
|
2006-07-14 21:23:58 +04:00
|
|
|
case 0xC4: // READ MULTIPLE SECTORS
|
2006-12-25 12:34:32 +03:00
|
|
|
case 0x24: // READ SECTORS EXT
|
|
|
|
case 0x29: // READ MULTIPLE EXT
|
2012-05-06 23:19:00 +04:00
|
|
|
if (controller->buffer_index >= controller->buffer_size)
|
|
|
|
BX_PANIC(("IO read(0x%04x): buffer_index >= %d", address, controller->buffer_size));
|
2002-02-07 20:43:06 +03:00
|
|
|
|
2002-09-09 20:56:56 +04:00
|
|
|
#if BX_SupportRepeatSpeedups
|
2002-10-25 01:07:56 +04:00
|
|
|
if (DEV_bulk_io_quantum_requested()) {
|
2002-09-09 20:56:56 +04:00
|
|
|
unsigned transferLen, quantumsMax;
|
2012-05-06 23:19:00 +04:00
|
|
|
quantumsMax = (controller->buffer_size - controller->buffer_index) / io_len;
|
2008-02-07 23:43:13 +03:00
|
|
|
if (quantumsMax == 0)
|
2003-02-01 15:21:43 +03:00
|
|
|
BX_PANIC(("IO read(0x%04x): not enough space for read", address));
|
2008-02-07 23:43:13 +03:00
|
|
|
DEV_bulk_io_quantum_transferred() = DEV_bulk_io_quantum_requested();
|
2002-10-25 01:07:56 +04:00
|
|
|
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(),
|
2012-05-06 23:19:00 +04:00
|
|
|
&controller->buffer[controller->buffer_index], transferLen);
|
2002-10-25 01:07:56 +04:00
|
|
|
DEV_bulk_io_host_addr() += transferLen;
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer_index += transferLen;
|
2002-09-09 20:56:56 +04:00
|
|
|
value32 = 0; // Value returned not important;
|
2006-03-07 21:16:41 +03:00
|
|
|
}
|
2002-09-09 20:56:56 +04:00
|
|
|
else
|
|
|
|
#endif
|
2006-03-07 21:16:41 +03:00
|
|
|
{
|
2002-09-09 20:56:56 +04:00
|
|
|
value32 = 0L;
|
|
|
|
switch(io_len){
|
|
|
|
case 4:
|
2012-05-06 23:19:00 +04:00
|
|
|
value32 |= (controller->buffer[controller->buffer_index+3] << 24);
|
|
|
|
value32 |= (controller->buffer[controller->buffer_index+2] << 16);
|
2002-09-09 20:56:56 +04:00
|
|
|
case 2:
|
2012-05-06 23:19:00 +04:00
|
|
|
value32 |= (controller->buffer[controller->buffer_index+1] << 8);
|
|
|
|
value32 |= controller->buffer[controller->buffer_index];
|
2002-09-09 20:56:56 +04:00
|
|
|
}
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer_index += io_len;
|
2006-03-07 21:16:41 +03:00
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
// if buffer completely read
|
2012-05-06 23:19:00 +04:00
|
|
|
if (controller->buffer_index >= controller->buffer_size) {
|
2001-04-10 05:04:59 +04:00
|
|
|
// update sector count, sector number, cylinder,
|
|
|
|
// drive, head, status
|
|
|
|
// if there are more sectors, read next one in...
|
|
|
|
//
|
2012-05-06 23:19:00 +04:00
|
|
|
if ((controller->current_command == 0xC4) ||
|
|
|
|
(controller->current_command == 0x29)) {
|
|
|
|
if (controller->num_sectors > controller->multiple_sectors) {
|
|
|
|
controller->buffer_size = controller->multiple_sectors * 512;
|
2006-07-14 21:23:58 +04:00
|
|
|
} else {
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer_size = controller->num_sectors * 512;
|
2006-07-14 21:23:58 +04:00
|
|
|
}
|
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
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;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
if (controller->num_sectors==0) {
|
|
|
|
controller->status.drq = 0;
|
2014-02-24 00:06:02 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).last_lsector = BX_SELECTED_DRIVE(channel).curr_lsector;
|
2006-07-17 22:40:26 +04:00
|
|
|
} else { /* read next one into controller buffer */
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->status.drq = 1;
|
|
|
|
controller->status.seek_complete = 1;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
if (ide_read_sector(channel, controller->buffer, controller->buffer_size)) {
|
|
|
|
controller->buffer_index = 0;
|
2006-07-17 22:40:26 +04:00
|
|
|
raise_interrupt(channel);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
GOTO_RETURN_VALUE;
|
2001-04-10 05:04:59 +04:00
|
|
|
break;
|
|
|
|
|
2001-09-28 11:14:50 +04:00
|
|
|
case 0xec: // IDENTIFY DEVICE
|
2011-10-01 01:02:09 +04:00
|
|
|
case 0xa1:
|
2005-10-02 14:16:54 +04:00
|
|
|
unsigned index;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
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;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
index = controller->buffer_index;
|
|
|
|
value32 = controller->buffer[index];
|
2005-10-02 14:16:54 +04:00
|
|
|
index++;
|
|
|
|
if (io_len >= 2) {
|
2012-05-06 23:19:00 +04:00
|
|
|
value32 |= (controller->buffer[index] << 8);
|
2001-04-10 05:04:59 +04:00
|
|
|
index++;
|
2005-10-02 14:16:54 +04:00
|
|
|
}
|
|
|
|
if (io_len == 4) {
|
2012-05-06 23:19:00 +04:00
|
|
|
value32 |= (controller->buffer[index] << 16);
|
|
|
|
value32 |= (controller->buffer[index+1] << 24);
|
2005-10-02 14:16:54 +04:00
|
|
|
index += 2;
|
|
|
|
}
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer_index = index;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
if (controller->buffer_index >= 512) {
|
|
|
|
controller->status.drq = 0;
|
2009-04-25 12:06:32 +04:00
|
|
|
BX_DEBUG(("Read all drive ID Bytes ..."));
|
2005-10-02 14:16:54 +04:00
|
|
|
}
|
|
|
|
GOTO_RETURN_VALUE;
|
|
|
|
break;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2005-10-02 14:16:54 +04:00
|
|
|
case 0xa0:
|
|
|
|
{
|
2012-05-06 23:19:00 +04:00
|
|
|
unsigned index = controller->buffer_index;
|
2005-10-02 19:44:10 +04:00
|
|
|
unsigned increment = 0;
|
|
|
|
|
|
|
|
// Load block if necessary
|
2012-05-06 23:19:00 +04:00
|
|
|
if (index >= controller->buffer_size) {
|
|
|
|
if (index > controller->buffer_size)
|
|
|
|
BX_PANIC(("index > %d : %d", controller->buffer_size, index));
|
2005-10-02 19:44:10 +04:00
|
|
|
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"));
|
2008-01-27 01:24:03 +03:00
|
|
|
}
|
2005-10-02 19:44:10 +04:00
|
|
|
/* set status bar conditions for device */
|
2011-12-28 15:51:42 +04:00
|
|
|
bx_gui->statusbar_setitem(BX_SELECTED_DRIVE(channel).statusbar_id, 1);
|
2012-05-06 23:19:00 +04:00
|
|
|
if (!BX_SELECTED_DRIVE(channel).cdrom.cd->read_block(controller->buffer,
|
2005-11-02 23:26:24 +03:00
|
|
|
BX_SELECTED_DRIVE(channel).cdrom.next_lba,
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer_size))
|
2005-10-27 21:01:11 +04:00
|
|
|
{
|
2005-11-02 23:26:24 +03:00
|
|
|
BX_PANIC(("CDROM: read block %d failed", BX_SELECTED_DRIVE(channel).cdrom.next_lba));
|
2005-10-27 21:01:11 +04:00
|
|
|
}
|
2005-10-02 19:44:10 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).cdrom.next_lba++;
|
|
|
|
BX_SELECTED_DRIVE(channel).cdrom.remaining_blocks--;
|
|
|
|
|
2009-04-25 12:06:32 +04:00
|
|
|
if (!BX_SELECTED_DRIVE(channel).cdrom.remaining_blocks) {
|
2014-02-14 22:27:36 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).cdrom.curr_lba = BX_SELECTED_DRIVE(channel).cdrom.next_lba;
|
2009-04-25 12:06:32 +04:00
|
|
|
BX_DEBUG(("CDROM: last READ block loaded"));
|
|
|
|
} else {
|
|
|
|
BX_DEBUG(("CDROM: READ block loaded (%d remaining)",
|
|
|
|
BX_SELECTED_DRIVE(channel).cdrom.remaining_blocks));
|
2008-12-21 11:56:26 +03:00
|
|
|
}
|
2005-10-02 19:44:10 +04:00
|
|
|
// one block transfered, start at beginning
|
|
|
|
index = 0;
|
2008-12-21 11:56:26 +03:00
|
|
|
break;
|
2005-10-02 19:44:10 +04:00
|
|
|
|
|
|
|
default: // no need to load a new block
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
value32 = controller->buffer[index+increment];
|
2005-10-02 19:44:10 +04:00
|
|
|
increment++;
|
|
|
|
if (io_len >= 2) {
|
2012-05-06 23:19:00 +04:00
|
|
|
value32 |= (controller->buffer[index+increment] << 8);
|
2005-10-02 19:44:10 +04:00
|
|
|
increment++;
|
|
|
|
}
|
|
|
|
if (io_len == 4) {
|
2012-05-06 23:19:00 +04:00
|
|
|
value32 |= (controller->buffer[index+increment] << 16);
|
|
|
|
value32 |= (controller->buffer[index+increment+1] << 24);
|
2005-10-02 19:44:10 +04:00
|
|
|
increment += 2;
|
|
|
|
}
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer_index = index + increment;
|
|
|
|
controller->drq_index += increment;
|
2005-10-02 19:44:10 +04:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
if (controller->drq_index >= (unsigned)BX_SELECTED_DRIVE(channel).atapi.drq_bytes) {
|
|
|
|
controller->status.drq = 0;
|
|
|
|
controller->drq_index = 0;
|
2005-10-02 19:44:10 +04:00
|
|
|
|
|
|
|
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)
|
2009-04-25 12:06:32 +04:00
|
|
|
BX_DEBUG(("PACKET drq bytes read"));
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->interrupt_reason.i_o = 1;
|
|
|
|
controller->status.busy = 0;
|
|
|
|
controller->status.drq = 1;
|
|
|
|
controller->interrupt_reason.c_d = 0;
|
2005-10-02 19:44:10 +04:00
|
|
|
|
|
|
|
// set new byte count if last block
|
2012-05-06 23:19:00 +04:00
|
|
|
if (BX_SELECTED_DRIVE(channel).atapi.total_bytes_remaining < controller->byte_count) {
|
|
|
|
controller->byte_count = BX_SELECTED_DRIVE(channel).atapi.total_bytes_remaining;
|
2005-10-02 19:44:10 +04:00
|
|
|
}
|
2012-05-06 23:19:00 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).atapi.drq_bytes = controller->byte_count;
|
2005-10-02 19:44:10 +04:00
|
|
|
|
|
|
|
raise_interrupt(channel);
|
|
|
|
} else {
|
|
|
|
// all bytes read
|
2009-04-25 12:06:32 +04:00
|
|
|
BX_DEBUG(("PACKET all bytes read"));
|
2012-05-06 23:19:00 +04:00
|
|
|
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;
|
2005-10-02 19:44:10 +04:00
|
|
|
|
|
|
|
raise_interrupt(channel);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
GOTO_RETURN_VALUE;
|
|
|
|
}
|
|
|
|
break;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
default:
|
2011-04-02 17:19:52 +04:00
|
|
|
BX_ERROR(("read from 0x%04x: current command is 0x%02x", address,
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->current_command));
|
2005-10-02 19:44:10 +04:00
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
break;
|
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
case 0x01: // hard disk error register 0x1f1
|
2006-02-07 00:27:34 +03:00
|
|
|
// -- 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
|
2012-05-06 23:19:00 +04:00
|
|
|
value8 = (!BX_ANY_IS_PRESENT(channel)) ? 0 : controller->error_register;
|
2001-04-10 05:04:59 +04:00
|
|
|
goto return_value8;
|
2002-09-23 00:56:12 +04:00
|
|
|
case 0x02: // hard disk sector count / interrupt reason 0x1f2
|
2012-05-06 23:19:00 +04:00
|
|
|
value8 = (!BX_ANY_IS_PRESENT(channel)) ? 0 : controller->sector_count;
|
2001-05-04 00:40:08 +04:00
|
|
|
goto return_value8;
|
2002-09-23 00:56:12 +04:00
|
|
|
case 0x03: // sector number 0x1f3
|
2012-05-06 23:19:00 +04:00
|
|
|
value8 = (!BX_ANY_IS_PRESENT(channel)) ? 0 : controller->sector_no;
|
2001-04-10 05:04:59 +04:00
|
|
|
goto return_value8;
|
2008-01-27 01:24:03 +03:00
|
|
|
case 0x04: // cylinder low 0x1f4
|
2012-05-06 23:19:00 +04:00
|
|
|
value8 = (!BX_ANY_IS_PRESENT(channel)) ? 0 : (controller->cylinder_no & 0x00ff);
|
2001-04-10 05:04:59 +04:00
|
|
|
goto return_value8;
|
2002-09-23 00:56:12 +04:00
|
|
|
case 0x05: // cylinder high 0x1f5
|
2012-05-06 23:19:00 +04:00
|
|
|
value8 = (!BX_ANY_IS_PRESENT(channel)) ? 0 : controller->cylinder_no >> 8;
|
2001-04-10 05:04:59 +04:00
|
|
|
goto return_value8;
|
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
case 0x06: // hard disk drive and head register 0x1f6
|
2001-09-19 19:30:44 +04:00
|
|
|
// 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) |
|
2012-05-06 23:19:00 +04:00
|
|
|
(controller->lba_mode << 6) |
|
2001-04-10 05:04:59 +04:00
|
|
|
(1 << 5) | // 01b = 512 sector size
|
2002-09-23 00:56:12 +04:00
|
|
|
(BX_HD_THIS channels[channel].drive_select << 4) |
|
2012-05-06 23:19:00 +04:00
|
|
|
(controller->head_no << 0);
|
2001-04-10 05:04:59 +04:00
|
|
|
goto return_value8;
|
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
case 0x07: // Hard Disk Status 0x1f7
|
|
|
|
case 0x16: // Hard Disk Alternate Status 0x3f6
|
2006-02-07 00:27:34 +03:00
|
|
|
if (!BX_SELECTED_IS_PRESENT(channel)) {
|
|
|
|
// (mch) Just return zero for these registers
|
|
|
|
value8 = 0;
|
2001-04-10 05:04:59 +04:00
|
|
|
} else {
|
2006-02-07 00:27:34 +03:00
|
|
|
value8 = (
|
2012-05-06 23:19:00 +04:00
|
|
|
(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) |
|
|
|
|
(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;
|
2001-04-10 05:04:59 +04:00
|
|
|
}
|
|
|
|
}
|
2002-10-25 01:07:56 +04:00
|
|
|
if (port == 0x07) {
|
|
|
|
DEV_pic_lower_irq(BX_HD_THIS channels[channel].irq);
|
2006-02-07 00:27:34 +03:00
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
goto return_value8;
|
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
case 0x17: // Hard Disk Address Register 0x3f7
|
2001-04-10 05:04:59 +04:00
|
|
|
// 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:
|
2001-05-30 22:56:02 +04:00
|
|
|
BX_PANIC(("hard drive: io read to address %x unsupported",
|
merge in BRANCH-io-cleanup.
To see the commit logs for this use either cvsweb or
cvs update -r BRANCH-io-cleanup and then 'cvs log' the various files.
In general this provides a generic interface for logging.
logfunctions:: is a class that is inherited by some classes, and also
. allocated as a standalone global called 'genlog'. All logging uses
. one of the ::info(), ::error(), ::ldebug(), ::panic() methods of this
. class through 'BX_INFO(), BX_ERROR(), BX_DEBUG(), BX_PANIC()' macros
. respectively.
.
. An example usage:
. BX_INFO(("Hello, World!\n"));
iofunctions:: is a class that is allocated once by default, and assigned
as the iofunction of each logfunctions instance. It is this class that
maintains the file descriptor and other output related code, at this
point using vfprintf(). At some future point, someone may choose to
write a gui 'console' for bochs to which messages would be redirected
simply by assigning a different iofunction class to the various logfunctions
objects.
More cleanup is coming, but this works for now. If you want to see alot
of debugging output, in main.cc, change onoff[LOGLEV_DEBUG]=0 to =1.
Comments, bugs, flames, to me: todd@fries.net
2001-05-15 18:49:57 +04:00
|
|
|
(unsigned) address));
|
2008-03-29 20:44:13 +03:00
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2001-05-30 22:56:02 +04:00
|
|
|
BX_PANIC(("hard drive: shouldnt get here!"));
|
2001-04-10 05:04:59 +04:00
|
|
|
return(0);
|
|
|
|
|
2008-01-27 01:24:03 +03:00
|
|
|
return_value32:
|
2001-06-23 21:59:14 +04:00
|
|
|
BX_DEBUG(("32-bit read from %04x = %08x {%s}",
|
2011-10-01 01:02:09 +04:00
|
|
|
(unsigned) address, value32, BX_SELECTED_TYPE_STRING(channel)));
|
2001-04-10 05:04:59 +04:00
|
|
|
return value32;
|
|
|
|
|
2008-01-27 01:24:03 +03:00
|
|
|
return_value16:
|
2001-06-23 21:59:14 +04:00
|
|
|
BX_DEBUG(("16-bit read from %04x = %04x {%s}",
|
2011-10-01 01:02:09 +04:00
|
|
|
(unsigned) address, value16, BX_SELECTED_TYPE_STRING(channel)));
|
2001-04-10 05:04:59 +04:00
|
|
|
return value16;
|
|
|
|
|
2008-01-27 01:24:03 +03:00
|
|
|
return_value8:
|
2001-06-23 21:59:14 +04:00
|
|
|
BX_DEBUG(("8-bit read from %04x = %02x {%s}",
|
2011-10-01 01:02:09 +04:00
|
|
|
(unsigned) address, value8, BX_SELECTED_TYPE_STRING(channel)));
|
2001-04-10 05:04:59 +04:00
|
|
|
return value8;
|
|
|
|
}
|
|
|
|
|
2006-03-07 21:16:41 +03:00
|
|
|
// static IO port write callback handler
|
|
|
|
// redirects to non-static class handler to avoid virtual functions
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2006-03-07 21:16:41 +03:00
|
|
|
void bx_hard_drive_c::write_handler(void *this_ptr, Bit32u address, Bit32u value, unsigned io_len)
|
2001-04-10 05:04:59 +04:00
|
|
|
{
|
|
|
|
#if !BX_USE_HD_SMF
|
|
|
|
bx_hard_drive_c *class_ptr = (bx_hard_drive_c *) this_ptr;
|
|
|
|
class_ptr->write(address, value, io_len);
|
|
|
|
}
|
|
|
|
|
2006-03-07 21:16:41 +03:00
|
|
|
void bx_hard_drive_c::write(Bit32u address, Bit32u value, unsigned io_len)
|
2001-04-10 05:04:59 +04:00
|
|
|
{
|
|
|
|
#else
|
|
|
|
UNUSED(this_ptr);
|
|
|
|
#endif // !BX_USE_HD_SMF
|
2006-11-18 14:51:07 +03:00
|
|
|
Bit64s logical_sector;
|
2002-10-25 15:44:41 +04:00
|
|
|
bx_bool prev_control_reset;
|
2006-12-25 12:34:32 +03:00
|
|
|
bx_bool lba48 = 0;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
Bit8u channel = BX_MAX_ATA_CHANNEL;
|
2003-02-01 15:21:43 +03:00
|
|
|
Bit32u port = 0xff; // undefined
|
2008-03-29 20:44:13 +03:00
|
|
|
int i;
|
2002-09-23 00:56:12 +04:00
|
|
|
|
|
|
|
for (channel=0; channel<BX_MAX_ATA_CHANNEL; channel++) {
|
2003-02-01 15:21:43 +03:00
|
|
|
if ((address & 0xfff8) == BX_HD_THIS channels[channel].ioaddr1) {
|
2002-09-23 00:56:12 +04:00
|
|
|
port = address - BX_HD_THIS channels[channel].ioaddr1;
|
|
|
|
break;
|
2008-03-29 20:44:13 +03:00
|
|
|
}
|
2003-02-01 15:21:43 +03:00
|
|
|
else if ((address & 0xfff8) == BX_HD_THIS channels[channel].ioaddr2) {
|
2002-09-23 00:56:12 +04:00
|
|
|
port = address - BX_HD_THIS channels[channel].ioaddr2 + 0x10;
|
|
|
|
break;
|
|
|
|
}
|
2008-03-29 20:44:13 +03:00
|
|
|
}
|
2002-09-23 00:56:12 +04:00
|
|
|
|
|
|
|
if (channel == BX_MAX_ATA_CHANNEL) {
|
2003-07-28 22:52:14 +04:00
|
|
|
if (address != 0x03f6) {
|
|
|
|
BX_PANIC(("write: unable to find ATA channel, ioport=0x%04x", address));
|
|
|
|
} else {
|
|
|
|
channel = 0;
|
|
|
|
port = address - 0x03e0;
|
2002-09-23 00:56:12 +04:00
|
|
|
}
|
2003-07-28 22:52:14 +04:00
|
|
|
}
|
2002-09-23 00:56:12 +04:00
|
|
|
|
2006-08-23 21:19:03 +04:00
|
|
|
switch (io_len) {
|
|
|
|
case 1:
|
|
|
|
BX_DEBUG(("8-bit write to %04x = %02x {%s}",
|
|
|
|
address, value, BX_SELECTED_TYPE_STRING(channel)));
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 2:
|
|
|
|
BX_DEBUG(("16-bit write to %04x = %04x {%s}",
|
|
|
|
address, value, BX_SELECTED_TYPE_STRING(channel)));
|
|
|
|
break;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2006-08-23 21:19:03 +04:00
|
|
|
case 4:
|
|
|
|
BX_DEBUG(("32-bit write to %04x = %08x {%s}",
|
|
|
|
address, value, BX_SELECTED_TYPE_STRING(channel)));
|
|
|
|
break;
|
|
|
|
|
|
|
|
default:
|
|
|
|
BX_DEBUG(("unknown-size write to %04x = %08x {%s}",
|
|
|
|
address, value, BX_SELECTED_TYPE_STRING(channel)));
|
|
|
|
break;
|
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
controller_t *controller = &BX_SELECTED_CONTROLLER(channel);
|
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
switch (port) {
|
|
|
|
case 0x00: // 0x1f0
|
2012-05-06 23:19:00 +04:00
|
|
|
switch (controller->current_command) {
|
2001-09-28 11:14:50 +04:00
|
|
|
case 0x30: // WRITE SECTORS
|
2006-07-17 22:40:26 +04:00
|
|
|
case 0xC5: // WRITE MULTIPLE SECTORS
|
2006-12-25 12:34:32 +03:00
|
|
|
case 0x34: // WRITE SECTORS EXT
|
|
|
|
case 0x39: // WRITE MULTIPLE EXT
|
2012-05-06 23:19:00 +04:00
|
|
|
if (controller->buffer_index >= controller->buffer_size)
|
|
|
|
BX_PANIC(("IO write(0x%04x): buffer_index >= %d", address, controller->buffer_size));
|
2002-02-07 20:43:06 +03:00
|
|
|
|
2002-09-09 20:56:56 +04:00
|
|
|
#if BX_SupportRepeatSpeedups
|
2002-10-25 01:07:56 +04:00
|
|
|
if (DEV_bulk_io_quantum_requested()) {
|
2002-09-09 20:56:56 +04:00
|
|
|
unsigned transferLen, quantumsMax;
|
2012-05-06 23:19:00 +04:00
|
|
|
quantumsMax = (controller->buffer_size - controller->buffer_index) / io_len;
|
2008-02-16 01:05:43 +03:00
|
|
|
if (quantumsMax == 0)
|
2003-02-01 15:21:43 +03:00
|
|
|
BX_PANIC(("IO write(0x%04x): not enough space for write", address));
|
2008-04-17 18:39:33 +04:00
|
|
|
DEV_bulk_io_quantum_transferred() = DEV_bulk_io_quantum_requested();
|
2002-10-25 01:07:56 +04:00
|
|
|
if (quantumsMax < DEV_bulk_io_quantum_transferred())
|
|
|
|
DEV_bulk_io_quantum_transferred() = quantumsMax;
|
|
|
|
transferLen = io_len * DEV_bulk_io_quantum_transferred();
|
2012-05-06 23:19:00 +04:00
|
|
|
memcpy(&controller->buffer[controller->buffer_index],
|
2008-04-17 18:39:33 +04:00
|
|
|
(Bit8u*) DEV_bulk_io_host_addr(), transferLen);
|
2005-10-02 14:16:54 +04:00
|
|
|
DEV_bulk_io_host_addr() += transferLen;
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer_index += transferLen;
|
2005-10-02 14:16:54 +04:00
|
|
|
}
|
2002-09-09 20:56:56 +04:00
|
|
|
else
|
|
|
|
#endif
|
2005-10-02 14:16:54 +04:00
|
|
|
{
|
2008-01-27 01:24:03 +03:00
|
|
|
switch(io_len) {
|
2002-09-09 20:56:56 +04:00
|
|
|
case 4:
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer[controller->buffer_index+3] = (Bit8u)(value >> 24);
|
|
|
|
controller->buffer[controller->buffer_index+2] = (Bit8u)(value >> 16);
|
2002-09-09 20:56:56 +04:00
|
|
|
case 2:
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer[controller->buffer_index+1] = (Bit8u)(value >> 8);
|
|
|
|
controller->buffer[controller->buffer_index] = (Bit8u) value;
|
2008-01-27 01:24:03 +03:00
|
|
|
}
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer_index += io_len;
|
2005-10-02 14:16:54 +04:00
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
/* if buffer completely writtten */
|
2012-05-06 23:19:00 +04:00
|
|
|
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 * 512;
|
2006-07-17 22:40:26 +04:00
|
|
|
} else {
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer_size = controller->num_sectors * 512;
|
2006-07-17 22:40:26 +04:00
|
|
|
}
|
|
|
|
}
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer_index = 0;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2006-07-17 22:40:26 +04:00
|
|
|
/* 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,
|
2008-01-27 01:24:03 +03:00
|
|
|
* clears BSY bit, and issues IRQ
|
2006-07-17 22:40:26 +04:00
|
|
|
*/
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
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;
|
2006-07-17 22:40:26 +04:00
|
|
|
} else { /* no more sectors to write */
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->status.busy = 0;
|
|
|
|
controller->status.drive_ready = 1;
|
|
|
|
controller->status.drq = 0;
|
|
|
|
controller->status.err = 0;
|
|
|
|
controller->status.corrected_data = 0;
|
2014-02-24 00:06:02 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).last_lsector = BX_SELECTED_DRIVE(channel).curr_lsector;
|
2006-07-17 22:40:26 +04:00
|
|
|
}
|
|
|
|
raise_interrupt(channel);
|
2001-04-10 05:04:59 +04:00
|
|
|
}
|
2005-10-02 14:16:54 +04:00
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
break;
|
|
|
|
|
2005-10-02 14:16:54 +04:00
|
|
|
case 0xa0: // PACKET
|
2012-05-06 23:19:00 +04:00
|
|
|
if (controller->buffer_index >= PACKET_SIZE)
|
2005-10-02 14:16:54 +04:00
|
|
|
BX_PANIC(("IO write(0x%04x): buffer_index >= PACKET_SIZE", address));
|
2006-08-23 21:19:03 +04:00
|
|
|
|
|
|
|
switch (io_len) {
|
|
|
|
case 4:
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer[controller->buffer_index+3] = (Bit8u)(value >> 24);
|
|
|
|
controller->buffer[controller->buffer_index+2] = (Bit8u)(value >> 16);
|
2006-08-23 21:19:03 +04:00
|
|
|
case 2:
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer[controller->buffer_index+1] = (Bit8u)(value >> 8);
|
|
|
|
controller->buffer[controller->buffer_index] = (Bit8u) value;
|
2006-08-23 21:19:03 +04:00
|
|
|
}
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer_index += io_len;
|
2005-10-02 14:16:54 +04:00
|
|
|
|
|
|
|
/* if packet completely writtten */
|
2012-05-06 23:19:00 +04:00
|
|
|
if (controller->buffer_index >= PACKET_SIZE) {
|
2005-10-02 14:16:54 +04:00
|
|
|
// complete command received
|
2012-05-06 23:19:00 +04:00
|
|
|
Bit8u atapi_command = controller->buffer[0];
|
|
|
|
controller->buffer_size = 2048;
|
2005-10-02 14:16:54 +04:00
|
|
|
|
2006-08-23 21:19:03 +04:00
|
|
|
BX_DEBUG(("ata%d-%d: ATAPI command 0x%02x started", channel,
|
|
|
|
BX_SLAVE_SELECTED(channel), atapi_command));
|
2005-10-02 14:16:54 +04:00
|
|
|
|
|
|
|
switch (atapi_command) {
|
|
|
|
case 0x00: // test unit ready
|
|
|
|
if (BX_SELECTED_DRIVE(channel).cdrom.ready) {
|
2012-05-06 23:19:00 +04:00
|
|
|
atapi_cmd_nop(controller);
|
2005-10-02 14:16:54 +04:00
|
|
|
} else {
|
|
|
|
atapi_cmd_error(channel, SENSE_NOT_READY, ASC_MEDIUM_NOT_PRESENT, 0);
|
|
|
|
}
|
|
|
|
raise_interrupt(channel);
|
|
|
|
break;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2005-10-02 14:16:54 +04:00
|
|
|
case 0x03: // request sense
|
|
|
|
{
|
2012-05-06 23:19:00 +04:00
|
|
|
int alloc_length = controller->buffer[4];
|
2005-10-02 14:16:54 +04:00
|
|
|
init_send_atapi_command(channel, atapi_command, 18, alloc_length);
|
|
|
|
|
|
|
|
// sense data
|
2012-05-06 23:19:00 +04:00
|
|
|
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];
|
2005-10-02 14:16:54 +04:00
|
|
|
|
2009-04-21 14:18:42 +04:00
|
|
|
if (BX_SELECTED_DRIVE(channel).sense.sense_key == SENSE_UNIT_ATTENTION) {
|
|
|
|
BX_SELECTED_DRIVE(channel).sense.sense_key = SENSE_NONE;
|
|
|
|
}
|
2005-10-02 14:16:54 +04:00
|
|
|
ready_to_send_atapi(channel);
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0x1b: // start stop unit
|
|
|
|
{
|
2006-02-26 22:11:20 +03:00
|
|
|
char ata_name[20];
|
2012-05-06 23:19:00 +04:00
|
|
|
//bx_bool Immed = (controller->buffer[1] >> 0) & 1;
|
|
|
|
bx_bool LoEj = (controller->buffer[4] >> 1) & 1;
|
|
|
|
bx_bool Start = (controller->buffer[4] >> 0) & 1;
|
2005-10-02 14:16:54 +04:00
|
|
|
|
|
|
|
if (!LoEj && !Start) { // stop the disc
|
|
|
|
BX_ERROR(("FIXME: Stop disc not implemented"));
|
2012-05-06 23:19:00 +04:00
|
|
|
atapi_cmd_nop(controller);
|
2005-10-02 14:16:54 +04:00
|
|
|
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"));
|
2012-05-06 23:19:00 +04:00
|
|
|
atapi_cmd_nop(controller);
|
2005-10-02 14:16:54 +04:00
|
|
|
raise_interrupt(channel);
|
|
|
|
} else if (LoEj && !Start) { // Eject the disc
|
2012-05-06 23:19:00 +04:00
|
|
|
atapi_cmd_nop(controller);
|
2002-09-23 00:56:12 +04:00
|
|
|
|
2005-10-02 14:16:54 +04:00
|
|
|
if (BX_SELECTED_DRIVE(channel).cdrom.ready) {
|
|
|
|
BX_SELECTED_DRIVE(channel).cdrom.cd->eject_cdrom();
|
|
|
|
BX_SELECTED_DRIVE(channel).cdrom.ready = 0;
|
2006-02-26 22:11:20 +03:00
|
|
|
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);
|
2013-01-22 22:26:49 +04:00
|
|
|
SIM->get_param_enum("status", base)->set(BX_EJECTED);
|
2005-10-02 14:16:54 +04:00
|
|
|
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
|
2012-05-06 23:19:00 +04:00
|
|
|
atapi_cmd_nop(controller);
|
2005-10-02 14:16:54 +04:00
|
|
|
raise_interrupt(channel);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
break;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2005-10-02 14:16:54 +04:00
|
|
|
case 0xbd: // mechanism status
|
|
|
|
{
|
2012-05-06 23:19:00 +04:00
|
|
|
Bit16u alloc_length = read_16bit(controller->buffer + 8);
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2005-10-02 14:16:54 +04:00
|
|
|
if (alloc_length == 0)
|
|
|
|
BX_PANIC(("Zero allocation length to MECHANISM STATUS not impl."));
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2005-10-02 19:44:10 +04:00
|
|
|
init_send_atapi_command(channel, atapi_command, 8, alloc_length);
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer[0] = 0; // reserved for non changers
|
|
|
|
controller->buffer[1] = 0; // reserved for non changers
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer[2] = 0; // Current LBA (TODO!)
|
|
|
|
controller->buffer[3] = 0; // Current LBA (TODO!)
|
|
|
|
controller->buffer[4] = 0; // Current LBA (TODO!)
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer[5] = 1; // one slot
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer[6] = 0; // slot table length
|
|
|
|
controller->buffer[7] = 0; // slot table length
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2005-10-02 14:16:54 +04:00
|
|
|
ready_to_send_atapi(channel);
|
|
|
|
}
|
|
|
|
break;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2008-07-07 22:36:07 +04:00
|
|
|
case 0x1a: // mode sense (6)
|
|
|
|
case 0x5a: // mode sense (10)
|
2005-10-02 14:16:54 +04:00
|
|
|
{
|
2008-07-07 22:36:07 +04:00
|
|
|
Bit16u alloc_length;
|
2005-10-02 14:16:54 +04:00
|
|
|
|
2008-07-07 22:36:07 +04:00
|
|
|
if (atapi_command == 0x5a) {
|
2012-05-06 23:19:00 +04:00
|
|
|
alloc_length = read_16bit(controller->buffer + 7);
|
2008-07-07 22:36:07 +04:00
|
|
|
} else {
|
2012-05-06 23:19:00 +04:00
|
|
|
alloc_length = controller->buffer[4];
|
2008-07-07 22:36:07 +04:00
|
|
|
}
|
2012-05-06 23:19:00 +04:00
|
|
|
Bit8u PC = controller->buffer[2] >> 6;
|
|
|
|
Bit8u PageCode = controller->buffer[2] & 0x3f;
|
2005-10-02 14:16:54 +04:00
|
|
|
|
|
|
|
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);
|
2012-05-06 23:19:00 +04:00
|
|
|
init_mode_sense_single(channel, &controller->buffer[8], 28);
|
|
|
|
controller->buffer[8] = 0x2a;
|
|
|
|
controller->buffer[9] = 0x12;
|
|
|
|
controller->buffer[10] = 0x00;
|
|
|
|
controller->buffer[11] = 0x00;
|
2005-10-02 14:16:54 +04:00
|
|
|
// Multisession, Mode 2 Form 2, Mode 2 Form 1
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer[12] = 0x70;
|
|
|
|
controller->buffer[13] = (3 << 5);
|
|
|
|
controller->buffer[14] = (unsigned char) (1 |
|
2005-10-02 14:16:54 +04:00
|
|
|
(BX_SELECTED_DRIVE(channel).cdrom.locked ? (1 << 1) : 0) |
|
|
|
|
(1 << 3) |
|
|
|
|
(1 << 5));
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer[15] = 0x00;
|
|
|
|
controller->buffer[16] = (706 >> 8) & 0xff;
|
|
|
|
controller->buffer[17] = 706 & 0xff;
|
|
|
|
controller->buffer[18] = 0;
|
|
|
|
controller->buffer[19] = 2;
|
|
|
|
controller->buffer[20] = (512 >> 8) & 0xff;
|
|
|
|
controller->buffer[21] = 512 & 0xff;
|
|
|
|
controller->buffer[22] = (706 >> 8) & 0xff;
|
|
|
|
controller->buffer[23] = 706 & 0xff;
|
|
|
|
controller->buffer[24] = 0;
|
|
|
|
controller->buffer[25] = 0;
|
|
|
|
controller->buffer[26] = 0;
|
|
|
|
controller->buffer[27] = 0;
|
2005-10-02 14:16:54 +04:00
|
|
|
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
|
2012-05-06 23:19:00 +04:00
|
|
|
BX_ERROR(("cdrom: MODE SENSE (chg), code=%x not implemented yet", PageCode));
|
2005-10-02 14:16:54 +04:00
|
|
|
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);
|
2012-05-06 23:19:00 +04:00
|
|
|
init_mode_sense_single(channel, &controller->buffer[8], 28);
|
|
|
|
controller->buffer[8] = 0x2a;
|
|
|
|
controller->buffer[9] = 0x12;
|
|
|
|
controller->buffer[10] = 0x00;
|
|
|
|
controller->buffer[11] = 0x00;
|
2005-10-02 14:16:54 +04:00
|
|
|
// Multisession, Mode 2 Form 2, Mode 2 Form 1
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer[12] = 0x70;
|
|
|
|
controller->buffer[13] = (3 << 5);
|
|
|
|
controller->buffer[14] = (unsigned char) (1 |
|
2005-10-02 14:16:54 +04:00
|
|
|
(BX_SELECTED_DRIVE(channel).cdrom.locked ? (1 << 1) : 0) |
|
|
|
|
(1 << 3) |
|
|
|
|
(1 << 5));
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer[15] = 0x00;
|
|
|
|
controller->buffer[16] = (706 >> 8) & 0xff;
|
|
|
|
controller->buffer[17] = 706 & 0xff;
|
|
|
|
controller->buffer[18] = 0;
|
|
|
|
controller->buffer[19] = 2;
|
|
|
|
controller->buffer[20] = (512 >> 8) & 0xff;
|
|
|
|
controller->buffer[21] = 512 & 0xff;
|
|
|
|
controller->buffer[22] = (706 >> 8) & 0xff;
|
|
|
|
controller->buffer[23] = 706 & 0xff;
|
|
|
|
controller->buffer[24] = 0;
|
|
|
|
controller->buffer[25] = 0;
|
|
|
|
controller->buffer[26] = 0;
|
|
|
|
controller->buffer[27] = 0;
|
2005-10-02 14:16:54 +04:00
|
|
|
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;
|
|
|
|
|
|
|
|
case 0x3: // saved values not implemented
|
|
|
|
atapi_cmd_error(channel, SENSE_ILLEGAL_REQUEST, ASC_SAVING_PARAMETERS_NOT_SUPPORTED, 1);
|
|
|
|
raise_interrupt(channel);
|
|
|
|
break;
|
|
|
|
|
|
|
|
default:
|
|
|
|
BX_PANIC(("Should not get here!"));
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0x12: // inquiry
|
|
|
|
{
|
2012-05-06 23:19:00 +04:00
|
|
|
Bit8u alloc_length = controller->buffer[4];
|
2005-10-02 14:16:54 +04:00
|
|
|
|
|
|
|
init_send_atapi_command(channel, atapi_command, 36, alloc_length);
|
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
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
|
2005-10-02 14:16:54 +04:00
|
|
|
|
|
|
|
// Vendor ID
|
2005-10-02 19:44:10 +04:00
|
|
|
const char* vendor_id = "BOCHS ";
|
2005-10-02 14:16:54 +04:00
|
|
|
for (i = 0; i < 8; i++)
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer[8+i] = vendor_id[i];
|
2005-10-02 14:16:54 +04:00
|
|
|
|
|
|
|
// Product ID
|
2006-08-05 11:49:31 +04:00
|
|
|
const char* product_id = "Generic CD-ROM ";
|
2005-10-02 14:16:54 +04:00
|
|
|
for (i = 0; i < 16; i++)
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer[16+i] = product_id[i];
|
2006-08-05 11:49:31 +04:00
|
|
|
if (BX_HD_THIS cdrom_count > 1) {
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer[31] = BX_SELECTED_DRIVE(channel).device_num;
|
2006-08-05 11:49:31 +04:00
|
|
|
}
|
2005-10-02 14:16:54 +04:00
|
|
|
|
|
|
|
// Product Revision level
|
|
|
|
const char* rev_level = "1.0 ";
|
|
|
|
for (i = 0; i < 4; i++)
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer[32+i] = rev_level[i];
|
2005-10-02 14:16:54 +04:00
|
|
|
|
|
|
|
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) {
|
2014-02-10 00:28:42 +04:00
|
|
|
Bit32u capacity = BX_SELECTED_DRIVE(channel).cdrom.max_lba;
|
2012-05-06 23:19:00 +04:00
|
|
|
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;
|
2005-10-02 14:16:54 +04:00
|
|
|
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) {
|
2012-05-06 23:19:00 +04:00
|
|
|
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];
|
2005-10-02 19:44:10 +04:00
|
|
|
if (transfer_length == 0) {
|
2012-05-06 23:19:00 +04:00
|
|
|
atapi_cmd_nop(controller);
|
2005-10-02 19:44:10 +04:00
|
|
|
raise_interrupt(channel);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
switch (transfer_req & 0xf8) {
|
|
|
|
case 0x00:
|
2012-05-06 23:19:00 +04:00
|
|
|
atapi_cmd_nop(controller);
|
2005-10-02 19:44:10 +04:00
|
|
|
raise_interrupt(channel);
|
|
|
|
break;
|
2005-11-04 22:03:46 +03:00
|
|
|
case 0xf8:
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer_size = 2352;
|
2005-10-02 19:44:10 +04:00
|
|
|
case 0x10:
|
2014-02-10 00:28:42 +04:00
|
|
|
{
|
|
|
|
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;
|
2014-02-14 22:27:36 +04:00
|
|
|
start_seek(channel);
|
2014-02-10 00:28:42 +04:00
|
|
|
}
|
2005-11-01 22:10:24 +03:00
|
|
|
break;
|
2005-10-02 19:44:10 +04:00
|
|
|
default:
|
2005-11-01 22:10:24 +03:00
|
|
|
BX_ERROR(("Read CD: unknown format"));
|
2005-10-02 19:44:10 +04:00
|
|
|
atapi_cmd_error(channel, SENSE_ILLEGAL_REQUEST, ASC_INV_FIELD_IN_CMD_PACKET, 1);
|
|
|
|
raise_interrupt(channel);
|
|
|
|
}
|
2005-10-02 14:16:54 +04:00
|
|
|
} else {
|
|
|
|
atapi_cmd_error(channel, SENSE_NOT_READY, ASC_MEDIUM_NOT_PRESENT, 1);
|
|
|
|
raise_interrupt(channel);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0x43: // read toc
|
2008-03-29 20:44:13 +03:00
|
|
|
if (BX_SELECTED_DRIVE(channel).cdrom.ready) {
|
2012-05-06 23:19:00 +04:00
|
|
|
bx_bool msf = (controller->buffer[1] >> 1) & 1;
|
|
|
|
Bit8u starting_track = controller->buffer[6];
|
2013-11-10 15:14:42 +04:00
|
|
|
int toc_length = 0;
|
2012-05-06 23:19:00 +04:00
|
|
|
Bit16u alloc_length = read_16bit(controller->buffer + 7);
|
|
|
|
Bit8u format = (controller->buffer[9] >> 6);
|
2008-03-29 20:44:13 +03:00
|
|
|
switch (format) {
|
2013-11-10 15:14:42 +04:00
|
|
|
// Win32: I just read the TOC using Win32's IOCTRL functions (Ben)
|
|
|
|
#if BX_SUPPORT_CDROM && defined(WIN32)
|
2008-03-29 20:44:13 +03:00
|
|
|
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:
|
2012-05-06 23:19:00 +04:00
|
|
|
if (!(BX_SELECTED_DRIVE(channel).cdrom.cd->read_toc(controller->buffer,
|
2008-03-29 20:44:13 +03:00
|
|
|
&toc_length, msf, starting_track, format))) {
|
2005-11-01 22:10:24 +03:00
|
|
|
atapi_cmd_error(channel, SENSE_ILLEGAL_REQUEST, ASC_INV_FIELD_IN_CMD_PACKET, 1);
|
|
|
|
raise_interrupt(channel);
|
2008-03-29 20:44:13 +03:00
|
|
|
} else {
|
|
|
|
init_send_atapi_command(channel, atapi_command, toc_length, alloc_length);
|
|
|
|
ready_to_send_atapi(channel);
|
|
|
|
}
|
|
|
|
break;
|
2004-08-23 13:39:45 +04:00
|
|
|
#else
|
2008-03-29 20:44:13 +03:00
|
|
|
case 0:
|
|
|
|
case 1:
|
|
|
|
case 2:
|
2012-05-06 23:19:00 +04:00
|
|
|
if (!(BX_SELECTED_DRIVE(channel).cdrom.cd->read_toc(controller->buffer,
|
2008-03-29 20:44:13 +03:00
|
|
|
&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;
|
2013-11-10 15:14:42 +04:00
|
|
|
#endif
|
2008-03-29 20:44:13 +03:00
|
|
|
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);
|
2005-10-02 14:16:54 +04:00
|
|
|
}
|
2008-03-29 20:44:13 +03:00
|
|
|
} else {
|
|
|
|
atapi_cmd_error(channel, SENSE_NOT_READY, ASC_MEDIUM_NOT_PRESENT, 1);
|
|
|
|
raise_interrupt(channel);
|
2005-10-02 14:16:54 +04:00
|
|
|
}
|
|
|
|
break;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2005-02-04 00:01:01 +03:00
|
|
|
case 0x28: // read (10)
|
|
|
|
case 0xa8: // read (12)
|
2008-01-27 01:24:03 +03:00
|
|
|
{
|
2005-02-04 00:01:01 +03:00
|
|
|
Bit32s transfer_length;
|
|
|
|
|
|
|
|
if (atapi_command == 0x28)
|
2012-05-06 23:19:00 +04:00
|
|
|
transfer_length = read_16bit(controller->buffer + 7);
|
2005-02-04 00:01:01 +03:00
|
|
|
else
|
2012-05-06 23:19:00 +04:00
|
|
|
transfer_length = read_32bit(controller->buffer + 6);
|
2005-02-04 00:01:01 +03:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
Bit32u lba = read_32bit(controller->buffer + 2);
|
2005-02-04 00:01:01 +03:00
|
|
|
|
|
|
|
if (!BX_SELECTED_DRIVE(channel).cdrom.ready) {
|
2005-05-04 22:19:49 +04:00
|
|
|
atapi_cmd_error(channel, SENSE_NOT_READY, ASC_MEDIUM_NOT_PRESENT, 1);
|
2005-02-04 00:01:01 +03:00
|
|
|
raise_interrupt(channel);
|
|
|
|
break;
|
|
|
|
}
|
2014-02-10 00:28:42 +04:00
|
|
|
if (lba > BX_SELECTED_DRIVE(channel).cdrom.max_lba) {
|
2006-03-26 04:38:58 +04:00
|
|
|
atapi_cmd_error(channel, SENSE_ILLEGAL_REQUEST, ASC_LOGICAL_BLOCK_OOR, 1);
|
|
|
|
raise_interrupt(channel);
|
|
|
|
break;
|
|
|
|
}
|
2005-02-04 00:01:01 +03:00
|
|
|
|
|
|
|
// Ben: see comment below
|
2014-02-10 00:28:42 +04:00
|
|
|
if ((lba + transfer_length - 1) > BX_SELECTED_DRIVE(channel).cdrom.max_lba) {
|
|
|
|
transfer_length = (BX_SELECTED_DRIVE(channel).cdrom.max_lba - lba + 1);
|
2005-02-04 00:01:01 +03:00
|
|
|
}
|
|
|
|
if (transfer_length <= 0) {
|
2012-05-06 23:19:00 +04:00
|
|
|
atapi_cmd_nop(controller);
|
2005-02-04 00:01:01 +03:00
|
|
|
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.
|
|
|
|
|
2014-02-10 00:28:42 +04:00
|
|
|
if ((lba + transfer_length - 1) > BX_SELECTED_DRIVE(channel).cdrom.max_lba) {
|
2005-05-04 22:19:49 +04:00
|
|
|
atapi_cmd_error(channel, SENSE_ILLEGAL_REQUEST, ASC_LOGICAL_BLOCK_OOR, 1);
|
2005-02-04 00:01:01 +03:00
|
|
|
raise_interrupt(channel);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
*/
|
2014-01-19 18:15:43 +04:00
|
|
|
BX_DEBUG(("cdrom: READ (%d) LBA=%d LEN=%d DMA=%d", atapi_command==0x28?10:12,
|
|
|
|
lba, transfer_length, controller->packet_dma));
|
2005-02-04 00:01:01 +03:00
|
|
|
|
|
|
|
// handle command
|
|
|
|
init_send_atapi_command(channel, atapi_command, transfer_length * 2048,
|
2005-11-06 11:21:38 +03:00
|
|
|
transfer_length * 2048, 1);
|
2005-02-04 00:01:01 +03:00
|
|
|
BX_SELECTED_DRIVE(channel).cdrom.remaining_blocks = transfer_length;
|
|
|
|
BX_SELECTED_DRIVE(channel).cdrom.next_lba = lba;
|
2014-02-14 22:27:36 +04:00
|
|
|
start_seek(channel);
|
2005-02-04 00:01:01 +03:00
|
|
|
}
|
|
|
|
break;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2005-10-02 14:16:54 +04:00
|
|
|
case 0x2b: // seek
|
|
|
|
{
|
2012-05-06 23:19:00 +04:00
|
|
|
Bit32u lba = read_32bit(controller->buffer + 2);
|
2005-10-02 14:16:54 +04:00
|
|
|
if (!BX_SELECTED_DRIVE(channel).cdrom.ready) {
|
|
|
|
atapi_cmd_error(channel, SENSE_NOT_READY, ASC_MEDIUM_NOT_PRESENT, 1);
|
|
|
|
raise_interrupt(channel);
|
|
|
|
break;
|
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2014-02-10 00:28:42 +04:00
|
|
|
if (lba > BX_SELECTED_DRIVE(channel).cdrom.max_lba) {
|
2005-10-02 14:16:54 +04:00
|
|
|
atapi_cmd_error(channel, SENSE_ILLEGAL_REQUEST, ASC_LOGICAL_BLOCK_OOR, 1);
|
|
|
|
raise_interrupt(channel);
|
|
|
|
break;
|
|
|
|
}
|
2005-12-27 16:21:25 +03:00
|
|
|
BX_SELECTED_DRIVE(channel).cdrom.cd->seek(lba);
|
2014-02-23 17:56:23 +04:00
|
|
|
atapi_cmd_nop(controller);
|
|
|
|
raise_interrupt(channel);
|
2014-02-24 00:06:02 +04:00
|
|
|
// TODO: DSC bit must be cleared here and set after completion
|
2005-10-02 14:16:54 +04:00
|
|
|
}
|
|
|
|
break;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2005-10-02 14:16:54 +04:00
|
|
|
case 0x1e: // prevent/allow medium removal
|
2008-03-29 20:44:13 +03:00
|
|
|
if (BX_SELECTED_DRIVE(channel).cdrom.ready) {
|
2012-05-06 23:19:00 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).cdrom.locked = controller->buffer[4] & 1;
|
|
|
|
atapi_cmd_nop(controller);
|
2008-03-29 20:44:13 +03:00
|
|
|
} else {
|
|
|
|
atapi_cmd_error(channel, SENSE_NOT_READY, ASC_MEDIUM_NOT_PRESENT, 1);
|
2005-10-02 14:16:54 +04:00
|
|
|
}
|
2008-03-29 20:44:13 +03:00
|
|
|
raise_interrupt(channel);
|
2005-10-02 14:16:54 +04:00
|
|
|
break;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2005-10-02 14:16:54 +04:00
|
|
|
case 0x42: // read sub-channel
|
|
|
|
{
|
2012-05-06 23:19:00 +04:00
|
|
|
bx_bool msf = get_packet_field(controller,1, 1, 1);
|
|
|
|
bx_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);
|
2005-11-06 11:21:38 +03:00
|
|
|
int ret_len = 4; // header size
|
2005-10-02 14:16:54 +04:00
|
|
|
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 {
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer[0] = 0;
|
|
|
|
controller->buffer[1] = 0; // audio not supported
|
|
|
|
controller->buffer[2] = 0;
|
|
|
|
controller->buffer[3] = 0;
|
2005-10-02 14:16:54 +04:00
|
|
|
|
|
|
|
if (sub_q) { // !sub_q == header only
|
2005-11-12 01:52:57 +03:00
|
|
|
if ((data_format == 2) || (data_format == 3)) { // UPC or ISRC
|
2005-11-06 11:21:38 +03:00
|
|
|
ret_len = 24;
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer[4] = data_format;
|
2005-11-12 01:52:57 +03:00
|
|
|
if (data_format == 3) {
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer[5] = 0x14;
|
|
|
|
controller->buffer[6] = 1;
|
2005-11-12 01:52:57 +03:00
|
|
|
}
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer[8] = 0; // no UPC, no ISRC
|
2005-11-06 11:21:38 +03:00
|
|
|
} else {
|
|
|
|
BX_ERROR(("Read sub-channel with SubQ not implemented (format=%d)", data_format));
|
2012-05-06 23:19:00 +04:00
|
|
|
atapi_cmd_error(channel, SENSE_ILLEGAL_REQUEST, ASC_INV_FIELD_IN_CMD_PACKET, 1);
|
2005-11-06 11:21:38 +03:00
|
|
|
raise_interrupt(channel);
|
|
|
|
break;
|
|
|
|
}
|
2005-10-02 14:16:54 +04:00
|
|
|
}
|
|
|
|
init_send_atapi_command(channel, atapi_command, ret_len, alloc_length);
|
2005-11-06 11:21:38 +03:00
|
|
|
ready_to_send_atapi(channel);
|
2005-10-02 14:16:54 +04:00
|
|
|
}
|
|
|
|
}
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0x51: // read disc info
|
2008-03-29 20:44:13 +03:00
|
|
|
// 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);
|
2005-10-02 14:16:54 +04:00
|
|
|
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
|
2006-06-15 13:44:37 +04:00
|
|
|
case 0x46: // get configuration
|
|
|
|
case 0x4a: // get event status notification
|
|
|
|
BX_DEBUG(("ATAPI command 0x%x not implemented yet", atapi_command));
|
|
|
|
atapi_cmd_error(channel, SENSE_ILLEGAL_REQUEST, ASC_ILLEGAL_OPCODE, 0);
|
2005-10-02 14:16:54 +04:00
|
|
|
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;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
default:
|
2003-02-01 15:21:43 +03:00
|
|
|
BX_PANIC(("IO write(0x%04x): current command is %02xh", address,
|
2012-05-06 23:19:00 +04:00
|
|
|
(unsigned) controller->current_command));
|
2005-10-02 14:16:54 +04:00
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
break;
|
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
case 0x01: // hard disk write precompensation 0x1f1
|
2005-10-02 14:16:54 +04:00
|
|
|
WRITE_FEATURES(channel,value);
|
2009-04-25 12:06:32 +04:00
|
|
|
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)));
|
2001-04-10 05:04:59 +04:00
|
|
|
break;
|
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
case 0x02: // hard disk sector count 0x1f2
|
2005-10-02 14:16:54 +04:00
|
|
|
WRITE_SECTOR_COUNT(channel,value);
|
2009-04-25 12:06:32 +04:00
|
|
|
BX_DEBUG(("sector count = %u {%s}", value, BX_SELECTED_TYPE_STRING(channel)));
|
2005-10-02 14:16:54 +04:00
|
|
|
break;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
case 0x03: // hard disk sector number 0x1f3
|
2005-10-02 14:16:54 +04:00
|
|
|
WRITE_SECTOR_NUMBER(channel,value);
|
2009-04-25 12:06:32 +04:00
|
|
|
BX_DEBUG(("sector number = %u {%s}", value, BX_SELECTED_TYPE_STRING(channel)));
|
2001-04-10 05:04:59 +04:00
|
|
|
break;
|
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
case 0x04: // hard disk cylinder low 0x1f4
|
2005-10-02 14:16:54 +04:00
|
|
|
WRITE_CYLINDER_LOW(channel,value);
|
2009-04-25 12:06:32 +04:00
|
|
|
BX_DEBUG(("cylinder low = %02xh {%s}", value, BX_SELECTED_TYPE_STRING(channel)));
|
2005-10-02 14:16:54 +04:00
|
|
|
break;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
case 0x05: // hard disk cylinder high 0x1f5
|
2005-10-02 14:16:54 +04:00
|
|
|
WRITE_CYLINDER_HIGH(channel,value);
|
2009-04-25 12:06:32 +04:00
|
|
|
BX_DEBUG(("cylinder high = %02xh {%s}", value, BX_SELECTED_TYPE_STRING(channel)));
|
2005-10-02 14:16:54 +04:00
|
|
|
break;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
case 0x06: // hard disk drive and head register 0x1f6
|
2001-09-19 19:30:44 +04:00
|
|
|
// 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
|
2001-04-10 05:04:59 +04:00
|
|
|
// b4: DRV
|
|
|
|
// b3..0 HD3..HD0
|
2008-03-30 12:32:57 +04:00
|
|
|
{
|
|
|
|
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);
|
2012-05-06 23:19:00 +04:00
|
|
|
if (!controller->lba_mode && ((value >> 6) & 1) == 1)
|
2008-03-30 12:32:57 +04:00
|
|
|
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));
|
|
|
|
}
|
2001-10-06 12:59:01 +04:00
|
|
|
}
|
2005-10-02 14:16:54 +04:00
|
|
|
break;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
case 0x07: // hard disk command 0x1f7
|
2005-06-19 11:22:20 +04:00
|
|
|
// (mch) Writes to the command register with drive_select != 0
|
|
|
|
// are ignored if no secondary device is present
|
2002-09-23 00:56:12 +04:00
|
|
|
if ((BX_SLAVE_SELECTED(channel)) && (!BX_SLAVE_IS_PRESENT(channel)))
|
2005-06-19 11:22:20 +04:00
|
|
|
break;
|
2002-10-05 23:40:51 +04:00
|
|
|
// Writes to the command register clear the IRQ
|
2002-10-25 01:07:56 +04:00
|
|
|
DEV_pic_lower_irq(BX_HD_THIS channels[channel].irq);
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
if (controller->status.busy) {
|
2006-08-02 21:47:09 +04:00
|
|
|
BX_ERROR(("ata%d: command 0x%02x sent, controller BSY bit set", channel, value));
|
|
|
|
break;
|
|
|
|
}
|
2008-02-16 01:05:43 +03:00
|
|
|
if ((value & 0xf0) == 0x10)
|
2001-04-10 05:04:59 +04:00
|
|
|
value = 0x10;
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->status.err = 0;
|
2001-04-10 05:04:59 +04:00
|
|
|
switch (value) {
|
|
|
|
|
2001-09-28 11:14:50 +04:00
|
|
|
case 0x10: // CALIBRATE DRIVE
|
2005-06-19 11:22:20 +04:00
|
|
|
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;
|
|
|
|
}
|
2004-01-20 00:48:07 +03:00
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
if (!BX_SELECTED_IS_PRESENT(channel)) {
|
2012-05-06 23:19:00 +04:00
|
|
|
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;
|
2005-06-19 11:22:20 +04:00
|
|
|
raise_interrupt(channel);
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_INFO(("calibrate drive: disk ata%d-%d not present", channel, BX_SLAVE_SELECTED(channel)));
|
2001-04-10 05:04:59 +04:00
|
|
|
break;
|
2005-06-19 11:22:20 +04:00
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
/* move head to cylinder 0, issue IRQ */
|
2012-05-06 23:19:00 +04:00
|
|
|
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;
|
2005-06-19 11:22:20 +04:00
|
|
|
raise_interrupt(channel);
|
2001-04-10 05:04:59 +04:00
|
|
|
break;
|
|
|
|
|
2006-12-25 12:34:32 +03:00
|
|
|
case 0x24: // READ SECTORS EXT
|
|
|
|
case 0x29: // READ MULTIPLE EXT
|
|
|
|
lba48 = 1;
|
2006-07-14 21:23:58 +04:00
|
|
|
case 0x20: // READ SECTORS, with retries
|
|
|
|
case 0x21: // READ SECTORS, without retries
|
2006-07-17 22:40:26 +04:00
|
|
|
case 0xC4: // READ MULTIPLE SECTORS
|
2001-04-10 05:04:59 +04:00
|
|
|
/* update sector_no, always points to current sector
|
2008-01-27 01:24:03 +03:00
|
|
|
* after each sector is read to buffer, DRQ bit set and issue IRQ
|
2001-04-10 05:04:59 +04:00
|
|
|
* 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
|
|
|
|
*/
|
|
|
|
|
2005-06-19 11:22:20 +04:00
|
|
|
if (!BX_SELECTED_IS_HD(channel)) {
|
2006-07-26 23:09:51 +04:00
|
|
|
BX_INFO(("ata%d-%d: read sectors issued to non-disk",
|
2005-06-19 11:22:20 +04:00
|
|
|
channel, BX_SLAVE_SELECTED(channel)));
|
|
|
|
command_aborted(channel, value);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
// Lose98 accesses 0/0/0 in CHS mode
|
2012-05-06 23:19:00 +04:00
|
|
|
if (!controller->lba_mode &&
|
|
|
|
!controller->head_no &&
|
|
|
|
!controller->cylinder_no &&
|
|
|
|
!controller->sector_no) {
|
2005-06-19 11:22:20 +04:00
|
|
|
BX_INFO(("ata%d-%d: : read from 0/0/0, aborting command",
|
|
|
|
channel, BX_SLAVE_SELECTED(channel)));
|
|
|
|
command_aborted(channel, value);
|
|
|
|
break;
|
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
lba48_transform(controller, lba48);
|
2006-12-25 12:34:32 +03:00
|
|
|
if ((value == 0xC4) || (value == 0x29)) {
|
2012-05-06 23:19:00 +04:00
|
|
|
if (controller->multiple_sectors == 0) {
|
2006-07-19 23:18:42 +04:00
|
|
|
command_aborted(channel, value);
|
|
|
|
break;
|
|
|
|
}
|
2012-05-06 23:19:00 +04:00
|
|
|
if (controller->num_sectors > controller->multiple_sectors) {
|
|
|
|
controller->buffer_size = controller->multiple_sectors * 512;
|
2006-07-14 21:23:58 +04:00
|
|
|
} else {
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer_size = controller->num_sectors * 512;
|
2006-07-14 21:23:58 +04:00
|
|
|
}
|
|
|
|
} else {
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer_size = 512;
|
2006-07-14 21:23:58 +04:00
|
|
|
}
|
2014-02-24 00:06:02 +04:00
|
|
|
if (!calculate_logical_address(channel, &logical_sector)) {
|
|
|
|
command_aborted(channel, value);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
BX_SELECTED_DRIVE(channel).next_lsector = logical_sector;
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->current_command = value;
|
|
|
|
|
|
|
|
if (ide_read_sector(channel, controller->buffer,
|
|
|
|
controller->buffer_size)) {
|
|
|
|
controller->error_register = 0;
|
2014-01-18 20:16:42 +04:00
|
|
|
controller->status.busy = 1;
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->status.drive_ready = 1;
|
2014-01-18 20:16:42 +04:00
|
|
|
controller->status.seek_complete = 0;
|
|
|
|
controller->status.drq = 0;
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->status.corrected_data = 0;
|
|
|
|
controller->buffer_index = 0;
|
2014-02-14 22:27:36 +04:00
|
|
|
start_seek(channel);
|
2006-07-17 22:40:26 +04:00
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
break;
|
|
|
|
|
2006-12-25 12:34:32 +03:00
|
|
|
case 0x34: // WRITE SECTORS EXT
|
|
|
|
case 0x39: // WRITE MULTIPLE EXT
|
|
|
|
lba48 = 1;
|
2006-07-17 22:40:26 +04:00
|
|
|
case 0x30: // WRITE SECTORS, with retries
|
|
|
|
case 0xC5: // WRITE MULTIPLE SECTORS
|
2001-04-10 05:04:59 +04:00
|
|
|
/* update sector_no, always points to current sector
|
2008-01-27 01:24:03 +03:00
|
|
|
* after each sector is read to buffer, DRQ bit set and issue IRQ
|
2001-04-10 05:04:59 +04:00
|
|
|
* 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
|
|
|
|
*/
|
|
|
|
|
2005-06-18 19:00:11 +04:00
|
|
|
if (!BX_SELECTED_IS_HD(channel)) {
|
2006-07-26 23:09:51 +04:00
|
|
|
BX_INFO(("ata%d-%d: write sectors issued to non-disk",
|
2005-06-18 19:00:11 +04:00
|
|
|
channel, BX_SLAVE_SELECTED(channel)));
|
|
|
|
command_aborted(channel, value);
|
2005-06-19 11:22:20 +04:00
|
|
|
break;
|
2005-06-18 19:00:11 +04:00
|
|
|
}
|
2012-05-06 23:19:00 +04:00
|
|
|
lba48_transform(controller, lba48);
|
2006-12-25 12:34:32 +03:00
|
|
|
if ((value == 0xC5) || (value ==0x39)) {
|
2012-05-06 23:19:00 +04:00
|
|
|
if (controller->multiple_sectors == 0) {
|
2006-07-19 23:18:42 +04:00
|
|
|
command_aborted(channel, value);
|
|
|
|
break;
|
|
|
|
}
|
2012-05-06 23:19:00 +04:00
|
|
|
if (controller->num_sectors > controller->multiple_sectors) {
|
|
|
|
controller->buffer_size = controller->multiple_sectors * 512;
|
2006-07-17 22:40:26 +04:00
|
|
|
} else {
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer_size = controller->num_sectors * 512;
|
2006-07-17 22:40:26 +04:00
|
|
|
}
|
|
|
|
} else {
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer_size = 512;
|
2006-07-17 22:40:26 +04:00
|
|
|
}
|
2014-02-24 00:06:02 +04:00
|
|
|
if (!calculate_logical_address(channel, &logical_sector)) {
|
|
|
|
command_aborted(channel, value);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
BX_SELECTED_DRIVE(channel).next_lsector = logical_sector;
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->current_command = value;
|
2006-07-19 23:18:42 +04:00
|
|
|
|
2001-04-10 05:04:59 +04:00
|
|
|
// implicit seek done :^)
|
2012-05-06 23:19:00 +04:00
|
|
|
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;
|
2001-04-10 05:04:59 +04:00
|
|
|
break;
|
|
|
|
|
2001-09-28 11:14:50 +04:00
|
|
|
case 0x90: // EXECUTE DEVICE DIAGNOSTIC
|
2006-02-07 00:27:34 +03:00
|
|
|
set_signature(channel, BX_SLAVE_SELECTED(channel));
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->error_register = 0x01;
|
|
|
|
controller->status.drq = 0;
|
2007-12-17 21:08:27 +03:00
|
|
|
raise_interrupt(channel);
|
2001-04-10 05:04:59 +04:00
|
|
|
break;
|
|
|
|
|
2001-09-28 11:14:50 +04:00
|
|
|
case 0x91: // INITIALIZE DRIVE PARAMETERS
|
2005-06-18 19:00:11 +04:00
|
|
|
if (!BX_SELECTED_IS_HD(channel)) {
|
2006-07-26 23:09:51 +04:00
|
|
|
BX_INFO(("ata%d-%d: initialize drive parameters issued to non-disk",
|
2005-06-18 19:00:11 +04:00
|
|
|
channel, BX_SLAVE_SELECTED(channel)));
|
|
|
|
command_aborted(channel, value);
|
2005-06-19 11:22:20 +04:00
|
|
|
break;
|
2005-06-18 19:00:11 +04:00
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
// sets logical geometry of specified drive
|
2005-06-18 19:00:11 +04:00
|
|
|
BX_DEBUG(("ata%d-%d: init drive params: sec=%u, drive sel=%u, head=%u",
|
|
|
|
channel, BX_SLAVE_SELECTED(channel),
|
2012-05-06 23:19:00 +04:00
|
|
|
(unsigned) controller->sector_count,
|
2002-09-23 00:56:12 +04:00
|
|
|
(unsigned) BX_HD_THIS channels[channel].drive_select,
|
2012-05-06 23:19:00 +04:00
|
|
|
(unsigned) controller->head_no));
|
2002-09-23 00:56:12 +04:00
|
|
|
if (!BX_SELECTED_IS_PRESENT(channel)) {
|
2002-10-07 00:19:03 +04:00
|
|
|
BX_PANIC(("init drive params: disk ata%d-%d not present", channel, BX_SLAVE_SELECTED(channel)));
|
2012-05-06 23:19:00 +04:00
|
|
|
//controller->error_register = 0x12;
|
|
|
|
controller->status.busy = 0;
|
|
|
|
controller->status.drive_ready = 1;
|
|
|
|
controller->status.drq = 0;
|
2005-06-18 19:00:11 +04:00
|
|
|
raise_interrupt(channel);
|
2001-04-10 05:04:59 +04:00
|
|
|
break;
|
2005-06-18 19:00:11 +04:00
|
|
|
}
|
2012-05-06 23:19:00 +04:00
|
|
|
if (controller->sector_count != BX_SELECTED_DRIVE(channel).hdimage->spt) {
|
2006-08-02 21:47:09 +04:00
|
|
|
BX_ERROR(("ata%d-%d: init drive params: logical sector count %d not supported", channel, BX_SLAVE_SELECTED(channel),
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->sector_count));
|
2005-06-18 19:00:11 +04:00
|
|
|
command_aborted(channel, value);
|
2005-06-19 11:22:20 +04:00
|
|
|
break;
|
2005-06-18 19:00:11 +04:00
|
|
|
}
|
2012-05-06 23:19:00 +04:00
|
|
|
if (controller->head_no == 0) {
|
2007-02-27 21:16:20 +03:00
|
|
|
// 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)));
|
2012-05-06 23:19:00 +04:00
|
|
|
} else if (controller->head_no != (BX_SELECTED_DRIVE(channel).hdimage->heads-1)) {
|
2006-08-02 21:47:09 +04:00
|
|
|
BX_ERROR(("ata%d-%d: init drive params: max. logical head number %d not supported", channel, BX_SLAVE_SELECTED(channel),
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->head_no));
|
2005-06-18 19:00:11 +04:00
|
|
|
command_aborted(channel, value);
|
2005-06-19 11:22:20 +04:00
|
|
|
break;
|
2005-06-18 19:00:11 +04:00
|
|
|
}
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->status.busy = 0;
|
|
|
|
controller->status.drive_ready = 1;
|
|
|
|
controller->status.drq = 0;
|
2005-06-18 19:00:11 +04:00
|
|
|
raise_interrupt(channel);
|
2001-04-10 05:04:59 +04:00
|
|
|
break;
|
|
|
|
|
2001-09-28 11:14:50 +04:00
|
|
|
case 0xec: // IDENTIFY DEVICE
|
2006-12-26 20:08:12 +03:00
|
|
|
{
|
2009-04-25 12:06:32 +04:00
|
|
|
BX_DEBUG(("Drive ID Command issued : 0xec "));
|
2005-06-18 19:00:11 +04:00
|
|
|
|
2006-12-26 20:08:12 +03:00
|
|
|
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 {
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->current_command = value;
|
|
|
|
controller->error_register = 0;
|
2005-06-18 19:00:11 +04:00
|
|
|
|
2006-12-26 20:08:12 +03:00
|
|
|
// See ATA/ATAPI-4, 8.12
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->status.busy = 0;
|
|
|
|
controller->status.drive_ready = 1;
|
|
|
|
controller->status.write_fault = 0;
|
|
|
|
controller->status.drq = 1;
|
2005-10-02 14:16:54 +04:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->status.seek_complete = 1;
|
|
|
|
controller->status.corrected_data = 0;
|
2006-12-26 20:08:12 +03:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer_index = 0;
|
2006-12-26 20:08:12 +03:00
|
|
|
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++) {
|
2011-10-01 01:02:09 +04:00
|
|
|
Bit16u temp16 = BX_SELECTED_DRIVE(channel).id_drive[i];
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer[i*2] = temp16 & 0x00ff;
|
|
|
|
controller->buffer[i*2+1] = temp16 >> 8;
|
2006-12-26 20:08:12 +03:00
|
|
|
}
|
|
|
|
raise_interrupt(channel);
|
|
|
|
}
|
2005-06-18 19:00:11 +04:00
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
break;
|
|
|
|
|
2001-09-28 11:14:50 +04:00
|
|
|
case 0xef: // SET FEATURES
|
2012-05-06 23:19:00 +04:00
|
|
|
switch(controller->features) {
|
2005-11-01 22:10:24 +03:00
|
|
|
case 0x03: // Set Transfer Mode
|
2006-07-19 23:18:42 +04:00
|
|
|
{
|
2012-05-06 23:19:00 +04:00
|
|
|
Bit8u type = (controller->sector_count >> 3);
|
|
|
|
Bit8u mode = controller->sector_count & 0x07;
|
2006-12-29 14:57:04 +03:00
|
|
|
switch (type) {
|
2006-07-19 23:18:42 +04:00
|
|
|
case 0x00: // PIO default
|
|
|
|
case 0x01: // PIO mode
|
|
|
|
BX_INFO(("ata%d-%d: set transfer mode to PIO", channel,
|
|
|
|
BX_SLAVE_SELECTED(channel)));
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->mdma_mode = 0x00;
|
|
|
|
controller->udma_mode = 0x00;
|
|
|
|
controller->status.drive_ready = 1;
|
|
|
|
controller->status.seek_complete = 1;
|
2006-07-19 23:18:42 +04:00
|
|
|
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));
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->mdma_mode = (1 << mode);
|
|
|
|
controller->udma_mode = 0x00;
|
|
|
|
controller->status.drive_ready = 1;
|
|
|
|
controller->status.seek_complete = 1;
|
2006-12-29 14:57:04 +03:00
|
|
|
raise_interrupt(channel);
|
|
|
|
break;
|
|
|
|
case 0x08: // UDMA mode
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->mdma_mode = 0x00;
|
|
|
|
controller->udma_mode = (1 << mode);
|
|
|
|
controller->status.drive_ready = 1;
|
|
|
|
controller->status.seek_complete = 1;
|
2006-07-19 23:18:42 +04:00
|
|
|
raise_interrupt(channel);
|
|
|
|
break;
|
|
|
|
default:
|
2006-12-29 14:57:04 +03:00
|
|
|
BX_ERROR(("ata%d-%d: unknown transfer mode type 0x%02x", channel,
|
|
|
|
BX_SLAVE_SELECTED(channel), type));
|
2006-07-19 23:18:42 +04:00
|
|
|
command_aborted(channel, value);
|
|
|
|
}
|
2006-12-26 20:08:12 +03:00
|
|
|
BX_SELECTED_DRIVE(channel).identify_set = 0;
|
2006-07-19 23:18:42 +04:00
|
|
|
}
|
2005-11-01 22:10:24 +03:00
|
|
|
break;
|
|
|
|
|
2005-06-19 11:22:20 +04:00
|
|
|
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
|
2005-11-01 22:10:24 +03:00
|
|
|
BX_INFO(("ata%d-%d: SET FEATURES subcommand 0x%02x not supported, but returning success",
|
2012-05-06 23:19:00 +04:00
|
|
|
channel,BX_SLAVE_SELECTED(channel),(unsigned) controller->features));
|
|
|
|
controller->status.drive_ready = 1;
|
|
|
|
controller->status.seek_complete = 1;
|
2005-11-01 22:10:24 +03:00
|
|
|
raise_interrupt(channel);
|
2005-06-19 11:22:20 +04:00
|
|
|
break;
|
2001-04-10 06:09:09 +04:00
|
|
|
|
2005-06-19 11:22:20 +04:00
|
|
|
default:
|
2005-10-02 14:16:54 +04:00
|
|
|
BX_ERROR(("ata%d-%d: SET FEATURES with unknown subcommand: 0x%02x",
|
2012-05-06 23:19:00 +04:00
|
|
|
channel,BX_SLAVE_SELECTED(channel),(unsigned) controller->features));
|
2005-06-19 11:22:20 +04:00
|
|
|
command_aborted(channel, value);
|
|
|
|
}
|
|
|
|
break;
|
2001-04-10 06:09:09 +04:00
|
|
|
|
2006-12-25 12:34:32 +03:00
|
|
|
case 0x42: // READ VERIFY SECTORS EXT
|
|
|
|
lba48 = 1;
|
2001-09-28 11:14:50 +04:00
|
|
|
case 0x40: // READ VERIFY SECTORS
|
2006-12-13 19:59:29 +03:00
|
|
|
case 0x41: // READ VERIFY SECTORS NO RETRY
|
2005-10-02 14:16:54 +04:00
|
|
|
if (!BX_SELECTED_IS_HD(channel)) {
|
2006-07-26 23:09:51 +04:00
|
|
|
BX_INFO(("ata%d-%d: read verify issued to non-disk",
|
2005-10-02 14:16:54 +04:00
|
|
|
channel,BX_SLAVE_SELECTED(channel)));
|
2002-09-23 00:56:12 +04:00
|
|
|
command_aborted(channel, value);
|
2005-10-02 14:16:54 +04:00
|
|
|
break;
|
2005-06-19 11:22:20 +04:00
|
|
|
}
|
2012-05-06 23:19:00 +04:00
|
|
|
lba48_transform(controller, lba48);
|
2006-12-13 19:59:29 +03:00
|
|
|
BX_INFO(("ata%d-%d: verify command : 0x%02x !", channel,BX_SLAVE_SELECTED(channel), value));
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->status.busy = 0;
|
|
|
|
controller->status.drive_ready = 1;
|
|
|
|
controller->status.drq = 0;
|
2005-10-02 14:16:54 +04:00
|
|
|
raise_interrupt(channel);
|
2001-04-10 05:04:59 +04:00
|
|
|
break;
|
2001-09-28 11:18:55 +04:00
|
|
|
|
2006-07-26 23:09:51 +04:00
|
|
|
case 0xc6: // SET MULTIPLE MODE
|
|
|
|
if (!BX_SELECTED_IS_HD(channel)) {
|
|
|
|
BX_INFO(("set multiple mode issued to non-disk"));
|
|
|
|
command_aborted(channel, value);
|
2012-05-06 23:19:00 +04:00
|
|
|
} else if ((controller->sector_count > MAX_MULTIPLE_SECTORS) ||
|
|
|
|
((controller->sector_count & (controller->sector_count - 1)) != 0) ||
|
|
|
|
(controller->sector_count == 0)) {
|
2006-07-13 21:34:44 +04:00
|
|
|
command_aborted(channel, value);
|
|
|
|
} else {
|
2012-05-06 23:19:00 +04:00
|
|
|
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;
|
2006-07-17 22:40:26 +04:00
|
|
|
raise_interrupt(channel);
|
2006-07-13 21:34:44 +04:00
|
|
|
}
|
|
|
|
break;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
// ATAPI commands
|
2001-09-28 11:14:50 +04:00
|
|
|
case 0xa1: // IDENTIFY PACKET DEVICE
|
2006-12-26 20:08:12 +03:00
|
|
|
{
|
|
|
|
if (BX_SELECTED_IS_CD(channel)) {
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->current_command = value;
|
|
|
|
controller->error_register = 0;
|
2006-12-26 20:08:12 +03:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->status.busy = 0;
|
|
|
|
controller->status.drive_ready = 1;
|
|
|
|
controller->status.write_fault = 0;
|
|
|
|
controller->status.drq = 1;
|
2006-12-26 20:08:12 +03:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->status.seek_complete = 1;
|
|
|
|
controller->status.corrected_data = 0;
|
2006-12-26 20:08:12 +03:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer_index = 0;
|
2006-12-26 20:08:12 +03:00
|
|
|
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++) {
|
2011-10-01 01:02:09 +04:00
|
|
|
Bit16u temp16 = BX_SELECTED_DRIVE(channel).id_drive[i];
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer[i*2] = temp16 & 0x00ff;
|
|
|
|
controller->buffer[i*2+1] = temp16 >> 8;
|
2006-12-26 20:08:12 +03:00
|
|
|
}
|
|
|
|
raise_interrupt(channel);
|
|
|
|
} else {
|
|
|
|
command_aborted(channel, 0xa1);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
break;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2001-09-28 11:14:50 +04:00
|
|
|
case 0x08: // DEVICE RESET (atapi)
|
2005-08-21 21:40:45 +04:00
|
|
|
if (BX_SELECTED_IS_CD(channel)) {
|
2006-02-07 00:27:34 +03:00
|
|
|
set_signature(channel, BX_SLAVE_SELECTED(channel));
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->status.busy = 1;
|
|
|
|
controller->error_register &= ~(1 << 7);
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->status.write_fault = 0;
|
|
|
|
controller->status.drq = 0;
|
|
|
|
controller->status.corrected_data = 0;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->status.busy = 0;
|
2005-08-21 21:40:45 +04:00
|
|
|
} else {
|
|
|
|
BX_DEBUG(("ATAPI Device Reset on non-cd device"));
|
|
|
|
command_aborted(channel, 0x08);
|
|
|
|
}
|
|
|
|
break;
|
2001-09-28 11:18:55 +04:00
|
|
|
|
2001-09-28 11:14:50 +04:00
|
|
|
case 0xa0: // SEND PACKET (atapi)
|
2005-10-30 17:14:03 +03:00
|
|
|
if (BX_SELECTED_IS_CD(channel)) {
|
|
|
|
// PACKET
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->packet_dma = (controller->features & 1);
|
|
|
|
if (controller->features & (1 << 1)) {
|
2005-10-30 17:14:03 +03:00
|
|
|
BX_ERROR(("PACKET-overlapped not supported"));
|
|
|
|
command_aborted (channel, 0xa0);
|
|
|
|
} else {
|
|
|
|
// We're already ready!
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->sector_count = 1;
|
|
|
|
controller->status.busy = 0;
|
|
|
|
controller->status.write_fault = 0;
|
2005-10-30 17:14:03 +03:00
|
|
|
// serv bit??
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->status.drq = 1;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2005-10-30 17:14:03 +03:00
|
|
|
// NOTE: no interrupt here
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->current_command = value;
|
|
|
|
controller->buffer_index = 0;
|
2005-10-30 17:14:03 +03:00
|
|
|
}
|
|
|
|
} else {
|
|
|
|
command_aborted (channel, 0xa0);
|
|
|
|
}
|
|
|
|
break;
|
2001-09-28 11:18:55 +04:00
|
|
|
|
2001-09-28 11:14:50 +04:00
|
|
|
case 0xa2: // SERVICE (atapi), optional
|
2005-10-30 17:14:03 +03:00
|
|
|
if (BX_SELECTED_IS_CD(channel)) {
|
|
|
|
BX_PANIC(("ATAPI SERVICE not implemented"));
|
2006-12-26 20:08:12 +03:00
|
|
|
command_aborted(channel, 0xa2);
|
2005-10-30 17:14:03 +03:00
|
|
|
} else {
|
2006-12-26 20:08:12 +03:00
|
|
|
command_aborted(channel, 0xa2);
|
2005-10-30 17:14:03 +03:00
|
|
|
}
|
|
|
|
break;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2006-12-26 20:08:12 +03:00
|
|
|
// power management & flush cache stubs
|
|
|
|
case 0xE0: // STANDBY NOW
|
|
|
|
case 0xE1: // IDLE IMMEDIATE
|
|
|
|
case 0xE7: // FLUSH CACHE
|
|
|
|
case 0xEA: // FLUSH CACHE EXT
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->status.busy = 0;
|
|
|
|
controller->status.drive_ready = 1;
|
|
|
|
controller->status.write_fault = 0;
|
|
|
|
controller->status.drq = 0;
|
2006-12-26 20:08:12 +03:00
|
|
|
raise_interrupt(channel);
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0xe5: // CHECK POWER MODE
|
2012-05-06 23:19:00 +04:00
|
|
|
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
|
2006-12-26 20:08:12 +03:00
|
|
|
raise_interrupt(channel);
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 0x70: // SEEK (cgs)
|
|
|
|
if (BX_SELECTED_IS_HD(channel)) {
|
|
|
|
BX_DEBUG(("write cmd 0x70 (SEEK) executing"));
|
2002-09-23 00:56:12 +04:00
|
|
|
if (!calculate_logical_address(channel, &logical_sector)) {
|
|
|
|
command_aborted(channel, value);
|
2006-12-26 20:08:12 +03:00
|
|
|
break;
|
|
|
|
}
|
2014-02-24 00:06:02 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).next_lsector = logical_sector;
|
2014-02-22 01:37:33 +04:00
|
|
|
controller->current_command = value;
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->error_register = 0;
|
2014-02-22 01:37:33 +04:00
|
|
|
controller->status.busy = 1;
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->status.drive_ready = 1;
|
2014-02-22 01:37:33 +04:00
|
|
|
controller->status.seek_complete = 0;
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->status.drq = 0;
|
|
|
|
controller->status.corrected_data = 0;
|
2014-02-22 01:37:33 +04:00
|
|
|
start_seek(channel);
|
2002-05-03 12:17:18 +04:00
|
|
|
} else {
|
2006-12-26 20:08:12 +03:00
|
|
|
BX_INFO(("write cmd 0x70 (SEEK) not supported for non-disk"));
|
2008-01-27 01:24:03 +03:00
|
|
|
command_aborted(channel, 0x70);
|
2006-12-26 20:08:12 +03:00
|
|
|
}
|
2002-05-03 12:17:18 +04:00
|
|
|
break;
|
|
|
|
|
2006-12-25 12:34:32 +03:00
|
|
|
case 0x25: // READ DMA EXT
|
|
|
|
lba48 = 1;
|
2005-02-08 21:32:27 +03:00
|
|
|
case 0xC8: // READ DMA
|
2006-07-26 23:09:51 +04:00
|
|
|
if (BX_SELECTED_IS_HD(channel) && BX_HD_THIS bmdma_present()) {
|
2012-05-06 23:19:00 +04:00
|
|
|
lba48_transform(controller, lba48);
|
2014-02-24 00:06:02 +04:00
|
|
|
if (!calculate_logical_address(channel, &logical_sector)) {
|
|
|
|
command_aborted(channel, value);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
BX_SELECTED_DRIVE(channel).next_lsector = logical_sector;
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->current_command = value;
|
2014-01-19 22:13:12 +04:00
|
|
|
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;
|
2014-02-14 22:27:36 +04:00
|
|
|
start_seek(channel);
|
2005-02-08 21:32:27 +03:00
|
|
|
} else {
|
2006-12-25 12:34:32 +03:00
|
|
|
BX_ERROR(("write cmd 0x%02x (READ DMA) not supported", value));
|
|
|
|
command_aborted(channel, value);
|
2005-02-08 21:32:27 +03:00
|
|
|
}
|
|
|
|
break;
|
|
|
|
|
2006-12-25 12:34:32 +03:00
|
|
|
case 0x35: // WRITE DMA EXT
|
|
|
|
lba48 = 1;
|
2005-02-08 21:32:27 +03:00
|
|
|
case 0xCA: // WRITE DMA
|
2006-07-26 23:09:51 +04:00
|
|
|
if (BX_SELECTED_IS_HD(channel) && BX_HD_THIS bmdma_present()) {
|
2012-05-06 23:19:00 +04:00
|
|
|
lba48_transform(controller, lba48);
|
2014-02-24 00:06:02 +04:00
|
|
|
if (!calculate_logical_address(channel, &logical_sector)) {
|
|
|
|
command_aborted(channel, value);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
BX_SELECTED_DRIVE(channel).next_lsector = logical_sector;
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->status.drive_ready = 1;
|
|
|
|
controller->status.seek_complete = 1;
|
|
|
|
controller->status.drq = 1;
|
|
|
|
controller->current_command = value;
|
2005-02-08 21:32:27 +03:00
|
|
|
} else {
|
2006-12-25 12:34:32 +03:00
|
|
|
BX_ERROR(("write cmd 0x%02x (WRITE DMA) not supported", value));
|
|
|
|
command_aborted(channel, value);
|
2005-02-08 21:32:27 +03:00
|
|
|
}
|
|
|
|
break;
|
2011-03-22 22:55:07 +03:00
|
|
|
case 0x27: // READ NATIVE MAX ADDRESS EXT
|
|
|
|
lba48 = 1;
|
|
|
|
case 0xF8: // READ NATIVE MAX ADDRESS
|
|
|
|
if (BX_SELECTED_IS_HD(channel)) {
|
2012-05-06 23:19:00 +04:00
|
|
|
lba48_transform(controller, lba48);
|
2011-03-22 22:55:07 +03:00
|
|
|
Bit64s max_sector = BX_SELECTED_DRIVE(channel).hdimage->hd_size / 512 - 1;
|
2012-05-06 23:19:00 +04:00
|
|
|
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);
|
2011-03-22 22:55:07 +03:00
|
|
|
} else {
|
2012-05-06 23:19:00 +04:00
|
|
|
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);
|
2011-03-22 22:55:07 +03:00
|
|
|
}
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->status.drive_ready = 1;
|
|
|
|
controller->status.seek_complete = 1;
|
2011-03-22 22:55:07 +03:00
|
|
|
raise_interrupt(channel);
|
|
|
|
} else {
|
|
|
|
command_aborted(channel, value);
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
command_aborted(channel, value);
|
|
|
|
}
|
|
|
|
break;
|
2002-05-03 12:17:18 +04:00
|
|
|
|
2011-10-01 01:02:09 +04:00
|
|
|
// 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:
|
2006-01-07 15:52:05 +03:00
|
|
|
BX_ERROR(("IO write to 0x%04x: unknown command 0x%02x", address, value));
|
2002-09-23 00:56:12 +04:00
|
|
|
command_aborted(channel, value);
|
2006-03-07 21:16:41 +03:00
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
break;
|
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
case 0x16: // hard disk adapter control 0x3f6
|
2005-08-21 21:40:45 +04:00
|
|
|
// (mch) Even if device 1 was selected, a write to this register
|
|
|
|
// goes to device 0 (if device 1 is absent)
|
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
prev_control_reset = controller->control.reset;
|
2006-07-26 23:09:51 +04:00
|
|
|
BX_HD_THIS channels[channel].drives[0].controller.control.reset = value & 0x04;
|
|
|
|
BX_HD_THIS channels[channel].drives[1].controller.control.reset = value & 0x04;
|
2005-08-21 21:40:45 +04:00
|
|
|
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;
|
2002-09-23 00:56:12 +04:00
|
|
|
|
2006-07-26 23:09:51 +04:00
|
|
|
BX_DEBUG(("ata%d: adapter control reg: reset controller = %d", channel,
|
2012-05-06 23:19:00 +04:00
|
|
|
(unsigned) (controller->control.reset) ? 1 : 0));
|
2006-07-26 23:09:51 +04:00
|
|
|
BX_DEBUG(("ata%d: adapter control reg: disable irq = %d", channel,
|
2012-05-06 23:19:00 +04:00
|
|
|
(unsigned) (controller->control.disable_irq) ? 1 : 0));
|
2002-09-23 00:56:12 +04:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
if (!prev_control_reset && controller->control.reset) {
|
2005-08-21 21:40:45 +04:00
|
|
|
// transition from 0 to 1 causes all drives to reset
|
2006-07-26 23:09:51 +04:00
|
|
|
BX_DEBUG(("Enter RESET mode"));
|
2005-08-21 21:40:45 +04:00
|
|
|
|
|
|
|
// (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;
|
|
|
|
|
2006-07-19 23:18:42 +04:00
|
|
|
BX_CONTROLLER(channel,id).multiple_sectors = 0;
|
2005-08-21 21:40:45 +04:00
|
|
|
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);
|
|
|
|
}
|
2012-05-06 23:19:00 +04:00
|
|
|
} else if (controller->reset_in_progress &&
|
|
|
|
!controller->control.reset) {
|
2005-08-21 21:40:45 +04:00
|
|
|
// 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;
|
|
|
|
|
2006-02-07 00:27:34 +03:00
|
|
|
set_signature(channel, id);
|
2005-08-21 21:40:45 +04:00
|
|
|
}
|
|
|
|
}
|
2006-07-26 23:09:51 +04:00
|
|
|
BX_DEBUG(("ata%d: adapter control reg: disable irq = %d", channel,
|
2012-05-06 23:19:00 +04:00
|
|
|
(unsigned) (controller->control.disable_irq) ? 1 : 0));
|
2005-08-21 21:40:45 +04:00
|
|
|
break;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
default:
|
2001-05-30 22:56:02 +04:00
|
|
|
BX_PANIC(("hard drive: io write to address %x = %02x",
|
merge in BRANCH-io-cleanup.
To see the commit logs for this use either cvsweb or
cvs update -r BRANCH-io-cleanup and then 'cvs log' the various files.
In general this provides a generic interface for logging.
logfunctions:: is a class that is inherited by some classes, and also
. allocated as a standalone global called 'genlog'. All logging uses
. one of the ::info(), ::error(), ::ldebug(), ::panic() methods of this
. class through 'BX_INFO(), BX_ERROR(), BX_DEBUG(), BX_PANIC()' macros
. respectively.
.
. An example usage:
. BX_INFO(("Hello, World!\n"));
iofunctions:: is a class that is allocated once by default, and assigned
as the iofunction of each logfunctions instance. It is this class that
maintains the file descriptor and other output related code, at this
point using vfprintf(). At some future point, someone may choose to
write a gui 'console' for bochs to which messages would be redirected
simply by assigning a different iofunction class to the various logfunctions
objects.
More cleanup is coming, but this works for now. If you want to see alot
of debugging output, in main.cc, change onoff[LOGLEV_DEBUG]=0 to =1.
Comments, bugs, flames, to me: todd@fries.net
2001-05-15 18:49:57 +04:00
|
|
|
(unsigned) address, (unsigned) value));
|
2001-04-10 05:04:59 +04:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2003-03-03 02:59:12 +03:00
|
|
|
bx_bool BX_CPP_AttrRegparmN(2)
|
2006-11-18 14:51:07 +03:00
|
|
|
bx_hard_drive_c::calculate_logical_address(Bit8u channel, Bit64s *sector)
|
2001-04-10 05:04:59 +04:00
|
|
|
{
|
2006-11-18 14:51:07 +03:00
|
|
|
Bit64s logical_sector;
|
2005-11-06 11:21:38 +03:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
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;
|
2006-12-25 12:34:32 +03:00
|
|
|
} else {
|
2012-05-06 23:19:00 +04:00
|
|
|
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;
|
2006-12-25 12:34:32 +03:00
|
|
|
}
|
2005-11-06 11:21:38 +03:00
|
|
|
} else {
|
2012-05-06 23:19:00 +04:00
|
|
|
logical_sector = ((Bit32u)controller->cylinder_no * BX_SELECTED_DRIVE(channel).hdimage->heads *
|
2011-11-26 19:09:00 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).hdimage->spt) +
|
2012-05-06 23:19:00 +04:00
|
|
|
(Bit32u)(controller->head_no * BX_SELECTED_DRIVE(channel).hdimage->spt) +
|
|
|
|
(controller->sector_no - 1);
|
2005-11-06 11:21:38 +03:00
|
|
|
}
|
|
|
|
|
2011-04-02 17:19:52 +04:00
|
|
|
Bit64s sector_count = BX_SELECTED_DRIVE(channel).hdimage->hd_size / 512;
|
2005-11-06 11:21:38 +03:00
|
|
|
if (logical_sector >= sector_count) {
|
2014-02-24 00:06:02 +04:00
|
|
|
BX_ERROR (("logical address out of bounds ("FMT_LL"d/"FMT_LL"d) - aborting command", logical_sector, sector_count));
|
2005-11-06 11:21:38 +03:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
*sector = logical_sector;
|
|
|
|
return 1;
|
2001-04-10 05:04:59 +04:00
|
|
|
}
|
|
|
|
|
2011-04-02 17:19:52 +04:00
|
|
|
void BX_CPP_AttrRegparmN(2)
|
|
|
|
bx_hard_drive_c::increment_address(Bit8u channel, Bit64s *sector)
|
2001-04-10 05:04:59 +04:00
|
|
|
{
|
2012-05-06 23:19:00 +04:00
|
|
|
controller_t *controller = &BX_SELECTED_CONTROLLER(channel);
|
|
|
|
|
|
|
|
controller->sector_count--;
|
|
|
|
controller->num_sectors--;
|
2005-11-06 11:21:38 +03:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
if (controller->lba_mode) {
|
2011-04-02 17:19:52 +04:00
|
|
|
Bit64s logical_sector = *sector;
|
|
|
|
logical_sector++;
|
2012-05-06 23:19:00 +04:00
|
|
|
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);
|
2006-12-25 12:34:32 +03:00
|
|
|
} else {
|
2012-05-06 23:19:00 +04:00
|
|
|
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);
|
2006-12-25 12:34:32 +03:00
|
|
|
}
|
2014-02-24 00:06:02 +04:00
|
|
|
*sector = logical_sector;
|
2005-11-06 11:21:38 +03:00
|
|
|
} else {
|
2012-05-06 23:19:00 +04:00
|
|
|
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++;
|
2014-02-24 00:06:02 +04:00
|
|
|
if (controller->cylinder_no >= BX_SELECTED_DRIVE(channel).hdimage->cylinders) {
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->cylinder_no = BX_SELECTED_DRIVE(channel).hdimage->cylinders - 1;
|
2014-02-24 00:06:02 +04:00
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
}
|
2005-11-06 11:21:38 +03:00
|
|
|
}
|
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
}
|
|
|
|
|
2006-03-07 21:16:41 +03:00
|
|
|
void bx_hard_drive_c::identify_ATAPI_drive(Bit8u channel)
|
2001-04-10 05:04:59 +04:00
|
|
|
{
|
|
|
|
unsigned i;
|
2005-08-05 22:35:00 +04:00
|
|
|
char serial_number[21];
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2006-12-29 14:57:04 +03:00
|
|
|
memset(&BX_SELECTED_DRIVE(channel).id_drive, 0, 512);
|
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[0] = (2 << 14) | (5 << 8) | (1 << 7) | (2 << 5) | (0 << 0); // Removable CDROM, 50us response, 12 byte packets
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
for (i = 1; i <= 9; i++)
|
2011-10-01 01:02:09 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[i] = 0;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2005-08-05 22:35:00 +04:00
|
|
|
strcpy(serial_number, "BXCD00000 ");
|
2006-08-05 11:49:31 +04:00
|
|
|
serial_number[8] = BX_SELECTED_DRIVE(channel).device_num;
|
2001-04-10 05:04:59 +04:00
|
|
|
for (i = 0; i < 10; i++) {
|
2005-08-05 22:35:00 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[10+i] = (serial_number[i*2] << 8) |
|
|
|
|
serial_number[i*2 + 1];
|
2001-04-10 05:04:59 +04:00
|
|
|
}
|
|
|
|
|
|
|
|
for (i = 20; i <= 22; i++)
|
2011-10-01 01:02:09 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[i] = 0;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2001-11-12 06:34:45 +03:00
|
|
|
const char* firmware = "ALPHA1 ";
|
2001-04-10 05:04:59 +04:00
|
|
|
for (i = 0; i < strlen(firmware)/2; i++) {
|
2012-05-06 23:19:00 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[23+i] = (firmware[i*2] << 8) | firmware[i*2 + 1];
|
2001-04-10 05:04:59 +04:00
|
|
|
}
|
2001-06-08 00:52:26 +04:00
|
|
|
BX_ASSERT((23+i) == 27);
|
2008-01-27 01:24:03 +03:00
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
for (i = 0; i < strlen((char *) BX_SELECTED_MODEL(channel))/2; i++) {
|
2011-10-01 01:02:09 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[27+i] = (BX_SELECTED_MODEL(channel)[i*2] << 8) |
|
|
|
|
BX_SELECTED_MODEL(channel)[i*2 + 1];
|
2001-04-10 05:04:59 +04:00
|
|
|
}
|
2001-06-08 00:52:26 +04:00
|
|
|
BX_ASSERT((27+i) == 47);
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[47] = 0;
|
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[48] = 1; // 32 bits access
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2005-10-30 22:18:59 +03:00
|
|
|
if (BX_HD_THIS bmdma_present()) {
|
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[49] = (1<<9) | (1<<8); // LBA and DMA
|
|
|
|
} else {
|
2005-10-30 17:14:03 +03:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[49] = (1<<9); // LBA only supported
|
2005-10-30 22:18:59 +03:00
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[50] = 0;
|
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[51] = 0;
|
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[52] = 0;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[53] = 3; // words 64-70, 54-58 valid
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
for (i = 54; i <= 62; i++)
|
2008-03-29 20:44:13 +03:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[i] = 0;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2014-01-19 18:15:43 +04:00
|
|
|
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;
|
|
|
|
}
|
2002-09-23 00:56:12 +04:00
|
|
|
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;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
for (i = 76; i <= 79; i++)
|
2008-03-29 20:44:13 +03:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[i] = 0;
|
2002-09-23 00:56:12 +04:00
|
|
|
|
|
|
|
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;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2006-12-26 20:08:12 +03:00
|
|
|
BX_SELECTED_DRIVE(channel).identify_set = 1;
|
2001-04-10 05:04:59 +04:00
|
|
|
}
|
|
|
|
|
2006-03-07 21:16:41 +03:00
|
|
|
void bx_hard_drive_c::identify_drive(Bit8u channel)
|
2001-04-10 05:04:59 +04:00
|
|
|
{
|
|
|
|
unsigned i;
|
2005-08-05 22:35:00 +04:00
|
|
|
char serial_number[21];
|
2001-04-10 05:04:59 +04:00
|
|
|
Bit32u temp32;
|
2006-12-25 12:34:32 +03:00
|
|
|
Bit64u num_sects;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2006-12-29 14:57:04 +03:00
|
|
|
memset(&BX_SELECTED_DRIVE(channel).id_drive, 0, 512);
|
|
|
|
|
2001-04-10 05:04:59 +04:00
|
|
|
// 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
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[0] = 0x0040;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
// 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.
|
2010-12-22 00:47:41 +03:00
|
|
|
if (BX_SELECTED_DRIVE(channel).hdimage->cylinders > 16383) {
|
2006-12-18 20:56:05 +03:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[1] = 16383;
|
|
|
|
} else {
|
2010-12-22 00:47:41 +03:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[1] = BX_SELECTED_DRIVE(channel).hdimage->cylinders;
|
2006-12-18 20:56:05 +03:00
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
// Word 2: reserved
|
|
|
|
|
|
|
|
// Word 3: number of user-addressable heads in default
|
|
|
|
// translation mode
|
2010-12-22 00:47:41 +03:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[3] = BX_SELECTED_DRIVE(channel).hdimage->heads;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
// 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)"
|
2011-11-26 19:09:00 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[4] = (512 * BX_SELECTED_DRIVE(channel).hdimage->spt);
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[5] = 512;
|
2011-11-26 19:09:00 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[6] = BX_SELECTED_DRIVE(channel).hdimage->spt;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
// 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).
|
2005-08-05 22:35:00 +04:00
|
|
|
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];
|
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
// 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
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[20] = 3;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
// Word 21: buffer size in 512 byte increments, 0000h = not specified
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[21] = 512; // 512 Sectors = 256kB cache
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
// Word 22: # of ECC bytes available on read/write long cmds
|
|
|
|
// 0000h = not specified
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[22] = 4;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
// 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++)
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[i] = 0;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
// 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++) {
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[27+i] = (BX_SELECTED_MODEL(channel)[i*2] << 8) |
|
|
|
|
BX_SELECTED_MODEL(channel)[i*2 + 1];
|
2006-12-29 14:57:04 +03:00
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
// 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
|
2006-07-13 21:34:44 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[47] = MAX_MULTIPLE_SECTORS;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
// Word 48: 0000h = cannot perform dword IO
|
|
|
|
// 0001h = can perform dword IO
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[48] = 1;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
// Word 49: Capabilities
|
|
|
|
// 15-10: 0 = reserved
|
|
|
|
// 9: 1 = LBA supported
|
|
|
|
// 8: 1 = DMA supported
|
|
|
|
// 7-0: Vendor unique
|
2005-02-08 21:32:27 +03:00
|
|
|
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;
|
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
// Word 50: Reserved
|
|
|
|
|
|
|
|
// Word 51: 15-8 PIO data transfer cycle timing mode
|
|
|
|
// 7-0 Vendor unique
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[51] = 0x200;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
// Word 52: 15-8 DMA data transfer cycle timing mode
|
|
|
|
// 7-0 Vendor unique
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[52] = 0x200;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
// Word 53: 15-1 Reserved
|
2006-12-29 14:57:04 +03:00
|
|
|
// 2 1=the fields reported in word 88 are valid
|
|
|
|
// 1 1=the fields reported in words 64-70 are valid
|
2001-04-10 05:04:59 +04:00
|
|
|
// 0 1=the fields reported in words 54-58 are valid
|
2006-12-29 14:57:04 +03:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[53] = 0x07;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
// 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
|
2010-12-22 00:47:41 +03:00
|
|
|
if (BX_SELECTED_DRIVE(channel).hdimage->cylinders > 16383) {
|
2007-10-08 23:33:08 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[54] = 16383;
|
|
|
|
} else {
|
2010-12-22 00:47:41 +03:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[54] = BX_SELECTED_DRIVE(channel).hdimage->cylinders;
|
2007-10-08 23:33:08 +04:00
|
|
|
}
|
2010-12-22 00:47:41 +03:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[55] = BX_SELECTED_DRIVE(channel).hdimage->heads;
|
2011-11-26 19:09:00 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[56] = BX_SELECTED_DRIVE(channel).hdimage->spt;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
// Word 57-58: Current capacity in sectors
|
|
|
|
// Excludes all sectors used for device specific purposes.
|
2008-01-27 01:24:03 +03:00
|
|
|
temp32 =
|
2010-12-22 00:47:41 +03:00
|
|
|
BX_SELECTED_DRIVE(channel).hdimage->cylinders *
|
|
|
|
BX_SELECTED_DRIVE(channel).hdimage->heads *
|
2011-11-26 19:09:00 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).hdimage->spt;
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[57] = (temp32 & 0xffff); // LSW
|
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[58] = (temp32 >> 16); // MSW
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
// 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
|
2006-07-13 21:34:44 +04:00
|
|
|
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;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
// 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.
|
2010-12-22 00:47:41 +03:00
|
|
|
if (BX_SELECTED_DRIVE(channel).hdimage->hd_size > 0)
|
|
|
|
num_sects = (BX_SELECTED_DRIVE(channel).hdimage->hd_size >> 9);
|
2006-12-25 12:34:32 +03:00
|
|
|
else
|
2011-11-26 19:09:00 +04:00
|
|
|
num_sects = BX_SELECTED_DRIVE(channel).hdimage->cylinders * BX_SELECTED_DRIVE(channel).hdimage->heads * BX_SELECTED_DRIVE(channel).hdimage->spt;
|
2006-12-25 12:34:32 +03:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[60] = (Bit16u)(num_sects & 0xffff); // LSW
|
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[61] = (Bit16u)(num_sects >> 16); // MSW
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
// 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.
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[62] = 0x0;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
// 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.
|
2005-02-08 21:32:27 +03:00
|
|
|
if (BX_HD_THIS bmdma_present()) {
|
2006-07-19 23:18:42 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[63] = 0x07 | (BX_SELECTED_CONTROLLER(channel).mdma_mode << 8);
|
2005-02-08 21:32:27 +03:00
|
|
|
} else {
|
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[63] = 0x0;
|
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2006-12-29 14:57:04 +03:00
|
|
|
// 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
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
// Word 80: 15-5 reserved
|
2006-12-29 14:57:04 +03:00
|
|
|
// 6 supports ATA/ATAPI-6
|
|
|
|
// 5 supports ATA/ATAPI-5
|
2001-04-10 05:04:59 +04:00
|
|
|
// 4 supports ATA/ATAPI-4
|
|
|
|
// 3 supports ATA-3
|
|
|
|
// 2 supports ATA-2
|
|
|
|
// 1 supports ATA-1
|
|
|
|
// 0 reserved
|
2006-12-29 14:57:04 +03:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[80] = 0x7e;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
// Word 81: Minor version number
|
2006-12-29 14:57:04 +03:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[81] = 0x00;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
|
|
|
// 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
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[82] = 1 << 14;
|
2006-12-25 12:34:32 +03:00
|
|
|
|
|
|
|
// 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
|
2006-12-26 20:08:12 +03:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[83] = (1 << 14) | (1 << 13) | (1 << 12) | (1 << 10);
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[84] = 1 << 14;
|
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[85] = 1 << 14;
|
2006-12-25 12:34:32 +03:00
|
|
|
|
|
|
|
// 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
|
2006-12-26 20:08:12 +03:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[86] = (1 << 14) | (1 << 13) | (1 << 12) | (1 << 10);
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).id_drive[87] = 1 << 14;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2006-12-29 14:57:04 +03:00
|
|
|
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;
|
2006-12-25 12:34:32 +03:00
|
|
|
|
|
|
|
// 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);
|
|
|
|
|
2001-04-10 05:04:59 +04:00
|
|
|
// Word 128-159 Vendor unique
|
|
|
|
// Word 160-255 Reserved
|
|
|
|
|
2006-12-26 20:08:12 +03:00
|
|
|
BX_SELECTED_DRIVE(channel).identify_set = 1;
|
2001-04-10 05:04:59 +04:00
|
|
|
}
|
|
|
|
|
2008-01-27 01:24:03 +03:00
|
|
|
void bx_hard_drive_c::init_send_atapi_command(Bit8u channel, Bit8u command, int req_length, int alloc_length, bx_bool lazy)
|
2001-04-10 05:04:59 +04:00
|
|
|
{
|
2012-05-06 23:19:00 +04:00
|
|
|
controller_t *controller = &BX_SELECTED_CONTROLLER(channel);
|
|
|
|
|
|
|
|
// byte_count is a union of cylinder_no;
|
2007-11-13 00:04:17 +03:00
|
|
|
// lazy is used to force a data read in the buffer at the next read.
|
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
if (controller->byte_count == 0xffff)
|
|
|
|
controller->byte_count = 0xfffe;
|
2007-11-13 00:04:17 +03:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
if ((controller->byte_count & 1) &&
|
|
|
|
!(alloc_length <= controller->byte_count))
|
2007-11-13 00:04:17 +03:00
|
|
|
{
|
2008-01-27 01:24:03 +03:00
|
|
|
BX_INFO(("Odd byte count (0x%04x) to ATAPI command 0x%02x, using 0x%04x",
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->byte_count, command, controller->byte_count - 1));
|
|
|
|
controller->byte_count--;
|
2007-11-13 00:04:17 +03:00
|
|
|
}
|
2002-08-05 19:47:40 +04:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
if (!controller->packet_dma) {
|
|
|
|
if (controller->byte_count == 0)
|
2008-07-06 18:15:41 +04:00
|
|
|
BX_PANIC(("ATAPI command 0x%02x with zero byte count", command));
|
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2007-11-13 00:04:17 +03:00
|
|
|
if (alloc_length < 0)
|
|
|
|
BX_PANIC(("Allocation length < 0"));
|
|
|
|
if (alloc_length == 0)
|
2012-05-06 23:19:00 +04:00
|
|
|
alloc_length = controller->byte_count;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2014-01-19 18:15:43 +04:00
|
|
|
controller->status.busy = 1;
|
|
|
|
controller->status.drive_ready = 1;
|
|
|
|
controller->status.drq = 0;
|
|
|
|
controller->status.err = 0;
|
|
|
|
|
2007-11-13 00:04:17 +03:00
|
|
|
// no bytes transfered yet
|
|
|
|
if (lazy)
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer_index = controller->buffer_size;
|
2007-11-13 00:04:17 +03:00
|
|
|
else
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer_index = 0;
|
|
|
|
controller->drq_index = 0;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
if (controller->byte_count > req_length)
|
|
|
|
controller->byte_count = req_length;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
if (controller->byte_count > alloc_length)
|
|
|
|
controller->byte_count = alloc_length;
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2007-11-13 00:04:17 +03:00
|
|
|
BX_SELECTED_DRIVE(channel).atapi.command = command;
|
2012-05-06 23:19:00 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).atapi.drq_bytes = controller->byte_count;
|
2007-11-13 00:04:17 +03:00
|
|
|
BX_SELECTED_DRIVE(channel).atapi.total_bytes_remaining = (req_length < alloc_length) ? req_length : alloc_length;
|
2001-04-10 05:04:59 +04:00
|
|
|
}
|
|
|
|
|
2006-03-07 21:16:41 +03:00
|
|
|
void bx_hard_drive_c::atapi_cmd_error(Bit8u channel, sense_t sense_key, asc_t asc, bx_bool show)
|
2001-04-10 05:04:59 +04:00
|
|
|
{
|
2005-05-04 22:19:49 +04:00
|
|
|
if (show) {
|
2005-11-01 22:10:24 +03:00
|
|
|
BX_ERROR(("ata%d-%d: atapi_cmd_error: key=%02x asc=%02x", channel, BX_SLAVE_SELECTED(channel), sense_key, asc));
|
2005-05-04 22:19:49 +04:00
|
|
|
} else {
|
2005-11-01 22:10:24 +03:00
|
|
|
BX_DEBUG(("ata%d-%d: atapi_cmd_error: key=%02x asc=%02x", channel, BX_SLAVE_SELECTED(channel), sense_key, asc));
|
2005-05-04 22:19:49 +04:00
|
|
|
}
|
2002-09-23 00:56:12 +04:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
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;
|
2005-05-04 22:19:49 +04:00
|
|
|
|
|
|
|
BX_SELECTED_DRIVE(channel).sense.sense_key = sense_key;
|
|
|
|
BX_SELECTED_DRIVE(channel).sense.asc = asc;
|
|
|
|
BX_SELECTED_DRIVE(channel).sense.ascq = 0;
|
2001-04-10 05:04:59 +04:00
|
|
|
}
|
|
|
|
|
2006-03-07 21:16:41 +03:00
|
|
|
void BX_CPP_AttrRegparmN(1)
|
2012-05-06 23:19:00 +04:00
|
|
|
bx_hard_drive_c::atapi_cmd_nop(controller_t *controller)
|
2001-04-10 05:04:59 +04:00
|
|
|
{
|
2012-05-06 23:19:00 +04:00
|
|
|
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;
|
2001-04-10 05:04:59 +04:00
|
|
|
}
|
|
|
|
|
2006-03-07 21:16:41 +03:00
|
|
|
void bx_hard_drive_c::init_mode_sense_single(Bit8u channel, const void* src, int size)
|
2001-04-10 05:04:59 +04:00
|
|
|
{
|
2012-05-06 23:19:00 +04:00
|
|
|
controller_t *controller = &BX_SELECTED_CONTROLLER(channel);
|
|
|
|
|
2006-02-26 22:11:20 +03:00
|
|
|
// Header
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer[0] = (size+6) >> 8;
|
|
|
|
controller->buffer[1] = (size+6) & 0xff;
|
2008-07-07 22:36:07 +04:00
|
|
|
if (BX_SELECTED_DRIVE(channel).cdrom.ready)
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer[2] = 0x12; // media present 120mm CD-ROM (CD-R) data/audio door closed
|
2006-02-26 22:11:20 +03:00
|
|
|
else
|
2012-05-06 23:19:00 +04:00
|
|
|
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
|
2006-02-26 22:11:20 +03:00
|
|
|
|
|
|
|
// Data
|
2012-05-06 23:19:00 +04:00
|
|
|
memcpy(controller->buffer + 8, src, size);
|
2001-04-10 05:04:59 +04:00
|
|
|
}
|
|
|
|
|
2003-03-03 02:59:12 +03:00
|
|
|
void BX_CPP_AttrRegparmN(1)
|
2002-09-23 00:56:12 +04:00
|
|
|
bx_hard_drive_c::ready_to_send_atapi(Bit8u channel)
|
2001-04-10 05:04:59 +04:00
|
|
|
{
|
2014-01-18 20:16:42 +04:00
|
|
|
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;
|
|
|
|
|
2014-01-19 22:13:12 +04:00
|
|
|
if (BX_SELECTED_CONTROLLER(channel).packet_dma) {
|
|
|
|
DEV_ide_bmdma_start_transfer(channel);
|
|
|
|
} else {
|
2008-07-06 18:15:41 +04:00
|
|
|
raise_interrupt(channel);
|
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
}
|
|
|
|
|
2008-03-29 20:44:13 +03:00
|
|
|
void BX_CPP_AttrRegparmN(1)
|
2002-09-23 00:56:12 +04:00
|
|
|
bx_hard_drive_c::raise_interrupt(Bit8u channel)
|
2001-04-10 05:04:59 +04:00
|
|
|
{
|
2008-03-29 20:44:13 +03:00
|
|
|
if (!BX_SELECTED_CONTROLLER(channel).control.disable_irq) {
|
|
|
|
Bit32u irq = BX_HD_THIS channels[channel].irq;
|
2009-04-25 12:06:32 +04:00
|
|
|
BX_DEBUG(("raising interrupt %d {%s}", irq, BX_SELECTED_TYPE_STRING(channel)));
|
2005-09-05 22:32:23 +04:00
|
|
|
#if BX_SUPPORT_PCI
|
2008-03-29 20:44:13 +03:00
|
|
|
DEV_ide_bmdma_set_irq(channel);
|
2005-09-05 22:32:23 +04:00
|
|
|
#endif
|
2008-03-29 20:44:13 +03:00
|
|
|
DEV_pic_raise_irq(irq);
|
|
|
|
} else {
|
2009-04-25 12:06:32 +04:00
|
|
|
BX_DEBUG(("not raising interrupt {%s}", BX_SELECTED_TYPE_STRING(channel)));
|
2008-03-29 20:44:13 +03:00
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
}
|
|
|
|
|
2006-03-07 21:16:41 +03:00
|
|
|
void bx_hard_drive_c::command_aborted(Bit8u channel, unsigned value)
|
2002-09-23 00:56:12 +04:00
|
|
|
{
|
2012-05-06 23:19:00 +04:00
|
|
|
controller_t *controller = &BX_SELECTED_CONTROLLER(channel);
|
|
|
|
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_DEBUG(("aborting on command 0x%02x {%s}", value, BX_SELECTED_TYPE_STRING(channel)));
|
2012-05-06 23:19:00 +04:00
|
|
|
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;
|
2002-09-23 00:56:12 +04:00
|
|
|
raise_interrupt(channel);
|
|
|
|
}
|
|
|
|
|
2006-03-07 21:16:41 +03:00
|
|
|
Bit32u bx_hard_drive_c::get_first_cd_handle(void)
|
2002-09-23 00:56:12 +04:00
|
|
|
{
|
|
|
|
for (Bit8u channel=0; channel<BX_MAX_ATA_CHANNEL; channel++) {
|
2008-03-29 20:44:13 +03:00
|
|
|
if (BX_DRIVE_IS_CD(channel,0)) return (channel*2);
|
2002-09-23 00:56:12 +04:00
|
|
|
if (BX_DRIVE_IS_CD(channel,1)) return ((channel*2) + 1);
|
2006-03-07 21:16:41 +03:00
|
|
|
}
|
2002-09-23 00:56:12 +04:00
|
|
|
return BX_MAX_ATA_CHANNEL*2;
|
2001-04-10 05:04:59 +04:00
|
|
|
}
|
|
|
|
|
2011-06-13 13:32:39 +04:00
|
|
|
bx_bool bx_hard_drive_c::get_cd_media_status(Bit32u handle)
|
2002-02-01 19:46:27 +03:00
|
|
|
{
|
2006-03-07 21:16:41 +03:00
|
|
|
if (handle >= BX_MAX_ATA_CHANNEL*2) return 0;
|
2002-09-23 00:56:12 +04:00
|
|
|
|
|
|
|
Bit8u channel = handle / 2;
|
|
|
|
Bit8u device = handle % 2;
|
2008-02-16 01:05:43 +03:00
|
|
|
return BX_HD_THIS channels[channel].drives[device].cdrom.ready;
|
2002-02-01 19:46:27 +03:00
|
|
|
}
|
|
|
|
|
2011-06-13 13:32:39 +04:00
|
|
|
bx_bool bx_hard_drive_c::set_cd_media_status(Bit32u handle, bx_bool status)
|
2002-02-01 19:46:27 +03:00
|
|
|
{
|
2006-02-26 22:11:20 +03:00
|
|
|
char ata_name[20];
|
|
|
|
|
2011-07-24 18:11:10 +04:00
|
|
|
BX_DEBUG(("set_cd_media_status handle=%d status=%d", handle, status));
|
2008-02-16 01:05:43 +03:00
|
|
|
if (handle >= BX_MAX_ATA_CHANNEL*2) return 0;
|
2002-09-23 00:56:12 +04:00
|
|
|
|
|
|
|
Bit8u channel = handle / 2;
|
|
|
|
Bit8u device = handle % 2;
|
|
|
|
|
2006-02-26 22:11:20 +03:00
|
|
|
sprintf(ata_name, "ata.%d.%s", channel, (device==0)?"master":"slave");
|
|
|
|
bx_list_c *base = (bx_list_c*) SIM->get_param(ata_name);
|
2002-02-01 19:46:27 +03:00
|
|
|
// if setting to the current value, nothing to do
|
2002-09-23 00:56:12 +04:00
|
|
|
if (status == BX_HD_THIS channels[channel].drives[device].cdrom.ready)
|
2002-02-01 19:46:27 +03:00
|
|
|
return(status);
|
2011-07-24 18:11:10 +04:00
|
|
|
// return 0 if selected drive is not a cdrom
|
2002-09-23 00:56:12 +04:00
|
|
|
if (!BX_DRIVE_IS_CD(channel,device))
|
2002-02-01 19:46:27 +03:00
|
|
|
return(0);
|
|
|
|
|
|
|
|
if (status == 0) {
|
|
|
|
// eject cdrom if not locked by guest OS
|
2013-11-10 15:14:42 +04:00
|
|
|
if (!BX_HD_THIS channels[channel].drives[device].cdrom.locked) {
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_HD_THIS channels[channel].drives[device].cdrom.cd->eject_cdrom();
|
|
|
|
BX_HD_THIS channels[channel].drives[device].cdrom.ready = 0;
|
2013-01-22 22:26:49 +04:00
|
|
|
SIM->get_param_enum("status", base)->set(BX_EJECTED);
|
2013-11-10 15:14:42 +04:00
|
|
|
} else {
|
|
|
|
return(1);
|
2006-02-26 22:11:20 +03:00
|
|
|
}
|
2005-11-01 22:10:24 +03:00
|
|
|
} else {
|
2002-02-01 19:46:27 +03:00
|
|
|
// insert cdrom
|
2006-02-26 22:11:20 +03:00
|
|
|
if (BX_HD_THIS channels[channel].drives[device].cdrom.cd->insert_cdrom(SIM->get_param_string("path", base)->getptr())) {
|
2008-02-16 01:05:43 +03:00
|
|
|
BX_INFO(("Media present in CD-ROM drive"));
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_HD_THIS channels[channel].drives[device].cdrom.ready = 1;
|
2005-11-01 22:10:24 +03:00
|
|
|
Bit32u capacity = BX_HD_THIS channels[channel].drives[device].cdrom.cd->capacity();
|
2014-02-10 00:28:42 +04:00
|
|
|
BX_HD_THIS channels[channel].drives[device].cdrom.max_lba = capacity - 1;
|
2014-02-14 22:27:36 +04:00
|
|
|
BX_HD_THIS channels[channel].drives[device].cdrom.curr_lba = capacity - 1;
|
2005-11-01 22:10:24 +03:00
|
|
|
BX_INFO(("Capacity is %d sectors (%.2f MB)", capacity, (float)capacity / 512.0));
|
2013-01-22 22:26:49 +04:00
|
|
|
SIM->get_param_enum("status", base)->set(BX_INSERTED);
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).sense.sense_key = SENSE_UNIT_ATTENTION;
|
2009-04-21 14:18:42 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).sense.asc = ASC_MEDIUM_MAY_HAVE_CHANGED;
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).sense.ascq = 0;
|
|
|
|
raise_interrupt(channel);
|
2013-11-10 15:14:42 +04:00
|
|
|
} else {
|
2008-02-16 01:05:43 +03:00
|
|
|
BX_INFO(("Could not locate CD-ROM, continuing with media not present"));
|
2002-09-23 00:56:12 +04:00
|
|
|
BX_HD_THIS channels[channel].drives[device].cdrom.ready = 0;
|
2013-01-22 22:26:49 +04:00
|
|
|
SIM->get_param_enum("status", base)->set(BX_EJECTED);
|
2002-02-01 19:46:27 +03:00
|
|
|
}
|
2005-11-01 22:10:24 +03:00
|
|
|
}
|
|
|
|
return (BX_HD_THIS channels[channel].drives[device].cdrom.ready);
|
2002-02-01 19:46:27 +03:00
|
|
|
}
|
|
|
|
|
2006-03-07 21:16:41 +03:00
|
|
|
bx_bool bx_hard_drive_c::bmdma_present(void)
|
2005-02-08 21:32:27 +03:00
|
|
|
{
|
|
|
|
#if BX_SUPPORT_PCI
|
2012-01-20 19:56:17 +04:00
|
|
|
if (BX_HD_THIS pci_enabled) {
|
2005-02-08 21:32:27 +03:00
|
|
|
return DEV_ide_bmdma_present();
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
#if BX_SUPPORT_PCI
|
2006-03-07 21:16:41 +03:00
|
|
|
bx_bool bx_hard_drive_c::bmdma_read_sector(Bit8u channel, Bit8u *buffer, Bit32u *sector_size)
|
2005-02-08 21:32:27 +03:00
|
|
|
{
|
2012-05-06 23:19:00 +04:00
|
|
|
controller_t *controller = &BX_SELECTED_CONTROLLER(channel);
|
|
|
|
|
|
|
|
if ((controller->current_command == 0xC8) ||
|
|
|
|
(controller->current_command == 0x25)) {
|
2005-10-30 17:14:03 +03:00
|
|
|
*sector_size = 512;
|
2006-07-17 22:40:26 +04:00
|
|
|
if (!ide_read_sector(channel, buffer, 512)) {
|
2005-10-30 17:14:03 +03:00
|
|
|
return 0;
|
|
|
|
}
|
2012-05-06 23:19:00 +04:00
|
|
|
} else if (controller->current_command == 0xA0) {
|
|
|
|
if (controller->packet_dma) {
|
2008-07-06 18:15:41 +04:00
|
|
|
switch (BX_SELECTED_DRIVE(channel).atapi.command) {
|
|
|
|
case 0x28: // read (10)
|
|
|
|
case 0xa8: // read (12)
|
|
|
|
case 0xbe: // read cd
|
2012-05-06 23:19:00 +04:00
|
|
|
*sector_size = controller->buffer_size;
|
2008-07-06 18:15:41 +04:00
|
|
|
if (!BX_SELECTED_DRIVE(channel).cdrom.ready) {
|
|
|
|
BX_PANIC(("Read with CDROM not ready"));
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
/* set status bar conditions for device */
|
2011-12-28 15:51:42 +04:00
|
|
|
bx_gui->statusbar_setitem(BX_SELECTED_DRIVE(channel).statusbar_id, 1);
|
2008-07-06 18:15:41 +04:00
|
|
|
if (!BX_SELECTED_DRIVE(channel).cdrom.cd->read_block(buffer, BX_SELECTED_DRIVE(channel).cdrom.next_lba,
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->buffer_size))
|
2008-07-06 18:15:41 +04:00
|
|
|
{
|
|
|
|
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--;
|
2014-02-14 22:27:36 +04:00
|
|
|
if (!BX_SELECTED_DRIVE(channel).cdrom.remaining_blocks) {
|
|
|
|
BX_SELECTED_DRIVE(channel).cdrom.curr_lba = BX_SELECTED_DRIVE(channel).cdrom.next_lba;
|
|
|
|
}
|
2008-07-06 18:15:41 +04:00
|
|
|
break;
|
|
|
|
default:
|
2012-05-06 23:19:00 +04:00
|
|
|
memcpy(buffer, controller->buffer, *sector_size);
|
2008-07-06 18:15:41 +04:00
|
|
|
break;
|
2005-10-30 17:14:03 +03:00
|
|
|
}
|
|
|
|
} else {
|
|
|
|
BX_ERROR(("PACKET-DMA not active"));
|
2012-05-06 23:19:00 +04:00
|
|
|
command_aborted(channel, controller->current_command);
|
2005-10-30 17:14:03 +03:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
BX_ERROR(("DMA read not active"));
|
2014-01-19 22:13:12 +04:00
|
|
|
command_aborted(channel, controller->current_command);
|
2005-02-08 21:32:27 +03:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
return 1;
|
|
|
|
}
|
|
|
|
|
2006-03-07 21:16:41 +03:00
|
|
|
bx_bool bx_hard_drive_c::bmdma_write_sector(Bit8u channel, Bit8u *buffer)
|
2005-02-08 21:32:27 +03:00
|
|
|
{
|
2012-05-06 23:19:00 +04:00
|
|
|
controller_t *controller = &BX_SELECTED_CONTROLLER(channel);
|
|
|
|
|
|
|
|
if ((controller->current_command != 0xCA) &&
|
|
|
|
(controller->current_command != 0x35)) {
|
2006-12-25 12:34:32 +03:00
|
|
|
BX_ERROR(("DMA write not active"));
|
2012-05-06 23:19:00 +04:00
|
|
|
command_aborted (channel, controller->current_command);
|
2005-02-08 21:32:27 +03:00
|
|
|
return 0;
|
|
|
|
}
|
2006-07-17 22:40:26 +04:00
|
|
|
if (!ide_write_sector(channel, buffer, 512)) {
|
2005-02-08 21:32:27 +03:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
return 1;
|
|
|
|
}
|
|
|
|
|
2006-03-07 21:16:41 +03:00
|
|
|
void bx_hard_drive_c::bmdma_complete(Bit8u channel)
|
2005-02-08 21:32:27 +03:00
|
|
|
{
|
2012-05-06 23:19:00 +04:00
|
|
|
controller_t *controller = &BX_SELECTED_CONTROLLER(channel);
|
|
|
|
|
|
|
|
controller->status.busy = 0;
|
|
|
|
controller->status.drive_ready = 1;
|
|
|
|
controller->status.drq = 0;
|
|
|
|
controller->status.err = 0;
|
2005-10-30 17:14:03 +03:00
|
|
|
if (BX_SELECTED_IS_CD(channel)) {
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->interrupt_reason.i_o = 1;
|
|
|
|
controller->interrupt_reason.c_d = 1;
|
|
|
|
controller->interrupt_reason.rel = 0;
|
2005-10-30 17:14:03 +03:00
|
|
|
} else {
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->status.write_fault = 0;
|
|
|
|
controller->status.seek_complete = 1;
|
|
|
|
controller->status.corrected_data = 0;
|
2014-02-24 00:06:02 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).last_lsector = BX_SELECTED_DRIVE(channel).curr_lsector;
|
2005-10-30 17:14:03 +03:00
|
|
|
}
|
2005-02-08 21:32:27 +03:00
|
|
|
raise_interrupt(channel);
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
|
2006-02-07 00:27:34 +03:00
|
|
|
void bx_hard_drive_c::set_signature(Bit8u channel, Bit8u id)
|
2005-08-21 21:40:45 +04:00
|
|
|
{
|
|
|
|
// Device signature
|
2006-02-07 00:27:34 +03:00
|
|
|
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;
|
2007-08-04 21:01:04 +04:00
|
|
|
BX_HD_THIS channels[channel].drive_select = 0;
|
2006-02-07 00:27:34 +03:00
|
|
|
} else if (BX_DRIVE_IS_CD(channel,id)) {
|
|
|
|
BX_CONTROLLER(channel,id).cylinder_no = 0xeb14;
|
2005-08-21 21:40:45 +04:00
|
|
|
} else {
|
2006-02-07 00:27:34 +03:00
|
|
|
BX_CONTROLLER(channel,id).cylinder_no = 0xffff;
|
2005-08-21 21:40:45 +04:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2006-07-17 22:40:26 +04:00
|
|
|
bx_bool bx_hard_drive_c::ide_read_sector(Bit8u channel, Bit8u *buffer, Bit32u buffer_size)
|
|
|
|
{
|
2012-05-06 23:19:00 +04:00
|
|
|
controller_t *controller = &BX_SELECTED_CONTROLLER(channel);
|
|
|
|
|
2008-12-11 21:01:56 +03:00
|
|
|
Bit64s logical_sector = 0;
|
2006-11-18 14:51:07 +03:00
|
|
|
Bit64s ret;
|
2006-07-17 22:40:26 +04:00
|
|
|
|
|
|
|
int sector_count = (buffer_size / 512);
|
|
|
|
Bit8u *bufptr = buffer;
|
|
|
|
do {
|
|
|
|
if (!calculate_logical_address(channel, &logical_sector)) {
|
2012-05-06 23:19:00 +04:00
|
|
|
command_aborted(channel, controller->current_command);
|
2006-07-17 22:40:26 +04:00
|
|
|
return 0;
|
|
|
|
}
|
2010-12-22 00:47:41 +03:00
|
|
|
ret = BX_SELECTED_DRIVE(channel).hdimage->lseek(logical_sector * 512, SEEK_SET);
|
2006-07-17 22:40:26 +04:00
|
|
|
if (ret < 0) {
|
|
|
|
BX_ERROR(("could not lseek() hard drive image file"));
|
2012-05-06 23:19:00 +04:00
|
|
|
command_aborted(channel, controller->current_command);
|
2006-07-17 22:40:26 +04:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
/* set status bar conditions for device */
|
2011-12-28 15:51:42 +04:00
|
|
|
bx_gui->statusbar_setitem(BX_SELECTED_DRIVE(channel).statusbar_id, 1);
|
2010-12-22 00:47:41 +03:00
|
|
|
ret = BX_SELECTED_DRIVE(channel).hdimage->read((bx_ptr_t)bufptr, 512);
|
2006-07-17 22:40:26 +04:00
|
|
|
if (ret < 512) {
|
|
|
|
BX_ERROR(("could not read() hard drive image file at byte %lu", (unsigned long)logical_sector*512));
|
2012-05-06 23:19:00 +04:00
|
|
|
command_aborted(channel, controller->current_command);
|
2006-07-17 22:40:26 +04:00
|
|
|
return 0;
|
|
|
|
}
|
2011-04-02 17:19:52 +04:00
|
|
|
increment_address(channel, &logical_sector);
|
2014-02-24 00:06:02 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).curr_lsector = logical_sector;
|
2006-07-17 22:40:26 +04:00
|
|
|
bufptr += 512;
|
|
|
|
} while (--sector_count > 0);
|
2008-03-29 20:44:13 +03:00
|
|
|
|
2006-07-17 22:40:26 +04:00
|
|
|
return 1;
|
|
|
|
}
|
|
|
|
|
|
|
|
bx_bool bx_hard_drive_c::ide_write_sector(Bit8u channel, Bit8u *buffer, Bit32u buffer_size)
|
|
|
|
{
|
2012-05-06 23:19:00 +04:00
|
|
|
controller_t *controller = &BX_SELECTED_CONTROLLER(channel);
|
|
|
|
|
2008-12-11 21:01:56 +03:00
|
|
|
Bit64s logical_sector = 0;
|
2006-11-18 14:51:07 +03:00
|
|
|
Bit64s ret;
|
2006-07-17 22:40:26 +04:00
|
|
|
|
|
|
|
int sector_count = (buffer_size / 512);
|
|
|
|
Bit8u *bufptr = buffer;
|
|
|
|
do {
|
|
|
|
if (!calculate_logical_address(channel, &logical_sector)) {
|
2012-05-06 23:19:00 +04:00
|
|
|
command_aborted(channel, controller->current_command);
|
2006-07-17 22:40:26 +04:00
|
|
|
return 0;
|
|
|
|
}
|
2010-12-22 00:47:41 +03:00
|
|
|
ret = BX_SELECTED_DRIVE(channel).hdimage->lseek(logical_sector * 512, SEEK_SET);
|
2006-07-17 22:40:26 +04:00
|
|
|
if (ret < 0) {
|
|
|
|
BX_ERROR(("could not lseek() hard drive image file at byte %lu", (unsigned long)logical_sector * 512));
|
2012-05-06 23:19:00 +04:00
|
|
|
command_aborted(channel, controller->current_command);
|
2006-07-17 22:40:26 +04:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
/* set status bar conditions for device */
|
2011-12-28 15:51:42 +04:00
|
|
|
bx_gui->statusbar_setitem(BX_SELECTED_DRIVE(channel).statusbar_id, 1, 1 /* write */);
|
2010-12-22 00:47:41 +03:00
|
|
|
ret = BX_SELECTED_DRIVE(channel).hdimage->write((bx_ptr_t)bufptr, 512);
|
2006-07-17 22:40:26 +04:00
|
|
|
if (ret < 512) {
|
|
|
|
BX_ERROR(("could not write() hard drive image file at byte %lu", (unsigned long)logical_sector*512));
|
2012-05-06 23:19:00 +04:00
|
|
|
command_aborted(channel, controller->current_command);
|
2006-07-17 22:40:26 +04:00
|
|
|
return 0;
|
|
|
|
}
|
2011-04-02 17:19:52 +04:00
|
|
|
increment_address(channel, &logical_sector);
|
2014-02-24 00:06:02 +04:00
|
|
|
BX_SELECTED_DRIVE(channel).curr_lsector = logical_sector;
|
2006-07-17 22:40:26 +04:00
|
|
|
bufptr += 512;
|
|
|
|
} while (--sector_count > 0);
|
2008-03-29 20:44:13 +03:00
|
|
|
|
2006-07-17 22:40:26 +04:00
|
|
|
return 1;
|
|
|
|
}
|
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
void bx_hard_drive_c::lba48_transform(controller_t *controller, bx_bool lba48)
|
2006-12-25 12:34:32 +03:00
|
|
|
{
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->lba48 = lba48;
|
2006-12-25 12:34:32 +03:00
|
|
|
|
2012-05-06 23:19:00 +04:00
|
|
|
if (!controller->lba48) {
|
|
|
|
if (!controller->sector_count)
|
|
|
|
controller->num_sectors = 256;
|
2006-12-25 12:34:32 +03:00
|
|
|
else
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->num_sectors = controller->sector_count;
|
2006-12-25 12:34:32 +03:00
|
|
|
} else {
|
2012-05-06 23:19:00 +04:00
|
|
|
if (!controller->sector_count && !controller->hob.nsector)
|
|
|
|
controller->num_sectors = 65536;
|
2006-12-25 12:34:32 +03:00
|
|
|
else
|
2012-05-06 23:19:00 +04:00
|
|
|
controller->num_sectors = (controller->hob.nsector << 8) |
|
|
|
|
controller->sector_count;
|
2006-12-25 12:34:32 +03:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2014-02-14 22:27:36 +04:00
|
|
|
void bx_hard_drive_c::start_seek(Bit8u channel)
|
|
|
|
{
|
2014-02-23 12:49:44 +04:00
|
|
|
Bit64s new_pos, prev_pos, max_pos;
|
|
|
|
Bit32u seek_time;
|
2014-02-24 00:06:02 +04:00
|
|
|
double fSeekBase, fSeekTime;
|
2014-02-14 22:27:36 +04:00
|
|
|
|
|
|
|
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;
|
2014-02-24 00:06:02 +04:00
|
|
|
fSeekBase = 80000.0;
|
2014-02-14 22:27:36 +04:00
|
|
|
} else {
|
2014-02-24 00:06:02 +04:00
|
|
|
max_pos = (BX_SELECTED_DRIVE(channel).hdimage->hd_size / 512) - 1;
|
|
|
|
prev_pos = BX_SELECTED_DRIVE(channel).last_lsector;
|
|
|
|
new_pos = BX_SELECTED_DRIVE(channel).next_lsector;
|
|
|
|
fSeekBase = 5000.0;
|
2014-02-14 22:27:36 +04:00
|
|
|
}
|
2014-02-24 00:06:02 +04:00
|
|
|
fSeekTime = fSeekBase * (double)abs((int)(new_pos - prev_pos + 1)) / (max_pos + 1);
|
2014-02-14 22:27:36 +04:00
|
|
|
seek_time = (fSeekTime > 10.0) ? (Bit32u)fSeekTime : 10;
|
|
|
|
bx_pc_system.activate_timer(
|
|
|
|
BX_SELECTED_DRIVE(channel).seek_timer_index, seek_time, 0);
|
|
|
|
}
|
|
|
|
|
2006-07-17 22:40:26 +04:00
|
|
|
error_recovery_t::error_recovery_t()
|
2001-04-10 05:04:59 +04:00
|
|
|
{
|
2006-03-07 21:16:41 +03:00
|
|
|
if (sizeof(error_recovery_t) != 8) {
|
|
|
|
BX_PANIC(("error_recovery_t has size != 8"));
|
|
|
|
}
|
2001-04-10 05:04:59 +04:00
|
|
|
|
2006-03-07 21:16:41 +03:00
|
|
|
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;
|
2001-04-10 05:04:59 +04:00
|
|
|
}
|
2011-06-13 13:32:39 +04:00
|
|
|
|
|
|
|
// 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)) {
|
2011-10-01 01:02:09 +04:00
|
|
|
int handle = (pname[4] - '0') << 1;
|
2011-06-13 13:32:39 +04:00
|
|
|
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) {
|
2011-10-01 01:02:09 +04:00
|
|
|
int handle = get_device_handle_from_param(param);
|
2011-06-13 13:32:39 +04:00
|
|
|
if (handle >= 0) {
|
|
|
|
if (!strcmp(param->get_name(), "status")) {
|
2011-07-24 18:11:10 +04:00
|
|
|
BX_HD_THIS channels[handle/2].drives[handle%2].status_changed = 1;
|
2011-06-13 13:32:39 +04:00
|
|
|
}
|
|
|
|
} 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) {
|
2011-07-24 18:11:10 +04:00
|
|
|
if (strlen(val) < 1) {
|
2011-06-13 13:32:39 +04:00
|
|
|
val = "none";
|
|
|
|
}
|
2011-10-01 01:02:09 +04:00
|
|
|
int handle = get_device_handle_from_param(param);
|
2011-06-13 13:32:39 +04:00
|
|
|
if (handle >= 0) {
|
|
|
|
if (!strcmp(param->get_name(), "path")) {
|
2011-07-24 18:11:10 +04:00
|
|
|
BX_HD_THIS channels[handle/2].drives[handle%2].status_changed = 1;
|
2011-06-13 13:32:39 +04:00
|
|
|
}
|
|
|
|
} else {
|
|
|
|
BX_PANIC(("cdrom_path_handler called with unexpected parameter '%s'", param->get_name()));
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return val;
|
|
|
|
}
|