Diff: main.cpp

Revision:

4:a9362bc0597a

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Tue Jul 24 17:41:28 2018 +0000
@@ -0,0 +1,36 @@
+#include "mbed.h"
+#include "VL53L1X.h"
+
+VL53L1X L(D14, D15);
+Serial pc(USBTX, USBRX);
+
+int main(){
+    uint16_t d, sr;
+    uint8_t rs;
+    int r;
+    // LED1 will blink if returns wrong Model ID
+    // Blinking LED2 related to firmware 
+    while (L.begin() == false){
+        pc.printf("Sensor offline!\n");
+        wait_ms(10);
+    }
+    
+    pc.printf("Sensor online!\n");
+    L.newDataReady();
+    
+    while(1){
+        L.softReset();
+        r = L.newDataReady();
+        
+        if(r){   
+            L.setDistanceMode(2);
+            d = L.getDistance();
+            sr = L.getSignalRate();
+            rs = L.getRangeStatus();
+            pc.printf("newDataReady?: %d, Distance (mm): %d, SignalRate: %d, RangeStatus: %d\n", r, d, sr, rs);
+        }
+        
+        wait_ms(500);
+    }
+    
+}
\ No newline at end of file