Laser radar calibration method and system and readable storage medium

Through the combination of the inertial navigation system and the spherical target and marking point, the least squares method and exhaustive method are used to calculate the installation angle of the lidar, which solves the problem of lidar calibration in downhole tunnels and achieves high-precision lidar positioning.

CN119044940APending Publication Date: 2024-11-29SANY INTELLIGENT EQUIP CO LTD
View PDF 0 Cites 2 Cited by

Patent Information

Application Number
CN202411239096.7
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-09-05
Publication Date
2024-11-29

AI Technical Summary

Technical Problem

In coal mine tunnels with low light and high dust, the existing lidar calibration methods are difficult to achieve accurate lidar calibration due to the small underground space and uneven ground.

Method used

The coordinates of the marker and spherical targets are calculated by using the inertial navigation system and multiple spherical targets and marking points through the least squares method and exhaustive method, and combined with gravity and horizontal coordinate systems, the installation angle of the lidar is accurately determined.

Benefits of technology

The precise calibration of lidar is achieved in the downhole tunnel, reducing the error in measuring coordinates of markers and spherical targets, and improving the positioning accuracy of lidar.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119044940A_ABST
    Figure CN119044940A_ABST
Patent Text Reader

Abstract

The invention provides a laser radar calibration method and system and a readable storage medium, and relates to the technical field of tunnel construction, the laser radar calibration method and system are used for a heading machine, the heading machine comprises an inertial navigation system and a first laser radar, a plurality of spherical targets and a plurality of identification points are arranged around the heading machine, and a marker is arranged below each spherical target; the laser radar calibration method comprises the following steps: acquiring the coordinate of each identification point in a three-dimensional rectangular coordinate system of a heading machine and the first coordinate of the center of any marker in the three-dimensional rectangular coordinate system of the heading machine; according to the Euler angle, the plurality of first coordinates and the distance from the center of the spherical target to the center of the marker; acquiring a fifth coordinate of the center of each spherical target in the laser radar coordinate system; and based on the plurality of second coordinates, the plurality of fifth coordinates and the coordinates of the laser radar in the three-dimensional rectangular coordinate system of the heading machine, the installation angle of the laser radar on the heading machine is determined, and the laser radar can be calibrated underground.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of tunnel construction, and in particular to a laser radar calibration method, system and readable storage medium. Background Art

[0002] The laser radar positioning system for the roadheader needs to be able to locate quickly and accurately in coal mine tunnels with low light and high dust. Among them, calibrating the installation angle and position of the laser radar on the roadheader is a key link in the positioning of the roadheader. At present, there are two main technical solutions on the well: using targets and direct calibration. The calibration method with the help of targets requires a larger site to obtain the true coordinates of the target in the carrier coordinate system, while the direct calibration technical method requires flat ground and side walls to evaluate the difference between point clouds or normal vectors. The small space of the underground tunnel and the uneven ground and side walls result in poor laser radar calibration. In other words, the harsh tunnel environment affects the underground calibration of the laser radar, and the existing on-site laser radar calibration method is affected by factors such as the small tunnel space, uneven ground and side walls and is not suitable for underground calibration.

[0003] Therefore, there is an urgent need for a laser radar calibration method, system and readable storage medium that can realize laser radar calibration in underground tunnels. Summary of the invention

[0004] In order to solve the above technical problems, the present application proposes a laser radar calibration method, system and readable storage medium that can realize laser radar calibration in underground tunnels.

[0005] To this end, a first aspect of the present invention proposes a laser radar calibration method.

[0006] A second aspect of the present invention provides a laser radar calibration system.

[0007] The third aspect of the present invention proposes another laser radar calibration system.

[0008] A fourth aspect of the present invention provides a readable storage medium.

[0009] In view of this, the first aspect of the present invention proposes a laser radar calibration method for a tunnel boring machine, which includes: an inertial navigation system and a first laser radar, a plurality of spherical targets and a plurality of identification points are arranged around the tunnel boring machine, and a marker is arranged under each spherical target; the laser radar calibration method includes: taking the optical center of the first laser radar as the origin, establishing a three-dimensional rectangular coordinate system of the tunnel boring machine; obtaining the center distance from each identification point to any marker; obtaining the coordinates of each identification point in the three-dimensional rectangular coordinate system of the tunnel boring machine; based on the coordinates of each identification point in the three-dimensional rectangular coordinate system of the tunnel boring machine and the center distance from each identification point to any marker, determining the first coordinate of the center of any marker in the three-dimensional rectangular coordinate system of the tunnel boring machine; taking the optical center of the first laser radar as the origin, establishing a water level system of the tunnel boring machine. horizontal coordinate system; determine the Euler angle of the three-dimensional rectangular coordinate system of the tunnel boring machine relative to the horizontal coordinate system based on the inertial navigation system; determine the second coordinate of the center of each marker in the horizontal coordinate system according to the Euler angle and multiple first coordinates; obtain the third coordinate of the center of each spherical target in the horizontal coordinate system according to the multiple second coordinates and the distance from the center of the spherical target to the center of the marker; determine the fourth coordinate of the center of each spherical target in the three-dimensional rectangular coordinate system of the tunnel boring machine based on the multiple third coordinates and the Euler angle; obtain the fifth coordinate of the center of each spherical target in the first laser radar coordinate system; determine the installation angle of the first laser radar on the tunnel boring machine based on the multiple second coordinates, the multiple fifth coordinates and the coordinates of the first laser radar in the three-dimensional rectangular coordinate system of the tunnel boring machine, and realize the calibration of the first laser radar.

