Fix to Stabilize deceleration code. Thanks to Bob Doiron.
Merge branch 'Heli_Dev_3' of https://github.com/R-Lefebvre/ardupilot into Heli_Dev_3