//
// Created by david on 2/26/21.
//

#ifndef SIMPLE_CXX_CLIENT_TERMINAL_OBJECTS_HPP
#define SIMPLE_CXX_CLIENT_TERMINAL_OBJECTS_HPP
#include "freertos/FreeRTOS.h"
#include "freertos/event_groups.h"


class esp_err_exception: virtual public std::exception {
public:
    explicit esp_err_exception(esp_err_t err): esp_err(err) {}
    explicit esp_err_exception(std::string msg): esp_err(ESP_FAIL), message(std::move(msg)) {}
    explicit esp_err_exception(std::string msg, esp_err_t err): esp_err(err), message(std::move(msg)) {}
    virtual esp_err_t get_err_t() { return esp_err; }
    ~esp_err_exception() noexcept override = default;
    virtual const char* what() const noexcept {
        return message.c_str();
    }
private:
    esp_err_t esp_err;
    std::string message;
};

static inline void throw_if_false(bool condition, std::string message)
{
    if (!condition) {
        throw(esp_err_exception(std::move(message)));
    }
}

static inline void throw_if_esp_fail(esp_err_t err, std::string message)
{
    if (err != ESP_OK) {
        throw(esp_err_exception(std::move(message), err));
    }
}

static inline void throw_if_esp_fail(esp_err_t err)
{
    if (err != ESP_OK) {
        throw(esp_err_exception(err));
    }
}

struct signal_group {
    explicit signal_group(): event_group(nullptr)
    {
        event_group = xEventGroupCreate();
        throw_if_false(event_group != nullptr, "create signal event group failed");
    }

    void set(uint32_t bits)
    {
        xEventGroupSetBits(event_group, bits);
    }

    void clear(uint32_t bits)
    {
        xEventGroupClearBits(event_group, bits);
    }

    bool wait(uint32_t flags, uint32_t time_ms) // waiting for all and clearing if set
    {
        EventBits_t bits = xEventGroupWaitBits(event_group, flags, pdTRUE, pdTRUE, pdMS_TO_TICKS(time_ms));
        return bits & flags;
    }

    bool is_any(uint32_t flags)
    {
        return xEventGroupGetBits(event_group) & flags;
    }

    bool wait_any(uint32_t flags, uint32_t time_ms) // waiting for any bit, not clearing them
    {
        EventBits_t bits = xEventGroupWaitBits(event_group, flags, pdFALSE, pdFALSE, pdMS_TO_TICKS(time_ms));
        return bits & flags;
    }

    ~signal_group()
    {
        if (event_group) vEventGroupDelete(event_group);
    }

    EventGroupHandle_t event_group;
};

#endif //SIMPLE_CXX_CLIENT_TERMINAL_OBJECTS_HPP