#include "Scheduler.h"

#include <stdarg.h>

using namespace Empty;

extern const AP_HAL::HAL& hal;

EmptyScheduler::EmptyScheduler()
{}

void EmptyScheduler::init(void* machtnichts)
{}

void EmptyScheduler::delay(uint16_t ms)
{}

uint64_t EmptyScheduler::millis64() {
    return 10000;
}

uint64_t EmptyScheduler::micros64() {
    return 200000;
}

uint32_t EmptyScheduler::millis() {
    return millis64();
}

uint32_t EmptyScheduler::micros() {
    return micros64();
}

void EmptyScheduler::delay_microseconds(uint16_t us)
{}

void EmptyScheduler::register_delay_callback(AP_HAL::Proc k,
            uint16_t min_time_ms)
{}

void EmptyScheduler::register_timer_process(AP_HAL::MemberProc k)
{}

void EmptyScheduler::register_io_process(AP_HAL::MemberProc k)
{}

void EmptyScheduler::register_timer_failsafe(AP_HAL::Proc, uint32_t period_us)
{}

void EmptyScheduler::suspend_timer_procs()
{}

void EmptyScheduler::resume_timer_procs()
{}

bool EmptyScheduler::in_timerprocess() {
    return false;
}

void EmptyScheduler::begin_atomic()
{}

void EmptyScheduler::end_atomic()
{}

bool EmptyScheduler::system_initializing() {
    return false;
}

void EmptyScheduler::system_initialized()
{}

void EmptyScheduler::panic(const prog_char_t *errormsg, ...)
{
    va_list ap;

    va_start(ap, errormsg);
    hal.console->vprintf(errormsg, ap);
    va_end(ap);
    hal.console->printf("\n");

    for(;;);
}

void EmptyScheduler::reboot(bool hold_in_bootloader) {
    for(;;);
}