src/health/manager/StateManager.cpp

#include <algorithm>
#include <utility>
#include "StateManager.h"
#include "utils/log.h"

namespace velia::health {

StateManager::StateManager()
    : m_log(spdlog::get("health"))
{
}

StateManager::~StateManager() = default;

/** @brief Registers an input source */
void StateManager::registerInput(void* input, State value)
{
    m_log->trace("Registering input {}", input);

    if (m_inputs.find(input) != m_inputs.end()) {
        throw std::invalid_argument("Input already registered.");
    }

    updateState(input, value);
}

/** @brief Unregisters an input source */
void StateManager::unregisterInput(void* input)
{
    m_log->trace("Unregistering input {}", input);

    auto it = m_inputs.find(input);
    if (it == m_inputs.end()) {
        throw std::invalid_argument("Input not registered.");
    }

    m_inputs.erase(it);
    computeOutput();
}

void StateManager::updateState(void* input, State value)
{
    m_inputs[input] = value;
    m_log->trace("Input {} changed state to {}", input, value);
    computeOutput();
}

void StateManager::computeOutput()
{
    auto itMax = std::max_element(m_inputs.begin(), m_inputs.end(), [](const auto& e1, const auto& e2) { return e1.second < e2.second; });

    if (itMax == m_inputs.end()) {
        // No inputs -- there's no sane thing to do, so remain silent
        m_oldState.reset();
    } else if (!m_oldState || (*m_oldState != itMax->second)) {
        m_oldState = itMax->second;
        m_log->info("Status: {}", itMax->second);
        m_outputSignal(itMax->second);
    }
}
}