test

Dependencies:   MbedJSONValue DISCO_L475VG_IOT01A_wifi mbed-http

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers US100.cpp Source File

US100.cpp

00001 #include "US100.h"
00002 #include "mbed.h"
00003 US100::US100(PinName t, PinName e) : trig(t), echo(e) {}
00004 // Trigger Echo
00005 // ______ _____________,,,,,,,,,
00006 // ____| 10us |_________| 150us-25ms, or 38ms if no obstacle
00007 //
00008 //return echo duration in us (refer to digram above)
00009 int US100::echo_duration()
00010 {
00011     timer.reset();
00012     trig = 0;
00013     wait_us(10);
00014     trig = 1;
00015     wait_us(10);
00016     trig = 0;
00017     while(echo == 0);
00018     timer.start();
00019     while(echo == 1);
00020     timer.stop();
00021     return timer.read_us();
00022 }
00023 
00024 int US100::distance()
00025 {
00026 int duration = echo_duration();
00027 int distacne_mm = duration*0.34/2/10;
00028 return distacne_mm;
00029 }