Skip to content

Commit

Permalink
Add begin and end APIs and improve library
Browse files Browse the repository at this point in the history
  • Loading branch information
@cparata
cparata committed Jan 28, 2021
1 parent c4fb917 commit 0a33856
Show file tree
Hide file tree
Showing 8 changed files with 226 additions and 211 deletions.
73 changes: 35 additions & 38 deletions examples/X_NUCLEO_53L0A1_Gesture_DirSwipe/X_NUCLEO_53L0A1_Gesture_DirSwipe.ino
View file
Original file line number Diff line number Diff line change
Expand Up @@ -72,12 +72,12 @@
#endif

// Components.
STMPE1600DigiOut *xshutdown_top;
STMPE1600DigiOut *xshutdown_left;
STMPE1600DigiOut *xshutdown_right;
VL53L0X_X_NUCLEO_53L0A1 *sensor_vl53l0x_top;
VL53L0X_X_NUCLEO_53L0A1 *sensor_vl53l0x_left;
VL53L0X_X_NUCLEO_53L0A1 *sensor_vl53l0x_right;
STMPE1600DigiOut xshutdown_top(&DEV_I2C, GPIO_15, (0x42 * 2));
STMPE1600DigiOut xshutdown_left(&DEV_I2C, GPIO_14, (0x43 * 2));
STMPE1600DigiOut xshutdown_right(&DEV_I2C, GPIO_15, (0x43 * 2));
VL53L0X_X_NUCLEO_53L0A1 sensor_vl53l0x_top(&DEV_I2C, &xshutdown_top);
VL53L0X_X_NUCLEO_53L0A1 sensor_vl53l0x_left(&DEV_I2C, &xshutdown_left);
VL53L0X_X_NUCLEO_53L0A1 sensor_vl53l0x_right(&DEV_I2C, &xshutdown_right);

