electronics-lab / Mbed 2 deprecated ultra-sonic-sensorII

mbed.hだけで超音波センサの制御できるかも

Dependencies:   mbed

main.cpp

Committer:
ponpoko1939
Date:
2018-03-28
Revision:
0:05cd466c355a

File content as of revision 0:05cd466c355a:

#include "mbed.h"

DigitalOut TRIG(p7);
DigitalIn  ECHO(p8);
Timer t; //Using timer0
Serial pc(USBTX,USBRX);

double duration,distance;

int main() {
    while(1){
start:
        while(ECHO == 0) {
            TRIG = 1;
            wait_us(10);
            TRIG = 0;
            wait_us(300);
            t.start();   
        }
        t.stop();
        
        duration = t.read_us();
    
        if(duration > 0){
            duration = duration / 2;
            distance = duration*340*100;
        }
        else {
            pc.printf("error");
            goto start;
        }
        pc.printf("Distance:%f\n",distance);
    }
}