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

AP_OSD: cope with no EKF for vspeed

Browse Source
This commit is contained in:
Andrew Tridgell 2018-07-10 13:12:49 +10:00
parent 4939f30ec4
commit 6328a7233f
1 changed files with 6 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
libraries/AP_OSD/AP_OSD_Screen.cpp
View File

@ -629,8 +629,12 @@ void AP_OSD_Screen::draw_aspeed(uint8_t x, uint8_t y)
void AP_OSD_Screen::draw_vspeed(uint8_t x, uint8_t y)
{
Vector3f v;
AP::ahrs().get_velocity_NED(v);
float vspd = -v.z;
float vspd;
if (AP::ahrs().get_velocity_NED(v)) {
vspd = -v.z;
} else {
vspd = AP::baro().get_climb_rate();
}
char sym;
if (vspd > 3.0f) {
sym = SYM_UP_UP;