diff options
| -rw-r--r-- | firmware/drivers/pcf50605.c | 13 | ||||
| -rw-r--r-- | firmware/drivers/power.c | 2 | ||||
| -rw-r--r-- | firmware/export/pcf50605.h | 1 |
3 files changed, 15 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 */ diff --git a/firmware/export/pcf50605.h b/firmware/export/pcf50605.h index 4ea1379e4a..eeb09b4612 100644 --- a/firmware/export/pcf50605.h +++ b/firmware/export/pcf50605.h @@ -28,6 +28,7 @@ int pcf50605_write_multiple(int address, const unsigned char* buf, int count); int pcf50605_a2d_read(int channel); bool pcf50605_charger_inserted(void); void pcf50605_standby_mode(void); +void pcf50605_init(void); #endif #endif |