/*
 * util.c
 */

#include "pico/stdlib.h"
#include "pico/bootrom.h"
#include "util.h"

#define HEARTBEAT_INTERVAL_MS 500

#ifdef PICO_DEFAULT_LED_PIN
static uint32_t last_heartbeat = 0;
#endif // PICO_DEFAULT_LED_PIN

void heartbeat_init(void) {
#ifdef PICO_DEFAULT_LED_PIN
    gpio_init(PICO_DEFAULT_LED_PIN);
    gpio_set_dir(PICO_DEFAULT_LED_PIN, GPIO_OUT);
    gpio_put(PICO_DEFAULT_LED_PIN, 1);
#endif // PICO_DEFAULT_LED_PIN
}

void heartbeat_run(void) {
#ifdef PICO_DEFAULT_LED_PIN
    uint32_t now = to_ms_since_boot(get_absolute_time());
    if (now >= (last_heartbeat + HEARTBEAT_INTERVAL_MS)) {
        last_heartbeat = now;
        gpio_xor_mask(1 << PICO_DEFAULT_LED_PIN);
    }
#endif // PICO_DEFAULT_LED_PIN
}

void reset_to_bootloader(void) {
#ifdef PICO_DEFAULT_LED_PIN
    reset_usb_boot(1 << PICO_DEFAULT_LED_PIN, 0);
#else // ! PICO_DEFAULT_LED_PIN
    reset_usb_boot(0, 0);
#endif // PICO_DEFAULT_LED_PIN
}