This is my innit that works when changing only the resolution right now:
#define NUMDEVICES 2//6
/* Define a configuration for every device you connect*/
VL53L5CX_Configuration devs[NUMDEVICES];
/* Define a 7-bit address for each tof sensor */
const uint8_t deviceAddresses[NUMDEVICES] = {0x54, 0x55};
GPIO_TypeDef* VL53L5CXLpnPorts[NUMDEVICES] = { // will be gone with extender
VL53L5CXLpn0_GPIO_Port,
VL53L5CXLpn1_GPIO_Port
};
uint16_t VL53L5CXLpnPins[NUMDEVICES] = { // will be gone with extender
VL53L5CXLpn0_Pin,
VL53L5CXLpn1_Pin
};
/* statuses of the sensor for error tracking */
uint8_t status, isAlive, dataIsReady;
/* The resolution used can be chosen between 4x4 and 8x8. */
const uint8_t resolution = VL53L5CX_RESOLUTION_4X4;
void initializeVL53L5X() {
for (int i = 0; i < NUMDEVICES; i++) { // Assume NUMDEVICES is defined as the number of devices
// Power on the sensor by setting the LPN pin high
HAL_GPIO_WritePin(VL53L5CXLpnPorts[i], VL53L5CXLpnPins[i], GPIO_PIN_SET);
HAL_Delay(15); // Allow time for the sensor to stabilize
devs[i].platform.address = VL53L5CX_DEFAULT_I2C_ADDRESS;
status = vl53l5cx_is_alive(&devs[i], &isAlive);
if (status != VL53L5CX_STATUS_OK || !isAlive) {
cout << status << endline;
cout << "sensor not alive on device " << i << "." << endline;
Error_Handler();
} else {
cout << "sensor is alive on device " << i << endline;
}
status = vl53l5cx_init(&devs[i]);
if (status != VL53L5CX_STATUS_OK) {
cout << "Failed to initialize VL53L5CX on device " << i << ", status: " << status << endline;
Error_Handler();
} else {
cout << "VL53L5CX initialized successfully on device " << i << endline;
}
status = vl53l5cx_set_i2c_address(&devs[i], deviceAddresses[i]);
if (status != VL53L5CX_STATUS_OK) {
cout << "Failed to set I2C address on device " << i << ", status: " << status << endline;
Error_Handler();
} else {
cout << "I2C address set to " << deviceAddresses[i] << " for device " << i << endline;
}
status = vl53l5cx_set_resolution(&devs[i], resolution);
status = vl53l5cx_set_ranging_frequency_hz(&devs[i], 15);
status = vl53l5cx_start_ranging(&devs[i]);
if (status) {
cout << "Start Ranging Failed on device " << i << endline;
}
// Power off the sensor by setting the LPN pin low after initialization
HAL_GPIO_WritePin(VL53L5CXLpnPorts[i], VL53L5CXLpnPins[i], GPIO_PIN_RESET);
HAL_Delay(15); // Allow time for the sensor to stabilize
}
}
I only don't understand what you mean with checking zones for targets? For now i just want to print the values, but as seen in my original post, it stops ranging with that error just past halfway the measurement.
