System and method for the creation of a terrain density model
First Claim
Patent Images
1. A method of constructing a density map for local terrain comprising the steps of dividing said local terrain into a grid of cells;
- obtaining readings for at least a portion of said cells from one or more environmental sensors; and
providing a vector for each of said cells in said grid for which readings are available, said vector representing the density of the terrain represented by each of said cells.
1 Assignment
0 Petitions
Accused Products
Abstract
A system and method of constructing a density map is disclosed. The density map is a cellular grid representing local terrain, wherein each cell contains a density vector representing the density of portion of the terrain corresponding to the cell. The density map can be used to classify and characterize the surrounding terrain, which is useful in making a determination of the traversability of the terrain to mobile vehicles.
141 Citations
23 Claims
-
1. A method of constructing a density map for local terrain comprising the steps of dividing said local terrain into a grid of cells;
-
obtaining readings for at least a portion of said cells from one or more environmental sensors; and
providing a vector for each of said cells in said grid for which readings are available, said vector representing the density of the terrain represented by each of said cells. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16)
determining, from said readings from said one or more sensors, the minimum elevation for those cells for which a reading is available; and
storing said minimum elevation data with said density vector for each of said cells.
-
-
4. The method of claim 3 further comprising the steps of:
-
determining, from said readings from said one or more sensors, the maximum elevation for those cells for which a reading is available; and
storing said maximum elevation data with said density vector for each of said cells.
-
-
5. The method of claim 1 wherein a new density map is re-generated at periodic intervals.
-
6. The method of claim 5 wherein said density map is cleared prior the generation of a new map.
-
7. The method of claim 5 wherein a portion of said density map is discarded and a portion is retained, and further wherein said retained portion is used to establish a new density map.
-
8. The method of claim 7 wherein said portion of said density map which is discarded contains the oldest of said readings and said portion of said density map which is retained contains the latest of said readings.
-
9. The method of claim 2 wherein said step of obtaining permeability readings further comprises the steps of:
-
directing said one or more sensors to emit energy at specific wavelengths directed in a specific direction;
measuring the degree of said energy reflected back to said sensors and the time elapsed between the emission of said energy and the detection of said reflected energy; and
determining the percentage of said emitted energy which is reflected back from said local terrain corresponding to one or more of said grid cells located at varying distances from said sensors.
-
-
10. The method of claim 1 wherein said one or more sensors are located on a mobile platform and further comprising the step of:
normalizing said readings received from said one or more sensors to compensate for motion of said mobile platform.
-
11. The method of claim 10 wherein each of said grid cells is assigned grid coordinates and wherein said step of normalizing said readings further comprises the steps of:
-
establishing a base reference for said grid coordinates based on the actual or estimated position of said mobile platform;
for each of said readings from said one or more sensors, adjusting the position of said reading to compensate for actual or estimated movement of said mobile platform since the establishment of said base reference.
-
-
12. The method of claim 11 further comprising the step of periodically re-establishing said base reference based on the actual or estimated position of said mobile platform.
-
13. The method of claim 12 further comprising the step of clearing said density map of all data prior to said establishment of a new base reference.
-
14. The method of claim 12 further comprising the step of re-normalizing any readings retained in said density map to said new base reference.
-
15. The method of claim 1 further comprising the step of providing a classification of said local terrain for each of said cells based on an interpretation of all data associated with each of said cells.
-
16. The method of claim 15 wherein said classification provides an indication of whether or not a mobile vehicle could traverse an area of said local terrain associated with any one of said cells.
-
17. An apparatus for assisting the autonomous navigation of a mobile vehicle comprising:
-
one or more environmental sensors mounted on said vehicle;
a processor programmed to receive data readings from said one or more sensors; and
software for constructing a density map based on said readings;
wherein said density map contains cells representing physical areas surrounding said vehicle and further wherein each of said cells contains at least a minimum terrain elevation and a density vector. - View Dependent Claims (18, 19, 20, 21, 22, 23)
software capable of interpreting said density map to establish a classification of said physical areas surrounding said vehicle corresponding to each of said cells.
-
-
23. The apparatus of claim 22 wherein said classification of said physical areas surrounding said vehicle is used to determine if said mobile vehicle can traverse said terrain.
Specification