A method for locating features in a field of view of an imaging sensor that includes receiving image data from the field of view of an imaging sensor, wherein the image data includes a plurality of image frames. The method also includes receiving three-dimensional position measurements, in an absolute coordinate system, for the imaging sensor at the point in time each image frame is acquired and identifying one or more features in each of the image frames. The method also includes determining position and velocity of the one or more features in the image frames based on changes to the one or more features between the image frames and determining three-dimensional positions of the one or more features in the image frames based on the received three-dimensional position measurements for the imaging sensor and position and velocity of the one or more features in the image frames.