A method and device for calibrating the heading angle of laser radar of unmanned mining vehicle
The method and device enhance the accuracy and efficiency of laser radar calibration on unmanned mining vehicles by using a pole and global coordinate system to determine heading angle offsets, addressing the challenges of vehicle size and field calibration errors.
Patent Information
- Application Number
- CN202411244240.6
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2024-09-06
- Publication Date
- 2024-12-06
- Estimated Expiration
- 2044-09-06
AI Technical Summary
The calibration of laser radar heading angles on unmanned mining vehicles is inaccurate and inefficient due to the vehicle's large size, disassembly during transportation, and lack of precise reference objects in the field, leading to safety issues in autonomous driving.
A method and device for calibrating the laser radar heading angle by preliminary calibration, transforming a preset driving track and pole into a global coordinate system, calculating distance and vertical distance measurements, and determining heading angle offsets to compensate for initial inaccuracies.
Accurately and quickly calibrates the laser radar heading angle, improving safety and efficiency in autonomous operations by aligning the radar with the vehicle body.
Smart Images

Figure CN118778020B_ABST
Abstract
Description
Technical Field
[0001] The invention belongs to the technical field of heading angle calibration, and in particular relates to a method and device for calibrating the heading angle of an unmanned mining vehicle laser radar. Background Art
[0002] The main sensor laser radar installed on the unmanned mining truck needs to be calibrated together with the vehicle body so that when the vehicle is running, the perceived obstacles can be correctly transformed to the correct position relative to the vehicle body. The current mainstream solution is to put the vehicle in the calibration workshop and calibrate it with reference objects in the workshop. However, as an unmanned mining truck operating in the field, the vehicle body is too large. Even if it is calibrated in the factory, the laser radar will be disassembled during transportation and needs to be reinstalled and recalibrated in the field. During the field calibration process, due to the lack of accurate reference objects and the lack of experience of the calibrator, the calibration results usually have relatively large errors, especially the radar heading angle yaw and the vehicle body heading angle yaw are difficult to coincide. Since the heading of the laser radar and the heading of the vehicle body do not coincide, even obstacles directly in front of the vehicle body may be transformed to the side of the vehicle body, resulting in safety issues in autonomous driving. Summary of the invention
[0003] In view of the above deficiencies in the prior art, the purpose of the invention is to provide a method and device for calibrating the heading angle of an unmanned mining vehicle laser radar, so as to solve the problems of poor accuracy and low efficiency of manual calibration in the prior art.
[0004] In a first aspect of the present invention, a method for calibrating a heading angle of a laser radar of an unmanned mining vehicle is proposed, comprising:
[0005] Preliminary calibration of the first heading angle of the unmanned mining vehicle's laser radar;
[0006] Obtain a preset driving track of the unmanned mining vehicle, erect a pole at a preset distance of the preset driving track, park the unmanned mining vehicle on the preset driving track or within a preset range of the preset driving track, and transform the preset driving track and the pole into a global coordinate system through the positioning system and laser radar of the unmanned mining vehicle;
[0007] The unmanned mining vehicle approaches the pole from far to near along a preset driving track. Each time the vehicle travels a preset distance, the distance from the unmanned mining vehicle to the pole and the vertical distance from the center point of the pole to the preset driving track are calculated to obtain multiple sets of measurement values of the distance from the unmanned mining vehicle to the pole and the vertical distance from the center point of the pole to the preset driving track;
[0008] Determine the heading angle offset value of the laser radar of the unmanned mining vehicle relative to the vehicle body according to the measured values of multiple groups of distances from the unmanned mining vehicle to the pole and the vertical distance from the center point of the pole to the preset driving track;
[0009] The second heading angle of the unmanned mining vehicle laser radar is calibrated according to the first heading angle of the unmanned mining vehicle laser radar and the heading angle offset value of the unmanned mining vehicle laser radar relative to the vehicle body.
[0010] Furthermore, in the above-mentioned method for calibrating the heading angle of the laser radar of the unmanned mining vehicle, the first heading angle of the laser radar of the unmanned mining vehicle is preliminarily calibrated, including:
[0011] Make sure that the positioning system and the laser radar of the unmanned mine car are calibrated to the center of the rear axle of the unmanned mine car, and preliminarily calibrate the first heading angle of the laser radar of the unmanned mine car.
[0012] Furthermore, in the above-mentioned method for calibrating the heading angle of the laser radar of the unmanned mining vehicle, the preset driving track and the pole are transformed into the global coordinate system through the positioning system and the laser radar of the unmanned mining vehicle, including:
[0013] Determine the global positioning value of the preset driving trajectory in the positioning system, and transform the preset driving trajectory into the global coordinate system;
[0014] Determine the initial calibration parameters of the pole in the laser radar coordinate system and the global positioning value of the pole in the positioning system;
[0015] The pole is transformed into the global coordinate system according to the initial calibration parameters of the pole in the laser radar coordinate system and the global positioning value of the pole in the positioning system.
[0016] Furthermore, in the above-mentioned method for calibrating the heading angle of the laser radar of an unmanned mining vehicle, calculating the vertical distance from the center point of the pole to the preset driving track includes:
[0017] Identify the pole;
[0018] Find the centroid of all radar point clouds of the pole in the XY plane of the global coordinate system;
[0019] Calculate the XY plane distance from the center of mass to all points on the preset driving trajectory;
[0020] Filter out the two trajectory points with the shortest distance;
[0021] Determine a straight line based on the two trajectory points with the shortest distance;
[0022] The XY plane distance from the center of mass to the straight line is calculated to obtain the measured value of the vertical distance from the center point of the pole to the preset driving trajectory.
[0023] Furthermore, in the above-mentioned method for calibrating the heading angle of the laser radar of the unmanned mining vehicle, the heading angle offset value of the laser radar is determined according to the measured values of the distance from the unmanned mining vehicle to the pole and the vertical distance from the center point of the pole to the preset driving track, which is calculated by the following formula:
[0024]
[0025]
[0026]
[0027]
[0028] Converted into a matrix:
[0029] Solving the above matrix equation yields ,according to Obtain Get the heading angle deviation value;
[0030] in,( , ), ( , )……( , ) represents the measured values of the distances from multiple groups of unmanned mining vehicles to the poles and the vertical distances from the center points of the poles to the preset driving tracks. represents the heading angle deviation value, d represents the actual value of the vertical distance from the center of the pole to the preset driving track, and n represents the number of measurements, from m1 to m n is the n-times measured value from the center of the minecart coordinate to the center of the pole, d1 to d n It is the n-times measured value of the vertical distance from the center of the pole to the preset driving trajectory.
[0031] Furthermore, in the above-mentioned method for calibrating the heading angle of the laser radar of the unmanned mine vehicle, the second heading angle of the laser radar of the unmanned mine vehicle is calibrated according to the first heading angle of the laser radar of the unmanned mine vehicle and the heading angle offset value of the laser radar of the unmanned mine vehicle relative to the vehicle body, including:
[0032] According to the heading angle offset value of the unmanned mining vehicle laser radar relative to the vehicle body, the first heading angle of the unmanned mining vehicle laser radar is compensated and calibrated to obtain the second heading angle of the unmanned mining vehicle laser radar.
[0033] Furthermore, in the above-mentioned method for calibrating the heading angle of the laser radar of an unmanned mining vehicle, identifying the pole includes:
[0034] The pole recognition model is obtained by training the bounding box of the pole;
[0035] The pole is identified through the pole identification model.
[0036] The second aspect of the present invention further provides a device for calibrating the heading angle of an unmanned mining vehicle laser radar, comprising:
[0037] The first calibration module: used to preliminarily calibrate the first heading angle of the unmanned mining vehicle laser radar;
[0038] Acquisition module and transformation module: used to acquire a preset driving track of the unmanned mining vehicle, erect a pole at a preset distance of the preset driving track, park the unmanned mining vehicle on the preset driving track or within a preset range of the preset driving track, and transform the preset driving track and the pole into the global coordinate system through the positioning system and laser radar of the unmanned mining vehicle;
[0039] Calculation module: used for the unmanned mining vehicle to approach the pole from far to near along the preset driving track. Every time the vehicle travels a preset distance, the distance from the unmanned mining vehicle to the pole and the vertical distance from the center point of the pole to the preset driving track are calculated to obtain multiple sets of measurement values of the distance from the unmanned mining vehicle to the pole and the vertical distance from the center point of the pole to the preset driving track;
[0040] Determination module: used to determine the heading angle offset value of the laser radar of the unmanned mining vehicle relative to the vehicle body according to the measured values of multiple sets of distances from the unmanned mining vehicle to the pole and the vertical distance from the center point of the pole to the preset driving track;
[0041] The second calibration module is used to calibrate the second heading angle of the unmanned mining vehicle laser radar according to the first heading angle of the unmanned mining vehicle laser radar and the heading angle offset value of the unmanned mining vehicle laser radar relative to the vehicle body.
[0042] According to a third aspect of the present invention, an electronic device is provided, comprising: a processor and a memory;
[0043] The processor is used to execute any of the above methods for calibrating the heading angle of the laser radar of an unmanned mining vehicle by calling the program or instruction stored in the memory.
[0044] In a fourth aspect of the present invention, a computer-readable storage medium is further proposed, wherein the computer-readable storage medium stores a program or instruction, and the program or instruction enables a computer to execute any of the above methods for calibrating the heading angle of an unmanned mining vehicle's laser radar.
[0045] The beneficial effects of the present invention are as follows: the present invention preliminarily calibrates the first heading angle of the laser radar of the unmanned mine car; obtains a preset driving track of the unmanned mine car, sets up a pole at a preset distance of the preset driving track, parks the unmanned mine car on the track or within a preset range of the track, and transforms the preset driving track and the pole into a global coordinate system through the positioning system and laser radar of the unmanned mine car; the unmanned mine car approaches the pole from far to near along the preset driving track, and each time the vehicle travels a preset length, calculates the distance from the unmanned mine car to the pole and the vertical distance from the center point of the pole to the preset driving track to obtain multiple sets of measured values of the distance from the unmanned mine car to the pole and the vertical distance from the center point of the pole to the preset driving track; determines the heading angle offset value of the laser radar of the unmanned mine car relative to the vehicle body according to the multiple sets of measured values of the distance from the unmanned mine car to the pole and the vertical distance from the center point of the pole to the preset driving track; the heading angle offset value of the laser radar of the unmanned mine car relative to the vehicle body is used to compensate the first heading angle of the laser radar of the unmanned mine car to calibrate the second heading angle of the laser radar of the unmanned mine car, so that the heading angle of the laser radar can be calibrated more accurately and quickly. BRIEF DESCRIPTION OF THE DRAWINGS
[0046] The accompanying drawings are only used to illustrate specific embodiments and are not considered to limit the present invention. In the entire drawings, the same reference symbols represent the same components. Obviously, the drawings described below are only some embodiments recorded in the embodiments of the present invention. For those of ordinary skill in the art, other drawings can also be obtained based on these drawings.
[0047] Figure 1 A method for calibrating the heading angle of an unmanned mining vehicle laser radar provided in an embodiment of the present invention;
[0048] Figure 2 A method diagram for calculating the vertical distance from the center point of a pole to a preset driving trajectory provided by an embodiment of the present invention;
[0049] Figure 3 A diagram of a method for identifying a pole provided by an embodiment of the present invention;
[0050] Figure 4 A diagram of a calibration device for the heading angle of an unmanned mining vehicle laser radar provided in an embodiment of the present invention;
[0051] Figure 5 A schematic block diagram of an electronic device provided by an embodiment of the present invention. DETAILED DESCRIPTION
[0052] In order to enable those skilled in the art to better understand the technical solutions in the embodiments of the present invention, the technical solutions of the present invention will be clearly and completely described below in conjunction with the accompanying drawings. Obviously, the described embodiments are part of the embodiments of the present invention, rather than all of the embodiments. It should be understood that these descriptions are only exemplary and are not intended to limit the scope of the present invention. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in the field without making creative work should fall within the scope of protection of the present invention.
[0053] Furthermore, in the following description, descriptions of well-known structures and technologies are omitted to avoid unnecessarily obscuring the concepts disclosed in the present invention.
[0054] In the description of the present invention, the terms "first", "second", and "third" are used for descriptive purposes only and should not be understood as indicating or implying relative importance. The terms "installed", "connected", and "connected" should be understood in a broad sense, for example, it can be a fixed connection, a detachable connection, or an integral connection; it can be a mechanical connection or an electrical connection; it can be a direct connection, or it can be indirectly connected through an intermediate medium, or it can be internal communication between two components. For ordinary technicians in this field, the specific meanings of the above terms in the present invention can be understood according to specific circumstances.
[0055] Exemplary embodiments will be described in detail herein, examples of which are shown in the accompanying drawings. When the following description refers to the drawings, unless otherwise indicated, the same numbers in different drawings represent the same or similar elements. The embodiments described in the following exemplary embodiments do not represent all embodiments consistent with the present invention. Instead, they are merely examples of methods and systems consistent with some aspects of the present invention as detailed in the appended claims.
[0056] The present invention proposes a method, device, electronic equipment and storage medium for calibrating the heading angle of a laser radar of an unmanned mining vehicle, which can calibrate the heading angle of the laser radar more accurately and quickly.
[0057] Method Embodiment
[0058] Figure 1 A method for calibrating the heading angle of an unmanned mining vehicle laser radar is provided in an embodiment of the present invention.
[0059] In the first aspect of the present invention, a method for calibrating the heading angle of an unmanned mining vehicle laser radar is proposed. Figure 1 , including five steps from S1 to S5:
[0060] S1: Preliminary calibration of the first heading angle of the unmanned mining vehicle’s LiDAR.
[0061] Specifically, in an embodiment of the present invention, the first heading angle of the unmanned mine car laser radar is preliminarily calibrated to determine that the positioning system of the unmanned mine car and the laser radar of the unmanned mine car are calibrated to the rear axle center of the unmanned mine car, and the first heading angle of the unmanned mine car laser radar is preliminarily calibrated.
[0062] S2: Obtain a preset driving track of the unmanned mine car, erect a pole at a preset distance of the preset driving track, park the unmanned mine car on the preset driving track or within a preset range of the preset driving track, and transform the preset driving track and the pole into a global coordinate system through the positioning system and laser radar of the unmanned mine car.
[0063] Specifically, in the embodiment of the present invention, a preset driving trajectory of the unmanned mining vehicle is obtained through a camera, and a pole is erected at a preset distance of the preset driving trajectory. The preset distance here is the vertical distance between the pole and the preset driving trajectory, which can be 1m, 2m, 3m, etc., and the protection scope of the present invention is not limited thereto; the vehicle is parked on the preset driving trajectory or within the preset range of the preset driving. The preset driving trajectory can be any position on the trajectory, and the preset range of the preset driving trajectory can be any position near the trajectory. The preset range can be any point on the original determined by drawing a circle with the center of the trajectory as the center; the pole is initially sensed by the laser radar and is in the laser radar coordinate system. The trajectory is sensed by the positioning system when recording, and the preset driving trajectory and the pole are transformed into the global coordinate system through the positioning system and the laser radar to facilitate subsequent coordinate value processing.
[0064] S3: The unmanned mine car approaches the pole from far to near along a preset driving trajectory. Every time the vehicle travels a preset distance, the distance from the unmanned mine car to the pole and the vertical distance from the center point of the pole to the preset driving trajectory are calculated to obtain multiple sets of measurement values of the distance from the unmanned mine car to the pole and the vertical distance from the center point of the pole to the preset driving trajectory.
[0065] Specifically, in an embodiment of the present invention, the preset length can be 1m, 2m, etc., and the protection scope of the present invention is not limited thereto. For example, every time the vehicle travels 1m, the distance from the unmanned mine car to the pole and the vertical distance from the center point of the pole to the preset driving trajectory are calculated to obtain multiple sets of measured values of the distance from the unmanned mine car to the pole and the vertical distance from the center point of the pole to the preset driving trajectory. Here, the measured values of the distance from the unmanned mine car to the pole and the vertical distance from the center point of the pole to the preset driving trajectory are measured values, not actual values.
[0066] For example, the track length is 20m, and every time the vehicle travels 1m, 20 sets of measurement values of the distance from the unmanned mining vehicle to the pole and the vertical distance from the center point of the pole to the preset driving track are obtained.
[0067] Among them, the preset driving trajectory in the vertical distance from the center point of the pole to the preset driving trajectory is not the preset length and the traveled trajectory after each travel of the preset length, but the preset driving trajectory.
[0068] S4: Determine the heading angle offset value of the laser radar of the unmanned mining vehicle relative to the vehicle body according to the measurement values of multiple groups of distances from the unmanned mining vehicle to the pole and the vertical distance from the center point of the pole to the preset driving track.
[0069] Specifically, in an embodiment of the present invention, a method for determining the heading angle offset value of the unmanned mining vehicle's laser radar relative to the vehicle body based on the measured values of multiple groups of distances from the unmanned mining vehicle to the pole and the vertical distance from the center point of the pole to the preset driving trajectory is described in detail below.
[0070] S5: Calibrate the second heading angle of the unmanned mining vehicle laser radar according to the first heading angle of the unmanned mining vehicle laser radar and the heading angle offset value of the unmanned mining vehicle laser radar relative to the vehicle body.
[0071] Specifically, in an embodiment of the present invention, the second heading angle of the unmanned mining vehicle laser radar is calibrated according to the first heading angle of the unmanned mining vehicle laser radar and the heading angle offset value of the unmanned mining vehicle laser radar relative to the vehicle body, so that the calibrated laser radar heading angle is more accurate.
[0072] Furthermore, in the above-mentioned method for calibrating the heading angle of the laser radar of the unmanned mining vehicle, the first heading angle of the laser radar of the unmanned mining vehicle is preliminarily calibrated, including:
[0073] Make sure that the positioning system and the laser radar of the unmanned mine car are calibrated to the center of the rear axle of the unmanned mine car, and preliminarily calibrate the first heading angle of the laser radar of the unmanned mine car.
[0074] Specifically, in the embodiment of the present invention, the first heading angle of the unmanned mining vehicle laser radar is preliminarily calibrated, but the accuracy is low and there is a large error.
[0075] Furthermore, in the above-mentioned method for calibrating the heading angle of the unmanned mining vehicle's laser radar, the preset driving trajectory and the pole are transformed into the global coordinate system through the positioning system and laser radar of the unmanned mining vehicle, including: transforming the preset driving trajectory into the global coordinate system and transforming the pole into the global coordinate system.
[0076] Specifically, in an embodiment of the present invention, transforming a preset driving trajectory into a global coordinate system includes: determining a global positioning value of the preset driving trajectory in a positioning system, and transforming the preset driving trajectory into a global coordinate system; transforming a pole into a global coordinate system includes: determining initial calibration parameters of the pole in a laser radar coordinate system and a global positioning value of the pole in the positioning system; transforming the pole into a global coordinate system according to the initial calibration parameters of the pole in the laser radar coordinate system and the global positioning value of the pole in the positioning system.
[0077] Figure 2 A method diagram for calculating the vertical distance from the center point of a pole to a preset driving trajectory provided in an embodiment of the present invention.
[0078] Furthermore, in the above-mentioned calibration method of the heading angle of the unmanned mining vehicle laser radar, the measured value of the vertical distance from the center point of the pole to the preset driving track is calculated, combined with Figure 2 , including six steps from S21 to S26:
[0079] S21: Identify the pole.
[0080] S22: Find the centroid of all radar point clouds of the pole in the XY plane of the global coordinate system.
[0081] S23: Calculate the XY plane distance from the center of mass to all points on the preset driving trajectory.
[0082] S24: Filter out the two trajectory points with the shortest distance;
[0083] S25: determining a straight line according to the two trajectory points with the shortest distance;
[0084] S26: Calculate the XY plane distance from the center of mass to the straight line to obtain a measured value of the vertical distance from the center point of the pole to the preset driving trajectory.
[0085] Specifically, in an embodiment of the present invention, the pole is identified after being trained by deep learning or other methods; after the pole is identified, the center point of the pole is obtained by finding the centroid of all radar point clouds of the pole in the XY plane of the global coordinate system; the XY plane distance from the center point of the pole to all points on the preset driving trajectory is calculated, and the two trajectory points with the shortest distance are selected from the XY plane distances from the center point of the pole to all points on the preset driving trajectory, a straight line is determined based on the two trajectory points with the shortest distance, and the XY plane distance from the center of the pole to the straight line is calculated to obtain the measurement value of the vertical distance from the center point of the pole to the preset driving trajectory.
[0086] Furthermore, in the above-mentioned method for calibrating the heading angle of the laser radar of the unmanned mining vehicle, the heading angle offset value of the laser radar is determined according to the measured values of the distance from the unmanned mining vehicle to the pole and the vertical distance from the center point of the pole to the preset driving track, which is calculated by the following formula:
[0087]
[0088]
[0089]
[0090]
[0091] Converted into a matrix:
[0092] Solving the above matrix equation yields ,according to Obtain Get the heading angle deviation value;
[0093] in,( , ), ( , )……( , ) represents the measured values of the distances from multiple groups of unmanned mining vehicles to the poles and the vertical distances from the center points of the poles to the preset driving tracks. represents the heading angle deviation value, d represents the actual value of the vertical distance from the center of the pole to the preset driving track, and n represents the number of measurements, from m1 to m n is the n-times measured value from the center of the minecart coordinate to the center of the pole, d1 to d n It is the n-times measured value of the vertical distance from the center of the pole to the preset driving trajectory.
[0094] Specifically, in the embodiment of the present invention, the matrix equation is solved to obtain It can be decomposed by SVD method.
[0095] Furthermore, in the above-mentioned method for calibrating the heading angle of the laser radar of the unmanned mine vehicle, the second heading angle of the laser radar of the unmanned mine vehicle is calibrated according to the first heading angle of the laser radar of the unmanned mine vehicle and the heading angle offset value of the laser radar of the unmanned mine vehicle relative to the vehicle body, including:
[0096] According to the heading angle offset value of the unmanned mining vehicle laser radar relative to the vehicle body, the first heading angle of the unmanned mining vehicle laser radar is compensated and calibrated to obtain the second heading angle of the unmanned mining vehicle laser radar.
[0097] Specifically, in an embodiment of the present invention, the first heading angle of the unmanned mining vehicle laser radar is compensated and calibrated according to the heading angle offset value of the unmanned mining vehicle laser radar relative to the vehicle body, so that the second heading angle of the unmanned mining vehicle laser radar is more accurate.
[0098] Figure 3 A diagram of a method for identifying a pole provided by an embodiment of the present invention.
[0099] Furthermore, in the above-mentioned method for calibrating the heading angle of the laser radar of an unmanned mining vehicle, Figure 3 , identify the pole, including two steps from S31 to S32:
[0100] S31: training the bounding box of the pole to obtain a pole recognition model;
[0101] S32: Identify the pole using the pole identification model.
[0102] Specifically, in the embodiment of the present invention, the pole recognition model obtained by training the pole bounding box can be trained by a deep learning method such as BevFusion, and the pole is recognized by the pole recognition model to obtain the relevant bounding box.
[0103] Device Embodiment
[0104] Figure 4 A diagram of a device for calibrating the heading angle of an unmanned mining vehicle laser radar provided in an embodiment of the present invention.
[0105] In a second aspect of the present invention, a device for calibrating the heading angle of an unmanned mining vehicle laser radar is provided. Figure 4 ,include:
[0106] The first calibration module 41 is used to preliminarily calibrate the first heading angle of the laser radar of the unmanned mining vehicle.
[0107] Specifically, in the embodiment of the present invention, the first calibration module 41 preliminarily calibrates the first heading angle of the unmanned mine car laser radar to determine that the positioning system of the unmanned mine car and the laser radar of the unmanned mine car are calibrated to the rear axle center of the unmanned mine car, and preliminarily calibrates the first heading angle of the unmanned mine car laser radar.
[0108] The acquisition module 42 and the transformation module 43 are used to acquire a preset driving track of the unmanned mining vehicle, erect a pole at a preset distance of the preset driving track, park the unmanned mining vehicle on the preset driving track or within a preset range of the preset driving track, and transform the preset driving track and the pole into the global coordinate system through the positioning system and laser radar of the unmanned mining vehicle.
[0109] Specifically, in the embodiment of the present invention, the acquisition module 42 acquires a preset driving trajectory of the unmanned mining vehicle through a camera, and a pole is erected at a preset distance of the preset driving trajectory. The preset distance here is the vertical distance between the pole and the preset driving trajectory, which can be 1m, 2m, 3m, etc., and does not limit the protection scope of the present invention; the car is parked on the trajectory or within a preset range of the trajectory. The trajectory can be any position on the trajectory, and the preset range of the trajectory can be any position near the trajectory. The preset range can be any point on the original determined by drawing a circle with the center of the trajectory as the center; the pole is initially sensed by the laser radar and is in the laser radar coordinate system. The trajectory is sensed by the positioning system when recording. The transformation module 43 transforms the preset driving trajectory and the pole to the global coordinate system through the positioning system and the laser radar to facilitate subsequent coordinate value processing.
[0110] Calculation module 44: used for the unmanned mining vehicle to approach the pole from far to near along a preset driving track. Every time the vehicle travels a preset distance, the distance from the unmanned mining vehicle to the pole and the vertical distance from the center point of the pole to the preset driving track are calculated to obtain multiple sets of measurement values of the distance from the unmanned mining vehicle to the pole and the vertical distance from the center point of the pole to the preset driving track.
[0111] Specifically, in the embodiment of the present invention, the preset length can be 1m, 2m, etc., and the protection scope of the present invention is not limited thereto. For example, every time the vehicle travels 1m, the calculation module 44 calculates the distance from the unmanned mining vehicle to the pole and the vertical distance from the center point of the pole to the preset driving trajectory to obtain multiple groups of measurement values of the distance from the unmanned mining vehicle to the pole and the vertical distance from the center point of the pole to the preset driving trajectory.
[0112] For example, the track length is 20m, and every time the vehicle travels 1m, 20 sets of measurement values of the distance from the unmanned mining vehicle to the pole and the vertical distance from the center point of the pole to the preset driving track are obtained.
[0113] Determination module 45: used to determine the heading angle offset value of the laser radar of the unmanned mining vehicle relative to the vehicle body according to the measurement values of multiple groups of distances from the unmanned mining vehicle to the pole and the vertical distance from the center point of the pole to the preset driving track.
[0114] Specifically, in the embodiment of the present invention, the determination module 45 determines the heading angle offset value of the unmanned mining vehicle laser radar relative to the vehicle body according to the measurement values of multiple groups of distances from the unmanned mining vehicle to the pole and the vertical distance from the center point of the pole to the preset driving trajectory.
[0115] The second calibration module 46 is used to calibrate the second heading angle of the unmanned mining vehicle laser radar according to the first heading angle of the unmanned mining vehicle laser radar and the heading angle offset value of the unmanned mining vehicle laser radar relative to the vehicle body.
[0116] Specifically, in the embodiment of the present invention, the second calibration module 46 calibrates the second heading angle of the unmanned mining vehicle laser radar according to the first heading angle of the unmanned mining vehicle laser radar and the heading angle offset value of the unmanned mining vehicle laser radar relative to the vehicle body so that the calibrated laser radar heading angle is more accurate.
[0117] According to a third aspect of the present invention, an electronic device is provided, comprising: a processor and a memory;
[0118] The processor is used to execute any of the above methods for calibrating the heading angle of the laser radar of an unmanned mining vehicle by calling the program or instruction stored in the memory.
[0119] In a fourth aspect of the present invention, a computer-readable storage medium is further proposed, wherein the computer-readable storage medium stores a program or instruction, and the program or instruction enables a computer to execute any of the above methods for calibrating the heading angle of an unmanned mining vehicle's laser radar.
[0120] Figure 5 It is a schematic block diagram of an electronic device provided by an embodiment of the present invention.
[0121] like Figure 5 As shown, the electronic device includes: at least one processor 501, at least one memory 502 and at least one communication interface 503. The various components in the electronic device are coupled together through a bus system 504. The communication interface 503 is used to transmit information between external devices. It can be understood that the bus system 504 is used to achieve connection and communication between these components. In addition to the data bus, the bus system 504 also includes a power bus, a control bus and a status signal bus. However, for the sake of clarity, Figure 5 Various buses are labeled as bus system 504 .
[0122] It can be understood that the memory 502 in this embodiment can be a volatile memory or a non-volatile memory, or can include both volatile and non-volatile memories.
[0123] In some implementations, the memory 502 stores the following elements, executable units or data structures, or a subset thereof, or an extended set thereof: an operating system and application programs.
[0124] Among them, the operating system includes various system programs, such as the framework layer, the core library layer, the driver layer, etc., which are used to implement various basic services and process hardware-based tasks. The application program includes various application programs, such as a media player (Media Player), a browser (Browser), etc., which are used to implement various application services. A program that implements any method of the calibration method of the heading angle of the unmanned mining vehicle laser radar provided in an embodiment of the present invention can be included in the application program.
[0125] In an embodiment of the present invention, the processor 501 calls a program or instruction stored in the memory 502, specifically, a program or instruction stored in an application, and the processor 501 is used to execute the steps of each embodiment of a method for calibrating the heading angle of an unmanned mining vehicle laser radar provided in an embodiment of the present invention.
[0126] Preliminary calibration of the first heading angle of the unmanned mining vehicle's laser radar;
[0127] Obtain a preset driving track of the unmanned mining vehicle, erect a pole at a preset distance of the preset driving track, park the unmanned mining vehicle on the preset driving track or within a preset range of the preset driving track, and transform the preset driving track and the pole into a global coordinate system through the positioning system and laser radar of the unmanned mining vehicle;
[0128] The unmanned mining vehicle approaches the pole from far to near along a preset driving track. Each time the vehicle travels a preset distance, the distance from the unmanned mining vehicle to the pole and the vertical distance from the center point of the pole to the preset driving track are calculated to obtain multiple sets of measurement values of the distance from the unmanned mining vehicle to the pole and the vertical distance from the center point of the pole to the preset driving track;
[0129] Determine the heading angle offset value of the laser radar of the unmanned mining vehicle relative to the vehicle body according to the measured values of multiple groups of distances from the unmanned mining vehicle to the pole and the vertical distance from the center point of the pole to the preset driving track;
[0130] The second heading angle of the unmanned mining vehicle laser radar is calibrated according to the first heading angle of the unmanned mining vehicle laser radar and the heading angle offset value of the unmanned mining vehicle laser radar relative to the vehicle body.
[0131] Any method in the calibration method of the heading angle of the unmanned mining vehicle laser radar provided in the embodiment of the present invention can be applied to the processor 501, or implemented by the processor 501. The processor 501 can be an integrated circuit chip with signal processing capabilities. In the implementation process, each step of the above method can be completed by the hardware integrated logic circuit in the processor 501 or the instructions in the form of software. The above-mentioned processor 501 can be a general-purpose processor, a digital signal processor (Digital Signal Processor, DSP), an application-specific integrated circuit (Application Specific Integrated Circuit, ASIC), a field programmable gate array (Field Programmable Gate Array, FPGA) or other programmable logic devices, discrete gates or transistor logic devices, discrete hardware components. The general-purpose processor can be a microprocessor or the processor can also be any conventional processor, etc.
[0132] The steps of any method in the calibration method of the heading angle of the laser radar of an unmanned mining vehicle provided by the embodiment of the present invention can be directly embodied as being executed by a hardware decoding processor, or being executed by a combination of hardware and software units in the decoding processor. The software unit can be located in a mature storage medium in the art such as a random access memory, a flash memory, a read-only memory, a programmable read-only memory, or an electrically erasable programmable memory, a register, etc. The storage medium is located in the memory 502, and the processor 501 reads the information in the memory 502 and completes the steps of the method in combination with its hardware.
[0133] Those skilled in the art will appreciate that although some embodiments described herein include certain features included in other embodiments but not other features, the combination of features from different embodiments is meant to be within the scope of the present invention and to form different embodiments.
[0134] Those skilled in the art will appreciate that the description of each embodiment has its own emphasis, and for parts not described in detail in a certain embodiment, reference can be made to the relevant descriptions of other embodiments.
[0135] Although the embodiments of the present invention are described in conjunction with the accompanying drawings, those skilled in the art may make various modifications and variations without departing from the spirit and scope of the present invention, and such modifications and variations all fall within the scope defined by the appended claims. The above are only specific embodiments of the present invention, but the protection scope of the present invention is not limited thereto. Any person skilled in the art who is familiar with the technical field can easily think of various equivalent modifications or substitutions within the technical scope disclosed by the present invention, and these modifications or substitutions should be included in the protection scope of the present invention. Therefore, the protection scope of the present invention shall be subject to the protection scope of the claims.
[0136] The above are only specific embodiments of the present invention, but the protection scope of the present invention is not limited thereto. Any technician familiar with the technical field can easily think of various equivalent modifications or replacements within the technical scope disclosed by the present invention, and these modifications or replacements should be included in the protection scope of the present invention. Therefore, the protection scope of the present invention shall be based on the protection scope of the claims.
Claims
1. A method for calibrating the heading angle of an unmanned mining vehicle laser radar, characterized in that: include: Preliminary calibration of the first heading angle of the unmanned mining vehicle's laser radar; Obtain a preset driving track of the unmanned mining vehicle, erect a pole at a preset distance of the preset driving track, park the unmanned mining vehicle on the preset driving track or within a preset range of the preset driving track, and transform the preset driving track and the pole into a global coordinate system through the positioning system and laser radar of the unmanned mining vehicle; The unmanned mining vehicle approaches the pole from far to near along a preset driving track. Each time the vehicle travels a preset distance, the distance from the unmanned mining vehicle to the pole and the vertical distance from the center point of the pole to the preset driving track are calculated to obtain multiple sets of measurement values of the distance from the unmanned mining vehicle to the pole and the vertical distance from the center point of the pole to the preset driving track; Determine the heading angle offset value of the laser radar of the unmanned mining vehicle relative to the vehicle body according to the measured values of the distances from the multiple groups of unmanned mining vehicles to the poles and the vertical distances from the center points of the poles to the preset driving tracks; Calibrate the second heading angle of the unmanned mining vehicle laser radar according to the first heading angle of the unmanned mining vehicle laser radar and the heading angle offset value of the unmanned mining vehicle laser radar relative to the vehicle body; The calculation of the vertical distance from the center point of the pole to the preset driving track includes: Identify the pole; Finding the centroid of all radar point clouds of the pole in the XY plane of the global coordinate system; Calculate the XY plane distance from the center of mass to all points on the preset driving trajectory; Filter out the two trajectory points with the shortest distance; Determine a straight line based on the two trajectory points with the shortest distance; The XY plane distance from the center of mass to the straight line is calculated to obtain the measured value of the vertical distance from the center point of the pole to the preset driving trajectory.
2. According to the method for calibrating the heading angle of the laser radar of an unmanned mining vehicle according to claim 1, it is characterized in that: The preliminary calibration of the first heading angle of the unmanned mine car laser radar includes: determining that the positioning system of the unmanned mine car and the laser radar of the unmanned mine car are both calibrated to the rear axle center of the unmanned mine car, and preliminary calibration of the first heading angle of the unmanned mine car laser radar.
3. The method for calibrating the heading angle of the laser radar of an unmanned mining vehicle according to claim 1 is characterized in that: The preset driving track and the pole are transformed into a global coordinate system by using the positioning system and laser radar of the unmanned mining vehicle, including: Determine the global positioning value of the preset driving trajectory in the positioning system, and transform the preset driving trajectory into a global coordinate system; Determine the initial calibration parameters of the pole in the laser radar coordinate system and the global positioning value of the pole in the positioning system; The pole is transformed into the global coordinate system according to the initial calibration parameters of the pole in the laser radar coordinate system and the global positioning value of the pole in the positioning system.
4. The method for calibrating the heading angle of the laser radar of an unmanned mining vehicle according to claim 1 is characterized in that: The heading angle deviation value of the laser radar is determined according to the measured values of the distances from the multiple groups of unmanned mining vehicles to the poles and the vertical distances from the center points of the poles to the preset driving tracks, and is calculated by the following formula: ; ; ; ; Converted into a matrix: ; Solving the above matrix equation yields ,according to Obtain Get the heading angle deviation value; in,( , ), ( , )……( , ) represents the measured values of the distances from multiple groups of unmanned mining vehicles to the poles and the vertical distances from the center points of the poles to the preset driving tracks. represents the heading angle deviation value, d represents the actual value of the vertical distance from the center of the pole to the preset driving track, and n represents the number of measurements, from m1 to m n is the n-times measured value from the center of the minecart coordinate to the center of the pole, d1 to d n It is the n-times measured value of the vertical distance from the center of the pole to the preset driving trajectory.
5. The method for calibrating the heading angle of the laser radar of an unmanned mining vehicle according to claim 1 is characterized in that: The second heading angle of the unmanned mining vehicle laser radar is calibrated according to the first heading angle of the unmanned mining vehicle laser radar and the heading angle offset value of the unmanned mining vehicle laser radar relative to the vehicle body, including: According to the heading angle offset value of the unmanned mining vehicle laser radar relative to the vehicle body, the first heading angle of the unmanned mining vehicle laser radar is compensated and calibrated to obtain the second heading angle of the unmanned mining vehicle laser radar.
6. The method for calibrating the heading angle of the laser radar of an unmanned mining vehicle according to claim 1 is characterized in that: Identify the poles, including: The pole recognition model is obtained by training the bounding box of the pole; The pole is identified by the pole identification model.
7. A device for calibrating the heading angle of an unmanned mining vehicle laser radar, characterized in that: include: The first calibration module: used to preliminarily calibrate the first heading angle of the unmanned mining vehicle laser radar; The acquisition module and the transformation module are used to acquire a preset driving track of the unmanned mining vehicle, erect a pole at a preset distance of the preset driving track, park the unmanned mining vehicle on the preset driving track or within a preset range of the preset driving track, and transform the preset driving track and the pole into a global coordinate system through the positioning system and laser radar of the unmanned mining vehicle; Calculation module: used for the unmanned mining vehicle to approach the pole from far to near along the preset driving track. Every time the vehicle travels a preset distance, the distance from the unmanned mining vehicle to the pole and the vertical distance from the center point of the pole to the preset driving track are calculated to obtain multiple sets of measurement values of the distance from the unmanned mining vehicle to the pole and the vertical distance from the center point of the pole to the preset driving track; A determination module is used to determine the heading angle offset value of the laser radar of the unmanned mining vehicle relative to the vehicle body according to the measured values of the distances from the multiple groups of unmanned mining vehicles to the poles and the vertical distances from the center points of the poles to the preset driving tracks; The second calibration module is used to calibrate the second heading angle of the unmanned mining vehicle laser radar according to the first heading angle of the unmanned mining vehicle laser radar and the heading angle offset value of the unmanned mining vehicle laser radar relative to the vehicle body; The calculation of the vertical distance from the center point of the pole to the preset driving track includes: Identify the pole; Finding the centroid of all radar point clouds of the pole in the XY plane of the global coordinate system; Calculate the XY plane distance from the center of mass to all points on the preset driving trajectory; Filter out the two trajectory points with the shortest distance; Determine a straight line based on the two trajectory points with the shortest distance; The XY plane distance from the center of mass to the straight line is calculated to obtain the measured value of the vertical distance from the center point of the pole to the preset driving trajectory.
8. An electronic device, characterized in that: include: Processor and memory; The processor is used to execute the method for calibrating the heading angle of the unmanned mining vehicle laser radar as described in any one of claims 1 to 6 by calling the program or instruction stored in the memory.
9. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a program or instruction, and the program or instruction enables a computer to execute a method for calibrating the heading angle of an unmanned mining vehicle laser radar as described in any one of claims 1 to 6.
