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

APM: use airspeed estimate for speed scaling if available

Browse Source
This commit is contained in:
Andrew Tridgell 2012-08-24 22:03:03 +10:00
parent 9cf8cc590f
commit 2b30561171
1 changed files with 4 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
ArduPlane/Attitude.pde
View File

@ -10,9 +10,9 @@ static void stabilize()
float ch2_inf = 1.0;
float ch4_inf = 1.0;
float speed_scaler;
float aspeed;
if (airspeed.use()) {
float aspeed = airspeed.get_airspeed();
if (ahrs.airspeed_estimate(&aspeed)) {
if (aspeed > 0) {
speed_scaler = g.scaling_speed / aspeed;
} else {
@ -26,7 +26,8 @@ static void stabilize()
}else{
speed_scaler = 1.67;
}
speed_scaler = constrain(speed_scaler, 0.6, 1.67); // This case is constrained tighter as we don't have real speed info
// This case is constrained tighter as we don't have real speed info
speed_scaler = constrain(speed_scaler, 0.6, 1.67);
}
if(crash_timer > 0) {