A method for calibrating the installation angle of forward millimeter-wave radar based on least squares method

The least squares method combined with vehicle and radar speed data to real-time calibration of millimeter-wave radar installation angles is solved in the existing technology by solving the problems of long calibration time and vehicle speed delay, and achieving high-precision and rapid installation angle calibration.

CN117331039BActive Publication Date: 2024-11-26SUZHOU CHENGTAI TECH CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202311291894.X
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2023-10-08
Publication Date
2024-11-26
Estimated Expiration
2043-10-08

AI Technical Summary

Technical Problem

The existing millimeter-wave radar installation angle calibration method has the problem of too long calibration time, failure to quickly obtain installation angle deviation, and failure to consider the calibration accuracy loss and correlation coefficient due to vehicle speed delay, resulting in too low calibration coefficient, resulting in calibration failure.

Method used

The forward millimeter-wave radar installation angle calibration method is adopted based on the least squares method. By obtaining the speed data detected by the vehicle and radar, the vehicle speed error ratio coefficient and radar installation error angle data are generated, and the installation angle is calibrated in real time by combining the least squares method to optimize the installation angle. Calibration accuracy and shorten calibration time.

Benefits of technology

It improves calibration accuracy and correlation, shortens calibration time, compensates for the problem of information transmission delay, and ensures calibration accuracy in vehicle speed delay.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN117331039B_ABST
    Figure CN117331039B_ABST
Patent Text Reader

Abstract

The present invention discloses a method, system and platform for calibrating the installation angle of a forward millimeter-wave radar based on the least squares method. The method obtains first speed data corresponding to a vehicle traveling straight, and generates second speed data corresponding to the first speed data; generates third speed data corresponding to the forward millimeter-wave radar according to the second speed data; generates vehicle speed error proportional coefficient data and radar installation error angle data corresponding to the second speed data and the third speed data respectively; generates goodness of fit data corresponding to a current fitting curve in combination with the least squares method, and calibrates the installation angle of the forward millimeter-wave radar in real time according to the goodness of fit data, so as to improve the calibration accuracy and correlation while shortening the calibration time; and optimize the calibration accuracy, and compensate for the delay problem existing in information transmission.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention belongs to the technical field of angle calibration processing, and in particular relates to a method, system and platform for calibrating the installation angle of a forward millimeter-wave radar based on a least squares method. Background Art

[0002] At present, there are many millimeter wave radar self-calibration methods. Ikram proposed a method based on corner reflector occupancy grid mapping to calibrate the radar installation angle: two clearly distinguishable corner reflectors are deployed on the site, and a vehicle with an uncalibrated angle is driven past the two corner reflectors. The corner reflectors are mapped to a 10cm2 grid through the vehicle position information and the target distance and angle information detected by the radar. When the vehicle moves, if there is no installation angle deviation, the same target point should be located in the same grid. If there is an installation angle deviation, the same target will occupy multiple grids in the grid. Finally, by assuming different installation angle deviations for mapping, the result of occupying the least grid is considered to be the true installation angle error.

[0003] Furthermore, Chang Le proposed a radar after-sales calibration method with a fixed corner reflector: A fixture is fixed at the license plate, B fixture is installed on the corner reflector positioning group and fixed 2.5m away from the radar antenna surface, and the laser pen is used to align the A and B fixtures so that the center of the corner reflector is facing the center of the radar, ensuring that the axis of the corner reflector is aligned with the axis of the radar and parallel or coincident with the axis of the vehicle body. When the calibration program is started, the horizontal and vertical angle deviations between the radar axis and the axis of the vehicle body in the direction of travel are measured to obtain the angle that the radar needs to be calibrated.

[0004] Chu Yongyan and others proposed a radar self-calibration method based on corner reflectors: radar corner reflectors are placed at four different points A, B, C, and D on the test road. The vehicle passes along the test road at a speed greater than 15 km / h. The stationary targets with the largest reflection power at the four locations are taken to calculate Δα and Δβ and compared with the stored values. When the difference between Δβ and the previous stored value is within the range, the current Δα and Δβ are obtained by taking the weighted average of the first n stored values ​​as the calibration angles.

[0005] In addition, Li Yang et al. proposed a self-calibration method for installation angle: it accumulates variance by circling consecutive guardrails several times. The vehicle drives linearly along the test road at a speed greater than 20km / h, circling consecutive guardrails several times, periodically detecting the position, distance, and angle of the fences, and using Hough transform to map the target point set coordinates in the radar coordinate system to the parameter coordinate system to fill in the accumulator matrix, taking the maximum value of the accumulator matrix, and obtaining the installation angle estimation result when the maximum value is 1, and counting all the installation angle estimation results to match the confidence.

