Patent attributes
A navigation system for a dynamic platform includes an inertial navigation system (INS) unit for measuring, in real-time, linear accelerations and angular velocities of the dynamic platform, and determining, using dead reckoning, initial estimates of current poses of the dynamic platform based on a previous pose of the dynamic platform and the linear accelerations and angular velocities of the dynamic platform. The navigation system further includes an exteroceptive sensor for acquiring sequential images of an environment in which the dynamic platform is traveling, a simultaneous localization and mapping (SLAM) unit for estimating visual odometer (VO) pose changes of the dynamic platform using the sequential images, and a sensor fusion engine for determining estimates of current poses of the dynamic platform based at least in part on the initial estimates of current poses determined by the INS unit and the VO pose changes estimated by the local sub-map tracker.
