Millimeter wave radar scale positioning method and system with Doppler compensation

Through Doppler compensation and feature point matching algorithm, the Doppler distortion problem of millimeter wave radar during high-speed motion is solved, and the positioning accuracy and point cloud registration success rate are improved.

CN115220041BActive Publication Date: 2024-11-12HUAZHONG UNIV OF SCI & TECH
View PDF 0 Cites 2 Cited by

Patent Information

Application Number
CN202210703470.9
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-06-21
Publication Date
2024-11-12
Estimated Expiration
2042-06-21

AI Technical Summary

Technical Problem

The existing millimeter-wave radar scale positioning technology causes inaccurate measurement results due to the Doppler effect during high-speed motion, resulting in Doppler distortion in the radar scanning map, affecting the positioning accuracy.

Method used

The Doppler compensation method is used to compensate the millimeter-wave radar point clouds, remove dynamic targets through the RANSAC algorithm, increase the point cloud density, estimate the uncertainty distribution under the Cartesian coordinate system, and calculate the bits using the maximum likelihood estimation algorithm. Pose transformation relationship reduces measurement error.

Benefits of technology

Effectively compensate for the Doppler effect, improves the success rate of millimeter-wave radar point cloud registration, reduces positioning errors, and improves positioning accuracy.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN115220041B_ABST
    Figure CN115220041B_ABST
Patent Text Reader

Abstract

A millimeter wave radar scale positioning method with Doppler compensation includes: performing Doppler distortion compensation on the millimeter wave radar point cloud; using the RANSAC algorithm to remove dynamic targets from the millimeter wave radar target points, and increasing the point cloud density by superimposing radar point clouds at adjacent moments; estimating the uncertainty distribution of the millimeter wave radar point cloud in the Cartesian coordinate system according to the measurement errors of the distance, speed and angle of the radar target in the polar coordinate system; according to the pre-processed point cloud obtained in the steps and the uncertainty estimation of the target point, using the feature point matching algorithm based on the RSD descriptor to associate radar data, and using the maximum likelihood estimation algorithm to calculate the posture transformation relationship of the current radar coordinate system relative to the key frame according to the association result, and obtaining the scale positioning result of the radar at the current moment. The present invention effectively improves the success rate of millimeter wave radar point cloud registration and reduces the influence of measurement values ​​with large errors.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of synchronous positioning and mapping, and in particular to a millimeter wave radar scale positioning method and system based on Doppler compensation. Background Art

[0002] Scale positioning is one of the key technologies for autonomous vehicles to achieve autonomous positioning and navigation. This technology can use the sensor data of historical key frames and combine it with the sensor measurement values ​​of the current vehicle to estimate its global position information at the current moment. This technology can effectively reduce the positioning drift problem caused by the accumulated error of the vehicle odometer.

[0003] Most of the existing scale positioning technologies are based on lidar or camera data. However, these sensors are easily affected by weather conditions (such as rain, fog, snow) and lighting conditions, and cannot work stably under all-weather conditions. Compared with the above sensors, millimeter-wave radar has a longer emission wavelength, so it has stronger penetration ability and can adapt to most weather conditions. This makes it an ideal positioning and navigation sensor. At the same time, with the continuous development of millimeter-wave radar based on FMCW technology (frequency modulated continuous wave) in hardware and production technology in recent years, millimeter-wave radar has shown its unique advantages in size, price and accuracy. Using millimeter-wave radar for scale positioning has gradually become one of the research hotspots in the field of positioning and navigation in academia and industry.

[0004] Although the existing millimeter-wave radar scale positioning work can achieve good positioning results, most of these works underestimate the impact of the Doppler effect in the positioning process. When a vehicle equipped with a millimeter-wave radar moves at high speed, the Doppler effect will change the original measurement information of the FMCW millimeter-wave radar, making the radar's measurement results no longer accurate. Specifically, the Doppler frequency will change the ranging information of the radar reflection point, thereby causing Doppler distortion of the radar scan image. The impact of this distortion is particularly obvious in FMCW radar scale positioning applications. This is because we cannot ensure that the sensor has the same speed when collecting two frames of radar scan images, which will cause us to be unable to correctly associate the two frames of radar point clouds during the subsequent point cloud registration process, further causing significant errors in scale positioning. Summary of the invention

[0005] In view of the above problems, the present invention is proposed to provide a millimeter wave radar scale positioning method and system with Doppler compensation to overcome the above problems or at least partially solve the above problems.

