const int trigPinfront = 5; const int echoPinfront = 4; const int trigPinleft = A5; const int echoPinleft = A4; const int trigPinright = A3; const int echoPinright = A2; long duration, distance, RightSensor,FrontSensor,LeftSensor; void setup() { Serial.begin (9600); pinMode(trigPinfront, OUTPUT); pinMode(echoPinfront, INPUT); pinMode(trigPinleft, OUTPUT); pinMode(echoPinleft, INPUT); pinMode(trigPinright, OUTPUT); pinMode(echoPinright, INPUT); } void loop() { SonarSensor(trigPinfront, echoPinfront); FrontSensor = distance; SonarSensor(trigPinleft, echoPinleft); LeftSensor = distance; SonarSensor(trigPinright, echoPinright); RightSensor = distance; Serial.print(" L: "); Serial.println(LeftSensor,2); Serial.print(" F: "); Serial.println(FrontSensor,2); Serial.print(" R: "); Serial.println(RightSensor,2); Serial.println(" ----- "); delay(200); } void SonarSensor(int trigPin,int echoPin) { digitalWrite(trigPin, LOW); delayMicroseconds(2); digitalWrite(trigPin, HIGH); delayMicroseconds(10); digitalWrite(trigPin, LOW); duration = pulseIn(echoPin, HIGH); distance = duration*0.034/2; }