Changeset 43c3937 in mainline for uspace/srv/bd/ata_bd/ata_bd.c

Timestamp:

2011-01-07T10:43:15Z (13 years ago)

Author:

Matus Dekanek <smekideki@…>

Branches:

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

Children:

5097bed4

Parents:

5f7d96e (diff), 0f191a2 (diff)
Note: this is a merge changeset, the changes displayed below correspond to the merge itself.
Use the (diff) links above to see all the changes relative to each parent.

Message:

merge with usb/development

File:

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

uspace/srv/bd/ata_bd/ata_bd.c

@@ -65 +65 @@
 #include <macros.h>
 
+#include "ata_hw.h"
 #include "ata_bd.h"
 
@@ -70 +71 @@
 #define NAMESPACE  "bd"
 
+/** Number of defined legacy controller base addresses. */
+#define LEGACY_CTLS 4
+
 /** Physical block size. Should be always 512. */
 static const size_t block_size = 512;
@@ -77 +81 @@
 
 /** I/O base address of the command registers. */
-static uintptr_t cmd_physical = 0x1f0;
+static uintptr_t cmd_physical;
 /** I/O base address of the control registers. */
-static uintptr_t ctl_physical = 0x170;
+static uintptr_t ctl_physical;
+
+/** I/O base addresses for legacy (ISA-compatible) controllers. */
+static ata_base_t legacy_base[LEGACY_CTLS] = {
+        { 0x1f0, 0x3f0 },
+        { 0x170, 0x370 },
+        { 0x1e8, 0x3e8 },
+        { 0x168, 0x368 }
+};
 
 static ata_cmd_t *cmd;
@@ -87 +99 @@
 static disk_t disk[MAX_DISKS];
 
+static void print_syntax(void);
 static int ata_bd_init(void);
 static void ata_bd_connection(ipc_callid_t iid, ipc_call_t *icall);
@@ -110 +123 @@
         int i, rc;
         int n_disks;
+        unsigned ctl_num;
+        char *eptr;
 
         printf(NAME ": ATA disk driver\n");
 
-        printf("I/O address %p/%p\n", (void *) ctl_physical,
-            (void *) cmd_physical);
+        if (argc > 1) {
+                ctl_num = strtoul(argv[1], &eptr, 0);
+                if (*eptr != '\0' || ctl_num == 0 || ctl_num > 4) {
+                        printf("Invalid argument.\n");
+                        print_syntax();
+                        return -1;
+                }
+        } else {
+                ctl_num = 1;
+        }
+
+        cmd_physical = legacy_base[ctl_num - 1].cmd;
+        ctl_physical = legacy_base[ctl_num - 1].ctl;
+
+        printf("I/O address %p/%p\n", (void *) cmd_physical,
+            (void *) ctl_physical);
 
         if (ata_bd_init() != EOK)
@@ -139 +168 @@
                         continue;
                 
-                snprintf(name, 16, "%s/disk%d", NAMESPACE, i);
+                snprintf(name, 16, "%s/ata%udisk%d", NAMESPACE, ctl_num, i);
                 rc = devmap_device_register(name, &disk[i].devmap_handle);
                 if (rc != EOK) {
@@ -160 +189 @@
         /* Not reached */
         return 0;
+}
+
+
+static void print_syntax(void)
+{
+        printf("Syntax: " NAME " <controller_number>\n");
+        printf("Controller number = 1..4\n");
 }