Changeset 60 for trunk/src/os2ahci/atapi.c

Timestamp:

Dec 16, 2010, 3:54:53 PM (15 years ago)

Author:

markus

Message:

added atapi_ calls; untested

File:

• trunk/src/os2ahci/atapi.c (modified) (8 diffs)

trunk/src/os2ahci/atapi.c

@@ -23 +23 @@
 #include "os2ahci.h"
 #include "ata.h"
+#include "atapi.h"
 
 /* -------------------------- macros and constants ------------------------- */
@@ -29 +30 @@
 
 /* -------------------------- function prototypes -------------------------- */
+
+static void atapi_req_sense_pp      (IORBH _far *iorb);
+static void atapi_execute_cdb_pp    (IORBH _far *iorb);
+
 
 /* ------------------------ global/static variables ------------------------ */
@@ -49 +54 @@
 int atapi_unit_ready(IORBH _far *iorb, int slot)
 {
+  dprintf("atapi_unit_ready called\n");
   iorb_seterr(iorb, IOERR_CMD_NOT_SUPPORTED);
   return(-1);
@@ -58 +64 @@
 int atapi_read(IORBH _far *iorb, int slot)
 {
-  iorb_seterr(iorb, IOERR_CMD_NOT_SUPPORTED);
-  return(-1);
-}  
+  IORB_EXECUTEIO _far *io = (IORB_EXECUTEIO _far *) iorb;
+  ATAPI_CDB_12 cdb;
+  AD_INFO *ai = ad_infos + iorb_unit_adapter(iorb);
+  USHORT count = io->BlockCount - io->BlocksXferred;
+  USHORT sg_indx;
+  USHORT sg_cnt;
+  int p = iorb_unit_port(iorb);
+  int d = iorb_unit_device(iorb);
+  int rc;
+
+  /* translate read command to SCSI/ATAPI READ12 command.
+   * READ12 seems to be the most supported READ variant - according to MMC,
+   * and its enough even for BluRay.
+   */
+  memset(&cdb, 0x00, sizeof(cdb));
+  cdb.cmd = ATAPI_CMD_READ_12;
+  SET_CDB_32(cdb.lba, io->RBA + io->BlocksXferred);
+
+  do {
+    /* update sector count (might have been updated due to S/G limitations) */
+    SET_CDB_32(cdb.trans_len, (u32) count);
+
+    /* update S/G count and index */
+    sg_indx = ata_get_sg_indx(io);
+    sg_cnt = io->cSGList - sg_indx;
+
+    /* issue command */
+    rc = ata_cmd(ai, p, d, slot, ATA_CMD_PACKET,
+                 AP_ATAPI_CMD, (void _far *) &cdb, sizeof(cdb),
+                 AP_SGLIST,    io->pSGList + sg_indx, (u16) sg_cnt,
+                 AP_DEVICE,    0x4000,
+                 AP_END);
+
+    if (rc > 0) {
+      /* couldn't map all S/G elements */
+      ata_max_sg_cnt(io, sg_indx, (USHORT) rc, &sg_cnt, &count);
+    }
+  } while (rc > 0 && sg_cnt > 0);
+    
+  if (rc == 0) {
+    add_workspace(iorb)->blocks = count;
+    add_workspace(iorb)->ppfunc = ata_read_pp;
+
+  } else if (rc > 0) {
+    iorb_seterr(iorb, IOERR_CMD_SGLIST_BAD);
+
+  } else {
+    iorb_seterr(iorb, IOERR_CMD_ADD_SOFTWARE_FAILURE);
+  }
+
+  return(rc);
+}
 
 /******************************************************************************
@@ -67 +122 @@
 int atapi_verify(IORBH _far *iorb, int slot)
 {
+  dprintf("atapi_verify called\n");
   iorb_seterr(iorb, IOERR_CMD_NOT_SUPPORTED);
   return(-1);
@@ -76 +132 @@
 int atapi_write(IORBH _far *iorb, int slot)
 {
+  dprintf("atapi_write called\n");
   iorb_seterr(iorb, IOERR_CMD_NOT_SUPPORTED);
   return(-1);
@@ -85 +142 @@
 int atapi_execute_cdb(IORBH _far *iorb, int slot)
 {
-  iorb_seterr(iorb, IOERR_CMD_NOT_SUPPORTED);
-  return(-1);
+  IORB_ADAPTER_PASSTHRU _far *pt = (IORB_ADAPTER_PASSTHRU _far *) iorb;
+  int rc;
+
+  /* we do not perform the S/G limitation recovery loop here:
+   * "ADDs are not required to iterate commands through the CDB PassThru
+   * mechanism:" -- Storage Device Driver Reference, Scatter/Gather Lists
+   */
+  rc = ata_cmd(ad_infos + iorb_unit_adapter(iorb),
+               iorb_unit_port(iorb),
+               iorb_unit_device(iorb),
+               slot, ATA_CMD_PACKET,
+               AP_ATAPI_CMD, (void _far *) pt->pControllerCmd, 
+                             pt->ControllerCmdLen,
+               AP_SGLIST,    pt->pSGList, pt->cSGList,
+               AP_END);
+
+  if (rc == 0) {
+    add_workspace(iorb)->blocks = pt->cSGList;
+    add_workspace(iorb)->ppfunc = atapi_execute_cdb_pp;
+
+  } else if (rc > 0) {
+    iorb_seterr(iorb, IOERR_CMD_SGLIST_BAD);
+
+  } else {
+    iorb_seterr(iorb, IOERR_CMD_ADD_SOFTWARE_FAILURE);
+  }
+  
+  return(rc);
+}
+
+/******************************************************************************
+ * Post processing function for atapi_execute_cdb(); since we have no
+ * knowledge of the command itself, we just tell the IRQ handler that
+ * we're done.
+ */
+static void atapi_execute_cdb_pp(IORBH _far *iorb)
+{
+  add_workspace(iorb)->complete = 1;
 }
 
@@ -100 +193 @@
 int atapi_req_sense(IORBH _far *iorb, int slot)
 {
-  iorb_seterr(iorb, IOERR_CMD_NOT_SUPPORTED);
-  return(-1);
-}
-
+  ADD_WORKSPACE _far *aws = add_workspace(iorb);
+  ATAPI_CDB_REQ_SENSE cdb;
+  int rc;
+  
+  /* allocate sense buffer in ADD workspace */
+  aws->buf = malloc(ATAPI_SENSE_LEN);
+  if (aws->buf == NULL) {
+    iorb_seterr(iorb, IOERR_CMD_SW_RESOURCE);
+    return(-1);
+  }
+  memset(aws->buf, 0x00, ATAPI_SENSE_LEN);
+
+  /* prepare request sense command */
+  memset(&cdb, 0x00, sizeof(cdb));
+  cdb.cmd = ATAPI_CMD_REQUEST_SENSE;
+  aws->ppfunc = atapi_req_sense_pp;
+  rc = ata_cmd(ad_infos + iorb_unit_adapter(iorb),
+               iorb_unit_port(iorb),
+               iorb_unit_device(iorb),
+               slot,
+               ATA_CMD_PACKET,
+               AP_ATAPI_CMD, (void _far*) &cdb, sizeof(cdb),
+               AP_VADDR, (void _far *) aws->buf, ATAPI_SENSE_LEN,
+               AP_END);
+
+  if (rc > 0) {
+    /* should never happen - we got 64 bytes here */
+    iorb_seterr(iorb, IOERR_CMD_SGLIST_BAD);
+
+  } else {
+    /* we failed to get info about an error -> return
+     * non specific device error
+     */
+    iorb_seterr(iorb, IOERR_DEVICE_NONSPECIFIC);
+  }
+
+  return(rc);
+}
+
+/******************************************************************************
+ * Post processing function for ATAPI request sense; examines the sense
+ * data returned and maps sense info to IORB error info.
+ */
+static void atapi_req_sense_pp(IORBH _far *iorb)
+{
+  ADD_WORKSPACE _far *aws = add_workspace(iorb);
+  ATAPI_SENSE_DATA *psd = (ATAPI_SENSE_DATA *) aws->buf;
+
+  /* map sense data to some IOERR_ value */
+  switch (ATAPI_GET_SENSE(psd)) {
+
+  case ASENSE_NO_SENSE:
+  case ASENSE_RECOVERED_ERROR:
+    /* no error */
+    break;
+
+  case ASENSE_NOT_READY:
+    iorb_seterr(iorb, IOERR_UNIT_NOT_READY);
+    break;
+
+  case ASENSE_UNIT_ATTENTION:
+    iorb_seterr(iorb, IOERR_MEDIA_CHANGED);
+    break;
+
+  case ASENSE_MEDIUM_ERROR:
+    iorb_seterr(iorb, IOERR_MEDIA);
+    break;
+
+  case ASENSE_ILLEGAL_REQUEST:
+    iorb_seterr(iorb, IOERR_CMD_SYNTAX);
+    break;
+
+  case ASENSE_DATA_PROTECT:
+    iorb_seterr(iorb, IOERR_MEDIA_WRITE_PROTECT);
+    break;
+
+  case ASENSE_BLANK_CHECK:
+    iorb_seterr(iorb, IOERR_MEDIA_NOT_FORMATTED);
+    break;
+
+  case ASENSE_ABORTED_COMMAND:
+  case ASENSE_COPY_ABORTED:
+    iorb_seterr(iorb, IOERR_CMD_ABORTED);
+    break;
+  
+  default:
+    iorb_seterr(iorb, IOERR_DEVICE_NONSPECIFIC);
+    break;
+  }
+
+  /* free sense buffer */
+  aws_free(aws);
+
+}