Programmi Esempio / Mbed 2 deprecated 4_Robot_Ultrasuoni

Ultrasuoni

Dependencies:   mbed HCSR04

main.cpp

Committer:
DonatoSt
Date:
2017-02-09
Revision:
0:ef0410ccfc84

File content as of revision 0:ef0410ccfc84:

#include "mbed.h"
#include "hcsr04.h"
HCSR04 sensor (D15, D14);
Serial pc(USBTX, USBRX);


DigitalOut dcm01(D6);
DigitalOut dcm02(D7);
DigitalOut dcm03(D4);
DigitalOut dcm04(D5);
float dist;

int main()
{

    pc.baud(115200);


    while(1) {
        sensor.start();
        dist=sensor.get_dist_cm();
        pc.printf("%dcm\t", sensor.get_dist_cm());


        if (dist > 20) {

            dcm01 = 0;
            dcm02 = 1;
            dcm03 = 0;
            dcm04 = 1;
           
            

        }

        if (dist < 20) {

            dcm01 = 1;
            dcm02 = 0;
            dcm03 = 0;
            dcm04 = 1;
           
            

        }





    }//Chiusa while
}//Chiusa main