//
// Error: Provides a simple interface for asserting and checking errors
//

#include "stm32f3xx_hal.h"

#include <stdio.h>

#include "config.h"
#include "error.h"

static volatile uint32_t err_reg;
static volatile uint8_t num_errors_asserted = 0;

// Moderately detailed messages corresponding to each error enum
//static const char *  error_message[] =
//{
//		"Info",
//		"General",
//};


// Set the passed error flag
void error_assert(const uint8_t errno)
{
    // Errno invalid: exceeds bit length of error register
    if(errno >= 32)
        return;

    // Don't count info messages as true errors
    if(errno > ERR_INFO)
    {
        // Set error flag
        err_reg |= (1<<errno);

        // Count how many errors have occurred
        num_errors_asserted++;
    }

    // Dispatch error message over IRdA and/or debug port
#ifdef DEBUG_ERROUT_ENABLE
    char outbuf[256];
    snprintf(outbuf, 256, "[%lu\] %s (no details) \r\n", HAL_GetTick(), error_message[errno]);
#endif
}


// Set the passed error flag with details about the error
void error_assert_info(const uint8_t errno, const char* details)
{
    // Errno invalid: exceeds bit length of error register
    if(errno >= 32)
        return;

    // Don't count info messages as true errors
    if(errno > ERR_INFO)
    {
        // Set error flag
        err_reg |= (1<<errno);

        // Count how many errors have occurred
        num_errors_asserted++;
    }

    // Dispatch error message over IRdA and/or debug port
#ifdef DEBUG_ERROUT_ENABLE
    char outbuf[256];
    if(errno == ERR_INFO)
        snprintf(outbuf, 256, "Info: %s \r\n", details);
    else
        snprintf(outbuf, 256, "[%lu\] %s (%s) \r\n", HAL_GetTick(), error_message[errno], details);
    usb_send_debug(outbuf);

    if(errno > ERR_INFO)
    {
        ir_efs_send(outbuf);
        error_sidechannel_addmsg(outbuf);
    }
#endif
}


// Check if the passed error flag has been asserted
inline uint8_t error_check(const uint8_t errno)
{
    return (err_reg & (1<<errno)) > 0;
}


// Return 1 if any error has occurred
inline uint8_t error_occurred(void)
{
    return err_reg > 0;
}


// Return the number of errors that have occurred
inline uint8_t error_count(void)
{
    return num_errors_asserted;
}