Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-11 02:18:29 -04:00
Code Issues Packages Projects Releases Wiki Activity

APM: fixed throttle display to always be between 0 and 100

Browse Source 
when rc3 is below RC3_MIN, don't give an invalid value
This commit is contained in:
Andrew Tridgell 2012-11-20 13:50:11 +11:00
parent 8ccac5da3d
commit f80783665f
1 changed files with 4 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
ArduPlane/GCS_Mavlink.pde
View File

@ -358,12 +358,15 @@ static void NOINLINE send_vfr_hud(mavlink_channel_t chan)
} else if (!ahrs.airspeed_estimate(&aspeed)) {
aspeed = 0;
}
float throttle_norm = g.channel_throttle.norm_output() * 100;
throttle_norm = constrain(throttle_norm, -100, 100);
uint16_t throttle = ((uint16_t)(throttle_norm + 100)) / 2;
mavlink_msg_vfr_hud_send(
chan,
aspeed,
(float)g_gps->ground_speed * 0.01,
(ahrs.yaw_sensor / 100) % 360,
(uint16_t)(100 * (g.channel_throttle.norm_output() / 2.0 + 0.5)), // scale -1,1 to 0-100
throttle,
current_loc.alt / 100.0,
barometer.get_climb_rate());
}