2 files changed, 7 insertions, 14 deletions

diff --git a/firmware/drivers/adc.c b/firmware/drivers/adc.c
index e5dd4c1e53..a75f788417 100644
--- a/firmware/drivers/adc.c
+++ b/firmware/drivers/adc.c
@@ -298,12 +298,17 @@ static struct adc_struct adcdata[NUM_ADC_CHANNELS] IDATA_ATTR;
  * a 13 bit value corresponding to 0-5.4v, the resulting range is 13FB-17FA,
  * representing 3.1-5.4v */
 static unsigned short ten_bit_subtractor(unsigned short data) {
-    return (data<<2)+0x13FB;
+    return (data<<2)+0x4FB;
 }
 
 static unsigned short _adc_scan(struct adc_struct *adc)
 {
-    unsigned short data = pcf50605_a2d_read(adc->channelnum);
+    unsigned short data;
+
+    /* ADCC1, 8 bit, start */
+    pcf50605_write(0x2f, 0x80 | (adc->channelnum << 1) | 0x1);
+    data = pcf50605_read(0x30); /* ADCS1 */
+
     if (adc->conversion) {
         data = adc->conversion(data);
     }
diff --git a/firmware/drivers/pcf50605.c b/firmware/drivers/pcf50605.c
index 7d2036e807..c8ea4a499f 100644
--- a/firmware/drivers/pcf50605.c
+++ b/firmware/drivers/pcf50605.c
@@ -98,18 +98,6 @@ int pcf50605_write_multiple(int address, const unsigned char* buf, int count)
     return 0;
 }
 
-unsigned short pcf50605_a2d_read(int adc_input)
-{
-    unsigned short hi;
-    unsigned char lo;
-
-    ipod_i2c_send(0x8, 0x2f, (adc_input<<1) | 0x1); /* ADCC2, ADCMUX = adc_input, ADCSTART = 1 */
-    hi = i2c_readbyte(0x8, 0x30);           /* ADCS1 */
-    lo = (i2c_readbyte(0x8, 0x31) & 0x3);   /* ADCS2 */
-
-    return (hi << 2) | lo;
-}
-
 /* The following command puts the iPod into a deep sleep.  Warning
    from the good people of ipodlinux - never issue this command
    without setting CHGWAK or EXTONWAK if you ever want to be able to