[0006] In addition, Cui Shenggang and others proposed a millimeter-wave radar installation angle self-calibration algorithm based on curve fitting. Compared with other algorithms, it only requires stationary objects on both sides of ordinary roads (trees, telephone poles, isolation piles, etc.), and does not require pre-deployment of corner reflectors. It can adapt to different road scenes. The calibration process is fully automated and does not require professional operation. The calibration time is shortened from more than 15 minutes to less than 5 minutes while ensuring the calibration accuracy.

[0007] Although the first four algorithms can calculate the installation angle deviation, they need to pre-deploy corner reflectors in the calibration environment or use them on roads with long straight guardrails. The calibration process takes too long and the installation angle deviation cannot be quickly obtained.

[0008] Although the fifth algorithm only requires static objects on both sides of ordinary roads (trees, telephone poles, isolation piles, etc.) compared to other algorithms and can adapt to different road scenarios, it was found in actual use that the calibration accuracy was lost because the vehicle speed delay was not taken into account. When the vehicle speed delay was large, the correlation coefficient would be too low, resulting in calibration failure.

[0009] As for the forward millimeter-wave radar installation angle calibration method based on curve fitting in patent CN115754945A, its accuracy will decrease accordingly when encountering a large vehicle speed delay and a large speed filtering amplitude transmitted from the vehicle body, affecting the final calibration result. Moreover, the final calculated goodness of fit cannot reach the commonly used judgment threshold of more than 0.95. If this goodness of fit judgment threshold is not lowered, the calibration will fail.

[0010] Therefore, in view of the above technical problems and defects, it is urgently necessary to design and develop a forward millimeter-wave radar installation angle calibration method, system and platform based on the least squares method. Summary of the invention

[0011] In order to overcome the shortcomings and difficulties of the above-mentioned prior art, the purpose of the present invention is to provide a forward millimeter-wave radar installation angle calibration method, system, platform and storage medium based on the least squares method, in order to improve the calibration accuracy and correlation while shortening the calibration time; and to further optimize the calibration accuracy and compensate for the delay problem in information transmission.

[0012] The first purpose of the present invention is to provide a forward millimeter-wave radar installation angle calibration method based on the least squares method; the second purpose of the present invention is to provide a forward millimeter-wave radar installation angle calibration system based on the least squares method; the third purpose of the present invention is to provide a forward millimeter-wave radar installation angle calibration platform based on the least squares method.

[0013] The first object of the present invention is achieved in that the method comprises the following steps:

[0014] Acquire first speed data corresponding to the vehicle traveling straight, and generate second speed data corresponding to the first speed data; wherein the second speed data is target object speed data based on the vehicle;

[0015] Generating third speed data corresponding to the forward millimeter-wave radar according to the second speed data; wherein the third speed data is speed data detected by the forward millimeter-wave radar;

[0016] generating vehicle speed error proportional coefficient data and radar installation error angle data corresponding to the second speed data and the third speed data respectively;

[0017] Combined with the least squares method, goodness of fit data corresponding to the current fitting curve is generated, and based on the goodness of fit data, the installation angle of the forward millimeter-wave radar is calibrated in real time.

[0018] Further, the acquiring of first speed data corresponding to the vehicle traveling straight ahead and the generation of second speed data corresponding to the first speed data, wherein the second speed data is target object speed data based on the vehicle, further comprises:

[0019] The first speed data is inverted and corresponding second speed data is generated in real time according to the inverted data.

[0020] Furthermore, the number of the vehicle-based target objects is at least one.

[0021] Further, the method further comprises generating third speed data corresponding to the forward millimeter-wave radar according to the second speed data; wherein the third speed data is speed data detected by the forward millimeter-wave radar; and further comprising:

[0022] generating first angle data of the target object relative to the forward millimeter-wave radar according to the second speed data and the third speed data;

[0023] According to the first angle data, second angle data corresponding to the forward millimeter-wave radar is generated, wherein the second angle data is angle data detected by the forward millimeter-wave radar.

[0024] Furthermore, the speed and angle in the method satisfy the following relationship:

[0025] V d / V h =A cos(θ d -θ e ) (2)

[0026] Among them, V d is the third speed data; V h is the second speed data; A is the vehicle speed error proportional coefficient data; θ d is the second angle data; θ e Install error angle data for radar.

[0027] The second object of the present invention is achieved as follows: the system comprises: a first data generating unit, configured to obtain first speed data corresponding to a vehicle traveling straight, and generate second speed data corresponding to the first speed data; wherein the second speed data is target object speed data based on the vehicle;

[0028] A second data generating unit is used to generate third speed data corresponding to the forward millimeter-wave radar according to the second speed data; wherein the third speed data is speed data detected by the forward millimeter-wave radar;