[0010] In this technical solution, a laser radar calibration method is used for a tunnel boring machine, and the tunnel boring machine includes: an inertial navigation system and a first laser radar, multiple spherical targets and multiple identification points are set around the tunnel boring machine, and a marker is set under each spherical target; the laser radar calibration method includes: establishing a three-dimensional rectangular coordinate system of the tunnel boring machine with the optical center of the first laser radar as the origin; obtaining the center distance from each identification point to any marker; obtaining the coordinates of each identification point in the three-dimensional rectangular coordinate system of the tunnel boring machine; based on the coordinates of each identification point in the three-dimensional rectangular coordinate system of the tunnel boring machine and the center distance from each identification point to any marker, determining the first coordinate of the center of any marker in the three-dimensional rectangular coordinate system of the tunnel boring machine; establishing a horizontal coordinate system of the tunnel boring machine with the optical center of the first laser radar as the origin ; Determine the Euler angles of the three-dimensional rectangular coordinate system of the tunnel boring machine relative to the horizontal coordinate system based on the inertial navigation system; determine the second coordinate of the center of each marker in the horizontal coordinate system based on the Euler angles and multiple first coordinates; obtain the third coordinate of the center of each spherical target in the horizontal coordinate system based on the multiple second coordinates and the distance from the center of the spherical target to the center of the marker; determine the fourth coordinate of the center of each spherical target in the three-dimensional rectangular coordinate system of the tunnel boring machine based on the multiple third coordinates and the Euler angles; obtain the fifth coordinate of the center of each spherical target in the first laser radar coordinate system; determine the installation angle of the first laser radar on the tunnel boring machine based on the multiple second coordinates, the multiple fifth coordinates and the coordinates of the first laser radar in the three-dimensional rectangular coordinate system of the tunnel boring machine, and realize the calibration of the first laser radar. Since the spherical target is set artificially and cannot be set at the specified coordinates, especially in the tunnel, it is basically impossible to accurately measure the coordinates of the spherical target. Therefore, it is very difficult to calibrate the laser radar in the tunnel. In the present application, the center of the spherical target is determined by gravity and the horizontal coordinate system. By transforming the coordinate system, the coordinates of the spherical target can be obtained more accurately. Therefore, in the present application, it is possible to obtain the coordinates of the spherical target in the case of a small space in the underground tunnel and uneven ground and side walls, thereby more accurately calibrating the laser radar in the underground tunnel.

[0011] Specifically, the coordinates of the multiple identification points need to have certain differences in three directions.

[0012] In the above technical scheme, further, based on the coordinates of each identification point in the three-dimensional rectangular coordinate system of the tunnel boring machine and the center distance from each identification point to any marker, the step of determining the first coordinate of the center of any marker in the three-dimensional rectangular coordinate system of the tunnel boring machine includes: using the least squares method to process the center distance from each identification point to any marker and the coordinates of each identification point to determine the sixth coordinate of the center of any marker in the three-dimensional rectangular coordinate system of the tunnel boring machine; based on the average distance from the identification point to the center of the marker and the coordinates of the identification point in the three-dimensional rectangular coordinate system of the tunnel boring machine, using the exhaustive method to enumerate the coordinates of the center of the marker in the three-dimensional rectangular coordinate system of the tunnel boring machine to obtain the seventh coordinate of the center of the marker in the three-dimensional rectangular coordinate system of the tunnel boring machine, and the sum of the absolute values ​​of the variances of the distances from the seventh coordinate to each marker is the smallest; and the average value of the calculated sixth coordinate and the seventh coordinate is taken as the first coordinate.

[0013] In this technical solution, based on the coordinates of each identification point in the three-dimensional rectangular coordinate system of the tunnel boring machine and the center distance from each identification point to any marker, the step of determining the first coordinate of the center of any marker in the three-dimensional rectangular coordinate system of the tunnel boring machine includes: using the least squares method to process the center distance from each identification point to any marker to determine the sixth coordinate of the center of any marker in the three-dimensional rectangular coordinate system of the tunnel boring machine; using the exhaustive method to determine the seventh coordinate of the center of any marker in the three-dimensional rectangular coordinate system of the tunnel boring machine; calculating the average value of the sixth coordinate and the seventh coordinate as the first coordinate. Since the marker is also installed manually, the coordinates of the marker cannot be directly determined in the coordinate system, and any method used to measure the coordinates of the marker will actually have certain errors. In order to reduce the error, the coordinates of the center of the marker are calculated in two ways in this application, and the coordinates of the marker obtained by the two ways are averaged, so as to further improve the accuracy of the coordinates of the marker. Since the coordinates of the center of the marker are required in the calibration process, accurate marker coordinates can make the calibration of the laser radar more accurate.

[0014] Specifically, the coordinates of the center point of the marker are calculated using formula (1) and formula (2), and then the coordinates of the center of the marker are calculated using the least squares method.

[0015] Formula (1): ; Formula (2): .

[0016] Specifically, the coordinates of the center of the marker are calculated using formula (3), thereby realizing the calculation of the coordinates of the center of the marker by an exhaustive method.

[0017] Formula (3): .

[0018] in, is the coordinate of the identification point in the three-dimensional rectangular coordinate system of the tunnel boring machine, is the sixth coordinate of the marker in the three-dimensional rectangular coordinate system of the tunnel boring machine, is the seventh coordinate of the marker in the three-dimensional rectangular coordinate system of the tunnel boring machine. is the average distance from the marker point to the marker, , is the pseudo-inverse of the matrix.

[0019] In any of the above technical solutions, further, the direction of the line connecting the center of the marker and the center of the spherical target is the direction of gravity.

[0020] In this technical solution, the direction of the line connecting the center of the marker and the center of the spherical target is the direction of gravity. Since the Z-axis direction of the horizontal coordinate system is the direction of gravity, when the direction of the line connecting the center of the marker and the center of the spherical target is the direction of gravity, the distance between the center of the marker and the center of the spherical target can be directly calculated in the horizontal coordinate system, thereby avoiding the inability to calculate the coordinates of the center of the spherical target in the three-dimensional rectangular coordinate system of the tunnel boring machine due to the inability to measure the angle between the line connecting the center of the marker and the center of the spherical target and the coordinate axis.

[0021] In any of the above technical solutions, further, the identification point is set on the tunnel boring machine.

[0022] In this technical solution, the identification point is set on the tunnel boring machine, so the coordinates of the identification point can be directly determined on the three-dimensional rectangular coordinate system of the tunnel boring machine. This can reduce the error of the identification point coordinates as much as possible and improve the accuracy of the laser radar calibration.

[0023] In any of the above technical solutions, further, the markers are symmetrically arranged along the traveling direction of the tunnel boring machine.

