#include <Servo.h>
Servo servo;
const int trigPin1 = 7;
const int echoPin1 = 6;
const int trigPin2 = 5;
const int echoPin2 = 3;
float duration1, duration2, distance1, distance2;
void setup() {
// put your setup code here, to run once:
servo.attach(9);
pinMode(trigPin1, OUTPUT);
pinMode(trigPin2, OUTPUT);
Serial.begin(9600);
}
void loop() {
digitalWrite(trigPin1, LOW);
digitalWrite(trigPin2, LOW);
delayMicroseconds(2);
digitalWrite(trigPin1, HIGH);
digitalWrite(trigPin2, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin1, LOW);
digitalWrite(trigPin2, LOW);
duration1 = pulseIn(echoPin1, HIGH);
duration2 = pulseIn(echoPin2, HIGH);
//distance1 = (duration1*.0343)/2;
distance2 = (duration2*.0343)/2;
Serial.print("Distance: ");
Serial.println(distance2);
delay(100);
}