Macdonald, Dettwiler and Associates Corporation

Joshua A Marshall

Timothy D Barfoot

Raja Mukherji

Robert Ward

Robert S Ward

The present invention provides a guidance, navigation, and control method and system for an underground mining vehicle that allow said vehicle to be taught a route by a human operator and then have it automatically drive the route with no human intervention. The method works in three steps: teaching, route profiling, and playback. In the teaching step the vehicle is manually driven by a operator along a route which can consist of an arbitrary sequence of maneuvers including tramming forwards, switching directions, tramming backwards, turning, or pausing movement. During this phase raw data from vehicle-mounted sensors including odometric sensors and rangefinders are logged to a file throughout teaching for later processing. During the (offline) route profiling step, the raw data in the log file are processed into a route profile, and a profile of desired speed as a function of distance along the path.

Guidance, navigation, and control system for a vehicle

A guidance, navigation, and control method and system for an underground mining vehicle wherein an operator directly or indirectly guides the vehicle along a route as vehicle-mounted sensors including odometric sensors and rangefinders log motion data to a file which data is processed into a route profile including a vehicle path, a sequence of submaps along the path, and a profile of desired speed as a function of distance along the path. Thereafter the vehicle automatically repeats the route as represented by the route profile without an operator using the sensors and the maps to determine vehicle location.

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.

Growing community of inventors

Bolton, Canada

Joshua A Marshall