Autonomous platform guidance systems with unknown environment mapping

1. A system for obtaining position features for guiding a mobile platform, the system including:

a mobile platform;

a sensory interface coupled to one or more sensors including at least some visual sensors and at least some inertial sensors, wherein a sensor of the one or more sensors senses one or more of: a position, a motion, or an environment of the mobile platform;

a database comprising feature point data obtained from sets of feature points identified in frames of images previously obtained by the visual sensors;

a processor coupled to the sensory interface, the mobile platform, the database, and a non-transitory computer readable storage medium, wherein the non-transitory computer readable storage medium stores computer instructions, which, when executed, cause the processor to guide and control the mobile platform and further cause the processor to:

determine, based upon a parameter of the one or more sensors, a statistical window of confidence, wherein the statistical window of confidence comprises a threshold number of sensor readings of the one or more sensors per a threshold length of time, wherein the statistical window of confidence provides a predetermined statistical degree of confidence in the sensor readings;

obtain sensor readings above the statistical degree of confidence using the statistical window of confidence;

maintain time dependent tracking state data using the sensor readings obtained according to the statistical window of confidence, wherein the time dependent tracking state data includes: (i) 3D coordinate pose data (x, y, and theta) of the mobile platform, and (ii) one or more frames of sensor readings including at least some frames from the visual sensors, and wherein sensor readings can include sensory information received from any one of a plurality of sensors available to the mobile platform;

create a set of shared 2D features comprising of 2D feature points identified in at least some frames of images obtained from visual sensors; and

triangulate 2D feature points from the set of shared 2D features thereby forming a 3D point set indicating a 3D position of features;

calculate a location of at least one 2D feature in a current frame using optical flow;

identify features existing along an epipolar line based upon the calculated location and a prediction of a camera pose;

check for similarity between descriptors of an identified feature and descriptors of a corresponding feature from a previous frame;

determine whether the number of features identified through optical flow is less than a number of corresponding features detected in the current frame, and when the number of features identified through optical flow is less than a number of corresponding features detected in the current frame, detect 2D corner features directly from the current frame at image regions without features; and

bin the image spatially, and adjusts a number of features in each bin so that the number of features in the bins is balanced.

2. The system of claim 1 , wherein the processor: links features in different images captured at different times by a same camera.

3. The system of claim 1 , wherein the processor: correlates unmatched features for a camera, by:

collecting a set of features that are not matched to any other features by existing links;

collecting a set of available links that do not match a feature from the camera in a current time frame;

calculating a similarity score between each member in the set of features and each member in the set of available links;

wherein similarity between a feature and a link is a best similarity score between a descriptor of the feature and descriptors of features in the link; and

if the similarity score is greater than a threshold, adding the feature to the link.

4. A non-transitory computer readable medium having instructions stored thereon, which, when executed, cause a processor to obtain position features for guiding a mobile platform, including causing the processor to:

determine, based upon a parameter of one or more sensors, a statistical window of confidence, wherein the statistical window of confidence comprises a threshold number of sensor readings of the one or more sensors per a threshold length of time, wherein the statistical window of confidence provides a predetermined statistical degree of confidence in the sensor readings;

obtain sensor readings above the statistical degree of confidence using the statistical window of confidence;

maintain time dependent tracking state data using the sensor readings obtained according to the statistical window of confidence, wherein the time dependent tracking state data includes:

(i) 3D coordinate pose data (x, y, and theta) of the mobile platform, and

(ii) one or more frames of sensor readings including at least some frames from one or more visual sensors, and wherein sensor readings can include sensory information received from any one of a plurality of sensors available to the mobile platform;

create a set of shared 2D features comprising of 2D feature points identified in at least some frames of images obtained from visual sensors;

triangulate 2D feature points from the set of shared 2D features thereby forming a 3D point set indicating a 3D position of features;

calculate a location of at least one 2D feature in a current frame using optical flow;

identify features existing along an epipolar line based upon the calculated location and a prediction of a camera pose;

check for similarity between descriptors of an identified feature and descriptors of a corresponding feature from a previous frame;

determine whether the number of features identified through optical flow is less than a number of corresponding features detected in the current frame, and when the number of features identified through optical flow is less than a number of corresponding features detected in the current frame, detect 2D corner features directly from the current frame at image regions without features; and

bin the image spatially, and adjusts a number of features in each bin so that the number of features in the bins is balanced.

5. A method of obtaining position features for guiding a mobile platform, including:

determine, based upon a parameter of one or more sensors, a statistical window of confidence, wherein the statistical window of confidence comprises a threshold number of sensor readings of the one or more sensors per a threshold length of time, wherein the statistical window of confidence provides a predetermined statistical degree of confidence in the sensor readings;

obtain sensor readings above the statistical degree of confidence using the statistical window of confidence;

maintain time dependent tracking state data using the sensor readings obtained according to the statistical window of confidence, wherein the time dependent tracking state data includes:

(i) 3D coordinate pose data (x, y, and theta) of the mobile platform, and

(ii) one or more frames of sensor readings including at least some frames from one or more visual sensors, and wherein sensor readings can include sensory information received from any one of a plurality of sensors available to the mobile platform;

create a set of shared 2D features comprising of 2D feature points identified in at least some frames of images obtained from visual sensors;

triangulate 2D feature points from the set of shared 2D features thereby forming a 3D point set indicating a 3D position of features;

calculating a location of at least one 2D feature in a current frame using optical flow;

identifying features existing along an epipolar line based upon the calculated location and a prediction of a camera pose;

checking for similarity between descriptors of an identified feature and descriptors for a corresponding feature from a previous frame;

determining whether the number of features identified through optical flow is less than a number of corresponding features detected in the current frame, and when the number of features identified through optical flow is less than a number of corresponding features detected in the current frame, detecting 2D corner features directly from the current frame at image regions without features; and

binning the image spatially and adjusting a number of features in each bin so that the number of features in the bins is balanced.

6. The method of claim 5 , further including: linking features in different images captured at different times by a same camera.

7. The method of claim 5 , further including:

correlating unmatched features for a camera, by:

collecting a set of features that are not matched to any other features by existing links;

collecting a set of available links that do not match a feature from the camera in a current time frame;

calculating a similarity score between each member in the set of features and each member in the set of available links;

wherein similarity between a feature and a link is a best similarity score between a descriptor of the feature and descriptors of features in the link; and

if the similarity score is greater than a threshold, adding the feature to the link.