electronics-lab / Mbed 2 deprecated ultra-sonic-sensorII

mbed.hだけで超音波センサの制御できるかも

Dependencies:   mbed

Diff: main.cpp

Revision:
0:05cd466c355a
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Wed Mar 28 10:08:10 2018 +0000
@@ -0,0 +1,34 @@
+#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);
+    }
+}