[0006] In order to solve the above technical problems, the embodiments of the present application disclose the following technical solutions:

[0007] A millimeter wave radar scale positioning method with Doppler compensation, characterized by comprising:

[0008] S100. Performing Doppler distortion compensation on the millimeter wave radar point cloud, wherein the distortion compensation value is determined by the measurement speed of the millimeter wave radar target point and the radar parameters;

[0009] S200. Use the RANSAC algorithm to remove dynamic targets from millimeter-wave radar target points, and increase the point cloud density by superimposing radar point clouds at adjacent moments; use the mean shift algorithm to aggregate the radar point clouds after overlapping frames to reduce the impact of millimeter-wave radar measurement errors;

[0010] S300. Estimate the uncertainty distribution of the millimeter wave radar point cloud in the Cartesian coordinate system according to the measurement errors of the distance, speed and angle of the radar target in the polar coordinate system;

[0011] S400. According to the preprocessed point cloud obtained in steps S100-S300 and the uncertainty estimate of the target point, the radar data is associated with a feature point matching algorithm based on the RSD descriptor, and the maximum likelihood estimation algorithm is used to calculate the pose transformation relationship of the current radar coordinate system relative to the key frame according to the association result, and further obtain the scale positioning result of the radar at the current moment.

[0012] Furthermore, the specific method of S100 includes:

[0013] S101. According to the signal transmission frequency f of the millimeter wave radar c And the slope K of each linear frequency modulation signal, calculate the Doppler coefficient β of the millimeter wave radar, where,

[0014] S102. Calculate the corresponding Doppler compensation value r according to the radar target speed measurement value v and the Doppler coefficient β obtained in S101 d =βv, where v is the radial velocity of the radar target;

[0015] S103. Restore the original laser radar target point measurement value according to the Doppler compensation value calculated in S102 in is the target distance measurement with Doppler distortion, and r is the restored radar target distance.

[0016] Furthermore, the calculation formula for the slope K of each linear frequency modulation signal of the millimeter wave radar is:

[0017]

[0018] Wherein, B and T are the bandwidth and duration of the linear frequency modulation signal respectively.

[0019] Furthermore, in S200, the specific method of using the RANSAC algorithm to remove dynamic targets from millimeter wave radar target points includes: obtaining the radial velocity v of the radar target r , the angle of the target θ, the speed of the car v s And the driving angle α, when the radial velocity v of the target point r Satisfy the formula v r =-v s cos(α-θ), the current target point is marked as a stationary radar target, which does not conform to the formula v r =-v s The points with cos(α-θ) are regarded as dynamic radar targets and removed.

[0020] Furthermore, in S200, the method of increasing the point cloud density by superimposing radar point clouds at adjacent moments includes: assuming that the current moment is t, then the point cloud at time t after superimposing the radar point cloud It is expressed as:

[0021]

[0022]

[0023] Among them, P t-i (i=1,2,…K) represents the measurement point cloud at time iK, Represents the coordinate transformation matrix of the radar at time ti relative to time t, represents the rotation matrix, Represents the translation vector.

[0024] Furthermore, the specific method of S300 includes:

[0025] S301. Convert the target position in the polar coordinate system to the Cartesian coordinate system, and convert the measurement error into a representation in the Cartesian system;

[0026] S302. According to the target distance after compensation in S103, the Jacobian matrix of the target position relative to the measurement error in the Cartesian coordinate system is calculated, and the covariance matrix of the target point is calculated.

[0027] Furthermore, the specific method of S400 includes:

[0028] S401. Using a preset method, obtain a relative standard deviation descriptor for each radar target point;

[0029] S402. Using the K nearest neighbor algorithm, obtain the corresponding relationship between the current radar point cloud and the key frame radar point cloud;

[0030] 403. Using a random sampling consistency algorithm, remove the incorrect matching relationship in S402 through random sampling and continuous iteration;

[0031] S404. Use the maximum likelihood estimation algorithm to calculate the attitude transformation relationship between the current radar coordinate system and the key frame, and use the global posture information of the key frame to obtain the scale positioning result of the radar at the current moment.

[0032] Further, in S401, a preset method is used to obtain a relative standard deviation descriptor of each radar target point:

