 }
 
 // Debug: Show current commands on lcd
-*/
 void lcd_command() {
-  lcd.clear();
-  lcd.setCursor(0,0);
-  lcd.print(
-          "Y"+String(cmd.yaw_pwm)+" "+String(cmd.yaw_direction)
-          +" L"+String(cmd.lid_pwm)+" "+String(cmd.lid_direction)
-          );
-}
-*/
+  if (debug == 1){
+     lcd.clear();
+     lcd.setCursor(0,0);
+     lcd.print(
+             "Y"+String(cmd.yaw_pwm)+" "+String(cmd.yaw_direction)
+             +" L"+String(cmd.lid_pwm)+" "+String(cmd.lid_direction)
+             );
+        }
+} 
+
 
 // Send command to the motors
 void do_command() {

 LiquidCrystal_I2C lcd(I2C_ADDR,En_pin,Rw_pin,Rs_pin,D4_pin,D5_pin,D6_pin,D7_pin);
*/

const int potPin1 = A0;
const int potPin2 = A1;
const int potPin3 = A2;

      stringComplete = true;
    } 
  }
  if (debug == 1){
     lcd.clear();
     lcd.setCursor(0,0);
     lcd.print(inputString);
  }
}