[0029] a third data generating unit, for generating vehicle speed error proportional coefficient data and radar installation error angle data corresponding to the second speed data and the third speed data respectively;

[0030] A calibration unit is generated, and the goodness of fit data corresponding to the current fitting curve is generated in combination with the least squares method, and the installation angle of the forward millimeter wave radar is calibrated in real time according to the goodness of fit data.

[0031] Furthermore, the first data generating unit further includes:

[0032] A first generating module, used for inverting the first speed data and generating corresponding second speed data in real time according to the inverted data;

[0033] And / or, the second data generating unit further includes:

[0034] A second generating module, configured to generate first angle data of the target object relative to the forward millimeter-wave radar according to the second speed data and the third speed data;

[0035] The third generating module is used to generate second angle data corresponding to the forward millimeter-wave radar according to the first angle data, wherein the second angle data is the angle data detected by the forward millimeter-wave radar.

[0036] Furthermore, the number of the vehicle-based target objects is at least one.

[0037] Furthermore, the speed and angle in the system satisfy the following relationship:

[0038] V d / V h =A cos(θ d -θ e ) (2)

[0039] Among them, V d is the third speed data; V h is the second speed data; A is the vehicle speed error proportional coefficient data; θ d is the second angle data; θ e Install error angle data for radar.

[0040] The third object of the present invention is achieved as follows: it includes a processor, a memory and a forward millimeter wave radar installation angle calibration platform control program based on the least squares method; wherein the forward millimeter wave radar installation angle calibration platform control program based on the least squares method is executed in the processor, and the forward millimeter wave radar installation angle calibration platform control program based on the least squares method is stored in the memory, and the forward millimeter wave radar installation angle calibration platform control program based on the least squares method implements the forward millimeter wave radar installation angle calibration method based on the least squares method.

[0041] The present invention obtains first speed data corresponding to a vehicle traveling straight through a method, and generates second speed data corresponding to the first speed data; generates third speed data corresponding to a forward millimeter-wave radar according to the second speed data; generates vehicle speed error proportional coefficient data and radar installation error angle data corresponding to the second speed data and the third speed data respectively; generates goodness of fit data corresponding to a current fitting curve by combining the least squares method, and calibrates the installation angle of the forward millimeter-wave radar in real time according to the goodness of fit data, so that the calibration accuracy and correlation can be improved while the calibration time can be shortened; and the calibration accuracy can be optimized, and the delay problem existing in information transmission can be compensated. BRIEF DESCRIPTION OF THE DRAWINGS

[0042] In order to more clearly illustrate the technical solutions in the embodiments of the present invention, the following briefly introduces the drawings required for use in the description of the embodiments. Obviously, the drawings described below are only some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.

[0043] Figure 1 It is a schematic diagram of the algorithm principle of an embodiment of a method for calibrating the installation angle of a forward millimeter-wave radar based on the least squares method of the present invention;

[0044] Figure 2 It is a schematic diagram of algorithm simulation results of an embodiment of a forward millimeter-wave radar installation angle calibration method based on the least squares method of the present invention;

[0045] Figure 3 It is a schematic diagram of simulation results of an embodiment of a forward millimeter-wave radar installation angle calibration method based on the least square method of the present invention without introducing a vehicle speed error proportional coefficient A;

[0046] Figure 4 It is a schematic diagram of simulation results of introducing a vehicle speed error proportional coefficient A of 0.01 in an embodiment of a forward millimeter wave radar installation angle calibration method based on the least square method of the present invention;

[0047] Figure 5 It is a schematic diagram of simulation results of data 1 of an embodiment of a method for calibrating the installation angle of a forward millimeter-wave radar based on the least square method of the present invention;

[0048] Figure 6 It is a schematic diagram of simulation results of data 2 of an embodiment of a method for calibrating the installation angle of a forward millimeter-wave radar based on the least squares method of the present invention;

[0049] Figure 7 It is a schematic diagram of simulation results of data 3 of an embodiment of a method for calibrating the installation angle of a forward millimeter-wave radar based on the least squares method of the present invention;

[0050] Figure 8 It is a schematic diagram of simulation results of data 4 of an embodiment of a method for calibrating the installation angle of a forward millimeter-wave radar based on the least squares method of the present invention;

[0051] Fig. 9 It is a schematic diagram of simulation results of data 5 of an embodiment of a method for calibrating the installation angle of a forward millimeter-wave radar based on the least squares method of the present invention;

[0052] Fig.10 It is a schematic diagram of simulation results of data 6 of an embodiment of a method for calibrating the installation angle of a forward millimeter-wave radar based on the least squares method of the present invention;

[0053] Fig.11 It is a schematic diagram of simulation results of data seven of an embodiment of a method for calibrating the installation angle of a forward millimeter-wave radar based on the least squares method of the present invention;

