 //#include "ServoTimer2.h"
 
 #include "Sound.h"
+
+#define MOTOR_SPEED_MIN_A 200
+#define MOTOR_SPEED_MAX_A 230 // This motor is slower on my setup.
+#define MOTOR_SPEED_MIN_B 200
+#define MOTOR_SPEED_MAX_B 255
 
 // Motor attached to channel A:
 const byte motorA_direction = 12;

//@todo: set speed
  digitalWrite(motorA_direction, HIGH); // Channel A forward
  digitalWrite(motorB_direction, HIGH); // Channel B forward
  analogWrite(motorA_pwm, 250); // Channel A at max speed 
  analogWrite(motorB_pwm, 250); // Channel B at max speed 
  motion_state = M_FWD;
}

void motion_rev()
{
  
//@todo: set speed
    digitalWrite(motorA_direction, LOW); // Channel A backward
    digitalWrite(motorB_direction, LOW); // Channel B backward
    analogWrite(motorA_pwm, 200); // Channel A at half speed 
    analogWrite(motorB_pwm, 200); // Channel B at half speed   
    motion_state = M_REV; 
  
}

{
  
    Serial.println("RIGHT");
    digitalWrite(motorA_direction, LOW); // Channel A backward
    digitalWrite(motorB_direction, HIGH); // Channel B forward
    analogWrite(motorA_pwm, MOTOR_SPEED_MIN_A);
    analogWrite(motorB_pwm, MOTOR_SPEED_MIN_B);   
    motion_state = M_ROTATE_RIGHT; 
  
}
