EventManager.cpp

Go to the documentation of this file.

 
#include "events/EventManager.h"
#include <pico/stdlib.h>
#include <FreeRTOS.h>
#include <semphr.h>
#include <task.h>
#include <portmacro.h>
#include "framework/FrameworkTask.h"
#include "utility/utility.h" // for is_in_interrupt()
#include "framework/FrameworkController.h"
 
StaticSemaphore_t EventManager::lockBuffer_;
 
EventManager::EventManager(size_t queueSize)
{
    lock = xSemaphoreCreateMutexStatic(&lockBuffer_);
    configASSERT(lock);
}
 
void EventManager::subscribe(uint32_t mask, FrameworkController* target)
{
    withSubscribers([&](auto& subs) {
        subs.push_back({mask, target});
    });
}
 
void EventManager::withSubscribers(const std::function<void(std::vector<Subscriber>&)>& fn)
{
    xSemaphoreTake(lock, portMAX_DELAY);
    fn(subscribers_);
    xSemaphoreGive(lock);
}
 
void EventManager::withSubscribersFromISR(const std::function<void(std::vector<Subscriber>&)>& fn)
{
    xSemaphoreTake(lock, portMAX_DELAY);
    fn(subscribers_);
    xSemaphoreGive(lock);
}
 
void EventManager::postNotification(const Notification& n, FrameworkTask* target)
{
    const uint8_t index = n.code();
 
    if (is_in_interrupt()) {
        BaseType_t xHigherPriTaskWoken = pdFALSE;
 
        withSubscribersFromISR([&](auto& subs) {
            for (auto& sub : subs) {
                if ((sub.eventMask & (1u << index)) &&
                    (target == nullptr || sub.controller == target)) {
                    sub.controller->notifyFromISR(index, 1, &xHigherPriTaskWoken);
                }
            }
        });
 
        portYIELD_FROM_ISR(xHigherPriTaskWoken);
    } else {
        withSubscribers([&](auto& subs) {
            for (auto& sub : subs) {
                if ((sub.eventMask & (1u << index)) &&
                    (target == nullptr || sub.controller == target)) {
                    sub.controller->notify(index, 1);
                }
            }
        });
    }
}
 
 
void EventManager::enqueue(const Event& event)
{
    const uint8_t code = event.notification.code();
 
    if (is_in_interrupt()) {
        BaseType_t xHigherPriTaskWoken = pdFALSE;
 
        withSubscribersFromISR([&](auto& subs) {
            for (auto& sub : subs) {
                if ((sub.eventMask & (1u << code)) &&
                    (event.target == nullptr || sub.controller == event.target))
                {
                    QueueHandle_t q = sub.controller->getEventQueue();
                    if (q) {
                        BaseType_t result = xQueueSendToBackFromISR(q, &event, &xHigherPriTaskWoken);
                        if (result != pdPASS) {
                            debug_print("[EventManager] xQueueSendFromISR FAILED — queue full!\n");
                        }
                    }
                }
            }
        });
 
        portYIELD_FROM_ISR(xHigherPriTaskWoken);
    } else {
        withSubscribers([&](auto& subs) {
            for (auto& sub : subs) {
                if ((sub.eventMask & (1u << code)) &&
                    (event.target == nullptr || sub.controller == event.target))
                {
                    QueueHandle_t q = sub.controller->getEventQueue();
                    if (q) {
                        if (xQueueSendToBack(q, &event, 0) != pdPASS) {
                            debug_print("[EventManager] xQueueSend FAILED — queue full!\n");
                        }
                    }
                }
            }
        });
    }
}
 
void EventManager::postEvent(const Event& e)
{
    enqueue(e);
    postNotification(e.notification, e.target);
}