[0054] Fig.12 It is a schematic diagram of simulation results of data 8 of an embodiment of a method for calibrating the installation angle of a forward millimeter-wave radar based on the least squares method of the present invention;

[0055] Fig.13 A schematic diagram of the process steps of a method for calibrating the installation angle of a forward millimeter-wave radar based on the least squares method of the present invention;

[0056] Fig.14 This is a schematic diagram of the architecture of a forward millimeter-wave radar installation angle calibration system based on the least squares method of the present invention;

[0057] Fig.15 This is a schematic diagram of a forward millimeter wave radar installation angle calibration platform architecture based on the least squares method of the present invention;

[0058] The purpose, features and advantages of the present invention will be further described with reference to the accompanying drawings in conjunction with the embodiments. DETAILED DESCRIPTION

[0059] In order to better understand the purpose, technical solutions and advantages of the present invention, the present invention is further described below in conjunction with the accompanying drawings and specific implementation methods. Those skilled in the art can easily understand other advantages and effects of the present invention from the contents disclosed in this specification.

[0060] The present invention may also be implemented or applied through other different specific examples, and the details in this specification may also be modified and changed in various ways based on different viewpoints and applications without departing from the spirit of the present invention.

[0061] It should be noted that if the embodiments of the present invention involve directional indications (such as up, down, left, right, front, back, etc.), the directional indications are only used to explain the relative position relationship, movement status, etc. between the components under a certain specific posture (as shown in the accompanying drawings). If the specific posture changes, the directional indication will also change accordingly.

[0062] In addition, if there are descriptions involving "first", "second", etc. in the embodiments of the present invention, the descriptions of "first", "second", etc. are only used for descriptive purposes and cannot be understood as indicating or suggesting their relative importance or implicitly indicating the number of the indicated technical features. Therefore, the features defined as "first" and "second" may explicitly or implicitly include at least one of the features. Secondly, the technical solutions between the various embodiments can be combined with each other, but they must be based on the ability of ordinary technicians in the field to implement them. When the combination of technical solutions is contradictory or cannot be implemented, it should be deemed that such a combination of technical solutions does not exist and is not within the scope of protection required by the present invention.

[0063] Preferably, the least square method-based forward millimeter-wave radar installation angle calibration method of the present invention is applied in one or more terminals or servers. The terminal is a device that can automatically perform numerical calculations and / or information processing according to pre-set or stored instructions, and its hardware includes but is not limited to microprocessors, application specific integrated circuits (ASIC), programmable gate arrays (FPGA), digital signal processors (DSP), embedded devices, etc.

[0064] The terminal can be a computing device such as a desktop computer, a notebook, a PDA, a cloud server, etc. The terminal can interact with the client through a keyboard, a mouse, a remote control, a touch pad, or a voice control device.

[0065] The present invention is to realize a method, system, platform and storage medium for calibrating the installation angle of a forward millimeter-wave radar based on the least squares method.

[0066] like Fig.13 , which is a flow chart of a forward millimeter-wave radar installation angle calibration method based on the least squares method provided in an embodiment of the present invention.

[0067] In this embodiment, the forward millimeter-wave radar installation angle calibration method based on the least squares method can be applied to a terminal with a display function or a fixed terminal. The terminal is not limited to a personal computer, a smart phone, a tablet computer, a desktop computer or an all-in-one computer equipped with a camera, etc.

[0068] The forward millimeter-wave radar installation angle calibration method based on the least squares method can also be applied to a hardware environment consisting of a terminal and a server connected to the terminal through a network. The network includes but is not limited to: a wide area network, a metropolitan area network or a local area network. The forward millimeter-wave radar installation angle calibration method based on the least squares method of an embodiment of the present invention can be executed by a server, can be executed by a terminal, or can be executed by both a server and a terminal.

[0069] For example, for a terminal that needs to perform a forward millimeter-wave radar installation angle calibration based on the least squares method, the forward millimeter-wave radar installation angle calibration function based on the least squares method provided by the method of the present invention can be directly integrated on the terminal, or a client for implementing the method of the present invention can be installed. For another example, the method provided by the present invention can also be run on a server or other device in the form of a software development kit (SDK), and an interface for the forward millimeter-wave radar installation angle calibration function based on the least squares method is provided in the form of SDK. The terminal or other device can implement the forward millimeter-wave radar installation angle calibration function based on the least squares method through the provided interface. The present invention is further described below in conjunction with the accompanying drawings.

[0070] like Figure 1-Figure 13 As shown, the present invention provides a method for calibrating the installation angle of a forward millimeter-wave radar based on the least squares method, wherein the method comprises the following steps:

