background.cpp

/*
 * filename   : background.cpp
 * created at : 2016-10-21 11:28:31
 * author     : Jianing Yang <jianingy.yang@gmail.com>
 */
#include "background.h"


task_t TASKS[10] = {NULL};

int register_bg_task(int id, task_t cb) {
    if (id > 20)
        return -1;

    LOG("register task %d with %p", id, cb);
    TASKS[id] = cb;
    return 0;
}

int schedule(void *userargs) {
    yield();
    for (int i = 0; i < sizeof(TASKS) / sizeof(task_t); i++) {
        task_t task = TASKS[i];
        if (task) {
            task(userargs);
        }
    }
}

void sleep_ms(unsigned long ms, void *userargs) {
    unsigned long start = millis();
    while (millis() - start < ms)
        schedule(userargs);
}
void sleep_ms(unsigned long ms) {
    sleep_ms(ms, NULL);
}