AP_NavEKF : Changed timout behaviour to only reset PosVel states
AP_NavEKF : Cleaned up InitialiseFilterDynamic
AP_NavEKF : staticMode bugfix and robustness improvements
AP_NavEKF : Position and Velocity reset bugfix