Plane: Set default airspeed variance using airspeed range

4 years ago · f5f13b9a47
1 changed files with 2 additions and 1 deletions
--- a/ArduPlane/ArduPlane.cpp
+++ b/ArduPlane/ArduPlane.cpp
@ -267,7 +267,8 @@ void Plane::one_second_loop()
				@@ -267,7 +267,8 @@ void Plane::one_second_loop()
    adsb.set_stall_speed_cm(aparm.airspeed_min);
    adsb.set_max_speed(aparm.airspeed_max);
 #endif
-    ahrs.writeDefaultAirSpeed((float)((aparm.airspeed_min + aparm.airspeed_max)/2));
+    ahrs.writeDefaultAirSpeed((float)((aparm.airspeed_min + aparm.airspeed_max)/2),
+                              (float)((aparm.airspeed_max - aparm.airspeed_min)/2));

    // sync MAVLink system ID
    mavlink_system.sysid = g.sysid_this_mav;