// Information header
// Developer    : Maria Isabel Montero Serdan 
// ID number    : A01738790
// Date         : 20/08/2024
// Project name : Act 04 Module 01

// Add all required constant definitions
#define M3_ACC 7
#define M3_FWD 41
#define M4_ACC 8
#define M4_FWD 37

// Add all required variable definitions
String robotLowSpeed = "Robot at low speed...";
String robotHighSpeed = "Robot at high speed...";

void setup() {
  // put your setup code here, to run once
  pinMode (M3_ACC, OUTPUT);
  pinMode (M3_FWD, OUTPUT);
  pinMode (M4_ACC, OUTPUT);
  pinMode (M4_FWD, OUTPUT);
  digitalWrite(M3_ACC, LOW);
  digitalWrite(M3_FWD, LOW);
  digitalWrite(M4_ACC, LOW);
  digitalWrite(M4_FWD, LOW);
  Serial.begin(9600);
}

void loop() {
  // put your main code here, to run repeatedly
  analogWrite(M3_ACC, 51);
  digitalWrite(M3_FWD, HIGH);
  analogWrite(M4_ACC, 51);
  digitalWrite(M4_FWD, HIGH);
  Serial.println(robotLowSpeed);
  delay(1600);
  analogWrite(M3_ACC, 179);
  digitalWrite(M3_FWD, HIGH);
  analogWrite(M4_ACC, 179);
  digitalWrite(M4_FWD, HIGH);
  Serial.println(robotHighSpeed);
  delay(1600);
}