[0071] S1, obtaining first speed data corresponding to a vehicle traveling straight, and generating second speed data corresponding to the first speed data; wherein the second speed data is target object speed data based on the vehicle;

[0072] S2. Generate third speed data corresponding to the forward millimeter-wave radar according to the second speed data; wherein the third speed data is speed data detected by the forward millimeter-wave radar;

[0073] S3, respectively generating vehicle speed error proportional coefficient data and radar installation error angle data corresponding to the second speed data and the third speed data;

[0074] S4. Generate goodness-of-fit data corresponding to the current fitting curve by combining the least squares method, and calibrate the installation angle of the forward millimeter-wave radar in real time according to the goodness-of-fit data.

[0075] The method further comprises: obtaining first speed data corresponding to the vehicle traveling straight, and generating second speed data corresponding to the first speed data; wherein the second speed data is target object speed data based on the vehicle;

[0076] S11, inverting the first speed data, and generating corresponding second speed data in real time according to the inverted data.

[0077] The number of the vehicle-based target objects is at least one.

[0078] The method further comprises: generating third speed data corresponding to the forward millimeter-wave radar according to the second speed data; wherein the third speed data is speed data detected by the forward millimeter-wave radar; and further comprising:

[0079] S21, generating first angle data of the target object relative to the forward millimeter-wave radar according to the second speed data and the third speed data;

[0080] S22. Generate second angle data corresponding to the forward millimeter-wave radar based on the first angle data, wherein the second angle data is angle data detected by the forward millimeter-wave radar.

[0081] The speed and angle in the method satisfy the following relationship:

[0082] V d / V h =A cos(θ d -θ e ), (1)

[0083] Among them, V d is the third speed data; V h is the second speed data; A is the vehicle speed error proportional coefficient data; θ d is the second angle data; θ e Install error angle data for radar.

[0084] Specifically, in the embodiment of the present invention, the vehicle driving direction is set as the positive direction of the X axis, and the left side of the driver's perspective is set as the positive direction of the Y axis. Figure 1 As shown in FIG. 1 , when the vehicle is moving straight, the target speed is the opposite of the vehicle speed, and the speed detected by the radar is the component of its ground speed in the radar radial direction.

[0085] If the radar has an installation error angle, then:

[0086]

[0087] If the vehicle speed error coefficient is considered, the vehicle in motion satisfies formula (2) for a single stationary target:

[0088] V d / V h =A cos(θ d -θ e ) (2)

[0089] Among them, θ t The target's true angle relative to the radar; V d The speed at which the radar detects the target; V h The speed of the vehicle; A The speed error proportional coefficient; θ d The angle at which the radar detects the target; θ e Radar installation angle error;

[0090] From formula (2), we get:

[0091]

[0092] definition:

[0093]

[0094] Formula (4) can be used to obtain formula (5) to solve the vehicle speed error proportional coefficient A and formula (6) radar installation error angle θ e ;

[0095] That is, the vehicle speed error proportional coefficient A is:

[0096]

[0097] That is, the radar installation error angle θ e for:

[0098]

[0099] Substituting formula (4) into formula (3) yields formula (7):

[0100] Y=C1cosθ d +C2sinθ d (7)

[0101] Extending formula (7) to n stationary target points yields formula (8):

[0102]

[0103] In summary, by solving C1 and C2, we can obtain the vehicle speed error coefficient A and the radar installation error angle θ e , use the least squares method to find the optimal solution of this equation, and define the loss function as formula (9)

[0104]

[0105] The optimal solution of C is obtained by deriving formula (9):

[0106]

[0107] make We can get formula (11):

[0108]

[0109] At this point, C1 and C2 in C can be obtained, and then the vehicle speed error proportional coefficient A and the radar installation error angle θ can be solved. e After obtaining the vehicle speed error proportional coefficient and the installation error angle, the goodness of fit of the current fitting curve needs to be calculated using formula (12).

[0110]

[0111] In the above formula, C is the matrix [C1; C2], C1 and C2 are defined variables, Y is the defined variable, SSE is the residual square, SST is the total discrete sum of squares, and R is the determination coefficient.

[0112] Specifically, in the algorithm simulation, the calibration accuracy is further optimized by introducing the vehicle speed error coefficient A in the derivation process of the above algorithm. This is because the speed received by the radar is usually forwarded through the MPC or domain controller using the CAN protocol, and the vehicle speed delay problem is unavoidable during the forwarding process.

[0113] In addition, in some vehicle models, the speed given by the vehicle body will produce a certain degree of delay after filtering, and the delay in vehicle speed will cause an error in the ratio Y of the direct use of radar speed measurement and the vehicle speed. Therefore, a speed error coefficient is introduced to eliminate the calibration accuracy loss caused by speed delay. In the scheme of the present invention, the accuracy loss caused by speed delay is reflected through the simulation of actual data.

