mirror of https://github.com/ArduPilot/ardupilot
Copter: publish navigation info to OSD
This commit is contained in:
parent
eec34fc47d
commit
f5c540a127
|
@ -190,6 +190,9 @@ const AP_Scheduler::Task Copter::scheduler_tasks[] = {
|
||||||
#if STATS_ENABLED == ENABLED
|
#if STATS_ENABLED == ENABLED
|
||||||
SCHED_TASK_CLASS(AP_Stats, &copter.g2.stats, update, 1, 100),
|
SCHED_TASK_CLASS(AP_Stats, &copter.g2.stats, update, 1, 100),
|
||||||
#endif
|
#endif
|
||||||
|
#if OSD_ENABLED == ENABLED
|
||||||
|
SCHED_TASK(publish_osd_info, 1, 10),
|
||||||
|
#endif
|
||||||
};
|
};
|
||||||
|
|
||||||
void Copter::read_aux_all()
|
void Copter::read_aux_all()
|
||||||
|
@ -580,4 +583,16 @@ void Copter::update_altitude()
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#if OSD_ENABLED == ENABLED
|
||||||
|
void Copter::publish_osd_info()
|
||||||
|
{
|
||||||
|
AP_OSD::NavInfo nav_info;
|
||||||
|
nav_info.wp_distance = flightmode->wp_distance();
|
||||||
|
nav_info.wp_bearing = flightmode->wp_bearing();
|
||||||
|
nav_info.wp_xtrack_error = flightmode->crosstrack_error();
|
||||||
|
nav_info.wp_number = mission.get_current_nav_index();
|
||||||
|
osd.set_nav_info(nav_info);
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
AP_HAL_MAIN_CALLBACKS(&copter);
|
AP_HAL_MAIN_CALLBACKS(&copter);
|
||||||
|
|
|
@ -919,6 +919,10 @@ private:
|
||||||
void userhook_auxSwitch2(uint8_t ch_flag);
|
void userhook_auxSwitch2(uint8_t ch_flag);
|
||||||
void userhook_auxSwitch3(uint8_t ch_flag);
|
void userhook_auxSwitch3(uint8_t ch_flag);
|
||||||
|
|
||||||
|
#if OSD_ENABLED == ENABLED
|
||||||
|
void publish_osd_info();
|
||||||
|
#endif
|
||||||
|
|
||||||
#include "mode.h"
|
#include "mode.h"
|
||||||
|
|
||||||
Mode *flightmode;
|
Mode *flightmode;
|
||||||
|
|
Loading…
Reference in New Issue