[0033] Take radar target point o i is the center of the circle, and the different radii r are counted j The number of radar target points n on (j=1,2,…m) j (j=1,2,…m), write the statistical results in vector form (n1,n2,…,n m ) T , and normalize to get the target point o i The descriptor d i .

[0034] The present invention also discloses a millimeter wave radar scale positioning system with Doppler compensation, comprising: a radar point cloud Doppler distortion compensation calculation module, a dynamic target removal and point cloud enhancement module, a radar target point uncertainty estimation module and a radar scale positioning result calculation module; wherein:

[0035] The radar point cloud Doppler distortion compensation calculation module is used to perform Doppler distortion compensation on the millimeter wave radar point cloud, wherein the distortion compensation value is determined by the measurement speed of the millimeter wave radar target point and the radar parameters;

[0036] The dynamic target removal and point cloud enhancement module is used to remove dynamic targets from millimeter-wave radar target points using the RANSAC algorithm, and to increase the point cloud density by superimposing radar point clouds at adjacent moments; the mean shift algorithm is used to aggregate radar point clouds after overlapping frames to reduce the impact of millimeter-wave radar measurement errors;

[0037] The uncertainty estimation module of radar target points is used to estimate the uncertainty distribution of millimeter-wave radar point cloud in Cartesian coordinate system according to the measurement errors of distance, speed and angle of radar targets in polar coordinate system;

[0038] The radar scale positioning result calculation module is used to associate radar data with the feature point matching algorithm based on the RSD descriptor according to the preprocessed point cloud and uncertainty estimation of the target point obtained by the radar point cloud Doppler distortion compensation calculation module, the dynamic target removal and point cloud enhancement module and the radar target point uncertainty estimation module, and calculate the posture transformation relationship of the current radar coordinate system relative to the key frame according to the maximum likelihood estimation algorithm based on the association result, so as to further obtain the scale positioning result of the radar at the current moment.

[0039] The present invention also discloses an electronic device, comprising:

[0040] a memory for storing instructions executable by a processor;

[0041] A processor is configured to execute the instructions to implement the millimeter wave radar scale positioning method with Doppler compensation.

[0042] The beneficial effects of the above technical solution provided by the embodiment of the present invention include at least:

[0043] The present invention compensates for the distance offset caused by the Doppler effect and reduces the mismatch phenomenon caused by inconsistency in the subsequent point cloud registration process. Experiments have shown that this method effectively improves the success rate of millimeter wave radar point cloud registration. In addition, the present invention proposes a millimeter wave radar target point uncertainty estimation method with Doppler compensation, which takes into account the target point uncertainty distribution after adding Doppler compensation. The uncertainty estimation result can give each target point a corresponding weight in the subsequent maximum likelihood estimation, thereby reducing the impact of the measurement value with large error.

[0044] The technical solution of the present invention is further described in detail below through the accompanying drawings and embodiments. BRIEF DESCRIPTION OF THE DRAWINGS

[0045] The accompanying drawings are used to provide a further understanding of the present invention and constitute a part of the specification. Together with the embodiments of the present invention, they are used to explain the present invention and do not constitute a limitation of the present invention. In the accompanying drawings:

[0046] Figure 1 This is a flow chart of a millimeter wave radar scale positioning method with Doppler compensation in embodiment 1 of the present invention;

[0047] Figure 2 This is a diagram showing the radar point cloud Doppler compensation and frame stacking effect in Example 1 of the present invention;

[0048] Figure 3 This is a performance comparison chart of the embodiment of the present invention and other millimeter wave radar scale positioning algorithms in embodiment 1 of the present invention. DETAILED DESCRIPTION

[0049] The exemplary embodiments of the present disclosure will be described in more detail below with reference to the accompanying drawings. Although the exemplary embodiments of the present disclosure are shown in the accompanying drawings, it should be understood that the present disclosure can be implemented in various forms and should not be limited by the embodiments set forth herein. On the contrary, these embodiments are provided to enable a more thorough understanding of the present disclosure and to fully convey the scope of the present disclosure to those skilled in the art.

[0050] In order to solve the problems existing in the prior art, an embodiment of the present invention provides a millimeter wave radar scale positioning method and system with Doppler compensation.

[0051] Example 1

[0052] A millimeter wave radar scale positioning method with Doppler compensation, such as Figure 1 ,include:

[0053] S100. Performing Doppler distortion compensation on the millimeter wave radar point cloud, wherein the distortion compensation value is determined by the measurement speed of the millimeter wave radar target point and the radar parameters;

