From f791767fb2b2f475bfc3590964c36be18b5794c3 Mon Sep 17 00:00:00 2001
From: Lucas De Marchi <lucas.demarchi@intel.com>
Date: Thu, 22 Oct 2015 15:15:05 -0200
Subject: [PATCH] AP_HAL_PX4: Scheduler: implement variadic version of panic()

---
 libraries/AP_HAL_PX4/Scheduler.cpp | 7 ++++++-
 1 file changed, 6 insertions(+), 1 deletion(-)

diff --git a/libraries/AP_HAL_PX4/Scheduler.cpp b/libraries/AP_HAL_PX4/Scheduler.cpp
index ec7041e473..c69d1321dd 100644
--- a/libraries/AP_HAL_PX4/Scheduler.cpp
+++ b/libraries/AP_HAL_PX4/Scheduler.cpp
@@ -376,8 +376,13 @@ void *PX4Scheduler::_storage_thread(void)
 
 void PX4Scheduler::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.scheduler->delay_microseconds(10000);
     _px4_thread_should_exit = true;
     exit(1);