esp-who/examples/esp32-s3-eye/main/src/app_motion.cpp

80 lines
2.5 KiB
C++
Raw Normal View History

2022-03-02 19:38:29 +08:00
#include "app_motion.hpp"
#include "esp_log.h"
#include "esp_camera.h"
#include "dl_image.hpp"
static const char TAG[] = "App/Motion";
2022-03-03 14:35:04 +08:00
AppMotion::AppMotion(AppButton *key,
AppSpeech *speech,
QueueHandle_t queue_i,
QueueHandle_t queue_o,
void (*callback)(camera_fb_t *)) : Frame(queue_i, queue_o, callback),
key(key),
speech(speech),
switch_on(false) {}
2022-03-02 19:38:29 +08:00
void AppMotion::update()
{
2022-03-03 14:35:04 +08:00
if (this->key->pressed > BUTTON_IDLE)
2022-03-02 19:38:29 +08:00
{
2022-03-03 14:35:04 +08:00
if (this->key->pressed == BUTTON_MENU)
2022-03-02 19:38:29 +08:00
{
this->switch_on = (this->key->menu == MENU_MOTION_DETECTION) ? true : false;
ESP_LOGD(TAG, "%s", this->switch_on ? "ON" : "OFF");
}
}
if (this->speech->command > COMMAND_NOT_DETECTED)
{
if (this->speech->command >= MENU_STOP_WORKING && this->speech->command <= MENU_MOTION_DETECTION)
{
this->switch_on = (this->speech->command == MENU_MOTION_DETECTION) ? true : false;
ESP_LOGD(TAG, "%s", this->switch_on ? "ON" : "OFF");
}
}
}
static void task(AppMotion *self)
{
ESP_LOGD(TAG, "Start");
while (true)
{
if (self->queue_i == nullptr)
break;
camera_fb_t *frame1 = NULL;
camera_fb_t *frame2 = NULL;
if (xQueueReceive(self->queue_i, &frame1, portMAX_DELAY))
{
if (self->switch_on)
{
if (xQueueReceive(self->queue_i, &frame2, portMAX_DELAY))
{
uint32_t moving_point_number = dl::image::get_moving_point_number((uint16_t *)frame1->buf, (uint16_t *)frame2->buf, frame1->height, frame1->width, 8, 15);
if (moving_point_number > 50)
{
ESP_LOGI(TAG, "Something moved!");
dl::image::draw_filled_rectangle((uint16_t *)frame1->buf, frame1->height, frame1->width, 0, 0, 20, 20);
}
self->callback(frame2);
}
}
if (self->queue_o)
xQueueSend(self->queue_o, &frame1, portMAX_DELAY);
else
self->callback(frame1);
}
}
ESP_LOGD(TAG, "Stop");
vTaskDelete(NULL);
}
void AppMotion::run()
{
2022-03-03 11:31:15 +08:00
xTaskCreatePinnedToCore((TaskFunction_t)task, TAG, 3 * 1024, this, 5, NULL, 0);
2022-03-02 19:38:29 +08:00
}