Diff: main.cpp

Revision:

0:bcce413163a4

Child:

1:2173f1dbfe1c

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Thu Jan 27 22:46:00 2022 +0000
@@ -0,0 +1,39 @@
+/* mbed Microcontroller Library
+ * Copyright (c) 2019 ARM Limited
+ * SPDX-License-Identifier: Apache-2.0
+ */
+#include "mbed.h"
+#include "VL53L0X.h"
+#include "tb6612.h"
+
+I2C         i2c(D14, D15);
+VL53L0X     vl_sensors[2] = {(&i2c),(&i2c)};
+BusOut      vl_shutdown(D11,D12);
+Serial      usb(USBTX, USBRX, 115200);
+TB6612 motorL(D8,D9,D10);
+TB6612 motorR(D3,D4,D5);
+
+int main()
+{
+    motorL.setSpeed(1.00);
+    motorR.setSpeed(1.00);
+    
+    usb.printf("Multiple VL53L0X\n\n\r");
+
+    uint8_t expander_shutdown_mask = 1;
+    for(uint8_t i = 0; i < 2 ; i++) {
+        vl_shutdown = expander_shutdown_mask;
+        expander_shutdown_mask = (expander_shutdown_mask << 1) + 1;
+        vl_sensors[i].init();
+        vl_sensors[i].setDeviceAddress(0x40 + i);
+        vl_sensors[i].setModeContinuous();
+        vl_sensors[i].startContinuous();
+    }
+    uint16_t results[2];
+    while(1) {
+        for(uint8_t i = 0; i < 2 ; i++) {
+            results[i] = vl_sensors[i].getRangeMillimeters();
+        }
+        usb.printf("1: %4imm 2: %4imm\n\r", results[0], results[1]);
+    }
+}
\ No newline at end of file