Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #define trigPin1 3
- #define echoPin1 2
- #define trigPin2 4
- #define echoPin2 5
- #define trigPin3 7
- #define echoPin3 8
- long duration, distance, RightSensor,BackSensor,FrontSensor,LeftSensor;
- void setup()
- {
- Serial.begin (9600);
- pinMode(trigPin1, OUTPUT);
- pinMode(echoPin1, INPUT);
- pinMode(trigPin2, OUTPUT);
- pinMode(echoPin2, INPUT);
- pinMode(trigPin3, OUTPUT);
- pinMode(echoPin3, INPUT);
- }
- void loop() {
- SonarSensor(trigPin1, echoPin1);
- RightSensor = distance;
- SonarSensor(trigPin2, echoPin2);
- LeftSensor = distance;
- SonarSensor(trigPin3, echoPin3);
- FrontSensor = distance;
- /*
- */
- if (LeftSensor < 130 || FrontSensor < 130 || RightSensor < 130)
- {
- Serial.print(LeftSensor);
- Serial.print(" - ");
- Serial.print(FrontSensor);
- Serial.print(" - ");
- Serial.println(RightSensor);
- Serial.println("hit");
- }
- }
- 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/2) / 29.1;
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement