YH92x: Implement ATA power off.

Change-Id: If1f48df42ea7a150365c4ddbd3f9f7a85ae4b7dc

3 files changed, 19 insertions, 3 deletions

diff --git a/firmware/export/config/samsungyh920.h b/firmware/export/config/samsungyh920.h
index 8717cb765c..7d6d590d96 100644
--- a/firmware/export/config/samsungyh920.h
+++ b/firmware/export/config/samsungyh920.h
@@ -113,7 +113,7 @@
 #define HAVE_LBA48
 
 /* We're able to shut off power to the HDD */
-/* todo #define HAVE_ATA_POWER_OFF */
+#define HAVE_ATA_POWER_OFF
 
 /* Software controlled LED */
 #define CONFIG_LED LED_REAL
diff --git a/firmware/export/config/samsungyh925.h b/firmware/export/config/samsungyh925.h
index 098bfc851d..26311cc5fb 100644
--- a/firmware/export/config/samsungyh925.h
+++ b/firmware/export/config/samsungyh925.h
@@ -110,7 +110,7 @@
 #define HAVE_LBA48
 
 /* We're able to shut off power to the HDD */
-/* todo #define HAVE_ATA_POWER_OFF */
+#define HAVE_ATA_POWER_OFF
 
 /* Software controlled LED */
 #define CONFIG_LED LED_REAL
diff --git a/firmware/target/arm/samsung/power-yh82x_yh92x.c b/firmware/target/arm/samsung/power-yh82x_yh92x.c
index a9b64a29f4..021ddade4d 100644
--- a/firmware/target/arm/samsung/power-yh82x_yh92x.c
+++ b/firmware/target/arm/samsung/power-yh82x_yh92x.c
@@ -52,15 +52,31 @@ unsigned int power_input_status(void)
 
 void ide_power_enable(bool on)
 {
+#if defined(SAMSUNG_YH920) || defined(SAMSUNG_YH925)
+    if (on)
+    {
+        GPIO_CLEAR_BITWISE(GPIOF_OUTPUT_VAL, 0x10);
+        DEV_EN |= DEV_IDE0;
+    }
+    else
+    {
+        DEV_EN &= ~DEV_IDE0;
+        GPIO_SET_BITWISE(GPIOF_OUTPUT_VAL, 0x10);
+    }
+#else
     (void)on;
     /* We do nothing */
+#endif
 }
 
-
 bool ide_powered(void)
 {
+#if defined(SAMSUNG_YH920) || defined(SAMSUNG_YH925)
+    return ((GPIOF_INPUT_VAL & 0x10) == 0);
+#else
     /* pretend we are always powered - we don't turn it off */
     return true;
+#endif
 }
 
 void power_off(void)