S2Project final failed code
Dependencies: QEI TB6612 VL53L0X
Diff: main.cpp
- Revision:
- 0:bcce413163a4
- Child:
- 1:2173f1dbfe1c
diff -r 000000000000 -r bcce413163a4 main.cpp --- /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