Heading machine positioning method and system based on inertial navigation and laser radar single-point distance measurement

Abstract

The invention discloses a heading machine positioning method based on inertial navigation and laser radar single-point distance measurement. The method comprises the following steps: a laser radar isused for scanning a tunneling reference surface, wherein a control point exists on the reference surface, coordinates of the control points are known, the distance from the control point to the laserradar is solved, and the distance is converted to a navigation coordinate system by using a mounting error matrix between a heading machine and the laser radar and an attitude matrix provided by an inertial navigation system so as to obtain the position of the heading machine; the value is fused with position information provided by inertial navigation by using a Kalman filter so as to obtain high-precision position information. The positioning method can meet the long-time high-precision positioning and orientating requirements for the heading machine, and has the advantages of passive measurement, capability of establishing an own system, low possibility of interference and accurate positioning. Meanwhile, the invention further discloses a heading machine positioning system based on theinertial navigation and the laser radar single-point distance measurement.

Description

technical field [0001] The invention relates to the technical field of positioning of roadheading machines, in particular to a roadheading machine positioning method and system based on inertial navigation and laser radar single-point ranging. Background technique [0002] The precise positioning and orientation system of the roadheader is a key issue in the excavation of roadways, tunnels, etc. The positioning and orientation system directly affects the efficiency and quality of the roadheader's work. The working environment of roadheaders and other mining construction machinery has large dust, strong noise and poor lighting conditions, which seriously affects the physical and mental health of operators and work efficiency. In order to reduce the workload of roadheader operators and improve the safety of tunneling workers, the roadway Machines are gradually transforming into automation. [0003] The autonomous positioning and orientation system of the roadheader is the key...

AI Technical Summary

Problems solved by technology

[0004] (1) Disadvantages of the autonomous positioning technology of the roadheader based on laser positioning: because this method uses the laser positioning sensor to generate a position signal based on the laser beam received by the laser target to obtain the location of the roadheader, this method can only get the position of the roadheader information, but cannot effectively obtain the direction and attitude of the roadheader traveling in the roadway

[0005] (2) The disadvantages of the autonomous positioning technology of the roadheader based on the inertial navigation system are: because this method uses the inertial navigation system to determine the position information of the carrier in real time, but the inertial navigation system uses the inertial measurement element to measure the acceleration of the carrier and obtain it through integration. The attitude and position information of the carrier, gyro drift and other factors cause errors to accumulate over time, and the roadheader usually needs to work underground for a week or more. Therefore, the position mea

Images