/* 
Developer    : Sergio Gomez Gutierrez
Number ID    : A01736487
Project name : A5P2
Date         : October 17th, 2023
Template URL : 
https://wokwi.com/projects/378857532813665281
*/

// definitions section

#define L_FWD 7
#define L_ACC 11
#define L_BWD 8

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

#define echoPin 5
#define trigPin 12

int timeInMicrosec = 0;
int distanceInCm = 0;

void setup () {
  Serial.begin(9600);
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
}

void loop () {
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);
  timeInMicrosec = pulseIn(echoPin, HIGH);
  Serial.println(timeInMicrosec);
  distanceInCm = timeInMicrosec * 0.033 / 2.0;
  Serial.println(distanceInCm);
  delay(100);
}