#include <platform.h>
#include <platform_config.h>
#include <platform_config_default.h>
#include <vl53l5cx_api.h>
#include <vl53l5cx_buffers.h>
#include <vl53l5cx_class.h>
#include <vl53l5cx_plugin_detection_thresholds.h>
#include <vl53l5cx_plugin_motion_indicator.h>
#include <vl53l5cx_plugin_xtalk.h>
/**
******************************************************************************
* @file VL53L5CX_Sat_HelloWorld.ino
* @author STMicroelectronics
* @version V1.0.0
* @date 11 November 2021
* @brief Arduino test application for the STMicrolectronics VL53L5CX
* proximity sensor satellite based on FlightSense.
* This application makes use of C++ classes obtained from the C
* components' drivers.
******************************************************************************
* @attention
*
* <h2><center>© COPYRIGHT(c) 2021 STMicroelectronics</center></h2>
*
* Redistribution and use in source and binary forms, with or without modification,
* are permitted provided that the following conditions are met:
* 1. Redistributions of source code must retain the above copyright notice,
* this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright notice,
* this list of conditions and the following disclaimer in the documentation
* and/or other materials provided with the distribution.
* 3. Neither the name of STMicroelectronics nor the names of its contributors
* may be used to endorse or promote products derived from this software
* without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
* DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
* SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
* CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
* OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
* OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*
******************************************************************************
*/
/*
* To use these examples you need to connect the VL53L5CX satellite sensor directly to the Nucleo board with wires as explained below:
* pin 1 (GND) of the VL53L5CX satellite connected to GND of the Nucleo board
* pin 2 (IOVDD) of the VL53L5CX satellite connected to 3V3 pin of the Nucleo board
* pin 3 (AVDD) of the VL53L5CX satellite connected to 5V pin of the Nucleo board
* pin 4 (PWREN) of the VL53L5CX satellite connected to pin A5-A0 of the Nucleo board
* pin 5 (LPn) of the VL53L5CX satellite connected to pin A3 of the Nucleo board
* pin 6 (SCL) of the VL53L5CX satellite connected to pin D15 (SCL) of the Nucleo board
* pin 7 (SDA) of the VL53L5CX satellite connected to pin D14 (SDA) of the Nucleo board
* pin 8 (I2C_RST) of the VL53L5CX satellite connected to pin A1 of the Nucleo board
* pin 9 (INT) of the VL53L5CX satellite connected to pin A2 of the Nucleo board
*/
/* Includes ------------------------------------------------------------------*/
#include <vl53l5cx_class.h>
#include <string.h>
#include <stdlib.h>
#include <stdio.h>
#include <stdint.h>
#include <assert.h>
#include <stdlib.h>
#define DEV_I2C Wire1
#else
#endif
#define SerialPort Serial
#ifndef LED_BUILTIN
#define LED_BUILTIN 13
#endif
#define LedPin LED_BUILTIN
#define LPN_PIN A3
#define I2C_RST_PIN A1
#define PWREN_PIN A5
// Components.
VL53L5CX sensor_vl53l5cx_sat(&DEV_I2C, LPN_PIN, I2C_RST_PIN);
/* Setup ---------------------------------------------------------------------*/
void setup()
{
// Led.
pinMode(LedPin, OUTPUT);
// Enable PWREN pin if present
if (PWREN_PIN >= 0) {
pinMode(PWREN_PIN, OUTPUT);
digitalWrite(PWREN_PIN, HIGH);
delay(10);
}
// Initialize serial for output.
SerialPort.begin(115200);
SerialPort.println("Initialize... Please wait, it may take few seconds...");
// Initialize I2C bus.
DEV_I2C.begin();
DEV_I2C.setClock(1000000);
// Configure VL53L5CX satellite component.
sensor_vl53l5cx_sat.begin();
sensor_vl53l5cx_sat.init_sensor();
// Start Measurements
sensor_vl53l5cx_sat.vl53l5cx_set_resolution(VL53L5CX_RESOLUTION_8X8);
sensor_vl53l5cx_sat.vl53l5cx_set_ranging_frequency_hz(15);
sensor_vl53l5cx_sat.vl53l5cx_start_ranging();
}
void loop()
{
static uint8_t loop_count = 0;
VL53L5CX_ResultsData Results;
uint8_t NewDataReady = 0;
char report[64*2];
uint8_t status;
uint8_t banpei[] = {0xFF,0xFF};
do {
status = sensor_vl53l5cx_sat.vl53l5cx_check_data_ready(&NewDataReady);
} while (!NewDataReady);
//Led on
digitalWrite(LedPin, HIGH);
status = sensor_vl53l5cx_sat.vl53l5cx_get_ranging_data(&Results);
for(int i =0; i < 64; i++){
int index = i*2;
report[index] = Results.distance_mm[i] & 0x00FF;
report[index+1] = (Results.distance_mm[i] >> 8)& 0x00FF;
}
SerialPort.write(banpei, 2);//データ本体
SerialPort.write(report, 64*2);//データ本体
}
digitalWrite(LedPin, LOW);
}
可視化プログラムを作る
