Lost-in-forest GPS-denied positioning system
Local terrain feature location data is obtained from a local sensor device at a user location without a prior-known global position. The local terrain feature location data characterizes relative distances and directions to a plurality of local terrain features nearest to the user location. Global terrain feature location data stored in at least one hardware memory device is accessed. The global terrain feature location data characterizes relative distances and directions between a plurality of distinctive terrain features located in a defined terrain region in terms of absolute global location coordinates. The local terrain feature location data is compared to the global terrain feature location data to develop multiple pattern matching hypotheses, wherein each pattern matching hypothesis characterizes a likelihood of a subset of the local terrain features matching a subset the global terrain features. Global location coordinates for the user location is then determined from the pattern matching hypotheses.
1. A method for determining global location coordinates, comprising:
using a local sensor device selected from the group consisting of: a LiDar sensor, a laser range finder, and a camera, at a user location without a prior-known global position, to obtain local terrain feature location data characterizing relative distances and directions to a plurality of local terrain features nearest to the user location;
storing in a hardware memory device global terrain feature location data, wherein the global terrain feature location data characterizes relative distances and directions between a plurality of distinctive terrain features located in a defined terrain region in terms of absolute global location coordinates, wherein the defined terrain region encompasses at least ninety thousand square meters (90,000 m 2 ); and
executing, with a navigation processor, program instructions to:
receive, from the local sensor device local terrain feature location data and from the hardware memory device, global terrain feature location data;
compare the local terrain feature location data to the global terrain feature location data based on a k-closest vector search algorithm; wherein the k-closest vector search algorithm includes developing a k-closest feature vector for each of a plurality of local terrain features and a k-closest feature vector for each of a plurality of global terrain features;
develop a plurality of pattern matching hypotheses using the k-closest feature vector for each of a plurality of local terrain features and the k-closest feature vector for each of a plurality of global terrain features, wherein each pattern matching hypothesis characterizes a likelihood of the plurality of local terrain features matching a subset of the plurality of global terrain features, wherein the likelihood is reiterated for each new locally observed terrain feature to form a reference frame having a group of locally observed terrain features; and
determine the global location coordinates for the user location from the plurality of pattern matching hypotheses wherein determining the global location coordinates for the user location from the plurality of pattern matching hypotheses accommodates possible additions and deletions of terrain features in the local terrain feature location data compared to the subset of the global terrain features.
2. The method according to claim 1 , further comprising:
updating the global location coordinates for the user location as the user location varies over time with user movement.
3. The method according to claim 2 , wherein the local sensor further includes an inertial measurement unit (IMU) device, wherein the local terrain feature location data includes IMU data.
4. The method according to claim 1 , wherein the comparing includes considering mapping uncertainty factors in terms of a defined pattern matching confidence threshold.
5. The method according to claim 1 , wherein the global terrain feature location data is derived from overhead imaging data.
6. The method according to claim 1 , wherein the global terrain feature location data is derived from Lidar data and/or radar data.
7. The method according to claim 1 , wherein the distinctive terrain features comprise trees.
8. A system for determining global location coordinates comprising:
a local sensor device selected from the group consisting of: a LiDar sensor, a laser range finder, and a camera, at a user location without a prior-known global position, configured to obtain local terrain feature location data characterizing relative distances and directions to a plurality of local terrain features nearest to the user location;
a hardware memory device storing global terrain feature location data, wherein the global terrain feature location data characterizes relative distances and directions between a plurality of distinctive terrain features located in a defined terrain region in terms of absolute global location coordinates, wherein the defined terrain region encompasses at least ninety thousand square meters (90,000 m 2 );
a navigation processor configured to execute program instructions to:
receive, from the local sensor device local terrain feature location data and from the hardware memory device global terrain feature location data;
compare the local terrain feature location data to the global terrain feature location data based on a k-closest vector search algorithm; wherein the k-closest vector search algorithm includes developing a k-closest feature vector for each of a plurality of local terrain features and a k-closest feature vector for each of a plurality of global terrain features;
develop a plurality of pattern matching hypotheses using the k-closest feature vector for each of a plurality of local terrain features and the k-closest feature vector for each of a plurality of global terrain features, wherein each pattern matching hypothesis characterizes a likelihood of the plurality of local terrain features matching a subset of the plurality of global terrain features, wherein the likelihood is reiterated for each new locally observed terrain feature to form a reference frame having a group of locally observed terrain features; and
determine global location coordinates for the user location from the plurality of pattern matching hypotheses wherein determining the global location coordinates for the user location from the plurality of pattern matching hypotheses accommodates possible additions and deletions of terrain features in the local terrain feature location data compared to the subset of the global terrain features.
9. The system according to claim 8 , wherein navigation processor is further configured to:
update the global location coordinates for the user location as the user location varies over time with user movement.
10. The system according to claim 9 , wherein the local sensor further includes an inertial measurement unit (IMU) device, wherein the local terrain feature location data includes IMU data.
11. The system according to claim 8 , wherein the comparing includes considering mapping uncertainty factors in terms of a defined pattern matching confidence threshold.
12. The system according to claim 8 , wherein the global terrain feature location data is derived from overhead imaging data.
13. The system according to claim 8 , wherein the global terrain feature location data is derived from LiDar data and/or radar data.
14. The system according to claim 8 , wherein the distinctive terrain features comprise trees.
15. A method for determining global location coordinates, comprising:
using a local sensor device selected configured to obtain local terrain feature location data characterizing relative distances and directions to a plurality of local terrain features nearest to a user location;
storing in a hardware memory device global terrain feature location data, wherein the global terrain feature location data characterizes relative distances and directions between a plurality of distinctive terrain features located in a defined terrain region in terms of absolute global location coordinates; and
executing, with a navigation processor, program instructions to:
receive, from the local sensor device local terrain feature location data and from the hardware memory device, global terrain feature location data;
compare the local terrain feature location data to the global terrain feature location data;
develop a plurality of pattern matching hypotheses, wherein each pattern matching hypothesis characterizes a likelihood of the plurality of local terrain features matching a subset of the global terrain features, wherein the likelihood is reiterated for each new locally observed terrain feature to form a reference frame having a group of locally observed terrain features; and
determine the global location coordinates for the user location from the plurality of pattern matching hypotheses wherein determining the global location coordinates for the user location from the plurality of pattern matching hypotheses accommodates possible additions and deletions of terrain features in the local terrain feature location data compared to the subset of the global terrain features.