           // Diagnostic function - set DAC2
           NegDac.output(param);
           break;
+        case 22:
+          // Diagnostic function - raw ADC values
+          int vsp = analogRead(Vsense_P);
+          int vsn = analogRead(Vsense_N);
+          int asp = analogRead(Asense_P);
+          int asn = analogRead(Asense_N);
+          Serial.println(String("ADC:") + vsp + ", " + vsn + ", " + asp + ", " + asn);
+          break;
       }
     }
   }


void readEEPROM() {
  stateOEP = readAddress(0);
  digitalWrite(OE_P, stateOEP);
  stateOEN = readAddress(1);
  digitalWrite(OE_N, stateOEN);
  stateITE = readAddress(2);
  digitalWrite(ITE, stateITE);
  stateAC1 = readAddress(3);

  }
  if (!limitingN) {
    // Adjust voltage within 10mv
    if (vSenseN > (setVN + 10)) {
      dacValN++;
      NegDac.output(dacValN);
    }
    if (vSenseN < (setVN - 10)) {
      dacValN--;
      NegDac.output(dacValN);
    }
  }
}