[0114] For the same set of data collected by deflecting the radar by -0.7°, the same point selection strategy is adopted. In the range of ±40°, static original points are selected in intervals of 10°, and 100 static original points are selected in each interval.

[0115] First, the algorithm is simulated by using formula (2)-formula (12), then the simulation is performed without introducing the speed error proportional coefficient A on the basis of formula (2), and finally the simulation with a large speed delay is performed by adding a speed error coefficient of 0.01 to Y, so as to ensure that the same data is used for calibration. Figure 2 The simulation result of the Nakamoto algorithm is 0.65827. Figure 3 The simulation result after removing the speed error proportional coefficient A is 0.60461. Figure 4 The result of introducing a speed error guideline of 0.01 is 0.53618. This error is because during the fitting process, the up and down offsets of the fitting curve cause the left and right offsets of the fitting result to be corrected. The up and down offsets are determined by A through formula (2), and the left and right offsets of the fitting curve are determined by θ in formula (2). eDetermine, the change of A affects θ e result.

[0116] As attached Figure 5-12 As shown, in the simulation of eight different data at the same installation position, the maximum value differs from the minimum value by 0.4487°, and the calibration accuracy is significantly better than the fifth algorithm mentioned above.

[0117] Preferably, in the actual measurement of the algorithm, the radar is installed in the front of the vehicle through a bracket, and the radar is deflected by 0.4° by adjusting the bracket, and calibrated on a public road. To ensure that the collected data is the data when the vehicle is driving normally in a straight line, the bumpy road section and the curve are filtered by the vehicle yaw angle and the steering wheel angle, see formula (13), when the absolute value of the vehicle yaw angle is greater than 0.5° / s or the absolute value of the steering wheel angle is greater than 2°, the collection of calibration points is stopped. To ensure the uniformity of the fitting point selection, within the range of ±40°, the static original points are selected in intervals of 10°, where 100 static original points are selected in each interval. Table 1 shows the results of 7 calibrations on public roads. The calibration results show that the difference between the maximum and minimum values ​​is 0.19°, and the calibration average difference is -1.4286e-05.

[0118]

[0119] Among them, yawrate is the vehicle yaw angle; wheelangle is the steering wheel angle.

[0120] To further improve the effectiveness of selecting the original points, the theoretical Y value threshold of each point can be calculated as a filtering condition. For example, when the design requires calibration of a radar with an installation error within ±5°, this threshold can be appropriately adjusted to 0.001 as shown in formula (14).

[0121] Y = cos(θ d ±5) (14)

[0122] Table 1 Public road test results

[0123]

[0124]

[0125] In general, the scheme of the present invention is compared in reverse through three fitting methods: first, the algorithm of the scheme of the present invention is simulated, then the speed error proportional coefficient proposed in the algorithm of the scheme of the present invention is removed for simulation, and finally, a speed error of 0.01 is added to the collected Y for simulation, in order to prove that the introduction of the speed error proportional coefficient optimizes the calibration results.

[0126] In addition, the scheme of the present invention is tested through the actual measurement of the algorithm. Due to the problem of UDS protocol and the limitation of radar memory size, all the original points cannot be directly saved in the flash. Currently, it is not possible to directly compare the results of adding the vehicle speed error proportional coefficient A and not adding A in the radar. What is used in the simulation is to save the original points output by the radar in real time for simulation, and the comparison between the simulation results and the measured results is the same.

[0127] To achieve the above object, the present invention also provides a forward millimeter wave radar installation angle calibration system based on the least squares method, such as Fig.14 As shown, the system specifically includes:

[0128] A first data generating unit is used to obtain first speed data corresponding to the vehicle traveling straight, and generate second speed data corresponding to the first speed data; wherein the second speed data is target object speed data based on the vehicle;

[0129] A second data generating unit is used to generate third speed data corresponding to the forward millimeter-wave radar according to the second speed data; wherein the third speed data is speed data detected by the forward millimeter-wave radar;

[0130] a third data generating unit, for generating vehicle speed error proportional coefficient data and radar installation error angle data corresponding to the second speed data and the third speed data respectively;

[0131] A calibration unit is generated, and the goodness of fit data corresponding to the current fitting curve is generated in combination with the least squares method, and the installation angle of the forward millimeter wave radar is calibrated in real time according to the goodness of fit data.

[0132] Furthermore, the first data generating unit further includes:

[0133] A first generating module, used for inverting the first speed data and generating corresponding second speed data in real time according to the inverted data;

[0134] And / or, the second data generating unit further includes:

[0135] A second generating module, configured to generate first angle data of the target object relative to the forward millimeter-wave radar according to the second speed data and the third speed data;

