36 lines
785 B
C++
36 lines
785 B
C++
#include <stdio.h>
|
|
#include "pico/stdlib.h"
|
|
#include "hardware/i2c.h"
|
|
#include "vl53l5cx.hpp"
|
|
#include "src/vl53l5cx_firmware.h"
|
|
|
|
#include "common/pimoroni_i2c.hpp"
|
|
|
|
using namespace pimoroni;
|
|
|
|
I2C i2c(4, 5);
|
|
VL53L5CX vl53l5cx(&i2c, (uint8_t *)&vl53l5cx_firmware_bin);
|
|
|
|
int main() {
|
|
stdio_init_all();
|
|
|
|
bool result = vl53l5cx.init();
|
|
if(!result) {
|
|
printf("Error initializing...\n");
|
|
}
|
|
vl53l5cx.set_ranging_mode(VL53L5CX::RANGING_MODE_AUTONOMOUS);
|
|
vl53l5cx.set_resolution(VL53L5CX::RESOLUTION_4X4);
|
|
vl53l5cx.start_ranging();
|
|
|
|
while(true) {
|
|
if(vl53l5cx.data_ready()) {
|
|
VL53L5CX::ResultsData result;
|
|
if(vl53l5cx.get_data(&result)) {
|
|
printf("Distance: %dmm\n", result.distance_mm[0]);
|
|
}
|
|
}
|
|
sleep_ms(20);
|
|
}
|
|
|
|
return 0;
|
|
} |