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); } }