bsp.c

#include "heivs/bsp.h"
#include "heivs/stm32_gpio_irq.h"
#include "heivs/delay.h"
#include "stm32/stm32f4xx_rcc.h"

static uint32_t was;
static void (*user_handler)(uint32_t is, uint32_t was);

uint32_t bsp_button_get_all(void)
{
    uint32_t i;
    uint32_t value = 0;

    for (i = 0 ; i < BSP_BUTTON_NR; i++)
    {
        value |= (bsp_button_get(i) << i);
    }

    return value;
}

static uint32_t buttons_handler(const struct gpio_t *gpio)
{
    uint32_t is = bsp_button_get_all();

    (void)gpio;

    user_handler(is, was);
    was = is;

    return 1;
}

status_e bsp_set_button_irq_handler(void (*handler)(uint32_t is, uint32_t was))
{
    uint32_t i ;

    if (!handler)
    {
        return ERROR_BAD_PARAM;
    }

    user_handler = handler;

    was = bsp_button_get_all();

    for (i = 0 ; i < BSP_BUTTON_NR; i++)
    {
        gpio_irq_setup(&bsp_button_gpios()[i], buttons_handler, GPIO_IRQ_MODE_EDGE_BOTH, 12);
    }

    return NO_ERROR;
}

/**
 * \brief set all leds
 *
 * \param enable for leds on
 */
static void set_all_leds(uint32_t enable)
{
    uint32_t i;

    for (i = 0 ; i < BSP_LED_NR ; i++)
    {
        bsp_led_set(i, enable);
    }
}


/**
 * \brief light a short pulse
 */
static void short_pulse(void)
{
    set_all_leds(1);
    delay_wait_ms(125);
    set_all_leds(0);
    delay_wait_ms(250);
}

/*
 * \brief light a long pulse
 */
static void long_pulse(void)
{
    set_all_leds(1);
    delay_wait_ms(500);
    set_all_leds(0);
    delay_wait_ms(250);
}

/**
 * \brief send a SOS using the leds
 */
static __attribute__ ((noreturn))
void SOS(status_e status)
{
    (void)status;
    for (;;)
    {
        short_pulse();
        short_pulse();
        short_pulse();

        delay_wait_ms(500);

        long_pulse();
        long_pulse();
        long_pulse();

        delay_wait_ms(500);

        short_pulse();
        short_pulse();
        short_pulse();

        delay_wait_ms(1000);
    }
}

__attribute__ ((weak, noreturn))
void bsp_fatal(status_e status)
{
    (void)status;

    __disable_irq();
    __disable_fault_irq();

    /**
     * When the debugger is connected, attract attention from the programmer
     */
    if (debugger_is_connected())
    {
        breakpoint();
    }

    /**
     * FIXME : Should we SOS or fire the external watchdog ?
     */
    SOS(status);
}

/**
 * \brief Called by the libc exit function
 *
 * Embedded software should not exit main :-/
 */
__attribute__ ((weak, noreturn))
void _exit(int status)
{
    /**
     * When the debugger is connected, attract attention from the programmer
     */
    if (debugger_is_connected())
    {
        /**
         * Uh oh, main exited ?!?
         */
        breakpoint();
    }

    if (status == NO_ERROR)
    {
        // main is not expected to return in an embedded system
        bsp_fatal(ERROR_MAIN_FINISHED);
    }

    //Forward the current error to bsp_fatal
    bsp_fatal(status);
}

static uint32_t rcc_csr_at_boot = 0;

void bsp_reset_reason_init(void)
{
    rcc_csr_at_boot = RCC->CSR;
}

uint32_t bsp_reset_reason_get(void)
{
    return rcc_csr_at_boot;
}

void bsp_reset_reason_clear(void)
{
    RCC->CSR |= RCC_CSR_RMVF;
}