[0024] In this technical solution, the markers are symmetrically arranged along the travel direction of the tunnel boring machine, and the calculation results can be mutually verified to a certain extent during calculation, thereby improving the accuracy of the calculated marker coordinates.

[0025] In any of the above technical solutions, further, the step of obtaining the center distance from each identification point to any marker object includes: selecting multiple identification points in the three-dimensional rectangular coordinate system of the tunnel boring machine; setting a laser rangefinder at each identification point; and using the laser rangefinder to measure the center distance from each identification point to any marker object.

[0026] In this technical solution, the step of obtaining the center distance from each identification point to any marker includes: selecting multiple identification points in the three-dimensional rectangular coordinate system of the tunnel boring machine; setting a laser rangefinder at each identification point; using the laser rangefinder to measure the center distance from each identification point to any marker, and measuring the distance from the center of the marker to the identification point by the laser rangefinder. This method has low difficulty in measuring distance in underground tunnels and can reduce the difficulty of the laser rangefinder in measuring the distance from the center of the marker to the identification point.

[0027] In any of the above technical solutions, further, the tunnel boring machine also includes: a second laser radar and a third laser radar; the second laser radar and the third laser radar are symmetrically arranged along the traveling direction of the tunnel boring machine; the laser radar calibration method also includes: obtaining the coordinates of the second laser radar and the third laser radar in the three-dimensional rectangular coordinate system of the tunnel boring machine; obtaining the eighth coordinate of the center of each spherical target in the second laser radar coordinate system; obtaining the ninth coordinate of the center of each spherical target in the third laser radar coordinate system; based on multiple second coordinates, multiple eighth coordinates, multiple ninth coordinates, and the coordinates of the second laser radar and the third laser radar in the three-dimensional rectangular coordinate system of the tunnel boring machine, determine the installation angles of the second laser radar and the third laser radar on the tunnel boring machine to realize the calibration of the second laser radar and the third laser radar.

[0028] In the technical scheme, the tunnel boring machine further includes: a second laser radar and a third laser radar; the second laser radar and the third laser radar are symmetrically arranged along the traveling direction of the tunnel boring machine; the laser radar calibration method further includes: obtaining the coordinates of the second laser radar and the third laser radar in the three-dimensional rectangular coordinate system of the tunnel boring machine; obtaining the eighth coordinate of the center of each spherical target in the second laser radar coordinate system; obtaining the ninth coordinate of the center of each spherical target in the third laser radar coordinate system; based on multiple second coordinates, multiple eighth coordinates, multiple ninth coordinates and the coordinates of the second laser radar and the third laser radar in the three-dimensional rectangular coordinate system of the tunnel boring machine, determining the installation angle of the second laser radar and the third laser radar on the tunnel boring machine, and realizing the calibration of the second laser radar and the third laser radar. By setting the second laser radar and the third laser radar on the basis of the first laser radar, the detection accuracy of the laser radar can be improved by setting two more laser radars, and the accuracy of the tunnel scanning data can be improved by using three laser radars to scan the tunnel at the same time.

[0029] The second aspect of the present invention proposes a laser radar calibration system for implementing the laser radar calibration method of the first aspect. The laser radar calibration system is used for a tunnel boring machine, which includes: an inertial navigation system and a first laser radar. A plurality of spherical targets and a plurality of identification points are arranged around the tunnel boring machine, and an identification object is arranged under each spherical target. The laser radar calibration system includes: a module for establishing a three-dimensional rectangular coordinate system of the tunnel boring machine, which is used to establish a three-dimensional rectangular coordinate system of the tunnel boring machine with the optical center of the first laser radar as the origin; a distance measurement module, which is used to obtain the center distance from each identification point to any identification object; and a coordinate calculation module, which is used to obtain the coordinates of each identification point in the three-dimensional rectangular coordinate system of the tunnel boring machine, based on the coordinates of each identification point in the three-dimensional rectangular coordinate system of the tunnel boring machine and the center distance from each identification point to any identification object. Determine the first coordinate of the center of any marker in the three-dimensional rectangular coordinate system of the tunnel boring machine; a horizontal coordinate system establishment module is used to establish the horizontal coordinate system of the tunnel boring machine with the optical center of the first laser radar as the origin; an Euler angle determination module is used to determine the Euler angle of the three-dimensional rectangular coordinate system of the tunnel boring machine relative to the horizontal coordinate system based on the inertial navigation system; the coordinate calculation module is also used to determine the second coordinate of the center of each marker in the horizontal coordinate system according to the Euler angle and multiple first coordinates; the coordinate acquisition module is used to obtain the fifth coordinate of the center of each spherical target in the first laser radar coordinate system; the coordinate calculation module is also used to determine the installation angle of the first laser radar on the tunnel boring machine based on multiple second coordinates, multiple fifth coordinates and the coordinates of the first laser radar in the three-dimensional rectangular coordinate system of the tunnel boring machine, so as to realize the calibration of the first laser radar.

[0030] The third aspect of the present invention proposes a laser radar calibration system, including a memory and a processor, the memory stores programs or instructions that can be run on the processor, and when the programs or instructions are executed by the processor, the steps of the laser radar calibration method of any of the above-mentioned technical solutions are implemented.

[0031] The laser radar calibration system provided by the technical solution of the present invention includes a memory and a processor and a program stored in the memory and executable on the processor, and when the program is executed by the processor, the steps defined by any of the above laser radar calibration methods are implemented. At the same time, since the laser radar calibration system of the present application can implement the steps defined by any of the above laser radar calibration methods, the laser radar calibration system provided by the technical solution has all the beneficial effects of the laser radar calibration method provided in any of the above technical solutions.

[0032] The fourth aspect of the present invention proposes a readable storage medium on which programs and / or instructions are stored. When the programs and / or instructions are executed by a processor, the steps of the laser radar calibration method in any of the above-mentioned technical solutions are implemented.

[0033] The readable storage medium provided according to the technical solution of the present invention has all the beneficial technical effects of the above-mentioned laser radar calibration method, which will not be repeated here, because the program and / or instructions stored thereon can implement the steps of the laser radar calibration method in any of the above-mentioned technical solutions when executed by the processor. BRIEF DESCRIPTION OF THE DRAWINGS

