Changeset 0e6dce8 in mainline for uspace/srv/bd/ata_bd/ata_bd.c

Timestamp:

2009-08-22T13:58:10Z (15 years ago)

Author:

Jiri Svoboda <jiri@…>

Branches:

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

Children:

b94334f

Parents:

a71c158

Message:

Display device model name upon initialization.

File:

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

uspace/srv/bd/ata_bd/ata_bd.c

@@ -50 +50 @@
 #include <as.h>
 #include <fibril_sync.h>
+#include <string.h>
 #include <devmap.h>
 #include <sys/types.h>
@@ -85 +86 @@
 static int ata_bd_write_block(int disk_id, uint64_t blk_idx, size_t blk_cnt,
     const void *buf);
-static int drive_identify(int drive_id, disk_t *d);
+static int disk_init(disk_t *d, int disk_id);
+static int drive_identify(int drive_id, void *buf);
 static int wait_status(unsigned set, unsigned n_reset, uint8_t *pstatus,
     unsigned timeout);
@@ -106 +108 @@
                 fflush(stdout);
 
-                rc = drive_identify(i, &disk[i]);
+                rc = disk_init(&disk[i], i);
 
                 if (rc == EOK) {
-                        printf("%u cylinders, %u heads, %u sectors\n",
-                            disk[i].cylinders, disk[i].heads, disk[i].sectors);
+                        printf("%s: %u cylinders, %u heads, %u sectors.\n",
+                            disk[i].model, disk[i].cylinders, disk[i].heads,
+                            disk[i].sectors);
                 } else {
                         printf("Not found.\n");
@@ -251 +254 @@
 }
 
+/** Initialize a disk.
+ *
+ * Probes for a disk, determines its parameters and initializes
+ * the disk structure.
+ */
+static int disk_init(disk_t *d, int disk_id)
+{
+        uint16_t buf[256];
+        uint8_t model[40];
+        uint16_t w;
+        uint8_t c;
+        size_t pos, len;
+        int rc;
+        int i;
+
+        rc = drive_identify(disk_id, buf);
+        if (rc != EOK) {
+                d->present = false;
+                return rc;
+        }
+
+        d->cylinders = buf[1];
+        d->heads = buf[3];
+        d->sectors = buf[6];
+
+        d->blocks = d->cylinders * d->heads * d->sectors;
+
+        /*
+         * Convert model name to string representation.
+         */
+        for (i = 0; i < 20; i++) {
+                w = buf[27 + i];
+                model[2 * i] = w >> 8;
+                model[2 * i + 1] = w & 0x00ff;
+        }
+
+        len = 40;
+        while (len > 0 && model[len - 1] == 0x20)
+                --len;
+
+        pos = 0;
+        for (i = 0; i < len; ++i) {
+                c = model[i];
+                if (c >= 0x80) c = '?';
+
+                chr_encode(c, d->model, &pos, 40);
+        }
+        d->model[pos] = '\0';
+
+        d->present = true;
+        fibril_mutex_initialize(&d->lock);
+
+        return EOK;
+}
+
 /** Transfer a logical block from/to the device.
  *
@@ -294 +352 @@
 /** Issue IDENTIFY command.
  *
- * This is used to detect whether an ATA device is present and if so,
- * to determine its parameters. The parameters are written to @a d.
+ * Reads @c identify data into the provided buffer. This is used to detect
+ * whether an ATA device is present and if so, to determine its parameters.
  *
  * @param disk_id       Device ID, 0 or 1.
- * @param d             Device structure to store parameters in.
- */
-static int drive_identify(int disk_id, disk_t *d)
+ * @param buf           Pointer to a 512-byte buffer.
+ */
+static int drive_identify(int disk_id, void *buf)
 {
         uint16_t data;
@@ -308 +366 @@
 
         drv_head = ((disk_id != 0) ? DHR_DRV : 0);
-        d->present = false;
 
         if (wait_status(0, ~SR_BSY, NULL, TIMEOUT_PROBE) != EOK)
@@ -330 +387 @@
 
         if ((status & SR_DRQ) != 0) {
-//              for (i = 0; i < block_size / 2; i++) {
-//                      data = pio_read_16(&cmd->data_port);
-//                      ((uint16_t *) buf)[i] = data;
-//              }
-
                 for (i = 0; i < block_size / 2; i++) {
                         data = pio_read_16(&cmd->data_port);
-
-                        switch (i) {
-                        case 1: d->cylinders = data; break;
-                        case 3: d->heads = data; break;
-                        case 6: d->sectors = data; break;
-                        }
+                        ((uint16_t *) buf)[i] = data;
                 }
         }
@@ -348 +395 @@
         if ((status & SR_ERR) != 0)
                 return EIO;
-
-        d->blocks = d->cylinders * d->heads * d->sectors;
-
-        d->present = true;
-        fibril_mutex_initialize(&d->lock);
 
         return EOK;