forked from espressif/esp-idf
feat(ble_mesh): ble mesh queue support
This commit is contained in:
33
components/bt/esp_ble_mesh/common/include/mesh/queue.h
Normal file
33
components/bt/esp_ble_mesh/common/include/mesh/queue.h
Normal file
@@ -0,0 +1,33 @@
|
|||||||
|
/*
|
||||||
|
* SPDX-FileCopyrightText: 2024 Espressif Systems (Shanghai) CO LTD
|
||||||
|
*
|
||||||
|
* SPDX-License-Identifier: Apache-2.0
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef _BLE_MESH_QUEUE_H_
|
||||||
|
#define _BLE_MESH_QUEUE_H_
|
||||||
|
|
||||||
|
#include "mesh/kernel.h"
|
||||||
|
#include "mesh/slist.h"
|
||||||
|
#include "mesh/atomic.h"
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
extern "C" {
|
||||||
|
#endif
|
||||||
|
|
||||||
|
typedef struct {
|
||||||
|
QueueHandle_t handle;
|
||||||
|
#if CONFIG_BLE_MESH_FREERTOS_STATIC_ALLOC
|
||||||
|
StaticQueue_t *buffer;
|
||||||
|
uint8_t *storage;
|
||||||
|
#endif
|
||||||
|
} bt_mesh_queue_t;
|
||||||
|
|
||||||
|
int bt_mesh_queue_init(bt_mesh_queue_t *queue, uint8_t queue_size, uint8_t item_size);
|
||||||
|
int bt_mesh_queue_deinit(bt_mesh_queue_t *queue);
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#endif /* _BLE_MESH_QUEUE_H_ */
|
48
components/bt/esp_ble_mesh/common/queue.c
Normal file
48
components/bt/esp_ble_mesh/common/queue.c
Normal file
@@ -0,0 +1,48 @@
|
|||||||
|
/*
|
||||||
|
* SPDX-FileCopyrightText: 2024 Espressif Systems (Shanghai) CO LTD
|
||||||
|
*
|
||||||
|
* SPDX-License-Identifier: Apache-2.0
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include "mesh/common.h"
|
||||||
|
#include "mesh/queue.h"
|
||||||
|
|
||||||
|
int bt_mesh_queue_init(bt_mesh_queue_t *queue, uint8_t queue_size, uint8_t item_size)
|
||||||
|
{
|
||||||
|
__ASSERT(queue && queue_size && item_size, "Invalid queue init parameters");
|
||||||
|
|
||||||
|
#if !CONFIG_BLE_MESH_FREERTOS_STATIC_ALLOC
|
||||||
|
queue->handle = xQueueCreate(queue_size, item_size);
|
||||||
|
__ASSERT(queue->handle, "Failed to create queue");
|
||||||
|
#else /* !CONFIG_BLE_MESH_FREERTOS_STATIC_ALLOC */
|
||||||
|
#if CONFIG_BLE_MESH_FREERTOS_STATIC_ALLOC_EXTERNAL
|
||||||
|
queue->buffer = heap_caps_calloc_prefer(1, sizeof(StaticQueue_t), 2, MALLOC_CAP_SPIRAM|MALLOC_CAP_8BIT, MALLOC_CAP_INTERNAL|MALLOC_CAP_8BIT);
|
||||||
|
#elif CONFIG_BLE_MESH_FREERTOS_STATIC_ALLOC_IRAM_8BIT
|
||||||
|
queue->buffer = heap_caps_calloc_prefer(1, sizeof(StaticQueue_t), 2, MALLOC_CAP_INTERNAL|MALLOC_CAP_IRAM_8BIT, MALLOC_CAP_INTERNAL|MALLOC_CAP_8BIT);
|
||||||
|
#endif
|
||||||
|
__ASSERT(queue->buffer, "Failed to create queue buffer");
|
||||||
|
#if CONFIG_BLE_MESH_FREERTOS_STATIC_ALLOC_EXTERNAL
|
||||||
|
queue->storage = heap_caps_calloc_prefer(1, (queue_size * item_size), 2, MALLOC_CAP_SPIRAM|MALLOC_CAP_8BIT, MALLOC_CAP_INTERNAL|MALLOC_CAP_8BIT);
|
||||||
|
#elif CONFIG_BLE_MESH_FREERTOS_STATIC_ALLOC_IRAM_8BIT
|
||||||
|
queue->storage = heap_caps_calloc_prefer(1, (queue_size * item_size), 2, MALLOC_CAP_INTERNAL|MALLOC_CAP_IRAM_8BIT, MALLOC_CAP_INTERNAL|MALLOC_CAP_8BIT);
|
||||||
|
#endif
|
||||||
|
__ASSERT(queue->storage, "Failed to create queue storage");
|
||||||
|
queue->handle = xQueueCreateStatic(queue_size, item_size, (uint8_t*)queue->storage, queue->buffer);
|
||||||
|
__ASSERT(queue->handle, "Failed to create static queue");
|
||||||
|
#endif /* !CONFIG_BLE_MESH_FREERTOS_STATIC_ALLOC */
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
int bt_mesh_queue_deinit(bt_mesh_queue_t *queue)
|
||||||
|
{
|
||||||
|
__ASSERT(queue, "Invalid queue init parameters");
|
||||||
|
vQueueDelete(queue->handle);
|
||||||
|
queue->handle = NULL;
|
||||||
|
#if CONFIG_BLE_MESH_FREERTOS_STATIC_ALLOC
|
||||||
|
heap_caps_free(queue->buffer);
|
||||||
|
queue->buffer = NULL;
|
||||||
|
heap_caps_free(queue->storage);
|
||||||
|
queue->storage = NULL;
|
||||||
|
#endif
|
||||||
|
return 0;
|
||||||
|
}
|
Reference in New Issue
Block a user