[0054] Specifically, the millimeter wave radar of the present invention adopts FMCW millimeter wave radar. Millimeter wave radar is a radar that works in the millimeter wave band for detection. The working frequency band of the vehicle-mounted millimeter wave radar is 77GHz-81GHz, and the wavelength is about 4mm. It is between microwave and centimeter wave, and has some advantages of microwave radar and photoelectric radar. The basic working principle of millimeter wave radar is to use high-frequency circuit to generate electromagnetic waves of specific modulation frequency (FMCW), and send electromagnetic waves through antenna and receive electromagnetic waves reflected from the target. It can measure the distance, speed and azimuth of multiple targets at the same time; speed measurement is based on the Doppler effect. By calculating the frequency change of the radar wave returned to the receiving antenna, the target's movement speed relative to the radar and the flight time can be obtained to obtain the distance of the target object. The azimuth measurement (including horizontal angle and vertical angle) is to calculate the azimuth of the target by the phase difference of the radar wave reflected by the same target received by the antenna array.

[0055] In this embodiment, the specific method of S100 includes:

[0056] S101. According to the signal transmission frequency f of the millimeter wave radar c And the slope K of each linear frequency modulation signal, calculate the Doppler coefficient β of the millimeter wave radar, where,

[0057] S102. Calculate the corresponding Doppler compensation value r according to the radar target speed measurement value v and the Doppler coefficient β obtained in S101 d =βv, where v is the radial velocity of the radar target;

[0058] S103. Restore the original laser radar target point measurement value according to the Doppler compensation value calculated in S102 in is the target distance measurement with Doppler distortion, and r is the restored radar target distance.

[0059] Specifically, the measured values ​​of the target distance r and speed v of the FMCW millimeter wave radar are expressed as:

[0060]

[0061] Among them, f b To measure the frequency of the intermediate signal, f v represents the frequency of change of the phase measured at the target point, λ represents the signal wavelength, c is the speed of light propagation, T c represents the interval time between two chirp signals, K represents the slope of the chirp signal (B is the chirp signal bandwidth, T r is the duration of the chirp signal).

[0062] When the millimeter-wave radar is interfered by the Doppler effect during the measurement process, the intermediate frequency of the radar will be b A Doppler frequency is superimposed on The distance measurement now becomes:

[0063]

[0064] In order to eliminate the influence of Doppler effect, the original distance measurement value needs to be Compensate for the Doppler shift caused by the Doppler effect d , the radar ranging result after compensation is expressed as It is worth noting that the velocity measurement value of the radar is obtained by the phase change of the intermediate frequency, so it is not affected by the Doppler effect. The Doppler shift can be completely eliminated by using the above method in theory. By using the above compensation method for all radar target points, we further obtain the radar point cloud P with Doppler compensation:

[0065] P = {p i |i=1,2,…N}

[0066]

[0067] Among them, θ i ,φ i are the horizontal angle and pitch angle measurement values ​​of the i-th target point, respectively, and N is the total number of target points in the point cloud.

[0068] S200. Use the RANSAC algorithm to remove dynamic targets from millimeter-wave radar target points, and increase the point cloud density by superimposing radar point clouds at adjacent moments; use the mean shift algorithm to aggregate the radar point clouds after overlapping frames to reduce the impact of millimeter-wave radar measurement errors;

[0069] In this embodiment, in S200, the specific method of using the RANSAC algorithm to remove dynamic targets from millimeter wave radar target points includes: obtaining the radial velocity v of the radar target r , the angle of the target θ, the speed of the car v s And the driving angle α, when the radial velocity v of the target point r Satisfy the formula v r =-v s cos(α-θ), the current target point is marked as a stationary radar target, which does not conform to the formula v r =-v s The points with cos(α-θ) are regarded as dynamic radar targets and removed. Through the random sampling consistency algorithm, we can get v s , a rough estimate of α, and outliers are considered as moving objects and noise and removed.

[0070] To address the problem of sparse millimeter-wave radar point clouds and large measurement errors, we adopted the method of superimposing point clouds at adjacent K times to provide more information for the current radar frame. Specifically, assuming that the current time is t, the point cloud at time t after superimposing the radar point cloud is It is expressed as:

[0071]

[0072]

