Embedded Class - Final Project2 / HCSR04
Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers HCSR04.cpp Source File

HCSR04.cpp

00001 #include "HCSR04.h"
00002 #include "mbed.h"
00003 
00004 Ultrasonic::Ultrasonic(PinName t, PinName e) : trig(t), echo(e) {
00005         trig=0;
00006 }
00007 
00008 int Ultrasonic::echo_duration() {
00009     timer.reset();
00010     trig = 1;
00011     wait_us(10);
00012     trig = 0;
00013     while(echo == 0);
00014     timer.start();
00015     while(echo == 1);
00016     timer.stop();
00017     return timer.read_us();
00018 }
00019 
00020 int Ultrasonic::distance(){
00021     duration = echo_duration();
00022     _distance= duration /58 / 2 ;
00023         return _distance;
00024 }