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]);
    }
}