|
|
@ -186,6 +186,8 @@ void Plane::read_radio() |
|
|
|
|
|
|
|
|
|
|
|
control_failsafe(); |
|
|
|
control_failsafe(); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
airspeed_nudge_cm = 0; |
|
|
|
|
|
|
|
throttle_nudge = 0; |
|
|
|
if (g.throttle_nudge && channel_throttle->get_control_in() > 50 && geofence_stickmixing()) { |
|
|
|
if (g.throttle_nudge && channel_throttle->get_control_in() > 50 && geofence_stickmixing()) { |
|
|
|
float nudge = (channel_throttle->get_control_in() - 50) * 0.02f; |
|
|
|
float nudge = (channel_throttle->get_control_in() - 50) * 0.02f; |
|
|
|
if (ahrs.airspeed_sensor_enabled()) { |
|
|
|
if (ahrs.airspeed_sensor_enabled()) { |
|
|
@ -193,9 +195,6 @@ void Plane::read_radio() |
|
|
|
} else { |
|
|
|
} else { |
|
|
|
throttle_nudge = (aparm.throttle_max - aparm.throttle_cruise) * nudge; |
|
|
|
throttle_nudge = (aparm.throttle_max - aparm.throttle_cruise) * nudge; |
|
|
|
} |
|
|
|
} |
|
|
|
} else { |
|
|
|
|
|
|
|
airspeed_nudge_cm = 0; |
|
|
|
|
|
|
|
throttle_nudge = 0; |
|
|
|
|
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
rudder_arm_disarm_check(); |
|
|
|
rudder_arm_disarm_check(); |
|
|
|