Balancing Robot

500 italic">// Robot Motor Control Example
500 italic">// Controls two DC motors for a robot car

500 italic">#define MOTOR_A1 5
500 italic">#define MOTOR_A2 6
500 italic">#define MOTOR_B1 9
500 italic">#define MOTOR_B2 10

void setup() {
  pinMode(MOTOR_A1, OUTPUT);
  pinMode(MOTOR_A2, OUTPUT);
  pinMode(MOTOR_B1, OUTPUT);
  pinMode(MOTOR_B2, OUTPUT);
}

void forward() {
  analogWrite(MOTOR_A1, 200);
  analogWrite(MOTOR_A2, 0);
  analogWrite(MOTOR_B1, 200);
  analogWrite(MOTOR_B2, 0);
}

void stop() {
  analogWrite(MOTOR_A1, 0);
  analogWrite(MOTOR_A2, 0);
  analogWrite(MOTOR_B1, 0);
  analogWrite(MOTOR_B2, 0);
}

void loop() {
  forward();
  delay(2000);
  stop();
  delay(1000);
}