Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_OSD_Screen.cpp: add decimal precision to vspd

This commit is contained in:
vierfuffzig 2020-10-01 21:40:03 +02:00 committed by Andrew Tridgell
parent 5e2450c4ea
commit 60b37f395e
1 changed files with 7 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
libraries/AP_OSD/AP_OSD_Screen.cpp
View File

@ -1394,6 +1394,7 @@ void AP_OSD_Screen::draw_vspeed(uint8_t x, uint8_t y)
{
Vector3f v;
float vspd;
float vs_scaled;
AP_AHRS &ahrs = AP::ahrs();
WITH_SEMAPHORE(ahrs.get_semaphore());
if (ahrs.get_velocity_NED(v)) {
@ -1413,8 +1414,12 @@ void AP_OSD_Screen::draw_vspeed(uint8_t x, uint8_t y)
} else {
sym = SYM_DOWN_DOWN;
}
vspd = fabsf(vspd);
backend->write(x, y, false, "%c%2d%c", sym, (int)u_scale(VSPEED, vspd), u_icon(VSPEED));
vs_scaled = u_scale(VSPEED, fabsf(vspd));
if (vs_scaled < 5.0f) {
backend->write(x, y, false, "%c%2.1f%c", sym, (float)vs_scaled, u_icon(VSPEED));
} else {
backend->write(x, y, false, "%c%3d%c", sym, (int)vs_scaled, u_icon(VSPEED));
}
}
#ifdef HAVE_AP_BLHELI_SUPPORT