diff --git a/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/platformio.ini b/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/platformio.ini
index d4b1918..e6e49ba 100644
--- a/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/platformio.ini
+++ b/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/platformio.ini
@@ -22,5 +22,23 @@ upload_flags =
 upload_port = COM4
 upload_speed = 19200
 
-board_build.f_cpu = 1000000L
+board_build.f_cpu = 8000000L
+board_fuses.lfuse = "0xE2"
+board_fuses.hfuse = "0xDF"
+board_fuses.efuse = "0xF9"
 
+[env:ATmega328PB]
+platform = atmelavr
+board = ATmega328PB
+framework = arduino
+upload_protocol = stk500v1
+; each flag in a new line
+upload_flags =
+    -P$UPLOAD_PORT
+    -b$UPLOAD_SPEED
+
+; edit these lines
+upload_port = COM4
+upload_speed = 19200
+
+board_build.f_cpu = 8000000L
\ No newline at end of file
diff --git a/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/src/Pyr0_Piezo_Sensor_V2.x.x.cpp b/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/src/Pyr0_Piezo_Sensor_V2.x.x.cpp
index 2cd9fa0..5c2813b 100644
--- a/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/src/Pyr0_Piezo_Sensor_V2.x.x.cpp
+++ b/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/src/Pyr0_Piezo_Sensor_V2.x.x.cpp
@@ -82,9 +82,6 @@ update the voltMeterConstant variable in pP_config.h with the correct value
 
 ------------------------------------------------------------*/
 
-// Debug output toggle. Uncomment to enable
-#define DEBUG true
-
 /*  Debug output verbose mode will continuously output sensor readings
     rather than waiting for user input */
 //#define VERBOSE true
