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

AP_HAL_Linux: Changes in Scheduler: Added defines for delays, RCIN_RERIOD changed

Browse Source
This commit is contained in:
Vladislav Zakharov 2015-04-16 18:19:19 +03:00 committed by Andrew Tridgell
parent 90378b21da
commit e505eb2cd8
1 changed files with 20 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

26
libraries/AP_HAL_Linux/Scheduler.cpp
View File

@ -27,6 +27,21 @@ extern const AP_HAL::HAL& hal;
#define APM_LINUX_TONEALARM_PRIORITY 11
#define APM_LINUX_IO_PRIORITY 10
#if CONFIG_HAL_BOARD_SUBTYPE == HAL_BOARD_SUBTYPE_LINUX_NAVIO
#define APM_LINUX_UART_PERIOD 10000
#define APM_LINUX_RCIN_PERIOD 500
#define APM_LINUX_TONEALARM_PERIOD 10000
#define APM_LINUX_IO_PERIOD 20000
#else
#define APM_LINUX_UART_PERIOD 10000
#define APM_LINUX_RCIN_PERIOD 10000
#define APM_LINUX_TONEALARM_PERIOD 10000
#define APM_LINUX_IO_PERIOD 20000
#endif // CONFIG_HAL_BOARD_SUBTYPE == HAL_BOARD_SUBTYPE_LINUX_NAVIO
LinuxScheduler::LinuxScheduler()
{}
@ -315,8 +330,7 @@ void *LinuxScheduler::_rcin_thread(void *arg)
poll(NULL, 0, 1);
}
while (true) {
sched->_microsleep(10000);
sched->_microsleep(APM_LINUX_RCIN_PERIOD);
((LinuxRCInput *)hal.rcin)->_timer_tick();
}
return NULL;
@ -330,7 +344,7 @@ void *LinuxScheduler::_uart_thread(void* arg)
poll(NULL, 0, 1);
}
while (true) {
sched->_microsleep(10000);
sched->_microsleep(APM_LINUX_UART_PERIOD);
// process any pending serial bytes
((LinuxUARTDriver *)hal.uartA)->_timer_tick();
@ -349,7 +363,7 @@ void *LinuxScheduler::_tonealarm_thread(void* arg)
poll(NULL, 0, 1);
}
while (true) {
sched->_microsleep(10000);
sched->_microsleep(APM_LINUX_TONEALARM_PERIOD);
// process tone command
((LinuxUtil *)hal.util)->_toneAlarm_timer_tick();
@ -365,12 +379,12 @@ void *LinuxScheduler::_io_thread(void* arg)
poll(NULL, 0, 1);
}
while (true) {
sched->_microsleep(20000);
sched->_microsleep(APM_LINUX_IO_PERIOD);
// process any pending storage writes
((LinuxStorage *)hal.storage)->_timer_tick();
// run registered IO processes
// run registered IO procepsses
sched->_run_io();
}
return NULL;