// Information header
// Developer    : Camila Martínez Buitrón
// ID number    : A01737689
// Date         : 27th August, 2024
// Project name : Mod01 Act06 

// Add all required constant definitions
#define M1_ACC 11
#define M1_FWD 33
#define M2_ACC 12
#define M2_FWD 35
#define M3_ACC 7
#define M3_FWD 41
#define M4_ACC 8
#define M4_FWD 37
#define S_PROX_R A8
#define S_PROX_L A6
#define S_PROX_M  A7

// Add all required variable definitions
bool proxStatusL = LOW;
bool proxStatusR = LOW;

void setup() {
  pinMode(M1_ACC, OUTPUT);
  pinMode(M1_FWD, OUTPUT);
  pinMode(M2_ACC, OUTPUT);
  pinMode(M2_FWD, OUTPUT);
  pinMode(M3_ACC, OUTPUT);
  pinMode(M3_FWD, OUTPUT);
  pinMode(M4_ACC, OUTPUT);
  pinMode(M4_FWD, OUTPUT);
  pinMode(S_PROX_L, INPUT);
  pinMode(S_PROX_R, INPUT);
  pinMode(S_PROX_M, INPUT);
  digitalWrite(M1_FWD, LOW);
  digitalWrite(M1_ACC, LOW);
  digitalWrite(M2_FWD, LOW);
  digitalWrite(M2_ACC, LOW);
  digitalWrite(M3_FWD, LOW);
  digitalWrite(M3_ACC, LOW);
  digitalWrite(M4_FWD, LOW);
  digitalWrite(M4_ACC, LOW);
  Serial.begin(9600);
}

void loop() {
  // put your main code here, to run repeatedly
  proxStatusL = digitalRead(S_PROX_L);
  proxStatusR = digitalRead(S_PROX_R);
  Serial.print("proxStatusL:");
  Serial.print(proxStatusL);
  Serial.print(" / ");
  Serial.print("proxStatusR:");
  Serial.print(proxStatusR);
  if (proxStatusR == 0){
    digitalWrite(M3_FWD, HIGH);
    analogWrite(M3_ACC, 100);
    digitalWrite(M4_FWD, HIGH);
    analogWrite(M4_ACC, 100);
    delay(10);
  }
  else{
    digitalWrite(M3_FWD, HIGH);
    analogWrite(M3_ACC, 0);
    digitalWrite(M4_FWD, LOW);
    analogWrite(M4_ACC, 0);
  }
   if (proxStatusL == 0){
    digitalWrite(M1_FWD, HIGH);
    analogWrite(M1_ACC, 100);
    digitalWrite(M2_FWD, HIGH);
    analogWrite(M2_ACC, 100);
    delay(10);
   }
   else{
    digitalWrite(M1_FWD, HIGH);
    analogWrite(M1_ACC, 0);
    digitalWrite(M2_FWD, LOW);
    analogWrite(M2_ACC, 0);
   }
}