primjer mjerenja udaljenosti
Dependencies: mbed
Fork of HC-SR04 by
main.cpp
- Committer:
- cvitas
- Date:
- 2015-06-12
- Revision:
- 1:144bd7bdd1d1
- Parent:
- 0:e7a1440e980a
File content as of revision 1:144bd7bdd1d1:
#include "mbed.h" //#include "Pswitch.h" Serial pc(USBTX, USBRX); // tx, rx DigitalOut trig (p25); DigitalIn echo (p6); DigitalOut led1 (LED1); //Pswitch sw(p8); double pulsedur, distance; Timer tmr; int main() { pc.printf("start\n"); while(1) { tmr.reset(); trig = 1; wait_us(10); trig = 0; while (!echo); // wait high tmr.start(); while (echo); // wait low tmr.stop(); pulsedur = tmr.read_us(); distance = pulsedur*0.017; //cm pc.printf("pulsedur=%8.2f\n\r", distance); pc.printf("\n"); if (distance<4) led1 =1; else led1 =0; wait(0.5); } }