[0034] The above and / or additional aspects and advantages of the present invention will become apparent and easily understood from the description of the embodiments in conjunction with the following drawings, in which: Figure 1 A schematic flow chart of a laser radar calibration method according to an embodiment of the present invention is shown; Figure 2 A schematic flow chart of a laser radar calibration method according to another embodiment of the present invention is shown; Figure 3 A schematic flow chart of a laser radar calibration method according to another embodiment of the present invention is shown; Figure 4 A schematic diagram of a laser radar calibration system according to an embodiment of the present invention is shown; Figure 5 A schematic diagram of a laser radar calibration system according to another embodiment of the present invention is shown; Figure 6 A schematic diagram showing the positions of a marker, a marker point and a spherical target relative to a tunnel boring machine in a laser radar calibration method according to an embodiment of the present invention is shown; Figure 7 A schematic diagram showing the position of a spherical target relative to a tunnel boring machine in a laser radar calibration method according to an embodiment of the present invention is shown.

[0035] in, Figure 6 and Figure 7 The corresponding relationship between the reference numerals and component names in the figure is: 1. Tunnel boring machine, 2. Spherical target, 3. Marking point, 4. Marking object. DETAILED DESCRIPTION

[0036] In order to more clearly understand the above-mentioned purpose, features and advantages of the present invention, the present invention is further described in detail below in conjunction with the accompanying drawings and specific embodiments. It should be noted that the embodiments of the present application and the features in the embodiments can be combined with each other without conflict.

[0037] In the following description, many specific details are set forth to facilitate a full understanding of the present invention. However, the present invention may also be implemented in other ways different from those described herein. Therefore, the protection scope of the present invention is not limited to the specific embodiments disclosed below.

[0038] Refer to the following Figures 1 to 7 The laser radar calibration method, system and readable storage medium according to some embodiments of the present invention are described.

[0039] like Figures 1 to 7 As shown, in an embodiment of the first aspect of the present invention, a laser radar calibration method is proposed for a tunnel boring machine 1, such as Figure 6 and Figure 7 As shown, the tunnel boring machine 1 includes: an inertial navigation system and a first laser radar, a plurality of spherical targets 2 and a plurality of marking points 3 are arranged around the tunnel boring machine 1, and a marking object 4 is arranged under each spherical target; Figure 1 As shown in the figure, the calibration method of the laser radar includes: S101: Establishing a three-dimensional rectangular coordinate system of the roadheader with the optical center of the first laser radar as the origin; S103: Obtain the center distance from each marking point to any marking object; S105: Obtaining the coordinates of each identification point in the three-dimensional rectangular coordinate system of the roadheader; S107: Determine a first coordinate of the center of any marker in the three-dimensional rectangular coordinate system of the roadheader based on the coordinates of each marking point in the three-dimensional rectangular coordinate system of the roadheader and the center distance from each marking point to any marker; S109: Establishing a horizontal coordinate system of the roadheader with the optical center of the first laser radar as the origin; S111: determining the Euler angle of the three-dimensional rectangular coordinate system of the roadheader relative to the horizontal coordinate system based on the inertial navigation system; S113: determining a second coordinate of the center of each marker in the horizontal coordinate system according to the Euler angle and the plurality of first coordinates; S115: Obtaining a third coordinate of the center of each spherical target in the horizontal coordinate system according to the plurality of second coordinates and the distance from the center of the spherical target to the center of the marker; S117: Determine a fourth coordinate of the center of each spherical target in the three-dimensional rectangular coordinate system of the tunnel boring machine based on the multiple third coordinates and the Euler angle; S119: Obtain the fifth coordinate of the center of each spherical target in the first laser radar coordinate system; S121: Based on the multiple second coordinates, the multiple fifth coordinates and the coordinates of the first laser radar in the three-dimensional rectangular coordinate system of the tunnel boring machine, determine the installation angle of the first laser radar on the tunnel boring machine to achieve calibration of the first laser radar.

[0040] In this embodiment, a laser radar calibration method is used for a tunnel boring machine, the tunnel boring machine includes: an inertial navigation system and a first laser radar, a plurality of spherical targets and a plurality of identification points are arranged around the tunnel boring machine, and a marker is arranged below each spherical target; the laser radar calibration method includes: establishing a three-dimensional rectangular coordinate system of the tunnel boring machine with the optical center of the first laser radar as the origin; obtaining the center distance from each identification point to any marker; obtaining the coordinates of each identification point in the three-dimensional rectangular coordinate system of the tunnel boring machine; determining the first coordinate of the center of any marker in the three-dimensional rectangular coordinate system of the tunnel boring machine based on the coordinates of each identification point in the three-dimensional rectangular coordinate system of the tunnel boring machine and the center distance from each identification point to any marker; establishing a horizontal coordinate system of the tunnel boring machine with the optical center of the first laser radar as the origin; Based on the inertial navigation system, the Euler angles of the three-dimensional rectangular coordinate system of the tunnel boring machine relative to the horizontal coordinate system are determined; based on the Euler angles and multiple first coordinates, the second coordinates of the center of each marker in the horizontal coordinate system are determined; based on the multiple second coordinates and the distance from the center of the spherical target to the center of the marker, the third coordinates of the center of each spherical target in the horizontal coordinate system are obtained; based on the multiple third coordinates and the Euler angles, the fourth coordinates of the center of each spherical target in the three-dimensional rectangular coordinate system of the tunnel boring machine are determined; the fifth coordinates of the center of each spherical target in the first laser radar coordinate system are obtained; based on the multiple second coordinates, the multiple fifth coordinates and the coordinates of the first laser radar in the three-dimensional rectangular coordinate system of the tunnel boring machine, the installation angle of the first laser radar on the tunnel boring machine is determined to realize the calibration of the first laser radar. Since the spherical target is set artificially and cannot be set at the specified coordinates, especially in the tunnel, it is basically impossible to accurately measure the coordinates of the spherical target. Therefore, it is very difficult to calibrate the laser radar in the tunnel. In the present application, the center of the spherical target is determined by gravity and the horizontal coordinate system. By transforming the coordinate system, the coordinates of the spherical target can be obtained more accurately. Therefore, in the present application, it is possible to obtain the coordinates of the spherical target in the case of a small space in the underground tunnel and uneven ground and side walls, thereby more accurately calibrating the laser radar in the underground tunnel.

