const int ledPin = 13;
const int motor1 = 2;
const int motor2 = 4;
bool ledState = true;
// Functions
// void forward(void);
// void brake(void);
void setup() {
Serial.begin(9600);
pinMode(ledPin, OUTPUT);
pinMode(motor1, OUTPUT);
pinMode(motor2, OUTPUT);
}
void loop() {
forward(4000);
brake();
delay(1000);
}
void forward(int duration) {
Serial.println("FORWARDS");
digitalWrite(motor1, HIGH);
digitalWrite(motor2, HIGH);
digitalWrite(ledPin, HIGH);
delay(duration);
}
void brake(void) {
digitalWrite(ledPin, LOW);
Serial.println("BRAKE");
digitalWrite(motor1, LOW);
digitalWrite(motor2, LOW);
}