X-Git-Url: http://v3vee.org/palacios/gitweb/gitweb.cgi?a=blobdiff_plain;f=palacios%2Fsrc%2Fdevices%2Fatapi.h;h=7667e97aa8960e85eb24c9d4105e8372c5baaf0f;hb=e8ee9e1536b3fa2e69f5537a90f5e034e9529248;hp=0892f8c2f90e0620c43d88694e3d986d44a376ec;hpb=36927aa4fd7f2aa4095de22589ec0a5210f91e99;p=palacios.git diff --git a/palacios/src/devices/atapi.h b/palacios/src/devices/atapi.h index 0892f8c..7667e97 100644 --- a/palacios/src/devices/atapi.h +++ b/palacios/src/devices/atapi.h @@ -17,11 +17,91 @@ * redistribute, and modify it as specified in the file "V3VEE_LICENSE". */ +#ifndef __DEVICES_ATAPI_H__ +#define __DEVICES_ATAPI_H__ + #define ATAPI_PACKET_SIZE 12 #include "atapi-types.h" +/* ACS-2 T13/2015-D Table B.2 Command codes */ +#define ATAPI_NOP 0x00 +#define CFA_REQ_EXT_ERROR_CODE 0x03 +#define ATAPI_DSM 0x06 +#define ATAPI_DEVICE_RESET 0x08 +#define ATAPI_RECAL 0x10 +#define ATAPI_READ 0x20 +#define ATAPI_READ_ONCE 0x21 +#define ATAPI_READ_EXT 0x24 +#define ATAPI_READDMA_EXT 0x25 +#define ATAPI_READDMA_QUEUED_EXT 0x26 +#define ATAPI_READ_NATIVE_MAX_EXT 0x27 +#define ATAPI_MULTREAD_EXT 0x29 +#define ATAPI_WRITE 0x30 +#define ATAPI_WRITE_ONCE 0x31 +#define ATAPI_WRITE_EXT 0x34 +#define ATAPI_WRITEDMA_EXT 0x35 +#define ATAPI_WRITEDMA_QUEUED_EXT 0x36 +#define ATAPI_SET_MAX_EXT 0x37 +#define ATAPI_SET_MAX_EXT 0x37 +#define CFA_WRITE_SECT_WO_ERASE 0x38 +#define ATAPI_MULTWRITE_EXT 0x39 +#define ATAPI_WRITE_VERIFY 0x3C +#define ATAPI_VERIFY 0x40 +#define ATAPI_VERIFY_ONCE 0x41 +#define ATAPI_VERIFY_EXT 0x42 +#define ATAPI_SEEK 0x70 +#define CFA_TRANSLATE_SECTOR 0x87 +#define ATAPI_DIAGNOSE 0x90 +#define ATAPI_SPECIFY 0x91 +#define ATAPI_DOWNLOAD_MICROCODE 0x92 +#define ATAPI_STANDBYNOW2 0x94 +#define ATAPI_IDLEIMMEDIATE2 0x95 +#define ATAPI_STANDBY2 0x96 +#define ATAPI_SETIDLE2 0x97 +#define ATAPI_CHECKPOWERMODE2 0x98 +#define ATAPI_SLEEPNOW2 0x99 +#define ATAPI_PACKETCMD 0xA0 +#define ATAPI_PIDENTIFY 0xA1 +#define ATAPI_QUEUED_SERVICE 0xA2 +#define ATAPI_SMART 0xB0 +#define CFA_ACCESS_METADATA_STORAGE 0xB8 +#define CFA_ERASE_SECTORS 0xC0 +#define ATAPI_MULTREAD 0xC4 +#define ATAPI_MULTWRITE 0xC5 +#define ATAPI_SETMULT 0xC6 +#define ATAPI_READDMA 0xC8 +#define ATAPI_READDMA_ONCE 0xC9 +#define ATAPI_WRITEDMA 0xCA +#define ATAPI_WRITEDMA_ONCE 0xCB +#define ATAPI_WRITEDMA_QUEUED 0xCC +#define CFA_WRITE_MULTI_WO_ERASE 0xCD +#define ATAPI_GETMEDIASTATUS 0xDA +#define ATAPI_DOORLOCK 0xDE +#define ATAPI_DOORUNLOCK 0xDF +#define ATAPI_STANDBYNOW1 0xE0 +#define ATAPI_IDLEIMMEDIATE 0xE1 +#define ATAPI_STANDBY 0xE2 +#define ATAPI_SETIDLE1 0xE3 +#define ATAPI_READ_BUFFER 0xE4 +#define ATAPI_CHECKPOWERMODE1 0xE5 +#define ATAPI_SLEEPNOW1 0xE6 +#define ATAPI_FLUSH_CACHE 0xE7 +#define ATAPI_WRITE_BUFFER 0xE8 +#define ATAPI_FLUSH_CACHE_EXT 0xEA +#define ATAPI_IDENTIFY 0xEC +#define ATAPI_MEDIAEJECT 0xED +#define ATAPI_SETFEATURES 0xEF +#define IBM_SENSE_CONDITION 0xF0 +#define ATAPI_SECURITY_SET_PASS 0xF1 +#define ATAPI_SECURITY_UNLOCK 0xF2 +#define ATAPI_SECURITY_ERASE_PREPARE 0xF3 +#define ATAPI_SECURITY_ERASE_UNIT 0xF4 +#define ATAPI_SECURITY_FREEZE_LOCK 0xF5 +#define CFA_WEAR_LEVEL 0xF5 +#define ATAPI_SECURITY_DISABLE 0xF6 + /* ATAPI sucks... * The OS will write to the cylinder register the number of bytes it wants to read * however the device can change that value @@ -33,7 +113,7 @@ static int atapi_update_req_len(struct ide_internal * ide, struct ide_channel * //PrintDebug("\tUpdating request length (pre=%d)\n", drive->req_len); if (drive->req_len == 0) { - PrintError("ATAPI Error: request of length 0\n"); + PrintError(VM_NONE,VCORE_NONE, "ATAPI Error: request of length 0\n"); return -1; } @@ -75,9 +155,12 @@ static void atapi_setup_cmd_resp(struct ide_internal * ide, struct ide_channel * drive->irq_flags.c_d = 0; channel->status.busy = 0; - channel->status.data_req = 1; channel->status.error = 0; + if (drive->transfer_length > 0) { + channel->status.data_req = 1; + } + ide_raise_irq(ide, channel); } @@ -129,11 +212,12 @@ static void atapi_cmd_nop(struct ide_internal * ide, struct ide_channel * channe static int atapi_read_chunk(struct ide_internal * ide, struct ide_channel * channel) { struct ide_drive * drive = get_selected_drive(channel); - int ret = drive->ops->read(drive->data_buf, drive->current_lba * ATAPI_BLOCK_SIZE, ATAPI_BLOCK_SIZE, -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)); + PrintError(VM_NONE,VCORE_NONE, "IDE: Error reading CD block (LBA=%p)\n", (void *)(addr_t)(drive->current_lba)); return -1; } @@ -155,7 +239,7 @@ static int atapi_update_data_buf(struct ide_internal * ide, struct ide_channel * return atapi_read_chunk(ide, channel); default: - PrintError("Unhandled ATAPI command in update buffer %x\n", drive->cd_state.atapi_cmd); + PrintError(VM_NONE,VCORE_NONE, "Unhandled ATAPI command in update buffer %x\n", drive->cd_state.atapi_cmd); return -1; } @@ -170,7 +254,7 @@ static int atapi_read10(struct guest_info * core, uint32_t lba = be_to_le_32(cmd->lba); uint16_t xfer_len = be_to_le_16(cmd->xfer_len); - PrintDebug("READ10: XferLen=%d ; LBA=%x \n", xfer_len, lba ); + PrintDebug(core->vm_info, core, "READ10: XferLen=%d ; LBA=%x \n", xfer_len, lba ); /* Check if cd is ready * if not: atapi_cmd_error(... ATAPI_SEN_NOT_RDY, ASC_MEDIA_NOT_PRESENT) @@ -181,8 +265,8 @@ static int atapi_read10(struct guest_info * core, return 0; } - 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", + if ((lba + xfer_len) > (drive->ops->get_capacity(drive->private_data) / ATAPI_BLOCK_SIZE)) { + PrintError(core->vm_info, core, "IDE: xfer len exceeded capacity (lba=%d) (xfer_len=%d) (ReadEnd=%d) (capacity=%d)\n", lba, xfer_len, lba + xfer_len, (uint32_t)drive->ops->get_capacity(drive->private_data)); atapi_cmd_error(ide, channel, ATAPI_SEN_ILL_REQ, ASC_LOG_BLK_OOR); @@ -190,8 +274,7 @@ static int atapi_read10(struct guest_info * core, return 0; } - // PrintDebug("Reading %d blocks from LBA 0x%x\n", xfer_len, lba); - + // PrintDebug(core->vm_info, core, "Reading %d blocks from LBA 0x%x\n", xfer_len, lba); drive->current_lba = lba; // Update the request length value in the cylinder registers @@ -202,7 +285,7 @@ static int atapi_read10(struct guest_info * core, if (channel->dma_status.active == 1) { if (dma_read(core, ide, channel) == -1) { - PrintError("Error in DMA read for CD Read10 command\n"); + PrintError(core->vm_info, core, "Error in DMA read for CD Read10 command\n"); return -1; } } @@ -210,7 +293,7 @@ static int atapi_read10(struct guest_info * core, } if (atapi_read_chunk(ide, channel) == -1) { - PrintError("IDE: Could not read initial chunk from CD\n"); + PrintError(core->vm_info, core, "IDE: Could not read initial chunk from CD\n"); return -1; } @@ -218,7 +301,7 @@ static int atapi_read10(struct guest_info * core, // 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 if (atapi_update_req_len(ide, channel, ATAPI_BLOCK_SIZE) == -1) { - PrintError("Could not update initial request length\n"); + PrintError(core->vm_info, core, "Could not update initial request length\n"); return -1; } @@ -244,7 +327,7 @@ static int atapi_get_capacity(struct ide_internal * ide, struct ide_channel * ch struct atapi_rd_capacity_resp * resp = (struct atapi_rd_capacity_resp *)(drive->data_buf); uint32_t capacity = drive->ops->get_capacity(drive->private_data); - resp->lba = le_to_be_32(capacity); + resp->lba = le_to_be_32((capacity / ATAPI_BLOCK_SIZE) - 1); resp->block_len = le_to_be_32(ATAPI_BLOCK_SIZE); atapi_setup_cmd_resp(ide, channel, sizeof(struct atapi_rd_capacity_resp)); @@ -267,6 +350,8 @@ static int atapi_get_config(struct ide_internal * ide, struct ide_channel * chan xfer_len = alloc_len; } + V3_Print(VM_NONE, VCORE_NONE, "ATAPI Get config: xfer_len=%d\b", xfer_len); + atapi_setup_cmd_resp(ide, channel, xfer_len); return 0; @@ -298,7 +383,7 @@ static int atapi_read_toc(struct ide_internal * ide, struct ide_channel * channe atapi_setup_cmd_resp(ide, channel, xfer_len); } else { - PrintError("Unhandled Format (%d)\n", cmd->format); + PrintError(VM_NONE, VCORE_NONE, "Unhandled Format (%d)\n", cmd->format); return -1; } @@ -312,8 +397,8 @@ static int atapi_mode_sense_cur_values(struct ide_internal * ide, struct ide_cha struct atapi_mode_sense_hdr * hdr = (struct atapi_mode_sense_hdr *)(drive->data_buf); uint_t resp_len = sizeof(struct atapi_mode_sense_hdr); uint16_t alloc_len = be_to_le_16(sense_cmd->alloc_len); - PrintDebug("Page Code: %x\n", sense_cmd->page_code); - PrintDebug("Alloc len: %d\n", alloc_len); + PrintDebug(VM_NONE, VCORE_NONE,"Page Code: %x\n", sense_cmd->page_code); + PrintDebug(VM_NONE, VCORE_NONE,"Alloc len: %d\n", alloc_len); switch (sense_cmd->page_code) { @@ -327,7 +412,7 @@ static int atapi_mode_sense_cur_values(struct ide_internal * ide, struct ide_cha resp_len += sizeof(struct atapi_error_recovery); - PrintError("mode sense (error recovery) resp_len=%d\n", resp_len); + PrintError(VM_NONE, VCORE_NONE,"mode sense (error recovery) resp_len=%d\n", resp_len); hdr->mode_data_len = le_to_be_16(resp_len - 2); @@ -340,7 +425,7 @@ static int atapi_mode_sense_cur_values(struct ide_internal * ide, struct ide_cha - PrintError("mode sense (caps/mechs v2) resp_len=%d\n", resp_len); + PrintError(VM_NONE, VCORE_NONE, "mode sense (caps/mechs v2) resp_len=%d\n", resp_len); *((uint16_t *)buf) = le_to_be_16(28 + 6); buf[2] = 0x70; @@ -389,7 +474,7 @@ static int atapi_mode_sense_cur_values(struct ide_internal * ide, struct ide_cha hdr->mode_data_len = le_to_be_16(resp_len - 2); - PrintError("mode sense (caps/mechs v2) resp_len=%d\n", resp_len); + PrintError(VM_NONE, VCORE_NONE, "mode sense (caps/mechs v2) resp_len=%d\n", resp_len); caps->page_code = 0x2a; caps->page_len = 0x12; @@ -419,7 +504,7 @@ static int atapi_mode_sense_cur_values(struct ide_internal * ide, struct ide_cha case 0x0e: case 0x3f: default: - PrintError("ATAPI: Mode sense Page Code not supported (%x)\n", sense_cmd->page_code); + PrintError(VM_NONE, VCORE_NONE, "ATAPI: Mode sense Page Code not supported (%x)\n", sense_cmd->page_code); atapi_cmd_error(ide, channel, ATAPI_SEN_ILL_REQ, ASC_INV_CMD_FIELD); ide_raise_irq(ide, channel); return 0; @@ -430,7 +515,7 @@ static int atapi_mode_sense_cur_values(struct ide_internal * ide, struct ide_cha // memset(hdr, 0, sizeof(struct atapi_mode_sense_hdr)); // hdr->media_type_code = 0x70; - PrintDebug("resp_len=%d\n", resp_len); + PrintDebug(VM_NONE, VCORE_NONE, "resp_len=%d\n", resp_len); drive->transfer_length = (resp_len > alloc_len) ? alloc_len : resp_len; drive->transfer_index = 0; @@ -453,7 +538,7 @@ static int atapi_mode_sense(struct ide_internal * ide, struct ide_channel * chan case 0x02: // default values case 0x03: // saved values default: - PrintError("ATAPI: Mode sense mode not supported (%x)\n", sense_cmd->page_ctrl); + PrintError(VM_NONE, VCORE_NONE, "ATAPI: Mode sense mode not supported (%x)\n", sense_cmd->page_ctrl); return -1; } return 0; @@ -532,7 +617,7 @@ static int atapi_handle_packet(struct guest_info * core, struct ide_internal * i struct ide_drive * drive = get_selected_drive(channel); uint8_t cmd = drive->data_buf[0]; - PrintDebug("IDE: ATAPI Command %x\n", cmd); + PrintDebug(core->vm_info, core, "IDE: ATAPI Command %x\n", cmd); drive->cd_state.atapi_cmd = cmd; @@ -545,7 +630,7 @@ static int atapi_handle_packet(struct guest_info * core, struct ide_internal * i */ break; case 0x03: // request sense - PrintError("IDE: Requesting Sense (0x3)\n"); + PrintError(core->vm_info, core, "IDE: Requesting Sense (0x3)\n"); atapi_req_sense(ide, channel); break; @@ -555,14 +640,14 @@ static int atapi_handle_packet(struct guest_info * core, struct ide_internal * i case 0x28: // read(10) if (atapi_read10(core, ide, channel) == -1) { - PrintError("IDE: Error in ATAPI read (%x)\n", cmd); + PrintError(core->vm_info, core, "IDE: Error in ATAPI read (%x)\n", cmd); return -1; } break; case 0x5a: // mode sense if (atapi_mode_sense(ide, channel) == -1) { - PrintError("IDE: Error in ATAPI mode sense (%x)\n", cmd); + PrintError(core->vm_info, core, "IDE: Error in ATAPI mode sense (%x)\n", cmd); return -1; } break; @@ -570,7 +655,7 @@ static int atapi_handle_packet(struct guest_info * core, struct ide_internal * i case 0x25: // read cdrom capacity if (atapi_get_capacity(ide, channel) == -1) { - PrintError("IDE: Error getting CDROM capacity (%x)\n", cmd); + PrintError(core->vm_info, core, "IDE: Error getting CDROM capacity (%x)\n", cmd); return -1; } break; @@ -578,14 +663,14 @@ static int atapi_handle_packet(struct guest_info * core, struct ide_internal * i case 0x43: // read TOC if (atapi_read_toc(ide, channel) == -1) { - PrintError("IDE: Error getting CDROM TOC (%x)\n", cmd); + PrintError(core->vm_info, core, "IDE: Error getting CDROM TOC (%x)\n", cmd); return -1; } break; case 0x46: // get configuration if (atapi_get_config(ide, channel) == -1) { - PrintError("IDE: Error getting CDROM Configuration (%x)\n", cmd); + PrintError(core->vm_info, core, "IDE: Error getting CDROM Configuration (%x)\n", cmd); return -1; } break; @@ -594,21 +679,21 @@ static int atapi_handle_packet(struct guest_info * core, struct ide_internal * i 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"); + PrintDebug(core->vm_info, core, "Error: Read disk info no-op to keep the Linux CD-ROM driver happy\n"); atapi_cmd_error(ide, channel, ATAPI_SEN_ILL_REQ, ASC_INV_CMD_FIELD); ide_raise_irq(ide, channel); break; case 0x12: // inquiry if (atapi_inquiry(ide, channel) == -1) { - PrintError("IDE: Error in ATAPI inquiry (%x)\n", cmd); + PrintError(core->vm_info, core, "IDE: Error in ATAPI inquiry (%x)\n", cmd); return -1; } break; case 0xbd: // mechanism status if (atapi_mech_status(ide, channel) == -1) { - PrintError("IDE: error in ATAPI Mechanism status query (%x)\n", cmd); + PrintError(core->vm_info, core, "IDE: error in ATAPI Mechanism status query (%x)\n", cmd); return -1; } break; @@ -618,6 +703,8 @@ static int atapi_handle_packet(struct guest_info * core, struct ide_internal * i case 0x1b: // start/stop drive + atapi_cmd_nop(ide,channel); + break; case 0xbe: // read cd @@ -642,7 +729,7 @@ static int atapi_handle_packet(struct guest_info * core, struct ide_internal * i case 0x4e: // stop play/scan default: - PrintError("Unhandled ATAPI command %x\n", cmd); + PrintError(core->vm_info, core, "Unhandled ATAPI command %x\n", cmd); atapi_cmd_error(ide, channel, ATAPI_SEN_ILL_REQ, ASC_INV_CMD_FIELD); ide_raise_irq(ide, channel); return -1; @@ -716,3 +803,5 @@ static void atapi_identify_device(struct ide_drive * drive) { /* Disabled until command packet DMA is fixed */ drive_id->dma_ultra = 0x2020; // Ultra_DMA_Mode_5_Selected | Ultra_DMA_Mode_5_Supported; } + +#endif