From 44298163ba2afb0d5506b67e163a655c44506295 Mon Sep 17 00:00:00 2001
From: Jörg Hohensohn <hohensoh@rockbox.org>
Date: Wed, 3 Dec 2003 01:03:54 +0000
Subject: No more spinning disk while charging flashed FM+V2 (you need the new
 bootloader to utilize it). ToDo: remove now false voltage reading from
 charging screen.

git-svn-id: svn://svn.rockbox.org/rockbox/trunk@4095 a1c6a512-1295-4272-9138-f99709370657
---
 firmware/drivers/power.c | 42 ++++++++++++++++++++++++++++++++++--------
 1 file changed, 34 insertions(+), 8 deletions(-)

(limited to 'firmware/drivers/power.c')

diff --git a/firmware/drivers/power.c b/firmware/drivers/power.c
index 549624fd92..a701d01658 100644
--- a/firmware/drivers/power.c
+++ b/firmware/drivers/power.c
@@ -36,11 +36,6 @@ void power_init(void)
     or_b(0x20, &PBIORL); /* Set charging control bit to output */
     charger_enable(false); /* Default to charger OFF */
 #endif
-#ifdef HAVE_ATA_POWER_OFF
-    or_b(0x20, &PADRL); /* leave the disk on */
-    or_b(0x20, &PAIORL);
-    PACR2 &= 0xFBFF;
-#endif
 }
 
 bool charger_inserted(void)
@@ -79,16 +74,47 @@ void charger_enable(bool on)
 
 void ide_power_enable(bool on)
 {
-#ifdef HAVE_ATA_POWER_OFF
+    (void)on;
+    bool touched = false;
+
+#ifdef NEEDS_ATA_POWER_ON
     if(on)
+    {
         or_b(0x20, &PADRL);
-    else
+        touched = true;
+    }
+#endif
+#ifdef HAVE_ATA_POWER_OFF
+    if(!on)
+    {
         and_b(~0x20, &PADRL);
+        touched = true;
+    }
+#endif
+
+/* late port preparation, else problems with read/modify/write 
+   of other bits on same port, while input and floating high */
+    if (touched)
+    {
+        or_b(0x20, &PAIORL); /* PA5 is an output */
+        PACR2 &= 0xFBFF; /* GPIO for PA5 */
+    }
+}
+
+
+bool ide_powered(void)
+{
+#if defined(NEEDS_ATA_POWER_ON) || defined(HAVE_ATA_POWER_OFF)
+    if ((PACR2 & 0x0400) || !(PAIOR & 0x0020)) // not configured for output
+        return true; // would be floating high, disk on
+    else
+        return (PADR & 0x0020) != 0;
 #else
-    on = on;
+    return TRUE; /* pretend always powered if not controlable */
 #endif
 }
 
+
 void power_off(void)
 {
     set_irq_level(15);
-- 
cgit v1.2.3