Mbed OS6のEventQueueを使ってみる

#include "mbed.h"
#include <cstdint>
#include <stdio.h>

DigitalOut led1(LED1);
DigitalOut led2(LED2);

const uint32_t TIMEOUT_MS = 5000;
InterruptIn button(BUTTON1);
volatile int countdown = 9;

void trigger()
{
    Watchdog::get_instance().kick();
    countdown = 9;
}

void led1_toggle()
{
    led1 = !led1;
}

void led2_toggle()
{
    led2 = !led2;
}

void PrintCountdown()
{
    printf("\r%3i", countdown--);
    fflush(stdout);
}

int main()
{
    printf("\r\nTarget started.\r\n");

    Watchdog &watchdog = Watchdog::get_instance();
    watchdog.start(TIMEOUT_MS);
    button.rise(&trigger);

    unsigned long watchdog_timeout = watchdog.get_timeout();
    printf("Watchdog initialized to %lu ms.\r\n", watchdog_timeout);
    printf("Press BUTTON1 at least once every %lu ms to kick the "
           "watchdog and prevent system reset.\r\n", watchdog_timeout);

    // creates a queue with the default size
    EventQueue queue;

    // events are simple callbacks
    queue.call_every(500ms, &PrintCountdown);
    queue.call_every( 10ms, &led1_toggle);
    queue.call_every(500ms, &led2_toggle);

    // events are executed by the dispatch method
    queue.dispatch_forever();
}