aboutsummaryrefslogtreecommitdiff
path: root/applications/message_handler_openamp/queue.hpp
diff options
context:
space:
mode:
authorKristofer Jonsson <kristofer.jonsson@arm.com>2023-02-08 14:23:00 +0100
committerKristofer Jonsson <kristofer.jonsson@arm.com>2023-02-08 14:44:01 +0100
commit3f5510fa3444217a442ac2e63ae50b27c9c26cf3 (patch)
treedbf2f8bb631af6e3a67d512835e17395e8e07704 /applications/message_handler_openamp/queue.hpp
parent87f6f7ebf5a51be7c819503894f486d05f2a8b31 (diff)
downloadethos-u-core-platform-3f5510fa3444217a442ac2e63ae50b27c9c26cf3.tar.gz
Updating message handler firmware23.02-rc1
The 'message handler' firmware was based on a custom interface between Linux and the firmware. Because the kernel driver has been converted into a rpmsg driver, the 'message handler' application has been updated into an OpenAMP based firmware. Change-Id: I1339180c4f53cbad42501a2827863b7b49561ff4
Diffstat (limited to 'applications/message_handler_openamp/queue.hpp')
-rw-r--r--applications/message_handler_openamp/queue.hpp87
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;
+};