// Gesture structure.
Gesture_DIRSWIPE_1_Data_t gestureDirSwipeData;
Expand All @@ -95,52 +95,52 @@ void SetupSingleShot(void){
uint32_t refSpadCount;
uint8_t isApertureSpads;

status = sensor_vl53l0x_left->StaticInit();
status = sensor_vl53l0x_left.StaticInit();
if( status ){
SerialPort.println("StaticInit left sensor failed");
}

status = sensor_vl53l0x_left->PerformRefCalibration(&VhvSettings, &PhaseCal);
status = sensor_vl53l0x_left.PerformRefCalibration(&VhvSettings, &PhaseCal);
if( status ){
SerialPort.println("PerformRefCalibration left sensor failed");
}

status = sensor_vl53l0x_left->PerformRefSpadManagement(&refSpadCount, &isApertureSpads);
status = sensor_vl53l0x_left.PerformRefSpadManagement(&refSpadCount, &isApertureSpads);
if( status ){
SerialPort.println("PerformRefSpadManagement left sensor failed");
}

status = sensor_vl53l0x_left->SetDeviceMode(VL53L0X_DEVICEMODE_SINGLE_RANGING); // Setup in single ranging mode
status = sensor_vl53l0x_left.SetDeviceMode(VL53L0X_DEVICEMODE_SINGLE_RANGING); // Setup in single ranging mode
if( status ){
SerialPort.println("SetDeviceMode left sensor failed");
}

status = sensor_vl53l0x_left->SetMeasurementTimingBudgetMicroSeconds(20*1000);
status = sensor_vl53l0x_left.SetMeasurementTimingBudgetMicroSeconds(20*1000);
if( status ){
SerialPort.println("SetMeasurementTimingBudgetMicroSeconds left sensor failed");
}

status = sensor_vl53l0x_right->StaticInit();
status = sensor_vl53l0x_right.StaticInit();
if( status ){
SerialPort.println("StaticInit right sensor failed");
}

status = sensor_vl53l0x_right->PerformRefCalibration(&VhvSettings, &PhaseCal);
status = sensor_vl53l0x_right.PerformRefCalibration(&VhvSettings, &PhaseCal);
if( status ){
SerialPort.println("PerformRefCalibration right sensor failed");
}

status = sensor_vl53l0x_right->PerformRefSpadManagement(&refSpadCount, &isApertureSpads);
status = sensor_vl53l0x_right.PerformRefSpadManagement(&refSpadCount, &isApertureSpads);
if( status ){
SerialPort.println("PerformRefSpadManagement right sensor failed");
}

status = sensor_vl53l0x_right->SetDeviceMode(VL53L0X_DEVICEMODE_SINGLE_RANGING); // Setup in single ranging mode
status = sensor_vl53l0x_right.SetDeviceMode(VL53L0X_DEVICEMODE_SINGLE_RANGING); // Setup in single ranging mode
if( status ){
SerialPort.println("SetDeviceMode right sensor failed");
}

status = sensor_vl53l0x_right->SetMeasurementTimingBudgetMicroSeconds(20*1000);
status = sensor_vl53l0x_right.SetMeasurementTimingBudgetMicroSeconds(20*1000);
if( status ){
SerialPort.println("SetMeasurementTimingBudgetMicroSeconds right sensor failed");
}
Expand Down Expand Up @@ -180,36 +180,33 @@ void setup() {
DEV_I2C.begin();
DEV_I2C.setClock(400000);

// Create VL53L0X top component.
xshutdown_top = new STMPE1600DigiOut(&DEV_I2C, GPIO_15, (0x42 * 2));
sensor_vl53l0x_top = new VL53L0X_X_NUCLEO_53L0A1(&DEV_I2C, xshutdown_top, A2);
// Configure VL53L0X top component.
sensor_vl53l0x_top.begin();

// Switch off VL53L0X top component.
sensor_vl53l0x_top->VL53L0X_Off();
sensor_vl53l0x_top.VL53L0X_Off();

// Create (if present) VL53L0X left component.
xshutdown_left = new STMPE1600DigiOut(&DEV_I2C, GPIO_14, (0x43 * 2));
sensor_vl53l0x_left = new VL53L0X_X_NUCLEO_53L0A1(&DEV_I2C, xshutdown_left, D8);
// Configure (if present) VL53L0X left component.
sensor_vl53l0x_left.begin();

// Switch off (if present) VL53L0X left component.
sensor_vl53l0x_left->VL53L0X_Off();
sensor_vl53l0x_left.VL53L0X_Off();

// Create (if present) VL53L0X right component.
xshutdown_right = new STMPE1600DigiOut(&DEV_I2C, GPIO_15, (0x43 * 2));
sensor_vl53l0x_right = new VL53L0X_X_NUCLEO_53L0A1(&DEV_I2C, xshutdown_right, D2);
// Configure (if present) VL53L0X right component.
sensor_vl53l0x_right.begin();

// Switch off (if present) VL53L0X right component.
sensor_vl53l0x_right->VL53L0X_Off();
sensor_vl53l0x_right.VL53L0X_Off();

// Initialize VL53L0X left component.
status = sensor_vl53l0x_left->InitSensor(0x12);
status = sensor_vl53l0x_left.InitSensor(0x12);
if(status)
{
SerialPort.println("Init sensor_vl53l0x_left failed...");
}

// Initialize VL53L0X right component.
status = sensor_vl53l0x_right->InitSensor(0x14);
status = sensor_vl53l0x_right.InitSensor(0x14);
if(status)
{
SerialPort.println("Init sensor_vl53l0x_right failed...");
Expand All @@ -227,8 +224,8 @@ void setup() {
void loop() {
int gesture_code;

sensor_vl53l0x_left->StartMeasurement();
sensor_vl53l0x_right->StartMeasurement();
sensor_vl53l0x_left.StartMeasurement();
sensor_vl53l0x_right.StartMeasurement();

int left_done = 0;
int right_done = 0;
Expand All @@ -240,20 +237,20 @@ void loop() {
if(left_done == 0)
{
NewDataReady = 0;
int status = sensor_vl53l0x_left->GetMeasurementDataReady(&NewDataReady);
int status = sensor_vl53l0x_left.GetMeasurementDataReady(&NewDataReady);

if( status ){
SerialPort.println("GetMeasurementDataReady left sensor failed");
}

if(NewDataReady)
{
status = sensor_vl53l0x_left->ClearInterruptMask(0);
status = sensor_vl53l0x_left.ClearInterruptMask(0);
if( status ){
SerialPort.println("ClearInterruptMask left sensor failed");
}

status = sensor_vl53l0x_left->GetRangingMeasurementData(&pRangingMeasurementData);
status = sensor_vl53l0x_left.GetRangingMeasurementData(&pRangingMeasurementData);
if( status ){
SerialPort.println("GetRangingMeasurementData left sensor failed");
}
Expand All @@ -272,20 +269,20 @@ void loop() {
if(right_done == 0)
{
NewDataReady = 0;
int status = sensor_vl53l0x_right->GetMeasurementDataReady(&NewDataReady);
int status = sensor_vl53l0x_right.GetMeasurementDataReady(&NewDataReady);

if( status ){
SerialPort.println("GetMeasurementDataReady right sensor failed");
}

if(NewDataReady)
{
status = sensor_vl53l0x_right->ClearInterruptMask(0);
status = sensor_vl53l0x_right.ClearInterruptMask(0);
if( status ){
SerialPort.println("ClearInterruptMask right sensor failed");
}

status = sensor_vl53l0x_right->GetRangingMeasurementData(&pRangingMeasurementData);
status = sensor_vl53l0x_right.GetRangingMeasurementData(&pRangingMeasurementData);
if( status ){
SerialPort.println("GetRangingMeasurementData right sensor failed");
}
Expand Down
53 changes: 25 additions & 28 deletions examples/X_NUCLEO_53L0A1_Gesture_Swipe1/X_NUCLEO_53L0A1_Gesture_Swipe1.ino
View file
Original file line number Diff line number Diff line change
Expand Up @@ -72,12 +72,12 @@
#endif

// Components.
STMPE1600DigiOut *xshutdown_top;
STMPE1600DigiOut *xshutdown_left;
STMPE1600DigiOut *xshutdown_right;
VL53L0X_X_NUCLEO_53L0A1 *sensor_vl53l0x_top;
VL53L0X_X_NUCLEO_53L0A1 *sensor_vl53l0x_left;
VL53L0X_X_NUCLEO_53L0A1 *sensor_vl53l0x_right;
STMPE1600DigiOut xshutdown_top(&DEV_I2C, GPIO_15, (0x42 * 2));
STMPE1600DigiOut xshutdown_left(&DEV_I2C, GPIO_14, (0x43 * 2));
STMPE1600DigiOut xshutdown_right(&DEV_I2C, GPIO_15, (0x43 * 2));
VL53L0X_X_NUCLEO_53L0A1 sensor_vl53l0x_top(&DEV_I2C, &xshutdown_top);
VL53L0X_X_NUCLEO_53L0A1 sensor_vl53l0x_left(&DEV_I2C, &xshutdown_left);
VL53L0X_X_NUCLEO_53L0A1 sensor_vl53l0x_right(&DEV_I2C, &xshutdown_right);

// Gesture structure.
Gesture_SWIPE_1_Data_t gestureSwipeData;
Expand All @@ -95,27 +95,27 @@ void SetupSingleShot(void){
uint32_t refSpadCount;
uint8_t isApertureSpads;

status = sensor_vl53l0x_top->StaticInit();
status = sensor_vl53l0x_top.StaticInit();
if( status ){
SerialPort.println("StaticInit top sensor failed");
}

status = sensor_vl53l0x_top->PerformRefCalibration(&VhvSettings, &PhaseCal);
status = sensor_vl53l0x_top.PerformRefCalibration(&VhvSettings, &PhaseCal);
if( status ){
SerialPort.println("PerformRefCalibration top sensor failed");
}

status = sensor_vl53l0x_top->PerformRefSpadManagement(&refSpadCount, &isApertureSpads);
status = sensor_vl53l0x_top.PerformRefSpadManagement(&refSpadCount, &isApertureSpads);
if( status ){
SerialPort.println("PerformRefSpadManagement top sensor failed");
}

status = sensor_vl53l0x_top->SetDeviceMode(VL53L0X_DEVICEMODE_SINGLE_RANGING); // Setup in single ranging mode
status = sensor_vl53l0x_top.SetDeviceMode(VL53L0X_DEVICEMODE_SINGLE_RANGING); // Setup in single ranging mode
if( status ){
SerialPort.println("SetDeviceMode top sensor failed");
}

status = sensor_vl53l0x_top->SetMeasurementTimingBudgetMicroSeconds(20*1000);
status = sensor_vl53l0x_top.SetMeasurementTimingBudgetMicroSeconds(20*1000);
if( status ){
SerialPort.println("SetMeasurementTimingBudgetMicroSeconds top sensor failed");
}
Expand Down Expand Up @@ -154,29 +154,26 @@ void setup() {
// Initialize I2C bus.
DEV_I2C.begin();

// Create VL53L0X top component.
xshutdown_top = new STMPE1600DigiOut(&DEV_I2C, GPIO_15, (0x42 * 2));
sensor_vl53l0x_top = new VL53L0X_X_NUCLEO_53L0A1(&DEV_I2C, xshutdown_top, A2);
// Configure VL53L0X top component.
sensor_vl53l0x_top.begin();

// Switch off VL53L0X top component.
sensor_vl53l0x_top->VL53L0X_Off();
sensor_vl53l0x_top.VL53L0X_Off();

// Create (if present) VL53L0X left component.
xshutdown_left = new STMPE1600DigiOut(&DEV_I2C, GPIO_14, (0x43 * 2));
sensor_vl53l0x_left = new VL53L0X_X_NUCLEO_53L0A1(&DEV_I2C, xshutdown_left, D8);
// Configure (if present) VL53L0X left component.
sensor_vl53l0x_left.begin();

// Switch off (if present) VL53L0X left component.
sensor_vl53l0x_left->VL53L0X_Off();
sensor_vl53l0x_left.VL53L0X_Off();

// Create (if present) VL53L0X right component.
xshutdown_right = new STMPE1600DigiOut(&DEV_I2C, GPIO_15, (0x43 * 2));
sensor_vl53l0x_right = new VL53L0X_X_NUCLEO_53L0A1(&DEV_I2C, xshutdown_right, D2);
// Configure (if present) VL53L0X right component.
sensor_vl53l0x_right.begin();

// Switch off (if present) VL53L0X right component.
sensor_vl53l0x_right->VL53L0X_Off();
sensor_vl53l0x_right.VL53L0X_Off();

// Initialize VL53L0X top component.
status = sensor_vl53l0x_top->InitSensor(0x10);
status = sensor_vl53l0x_top.InitSensor(0x10);
if(status)
{
SerialPort.println("Init sensor_vl53l0x_top failed...");
Expand All @@ -194,7 +191,7 @@ void setup() {
void loop() {
int gesture_code;

sensor_vl53l0x_top->StartMeasurement();
sensor_vl53l0x_top.StartMeasurement();

int top_done = 0;
uint8_t NewDataReady=0;
Expand All @@ -205,20 +202,20 @@ void loop() {
if(top_done == 0)
{
NewDataReady = 0;
int status = sensor_vl53l0x_top->GetMeasurementDataReady(&NewDataReady);
int status = sensor_vl53l0x_top.GetMeasurementDataReady(&NewDataReady);

if( status ){
SerialPort.println("GetMeasurementDataReady top sensor failed");
}

if(NewDataReady)
{
status = sensor_vl53l0x_top->ClearInterruptMask(0);
status = sensor_vl53l0x_top.ClearInterruptMask(0);
if( status ){
SerialPort.println("ClearInterruptMask top sensor failed");
}

status = sensor_vl53l0x_top->GetRangingMeasurementData(&pRangingMeasurementData);
status = sensor_vl53l0x_top.GetRangingMeasurementData(&pRangingMeasurementData);
if( status ){
SerialPort.println("GetRangingMeasurementData top sensor failed");
}
Expand Down
Loading

0 comments on commit 0a33856

Please sign in to comment.