[0041] Specifically, the coordinates of the multiple identification points need to have certain differences in three directions.

[0042] In the above embodiment, further, based on the coordinates of each identification point in the three-dimensional rectangular coordinate system of the tunnel boring machine and the center distance from each identification point to any marker, the step of determining the first coordinate of the center of any marker in the three-dimensional rectangular coordinate system of the tunnel boring machine includes: using the least squares method to process the center distance from each identification point to any marker and the coordinates of each identification point to determine the sixth coordinate of the center of any marker in the three-dimensional rectangular coordinate system of the tunnel boring machine; based on the average distance from the identification point to the center of the marker and the coordinates of the identification point in the three-dimensional rectangular coordinate system of the tunnel boring machine, using the exhaustive method to enumerate the coordinates of the center of the marker in the three-dimensional rectangular coordinate system of the tunnel boring machine to obtain the seventh coordinate of the center of the marker in the three-dimensional rectangular coordinate system of the tunnel boring machine, and the sum of the absolute values ​​of the variances of the distances from the seventh coordinate to each marker is the smallest; and calculating the average of the sixth coordinate and the seventh coordinate as the first coordinate.

[0043] In this embodiment, based on the coordinates of each identification point in the three-dimensional rectangular coordinate system of the tunnel boring machine and the center distance from each identification point to any marker, the step of determining the first coordinate of the center of any marker in the three-dimensional rectangular coordinate system of the tunnel boring machine includes: using the least squares method to process the center distance from each identification point to any marker to determine the sixth coordinate of the center of any marker in the three-dimensional rectangular coordinate system of the tunnel boring machine; using the exhaustive method to determine the seventh coordinate of the center of any marker in the three-dimensional rectangular coordinate system of the tunnel boring machine; calculating the average of the sixth coordinate and the seventh coordinate as the first coordinate. Since the marker is also installed artificially, the coordinates of the marker cannot be directly determined in the coordinate system, and any method used to measure the coordinates of the marker will actually have certain errors. In order to reduce the error, the coordinates of the center of the marker are calculated in two ways in this application, and the coordinates of the marker obtained by the two methods are averaged to further improve the accuracy of the coordinates of the marker. Since the coordinates of the center of the marker are required in the calibration process, accurate marker coordinates can make the calibration of the laser radar more accurate.

[0044] Specifically, the coordinates of the center point of the marker are calculated using formula (1) and formula (2), and then the coordinates of the center of the marker are calculated using the least squares method.

[0045] Formula (1): ; Formula (2): .

[0046] Specifically, the coordinates of the center of the marker are calculated using formula (3), thereby realizing the calculation of the coordinates of the center of the marker by an exhaustive method.

[0047] Formula (3): .

[0048] in, is the coordinate of the identification point in the three-dimensional rectangular coordinate system of the tunnel boring machine, is the sixth coordinate of the marker in the three-dimensional rectangular coordinate system of the tunnel boring machine, is the seventh coordinate of the marker in the three-dimensional rectangular coordinate system of the tunnel boring machine. is the average distance from the marker point to the marker, , is the pseudo-inverse of the matrix.

[0049] In any of the above embodiments, further, the direction of the line connecting the center of the marker and the center of the spherical target is the direction of gravity.

[0050] In this embodiment, the direction of the line connecting the center of the marker and the center of the spherical target is the direction of gravity. Since the Z-axis direction of the horizontal coordinate system is the direction of gravity, when the direction of the line connecting the center of the marker and the center of the spherical target is the direction of gravity, the distance between the center of the marker and the center of the spherical target can be directly calculated in the horizontal coordinate system, thereby avoiding the inability to calculate the coordinates of the center of the spherical target in the three-dimensional rectangular coordinate system of the tunnel boring machine due to the inability to measure the angle between the line connecting the center of the marker and the center of the spherical target and the coordinate axis.

[0051] In any of the above embodiments, further, the identification point is set on the tunnel boring machine.

[0052] In this embodiment, the identification point is set on the tunnel boring machine, so the coordinates of the identification point can be directly determined on the three-dimensional rectangular coordinate system of the tunnel boring machine, which can reduce the error of the identification point coordinates as much as possible and improve the accuracy of the laser radar calibration.

[0053] In any of the above embodiments, further, the markers are symmetrically arranged along the traveling direction of the tunnel boring machine.

[0054] In this embodiment, the markers are symmetrically arranged along the travel direction of the tunnel boring machine, and during calculation, the calculation results can be mutually verified to a certain extent, thereby improving the accuracy of the calculated coordinates of the markers.

[0055] In any of the above embodiments, further, the step of obtaining the center distance from each identification point to any marker object includes: selecting multiple identification points in the three-dimensional rectangular coordinate system of the tunnel boring machine; setting a laser rangefinder at each identification point; and using the laser rangefinder to measure the center distance from each identification point to any marker object.

[0056] In this embodiment, the step of obtaining the center distance from each identification point to any marker includes: selecting multiple identification points in the three-dimensional rectangular coordinate system of the tunnel boring machine; setting a laser rangefinder at each identification point; using the laser rangefinder to measure the center distance from each identification point to any marker, and measuring the distance from the center of the marker to the identification point by the laser rangefinder. This method is less difficult when measuring underground tunnels, and reduces the difficulty of the laser rangefinder in measuring the distance from the center of the marker to the identification point.

[0057] In any of the above embodiments, further, the tunnel boring machine also includes: a second laser radar and a third laser radar; the second laser radar and the third laser radar are symmetrically arranged along the traveling direction of the tunnel boring machine; the laser radar calibration method also includes: obtaining the coordinates of the second laser radar and the third laser radar in the three-dimensional rectangular coordinate system of the tunnel boring machine; obtaining the eighth coordinate of the center of each spherical target in the second laser radar coordinate system; obtaining the ninth coordinate of the center of each spherical target in the third laser radar coordinate system; based on multiple second coordinates, multiple eighth coordinates, multiple ninth coordinates and the coordinates of the second laser radar and the third laser radar in the three-dimensional rectangular coordinate system of the tunnel boring machine, determine the installation angles of the second laser radar and the third laser radar on the tunnel boring machine to realize the calibration of the second laser radar and the third laser radar.

