4180 Lab 2
Dependencies: mbed wave_player Servo 4DGL-uLCD-SE Motor SDFileSystem LSM9DS1_Library_cal PinDetect X_NUCLEO_53L0A1
sensor_EC.h
- Committer:
- emilywilson
- Date:
- 2020-02-04
- Revision:
- 2:de355b6fbd87
- Parent:
- 1:6d8f645530b8
File content as of revision 2:de355b6fbd87:
#include "mbed.h" #include "Servo.h" #include "XNucleo53L0A1.h" #include <stdio.h> Serial pc1(USBTX,USBRX); DigitalOut shdn(p26); // This VL53L0X board test application performs a range measurement in polling mode // Use 3.3(Vout) for Vin, p28 for SDA, p27 for SCL, P26 for shdn on mbed LPC1768 //I2C sensor pins #define VL53L0_I2C_SDA p28 #define VL53L0_I2C_SCL p27 static XNucleo53L0A1 *board=NULL; Servo servo(p9); int min_dist = 66536; int angle = 0; int run_sensor_EC() { int status; uint32_t distance; DevI2C *device_i2c = new DevI2C(VL53L0_I2C_SDA, VL53L0_I2C_SCL); /* creates the 53L0A1 expansion board singleton obj */ board = XNucleo53L0A1::instance(device_i2c, A2, D8, D2); shdn = 0; //must reset sensor for an mbed reset to work wait(0.1); shdn = 1; wait(0.1); /* init the 53L0A1 board with default values */ status = board->init_board(); while (status) { pc1.printf("Failed to init board! \r\n"); status = board->init_board(); } for (float i = 0.0; i < 1.0; i += 0.1) { status = board->sensor_centre->get_distance(&distance); if (status == VL53L0X_ERROR_NONE) { pc1.printf("D=%ld mm\r\n", distance); } if (distance < min_dist) { min_dist = distance; angle = i; } } return 0; }