From 2af4244854c08562440cafe2e69c8bcb5016fb36 Mon Sep 17 00:00:00 2001 From: Lucas De Marchi Date: Thu, 22 Oct 2015 15:15:05 -0200 Subject: [PATCH] AP_HAL_Linux: Scheduler: implement variadic version of panic() --- libraries/AP_HAL_Linux/Scheduler.cpp | 7 ++++++- 1 file changed, 6 insertions(+), 1 deletion(-) diff --git a/libraries/AP_HAL_Linux/Scheduler.cpp b/libraries/AP_HAL_Linux/Scheduler.cpp index f40e6be03a..0839e76587 100644 --- a/libraries/AP_HAL_Linux/Scheduler.cpp +++ b/libraries/AP_HAL_Linux/Scheduler.cpp @@ -409,8 +409,13 @@ void *Scheduler::_io_thread(void* arg) void Scheduler::panic(const prog_char_t *errormsg, ...) { - write(1, errormsg, strlen(errormsg)); + va_list ap; + + va_start(ap, errormsg); + vdprintf(1, errormsg, ap); + va_end(ap); write(1, "\n", 1); + hal.rcin->deinit(); hal.scheduler->delay_microseconds(10000); exit(1);