Uses 2 HC-SR04 ultrasonic modules to steer the RenBuggy away from obstacles. Renishaw Team page fork.

Dependencies:   mbed

Fork of RenBuggy_Ultrasonic by Ren Buggy

main.cpp

Committer:
RenBuggy
Date:
2016-07-14
Revision:
0:fbceffb594b6
Child:
1:80c2ef16a42f

File content as of revision 0:fbceffb594b6:

#include "mbed.h"
#include "ultrasonic_buggy.h"
//#include "USBSerial.h"

//USBSerial serial;


int main(){
    
    float left_distance;
    float right_distance;
    stop();
    wait(5);
    //serial.printf("PROGRAM START\n\r");
    while(1){
        
        
        //wait(1);
        
        left_distance = getDistance_l();
        right_distance = getDistance_r();
        
        //if((left_distance > 0.3) && (right_distance > 0.3)){
        //serial.printf("left distance = %f   right distance = %f\n\r", left_distance, right_distance);
            /* if(left_distance > right_distance){
                left(0.1);
            }
            else if(right_distance > left_distance){
                right(0.1);
            }
        }
        
        else{
            right(3);
        }*/
        
    }
}