Detected people approaching if the distance is < 6 feet then LEDs blinking RED otherwise LEDs light green.
Dependencies: mbed X_NUCLEO_53L1A1_mbed WS2812
Diff: main_copy.txt
- Revision:
- 2:28ca549860f6
- Parent:
- 1:092ee96f479a
diff -r 092ee96f479a -r 28ca549860f6 main_copy.txt --- a/main_copy.txt Sun Nov 01 20:23:28 2020 +0000 +++ /dev/null Thu Jan 01 00:00:00 1970 +0000 @@ -1,217 +0,0 @@ -/* - * This VL53L1X satellite board sample application performs range measurements - * with interrupts enabled to generate a hardware interrupt each time a new - * measurement is ready to be read. - * - * Measured ranges are output on the Serial Port, running at 115200 baud. - * - * On STM32-Nucleo boards : - * The User Blue button stops the current measurement and entire program, - * releasing all resources. - * - * The Black Reset button is used to restart the program. - * - * *** NOTE : By default hardlinks U10, U11, U15 & U18, on the underside of - * the X-NUCELO-53L1A1 expansion board are not made/OFF. - * These links must be made to allow interrupts from the Satellite boards - * to be received. - * U11 and U18 must be made/ON to allow interrupts to be received from the - * INT_L & INT_R positions; or - * U10 and U15 must be made/ON to allow interrupts to be received from the - * Alternate INT_L & INT_R positions. - * The X_NUCLEO_53L1A1 firmware library defaults to use the INT_L/INT_R - * positions. - * INT_L is available on expansion board Arduino Connector CN5, pin 1 as D9. - * Alternate INT_L is on CN5 Connector pin 2 as D8. - * INT_R is available on expansion board Arduino Connector CN9, pin 3 as D4. - * Alternate INT_R is on CN9 Connector pin 5 as D2. - * The pinouts are shown here : https://developer.mbed.org/components/X-NUCLEO-53L1A1/ - */ - -#include <stdio.h> - -#include "mbed.h" -#include "VL53L1X_I2C.h" -#include "VL53L1X_Class.h" -#include "LED_WS2812.h" - -#define VL53L1_I2C_SDA D14 -#define VL53L1_I2C_SCL D15 - -#if TARGET_STM // we are cross compiling for an STM32-Nucleo - InterruptIn stop_button(USER_BUTTON); -#endif -#if TARGET_Freescale // we are cross-compiling for NXP FRDM boards. - InterruptIn stop_button(SW2); -#endif - -static VL53L1X *sensor = NULL; -Serial pc(SERIAL_TX, SERIAL_RX); - -/* flags that handle interrupt request for sensor and user blue button*/ -volatile bool int_sensor = false; -volatile bool int_stop = false; - - -/* ISR callback function of the sensor */ -void sensor_irq(void) -{ - int_sensor = true; - sensor->disable_interrupt_measure_detection_irq(); -} - -/* ISR callback function of the user blue button to switch measuring sensor. */ -void measuring_stop_irq(void) -{ - int_stop = true; -} - -/* Start the sensor ranging */ -int start_ranging() -{ - int status = 0; - /* start the measure on the sensor */ - if (NULL != sensor) { - status = sensor->stop_measurement(); - if (status != 0) { - return status; - } - - status = sensor->start_measurement(&sensor_irq); - if (status != 0) { - return status; - } - } - return status; -} - -int range_measure(VL53L1X_DevI2C *device_i2c) -{ - int status = 0; - uint16_t distance = 0; - /* Create a xshutdown pin */ - DigitalOut xshutdown(D7); - - - /* create instance of sensor class */ - sensor = new VL53L1X(device_i2c, &xshutdown, A2); - - sensor->vl53l1_off(); - /* initialise sensor */ - sensor->init_sensor(0x52); - - if (status) { - delete sensor; - sensor= NULL; - printf("Sensor centre not present\n\r"); - } - - /* init an array with chars to id the sensors */ - status = start_ranging(); - if (status != 0) { - printf("Failed to start ranging!\r\n"); - return status; - } - - if (NULL != sensor) { - printf("Entering loop mode\r\n"); - /* Main ranging interrupt loop */ - while (true) { - if (int_sensor) { - int_sensor = false; - status = sensor->handle_irq(&distance); - printf("distance: %d\r\n", distance); - } - - if (int_stop) { - printf("\r\nEnding loop mode \r\n"); - break; - } - } - } - - return status; - -} - - -int range_threshold(VL53L1X_DevI2C *device_i2c) -{ - int status = 0; - uint16_t distance = 0; - /* Create a xshutdown pin */ - DigitalOut xshutdown(D7); - - LED_WS2812 LED(A3,4); - LED.SetIntensity(25); - LED.SetColor(1,BLACK); - - /* create instance of sensor class */ - sensor = new VL53L1X(device_i2c, &xshutdown, A2); - - sensor->vl53l1_off(); - /* initialise sensor */ - sensor->init_sensor(0x52); - - if (status) { - delete sensor; - sensor= NULL; - printf("Sensor centre not present\n\r"); - } - - status = sensor->vl53l1x_set_inter_measurement_in_ms(1000); - status = sensor->vl53l1x_set_distance_threshold(1000, - 1000, 0, 0); - status = start_ranging(); - if (status != 0) { - printf("Failed to start ranging!\r\n"); - return status; - } - - if (NULL != sensor) { - printf("Entering loop mode\r\n"); - /* Main ranging interrupt loop */ - while (true) { - LED.SetColor(GREEN); - printf("BLACK\n"); - if (int_sensor) { - LED.SetColor(RED); - wait(1); - printf("RED\n"); - int_sensor = false; - status = sensor->handle_irq(&distance); - printf("distance: %d\r\n", distance); - - } - if (int_stop) { - printf("\r\nEnding loop mode \r\n"); - break; - } - } - } - - return status; - -} - -// -// -//int range_threshold(VL53L1X_DevI2C *device_i2c) -//{ -// printf("toto"); -// return 0; -//} - - -/*=================================== Main ================================== -=============================================================================*/ -int main() -{ - stop_button.rise(&measuring_stop_irq); - - VL53L1X_DevI2C *device_i2c = new VL53L1X_DevI2C(VL53L1_I2C_SDA, VL53L1_I2C_SCL); -// range_measure(device_i2c); // start continuous measures - range_threshold(device_i2c); - - return 0; -}