test

Dependencies:   mbed

Fork of HelloWorld_53L0A1 by ST

main.cpp

Committer:
zero515
Date:
2017-02-01
Revision:
8:5f1b4151c9e4
Parent:
7:e30d35831e6c
Child:
9:fd46a7024326

File content as of revision 8:5f1b4151c9e4:

#include "mbed.h"
#include "x_nucleo_53l0a1.h"
#include <stdio.h>

#define VL53L0_I2C_SDA   D4 
#define VL53L0_I2C_SCL   D5 

static X_NUCLEO_53L0A1 *board=NULL;
Serial pc(USBTX, USBRX);


int main()
{   
   int status,i,add,ds[12];
   uint32_t distance;
   pc.baud(115200);

   DevI2C *device_i2c =new DevI2C(VL53L0_I2C_SDA, VL53L0_I2C_SCL);     
        
   board=X_NUCLEO_53L0A1::Instance(device_i2c, A2, D8, D2);

   status=board->InitBoard();
   if(status) { printf("Failed to init board!\n\r"); return 0; }
   
   for(i = 0; i <= 10; i++) {
       ds[i] = 0;
    }

   while(1)
   {
       for(i = 0; i <= 9; i++) {
           ds[i] = ds [i+1];
           }
       status = board->sensor_centre->GetDistance(&distance);
       ds[9] = distance;
       if(ds[9] == 0){
           ds[9] = ds[8];
           }
       for(i = 0; i <= 9; i++) {
           add = ds[i] + add;
           }
       add = add/10;
       printf("%d\n\r", add);
   }

}