AP_NavEKF : Removed double to float conversions