[0058] In this embodiment, the tunnel boring machine further includes: a second laser radar and a third laser radar; the second laser radar and the third laser radar are symmetrically arranged along the traveling direction of the tunnel boring machine; the laser radar calibration method further includes: obtaining the coordinates of the second laser radar and the third laser radar in the three-dimensional rectangular coordinate system of the tunnel boring machine; obtaining the eighth coordinate of the center of each spherical target in the second laser radar coordinate system; obtaining the ninth coordinate of the center of each spherical target in the third laser radar coordinate system; based on multiple second coordinates, multiple eighth coordinates, multiple ninth coordinates and the coordinates of the second laser radar and the third laser radar in the three-dimensional rectangular coordinate system of the tunnel boring machine, determining the installation angle of the second laser radar and the third laser radar on the tunnel boring machine, and realizing the calibration of the second laser radar and the third laser radar. By setting the second laser radar and the third laser radar on the basis of the first laser radar, the detection accuracy of the laser radar can be improved by setting two more laser radars, and the accuracy of the tunnel scanning data can be improved by using three laser radars to scan the tunnel at the same time.

[0059] Specifically, this application proposes a specific implementation method of a laser radar calibration method according to actual usage conditions, such as Figure 2 As shown, the specific steps are as follows: S201: hanging spherical target; S203: Collecting tunnel point cloud; S205: Acquire a spherical target point cloud; S207: Obtain the coordinates of the center of the spherical target in the laser radar coordinate system; S209: Use the angle output by the inertial navigation system; S211: measuring the distance from the marking point on the tunnel boring machine to the card; S213: Obtain the coordinates of the center of the card in the tunnel boring machine coordinate system; S215: Calculate the coordinates of the center of the spherical target in the tunnel boring machine coordinate system; S217: Calculate the laser radar installation angle.

[0060] Specifically, this application proposes a specific implementation method of three laser radar calibration methods for actual usage, such as Figure 3 As shown, the specific steps are as follows: S301, hang spherical targets and markers. Install laser radar and inertial navigation system on the tunnel boring machine, hang three spherical targets in sequence on the left rear of the tunnel boring machine to calibrate the radars on the left and middle of the tunnel boring machine, and hang three spherical targets in sequence on the right rear of the tunnel boring machine to calibrate the radars on the right and middle of the tunnel boring machine. Adjust the hanging height of the spherical targets to ensure that the laser rangefinder can illuminate the spherical targets when emitting laser from the top of the radar shell, such as Figure 7 Hang a plumb bob at the bottom of the spherical target and tie a card 3 cm away from the bottom of the spherical target. The card is a marker.

[0061] S303, establish a tunnel boring machine coordinate system. The origin of the tunnel boring machine coordinate system is located at the optical center of the middle laser radar, and the x, y, and z axes point to the right, front, and top respectively, and the y axis is parallel to the side wall of the tunnel boring machine. The coordinates of the laser radar optical center in the tunnel boring machine coordinate system are measured on the design drawing of the tunnel boring machine. The tunnel boring machine coordinate system is specifically a three-dimensional rectangular coordinate system of the tunnel boring machine.

[0062] S305, set the marking points on the main frame of the tunnel boring machine, and calculate the coordinates of the marking objects according to the coordinates of the marking points. Select n (n>3) marking points on the main frame of the tunnel boring machine, and the marking points should have a large distribution in the x, y, and z directions. Measure the coordinates of the marking points in the tunnel boring machine coordinate system on the design drawing of the tunnel boring machine, such as Figure 6 As shown. Multiple people use laser rangefinders to measure the distance from each marking point to the card, and average the measurement results of each marking point. The coordinates of the center of the card in the coordinate system of the tunnel boring machine are obtained based on the least squares method 1 , as shown in formulas (1) and (2). Set the coordinate range and use the coordinate search method to obtain the coordinates of the card center in the tunnel boring machine coordinate system. , as shown in formula (3). The average coordinates 1 and 2 are used to obtain the coordinates of the card center in the tunnel boring machine coordinate system. .

[0063] Formula (1): .

[0064] Formula (2): .

[0065] Formula (3): .

[0066] in, is the coordinate of the identification point in the three-dimensional rectangular coordinate system of the tunnel boring machine, is the average distance from the identification point to the card, , pinv is the pseudo-inverse of the matrix.

[0067] S307, convert the coordinates of the marker into coordinates in the horizontal coordinate system, and use the horizontal coordinate system to calculate the coordinates of the center of the spherical target. Use the Euler angle output by the inertial navigation system to convert the coordinates of the center of the card in the tunnel boring machine coordinate system to the carrier northeast celestial coordinate system to obtain the coordinates of the center of the card in the carrier northeast celestial coordinate system. The origin of the carrier northeast celestial coordinate system is the origin of the tunnel boring machine coordinate system, and the direction is the direction of the northeast celestial coordinate system. Increase the z component of the coordinates of the center of the card in the carrier northeast celestial coordinate system by 3+r (target sphere radius) cm and convert it to the tunnel boring machine coordinate system to obtain the true value coordinates of the center of the spherical target in the tunnel boring machine coordinate system.

[0068] S309, using laser radar to obtain the coordinates of the center of the spherical target in the laser radar coordinate system. Use laser radar scanning to obtain the roadway point cloud, segment the spherical target point cloud based on the reflection intensity, and use the least square method to obtain the coordinates of the center of the spherical target in the laser radar coordinate system.

[0069] S311, based on the coordinates of the laser radar in the tunnel boring machine coordinate system and the true value coordinates of the center of the spherical target in the tunnel boring machine coordinate system, calculate the installation angle of the laser radar on the tunnel boring machine. Set the angle search range, and combine the coordinates of the laser radar in the tunnel boring machine coordinate system and the true value coordinates of the center of the spherical target in the tunnel boring machine coordinate system to obtain the installation angle of the laser radar on the tunnel boring machine, as shown in formula (4) and formula (5).

[0070] Formula (4): .

[0071] Formula (5): .