[0073] Among them, P t-i (i=1,2,…K) represents the measurement point cloud at time iK, Represents the coordinate transformation matrix of the radar at time ti relative to time t, represents the rotation matrix, Represents the translation vector.

[0074] We then overlay the point cloud The mean shift algorithm is used to further reduce the radar measurement error. Figure 2 The effect of radar point cloud enhancement is shown. It is not difficult to see from the figure that the density of radar point cloud after stacking frames is significantly increased. When the radar moves relative to the target point, the Doppler effect will reduce the actual measurement distance, and vice versa. The method provided by the present invention can effectively deal with Doppler shift and low resolution and measurement error of radar.

[0075] S300. Estimate the uncertainty distribution of the millimeter wave radar point cloud in the Cartesian coordinate system according to the measurement errors of the distance, speed and angle of the radar target in the polar coordinate system;

[0076] The specific method of implementing S300 includes:

[0077] S301. Convert the target position in the polar coordinate system to the Cartesian coordinate system, and convert the measurement error into a representation in the Cartesian system;

[0078] S302. According to the target distance after compensation in S103, the Jacobian matrix of the target position relative to the measurement error in the Cartesian coordinate system is calculated, and the covariance matrix of the target point is calculated.

[0079] Specifically, the measurement errors of the distance r, velocity v and angle θ, φ of the target point in the polar coordinate system are expressed as vector form n m =[n r ,n v ,n θ ,n φ ] T ,set up where Σ m is the covariance of the measured value. At this time, the coordinates of the target point in the Cartesian coordinate system can be written as:

[0080] p=f(r,v,θ,φ,n m )≈f(r,v,θ,φ)+Jn m

[0081] Where J is the Jacobian matrix of the transformed target point with respect to the error term:

[0082]

[0083] in, Defined as the Doppler coefficient, represents the distance measurement value after compensation. Then the uncertainty distribution of the target point with Doppler compensation in the Cartesian coordinate system is written as:

[0084] Σ c =E[(pf(r,v,θ,φ))(pf(r,v,θ,φ)) T ]≈JΣ m J T

[0085] The uncertainty of the point cloud obtained by this method shows that the target points farther away from the radar have greater uncertainty, which is in line with our previous expectations. In the subsequent point cloud registration process, the system will give higher weights to points with smaller uncertainty, thereby reducing the impact of low-quality measurement points on the positioning results.

[0086] S400. According to the preprocessed point cloud obtained in steps S100-S300 and the uncertainty estimate of the target point, the radar data is associated with a feature point matching algorithm based on the RSD descriptor, and the maximum likelihood estimation algorithm is used to calculate the pose transformation relationship of the current radar coordinate system relative to the key frame according to the association result, and further obtain the scale positioning result of the radar at the current moment.

[0087] The specific method of S400 in this embodiment includes:

[0088] S401. Using a preset method, obtain a relative standard deviation descriptor for each radar target point;

[0089] S402. Using the K nearest neighbor algorithm, obtain the corresponding relationship between the current radar point cloud and the key frame radar point cloud;

[0090] 403. Using a random sampling consistency algorithm, remove the incorrect matching relationship in S402 through random sampling and continuous iteration;

[0091] S404. Use the maximum likelihood estimation algorithm to calculate the attitude transformation relationship between the current radar coordinate system and the key frame, and use the global posture information of the key frame to obtain the scale positioning result of the radar at the current moment.

[0092] Specifically, in S401, a preset method is used to obtain a relative standard deviation descriptor of each radar target point:

[0093] Take radar target point o i is the center of the circle, and the different radii r are counted j The number of radar target points n on (j=1,2,…m) j (j=1,2,…m), write the statistical results in vector form (n1,n2,…,n m ) T , and normalize to get the target point o i The descriptor d i .

[0094] Specifically, this embodiment uses a point cloud registration algorithm based on a feature point method to calculate the relative position and posture of the radar when collecting two frames of point clouds. First, we calculate the RSD (relative standard deviation) descriptor of each radar target point.

[0095] Figure 3The comparison diagram of the effect of point cloud association before and after Doppler compensation is shown, where the green dot represents the radar target point that is currently matched successfully, the red dot represents the key frame radar target point that is matched successfully, the white line between the red dot and the green dot represents the corresponding relationship, and the white dot represents the current radar target point for which no effective match is found. It is not difficult to see from the figure that the Doppler compensation algorithm proposed in the present invention can effectively improve the success rate of radar target point matching.

