Traffic management system for a passageway environment
First Claim
1. A traffic management system for one or more vehicles located in a passageway environment comprising:
- a) one or more vehicles, each equipped with one or more odometric sensors, one or more range-sensing devices, and a microprocessor including memory storage, said one or more odometric sensors and one or more range-sensing devices being connected to said microprocessor;
b) route planning means for generating strategic route plans for said one or more vehicles located in said passageway environment;
c) each vehicle including means to estimate its global position and orientation in said passageway environment;
d) vehicle monitoring means for monitoring the global position and orientation of said one or more vehicles in said passageway environment as said one or more vehicles progress along said strategic route plans; and
e) a central microprocessor that executes said route planning and vehicle monitoring means, said central microprocessor being connected to said one or more vehicles by way of a wireless data communications system.
8 Assignments
0 Petitions
Accused Products
Abstract
The present invention provides a system for coordinating multiple vehicles in a passageway environment (e.g., in underground mines). The system includes methods and apparatus for determining the global position and orientation of a vehicle in said passageway environment, and methods for planning routes and monitoring the travels of multiple vehicles in said passageway environment. A global position and orientation estimation system employs one or more odometric sensors and one or more range sensing devices. It works in three basic steps. In the first step, it records and processes sensor data that is descriptive of the passageway environment by moving the system through said passageway environment. In the second step, it generates a globally consistent map of said passageway environment. Finally, real-time localization is provided by employing odometric sensors and range sensing devices to determine the system'"'"'s global position and orientation with respect to said globally consistent map, both initially and as it travels through the passageway environment. A route planning method accepts higher-level goals for a set of multiple vehicles in said passageway environment and generates a route plan for each vehicle that minimizes the travel time for the group of vehicles, while at the same time avoiding collisions between vehicles. Route plans are sent to the vehicles for implementation and a monitoring method tracks the global positions and orientations of the vehicles and ensures that both safety and efficiency are maintained.
160 Citations
126 Claims
-
1. A traffic management system for one or more vehicles located in a passageway environment comprising:
-
a) one or more vehicles, each equipped with one or more odometric sensors, one or more range-sensing devices, and a microprocessor including memory storage, said one or more odometric sensors and one or more range-sensing devices being connected to said microprocessor;
b) route planning means for generating strategic route plans for said one or more vehicles located in said passageway environment;
c) each vehicle including means to estimate its global position and orientation in said passageway environment;
d) vehicle monitoring means for monitoring the global position and orientation of said one or more vehicles in said passageway environment as said one or more vehicles progress along said strategic route plans; and
e) a central microprocessor that executes said route planning and vehicle monitoring means, said central microprocessor being connected to said one or more vehicles by way of a wireless data communications system. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17, 18, 19, 20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31, 32, 33, 34, 35, 36, 37, 38, 39)
-
-
40. A global position and orientation estimation system for a passageway environment comprising
a) one or more odometric sensors, one or more range-sensing devices, and a microprocessor including memory storage, said one or more odometric sensors and one or more range-sensing devices being connected to said microprocessor; - and
b) means for estimating the global position and orientation of the system in a passageway environment comprising i) means for moving the system throughout said passageway environment while simultaneously logging raw data from sensors including said one or more range-sensing devices and said one or more odometric sensors, determining the acquisition times of all raw data, and storing said raw data and acquisition times in said microprocessor memory ii) means for pre-processing said logged data to obtain estimates of the system'"'"'s positions and orientations during the logging process iii) means for storing said logged and pre-processed data to a log file in said microprocessor memory storage iv) means for creating a globally consistent map of said passageway environment from said logged and pre-processed data and storing said globally consistent map in said microprocessor memory, and v) means for repeatedly determining the global position and orientation of the system, in real time, as it is propelled through said passageway environment, using said one or more range-sensing devices, said one or more odometric sensors, said microprocessor, and said globally consistent map of said passageway environment stored in said microprocessor memory. - View Dependent Claims (41, 42, 43, 44, 45, 46, 47, 48, 49, 50, 51, 52, 53, 54, 55, 56, 57, 58, 59, 60, 61, 62, 63, 64)
- and
-
65. A traffic management method for one or more vehicles located in a passageway environment, the vehicles each being equipped with one or more odometric sensors, one or more range-sensing devices, and a microprocessor including memory storage, said one or more odometric sensors and one or more range-sensing devices being connected to said microprocessor, a central microprocessor being connected to said one or more vehicles by way of a wireless data communications system, and said method comprising the steps of:
-
a) generating strategic route plans for said one or more vehicles;
b) estimating global positions and orientations of said one or more vehicles in said passageway environment; and
c) monitoring the global position and orientation of said one or more vehicles in said passageway environment as said one or more vehicles progress along said strategic route plans. - View Dependent Claims (66, 67, 68, 69, 70, 71, 72, 73, 74, 75, 76, 77, 78, 79, 80, 81, 82, 83, 84, 85, 86, 87, 88, 89, 90, 91, 92, 93, 94, 95, 96, 97, 98, 99, 100, 101, 102)
-
-
103. A method for estimating the global position and orientation of a vehicle in a passageway environment, the vehicle being equipped with one or more odometric sensors, one or more range-sensing devices, and a microprocessor including memory storage, said one or more odometric sensors and one or more range-sensing devices being connected to said microprocessor, and said method including the steps of
a) estimating the global position and orientation of the vehicle in a passageway environment by the steps of i) moving the vehicle throughout said passageway environment while simultaneously logging raw data from sensors including said one or more range-sensing devices and said one or more odometric sensors, determining the acquisition times of all raw data, and storing said raw data and acquisition times in said microprocessor memory ii) pre-processing said logged data to obtain estimates of the vehicle'"'"'s positions and orientations during the logging process iii) storing said logged and pre-processed data to a log file in said microprocessor memory storage iv) creating a globally consistent map of said passageway environment from said logged and pre-processed data and storing said globally consistent map in said microprocessor memory, and v) repeatedly determining the global position and orientation of the vehicle, in real time, as it is propelled through said passageway environment, using said one or more range-sensing devices, said one or more odometric sensors, said microprocessor, and said globally consistent map of said passageway environment stored in said microprocessor memory.
Specification