The present application relates to the technical field of automotive electronics, in particular to a method for estimating an ambiguous velocity of a target.
It is very important for automotive sensors to accurately estimate the position and velocity of a target while detecting the target. Some key functions of automotive radar, such as adaptive cruise control (ACC) and automatic emergency braking (AEB), depend entirely on the accuracy of velocity estimation. In order to determine whether a fast moving target may have an impact on the driving safety of a vehicle, it is especially important to accurately estimate the velocity thereof, which determines whether an alarm message may be sent in a timely and accurate manner, and thus a driver or a driverless vehicle may make appropriate judgments. In the design of the automotive radar, there are three parameters that have strong correlation with velocity: the maximum sensing range, the range resolution and the maximum sensing velocity. However, due to the waveform design of the radar, they are in a mutually constrained relationship, so it is not possible to optimize all three parameters simultaneously, but only to find a balance among the three parameters.
A method for estimating an ambiguous velocity is provided in “METHOD AND DEVICE FOR DETERMINING SPACING AND RADIAL VELOCITY OF OBJECT BY USING RADAR SIGNALS-CN104246534B” and “FAST LINEAR FMCW RADAR-CN105103003B” by using frequency modulated continuous wave (FMCW) of a carrier frequency shift. In the above-mentioned documents, the amount of the carrier frequency shift is constrained due to the phenomenon of phase convolutions, and accordingly, the range of the maximum sensing velocity is also limited.
In order to overcome the problem about estimation of a velocity and a range of an ambiguous region in the prior art, the present application provides a method for estimating an ambiguous velocity of a target.
A method for estimating an ambiguous velocity of a target is applied to a radar sensor, and includes:
Optionally, the first waveform signal and the second waveform signal have the same bandwidth, and the first center frequency is not equal to the second center frequency.
Optionally, the processing intermediate frequency signals of the first waveform signal and the second waveform signal to generate a first Range-Doppler matrix and a second Range-Doppler matrix respectively includes:
Optionally, after constant false early warning detection and parameter acquisition, the phase difference Δϕ between the first Range-Doppler matrix and the second Range-Doppler matrix is further calculated by the following formula:
Range-Doppler matrix is further calculated by the following formula:
denotes a sweep frequency period, and
and ϕ2=2πfDbTPRI (3) are enabled.
Optionally, the beat frequency of the second waveform signal is calculated by the following formula:
Optionally, phases of the first waveform signal and the second waveform signal have periodicity, and from formula (2), it is obtained that ϕ1 is proportional to R, thereby obtaining:
denotes a phase of ϕ1 convoluted into [−π, π], and M is an integer and calculated by the following formula:
denotes a phase of ϕ1 convoluted into [−π, π], and M is an integer and calculated by the following formula:
and
an actual phase difference Δϕ is a 2π period of the corresponding quantity of convolutions of an estimated phase difference ΔϕRDM, that is, Δϕ=ΔϕRDM+M·2π+m·2π, so the actual phase difference is calculated by the following formula:
where mi is an integer, with a range of [−mmax, . . . , −2, −1, 0, 1, 2, mmax]; and Ri and fDBi denote a range and a Doppler frequency shift corresponding to mi.
Optionally, the acquiring the quantity of phase convolutions based on a phase difference between the first Range-Doppler matrix and the second Range-Doppler matrix and a beat frequency of the second waveform signal further includes the following steps:
Optionally, the acquiring qi and fDBi based on the minimum ambiguous Doppler frequency difference includes:
Optionally, the obtaining a convolution estimated value qest of the quantity of convolutions based on a Doppler frequency shift difference includes:
Optionally, the obtaining the quantity q of convolutions based on qi and qest includes:
Optionally, the optimization iteration algorithm at least includes one of likelihood estimation, Bayesian estimation, and statistical entropy.
Optionally, the estimating a target velocity and a target range through the quantity of phase convolutions includes:
Compared with the prior art, the present application has the following beneficial effects: the first Range-Doppler matrix and the second Range-Doppler matrix in the present application have phase convolutions, and a plurality of possible range values and velocity values appear, resulting in ambiguity. According to the present application, the target range and the target velocity are estimated through joint estimation, and phase compensation caused by the ambiguous velocity is not needed. Moreover, the calculation of the ambiguous velocity is not limited by a frequency shift fAB in the prior art. Therefore, waveform design parameters are selected flexibly. Meanwhile, an aliased region and velocity estimation are further improved by using information from the Doppler frequency shift difference, which makes the estimation of the ambiguous velocity more reliable.
The present application will be further illustrated below in conjunction with the detailed description.
The same or similar numbers in the accompanying drawings of the embodiments of the present application correspond to the same or similar components. In the description of the present application, it should be understood that the terms “upper” “lower”, “left”, “right”, “top”, “bottom”, “inside”, “outside”, etc. indicate orientations or positional relationships based on the orientations or positional relationships shown in the accompanying drawings, and are merely for the convenience of describing the present application and simplifying the description, rather than indicating or implying that the referred devices or components must have a specific orientation, be constructed and operated in a specific orientation, so the terms describing the positional relationship in the accompanying drawings are for illustrative purposes merely and should not be construed as limitations on the patent.
In addition, the terms “first”, “second”, etc. are used for descriptive purposes merely, primarily to distinguish between different devices, components or parts (specific types and configurations may be the same or different), not to indicate or imply relative importance and number of the referred devices, components or parts, and thus they should not be construed as indicating or implying relative importance.
In the embodiments shown in
Step 100: Alternately transmit a first waveform signal and a second waveform signal at a first center frequency and a second center frequency respectively. In step 100, the first waveform signal and the second waveform signal have the same bandwidth, and the first center frequency is not equal to the second center frequency.
Step 200: Process intermediate frequency signals of the first waveform signal and the second waveform signal to generate a first Range-Doppler matrix and a second Range-Doppler matrix respectively. In step 200, the processing intermediate frequency signals of the first waveform signal and the second waveform signal to generate a first Range-Doppler matrix and a second Range-Doppler matrix respectively includes: after constructing data matrices for the intermediate frequency signals of the first waveform signal and the intermediate frequency signals of the second waveform signal respectively, obtain the first Range-Doppler matrix and the second Range-Doppler matrix by two-dimensional Fourier transform processing.
Step 300: After constant false early warning detection and parameter acquisition, acquire the quantity of phase convolutions based on a phase difference between the first Range-Doppler matrix and the second Range-Doppler matrix and a beat frequency of the second waveform signal. In step 300, the acquiring the quantity of phase convolutions based on a phase difference between the first Range-Doppler matrix and the second Range-Doppler matrix and a beat frequency of the second waveform signal includes the following steps: acquire a Doppler frequency shift fDBi and the quantity of convolutions qi corresponding to mi based on the minimum ambiguous Doppler frequency difference; obtain a convolution estimated value qest based on a Doppler frequency shift difference; and obtain the quantity q of phase convolutions based on qi and qest.
Step 400: Estimate a target velocity and a target range through the quantity of phase convolutions. In step 400, the estimating a target velocity and a target range through the quantity of phase convolutions includes: obtain an aliased Doppler frequency fDB,RD,i through formula 8, and obtain the target velocity through the aliased Doppler frequency fDB,RD,i; and calculate the target range through formula (4).
The first Range-Doppler matrix and the second Range-Doppler matrix in the present application have phase convolutions, and a plurality of possible velocity values appear, resulting in ambiguity. According to the present application, the target range and the target velocity are estimated through joint estimation, and phase compensation caused by the ambiguous velocity is not needed. Moreover, the calculation of the ambiguous velocity is not limited by an assumed frequency shift fa in the prior art. Therefore, waveform design parameters are selected flexibly. Meanwhile, an aliased region and velocity estimation are further improved by using information from the Doppler frequency shift difference, which makes the estimation of the ambiguous velocity more reliable.
In some embodiments, the first waveform signal and the second waveform signal have the same bandwidth, and the first center frequency is not equal to the second center frequency. In this embodiment, a series of chirped signals with the same bandwidth but different center frequencies are alternately emitted for a special waveform in the present application, that is, the first waveform signal A with a center frequency being the first center frequency fc,A and the second waveform signal B with a center frequency being the second center frequency fc,B are alternately emitted. Referring to
In some embodiments, the processing intermediate frequency signals of the first waveform signal and the second waveform signal to generate a first Range-Doppler matrix and a second Range-Doppler matrix respectively includes: after constructing the data matrices for the intermediate frequency signals of the first waveform signal and the intermediate frequency signals of the second waveform signal respectively, obtain the first Range-Doppler matrix and the second Range-Doppler matrix by two-dimensional Fourier transform processing, constant false early warning detection, and parameter acquisition. In this embodiment, referring to
In some embodiments, a phase difference Δϕ between the first Range-Doppler matrix and the second Range-Doppler matrix is calculated by the following formula:
denotes the sweep frequency period, and
and ϕ2=2πfDBTPRI (3) are enabled.
In the above embodiment, a phase of the first waveform signal A in the first Range-Doppler matrix is:
and a phase of the second waveform signal B in the second Range-Doppler matrix is:
Thus, the phase difference between the two RD matrices under the waveform A and B is:
are enabled.
In some embodiments, the beat frequency of the second waveform signal is calculated by the following formula:
where BW denotes the bandwidth, TPRI denotes the sweep frequency period, fDB denotes a Doppler frequency shift of the second waveform signal, that is,
and fc,B denotes a carrier frequency of the second waveform signal. Δϕ=ϕB−ϕA and fbeat,B may both be estimated through the first Range-Doppler matrix and the second Range-Doppler matrix in
In one implementation of the above embodiment, phases of the first waveform signal and the second waveform signal have periodicity, and from formula (2), it may be obtained that ϕ1 is proportional to R, thereby obtaining:
denotes a phase of ϕ1 convoluted into [−π, π], and M is an integer and calculated by the following formula:
An actual phase difference Δϕ is a 2π period of the corresponding quantity of convolutions of an estimated phase difference ΔϕRDM, that is, Δϕ=ΔϕRDM+M·2π+m·2π, thereby calculating the actual phase difference by the following formula:
where mi is an integer, with a range of [−mmax, . . . , −2, −1, 0, 1, 2,mmax]; and Ri and fDBi denote a range and a Doppler frequency shift corresponding to mi.
In some embodiments, the acquiring the quantity of phase convolutions based on a phase difference between the first Range-Doppler matrix and the second Range-Doppler matrix and a beat frequency of the second waveform signal includes the following steps:
When fDBi is greater than fD,max or smaller than −fD,max, qi is estimated by the following formula:
where sign(fDBi) determines qi as a positive number or a negative number, and round refers to rounding.
The aliased Doppler frequency fDB,RD,i is compared with an actual aliased Doppler frequency fDB,aliased, and when |fDB,RD,i−fDB,aliased| is the smallest, qi and fDBi are acquired. The actual aliased Doppler frequency fDB,aliased is obtained through the first Range-Doppler matrix and the second Range-Doppler matrix.
The convolution estimated velocity qest is obtained through the Doppler frequency shift difference. In one implementation of this embodiment, an estimated velocity is obtained based on a Doppler frequency difference between the first waveform signal and the second waveform signal by the following formula:
The convolution estimated value qest is estimated through the estimated velocity by the following formula:
The quantity q of phase convolutions is obtained based on qi and qest. In one implementation of this embodiment, velocities and ranges corresponding to qi and qest respectively are calculated based on qi, and qest, and optimization iteration is performed through likelihood estimation to acquire the quantity q of convolutions. In addition, the present application may also perform optimization by Bayesian estimation, statistical entropy, and other algorithms.
In one embodiment, the estimating a target velocity and a target range through the quantity of phase convolutions includes:
so a final velocity may be calculated. Meanwhile, the target range is calculated based on the beat frequency of the second waveform signal. That is, the final target range may be calculated by
In some embodiments, a series of chirped signals with the same bandwidth but different center frequencies are alternately emitted for a special waveform in the present application, that is, the first waveform signal A with a center frequency being the first center frequency fc,A and the second waveform signal B with a center frequency being the second center frequency fc,B are alternately emitted. Referring to
The phase of the first waveform signal A in the first Range-Doppler matrix is:
and the phase of the second waveform signal B in the second Range-Doppler matrix is:
Thus, the phase difference between the two RD matrices under the waveform A and B is:
and ϕ2=2πfDB TPRI (3) are enabled.
The Doppler frequency shift of the second waveform signal B is
and in addition, the beat frequency fbeat,B of the waveform B is
It may be seen that Δϕ=ϕ8−ϕA and fbeat,B may both be estimated from the first Range-Doppler matrix and the second Range-Doppler matrix in
The basic principle of the present application is to calculate the range R and the Doppler frequency fDB by combining (1) with (4).
The phase in formula (1) is used for velocity estimation, and there are two points to consider here. Firstly, it may be seen from (2) that ϕ1 has a linear relationship with R. Apparently, the greater R, the greater ϕ1. Because the patent solution has no constraint on the amplitude of the movement of the center frequencies of the waveforms A and B, the range of ϕ1 may even exceed [−π, π]. As the phases have the periodicity of 2π, ϕ1 may be expressed as follows:
Although RA and ϕ1 (R is unknown) in (4) are unknown, M may still be obtained by the following beat frequency (4):
Secondly, a phase ϕ2 associated with the Doppler frequency may also exceed [−π,π], so that the ambiguous Doppler frequency is
As may be seen from the above, depending on the target velocity, there may be a plurality of convolutions. The greater the velocity, the greater q.
Although the quantity q of phase convolutions caused by the target velocity is unknown, the correct phase, velocity, and range may be determined by likelihood estimation. In conclusion, the phase difference in equation (1) may be rewritten as:
The phase difference estimated based on the RD diagram obtained from the first waveform signal A and the second waveform signal B may also have a convolution of 2π:
The actual phase difference is a plurality of 2π periods of ΔϕRDM, that is,
The purpose of this algorithm is to simultaneously estimate the range and the ambiguous Doppler frequency shift fDB by the following two formulas:
The two formulas have three unknown numbers: mi, Ri, and fDBi·mi is an integer, with a range of [−mmax, . . . , −2, −1, 0, 1, 2, mmax]. With different mi, different Ri and fDBi may be obtained
In formula (7), for different mi different Ri and fDBi may be provided. Correct Ri and fDBi are obtained by an optimization iteration method according to the following three steps. The steps are as follows:
Step 1: The minimum ambiguous Doppler frequency difference
Assuming that qi is known, a corresponding aliased Doppler frequency fDB,RD,i of each fDBi may be calculated by the following formula:
Referring to
As qi may be either a positive integer or a negative integer, a sign thereof is determined by the Doppler frequency fDBi. All fDB,RD,i obtained by (8) are compared with the actual aliased Doppler frequency fDB,aliased obtained from the RD diagram, and the correct qi and fDBi enable |fDB,RD,i−fDB,aliased to be the smallest.
Step 2: Obtain the estimated value qest of q based on the Doppler frequency shift difference
Another reference parameter is the Doppler frequency shift difference on the RD diagram of the waveforms A and B. The Doppler frequency shift has the following relationship with the carrier frequency:
Assuming that the Doppler frequency is aliased (or ambiguous), in the same aliased region, the difference
between fDA and fDB may be simplified as:
Thus, based on vest, the aliased region may be estimated as:
Step 3: Optimization iteration
For qi and qest calculated from the above two criteria, estimated values thereof are not accurate in some practical scenarios, such as a low signal-to-noise ratio. Therefore, in order to further obtain a more accurate estimated value of q, optimization iteration needs to be performed by combining qi and qest, and the corresponding velocities and ranges obtained therefrom, that is, vi, vest, Ri, and Rest so that the accuracy of q is improved, which make an estimation result thereof more robust compared with the prior art. There are various optimize iteration methods, such as likelihood estimation.
The optimal q is firstly found by iterative optimization, and then the corresponding unambiguous Doppler frequency is found by (8), thereby obtaining v; and then R is obtained through (4).
In some embodiments, the calculation process of q may be described with reference to
Apparently, the above embodiments of the present application are merely examples of the present application for purposes of clarity and are not intended to limit the implementations of the present application. Changes or modifications in other different forms may also be made by a person of ordinary skill in the art on the basis of the above description. All implementations need not to be, and cannot be, exhaustive. Any modification, equivalent substitution, improvement, etc. made within the spirit and principles of the present application shall fall within the protection scope of the claims of the present application.
Number | Date | Country | Kind |
---|---|---|---|
202110627559.7 | Jun 2021 | CN | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/CN2021/102240 | 6/25/2021 | WO |