System and method of navigation based on state estimation using a stepped filter

摘要

Embodiments include systems and methods of navigation. In on embodiment, a plurality of position and motion states of a vehicle are estimated. The states may be estimated based on information received from a satellite receiver and an inertial measurement sensor. Estimating the states comprises performing one or more of a plurality of update steps at the rate that information is received from the satellite receiver. The states are estimated at a rate greater than the rate at which the update steps are performed. In one embodiment, the states are estimated using a stepped extended Kalman filter.