1 files changed, 22 insertions, 3 deletions

diff --git a/firmware/target/coldfire/iriver/h100/power-h100.c b/firmware/target/coldfire/iriver/h100/power-h100.c
index 0714ab2d3f..9effeef7c8 100644
--- a/firmware/target/coldfire/iriver/h100/power-h100.c
+++ b/firmware/target/coldfire/iriver/h100/power-h100.c
@@ -22,6 +22,7 @@
 #include "kernel.h"
 #include "system.h"
 #include "power.h"
+#include "spdif.h"
 
 
 #ifdef CONFIG_TUNER
@@ -85,8 +86,23 @@ void spdif_power_enable(bool on)
         and_l(~0x01000000, &GPIO1_OUT);
     else
         or_l(0x01000000, &GPIO1_OUT);
-}
+
+#ifndef BOOTLOADER
+    /* Make sure the feed is reset */
+    spdif_set_output_source(spdif_get_output_source(NULL), true);
 #endif
+}
+
+bool spdif_powered(void)
+{
+    bool state = (GPIO1_READ & 0x01000000)?false:true;
+#ifdef SPDIF_POWER_INVERTED
+    return !state;
+#else
+    return state;
+#endif /* SPDIF_POWER_INVERTED */
+}
+#endif /* HAVE_SPDIF_POWER */
 
 void ide_power_enable(bool on)
 {
@@ -96,13 +112,11 @@ void ide_power_enable(bool on)
         or_l(0x80000000, &GPIO_OUT);
 }
 
-
 bool ide_powered(void)
 {
     return (GPIO_OUT & 0x80000000)?false:true;
 }
 
-
 void power_off(void)
 {
     set_irq_level(HIGHEST_IRQ_LEVEL);
@@ -138,6 +152,11 @@ void spdif_power_enable(bool on)
 {
    (void)on;
 }
+
+bool spdif_powered(void)
+{
+    return false;
+}
 #endif
 
 #endif /* SIMULATOR */