[0096] Finally, the present invention uses the maximum likelihood estimation method to obtain the relative posture transformation matrix of the current radar with respect to the key frame

[0097]

[0098]

[0099] where y i ∈P k ,x i ∈P b is the current radar point cloud P obtained by using the K-nearest neighbor algorithm b And the keyframe radar point cloud P k The present invention adopts the Levenberg-Marquardt algorithm to solve the optimization problem, and adopts the Cauchy robust kernel function to further reduce the influence of mismatching and large measurement error points.

[0100] The pose of the keyframe relative to the world coordinate system and the Finally, this method can obtain the scale positioning result of the radar in the world coordinate system at the current moment.

[0101] Figure 3 The positioning results of this method and other millimeter-wave radar scale positioning algorithms are shown, and the data used for comparison are the mean translation and rotation errors of millimeter-wave radar scale positioning. Among them, the MC-RANSAC algorithm is the current optimal method. It can be seen that with the increase of the current radar's own speed and the difference between the radar speed when the key frame is collected, the scale positioning error of the method used for comparison is also increasing, which shows that the Doppler effect will significantly affect the radar scale positioning accuracy under high-speed motion. Compared with these methods, the method proposed in the present invention achieves the lowest average translation error and a rotation error close to the current optimal method. This result verifies the effectiveness of the algorithm proposed in the present invention.

[0102] Example 2

[0103] This embodiment discloses a millimeter wave radar scale positioning system with Doppler compensation, including: a radar point cloud Doppler distortion compensation calculation module, a dynamic target removal and point cloud enhancement module, a radar target point uncertainty estimation module and a radar scale positioning result calculation module; wherein:

[0104] The radar point cloud Doppler distortion compensation calculation module is used to perform Doppler distortion compensation on the millimeter wave radar point cloud, wherein the distortion compensation value is determined by the measurement speed of the millimeter wave radar target point and the radar parameters;

[0105] The dynamic target removal and point cloud enhancement module is used to remove dynamic targets from millimeter-wave radar target points using the RANSAC algorithm, and to increase the point cloud density by superimposing radar point clouds at adjacent moments; the mean shift algorithm is used to aggregate radar point clouds after overlapping frames to reduce the impact of millimeter-wave radar measurement errors;

[0106] The uncertainty estimation module of radar target points is used to estimate the uncertainty distribution of millimeter-wave radar point cloud in Cartesian coordinate system according to the measurement errors of distance, speed and angle of radar targets in polar coordinate system;

[0107] The radar scale positioning result calculation module is used to associate radar data with the feature point matching algorithm based on the RSD descriptor according to the preprocessed point cloud and uncertainty estimation of the target point obtained by the radar point cloud Doppler distortion compensation calculation module, the dynamic target removal and point cloud enhancement module and the radar target point uncertainty estimation module, and calculate the posture transformation relationship of the current radar coordinate system relative to the key frame according to the maximum likelihood estimation algorithm based on the association result, so as to further obtain the scale positioning result of the radar at the current moment.

[0108] In this embodiment, the specific working methods of the radar point cloud Doppler distortion compensation calculation module, the dynamic target removal and point cloud enhancement module, the radar target point uncertainty estimation module and the radar scale positioning result calculation module have been described in detail in Example 1, so this embodiment will not be repeated here.

[0109] Example 3

[0110] This embodiment discloses an electronic device, including:

[0111] a memory for storing instructions executable by a processor;

[0112] The processor is configured to execute the instructions to implement a millimeter wave radar scale positioning method with Doppler compensation as described in Example 1.

[0113] It should be understood that the specific order or hierarchy of steps in the disclosed process is an example of an exemplary method. Based on design preferences, it should be understood that the specific order or hierarchy of steps in the process can be rearranged without departing from the scope of protection of the present disclosure. The attached method claims present the elements of the various steps in an exemplary order and are not intended to be limited to the specific order or hierarchy described.

[0114] In the above detailed description, various features are grouped together in a single embodiment to simplify the disclosure. This method of disclosure should not be interpreted as reflecting an intention that the embodiments of the claimed subject matter require more features than are clearly stated in each claim. On the contrary, as reflected in the appended claims, the invention is in a state of having less than all the features of the disclosed individual embodiments. Therefore, the appended claims are hereby expressly incorporated into the detailed description, with each claim standing on its own as a separate preferred embodiment of the invention.