[0072] in, is the coordinate of the center of the spherical target in the laser radar coordinate system, is the coordinate of the laser radar in the tunnel boring machine coordinate system, is the true coordinate of the center of the spherical target in the tunnel boring machine coordinate system, are the pitch angle, roll angle, and yaw angle of the laser radar on the tunnel boring machine. For the laser radars on the left and right sides of the tunnel boring machine, , for the laser radar in the middle of the tunnel boring machine, .

[0073] The second aspect of the present invention provides a laser radar calibration system 400, such as Figure 4 As shown, a laser radar calibration method for implementing the first aspect is used, and the laser radar calibration system is used for a tunnel boring machine. The tunnel boring machine includes: an inertial navigation system and a first laser radar. A plurality of spherical targets and a plurality of identification points are arranged around the tunnel boring machine, and an identification object is arranged under each spherical target. The laser radar calibration system includes: a tunnel boring machine three-dimensional rectangular coordinate system establishment module 401, which is used to establish a three-dimensional rectangular coordinate system of the tunnel boring machine with the optical center of the first laser radar as the origin; a distance measurement module 402, which is used to obtain the center distance from each identification point to any identification object; a coordinate calculation module 403, which is used to obtain the coordinates of each identification point in the three-dimensional rectangular coordinate system of the tunnel boring machine, and determine the center of any identification point in the tunnel boring machine based on the coordinates of each identification point in the three-dimensional rectangular coordinate system of the tunnel boring machine and the center distance from each identification point to any identification object. The first coordinate in the three-dimensional rectangular coordinate system of the tunnel boring machine; a horizontal coordinate system establishing module 404 is used to establish the horizontal coordinate system of the tunnel boring machine with the optical center of the first laser radar as the origin; an Euler angle determining module 405 is used to determine the Euler angle of the three-dimensional rectangular coordinate system of the tunnel boring machine relative to the horizontal coordinate system based on the inertial navigation system; a coordinate calculating module 403 is also used to determine the second coordinate of the center of each marker in the horizontal coordinate system according to the Euler angle and the multiple first coordinates; a coordinate acquisition module 406 is used to obtain the fifth coordinate of the center of each spherical target in the first laser radar coordinate system; the coordinate calculating module 403 is also used to determine the installation angle of the first laser radar on the tunnel boring machine based on the multiple second coordinates, the multiple fifth coordinates and the coordinates of the first laser radar in the three-dimensional rectangular coordinate system of the tunnel boring machine, so as to realize the calibration of the first laser radar.

[0074] The third aspect of the present invention provides a laser radar calibration system 500, such as Figure 5 As shown, it includes a memory 501 and a processor 502. The memory 501 stores programs or instructions that can be run on the processor. When the programs or instructions are executed by the processor, the steps of the laser radar calibration method of any of the above embodiments are implemented.

[0075] The laser radar calibration system provided according to an embodiment of the present invention includes a memory and a processor and a program stored in the memory and executable on the processor, and when the program is executed by the processor, the steps defined by any of the laser radar calibration methods described above are implemented. At the same time, since the laser radar calibration system of the present application can implement the steps defined by any of the laser radar calibration methods described above, the laser radar calibration system provided in this embodiment has all the beneficial effects of the laser radar calibration method provided in any of the above embodiments.

[0076] A fourth aspect of the present invention proposes a readable storage medium having programs and / or instructions stored thereon, which, when executed by a processor, implement the steps of the laser radar calibration method in any of the above-mentioned embodiments.

[0077] The readable storage medium provided according to an embodiment of the present invention has all the beneficial technical effects of the above-mentioned laser radar calibration method, and will not be repeated here, because the program and / or instructions stored thereon can implement the steps of the laser radar calibration method in any of the above-mentioned embodiments when executed by the processor.

[0078] In the description of the present invention, the term "plurality" refers to two or more than two. Unless otherwise clearly defined, the orientation or positional relationship indicated by the terms "upper" and "lower" is based on the orientation or positional relationship of the drawings. It is only for the convenience of describing the present invention and simplifying the description, and does not indicate or imply that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation. Therefore, it cannot be understood as a limitation on the present invention. The terms "connection", "installation", "fixation", etc. should be understood in a broad sense. For example, "connection" can be a fixed connection, a detachable connection, or an integral connection; it can be directly connected or indirectly connected through an intermediate medium. For ordinary technicians in this field, the specific meanings of the above terms in the present invention can be understood according to specific circumstances.

[0079] In the description of the present invention, the description of the terms "one embodiment", "some embodiments", "specific embodiments", etc. means that the specific features, structures, materials or characteristics described in conjunction with the embodiment or example are included in at least one embodiment or example of the present invention. In the present invention, the schematic representation of the above terms does not necessarily refer to the same embodiment or example. Moreover, the specific features, structures, materials or characteristics described can be combined in any one or more embodiments or examples in a suitable manner.

[0080] The above are only preferred embodiments of the present invention and are not intended to limit the present invention. For those skilled in the art, the present invention may have various modifications and variations. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present invention shall be included in the protection scope of the present invention.

Claims

1. A laser radar calibration method, characterized in that: Used for a tunnel boring machine, the tunnel boring machine comprising: an inertial navigation system and a first laser radar, a plurality of spherical targets and a plurality of marking points are arranged around the tunnel boring machine, and a marking object is arranged under each of the spherical targets; The laser radar calibration method includes: Taking the optical center of the first laser radar as the origin, a three-dimensional rectangular coordinate system of the roadheader is established; Obtaining the center distance from each of the marking points to any of the marking objects; Obtaining the coordinates of each of the identification points in the three-dimensional rectangular coordinate system of the tunnel boring machine; Based on the coordinates of each of the identification points in the three-dimensional rectangular coordinate system of the tunnel boring machine and the center distance from each of the identification points to any of the identification objects, determine the first coordinates of the center of any of the identification objects in the three-dimensional rectangular coordinate system of the tunnel boring machine; Taking the optical center of the first laser radar as the origin, establishing a horizontal coordinate system of the roadheader; Determining the Euler angle of the three-dimensional rectangular coordinate system of the roadheader relative to the horizontal coordinate system based on the inertial navigation system; Determine a second coordinate of the center of each of the markers in the horizontal coordinate system according to the Euler angles and the plurality of the first coordinates; Obtaining a third coordinate of the center of each spherical target in the horizontal coordinate system according to the plurality of second coordinates and the distance from the center of the spherical target to the center of the marker; Based on the plurality of third coordinates and the Euler angles, determining a fourth coordinate of the center of each of the spherical targets in the three-dimensional rectangular coordinate system of the tunnel boring machine; Obtaining the fifth coordinate of the center of each of the spherical targets in the first laser radar coordinate system; Based on the multiple second coordinates, the multiple fifth coordinates and the coordinates of the first laser radar in the three-dimensional rectangular coordinate system of the tunnel boring machine, the installation angle of the first laser radar on the tunnel boring machine is determined to achieve calibration of the first laser radar.

