Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <Ultrasonic.h>
- volatile float maxfrontdistance = 15.00;
- volatile float maxleftdistance = 10.00 , maxrightdistance = 10.00;
- volatile float leftdistance, frontdistance, rightdistance;
- bool Leftclear, Frontclear, Rightclear;
- Ultrasonic USleft(3, 10);
- Ultrasonic USfront(6, 11);
- Ultrasonic USright(5, 9);
- void setup(){
- Serial.begin(9600);
- }
- void loop(){
- checkfrontdistance();
- checkleftdistance();
- checkrightdistance();
- if(!Leftclear){
- Serial.print("Left not clear");
- }
- delay(2000);
- }
- void checkleftdistance() {
- Serial.print("Left:");
- leftdistance = USleft.distanceRead();
- if (leftdistance>maxleftdistance)
- (Leftclear = true);
- Serial.print(USleft.distanceRead());
- Serial.println("cm");
- }
- void checkfrontdistance() {
- Serial.print("Front:");
- frontdistance = USfront.distanceRead();
- if (frontdistance>maxfrontdistance)
- (Frontclear = true);
- Serial.print(USfront.distanceRead());
- Serial.println("cm");
- }
- void checkrightdistance() {
- Serial.print("Right:");
- rightdistance = USright.distanceRead();
- if (rightdistance>maxrightdistance)
- (Rightclear = true);
- Serial.print(USright.distanceRead());
- Serial.println("cm");
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement