Changeset 4046b2f4 in mainline for uspace/srv/bd/ata_bd/ata_bd.c

Timestamp:

2011-08-30T17:35:04Z (13 years ago)

Author:

Martin Decky <martin@…>

Branches:

lfn, master, serial, ticket/834-toolchain-update, topic/msim-upgrade, topic/simplify-dev-export

Children:

7a72ce1a

Parents:

c3d19ac

Message:

TOC reading support
cherrypicked from lp:~jkavalik/cdfs/main

File:

• uspace/srv/bd/ata_bd/ata_bd.c (modified) (3 diffs)

uspace/srv/bd/ata_bd/ata_bd.c

@@ -118 +118 @@
 static int ata_pcmd_inquiry(int dev_idx, void *obuf, size_t obuf_size);
 static int ata_pcmd_read_12(int dev_idx, uint64_t ba, size_t cnt,
+    void *obuf, size_t obuf_size);
+static int ata_pcmd_read_toc(int dev_idx, uint8_t ses,
     void *obuf, size_t obuf_size);
 static void disk_print_summary(disk_t *d);
@@ -353 +355 @@
                             UPPER32(disk[disk_id].blocks));
                         continue;
+                case BD_READ_TOC:
+                        cnt = IPC_GET_ARG1(call);
+                        if (disk[disk_id].dev_type == ata_pkt_dev)
+                                retval = ata_pcmd_read_toc(disk_id, cnt, fs_va,
+                                    disk[disk_id].block_size);
+                        else
+                                retval = EINVAL;
+                        break;
                 default:
                         retval = EINVAL;
@@ -810 +820 @@
 }
 
+/** Issue ATAPI read TOC command.
+ *
+ * Read TOC in 'multi-session' format (first and last session number
+ * with last session LBA).
+ *
+ * http://suif.stanford.edu/~csapuntz/specs/INF-8020.PDF page 171
+ *
+ * Output buffer must be large enough to hold the data, otherwise the
+ * function will fail.
+ *
+ * @param dev_idx       Device index (0 or 1)
+ * @param session       Starting session
+ * @param obuf          Buffer for storing inquiry data read from device
+ * @param obuf_size     Size of obuf in bytes
+ *
+ * @return EOK on success, EIO on error.
+ */
+static int ata_pcmd_read_toc(int dev_idx, uint8_t session, void *obuf,
+    size_t obuf_size)
+{
+        ata_pcmd_read_toc_t cp;
+        int rc;
+
+        memset(&cp, 0, sizeof(cp));
+
+        cp.opcode = PCMD_READ_TOC;
+        cp.msf = 0;
+        cp.format = 0x01; /* 0x01 = multi-session mode */
+        cp.start = session;
+        cp.size = host2uint16_t_be(obuf_size);
+        cp.oldformat = 0x40; /* 0x01 = multi-session mode (shifted to MSB) */
+        
+        rc = ata_cmd_packet(0, &cp, sizeof(cp), obuf, obuf_size);
+        if (rc != EOK)
+                return rc;
+        
+        return EOK;
+}
+
 /** Read a physical from the device.
  *