S2Project final failed code
Dependencies: QEI TB6612 VL53L0X
main.cpp
- Committer:
- sas638
- Date:
- 2022-01-27
- Revision:
- 0:bcce413163a4
- Child:
- 1:2173f1dbfe1c
File content as of revision 0:bcce413163a4:
/* 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]); } }