Changeset 166 for trunk/src/os2ahci/ahci.c

Timestamp:

Aug 1, 2013, 5:11:07 PM (12 years ago)

Author:

David Azarewicz

Message:

added ability to ignore individual ports

File:

• trunk/src/os2ahci/ahci.c (modified) (1 diff)

trunk/src/os2ahci/ahci.c

@@ -598 +598 @@
   dprintf("ahci_scan_ports: scanning ports on adapter %d\n", ad_no(ai));
   for (p = 0; p < AHCI_MAX_PORTS; p++) {
-    if (ai->port_map & (1UL << p)) {
-
-      ddprintf("ahci_scan_ports: Wait till not busy on port %d\n", p);
-      /* wait until all active commands have completed on this port */
-      timer_init(&Timer, 250);
-      while (ahci_port_busy(ai, p)) {
-        if (timer_check_and_block(&Timer)) break;
+    if (!(ai->port_map & (1UL << p))) continue;
+    if (port_ignore[ad_no(ai)][p]) continue;
+
+    ddprintf("ahci_scan_ports: Wait till not busy on port %d\n", p);
+    /* wait until all active commands have completed on this port */
+    timer_init(&Timer, 250);
+    while (ahci_port_busy(ai, p)) {
+      if (timer_check_and_block(&Timer)) break;
+    }
+
+    if (!init_complete) {
+      if ((pc = ahci_save_port_config(ai, p)) == NULL) {
+        goto exit_port_scan;
       }
-
-      if (!init_complete) {
-        if ((pc = ahci_save_port_config(ai, p)) == NULL) {
-          goto exit_port_scan;
-        }
+    }
+
+    /* start/reset port; if no device is attached, this is expected to fail */
+    if (init_reset) {
+      rc = ahci_reset_port(ai, p, 0);
+    } else {
+      ddprintf("ahci_scan_ports: (re)starting port %d\n", p);
+      ahci_stop_port(ai, p);
+      rc = ahci_start_port(ai, p, 0);
+    }
+    if (rc) {
+      /* no device attached to this port */
+      ai->port_map &= ~(1UL << p);
+      goto restore_port_config;
+    }
+
+    /* this port seems to have a device attached and ready for commands */
+    ddprintf("ahci_scan_ports: port %d seems to be attached to a device; probing...\n", p);
+
+    /* Get ATA(PI) identity. The so-called signature gives us a hint whether
+     * this is an ATA or an ATAPI device but we'll try both in either case;
+     * the signature will merely determine whether we're going to probe for
+     * an ATA or ATAPI device, first, in order to reduce the chance of sending
+     * the wrong command (which would result in a port reset given the way
+     * ahci_exec_polled_cmd() was implemented).
+     */
+    is_ata = readl(port_base(ai, p) + PORT_SIG) == 0x00000101UL;
+    for (i = 0; i < 2; i++) {
+      rc = ahci_exec_polled_cmd(ai, p, 0, 500,
+                                (is_ata) ? ATA_CMD_ID_ATA : ATA_CMD_ID_ATAPI,
+                                AP_VADDR, (void _far *) id_buf, 512,
+                                AP_END);
+      if (rc == 0) {
+        break;
       }
 
-      /* start/reset port; if no device is attached, this is expected to fail */
-      if (init_reset) {
-        rc = ahci_reset_port(ai, p, 0);
-      } else {
-        ddprintf("ahci_scan_ports: (re)starting port %d\n", p);
-        ahci_stop_port(ai, p);
-        rc = ahci_start_port(ai, p, 0);
-      }
-      if (rc) {
-        /* no device attached to this port */
-        ai->port_map &= ~(1UL << p);
-        goto restore_port_config;
-      }
-
-      /* this port seems to have a device attached and ready for commands */
-      ddprintf("ahci_scan_ports: port %d seems to be attached to a device; probing...\n", p);
-
-      /* Get ATA(PI) identity. The so-called signature gives us a hint whether
-       * this is an ATA or an ATAPI device but we'll try both in either case;
-       * the signature will merely determine whether we're going to probe for
-       * an ATA or ATAPI device, first, in order to reduce the chance of sending
-       * the wrong command (which would result in a port reset given the way
-       * ahci_exec_polled_cmd() was implemented).
-       */
-      is_ata = readl(port_base(ai, p) + PORT_SIG) == 0x00000101UL;
-      for (i = 0; i < 2; i++) {
-        rc = ahci_exec_polled_cmd(ai, p, 0, 500,
-                                  (is_ata) ? ATA_CMD_ID_ATA : ATA_CMD_ID_ATAPI,
-                                  AP_VADDR, (void _far *) id_buf, 512,
-                                  AP_END);
-        if (rc == 0) {
-          break;
-        }
-
-        /* try again with ATA/ATAPI swapped */
-        is_ata = !is_ata;
-      }
-
-      if (rc == 0) {
-        /* we have a valid IDENTIFY or IDENTIFY_PACKET response */
-        ddphex(id_buf, 512, "ATA_IDENTIFY%s results:\n", (is_ata) ? "" : "_PACKET");
-        ahci_setup_device(ai, p, 0, id_buf);
-      } else {
-        /* no device attached to this port */
-        ai->port_map &= ~(1UL << p);
-      }
-
-    restore_port_config:
-      if (pc != NULL) {
-        ahci_restore_port_config(ai, p, pc);
-      }
+      /* try again with ATA/ATAPI swapped */
+      is_ata = !is_ata;
+    }
+
+    if (rc == 0) {
+      /* we have a valid IDENTIFY or IDENTIFY_PACKET response */
+      ddphex(id_buf, 512, "ATA_IDENTIFY%s results:\n", (is_ata) ? "" : "_PACKET");
+      ahci_setup_device(ai, p, 0, id_buf);
+    } else {
+      /* no device attached to this port */
+      ai->port_map &= ~(1UL << p);
+    }
+
+  restore_port_config:
+    if (pc != NULL) {
+      ahci_restore_port_config(ai, p, pc);
     }
   }