aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

HAL_PX4: support reboot

Browse Source
This commit is contained in:
Andrew Tridgell 2013-01-03 19:34:36 +11:00
parent c6c336a6e8
commit b30fa6535b
1 changed files with 7 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
libraries/AP_HAL_PX4/Scheduler.cpp
View File

@ -5,12 +5,15 @@
#include "AP_HAL_PX4.h"
#include "Scheduler.h"
#include <unistd.h>
#include <stdlib.h>
#include <sched.h>
#include <errno.h>
#include <stdio.h>
#include <drivers/drv_hrt.h>
#include <nuttx/arch.h>
#include <systemlib/systemlib.h>
using namespace PX4;
@ -133,7 +136,7 @@ void PX4Scheduler::end_atomic() {
void PX4Scheduler::reboot()
{
hal.uartA->println_P(PSTR("REBOOT NOT IMPLEMENTED\r\n"));
up_systemreset();
}
void PX4Scheduler::_timer_event(void *arg)
@ -181,7 +184,9 @@ void PX4Scheduler::_timer_event(void *arg)
void PX4Scheduler::panic(const prog_char_t *errormsg) {
hal.console->println_P(errormsg);
for(;;);
hal.scheduler->usleep(10000);
fflush(stdout);
exit(1);
}
#endif