/*
 * 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;
};