 }
 
 // Debug: Show current commands on lcd
+*/
 void lcd_command() {
   lcd.clear();
   lcd.setCursor(0,0);

  lcd.print("SandBox");
  delay(30);
  //lcd.clear();
  
  //serial
  Serial.begin(115200);

          +" L"+String(cmd.lid_pwm)+" "+String(cmd.lid_direction)
          );
}
*/

// Send command to the motors
void do_command() {
