Method and system for positioning using optical sensor and motion sensors

Abstract

An integrated navigation solution is provided for a device within a moving platform. Motion sensor data from a sensor assembly of the device is obtained, optical samples from at least one optical sensor for the platform are obtained and map information for an environment encompassing the platform is obtained. Correspondingly, an integrated navigation solution is generated based at least in part on the obtained motion sensor data using a nonlinear state estimation technique, wherein the nonlinear state estimation technique uses a nonlinear measurement model for optical sensor data. Generating the integrated navigation solution includes using the sensor data with the nonlinear state estimation technique and integrating the optical sensor data directly by updating the nonlinear state estimation technique using the nonlinear measurement model and the map information. The integrated navigation solution is then provided.