diff options
Diffstat (limited to 'applications/message_handler_openamp/queue.hpp')
-rw-r--r-- | applications/message_handler_openamp/queue.hpp | 87 |
1 files changed, 87 insertions, 0 deletions
diff --git a/applications/message_handler_openamp/queue.hpp b/applications/message_handler_openamp/queue.hpp new file mode 100644 index 0000000..dcf676b --- /dev/null +++ b/applications/message_handler_openamp/queue.hpp @@ -0,0 +1,87 @@ +/* + * SPDX-FileCopyrightText: Copyright 2022-2023 Arm Limited and/or its affiliates <open-source-office@arm.com> + * + * SPDX-License-Identifier: Apache-2.0 + * + * Licensed under the Apache License, Version 2.0 (the License); you may + * not use _this file except in compliance with the License. + * You may obtain a copy of the License at + * + * www.apache.org/licenses/LICENSE-2.0 + * + * Unless required by applicable law or agreed to in writing, software + * distributed under the License is distributed on an AS IS BASIS, WITHOUT + * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. + * See the License for the specific language governing permissions and + * limitations under the License. + */ + +#pragma once + +/***************************************************************************** + * Includes + *****************************************************************************/ + +#include <FreeRTOS.h> +#include <queue.h> + +#include <cstdlib> +#include <functional> + +#include <ethosu_log.h> + +/***************************************************************************** + * Queue + *****************************************************************************/ + +template <typename T> +class Queue { +public: + using Predicate = std::function<bool(const T &data)>; + + Queue(const size_t size = 10) : queue(xQueueCreate(size, sizeof(T))) {} + + ~Queue() { + vQueueDelete(queue); + } + + int send(const T &msg, TickType_t delay = portMAX_DELAY) { + if (pdPASS != xQueueSend(queue, &msg, delay)) { + LOG_ERR("Failed to send message"); + return -1; + } + + return 0; + } + + int receive(T &msg, TickType_t delay = portMAX_DELAY) { + if (pdTRUE != xQueueReceive(queue, &msg, delay)) { + LOG_ERR("Failed to receive message"); + return -1; + } + + return 0; + } + + void erase(Predicate pred) { + const size_t count = uxQueueMessagesWaiting(queue); + for (size_t i = 0; i < count; i++) { + T data; + + if (pdPASS != xQueueReceive(queue, &data, 0)) { + LOG_ERR("Failed to dequeue message"); + abort(); + } + + if (!pred(data)) { + if (pdPASS != xQueueSend(queue, &data, 0)) { + LOG_ERR("Failed to requeue message"); + abort(); + } + } + } + } + +private: + QueueHandle_t queue; +}; |