Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-22 16:48:29 -04:00
Code Issues Packages Projects Releases Wiki Activity

HAL_SITL: implement reboot support

Browse Source
This commit is contained in:
Pierre Kancir 2018-05-28 18:20:30 +02:00 committed by Peter Barker
parent 7732b41186
commit b615677223
3 changed files with 6 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
libraries/AP_HAL_SITL/HAL_SITL_Class.cpp
View File

@ -84,10 +84,12 @@ void HAL_SITL::run(int argc, char * const argv[], Callbacks* callbacks) const
callbacks->setup();
scheduler->system_initialized();
for (;;) {
while (!HALSITL::Scheduler::_should_reboot) {
callbacks->loop();
HALSITL::Scheduler::_run_io_procs(false);
}
execv(argv[0], argv);
AP_HAL::panic("PANIC: REBOOT FAILED");
}
const AP_HAL::HAL& AP_HAL::get_HAL() {

3
libraries/AP_HAL_SITL/Scheduler.cpp
View File

@ -23,6 +23,7 @@ bool Scheduler::_in_timer_proc = false;
AP_HAL::MemberProc Scheduler::_io_proc[SITL_SCHEDULER_MAX_TIMER_PROCS] = {nullptr};
uint8_t Scheduler::_num_io_procs = 0;
bool Scheduler::_in_io_proc = false;
bool Scheduler::_should_reboot = false;
Scheduler::Scheduler(SITL_State *sitlState) :
_sitlState(sitlState),
@ -130,7 +131,7 @@ void Scheduler::sitl_end_atomic() {
void Scheduler::reboot(bool hold_in_bootloader)
{
hal.uartA->printf("REBOOT NOT IMPLEMENTED\r\n\n");
_should_reboot = true;
}
void Scheduler::_run_timer_procs(bool called_from_isr)

1
libraries/AP_HAL_SITL/Scheduler.h
View File

@ -50,6 +50,7 @@ public:
uint64_t stopped_clock_usec() const { return _stopped_clock_usec; }
static void _run_io_procs(bool called_from_isr);
static bool _should_reboot;
private:
SITL_State *_sitlState;