static int atapi_read_chunk(struct vm_device * dev, struct ide_channel * channel) {
struct ide_drive * drive = get_selected_drive(channel);
- int ret = drive->cd_ops->read(drive->data_buf, 1, drive->current_lba, drive->private_data);
+ int ret = drive->ops->read(drive->data_buf, drive->current_lba * ATAPI_BLOCK_SIZE, ATAPI_BLOCK_SIZE,
+drive->private_data);
if (ret == -1) {
PrintError("IDE: Error reading CD block (LBA=%p)\n", (void *)(addr_t)(drive->current_lba));
return 0;
}
-static int atapi_read10(struct vm_device * dev, struct ide_channel * channel) {
+static int atapi_read10(struct guest_info * core,
+ struct vm_device * dev,
+ struct ide_channel * channel) {
struct ide_drive * drive = get_selected_drive(channel);
struct atapi_read10_cmd * cmd = (struct atapi_read10_cmd *)(drive->data_buf);
uint32_t lba = be_to_le_32(cmd->lba);
return 0;
}
- if (lba + xfer_len > drive->cd_ops->get_capacity(drive->private_data)) {
+ if (lba + xfer_len > drive->ops->get_capacity(drive->private_data)) {
PrintError("IDE: xfer len exceeded capacity (lba=%d) (xfer_len=%d) (ReadEnd=%d) (capacity=%d)\n",
lba, xfer_len, lba + xfer_len,
- drive->cd_ops->get_capacity(drive->private_data));
+ (uint32_t)drive->ops->get_capacity(drive->private_data));
atapi_cmd_error(dev, channel, ATAPI_SEN_ILL_REQ, ASC_LOG_BLK_OOR);
ide_raise_irq(dev, channel);
return 0;
drive->current_lba = lba;
// Update the request length value in the cylinder registers
-
+ drive->transfer_length = xfer_len * ATAPI_BLOCK_SIZE;
+ drive->transfer_index = 0;
+
+ if (channel->features.dma) {
+
+ if (channel->dma_status.active == 1) {
+ if (dma_read(core, dev, channel) == -1) {
+ PrintError("Error in DMA read for CD Read10 command\n");
+ return -1;
+ }
+ }
+ return 0;
+ }
+
if (atapi_read_chunk(dev, channel) == -1) {
PrintError("IDE: Could not read initial chunk from CD\n");
return -1;
}
- drive->transfer_length = xfer_len * ATAPI_BLOCK_SIZE;
- drive->transfer_index = 0;
-
// Length of ATAPI buffer sits in cylinder registers
// This is weird... The host sets this value to say what it would like to transfer,
// if it is larger than the correct size, the device shrinks it to the correct size
static int atapi_get_capacity(struct vm_device * dev, struct ide_channel * channel) {
struct ide_drive * drive = get_selected_drive(channel);
struct atapi_rd_capacity_resp * resp = (struct atapi_rd_capacity_resp *)(drive->data_buf);
- uint32_t capacity = drive->cd_ops->get_capacity(drive->private_data);
+ uint32_t capacity = drive->ops->get_capacity(drive->private_data);
resp->lba = le_to_be_32(capacity);
resp->block_len = le_to_be_32(ATAPI_BLOCK_SIZE);
}
-static int atapi_handle_packet(struct vm_device * dev, struct ide_channel * channel) {
+static int atapi_inquiry(struct vm_device * dev, struct ide_channel * channel) {
+ struct ide_drive * drive = get_selected_drive(channel);
+ struct atapi_inquiry_cmd * inquiry_cmd = (struct atapi_inquiry_cmd *)(drive->data_buf);
+ uint16_t alloc_len = be_to_le_16(inquiry_cmd->alloc_len);
+ struct atapi_inquiry_resp * resp = (struct atapi_inquiry_resp *)(drive->data_buf);
+ int xfer_len = sizeof(struct atapi_inquiry_resp);
+ const char * vendor_id = "VTAB ";
+ const char * product_id = "Turbo CD-ROM ";
+ const char * product_rev = "1.0 ";
+
+ memset(resp, 0, sizeof(struct atapi_inquiry_resp));
+
+ resp->dev_type = DEV_TYPE_CDROM;
+ resp->removable_media = 1;
+ resp->resp_data_fmt = 0x1;
+ resp->atapi_trans_ver = 0x2;
+ resp->additional_len = 31;
+
+ memcpy(resp->t10_vendor_id, vendor_id, strlen(vendor_id));
+ memcpy(resp->product_id, product_id, strlen(product_id));
+ memcpy(resp->product_rev, product_rev, strlen(product_rev));
+
+ if (alloc_len < xfer_len) {
+ xfer_len = alloc_len;
+ }
+
+ atapi_setup_cmd_resp(dev, channel, xfer_len);
+
+ return 0;
+}
+
+
+static int atapi_cmd_is_data_op(uint8_t cmd) {
+ switch (cmd) {
+ case 0x28: // read (10)
+ case 0xa8: // read (12)
+ case 0x2a: // write (10)
+ case 0xaa: // write (12)
+ return 1;
+ default:
+ return 0;
+ }
+}
+
+
+static int atapi_handle_packet(struct guest_info * core, struct vm_device * dev, struct ide_channel * channel) {
struct ide_drive * drive = get_selected_drive(channel);
uint8_t cmd = drive->data_buf[0];
atapi_req_sense(dev, channel);
break;
+ case 0x1e: // lock door
+ atapi_cmd_nop(dev, channel);
+ break;
+
case 0x28: // read(10)
- if (atapi_read10(dev, channel) == -1) {
+ if (atapi_read10(core, dev, channel) == -1) {
PrintError("IDE: Error in ATAPI read (%x)\n", cmd);
return -1;
}
}
break;
+
+ case 0x4a: // Get Status/event
case 0x51: // read disk info
// no-op to keep the Linux CD-ROM driver happy
PrintDebug("Error: Read disk info no-op to keep the Linux CD-ROM driver happy\n");
ide_raise_irq(dev, channel);
break;
-
+ case 0x12: // inquiry
+ if (atapi_inquiry(dev, channel) == -1) {
+ PrintError("IDE: Error in ATAPI inquiry (%x)\n", cmd);
+ return -1;
+ }
+ break;
case 0xa8: // read(12)
case 0x1b: // start/stop drive
case 0xbd: // mechanism status
- case 0x12: // inquiry
case 0xbe: // read cd
case 0x2b: // seek
- case 0x1e: // lock door
+
case 0x42: // read sub-channel
case 0xba: // scan
case 0xbb: // set cd speed
case 0x4e: // stop play/scan
-
- case 0x4a: // ???
+
default:
PrintError("Unhandled ATAPI command %x\n", cmd);
atapi_cmd_error(dev, channel, ATAPI_SEN_ILL_REQ, ASC_INV_CMD_FIELD);