[0136] The third generating module is used to generate second angle data corresponding to the forward millimeter-wave radar according to the first angle data, wherein the second angle data is the angle data detected by the forward millimeter-wave radar.

[0137] The number of the target object based on the vehicle is at least one. The speed and angle in the system satisfy the following relationship:

[0138] V d / V h =A cos(θ d -θ e ) (2)

[0139] Among them, V d is the third speed data; V h is the second speed data; A is the vehicle speed error proportional coefficient data; θ d is the second angle data; θ e Install error angle data for radar.

[0140] In the system solution embodiment of the present invention, the method steps involved in the least squares method-based forward millimeter-wave radar installation angle calibration have been described above in detail, that is, the functional modules in the system are used to implement the steps or sub-steps in the above method embodiment, which will not be repeated here.

[0141] To achieve the above object, the present invention also provides a forward millimeter wave radar installation angle calibration platform based on the least squares method, such as Fig.15 As shown, it includes a processor, a memory, and a forward millimeter wave radar installation angle calibration platform control program based on the least squares method; wherein the forward millimeter wave radar installation angle calibration platform control program based on the least squares method is executed by the processor, the forward millimeter wave radar installation angle calibration platform control program based on the least squares method is stored in the memory, and the forward millimeter wave radar installation angle calibration platform control program based on the least squares method implements the forward millimeter wave radar installation angle calibration method steps based on the least squares method. For example:

[0142] S1, obtaining first speed data corresponding to a vehicle traveling straight, and generating second speed data corresponding to the first speed data; wherein the second speed data is target object speed data based on the vehicle;

[0143] S2. Generate third speed data corresponding to the forward millimeter-wave radar according to the second speed data; wherein the third speed data is speed data detected by the forward millimeter-wave radar;

[0144] S3, respectively generating vehicle speed error proportional coefficient data and radar installation error angle data corresponding to the second speed data and the third speed data;

[0145] S4. Generate goodness-of-fit data corresponding to the current fitting curve by combining the least squares method, and calibrate the installation angle of the forward millimeter-wave radar in real time according to the goodness-of-fit data.

[0146] The specific details of the steps have been explained above and will not be repeated here.

[0147] In the embodiment of the present invention, the built-in processor of the forward millimeter wave radar installation angle calibration platform based on the least square method can be composed of an integrated circuit, for example, it can be composed of a single packaged integrated circuit, or it can be composed of a plurality of integrated circuits with the same or different functions, including one or more central processing units (CPU), microprocessors, digital processing chips, graphics processors, and a combination of various control chips. The processor uses various interfaces and lines to connect various components, and executes or executes programs or units stored in the memory, and calls data stored in the memory to perform various functions and process data of the forward millimeter wave radar installation angle calibration based on the least square method;

[0148] The memory is used to store program codes and various data, is installed in the forward millimeter-wave radar installation angle calibration platform based on the least squares method, and realizes high-speed and automatic access to programs or data during operation.

[0149] The memory includes read-only memory (ROM), random access memory (RAM), programmable read-only memory (PROM), erasable programmable read-only memory (EPROM), one-time programmable read-only memory (OTPROM), electronically erasable programmable read-only memory (EEPROM), compact disc read-only memory (CD-ROM) or other optical disc storage, magnetic disk storage, magnetic tape storage, or any other computer-readable medium that can be used to carry or store data.

[0150] The present invention obtains first speed data corresponding to a vehicle traveling straight through a method, and generates second speed data corresponding to the first speed data; generates third speed data corresponding to a forward millimeter-wave radar according to the second speed data; generates vehicle speed error proportional coefficient data and radar installation error angle data corresponding to the second speed data and the third speed data respectively; generates goodness of fit data corresponding to a current fitting curve by combining the least squares method, and calibrates the installation angle of the forward millimeter-wave radar in real time according to the goodness of fit data, so that the calibration accuracy and correlation can be improved while the calibration time can be shortened; and the calibration accuracy can be optimized, and the delay problem existing in information transmission can be compensated.

[0151] That is to say, the present invention proposes a new self-calibration method for the self-calibration problem of the installation angle of the millimeter-wave radar. First, the algorithm flow is derived, and the vehicle speed error coefficient is introduced to further optimize the calibration accuracy, which can make up for the delay problem in information transmission. By introducing the vehicle speed error coefficient, the calibration accuracy and correlation can be improved while the calibration time can be shortened to less than one minute.

[0152] The above-mentioned embodiments only express several implementation methods of the present invention, and the description thereof is relatively specific and detailed, but it cannot be understood as limiting the scope of the patent of the present invention. It should be pointed out that, for ordinary technicians in this field, several variations and improvements can be made without departing from the concept of the present invention, which all belong to the protection scope of the present invention. Therefore, the protection scope of the patent of the present invention shall be subject to the attached claims.

