 }
 
 void showRPM() {
-  debug_motor_rpm = true;
+  xv_config.show_rpm = true;
   if (xv_config.raw_data == true) {
     hideRaw();
   }
-  Serial.println("Showing RPM data");
+  Serial.println(F(" "));
+  Serial.print(F("Showing RPM data"));
+  Serial.println(F(" "));
 }
 
 void hideRPM() {
-  debug_motor_rpm = false;
-  Serial.println("Hiding RPM data");
+  xv_config.show_rpm = false;
+  Serial.println(F(" "));
+  Serial.print(F("Hiding RPM data"));
+  Serial.println(F(" "));
 }
 
 void showDist() {
-  debug_dist = true;
+  xv_config.show_dist = true;
   if (xv_config.raw_data == true) {
     hideRaw();
   }
-  Serial.println("Showing Distance data");
+  Serial.println(F(" "));
+  Serial.print(F("Showing Distance data"));
+  Serial.println(F(" "));
 }
 
 void hideDist() {
-  debug_dist = false;
-  Serial.println("Hiding Distance data");
+  xv_config.show_dist = false;
+  Serial.println(F(" "));
+  Serial.print(F("Hiding Distance data"));
+  Serial.println(F(" "));
 }
 
 void showAngle() {


  xv_config.motor_enable = true;
  xv_config.raw_data = true;
  EEPROM_writeAnything(0, xv_config);
}


    sVal = atof(arg);    // Converts a char string to a float
    if (sVal < 200) {
      sVal = 200;
      Serial.println(F(" "));
      Serial.print(F("Setting to minimum 200"));
      Serial.println(F(" "));
    }
    if (sVal > 300) {
      sVal = 300;
      Serial.println(F(" "));
      Serial.print(F("Setting to maximum 300"));
      Serial.println(F(" "));
    }
  }
  else {
