// Information header
// Developer    : Maria Isabel Montero Serdan 
// ID number    : A01738790
// Date         : agosto 29 2024 
// Project name : Mod1 Act06A 

#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_IMPACT_L A11
#define S_IMPACT_R A12

bool impactStatusL = LOW;
bool impactStatusR = LOW;

void setup() {
  // put your setup code here, to run once:
  pinMode(M1_FWD, OUTPUT);
  pinMode(M1_ACC,OUTPUT);
  pinMode(M2_FWD, OUTPUT);
  pinMode(M2_ACC, OUTPUT);
  pinMode(M3_FWD, OUTPUT);
  pinMode(M3_ACC, OUTPUT);
  pinMode(M4_FWD, OUTPUT);
  pinMode(M4_ACC, OUTPUT);
  pinMode(S_IMPACT_L, INPUT);
  pinMode(S_IMPACT_R, 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:
 impactStatusL = digitalRead(S_IMPACT_L);
  impactStatusR =digitalRead(S_IMPACT_R);
  Serial.print("impactStatusL: ");
  Serial.print(impactStatusL);
  Serial.print("|");
  Serial.print("impactStatusR: ");
  Serial.print(impactStatusR);
  if (impactStatusR == 0){
    digitalWrite(M1_FWD, HIGH);
    analogWrite(M1_ACC, 64);
    digitalWrite(M2_FWD, HIGH);
    analogWrite(M2_ACC, 64);
    delay(10);
 
}
 else {
 digitalWrite(M1_FWD, LOW);
 analogWrite(M1_ACC, 0);
 digitalWrite(M2_FWD, LOW);
 analogWrite(M2_ACC, 0);
 }
   if (impactStatusL == 0){
    digitalWrite(M3_FWD, HIGH);
    analogWrite(M3_ACC, 64);
    digitalWrite(M4_FWD, HIGH);
    analogWrite(M4_ACC, 64);
    delay(10);
 
}
 else {
 digitalWrite(M3_FWD, LOW);
 analogWrite(M3_ACC, 0);
 digitalWrite(M4_FWD, LOW);
 analogWrite(M4_ACC, 0);
 }
 }