Initializing position and direction of mining vehicle

• US 20060265166A1
• Filed: 03/25/2004
• Published: 11/23/2006
• Est. Priority Date: 03/25/2003
• Status: Active Grant

• Current Assignee: Sandvik Tamrock Oy (Sandvik AB)
• Original Assignee: Sandvik Tamrock Oy (Sandvik AB)
• Inventors: Mäkelä, Hannu
• Granted Patent: US 7,392,151 B2
• Time in Patent Office: Days
• US Class Current: 702/95
• CPC Class Codes: G01C 21/30 Map- or contour-matching
• CPC Class Codes: G05D 1/0038 by providing the operator with simple or augmented images from one or more cameras located onboard the vehicle, e.g. tele-operation images analyzed by a computer and used for automatic navigation G05D1/0246
• CPC Class Codes: G05D 1/024 in combination with a laser lasers per se H01S
• CPC Class Codes: G05D 1/0255 using acoustic signals, e.g. ultra-sonic singals sonar systems designed for anti-collision purposes G01S15/93
• CPC Class Codes: G05D 1/027 comprising intertial navigation means, e.g. azimuth detector inertial navigation G01C21/16; inertial navigation combined with non-inertial navigation instruments G01C21/165

Abstract

A method of initializing the position and direction of a mining vehicle, and a mining vehicle. An environmental model and route points are stored in a control system of the vehicle. The environment of the vehicle is scanned, and scanned points are generated based on obstacles observed. The control system is arranged to determine coordinates of the scanned points by using the position of the route points within a search range and at least one direction. The coordinates calculated for the scanned points are compared with the environmental model. Such a route point and direction are selected as initial values for the mining vehicle, by which the generated coordinates of the scanned points best match the environmental model.

Claims

1. A method of initializing the position and direction of a mining vehicle, the mining vehicle comprising a movable carrier and a control system, and wherein the control system is arranged to read an electronic environmental model including data on coordinates of an environment delimiting a route;

and a route including at least the coordinates of route points of the route to be driven, the method comprising;

scanning the environment of the mining vehicle and determining scanned points on the basis of obstacles detected by the scanning;

determining a search range including at least part of the route points of the preplanned route of the mining vehicle;

selecting each route point within the search range at a time as the position of the mining vehicle;

calculating coordinates for the scanned points of the scanning by using each route point within the search range and at least one direction;

comparing the coordinates calculated for the scanned points with the environmental model;

and selecting such a route point and direction as the initial values of the vehicle, the coordinates of the scanned points of which best match the environmental model.

2. A method as claimed in claim 1, comprising

selecting the direction of the route at the route point observed as the direction,

changing the direction in steps by a predetermined tolerance for each route point observed relative to a direction of the route specified by the route point,

calculating the coordinates of the scanned points for each direction,

and comparing, based on each direction, the calculated coordinates of the scanned points with the environmental model.

3. A method as claimed in claim 1, comprising

estimating the position of the vehicle,

and outlining the search range based on the position, the search range comprising only part of the route points specifying the route driven.

4. A method as claimed in claim 1, comprising

estimating the position of the vehicle,

outlining the search range based on the position, the search range comprising only part of the route points specifying the route driven.

and outlining the search range manually by an operator.

5. A method as claimed in claim 1, comprising

performing a plurality of scannings,

determining a median for each direction of the scanning based on the scannings,

and using the median determined for each direction in the determination of the scanned points.

6. A method as claimed in any claim 1, comprising

determining a correlation coefficient based on a comparison of the compatibility of the coordinates of each scanned point and the environmental model,

and selecting the initial values by comparing the generated correlation coefficients with each other.

7. A method as claimed in claim 1, comprising

giving the control system at least two points specifying the assumed route,

generating the assumed route in the control system based on the position of the points given,

and performing the initialization based on the assumed route and the environmental model.

8. A mining vehicle, comprising:

a movable carrier;

a control system including at least one control unit arranged to read an electronic environmental model including data on coordinates of an environment delimiting a route; and

a route including at least the coordinates of route points of the route to be driven;

at least one scanner for detecting obstacles in the environment of the vehicle;

means for determining scanned points on the basis of the results of the scanning,

and wherein

the control system is arranged to determine coordinates for the scanned points by using the position of the route points within a predetermined search range and at least one direction;

the control system is arranged to compare the coordinates calculated for the scanned points with the environmental model;

and the control system is arranged to select such a route point and direction as the initial values of the vehicle, by which the generated coordinates of the scanned points best match the environmental model.

9. A method of initializing the position and direction of a mining vehicle,

the mining vehicle comprising a movable carrier and a control system, and wherein the control system is arranged to read an electronic environmental model including data on coordinates of an environment delimiting a route;

and a route including at least the coordinates of route points of the route to be driven,

and in which method;

the environment of the mining vehicle is scanned, and

scanned points are determined on the basis of obstacles detected by the scanning,

the method further comprising

selecting one route point as the initial point of the search;

selecting a plurality of other route points for observation starting from the initial point;

calculating coordinates for the scanned points of the scanning by using the selected route points and at least one direction;

comparing the coordinates calculated for the scanned points with the environmental model;

and selecting such a route point and direction as the initial value of the vehicle, the coordinates of the scanned points of which fulfil a predetermined criterion.

10. A method as claimed in claim 9, comprising delimiting the number of route points to be observed.

11. A mining vehicle:

a movable carrier;

a control system including at least one control unit arranged to read an electronic environmental model including data on coordinates of an environment delimiting a route; and

a route including at least the coordinates of route points of the route to be driven;

at least one scanner for detecting obstacles in the environment of the vehicle;

means for determining scanned points on the basis of the results of the scanning,

and wherein

the control system is arranged to determine the position of one selected route point

and at least one direction as the initial point by using the coordinates of the scanned points;

the control system is arranged to determine coordinates of the scanned points for a plurality of route points starting from the initial point;

the control system is arranged to compare the coordinates calculated for the scanned points with the environmental model;

and the control system is arranged to select such a route point and direction as the initial values of the vehicle, by which the generated coordinates of the scanned points fulfil a predetermined criterion.