2 files changed, 14 insertions, 1 deletions

diff --git a/firmware/drivers/pcf50605.c b/firmware/drivers/pcf50605.c
index a8c61b1789..0f71229964 100644
--- a/firmware/drivers/pcf50605.c
+++ b/firmware/drivers/pcf50605.c
@@ -65,6 +65,12 @@
 #define PSSC   0x18
 #define PWROKM 0x19
 #define PWROKS 0x1a
+#define D1REGC1 0x24
+  #define VOUT_3000mV 0xf5
+  #define VOUT_3300mV 0xf8
+#define D2REGC1 0x25
+#define D3REGC1 0x26
+
 
 int pcf50605_read(int address)
 {
@@ -101,3 +107,10 @@ void pcf50605_standby_mode(void)
     pcf50605_write(OOCC1, GOSTDBY | CHGWAK | EXTONWAK);
 }
 
+void pcf50605_init(void)
+{
+    /* The following values were taken from the ipodlinux kernel source */
+    pcf50605_write(D1REGC1, VOUT_3000mV); /* Unknown */
+    pcf50605_write(D2REGC1, VOUT_3300mV); /* Dock Connector pin 17 */
+    pcf50605_write(D3REGC1, VOUT_3000mV); /* Unknown */
+}
diff --git a/firmware/drivers/power.c b/firmware/drivers/power.c
index 9cc751e41e..c4b9fb5b7d 100644
--- a/firmware/drivers/power.c
+++ b/firmware/drivers/power.c
@@ -85,7 +85,7 @@ void power_init(void)
 #endif
 #endif
 #elif CONFIG_CPU == PP5020 || CONFIG_CPU == PP5002
-    /* TODO: Implement power_init() */
+    pcf50605_init();
 #else
 #ifdef HAVE_POWEROFF_ON_PB5
     PBCR2 &= ~0x0c00;    /* GPIO for PB5 */