AP_InertialNav: bug fix for gps delay handling