Radar yaw angle calibration method and device and related product
By calculating the fitted straight line slope of the obstructions on both sides of the road, radar yaw angle calibration without additional sensor assistance is achieved, and the problem of high cost of radar yaw angle calibration and accuracy dependence on external parameters in the existing technology is solved, and the problem of high cost of radar yaw angle calibration in the existing technology is improved. Calibration accuracy and independence.
Patent Information
- Application Number
- CN202310599221.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2023-05-25
- Publication Date
- 2024-11-26
AI Technical Summary
The existing radar calibration methods require auxiliary sensors to perform yaw angle calibration, resulting in increased cost and accuracy dependence on external parameter calibration, and lack of independent calibration solutions.
By obtaining the forward radar data of the vehicle along the road direction, a fitted line slope with approximately parallel obstacles on both sides of the road is generated, and the yaw angle of the forward radar is calculated, which realizes yaw angle calibration without additional sensor assistance, improving calibration accuracy.
The radar yaw angle calibration without additional sensor assistance is realized, which reduces costs and improves calibration accuracy, and supports calibration of full-view radar.
Smart Images

Figure CN119024282A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of autonomous driving technology, and in particular to a radar yaw angle calibration method, device, program product, medium, computer device and mobile tool. Background Art
[0002] In the environmental perception of autonomous driving technology, millimeter-wave radar, lidar and other sensors are used to acquire environmental data. When performing subsequent environmental data fusion, the data of each sensor needs to be calibrated to a unified coordinate system.
[0003] The existing radar calibration method mainly uses other sensors to assist in joint calibration. There are two main methods. One is the joint calibration of radar and vision. First, the mapping matrix from the vehicle coordinate system to the camera coordinate system is calibrated, and then it is converted to the pixel coordinate system through the camera internal parameters. At the same time, the target detected by the radar is projected onto the image through an initial mapping matrix, and the initial mapping matrix from the radar wave to the vehicle coordinate system is adjusted so that the detected target points and the targets on the image coincide with each other, and the matrix between the radar wave and the vehicle coordinate system is obtained. The other is the joint calibration between radar waves, usually the joint calibration of millimeter wave radar and laser radar. First, the mapping matrix between the laser radar and the vehicle coordinate system is calibrated, and the laser point cloud is converted to the vehicle coordinate system. The millimeter wave point cloud is also converted to the vehicle coordinate system through the initial mapping matrix, and the mapping matrix from the millimeter wave to the vehicle body is adjusted to merge the millimeter wave point cloud and the laser radar point cloud.
[0004] The joint calibration method first needs to ensure the time synchronization between the sensor to be calibrated and the calibrated sensor, and the calibration accuracy of the external parameters between the calibrated radar and the vehicle body will affect the calibration accuracy of the external parameters of the radar to be calibrated; secondly, the joint calibration requires the arrangement of the scene, such as placing corner reflectors, etc., so that the key point can be detected in different sensors; thirdly, the joint calibration needs to cooperate with cameras or other radars, and the calibration scheme that lacks a joint subject requires additional costs. Summary of the invention
[0005] The purpose of the present invention is to provide a radar yaw angle calibration method, device, program product, medium, computer device and mobile tool to address the problem in the prior art that the yaw angle of the radar requires auxiliary sensors for calibration.
[0006] To achieve the above object, the present invention provides a radar yaw angle calibration method in a first aspect, comprising:
[0007] Acquire first radar data of a forward radar generated by a vehicle traveling along a road direction on a preset road section;
[0008] Taking the lines on both sides of the preset road section as the center lines, expansion is performed respectively to generate a first expansion area and a second expansion area;
[0009] Performing curve fitting on the first radar data of the same sub-section in the first expansion area and the second expansion area to generate a first fitting curve and a second fitting curve respectively; wherein the sub-section is a sub-section of the preset section;
[0010] If the first fitting curve and the second fitting curve are straight lines, and the first slope of the first fitting curve and the second slope of the second fitting curve are within a preset deviation range, a forward radar yaw angle is generated according to the first slope and the second slope.
[0011] Further, generating a forward radar yaw angle according to the first slope and the second slope specifically includes:
[0012] Selecting a set of the first slope and the second slope, calculating an average of the first slope and the second slope, and generating a first slope average value;
[0013] A forward radar yaw angle is generated according to the first slope average value.
[0014] Further, generating a forward radar yaw angle according to the first slope and the second slope specifically includes:
[0015] Selecting multiple groups of the first slope and the second slope, calculating an average value of the first slope and the second slope of each group, and generating an average value of the first slope of each group;
[0016] The average values of the first slopes of each group are added together to obtain the average value, thereby generating the average value of the second slopes;
[0017] A forward radar yaw angle is generated according to the second slope average value.
[0018] Further, performing curve fitting on the first radar data of the same sub-section in the first expansion area and the second expansion area to generate a first fitting curve and a second fitting curve respectively specifically includes:
[0019] Acquiring vehicle heading angle data synchronized with the first radar data;
[0020] Compensating and correcting the first radar data by using the vehicle heading angle data and a compensation matrix;
[0021] The compensated and corrected first radar data is subjected to curve fitting to generate a first fitting curve and a second fitting curve respectively.
[0022] Furthermore, the method further comprises:
[0023] Generate a left front corner radar yaw angle and a right front corner radar yaw angle according to the forward radar yaw angle;
[0024] Generate a left rear corner radar yaw angle according to the left front corner radar yaw angle;
[0025] A right rear corner radar yaw angle is generated according to the right front corner radar yaw angle and / or the left rear corner radar yaw angle.
[0026] Further, the generating of the left front radar yaw angle according to the forward radar yaw angle is specifically:
[0027] Acquire second radar data of a left front corner radar generated by the vehicle traveling along a road direction in a preset road section;
[0028] Adjust the second radar data point in the overlapping area of the left front corner radar and the forward radar detection range to coincide with the first radar data point, and calculate the adjusted angle value;
[0029] A left front corner radar yaw angle is generated according to the adjusted angle value and the forward radar yaw angle.
[0030] Furthermore, there are parallel obstacles on both sides of the preset road section.
[0031] A second aspect of the present invention provides a radar yaw angle calibration device, comprising:
[0032] An acquisition module, used to acquire first radar data of a forward radar generated by a vehicle traveling along a road direction in a preset road section;
[0033] A first data processing module is used to expand the two sides of the road of the preset section as the center line to generate a first expansion area and a second expansion area;
[0034] A second data processing module is used to perform curve fitting on the first radar data of the same sub-section in the first expansion area and the second expansion area to generate a first fitting curve and a second fitting curve respectively; wherein the sub-section is a sub-section of the preset section;
[0035] The third data processing module is used to generate a forward radar yaw angle according to the first slope and the second slope if the first fitting curve and the second fitting curve are straight lines and the first slope of the first fitting curve and the second slope of the second fitting curve are within a preset deviation range.
[0036] A third aspect of the present invention provides a computer program product. When the computer program product is run on a computer, the computer is enabled to execute the radar yaw angle calibration method as described in any one of the first aspects.
[0037] A fourth aspect of the present invention provides a computer-readable storage medium having a computer program stored thereon, which, when executed by a processor, implements the steps of any one of the methods described in the first aspect.
[0038] A fifth aspect of the present invention provides a computer device, comprising a memory, a processor, and a computer program stored in the memory, wherein the processor executes the computer program to implement the steps of any method described in the first aspect.
[0039] The sixth aspect of the present invention provides a mobile tool, characterized in that it includes the computer device described in the fifth aspect.
[0040] The radar yaw angle calibration method and device, and related products provided by the present invention calculate the slope of the fitted straight line approximately parallel to the obstacles on both sides of the road based on the forward radar data to complete the yaw angle calibration of the forward radar relative to the vehicle body. No additional sensor is required to assist in the yaw angle calibration, thus saving the calibration cost. BRIEF DESCRIPTION OF THE DRAWINGS
[0041] Figure 1 One of the flow charts of the radar yaw angle calibration method provided in the first embodiment of the present invention;
[0042] Figure 2 A schematic diagram of selecting a sub-section expansion area provided in the first embodiment of the present invention;
[0043] Figure 3 The second flowchart of the radar yaw angle calibration method provided in the first embodiment of the present invention;
[0044] Figure 4 A schematic diagram of the installation of a full-view radar provided in Embodiment 1 of the present invention;
[0045] Figure 5 A schematic diagram of the structure of a radar yaw angle calibration device provided in Embodiment 2 of the present invention;
[0046] Figure 6 A schematic diagram of the structure of a computer program product provided in Embodiment 3 of the present invention;
[0047] Figure 7 This is a schematic diagram of the structure of a computer device provided in Embodiment 5 of the present invention. DETAILED DESCRIPTION
[0048] In order to make the purpose, technical solution and advantages of the embodiments of the present invention clearer, the technical solution in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
[0049] It should be noted that, in the absence of conflict, the embodiments and features in the embodiments of the present application may be combined with each other.
[0050] The present invention may be described in the general context of computer-executable instructions executed by a computer, such as program modules. Generally, program modules include routines, programs, objects, components, data structures, etc. that perform specific tasks or implement specific abstract data types. The present invention may also be practiced in distributed computing environments where tasks are performed by remote processing devices connected through a communications network. In a distributed computing environment, program modules may be located in local and remote computer storage media, including storage devices.
[0051] In the present invention, "module", "device", "system" and the like refer to related entities applied to computers, such as hardware, a combination of hardware and software, software or software in execution, etc. In detail, for example, an element can be, but is not limited to, a process, a processor, an object, an executable element, an execution thread, a program and / or a computer running on a processor. In addition, an application or script program running on a server, a server can all be an element. One or more elements can be in an execution process and / or thread, and an element can be localized on a computer and / or distributed between two or more computers, and can be operated by various computer-readable media. An element can also communicate through local and / or remote processes according to a signal with one or more data packets, for example, a signal from a data that interacts with another element in a local system, a distributed system, and / or a network on the Internet through a signal to interact with other systems.
[0052] Finally, it should be noted that, in this article, relational terms such as first and second, etc. are only used to distinguish one entity or operation from another entity or operation, and do not necessarily require or imply any such actual relationship or order between these entities or operations. Moreover, the terms "include" and "comprise" include not only those elements, but also other elements that are not explicitly listed, or also include elements inherent to such processes, methods, articles or equipment. In the absence of further restrictions, the elements defined by the statement "include..." do not exclude the existence of other identical elements in the process, method, article or equipment that includes the elements.
[0053] The radar yaw angle calibration method, device and related products provided by the present invention obtain forward radar data traveling along the road direction on a preset road section, calculate the slope of the fitted straight lines approximately parallel to the obstacles on both sides of the road based on the data, generate the forward radar yaw angle, and complete the yaw angle calibration of the forward radar relative to the vehicle body without the need for auxiliary calibration of other sensors; the calibration accuracy is improved by selecting multiple groups of approximately parallel fitted straight lines to calculate the slope average value; the radars at the four corners of the vehicle are calibrated through the calibrated forward radar, and the calibration of the full-view radar is achieved without the need for the assistance of other additional sensors.
[0054] Embodiment 1
[0055] The radars applicable to the yaw angle calibration method of the present application include millimeter-wave radars and laser radars. The following embodiments involve the calibration of four corner radars. When the corner radars are arranged for autonomous driving vehicles, millimeter-wave radars are generally selected. Although the detection range of a single millimeter-wave radar is limited, even if a full-view layout is carried out, the price is cheaper than that of laser radars. 3D millimeter-wave radars have no ability to resolve targets in vertical space. When calibrating external parameters relative to the vehicle body, they do not pay attention to the Z-axis offset, roll angle, and pitch angle. Only the offset and yaw angle of the X-axis and Y-axis need to be calibrated. For millimeter-wave radars, due to certain errors in ranging accuracy, the automatic calibration of the offset values of the X-axis and Y-axis is not as accurate as that of manual direct measurement. The measured structural parameters can be used directly. Therefore, for the calibration of the external parameters of the 3D millimeter-wave radar, it is only necessary to automatically calibrate the yaw angle. The following is an example of the full-view layout of the 3D millimeter-wave radar on the vehicle body.
[0056] Figure 1 This is a flow chart of a radar yaw angle calibration method provided in Embodiment 1 of the present invention, as shown in FIG. Figure 1 As shown, the radar yaw angle calibration method includes:
[0057] Step 110, obtaining first radar data of a forward radar generated by a vehicle traveling along a road direction on a preset road section.
[0058] The preset road section may be a straight road or a road consisting of a straight road section and a curve. To simplify the subsequent slope algorithm, a straight road section without a curve is preferred. In a possible implementation, the preset road section is kept empty to avoid vehicles or pedestrians, so as to more accurately extract the road boundary points.
[0059] According to the detection characteristics of the radar, it is preset that there must be obstacles on both sides of the road section. In this solution, the obstacles are required to be parallel obstacles, such as parallel guardrails, and / or street lights, and / or isolation belts, etc. The parallel obstacles on both sides of the road do not need to be of the same type, and the guardrails and street lights can be parallel. When the millimeter-wave radar detects parallel obstacles on both sides, the first radar data obtained in the parallel road section is valid data.
[0060] Step 120 , dilation is performed with both sides of the preset road section as center lines to generate a first dilation area and a second dilation area.
[0061] Specifically, the parallel obstacles used for testing, such as guardrails, street lights, isolation belts, etc., are usually located on both sides of the road. The first radar data deviating from the two sides of the road may be interference data such as pedestrians and vehicles. By expanding within a preset range with the two sides of the road as the center line, a part of the interference data is filtered out, and the subsequent data processing volume is simplified. The size of the expansion radius can be flexibly set according to the obstacle situation of the preset road section. In a possible implementation, the expansion radius is set to 0.5 meters, that is, the width of the expansion area is 1 meter.
[0062] Step 130 , curve fitting is performed on the first radar data of the same sub-section in the first expansion area and the second expansion area to generate a first fitting curve and a second fitting curve respectively; wherein the sub-section is a sub-section of a preset section.
[0063] In an optional solution, step 130, in order to correct the deviation of the vehicle traveling along the road direction during driving, the first radar data is first compensated and corrected before curve fitting, which specifically includes steps A1-A3:
[0064] Step A1, firstly obtain vehicle heading angle data synchronized with the first radar data.
[0065] In a possible implementation, the vehicle heading angle is converted to a heading angle in a true north coordinate system, where true north is 0° in the real world.
[0066] Step A2, compensating and correcting the first radar data using the vehicle heading angle data and the compensation matrix, as shown in formula (1):
[0067]
[0068] Among them, x r ,y r is the first radar data before compensation, that is, the coordinate value of the obstacle in the millimeter-wave radar coordinate system, α is the heading angle in the synchronized vehicle true north coordinate system, and x and y are the compensation correction values of the first radar data of the millimeter-wave radar in the true north coordinate system.
[0069] Step A3: performing curve fitting on the compensated and corrected first radar data to generate a first fitting curve and a second fitting curve respectively.
[0070] Specifically, a curve fitting is performed on the first radar data of the same sub-section in the compensated and corrected first expansion area and the second expansion area through a curve fitting algorithm. In one possible implementation, the curve fitting algorithm is a least squares method. If the first expansion area and the second expansion area are in a curve, the first curve and the second curve are nonlinear curves; if the first expansion area and the second expansion area are completely in a straight section, the first curve and the second curve are linear curves, i.e., straight lines.
[0071] Step 140: if the first fitting curve and the second fitting curve are straight lines, and the first slope of the first fitting curve and the second slope of the second fitting curve are within a preset deviation range, generate a forward radar yaw angle according to the first slope and the second slope.
[0072] Specifically, to simplify the calculation, only the fitting curves of the straight sections are selected. When the first slope of the first fitting curve and the second slope of the second fitting curve are within the preset deviation range, it means that the two fitting curves are approximately parallel and are retained as valid data for calibration.
[0073] In a possible implementation manner, generating a forward radar yaw angle according to the first slope and the second slope specifically includes:
[0074] A set of first slope and second slope is selected, and the average of the first slope and the second slope is calculated to generate the first slope average value; the forward radar yaw angle is generated according to the first slope average value. If the first radar data is compensated and corrected to the true north coordinate system, the value of the first slope average value after angle conversion is the value of the forward radar yaw angle.
[0075] In another possible implementation, in order to further improve the calibration accuracy, the forward radar yaw angle is generated according to the first slope and the second slope, specifically including:
[0076] First, multiple groups of first slopes and second slopes are selected, and the average value of each group of first slopes and second slopes is calculated to generate the average value of the first slope of each group, wherein each selected group of first slopes and second slopes is the slope calculated on the sub-section, and both meet the slope deviation within the preset deviation range. The vehicle is divided into multiple sub-sections when traveling on the preset section, and the first radar data obtained from each sub-section is roughly calibrated for the radar yaw angle. In a possible implementation, the sub-section data is segmented at a millimeter wave frame rate. For example, if the millimeter wave frame rate is 15 frames per second, the data is segmented as a sub-section with 15 frames or a multiple of 15 frames.
[0077] Secondly, the average values of the first slopes of each group are added together to obtain the average value to generate the second slope average value. The first slope average value of each group is used for the slope of the rough calibration of the radar yaw angle, and the second slope average value is the arithmetic mean of the rough calibration slopes of multiple radar yaw angles. By calculating the arithmetic mean value, the slope calculation error can be offset to improve the calibration accuracy.
[0078] Finally, the forward radar yaw angle is generated according to the second slope average value. If the first radar data is compensated and corrected to the true north coordinate system, the value of the second slope average value after angle conversion is the value of the forward radar yaw angle.
[0079] In a specific example, Figure 2The schematic diagram of sub-section expansion area selection provided in the first embodiment of the present invention is as follows: Figure 2 As shown, it includes a vehicle driving path 1, a left side line of the road 2, a right side line of the road 3, a first radar data point 4, a first expansion area 5 and a second expansion area 6.
[0080] The vehicle driving path 1 is a straight sub-section in a preset road section. The vehicle is not limited to driving in the middle of the road, and can choose any lane line to drive along the road direction. The first radar data point 4 is the first radar data point detected by the on-board forward radar along the road direction. The first expansion area 5 is an area expanded with the left side line 2 of the road as the center line and a radius of 0.5 meters. The second expansion area 6 is an area expanded with the right side line 3 of the road as the center line and a radius of 0.5 meters. The first radar data point 4 covered by the first expansion area 5 and the second expansion area 6 is used for curve fitting of the road boundary.
[0081] In an alternative approach, Figure 3 The second flowchart of the radar yaw angle calibration method provided in the first embodiment of the present invention is as follows: Figure 3 As shown, after step 140, the method further includes:
[0082] Step 210: Generate a left front corner radar yaw angle and a right front corner radar yaw angle according to the forward radar yaw angle.
[0083] Specifically, first, the second radar data of the left front corner radar generated by the vehicle traveling along the road direction in a preset section is obtained; secondly, the second radar data point in the overlapping area of the left front corner radar and the forward radar detection range is adjusted to coincide with the first radar data point, and the adjusted angle value is calculated; finally, the yaw angle of the left front corner radar is generated according to the adjusted angle value and the yaw angle of the forward radar.
[0084] The steps for generating the right front corner radar yaw angle are similar to those for generating the left front corner radar yaw angle, and will not be repeated here.
[0085] Step 220, generating a left rear corner radar yaw angle according to the left front corner radar yaw angle.
[0086] Specifically, first, the third radar data of the left rear corner radar generated by the vehicle traveling along the road direction in a preset section is obtained; secondly, the third radar data point in the overlapping area of the left rear corner radar and the left front corner radar detection range is adjusted to coincide with the second radar data point, and the adjusted angle value is calculated; finally, the yaw angle of the left rear corner radar is generated according to the adjusted angle value and the yaw angle of the left front corner radar.
[0087] Step 230 , generating a right rear corner radar yaw angle according to the right front corner radar yaw angle and / or the left rear corner radar yaw angle.
[0088] Among them, the step of generating the right rear corner radar yaw angle according to the right front corner radar yaw angle is similar to step 220 and will not be repeated here.
[0089] Among them, the yaw angle of the right rear corner radar is generated according to the yaw angle of the left rear corner radar, specifically: first, the fourth radar data of the right rear corner radar generated by the vehicle traveling along the road direction in a preset section is obtained; secondly, the fourth radar data point in the overlapping area of the right rear corner radar and the left rear corner radar detection range is adjusted to coincide with the third radar data point, and the adjusted angle value is calculated; finally, the yaw angle of the right rear corner radar is generated according to the adjusted angle value and the yaw angle of the left rear corner radar.
[0090] The right rear corner radar yaw angle is generated according to the left rear corner radar yaw angle and the right front corner radar yaw angle, specifically:
[0091] A first right rear corner radar yaw angle is generated according to the right front corner radar yaw angle; a second right rear corner radar yaw angle is generated according to the left rear corner radar yaw angle;
[0092] The first right rear corner radar yaw angle and the second right rear corner radar yaw angle are arithmetically averaged to generate the final right rear corner radar yaw angle. According to the fact that the calibration of the right front corner radar has one less calibration error than that of the left rear corner radar, and the radar detection range overlap area angle is larger than that of the left rear corner radar, the right rear corner radar can be jointly calibrated by the right front corner radar and the left rear corner radar to offset different calibration errors and improve the calibration accuracy of the right rear corner radar.
[0093] In a specific example, Figure 4 The schematic diagram of the installation of the full-view radar provided in the first embodiment of the present invention includes a vehicle body 7, a forward radar 8, a left front corner radar 9, a right front corner radar 10, a left rear corner radar 11 and a right rear corner radar 12. The lateral field of view of the radar is not less than 150°.
[0094] Embodiment 2
[0095] Embodiment 2 of the present invention provides a radar yaw angle calibration device. Figure 5 This is a schematic diagram of the structure of a radar yaw angle calibration device provided in Embodiment 2 of the present invention. The radar yaw angle calibration device 300 includes an acquisition module 301 , a first data processing module 302 , a second data processing module 303 and a third data processing module 304 .
[0096] The acquisition module 301 is used to acquire first radar data of a forward radar generated by a vehicle traveling along a road direction on a preset road section, wherein there are parallel obstacles on both sides of the preset road section.
[0097] The first data processing module 302 is used to perform expansion with the two side lines of the preset road section as the center lines to generate a first expansion area and a second expansion area.
[0098] The second data processing module 303 is used to perform curve fitting on the first radar data of the same sub-section in the first expansion area and the second expansion area to generate a first fitting curve and a second fitting curve respectively; wherein the sub-section is a sub-section of a preset section.
[0099] The first radar data of the same sub-section in the first expansion area and the second expansion area are subjected to curve fitting to generate a first fitting curve and a second fitting curve respectively, specifically comprising:
[0100] Acquiring vehicle heading angle data synchronized with the first radar data;
[0101] Compensating and correcting the first radar data using the vehicle heading angle data and the compensation matrix;
[0102] The compensated and corrected first radar data is subjected to curve fitting to generate a first fitting curve and a second fitting curve respectively.
[0103] The third data processing module 304 is configured to generate a forward radar yaw angle according to the first slope and the second slope if the first fitting curve and the second fitting curve are straight lines and the first slope of the first fitting curve and the second slope of the second fitting curve are within a preset deviation range.
[0104] Among them, generating the forward radar yaw angle according to the first slope and the second slope specifically includes: selecting a set of first slope and second slope, calculating the average value of the first slope and the second slope, and generating the first slope average value; generating the forward radar yaw angle according to the first slope average value.
[0105] Among them, generating a forward radar yaw angle according to the first slope and the second slope specifically also includes: selecting multiple groups of first slopes and second slopes, calculating the average value of the first slope and the second slope of each group, and generating the first slope average value of each group; adding the first slope average values of each group to obtain the average value, and generating the second slope average value; generating the forward radar yaw angle according to the second slope average value.
[0106] In an optional scheme, the third data processing module 304 is also used to generate a left front corner radar yaw angle and a right front corner radar yaw angle according to the forward radar yaw angle; generate a left rear corner radar yaw angle according to the left front corner radar yaw angle; generate a right rear corner radar yaw angle according to the right front corner radar yaw angle and / or the left rear corner radar yaw angle.
[0107] Among them, the left front corner radar yaw angle is generated according to the forward radar yaw angle, specifically: obtain the second radar data of the left front corner radar generated by the vehicle traveling along the road direction in a preset section; adjust the second radar data point in the overlapping area of the left front corner radar and the forward radar detection range to coincide with the first radar data point, and calculate the adjusted angle value; generate the left front corner radar yaw angle according to the adjusted angle value and the forward radar yaw angle.
[0108] It should be noted that it should be understood that the division of the various modules of the above device is only a division of logical functions. In actual implementation, they can be fully or partially integrated into one physical entity, or they can be physically separated. And these modules can all be implemented in the form of software called by processing elements; they can also be all implemented in the form of hardware; some modules can also be implemented in the form of software called by processing elements, and some modules can be implemented in the form of hardware. For example, the data processing module can be a separately established processing element, or it can be integrated in a chip of the above device. In addition, it can also be stored in the memory of the above device in the form of program code, and called and executed by a processing element of the above device. The implementation of other modules is similar. In addition, these modules can be fully or partially integrated together, or they can be implemented independently. The processing element described here can be an integrated circuit with signal processing capabilities. In the implementation process, each step of the above method or each module above can be completed by an integrated logic circuit of hardware in the processor element or instructions in the form of software.
[0109] For example, the above modules may be one or more integrated circuits configured to implement the above methods, such as one or more application specific integrated circuits (ASIC), or one or more microprocessors (DSP), or one or more field programmable gate arrays (FPGA). For another example, when a module above is implemented in the form of a processing element scheduling program code, the processing element may be a general-purpose processor, such as a central processing unit (CPU) or other processor that can call program code. For another example, these modules may be integrated together and implemented in the form of a system-on-a-chip (SOC).
[0110] In the above embodiments, it can be implemented in whole or in part by software, hardware, firmware or any combination thereof. When implemented using software, it can be implemented in whole or in part in the form of a computer program product. The computer program product includes one or more computer instructions. When the computer program instructions are loaded and executed on a computer, the process or function described in the embodiment of the present application is generated in whole or in part. The above computer can be a general-purpose computer, a special-purpose computer, a computer network, or other programmable devices. The above-mentioned computer instructions can be stored in a computer-readable storage medium, or transmitted from one computer-readable storage medium to another computer-readable storage medium. For example, the above-mentioned computer instructions can be transmitted from one website, computer, server or data center to another website, computer, server or data center through wired (such as coaxial cable, optical fiber, digital subscriber line (DSL)) or wireless (such as infrared, wireless, Bluetooth, microwave, etc.) methods. The above-mentioned computer-readable storage medium can be any available medium that can be accessed by a computer or a data storage device such as a server or data center that includes one or more available media integrated. The above-mentioned available medium can be a magnetic medium (such as a floppy disk, a hard disk, a tape), an optical medium (such as a DVD), or a semiconductor medium (such as a solid state disk (SSD)), etc.
[0111] Embodiment 3
[0112] Embodiment 3 provides a computer program product including instructions, such as Figure 6 As shown, when the computer program product runs on a computer, the computer is enabled to execute any one of the radar yaw angle calibration methods provided in Example 1.
[0113] Embodiment 4
[0114] Embodiment 4 of the present invention provides a computer-readable storage medium on which a computer program is stored. When the computer program is executed by a processor, any radar yaw angle calibration method provided in Embodiment 1 is implemented.
[0115] Embodiment 5
[0116] A fifth embodiment of the present invention provides a computer device, Figure 7 This is a schematic diagram of the structure of a computer device provided in Embodiment 5 of the present invention. Figure 7 As shown, it includes a memory 100, a processor 200 and a computer program stored in the memory, and the processor executes the computer program to implement any one of the radar yaw angle calibration methods provided in the above embodiment 1.
[0117] Embodiment 6
[0118] A sixth embodiment of the present invention provides a mobile tool, including the computer device of the fifth embodiment described above.
[0119] The mobile tools referred to in this application may be those with tool functions, such as excavators, bulldozers, forklifts, rollers, sewage treatment vehicles, sanitation vehicles, vacuum trucks, floor scrubbers, sprinkler trucks, sweeping robot lawn mowers, etc.
[0120] The professionals should further realize that the units and algorithm steps of each example described in conjunction with the embodiments disclosed herein can be implemented by electronic hardware, computer software, or a combination of the two. In order to clearly illustrate the interchangeability of hardware and software, the composition and steps of each example have been generally described in the above description according to the function. Whether these functions are performed in hardware or software depends on the specific application and design constraints of the technical solution. Professionals and technicians can use different methods to implement the described functions for each specific application, but such implementation should not be considered to be beyond the scope of the present invention.
[0121] The steps of the method or algorithm described in conjunction with the embodiments disclosed herein may be implemented using hardware, a software module executed by a processor, or a combination of the two. The software module may be placed in a random access memory (RAM), a memory, a read-only memory (ROM), an electrically programmable ROM, an electrically erasable programmable ROM, a register, a hard disk, a removable disk, a CD-ROM, or any other form of storage medium known in the art.
[0122] The specific implementation methods described above further illustrate the objectives, technical solutions and beneficial effects of the present invention in detail. It should be understood that the above description is only a specific implementation method of the present invention and is not intended to limit the scope of protection of the present invention. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principles of the present invention should be included in the scope of protection of the present invention.
Claims
1. A radar yaw angle calibration method, characterized in that: The calibration method comprises: Acquire first radar data of a forward radar generated by a vehicle traveling along a road direction on a preset road section; Taking the lines on both sides of the preset road section as the center lines, expansion is performed respectively to generate a first expansion area and a second expansion area; Performing curve fitting on the first radar data of the same sub-section in the first expansion area and the second expansion area to generate a first fitting curve and a second fitting curve respectively; wherein the sub-section is a sub-section of the preset section; If the first fitting curve and the second fitting curve are straight lines, and the first slope of the first fitting curve and the second slope of the second fitting curve are within a preset deviation range, a forward radar yaw angle is generated according to the first slope and the second slope.
2. The radar yaw angle calibration method according to claim 1, characterized in that: Generating the forward radar yaw angle according to the first slope and the second slope specifically includes: Selecting a set of the first slope and the second slope, calculating an average of the first slope and the second slope, and generating a first slope average value; A forward radar yaw angle is generated according to the first slope average value.
3. The radar yaw angle calibration method according to claim 1, characterized in that: The generating the forward radar yaw angle according to the first slope and the second slope specifically includes: Selecting multiple groups of the first slope and the second slope, calculating an average value of the first slope and the second slope of each group, and generating an average value of the first slope of each group; The average values of the first slopes of each group are added together to obtain the average value, thereby generating the average value of the second slopes; A forward radar yaw angle is generated according to the second slope average value.
4. The radar yaw angle calibration method according to claim 1, characterized in that: The step of performing curve fitting on the first radar data of the same sub-section in the first expansion area and the second expansion area to generate a first fitting curve and a second fitting curve respectively specifically includes: Acquiring vehicle heading angle data synchronized with the first radar data; Compensating and correcting the first radar data by using the vehicle heading angle data and a compensation matrix; The compensated and corrected first radar data is subjected to curve fitting to generate a first fitting curve and a second fitting curve respectively.
5. The radar yaw angle calibration method according to claim 1, characterized in that: The method further comprises: Generate a left front corner radar yaw angle and a right front corner radar yaw angle according to the forward radar yaw angle; Generate a left rear corner radar yaw angle according to the left front corner radar yaw angle; A right rear corner radar yaw angle is generated according to the right front corner radar yaw angle and / or the left rear corner radar yaw angle.
6. The radar yaw angle calibration method according to claim 5, characterized in that: The generating of the left front radar yaw angle according to the forward radar yaw angle is specifically: Acquire second radar data of a left front corner radar generated by the vehicle traveling along a road direction in a preset road section; Adjust the second radar data point in the overlapping area of the left front corner radar and the forward radar detection range to coincide with the first radar data point, and calculate the adjusted angle value; A left front corner radar yaw angle is generated according to the adjusted angle value and the forward radar yaw angle.
7. The radar yaw angle calibration method according to claim 1, characterized in that: There are parallel obstacles on both sides of the preset road section.
8. A radar yaw angle calibration device, characterized in that: The device comprises: An acquisition module, used to acquire first radar data of a forward radar generated by a vehicle traveling along a road direction in a preset road section; A first data processing module is used to expand the two sides of the road of the preset section as the center line to generate a first expansion area and a second expansion area; A second data processing module is used to perform curve fitting on the first radar data of the same sub-section in the first expansion area and the second expansion area to generate a first fitting curve and a second fitting curve respectively; wherein the sub-section is a sub-section of the preset section; The third data processing module is used to generate a forward radar yaw angle according to the first slope and the second slope if the first fitting curve and the second fitting curve are straight lines and the first slope of the first fitting curve and the second slope of the second fitting curve are within a preset deviation range.
9. A computer-readable storage medium having a computer program stored thereon, characterized in that: When the computer program is executed by a processor, the steps of the method according to claims 1 to 7 are implemented.
10. A computer device comprising a memory, a processor and a computer program stored in the memory, characterized in that: The processor executes the computer program to implement the steps of the method of claims 1-7.
