Robot team project
Dependencies: QEI Motordriver ros_lib_melodic
main.cpp
- Committer:
- florine_van
- Date:
- 2019-10-22
- Revision:
- 3:a3144a45f44c
- Parent:
- 2:c537f1ebad7b
- Child:
- 4:cb50c6fa340b
File content as of revision 3:a3144a45f44c:
#include "mbed.h" #include "Sensor.h" // Set up serial to pc Serial pc(SERIAL_TX, SERIAL_RX); // Set up I²C on the STM32 NUCLEO-401RE #define addr1 (0x29) #define addr2 (0x2A) #define addr3 (0x2B) #define addr4 (0x2C) int main() { int range1; int range2; int range3; int range4; // Create sensors Sensor sensor1(I2C_SDA, I2C_SCL, PC_9); Sensor sensor2(I2C_SDA, I2C_SCL, PC_11); Sensor sensor3(I2C_SDA, I2C_SCL, PD_2); Sensor sensor4(I2C_SDA, I2C_SCL, PG_3); // load settings onto VL6180X sensors sensor2.init(); // change default address of sensor 2 sensor2.changeAddress(addr2); sensor3.init(); // change default address of sensor 3 sensor3.changeAddress(addr3); sensor4.init(); // change default address of sensor 4 sensor4.changeAddress(addr4); sensor1.init(); while (1) { range1 = sensor1.read(); range2 = sensor2.read(); range3 = sensor3.read(); range4 = sensor4.read(); pc.printf("Range one = %d | range two = %d | range three = %d | range four = %d\r\n",range1, range2, range3, range4); wait_ms(100); } }