mirror of
https://github.com/alexandrebobkov/ESP-Nodes.git
synced 2025-08-10 20:24:22 +00:00
Ultrasonic
This commit is contained in:
@@ -50,6 +50,8 @@
|
||||
#include "esp_system.h"
|
||||
#include "espnow_config.h"
|
||||
|
||||
#include "ultrasonic.h"
|
||||
|
||||
#include "config.h"
|
||||
|
||||
static const char *TAG = "ESP IDF Robot";
|
||||
@@ -321,6 +323,22 @@ void onDataReceived (const uint8_t *mac_addr, const uint8_t *data, uint8_t data_
|
||||
update_pwm(rc_x, rc_y);
|
||||
}
|
||||
|
||||
void ultrasonic_task (void *arg) {
|
||||
ultrasonic_sensor_t sensor = {
|
||||
.trigger_gpio = GPIO_NUM_4, // Example GPIO for trigger
|
||||
.echo_gpio = GPIO_NUM_5 // Example GPIO for echo
|
||||
};
|
||||
ESP_ERROR_CHECK(ultrasonic_init(&sensor));
|
||||
|
||||
uint32_t time_us;
|
||||
while (true) {
|
||||
ESP_ERROR_CHECK(ultrasonic_measure_raw(&sensor, PING_TIMEOUT, &time_us));
|
||||
float distance_cm = (float)time_us / ROUNDTRIP_CM;
|
||||
ESP_LOGI(TAG, "Distance: %.2f cm", distance_cm);
|
||||
vTaskDelay(1000 / portTICK_PERIOD_MS);
|
||||
}
|
||||
}
|
||||
|
||||
void app_main(void)
|
||||
{
|
||||
// Initialize internal temperature sensor
|
||||
|
Reference in New Issue
Block a user