[0115] Those skilled in the art will also appreciate that the various illustrative logic blocks, modules, circuits, and algorithmic steps described in conjunction with the embodiments herein can all be implemented as electronic hardware, computer software, or a combination thereof. In order to clearly illustrate the interchangeability between hardware and software, various illustrative components, blocks, modules, circuits, and steps are generally described above around their functions. Whether such functions are implemented as hardware or software depends on specific applications and the design constraints imposed on the entire system. A skilled person can implement the described functions in an alternative manner for each specific application, but such implementation decisions should not be interpreted as departing from the scope of protection of the present disclosure.

[0116] The steps of the method or algorithm described in conjunction with the embodiments herein may be directly embodied as hardware, a software module executed by a processor, or a combination thereof. The software module may be located in a RAM memory, a flash memory, a ROM memory, an EPROM memory, an EEPROM memory, a register, a hard disk, a mobile disk, a CD-ROM, or any other form of storage medium well known in the art. An exemplary storage medium is connected to the processor so that the processor can read information from the storage medium and can write information to the storage medium. Of course, the storage medium may also be an integral part of the processor. The processor and the storage medium may be located in an ASIC. The ASIC may be located in a user terminal. Of course, the processor and the storage medium may also be present in a user terminal as discrete components.

[0117] For software implementation, the techniques described in this application can be implemented with modules (e.g., procedures, functions, etc.) that perform the functions described in this application. These software codes can be stored in a memory unit and executed by a processor. The memory unit can be implemented within the processor or outside the processor. In the latter case, it is coupled to the processor in a communication manner via various means, which are well known in the art.

[0118] The above description includes examples of one or more embodiments. Of course, it is impossible to describe all possible combinations of components or methods for the purpose of describing the above embodiments, but it should be recognized by those skilled in the art that the various embodiments may be further combined and arranged. Therefore, the embodiments described herein are intended to cover all such changes, modifications and variations that fall within the scope of protection of the appended claims. In addition, with respect to the term "comprising" used in the specification or claims, the word is covered in a manner similar to the term "including", just as "including," is explained as a transitional word in the claims. In addition, any term "or" used in the specification of the claims is intended to mean "non-exclusive or".

Claims

1. A millimeter wave radar scale positioning method with Doppler compensation, characterized in that: include: S100. Performing Doppler distortion compensation on the millimeter wave radar point cloud, wherein the distortion compensation value is determined by the measurement speed of the millimeter wave radar target point and the radar parameters; S200. Use the RANSAC algorithm to remove dynamic targets from millimeter-wave radar target points, and increase the point cloud density by superimposing radar point clouds at adjacent moments; use the mean shift algorithm to aggregate the radar point cloud after stacking frames to reduce the impact of millimeter-wave radar measurement errors; In S200, the method of increasing the point cloud density by superimposing radar point clouds at adjacent moments includes: assuming that the current moment is t, then the point cloud at time t after superimposing the radar point cloud It is expressed as: ; ; in express The measured point cloud at the time, , express The radar at that moment is relative to The coordinate transformation matrix at time, represents the rotation matrix, represents the translation vector; S300. Estimate the uncertainty distribution of the millimeter wave radar point cloud in the Cartesian coordinate system according to the measurement errors of the distance, speed and angle of the radar target in the polar coordinate system; S400. According to the preprocessed point cloud obtained in steps S100-S300 and the uncertainty estimate of the target point, the radar data is associated with a feature point matching algorithm based on the RSD descriptor, and the maximum likelihood estimation algorithm is used to calculate the pose transformation relationship of the current radar coordinate system relative to the key frame according to the association result, and further obtain the scale positioning result of the radar at the current moment.

2. A millimeter wave radar scalar positioning method with Doppler compensation as claimed in claim 1, characterized in that: The specific methods of S100 include: S101. According to the signal transmission frequency of millimeter wave radar and the slope of each linear FM signal K , calculate the Doppler coefficient of millimeter wave radar β ,in, ; S102. According to the radar target speed measurement value And the Doppler coefficient obtained in S101 β , calculate the corresponding Doppler compensation value ,in is the radial measured velocity of the radar target; S103. Restore the original laser radar target point measurement value according to the Doppler compensation value calculated in S102 ;in is the target distance measurement with Doppler distortion, is the restored radar target distance.

