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;
+};