VL53L0X test started

This commit is contained in:
Ollo 2023-03-22 20:02:23 +01:00
parent 712ef73a30
commit a0c657a418
2 changed files with 39 additions and 43 deletions

View File

@ -12,6 +12,5 @@
platform = espressif32 platform = espressif32
board = esp32doit-devkit-v1 board = esp32doit-devkit-v1
framework = arduino framework = arduino
lib_deps = OneWire lib_deps = pololu/VL53L0X@^1.3.1
DallasTemperature
build_flags = -DPIO_FRAMEWORK_ARDUINO_LWIP2_LOW_MEMORY -DBOOTLOADER_LOG_LEVEL_VERBOSE -DLOG_DEFAULT_LEVEL_VERBOSE -DCORE_DEBUG_LEVEL=5 build_flags = -DPIO_FRAMEWORK_ARDUINO_LWIP2_LOW_MEMORY -DBOOTLOADER_LOG_LEVEL_VERBOSE -DLOG_DEFAULT_LEVEL_VERBOSE -DCORE_DEBUG_LEVEL=5

View File

@ -1,61 +1,58 @@
#include <Arduino.h> #include <Arduino.h>
#include "driver/pcnt.h" #include "driver/pcnt.h"
#include <VL53L0X.h>
#define PWM_FREQ 50000
#define PWM_BITS 8
#define OUTPUT_SENSOR 14 #define OUTPUT_SENSOR 14
#define SENSOR_PLANT 17 #define SENSOR_PLANT 17
int16_t pulses = 0; VL53L0X tankSensor;
int16_t pulses2 = 0;
int plantId = 0;
void setup() {
RTC_SLOW_ATTR uint8_t tick = 0;
RTC_SLOW_ATTR bool dir = true;
void setup() void setup()
{ {
Serial.begin(115200); Serial.begin(115200);
pinMode(OUTPUT_SENSOR, OUTPUT); pinMode(OUTPUT_SENSOR, OUTPUT);
tankSensor.setTimeout(500);
ledcSetup(plantId, PWM_FREQ, PWM_BITS);
ledcAttachPin(SENSOR_PLANT, plantId);
ledcWrite(plantId, plantId);
pinMode(SENSOR_PLANT, INPUT);
pcnt_config_t pcnt_config = { }; // Instancia PCNT config
pcnt_unit_t unit = (pcnt_unit_t)(PCNT_UNIT_0 + plantId);
pcnt_config.pulse_gpio_num = SENSOR_PLANT; // Configura GPIO para entrada dos pulsos
pcnt_config.ctrl_gpio_num = PCNT_PIN_NOT_USED; // Configura GPIO para controle da contagem
pcnt_config.unit = unit; // Unidade de contagem PCNT - 0
pcnt_config.channel = PCNT_CHANNEL_0; // Canal de contagem PCNT - 0
pcnt_config.counter_h_lim = INT16_MAX; // Limite maximo de contagem - 20000
pcnt_config.pos_mode = PCNT_COUNT_INC; // Incrementa contagem na subida do pulso
pcnt_config.neg_mode = PCNT_COUNT_DIS; // Incrementa contagem na descida do pulso
pcnt_config.lctrl_mode = PCNT_MODE_KEEP; // PCNT - modo lctrl desabilitado
pcnt_config.hctrl_mode = PCNT_MODE_KEEP; // PCNT - modo hctrl - se HIGH conta incrementando
pcnt_unit_config(&pcnt_config); // Configura o contador PCNT
pcnt_counter_pause(PCNT_UNIT_0); // Pausa o contador PCNT
pcnt_counter_clear(PCNT_UNIT_0); // Zera o contador PCNT
digitalWrite(OUTPUT_SENSOR, HIGH); digitalWrite(OUTPUT_SENSOR, HIGH);
Serial.println("Nodemcu ESP32 Start done"); Serial.println("Nodemcu ESP32 Start done");
tankSensor.setTimeout(500);
long start = millis();
bool distanceReady = false;
while (start + 500 > millis())
{
if (tankSensor.init())
{
distanceReady = true;
break;
}
else
{
delay(20);
}
}
if (distanceReady)
{
Serial.println("Sensor init done");
tankSensor.setSignalRateLimit(0.1);
// increase laser pulse periods (defaults are 14 and 10 PCLKs)
tankSensor.setVcselPulsePeriod(VL53L0X::VcselPeriodPreRange, 18);
tankSensor.setVcselPulsePeriod(VL53L0X::VcselPeriodFinalRange, 14);
tankSensor.setMeasurementTimingBudget(200000);
} else {
Serial.println("Sensor init failed");
}
} }
void loop() { void loop() {
pcnt_counter_resume(PCNT_UNIT_0);
delay(500); delay(500);
pcnt_counter_pause(PCNT_UNIT_0);
pcnt_get_counter_value(PCNT_UNIT_0, &pulses); if (!tankSensor.timeoutOccurred())
pcnt_counter_clear(PCNT_UNIT_0); {
uint16_t distance = tankSensor.readRangeSingleMillimeters();
Serial.println(pulses*2); }
} }