Changeset 160 for trunk/src/os2ahci/apm.c

Timestamp:

May 31, 2013, 2:03:41 AM (12 years ago)

Author:

David Azarewicz

Message:

fixed trap dump kernel exit, some work on suspend/resume routines

File:

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

trunk/src/os2ahci/apm.c

@@ -77 +77 @@
     if (evt->ulParm2 >> 16 != APM_PWRSTATEREADY) {
       /* we're suspending */
-      apm_suspend();
+      suspend();
     }
     break;
@@ -84 +84 @@
   case APM_CRITRESUMEEVENT:
     /* we're resuming */
-    apm_resume();
+    resume();
     break;
 
@@ -96 +96 @@
 
 /******************************************************************************
- * APM suspend handler. In a nutshell, it'll turn of interrupts and flush all
+ * Suspend handler. In a nutshell, it'll turn off interrupts and flush all
  * write caches.
  */
-void apm_suspend(void)
+void suspend(void)
 {
   int a;
@@ -107 +107 @@
 
   if (suspended) return;
-  dprintf("apm_suspend()\n");
+  dprintf("suspend()\n");
 
   /* restart all ports with interrupts disabled */
@@ -132 +132 @@
       }
     }
+
+    /* AHCI spec rev1.1 section 8.3.3:
+     * Software must disable interrupts prior to requesting a transition of the HBA to D3 state.
+     */
+    writel(ai->mmio + HOST_CTL, readl(ai->mmio + HOST_CTL) & ~HOST_IRQ_EN);
+    readl(ai->mmio + HOST_CTL); /* flush */
   }
 
@@ -137 +143 @@
   init_complete = 0;
 
+#if 0
   /* restore BIOS configuration for each adapter and release the adapter */
   for (a = 0; a < ad_info_cnt; a++) {
     ahci_restore_bios_config(ad_infos + a);
-    unlock_adapter(ad_infos + a);
-  }
+  }
+#endif
+
+  /* TODO: put the device into the D3 state */
 
   suspended = 1;
-  dprintf("apm_suspend() finished\n");
-}
-
-/******************************************************************************
- * APM resume handler. All ports are restarted with interrupts enabled using
+  dprintf("suspend() finished\n");
+}
+
+/******************************************************************************
+ * Resume handler. All ports are restarted with interrupts enabled using
  * the same function as the IOCM_COMPLETE_INIT handler does.
  */
-void apm_resume(void)
+void resume(void)
 {
   int a;
 
   if (!suspended) return;
-  dprintf("apm_resume()\n");
+  dprintf("resume()\n");
+
+  /* TODO: put the device into the D0 state */
 
   for (a = 0; a < ad_info_cnt; a++) {
@@ -165 +176 @@
      * done to get the adapter and its ports up and running.
      */
-    lock_adapter(ai);
     ahci_complete_init(ai);
   }
@@ -178 +188 @@
 
   suspended = 0;
-  dprintf("apm_resume() finished\n");
-}
+  dprintf("resume() finished\n");
+}
+
+/******************************************************************************
+ * This is the kernel exit handler for panics and traps.
+ * Assume the system is trashed and do the absolute minimum necessary
+ * to put the adapters into a state so that the BIOS can operate the
+ * adapters. We never need to recover from this as the system will be rebooted.
+ */
+void shutdown_driver(void)
+{
+  int a;
+  int p;
+  u16 i;
+  u32 tmp;
+  //int d;
+
+  dprintf("shutdown_driver() enter\n");
+
+  for (a = 0; a < ad_info_cnt; a++) {
+    AD_INFO *ai = ad_infos + a;
+
+    /* Try to be nice. Wait 50ms for adapter to go not busy.
+     * If it doesn't go not busy in that time, too bad. Stop it anyway.
+     */
+    for (i=0; i<50000 && ai->busy; i++) udelay(1000);
+
+    for (p = 0; p <= ai->port_max; p++) {
+      u8 _far *port_mmio = port_base(ai, p);
+
+      /* Wait up to 50ms for port to go not busy. Again stop it
+       * anyway if it doesn't go not busy in that time.
+       */
+      for (i=0; i<50000 && ahci_port_busy(ai, p); i++) udelay(1000);
+
+      /* stop port */
+      writel(port_mmio + PORT_IRQ_MASK, 0); /* disable port interrupts */
+      writel(port_mmio + PORT_CMD, readl(port_mmio + PORT_CMD) & ~PORT_CMD_FIS_RX); /* disable FIS reception */
+      while (readl(port_mmio + PORT_CMD) & PORT_CMD_FIS_ON); /* wait for it to stop */
+      writel(port_mmio + PORT_CMD, readl(port_mmio + PORT_CMD) & ~PORT_CMD_START); /* set port to idle */
+      while (readl(port_mmio + PORT_CMD) & PORT_CMD_LIST_ON); /* wait for it to stop */
+
+      /* clear any pending port IRQs */
+      tmp = readl(port_mmio + PORT_IRQ_STAT);
+      if (tmp) writel(port_mmio + PORT_IRQ_STAT, tmp);
+      writel(ai->mmio + HOST_IRQ_STAT, 1UL << p);
+
+      /* reset PxSACT register (tagged command queues, not reset by COMRESET) */
+      writel(port_mmio + PORT_SCR_ACT, 0);
+      readl(port_mmio + PORT_SCR_ACT);  /* flush */
+
+      #if 0
+      ahci_start_port(ai, p, 0);
+
+      /* flush cache on all attached devices */
+      for (d = 0; d <= ai->ports[p].dev_max; d++) {
+        if (ai->ports[p].devs[d].present) {
+          ahci_flush_cache(ai, p, d);
+        }
+      }
+      #endif
+    }
+  }
+
+  init_complete = 0;
+
+  /* restore BIOS configuration for each adapter */
+  for (a = 0; a < ad_info_cnt; a++) {
+    ahci_restore_bios_config(ad_infos + a);
+  }
+
+  dprintf("shutdown_driver() finished\n");
+}
+