3. A millimeter wave radar scale positioning method with Doppler compensation as claimed in claim 2, characterized in that: The slope of each linear frequency modulation signal of the millimeter wave radar K The calculation formula is: ; Wherein, B and T are the bandwidth and duration of the linear frequency modulation signal respectively.

4. A millimeter wave radar scalar positioning method with Doppler compensation as claimed in claim 1, characterized in that: In S200, the specific method of using the RANSAC algorithm to remove dynamic targets from millimeter-wave radar target points includes: obtaining the radial velocity of the radar target , the angle of the target , the speed of the car And the driving angle , when the radial velocity of the target point Satisfy the formula When the current target point is marked as a stationary radar target, it will not conform to the formula The points are regarded as dynamic radar targets and removed.

5. A millimeter wave radar scalar positioning method with Doppler compensation as claimed in claim 1, characterized in that: The specific methods of S300 include: S301. Convert the target position in the polar coordinate system to the Cartesian coordinate system, and convert the measurement error into a representation in the Cartesian system; S302. According to the target distance after compensation in S103, the Jacobian matrix of the target position relative to the measurement error in the Cartesian coordinate system is calculated, and the covariance matrix of the target point is calculated.

6. A millimeter wave radar scalar positioning method with Doppler compensation as claimed in claim 1, characterized in that: The specific methods of S400 include: S401. Using a preset method, obtain a relative standard deviation descriptor for each radar target point; S402. Using the K nearest neighbor algorithm, obtain the corresponding relationship between the current radar point cloud and the key frame radar point cloud; S403. Use random sampling consistency algorithm to remove the wrong matching relationship in S402 through random sampling and continuous iteration; S404. Use the maximum likelihood estimation algorithm to calculate the attitude transformation relationship between the current radar coordinate system and the key frame, and use the global posture information of the key frame to obtain the scale positioning result of the radar at the current moment.

7. A millimeter wave radar scalar positioning method with Doppler compensation as claimed in claim 6, characterized in that: In S401, a preset method is used to obtain a relative standard deviation descriptor of each radar target point: Radar target point is the center of the circle, and different radii are counted Number of radar target points on , write the statistical results into vector form , and normalize to get the target point Descriptor .

8. A millimeter wave radar scale positioning system with Doppler compensation, characterized in that: include: Radar point cloud Doppler distortion compensation calculation module, dynamic target removal and point cloud enhancement module, radar target point uncertainty estimation module and radar scale positioning result calculation module; Among them: The radar point cloud Doppler distortion compensation calculation module is used to perform Doppler distortion compensation on the millimeter wave radar point cloud, wherein the distortion compensation value is determined by the measurement speed of the millimeter wave radar target point and the radar parameters; The dynamic target removal and point cloud enhancement module is used to remove dynamic targets from millimeter-wave radar target points using the RANSAC algorithm, and to increase the point cloud density by superimposing radar point clouds at adjacent times; the mean shift algorithm is used to aggregate the radar point cloud after the frame overlap to reduce the influence of the millimeter-wave radar measurement error; the method of increasing the point cloud density by superimposing radar point clouds at adjacent times includes: assuming that the current time is t, then the point cloud at time t after superimposing the radar point cloud It is expressed as: ; ; in, express The measured point cloud at the time, , express The radar at that moment is relative to The coordinate transformation matrix at time, represents the rotation matrix, represents the translation vector; The uncertainty estimation module of radar target points is used to estimate the uncertainty distribution of millimeter-wave radar point cloud in Cartesian coordinate system according to the measurement errors of distance, speed and angle of radar targets in polar coordinate system; The radar scale positioning result calculation module is used to associate radar data with the feature point matching algorithm based on the RSD descriptor according to the preprocessed point cloud and uncertainty estimation of the target point obtained by the radar point cloud Doppler distortion compensation calculation module, the dynamic target removal and point cloud enhancement module and the radar target point uncertainty estimation module, and calculate the posture transformation relationship of the current radar coordinate system relative to the key frame according to the maximum likelihood estimation algorithm based on the association result, so as to further obtain the scale positioning result of the radar at the current moment.

9. An electronic device, characterized in that: include: a memory for storing instructions executable by a processor; A processor is configured to execute the instructions to implement the positioning method as described in any one of claims 1-7.

Citation Information

Cited By

  • Polar coordinate voxel division-based 4D millimeter wave radar point cloud registration method

    CN120070524A

  • Radar speed measurement method and radar system

    TWI932460B