@@ -115,20 +112,6 @@ void setup() {
   Serial.begin(9600);
 
   attachInterrupt(digitalPinToInterrupt(Z_TRG), pulse, FALLING);
-  
-  // Atmega's Secret Voltmeter setup:
-  // set the reference to Vcc and the measurement to the internal 1.1V reference
-  #if defined(__AVR_ATmega32U4__) || defined(__AVR_ATmega1280__) || defined(__AVR_ATmega2560__)
-    ADMUX = _BV(REFS0) | _BV(MUX4) | _BV(MUX3) | _BV(MUX2) | _BV(MUX1);
-  #elif defined (__AVR_ATtiny24__) || defined(__AVR_ATtiny44__) || defined(__AVR_ATtiny84__)
-    ADMUX = _BV(MUX5) | _BV(MUX0);
-  #elif defined (__AVR_ATtiny25__) || defined(__AVR_ATtiny45__) || defined(__AVR_ATtiny85__)
-    ADMUX = _BV(MUX3) | _BV(MUX2);
-  #else
-    ADMUX = _BV(REFS0) | _BV(MUX3) | _BV(MUX2) | _BV(MUX1);
-  #endif
-
-  delay(2); // Wait for vref to settle
 
   Serial.println("Initializing Pyr0-Piezo Sensor...");
 
@@ -166,11 +149,10 @@ void loop() {
     VComp = analogRead(VCOMP_SENSE_PIN);
     VFol = analogRead(V_FOLLOW_PIN);
 
-    // Voltage Follower adjustment
     VLast = VOld - Vin;
     if (VLast > Hyst || VLast < -Hyst) {
+    // Voltage Follower adjustment
       adjustFollow();
-
     // Voltage Comparator adjustment
       adjustComp();
     // Alert the user that auto-calibration is ongoing
diff --git a/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/src/pP_config.cpp b/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/src/pP_config.cpp
index 47a5288..3b4fced 100644
--- a/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/src/pP_config.cpp
+++ b/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/src/pP_config.cpp
@@ -8,6 +8,8 @@ int LOOP_DUR = LOOP_DUR_DEFAULT; // duration of time between ADC checks and othe
 int TRG_DUR = TRG_DUR_DEFAULT;   // duration of the Z-axis pulse sent, in ms
 int Hyst = HYST_DEFAULT;         // Hysteresis value for ADC measurements
 int Debug = 0;
+long voltMeterConstant = VM_CONST_DEFAULT;
+uint8_t pP_i2c_address = 0xa0;
 
 void resetEEPROM() {
     resetConfig();
@@ -65,6 +67,14 @@ void restoreConfig() {
     } else {
         Hyst = temp;
     }
+
+    long longTemp;
+    EEPROM.get(VM_CONST_DEFAULT, longTemp);
+    if (longTemp < 1000000L || longTemp > 1200000L) {
+        resetEEPROM();
+    } else {
+        voltMeterConstant = longTemp;
+    }
 }
 
 void resetConfig() {
@@ -74,4 +84,5 @@ void resetConfig() {
     LOOP_DUR = LOOP_DUR_DEFAULT;
     TRG_DUR = TRG_DUR_DEFAULT;
     Hyst = HYST_DEFAULT;
+    voltMeterConstant = VM_CONST_DEFAULT;
 }
\ No newline at end of file
diff --git a/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/src/pP_config.h b/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/src/pP_config.h
index 657cbf0..95fa6ba 100644
--- a/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/src/pP_config.h
+++ b/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/src/pP_config.h
@@ -48,14 +48,15 @@
 #endif
 
 #define VM_CONST_ADDRESS 28
+#define VM_CONST_DEFAULT 1125300L
 #if !(defined(voltMeterConstant))
-  extern long voltMeterConstant = 1125300L; // For fine tuning input voltage sense
+  extern long voltMeterConstant; // For fine tuning input voltage sense
 #endif
 
 #ifdef I2C_INPUT
   #define I2C_SLAVE_ADDRESS 24
   #if !(defined(pP_i2c_address))
-    extern byte pP_i2c_address = 0xa0;     // I2C Bus Address
+    extern uint8_t pP_i2c_address;     // I2C Bus Address
   #endif
 #endif
 
diff --git a/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/src/pP_function.h b/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/src/pP_function.h
index 4c35da6..2c0979c 100644
--- a/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/src/pP_function.h
+++ b/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/src/pP_function.h
@@ -17,9 +17,6 @@ void digitalWriteFast(uint8_t pin, uint8_t x) {
 void pulse() {
   digitalWriteFast(TRG_OUT, LOW);
   sensorHReading = 1;
-  #ifdef DEBUG
-    Serial.println("Trig!");
-  #endif
   delay(TRG_DUR);
   digitalWriteFast(TRG_OUT, HIGH);
 }
@@ -28,6 +25,21 @@ void pulse() {
 
 long readVcc() {
   // Read 1.1V reference against AVcc
+
+  // Atmega's Secret Voltmeter setup:
+  // set the reference to Vcc and the measurement to the internal 1.1V reference
+#if defined(__AVR_ATmega32U4__) || defined(__AVR_ATmega1280__) || defined(__AVR_ATmega2560__)
+  ADMUX = _BV(REFS0) | _BV(MUX4) | _BV(MUX3) | _BV(MUX2) | _BV(MUX1);
+#elif defined(__AVR_ATtiny24__) || defined(__AVR_ATtiny44__) || defined(__AVR_ATtiny84__)
+  ADMUX = _BV(MUX5) | _BV(MUX0);
+#elif defined(__AVR_ATtiny25__) || defined(__AVR_ATtiny45__) || defined(__AVR_ATtiny85__)
+  ADMUX = _BV(MUX3) | _BV(MUX2);
+#else
+  ADMUX = _BV(REFS0) | _BV(MUX3) | _BV(MUX2) | _BV(MUX1);
+#endif
+
+  delay(2); // Wait for vref to settle
+
   ADCSRA |= _BV(ADSC); // Start conversion
   while (bit_is_set(ADCSRA,ADSC)); // measuring
 
diff --git a/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/src/pP_serial.h b/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/src/pP_serial.h
index fbd802b..e6aae55 100644
--- a/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/src/pP_serial.h
+++ b/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/src/pP_serial.h
@@ -8,7 +8,7 @@ void parseData() {
   strcpy(serialMessageIn, strtokIndx);   // copy it to serialMessageIn
   
   strtokIndx = strtok(NULL, " "); // this continues where the previous call left off
-  serialInt = atoi(strtokIndx);   // convert this part to an integer
+  serialLong = atol(strtokIndx);   // convert this part to an integer
 
 }
 /*------------------------------------------------*/
@@ -18,7 +18,7 @@ void identifyMarkers() {
   char x = Serial.read();
 //  char y = Wire.read();
 
-  if (x == endMarker) {
+  if (x == '\n' || x == '\r') {
     serialIncoming = true;
     inputBuffer[bytesRecvd] = 0;
     parseData();
@@ -26,8 +26,7 @@ void identifyMarkers() {
   } else {
     inputBuffer[bytesRecvd] = x;
     bytesRecvd++;
-    if (bytesRecvd == buffSize)
-    {
+    if (bytesRecvd == buffSize) {
       bytesRecvd = buffSize - 1;
     }
   }
@@ -59,9 +58,8 @@ void identifyMarkers() {
 
 void updateGainFactor()
 {
-  if (serialInt >= 0)
-  {
-    GAIN_FACTOR = serialInt;
+  if (serialLong >= 0) {
+    GAIN_FACTOR = serialLong;
     adjustGain();
     EEPROM.put(GAIN_FACTOR_ADDRESS, GAIN_FACTOR);
   }
@@ -70,9 +68,8 @@ void updateGainFactor()
 /*------------------------------------------------*/
 
 void updateVFol() {
-  if (serialInt >= 0)
-  {
-    followerThrs = serialInt;
+  if (serialLong >= 0) {
+    followerThrs = serialLong;
     adjustFollow();
     EEPROM.put(FOLLOWER_THRESHOLD_ADDRESS, followerThrs);
   }
@@ -80,9 +77,8 @@ void updateVFol() {
 /*------------------------------------------------*/
 
 void updateVComp() {
-  if (serialInt >= 0)
-  {
-    compThrs = serialInt;
+  if (serialLong >= 0) {
+    compThrs = serialLong;
     adjustComp();
     EEPROM.put(COMP_THRESHOLD_ADDRESS, compThrs);
   }
@@ -90,38 +86,33 @@ void updateVComp() {
 
 /*------------------------------------------------*/
 
-void updateLoopDuration()
-{
-  if (serialInt >= 0)
-  {
-    LOOP_DUR = serialInt;
+void updateLoopDuration() {
+  if (serialLong >= 0) {
+    LOOP_DUR = serialLong;
     EEPROM.put(LOOP_DUR_ADDRESS, LOOP_DUR);
   }
 }
 /*------------------------------------------------*/
 
 void updateTrigDuration() {
-  if (serialInt >= 0)
-  {
-    TRG_DUR = serialInt;
+  if (serialLong >= 0) {
+    TRG_DUR = serialLong;
     EEPROM.put(TRG_DUR_ADDRESS, TRG_DUR);
   }
 }
 /*------------------------------------------------*/
 
 void updateHysteresis() {
-  if (serialInt >= 0)
-  {
-    Hyst = serialInt;
+  if (serialLong >= 0) {
+    Hyst = serialLong;
     EEPROM.put(HYST_ADDRESS, Hyst);
   }
 }
 /*------------------------------------------------*/
 
 void updateConstant() {
-  if (serialInt >= 0)
-  {
-    voltMeterConstant = (long) serialInt;
+  if (serialLong >= 0) {
+    voltMeterConstant = (long) serialLong;
     EEPROM.put(VM_CONST_ADDRESS, voltMeterConstant);
   }
 }
@@ -129,21 +120,19 @@ void updateConstant() {
 /*------------------------------------------------*/
 
 void updateDebug() {
-  if (serialInt > 0) {
+  if (serialLong > 0) {
     Debug = 1;
-  } else if (serialInt == 0) {
+  } else if (serialLong == 0) {
     Debug = 0;
   }
 }
 
 /*------------------------------------------------*/
 
-void serialPrintConfig()
-{
+void serialPrintConfig() {
   Serial.print("GAIN_F ");
   Serial.print(GAIN_FACTOR);
-  switch (GAIN_FACTOR)
-  {
+  switch (GAIN_FACTOR) {
   case 0:
     Serial.println(" 3x");
     break;
@@ -183,8 +172,7 @@ void serialPrintConfig()
   Serial.println(voltMeterConstant);
 }
 
-void serialPrintState()
-{
+void serialPrintState() {
   Serial.print("{");
 
   Serial.print("\"Vcc\":");
@@ -192,11 +180,11 @@ void serialPrintState()
   Serial.print(",");
 
   Serial.print("\"VComp\":");
-  Serial.print(VComp);
+  Serial.print((long) VComp * Vin / 1023);
   Serial.print(",");
 
   Serial.print("\"VFol\":");
-  Serial.print(VFol);
+  Serial.print((long) VFol * Vin / 1023);
   Serial.print(",");
 
   Serial.print("\"Err\":");
@@ -217,7 +205,7 @@ void updateParams() {
     updateVComp();
   }
   else if (strcmp(serialMessageIn, "LOOP_D") == 0) {
-    updateTrigDuration();
+    updateLoopDuration();
   }
   else if (strcmp(serialMessageIn, "TRG_D") == 0) {
     updateTrigDuration();
diff --git a/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/src/pP_volatile.h b/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/src/pP_volatile.h
index 1ed74a9..9d12576 100644
--- a/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/src/pP_volatile.h
+++ b/firmware/AVR-Source/Pyr0_Piezo_Sensor_v2.x.x/src/pP_volatile.h
@@ -33,7 +33,7 @@ char inputBuffer[buffSize];
 byte bytesRecvd = 0;
 bool serialIncoming = false;
 char serialMessageIn[buffSize] = {0};
-int serialInt = 0;
+long serialLong = 0;
 
 //#define LOW 0
 //#define HIGH 1