AP_NavEKF : Bug fix for height drift due to timer wrap-around