main.cpp

00001 #include "mbed.h"
00002 #include "XNucleo53L0A1.h"
00003 #include <stdio.h>
00004 
00005 #define VL53L0_I2C_SDA   D14 
00006 #define VL53L0_I2C_SCL   D15 
00007 
00008 static XNucleo53L0A1 *board=NULL;
00009 
00010 
00011 int main()
00012 {
00013     
00014     DevI2C *device_i2c = new DevI2C(VL53L0_I2C_SDA, VL53L0_I2C_SCL);
00015     
00016     /* creates the 53L0A1 expansion board singleton obj */
00017     board = XNucleo53L0A1::instance(device_i2c, A2, D8, D2);
00018 
00019     /* init the 53L0A1 expansion board with default values */
00020     status = board->init_board();
00021     if (status) {
00022         printf("Failed to init board!\r\n");
00023         return 0;
00024     }
00025 
00026    while (1) {
00027         status = board->sensor_centre->get_distance(&distance);
00028         if (status == VL53L0X_ERROR_NONE) {
00029            printf("Distance : %ld\r\n", distance);
00030         }
00031    }
00032 }