|
|
@ -37,16 +37,16 @@ const AP_Scheduler::Task Tracker::scheduler_tasks[] = { |
|
|
|
SCHED_TASK(update_tracking, 50, 1000), |
|
|
|
SCHED_TASK(update_tracking, 50, 1000), |
|
|
|
SCHED_TASK(update_GPS, 10, 4000), |
|
|
|
SCHED_TASK(update_GPS, 10, 4000), |
|
|
|
SCHED_TASK(update_compass, 10, 1500), |
|
|
|
SCHED_TASK(update_compass, 10, 1500), |
|
|
|
SCHED_TASK(update_battery, 10, 1500), |
|
|
|
SCHED_TASK_CLASS(AP_BattMonitor, &tracker.battery, read, 10, 1500), |
|
|
|
SCHED_TASK(update_barometer, 10, 1500), |
|
|
|
SCHED_TASK(update_barometer, 10, 1500), |
|
|
|
SCHED_TASK(gcs_update, 50, 1700), |
|
|
|
SCHED_TASK(gcs_update, 50, 1700), |
|
|
|
SCHED_TASK(gcs_data_stream_send, 50, 3000), |
|
|
|
SCHED_TASK(gcs_data_stream_send, 50, 3000), |
|
|
|
SCHED_TASK(compass_accumulate, 50, 1500), |
|
|
|
SCHED_TASK(compass_accumulate, 50, 1500), |
|
|
|
SCHED_TASK(barometer_accumulate, 50, 900), |
|
|
|
SCHED_TASK_CLASS(AP_Baro, &tracker.barometer, accumulate, 50, 900), |
|
|
|
SCHED_TASK(ten_hz_logging_loop, 10, 300), |
|
|
|
SCHED_TASK(ten_hz_logging_loop, 10, 300), |
|
|
|
SCHED_TASK(dataflash_periodic, 50, 300), |
|
|
|
SCHED_TASK_CLASS(DataFlash_Class, &tracker.DataFlash, periodic_tasks, 50, 300), |
|
|
|
SCHED_TASK(ins_periodic, 50, 50), |
|
|
|
SCHED_TASK_CLASS(AP_InertialSensor, &tracker.ins, periodic, 50, 50), |
|
|
|
SCHED_TASK(update_notify, 50, 100), |
|
|
|
SCHED_TASK_CLASS(AP_Notify, &tracker.notify, update, 50, 100), |
|
|
|
SCHED_TASK(check_usb_mux, 10, 300), |
|
|
|
SCHED_TASK(check_usb_mux, 10, 300), |
|
|
|
SCHED_TASK(gcs_retry_deferred, 50, 1000), |
|
|
|
SCHED_TASK(gcs_retry_deferred, 50, 1000), |
|
|
|
SCHED_TASK(one_second_loop, 1, 3900), |
|
|
|
SCHED_TASK(one_second_loop, 1, 3900), |
|
|
@ -82,16 +82,6 @@ void Tracker::loop() |
|
|
|
scheduler.run(19900UL); |
|
|
|
scheduler.run(19900UL); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
void Tracker::dataflash_periodic(void) |
|
|
|
|
|
|
|
{ |
|
|
|
|
|
|
|
DataFlash.periodic_tasks(); |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void Tracker::ins_periodic() |
|
|
|
|
|
|
|
{ |
|
|
|
|
|
|
|
ins.periodic(); |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void Tracker::one_second_loop() |
|
|
|
void Tracker::one_second_loop() |
|
|
|
{ |
|
|
|
{ |
|
|
|
// send a heartbeat
|
|
|
|
// send a heartbeat
|
|
|
|