   int cval = 0;
 
   // Read positive voltage
-  vSenseP = (analogReadV(10, Vsense_P) * VDRP) / 1000;
+  vSenseP = (analogReadV(10, Vsense_P) * (VDRP+offsetP)) / 1000;
 
   // Read negative voltage
-  vSenseN = ((Vref/2) - analogReadV(10, Vsense_N)) * 10;
+  vSenseN = (((Vref/2)-offsetN) - analogReadV(10, Vsense_N)) * -10;
 
   // Read positive current
   cval =  analogReadV(10, Asense_P) - 2500;

  } else {
    return 0;
  }
}

void readEEPROM() {

// Reference voltage measured from device
#define Vref 4881
// Vsense1 ratio
#define VDRP 4950

#define DAC_P 9
#define DAC_N 7