Claims

1. A method for calibrating the installation angle of a forward millimeter-wave radar based on the least squares method, characterized in that: The method comprises the steps of: Acquire first speed data corresponding to the vehicle traveling straight, and generate second speed data corresponding to the first speed data; wherein the second speed data is target object speed data based on the vehicle; Generating third speed data corresponding to the forward millimeter-wave radar according to the second speed data; wherein the third speed data is speed data detected by the forward millimeter-wave radar; generating vehicle speed error proportional coefficient data and radar installation error angle data corresponding to the second speed data and the third speed data respectively; In combination with the least squares method, goodness of fit data corresponding to the current fitting curve is generated, and according to the goodness of fit data, the installation angle of the forward millimeter wave radar is calibrated in real time; The speed and angle in the method satisfy the following relationship: V d / V h =A cos(θ d -θ e ) (2) Among them, V d is the third speed data; V h is the second speed data; A is the vehicle speed error proportional coefficient data; θ d is the second angle data; θ e Install error angle data for radar.

2. According to the least square method-based forward millimeter wave radar installation angle calibration method of claim 1, it is characterized in that: The method further comprises: obtaining first speed data corresponding to the vehicle traveling straight, and generating second speed data corresponding to the first speed data; wherein the second speed data is target object speed data based on the vehicle; The first speed data is inverted and corresponding second speed data is generated in real time according to the inverted data.

3. The method for calibrating the installation angle of a forward millimeter-wave radar based on the least squares method according to claim 1 or 2, characterized in that: The number of the vehicle-based target objects is at least one.

4. According to the least square method-based forward millimeter wave radar installation angle calibration method of claim 1, it is characterized in that: The method further comprises: generating third speed data corresponding to the forward millimeter-wave radar according to the second speed data; wherein the third speed data is speed data detected by the forward millimeter-wave radar; and further comprising: generating first angle data of the target object relative to the forward millimeter-wave radar according to the second speed data and the third speed data; According to the first angle data, second angle data corresponding to the forward millimeter-wave radar is generated, wherein the second angle data is angle data detected by the forward millimeter-wave radar.

5. A forward millimeter wave radar installation angle calibration system based on least squares method, characterized in that: The system is used to implement the forward millimeter wave radar installation angle calibration method based on the least squares method as described in any one of claims 1 to 4; the system includes: A first data generating unit is used to obtain first speed data corresponding to the vehicle traveling straight, and generate second speed data corresponding to the first speed data; wherein the second speed data is target object speed data based on the vehicle; A second data generating unit is used to generate third speed data corresponding to the forward millimeter-wave radar according to the second speed data; wherein the third speed data is speed data detected by the forward millimeter-wave radar; a third data generating unit, for generating vehicle speed error proportional coefficient data and radar installation error angle data corresponding to the second speed data and the third speed data respectively; A calibration unit is generated, and the goodness of fit data corresponding to the current fitting curve is generated in combination with the least squares method, and the installation angle of the forward millimeter wave radar is calibrated in real time according to the goodness of fit data.

6. The forward millimeter wave radar installation angle calibration system based on the least squares method according to claim 5, characterized in that: The first data generating unit further includes: A first generating module, used for inverting the first speed data and generating corresponding second speed data in real time according to the inverted data; And / or, the second data generating unit further includes: A second generating module, configured to generate first angle data of the target object relative to the forward millimeter-wave radar according to the second speed data and the third speed data; The third generating module is used to generate second angle data corresponding to the forward millimeter-wave radar according to the first angle data, wherein the second angle data is the angle data detected by the forward millimeter-wave radar.

7. A forward millimeter wave radar installation angle calibration system based on least squares method according to claim 5 or 6, characterized in that: The number of the vehicle-based target objects is at least one.

8. The least square method-based forward millimeter wave radar installation angle calibration system according to claim 5 or 6, characterized in that: The speed and angle in the system satisfy the following relationship: V d / V h =A cos(θ d -θ e ) (2) Among them, V d is the third speed data; V h is the second speed data; A is the vehicle speed error proportional coefficient data; θ d is the second angle data; θ e Install error angle data for radar.

9. A forward millimeter wave radar installation angle calibration platform based on the least squares method, characterized in that: The invention comprises a processor, a memory and a forward millimeter-wave radar installation angle calibration platform control program based on the least squares method; wherein the forward millimeter-wave radar installation angle calibration platform control program based on the least squares method is executed by the processor, the forward millimeter-wave radar installation angle calibration platform control program based on the least squares method is stored in the memory, and the forward millimeter-wave radar installation angle calibration platform control program based on the least squares method implements the forward millimeter-wave radar installation angle calibration method based on the least squares method as described in any one of claims 1 to 4.