2. The laser radar calibration method according to claim 1, characterized in that: The step of determining the first coordinate of the center of any of the markers in the three-dimensional rectangular coordinate system of the roadheader based on the coordinates of each of the marking points in the three-dimensional rectangular coordinate system of the roadheader and the center distance of each of the marking points to any of the markers comprises: The least square method is used to process the distance from each of the identification points to the center of any of the identification objects and the coordinates of each identification point to determine the sixth coordinate of the center of any of the identification objects in the three-dimensional rectangular coordinate system of the roadheader; Based on the average distance from the identification point to the center of the marker and the coordinates of the identification point in the three-dimensional rectangular coordinate system of the tunnel boring machine, an exhaustive method is used to exhaustively enumerate the coordinates of the center of the marker in the three-dimensional rectangular coordinate system of the tunnel boring machine to obtain the seventh coordinate of the center of the marker in the three-dimensional rectangular coordinate system of the tunnel boring machine, and the sum of the absolute values ​​of the variances of the distances from the seventh coordinate to each of the markers is the smallest; An average value of the sixth coordinate and the seventh coordinate is calculated as the first coordinate.

3. The laser radar calibration method according to claim 1, characterized in that: The direction of the line connecting the center of the marker and the center of the spherical target is the direction of gravity.

4. The laser radar calibration method according to claim 1, characterized in that: The identification point is arranged on the tunnel boring machine.

5. The laser radar calibration method according to claim 1, characterized in that: The markers are symmetrically arranged along the traveling direction of the tunnel boring machine.

6. The laser radar calibration method according to claim 1, characterized in that: The step of obtaining the distance from each of the marking points to the center of any of the marking objects comprises: Selecting a plurality of the identification points in the three-dimensional rectangular coordinate system of the tunnel boring machine; A laser rangefinder is arranged at each of the marking points; The laser rangefinder is used to measure the distance from each of the marking points to the center of any of the marking objects.

7. The laser radar calibration method according to any one of claims 1 to 6, characterized in that: The roadheader further includes: a second laser radar and a third laser radar; The second laser radar and the third laser radar are symmetrically arranged along the traveling direction of the tunnel boring machine; The laser radar calibration method also includes: Obtaining coordinates of the second laser radar and the third laser radar in the three-dimensional rectangular coordinate system of the tunnel boring machine; Obtaining the eighth coordinate of the center of each of the spherical targets in the second laser radar coordinate system; Obtaining a ninth coordinate of the center of each of the spherical targets in the third laser radar coordinate system; Based on the multiple second coordinates, the multiple eighth coordinates, the multiple ninth coordinates, and the coordinates of the second laser radar and the third laser radar in the three-dimensional rectangular coordinate system of the tunnel boring machine, the installation angles of the second laser radar and the third laser radar on the tunnel boring machine are determined to achieve calibration of the second laser radar and the third laser radar.

8. A laser radar calibration system, characterized in that: Used to implement the laser radar calibration method according to any one of claims 1 to 7, the laser radar calibration system is used for a roadheader, the roadheader comprises: an inertial navigation system and a first laser radar, a plurality of spherical targets and a plurality of marking points are arranged around the roadheader, and a marking object is arranged under each of the spherical targets, and the laser radar calibration system comprises: A module for establishing a three-dimensional rectangular coordinate system of a roadheader, used to establish a three-dimensional rectangular coordinate system of the roadheader with the optical center of the first laser radar as the origin; A distance measurement module, used to obtain the distance from each of the marking points to the center of any of the marking objects; A coordinate calculation module, used for obtaining the coordinates of each of the identification points in the three-dimensional rectangular coordinate system of the tunnel boring machine, and determining the first coordinates of the center of any of the identification objects in the three-dimensional rectangular coordinate system of the tunnel boring machine based on the coordinates of each of the identification points in the three-dimensional rectangular coordinate system of the tunnel boring machine and the center distance from each of the identification points to any of the identification objects; A horizontal coordinate system establishment module, used to establish a horizontal coordinate system of the roadheader with the optical center of the first laser radar as the origin; An Euler angle determination module, used to determine the Euler angle of the three-dimensional rectangular coordinate system of the roadheader relative to the horizontal coordinate system based on the inertial navigation system; The coordinate calculation module is further used to determine the second coordinate of the center of each of the markers in the horizontal coordinate system according to the Euler angle and the plurality of the first coordinates; A coordinate acquisition module, used for acquiring the fifth coordinate of the center of each of the spherical targets in the first laser radar coordinate system; The coordinate calculation module is also used to determine the installation angle of the first laser radar on the tunnel boring machine based on multiple second coordinates, multiple fifth coordinates and the coordinates of the first laser radar in the three-dimensional rectangular coordinate system of the tunnel boring machine, so as to calibrate the first laser radar.

9. A laser radar calibration system, characterized in that: It comprises a memory and a processor, wherein the memory stores programs or instructions that can be run on the processor, and when the programs or instructions are executed by the processor, the steps of the laser radar calibration method as described in any one of claims 1 to 7 are implemented.

10. A readable storage medium having a program and / or an instruction stored thereon, characterized in that: When the program and / or the instruction are executed, the steps of the laser radar calibration method as described in any one of claims 1 to 7 are implemented.

Citation Information

Cited By

  • Downsampling method and device for point cloud data, computer readable storage medium, electronic equipment and computer program product

    CN119741314A

  • Installation and calibration method based on airborne laser radar of heading machine in roadway environment

    CN121142514A