
test
Dependencies: MbedJSONValue DISCO_L475VG_IOT01A_wifi mbed-http
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 }
Generated on Mon Jul 18 2022 16:40:03 by
