/* 
Christopher Bernardo Osorio Valderrama A01736358
*/
// definitions section
#define SENSOR_INPUT A0
#define L_FWD 7 
#define L_ACC 11
#define L_BWD 8 

#define R_FWD 2
#define R_ACC 3
#define R_BWD 4

int sensorValue = 0;

void setup() {
  Serial.begin(9600);
  pinMode(L_FWD, OUTPUT);
  pinMode(L_ACC, OUTPUT);
  pinMode(L_BWD, OUTPUT);

  pinMode(R_FWD, OUTPUT);
  pinMode(R_ACC, OUTPUT);
  pinMode(R_BWD, OUTPUT);
  //pinMode(SENSOR_INPUT, INPUT);

  digitalWrite(L_FWD, LOW);
 // digitalWrite(L_ACC, LOW);
  analogWrite(L_ACC,0);
  digitalWrite(L_BWD, LOW);

  digitalWrite(R_FWD, LOW);
  analogWrite(R_ACC,0);
  //digitalWrite(R_ACC, LOW);
  digitalWrite(R_BWD, LOW);
}

// loop() function - runs forever before setup()
void loop() {
  sensorValue = analogRead(SENSOR_INPUT);
  Serial.println(sensorValue);
  if (sensorValue < 120){
    digitalWrite(L_FWD, HIGH);
    //digitalWrite(L_ACC, HIGH);
    analogWrite(L_ACC,224);
    digitalWrite(L_BWD, LOW);
    digitalWrite(R_FWD, LOW);
    // digitalWrite(R_ACC, LOW);
    analogWrite(R_ACC,0);
    digitalWrite(R_BWD, LOW);
  }
  else{
    digitalWrite(L_FWD, LOW);
    //digitalWrite(L_ACC, LOW);
    analogWrite(L_ACC,0);
    digitalWrite(L_BWD, LOW);
    digitalWrite(R_FWD, HIGH);
    //digitalWrite(R_ACC, HIGH);
    analogWrite(R_ACC,224);
    digitalWrite(R_BWD, LOW);
  } 
   
  delay(50);
  
}