diff --git a/libraries/AP_HAL_Empty/Scheduler.cpp b/libraries/AP_HAL_Empty/Scheduler.cpp index 04a287dc7d..b493cd7bd6 100644 --- a/libraries/AP_HAL_Empty/Scheduler.cpp +++ b/libraries/AP_HAL_Empty/Scheduler.cpp @@ -1,6 +1,8 @@ #include "Scheduler.h" +#include + using namespace Empty; extern const AP_HAL::HAL& hal; @@ -69,8 +71,15 @@ bool EmptyScheduler::system_initializing() { void EmptyScheduler::system_initialized() {} -void EmptyScheduler::panic(const prog_char_t *errormsg, ...) { - hal.console->println_P(errormsg); +void EmptyScheduler::panic(const prog_char_t *errormsg, ...) +{ + va_list ap; + + va_start(ap, errormsg); + hal.console->vprintf_P(errormsg, ap); + va_end(ap); + hal.console->printf_P("\n"); + for(;;); }