113 lines
3.1 KiB
C
113 lines
3.1 KiB
C
/*
|
|
This example code is in the Public Domain (or CC0 licensed, at your option.)
|
|
|
|
Unless required by applicable law or agreed to in writing, this
|
|
software is distributed on an "AS IS" BASIS, WITHOUT WARRANTIES OR
|
|
CONDITIONS OF ANY KIND, either express or implied.
|
|
*/
|
|
|
|
#include <stdint.h>
|
|
#include <string.h>
|
|
#include <stdbool.h>
|
|
#include "freertos/xtensa_api.h"
|
|
#include "freertos/FreeRTOSConfig.h"
|
|
#include "freertos/FreeRTOS.h"
|
|
#include "freertos/queue.h"
|
|
#include "freertos/task.h"
|
|
#include "esp_log.h"
|
|
#include "bt_app_core.h"
|
|
|
|
static void bt_app_task_handler(void *arg);
|
|
static bool bt_app_send_msg(bt_app_msg_t *msg);
|
|
static void bt_app_work_dispatched(bt_app_msg_t *msg);
|
|
|
|
static xQueueHandle bt_app_task_queue = NULL;
|
|
static xTaskHandle bt_app_task_handle = NULL;
|
|
|
|
bool bt_app_work_dispatch(bt_app_cb_t p_cback, uint16_t event, void *p_params, int param_len, bt_app_copy_cb_t p_copy_cback)
|
|
{
|
|
ESP_LOGD(BT_APP_CORE_TAG, "%s event 0x%x, param len %d", __func__, event, param_len);
|
|
|
|
bt_app_msg_t msg = { };
|
|
|
|
msg.sig = BT_APP_SIG_WORK_DISPATCH;
|
|
msg.event = event;
|
|
msg.cb = p_cback;
|
|
|
|
if (param_len == 0) {
|
|
return bt_app_send_msg(&msg);
|
|
} else if (p_params && param_len > 0) {
|
|
if ((msg.param = malloc(param_len)) != NULL) {
|
|
memcpy(msg.param, p_params, param_len);
|
|
/* check if caller has provided a copy callback to do the deep copy */
|
|
if (p_copy_cback) {
|
|
p_copy_cback(&msg, msg.param, p_params);
|
|
}
|
|
return bt_app_send_msg(&msg);
|
|
}
|
|
}
|
|
|
|
return false;
|
|
}
|
|
|
|
static bool bt_app_send_msg(bt_app_msg_t *msg)
|
|
{
|
|
if (msg == NULL) {
|
|
return false;
|
|
}
|
|
|
|
if (xQueueSend(bt_app_task_queue, msg, 10 / portTICK_RATE_MS) != pdTRUE) {
|
|
ESP_LOGE(BT_APP_CORE_TAG, "%s xQueue send failed", __func__);
|
|
return false;
|
|
}
|
|
return true;
|
|
}
|
|
|
|
static void bt_app_work_dispatched(bt_app_msg_t *msg)
|
|
{
|
|
if (msg->cb) {
|
|
msg->cb(msg->event, msg->param);
|
|
}
|
|
}
|
|
|
|
static void bt_app_task_handler(void *arg)
|
|
{
|
|
bt_app_msg_t msg;
|
|
for (;;) {
|
|
if (pdTRUE == xQueueReceive(bt_app_task_queue, &msg, (portTickType)portMAX_DELAY)) {
|
|
ESP_LOGD(BT_APP_CORE_TAG, "%s, sig 0x%x, 0x%x", __func__, msg.sig, msg.event);
|
|
switch (msg.sig) {
|
|
case BT_APP_SIG_WORK_DISPATCH:
|
|
bt_app_work_dispatched(&msg);
|
|
break;
|
|
default:
|
|
ESP_LOGW(BT_APP_CORE_TAG, "%s, unhandled sig: 0x%x", __func__, msg.sig);
|
|
break;
|
|
} // switch (msg.sig)
|
|
|
|
if (msg.param) {
|
|
free(msg.param);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
void bt_app_task_start_up(void)
|
|
{
|
|
bt_app_task_queue = xQueueCreate(10, sizeof(bt_app_msg_t));
|
|
xTaskCreate(bt_app_task_handler, "BtAppT", 2048, NULL, configMAX_PRIORITIES - 3, bt_app_task_handle);
|
|
return;
|
|
}
|
|
|
|
void bt_app_task_shut_down(void)
|
|
{
|
|
if (bt_app_task_handle) {
|
|
vTaskDelete(bt_app_task_handle);
|
|
bt_app_task_handle = NULL;
|
|
}
|
|
if (bt_app_task_queue) {
|
|
vQueueDelete(bt_app_task_queue);
|
|
bt_app_task_queue = NULL;
|
|
}
|
|
}
|