Diff: main.cpp

Revision:

2:f570ff03fb81

Parent:

1:e54ded4af43a

Child:

3:7777bbcf11f6

--- a/main.cpp	Wed Aug 08 21:44:33 2018 +0000
+++ b/main.cpp	Thu Aug 09 18:12:38 2018 +0000
@@ -1,78 +1,25 @@
 #include "mbed.h"
 #include "VL53L1X.h"
-void resetPin(int pin);
 
 Serial pc(USBTX,USBRX);
 
-bool s1_init = false;
-bool s2_init = false;
-bool s3_init = false;
-bool s4_init = false;
-
 VL53L1X sensor1(D14, D15, D0);
 VL53L1X sensor2(D14, D15, D1);
 VL53L1X sensor3(D14, D15, D2);
 VL53L1X sensor4(D14, D15, D3);
 
-int count = 0;
 int main()
-{
-    sensor1.turnOff();
-    sensor2.turnOff();
-    sensor3.turnOff();
-    sensor4.turnOff();
-    if (sensor2.initReading(0x25, 25000))
-    {
-        s2_init = true;
-    } 
-    if (sensor1.initReading(0x27, 25000))
-    {
-        s1_init = true;
-    }
-    if (sensor3.initReading(0x35, 25000))
-    {
-        s3_init = true;
-    }        
-    if (sensor4.initReading(0x37, 50000))
-    {
-        s4_init = true;
-    }    
-    while(1)
-    {  
+{  
+    sensor1.initReading(0x25,25000);
+    sensor2.initReading(0x27,25000);
+    sensor3.initReading(0x35,25000);
+    sensor4.initReading(0x37,25000);
 
-        sensor1.startContinuous(50);
-        sensor2.startContinuous(50);
-        sensor3.startContinuous(50);
-        sensor4.startContinuous(50);
-
-      if (s1_init)
-        pc.printf("%d", sensor1.read());
-      else 
-        pc.printf("-1");
-    
-      pc.printf(",");
-      
-      if (s2_init)
-        pc.printf("%d", sensor2.read());
-      else pc.printf("-1");
-
-      pc.printf(",");
-      
-      if (s3_init)
-        pc.printf("%d", sensor3.read());
-      else pc.printf("-1");      
-      
-      pc.printf(",");
-      
-      if (s4_init)
-        pc.printf("%d", sensor4.read());
-      else pc.printf("-1");
-        
-      pc.printf("\r\n");
-      sensor1.stopContinuous();
-      sensor2.stopContinuous();
-      sensor3.stopContinuous();
-      sensor4.stopContinuous();
-      wait(.02);
+    while(1)
+    {       
+      pc.printf("%d, ", sensor1.readFromOneSensor());
+      pc.printf("%d, ", sensor2.readFromOneSensor());
+      pc.printf("%d, ", sensor3.readFromOneSensor());
+      pc.printf("%d, \r\n", sensor4.readFromOneSensor()); 
     }
 }