/*
https://forum.arduino.cc/t/i-am-building-an-arduino-rc-car-with-2-ultra-sonic-sensors-hc-sr04/1214989/
Testing just the sensors..
1.24.2024 ~q
*/
//HCSR04 Variables
int trig = 6;
int trig2 = 2;
int echo = 7;
int echo2 = 3;
unsigned long pulsetime = 0;
void setup() {
// put your setup code here, to run once:
Serial.begin(115200);
Serial.println("Ready..");
pinMode(trig, OUTPUT);
pinMode(trig2, OUTPUT);
pinMode(echo, INPUT);
pinMode(echo2, INPUT);
}
void loop() {
// put your main code here, to run repeatedly:
Serial.print("Distance front: ");
int dist = readDistanceF();
Serial.println(dist);
Serial.print("Distance back: ");
dist = readDistanceB();
Serial.println(dist);
delay(1000);
}
//Returns distance value from ultrasonic sensor
int readDistanceF()
{
digitalWrite(trig, LOW);
delayMicroseconds(2);
digitalWrite(trig, HIGH);
delayMicroseconds(10);
digitalWrite(trig, LOW);
pulsetime = pulseIn(echo, HIGH);
return pulsetime / 58.2; //magic
}
int readDistanceB()
{
digitalWrite(trig2, LOW);
delayMicroseconds(2);
digitalWrite(trig2, HIGH);
delayMicroseconds(10);
digitalWrite(trig2, LOW);
pulsetime = pulseIn(echo2, HIGH);
return pulsetime / 58.2; //magic
}