Method and system for measuring the velocity of a carrier with respect to the ground

Abstract

A method for measuring, using a radar or sonar, the velocity with respect to the ground of a carrier moving parallel to the ground, includes the following steps: a) orienting the line of sight of the radar or sonar toward the ground; b) emitting a plurality of radar or sonar signals (P.sub.1-P.sub.N) that are directed toward the ground, and acquiring respective echo signals (E.sub.1-E.sub.N); c) processing the acquired echo signals so as to obtain, for one or more echo delay values, a corresponding Doppler spectrum; d) for the or at least one the echo delay value, determining a high cut-off frequency of the corresponding Doppler spectrum; and e) computing the velocity of the carrier with respect to the ground on the basis of the one or more high cut-off frequencies. A system allowing such a method to be implemented.

Claims

1. A method for measuring the velocity of a carrier vehicle with respect to the ground, the carrier vehicle moving parallel to the ground and being equipped with a radar or sonar having an emission and reception cone about a line of sight, the method comprising the following steps: (a) orienting the line of sight of the radar or sonar toward the ground, such that a footprint on the ground of said emission and reception cone is passed through by the projection onto the ground of the velocity vector of the carrier vehicle; (b) using the radar or sonar to emit a plurality of signals that are directed toward the ground, and to acquire respective echo signals at a plurality of echo delay time values; (c) processing the acquired echo signals so as to obtain, for one or more of the plurality of echo delay time values, a corresponding Doppler spectrum; (d) for said one or more echo delay time value, identifying an uppermost, in absolute value, frequency value of the corresponding Doppler spectrum; and (e) computing the velocity of the carrier vehicle with respect to the ground as a function of: its height with respect to the ground, said one or more uppermost frequencies and the corresponding echo delay time values.

2. The method as claimed in claim 1, wherein: step c) comprises processing the acquired echo signals so as to obtain a said Doppler spectrum for each of the plurality of echo delay time values; step d) comprises determining a plurality of said maximum frequencies for a plurality of said Doppler spectra; and step e) comprises computing the velocity of the carrier vehicle with respect to the ground as a function of its height with respect to the ground and of a plurality of said maximum frequencies.

3. The method as claimed in claim 2, wherein step e) also comprises computing an index of confidence in the velocity measurement as a function of a plurality of said maximum frequencies.

4. The method as claimed in claim 2, wherein step c) comprises constructing a delay-Doppler matrix and step d) comprises applying an edge-detection algorithm to said matrix.

5. The method as claimed in claim 1, wherein, in step d), said or each maximum frequency is determined by identifying a maximum of the derivative of the corresponding Doppler spectrum with respect to frequency.

6. The method as claimed in claim 1, wherein step e) comprises, for said one or more echo delay time value, designated T.sub.R, computing a velocity given by:
V.sub.r/s,R=(c.Math.f.sub.DR)/(2f.sub.em.Math.cos(α.sub.R)) where: c is the propagation speed of the signal emitted by the radar or sonar; f.sub.DR is the maximum frequency of the Doppler spectrum corresponding to the delay T.sub.R; f.sub.em is the frequency of the signal emitted by the radar or sonar; α.sub.R=sin.sup.−1(2h/c.Math.T.sub.R), h being the height of the carrier vehicle with respect to the ground; and wherein said velocity of the carrier vehicle with respect to the ground is determined depending on one or more of the velocities v.sub.r/s,R thus computed.

7. The method as claimed in claim 1, wherein the emission and reception cone has an aperture angle in a plane perpendicular to the ground and containing the line of sight comprised between 40° and 80°.

8. The method as claimed in claim 1, also comprising a step d′) comprising processing the acquired echo signals so as to determine a maximum and minimum value of the echo delay time values of said echo signals, and to deduce therefrom an estimation of the height h of the carrier vehicle with respect to the ground and of the angle made by the line of sight and the ground.

9. The method as claimed in claim 1, wherein, in step a), the beam is directed obliquely toward the ground.

10. A system for measuring the velocity of a carrier vehicle with respect to the ground by means of a method as claimed in claim 1, comprising: a radar or sonar having an emission and reception cone about a line of sight that is configured to be oriented toward the ground; and a device comprising at least one of a processor or a dedicated electronic circuit for processing echo signals acquired by said radar or sonar; wherein said device is configured to: process the acquired echo signals so as to obtain, for said one or more echo delay time values, the corresponding Doppler spectrum; for said or at least one said echo delay time value, determine the maximum, in absolute value, frequency value of the corresponding Doppler spectrum; and compute the velocity of the carrier vehicle with respect to the ground as a function of a datum indicative of its height with respect to the ground, of said one or more maximum frequencies and of corresponding delay time values.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

(1) Other features, details and advantages of the invention will become apparent on reading the description given with reference to the appended drawings, which are given by way of example and show, respectively:

(2) FIG. 1, a schematic showing the principle of a velocity measurement according to one embodiment of the invention;

(3) FIG. 2, a delay/Doppler (or, equivalently, range/Doppler) matrix obtained using a The method as claimed in one embodiment of the invention;

(4) FIG. 3A, one three-dimensional view and to two-dimensional views of a velocity measurement configuration according to the invention;

(5) FIG. 3B, one three-dimensional view and two two-dimensional views of a velocity measurement configuration according to the invention;

(6) FIG. 3C, one three-dimensional view and two two-dimensional views of a velocity measurement configuration according to the invention;

(7) FIG. 3D, a view of the same type as that in FIG. 3C, but in the case where the projection onto the ground of the direction of sight of the radar or sonar is not aligned with the velocity of the carrier;

(8) FIG. 4, graphs illustrating various data-processing operations allowing a velocity measurement to be extracted from a delay/Doppler matrix of the type illustrated in FIG. 2;

(9) FIG. 5, graphs illustrating various data-processing operations allowing a velocity measurement to be extracted from a delay/Doppler matrix of the type illustrated in FIG. 2;

(10) FIG. 6, graphs illustrating various data-processing operations allowing a velocity measurement to be extracted from a delay/Doppler matrix of the type illustrated in FIG. 2;

(11) FIG. 7, a flowchart of an algorithm allowing a velocity measurement to be extracted from a delay/Doppler matrix according to one embodiment of the invention; and

(12) FIG. 8, shows an illustration of the principle of the—optional—measurement of the height of the carrier and of the angle of sight of the radar or sonar.

DETAILED DESCRIPTION

(13) By carrier what is meant is any movable body capable of carrying a radar or sonar; it may for example be a land vehicle, a car for example, an aircraft or even a non-automotive object. The carrier may be moved with a horizontal translational movement and/or rotated about a vertical axis; this is for example the case with an electronic white stick, to which the user imparts a circularly arcuate movement. In the latter case, it is the velocity of the portion of the carrier on which the radar or sonar is mounted that is measured (the end of the white stick for example).

(14) Below, solely the case of a radar will be considered, but the generalization to a sonar should in principle cause no difficulty.

(15) The invention exploits measurements of time-of-flight and of Doppler shift to estimate both the distance from the ground and its velocity relative to the carrier. As illustrated in FIG. 1, a radar RAD fastened to a carrier PRT emits a succession of N>1 pulses P.sub.1-P.sub.N in the direction of the ground, and receives corresponding echoes E.sub.1-E.sub.N. Each echo is sampled in the time domain (M>1 samples) and, in general, the complex amplitude of each sample is quantified in order to allow digital processing to be carried out. The number N of pulses is generally comprised between 10 and 100, and may for example be N=32 or N=64. The choice of N is made depending on the intended application, and in particular depending on the expected variations in the velocity of the carrier and on the expected maximum distance of obstacles. The larger this distance, the longer the dwell time after emission of a pulse (and therefore the lower the emission rate) must be. Furthermore, the dwell time and the number of pulses emitted and echoes received influence the precision of estimation of the velocity of a carrier that does not move at a constant velocity. The number M of samples for each echo depends on the sought-after distance resolution; for example, for a maximum distance of 3 m, if it is desired to obtain a precision of 1 cm, M must be greater than or equal to 300 (M≥300).

(16) Thus, a matrix M.sub.T of N×M samples is obtained in the time domain; one dimension of the matrix corresponds to the “slow time”, which is sampled via the emission rate of the pulses P.sub.1-P.sub.N, whereas the other corresponds to the “fast time”, which is quantified at the sampling frequency of the echoes. A discrete Fourier transform DFT is then computed with respect to the slow-time dimension. This computation is typically carried out by means of a fast-Fourier-transform (FFT) algorithm. Thus, a second N×M matrix M.sub.DD, called the delay/Doppler matrix, is obtained. Its name comes from the fact that the dimension corresponding to the fast time represents the delay T in reception of an echo signal with respect to the corresponding emission time, which delay is related to the radar/ground distance D by the relationship D=cT/2, c being the speed of propagation of the signal (speed of light in the case of a radar, speed of sound in the case of a sonar) whereas the dimension along which the Fourier transform is computed corresponds to the Doppler shift, which conveys velocity information. As a variant, it is possible to consider a range/Doppler matrix.

(17) The case of a pulsed radar is the easiest to understand; however, a delay/Doppler matrix may also be obtained using other types of radar, for example frequency-modulated continuous-wave (FMCW) radars and radars using pulse compression. Such radars are also suitable for implementing the invention.

(18) An example of a matrix M.sub.DD is illustrated in FIG. 2, in which each shade of gray corresponds to a value of the power of the signal received in one delay/Doppler box. In fact, in FIG. 2, the horizontal axis represents the distance from the ground and not the delay, but this is of no importance because these two quantities are related to each other by a constant of proportionality.

(19) Digital processing of the matrix M.sub.DD allows not only the velocity v.sub.r/s of the radar/sonar with respect to the ground to be obtained, but also its height h and the angle α.sub.0 made by the ground (assumed to be flat) and the pointing direction of the radar. As a variant, the parameters h and α.sub.0 may be known, this allowing simplified processing operations to be used to determine v.sub.r/s.

(20) The digital processing operations are carried out by an electronic signal-processing device that may, for example, be or comprise a processor, for example a suitably programmed digital signal processor (DSP) and/or a dedicated circuit. The device has been represented by the reference DET in FIG. 1 and FIG. 3A. Typically, the device DET is located on-board the carrier, but it is also possible to transmit the radar or sonar measurements to a remote processing device.

(21) FIG. 3A, FIG. 3B and FIG. 3C illustrate the geometric configuration used to perform a measurement of velocity v.sub.r/s according to the invention. The radar RAD is located at a height h with respect to the ground SL, which is considered to be flat, and moves at a velocity v.sub.r/s parallel to the latter. A Cartesian coordinate system is defined, with its origin O located on the ground and plumb with the radar; the y-axis corresponds to the vertical axis, and therefore the ground coincides with the xOz plane, the velocity v.sub.s/r being oriented in the positive direction of the z-axis. The line of sight LV of the radar lies in the xOy plane and makes, with the ground (and therefore with the x-axis) an angle α.sub.0 that is different from 0° and from 90° and preferably comprised between 20° and 70°. The larger the maximum measuring distance, the smaller the angle α.sub.0 may be.

(22) The radar RAD emits pulses P.sub.i in an emission and reception cone CER that is centered on the line of sight AV and that has an aperture angle δ in the xOy plane (perpendicular to the ground) and δ′ in the zOx plane (perpendicular to the ground). The footprint EF on the ground of the beam therefore has an elliptical shape. The invention takes into account the fact that the aperture angle of the beam is not generally negligible—it may for example be comprised between 10° and 80° and preferably between 40° and 60°, or even between 40° and 80°. In fact, as will become clear below, having a non-negligible angular aperture in the xOy plane is an advantage. Furthermore, too large an aperture angle—for example δ and/or δ′>80°—is undesirable because the sidelobes of the radiation pattern would then disrupt the measurement.

(23) In the example of FIGS. 3A-3C, the footprint EF does not extend up to plumb with the radar (point O). In other words, the aperture half-angle in the xOy plane, δ/2, is smaller than α.sub.0. This is preferred, but not essential: if the point O is comprised in the footprint on the ground of the beam, the corresponding echo will have a zero Doppler shift and it will therefore be necessary to ignore it in the computation of the velocity (Equations 6 and 7 below take an indeterminate value “0/0” for such an echo). This results in additional complexity in the processing, as these problematic contributions must be excluded, and in a degradation in signal-to-noise ratio (because a fraction of the echo signal is not usable).

(24) At the very most, the angle of inclination α.sub.0 could be equal to 90°, the line of sight being perpendicular to the ground; however, for the reasons given above, the use of a beam directed obliquely toward the ground is clearly preferred.

(25) It may be seen that the various points in the footprint EF are located at different distances from the radar RAD, which is considered to be point-like; the extreme values taken by these distances are designated R.sub.min and R.sub.max. The locus of the points in the footprint EF at a given distance from the radar is a circular arc (shown in FIG. 3C). The components of the echo signals E.sub.i (i∈{1, 2, . . . , N}) emitted by points at different distances reach the radar at different times, this resulting in temporal spreading of the echoes.

(26) Likewise, the radial component v.sub.R of the velocity v.sub.r/s—and therefore the Doppler shift—is not the same for all the points in the footprint.

(27) Considering the xOy plane, it may be seen from FIG. 3B that the radial velocity v.sub.R at any point P.sub.R of the footprint is the projection of the velocity v.sub.s/r onto the radius R—of length comprised between R.sub.min and R.sub.max—connecting this point to the radar. If only points located on the x-axis are considered, it is found that
v.sub.R=v.sub.s/r cos(α.sub.R)  [Math. 3]
where

(28) $\begin{array}{cc}{\alpha }_R\in \left[{\alpha }_0-\frac{\delta }{2};{\alpha }_0+\frac{\delta }{2}\right]& \left[\mathrm{Math}.4\right]\end{array}$
is the angle made by the radius R and the x-axis. Furthermore

(29) $\begin{array}{cc}{\alpha }_R={\sin }^{-1}\left(\frac{h}{R}\right)={\sin }^{-1}\left(\frac{2h}{c.Math.T_R}\right)& \left[\mathrm{Math}.5\right]\end{array}$
where T.sub.R is the delay of echoes originating from a point at the distance R from the radar. It is therefore possible to plot a curve that, for points located on the x-axis, expresses the relationship between the Doppler frequency and the delay. This curve is illustrated in FIG. 4 and allows the spread of the spectrum of FIG. 2 in the “delay” direction to be understood.

(30) Considering the zOx plane, it may be seen from FIG. 3C that, for a given radial distance R, the velocity perceived at the point P.sub.B will be lower than the velocity perceived at the point P.sub.A: v.sub.B=v.sub.A cos(δ′/2). More generally, the radial velocity perceived at a point P.sub.Rθ located at the radial distance R from the radar and such that the line that connects it to the origin O makes with the x-axis an angle θ∈[−δ′/2; δ′/2] is equal to v.sub.Rθ=v.sub.A cos(θ). Thus, there are a plurality of Doppler frequencies measured for a given distance R, this being illustrated in FIG. 5—in which fd.sub.A and fd.sub.B are the Doppler frequencies of the points P.sub.A and P.sub.B—and explaining the spread of the spectrum of FIG. 2 in the “Doppler” direction.

(31) Up to now, the case where the projection onto the ground of the line of sight has the same direction as the velocity v.sub.r/s has been considered. However this is not essential; what counts is that the angle made by the projection onto the ground of the line of sight and the velocity v.sub.r/s (and therefore the x-axis) is smaller than δ′/2, such that the footprint EF on the ground is passed through by the projection onto the ground of v.sub.r/s. This is illustrated in FIG. 3D.

(32) The above considerations will have allowed the digital processing operations that must be implemented to determine the velocity v.sub.r/s from a delay/Doppler spectrum of the type illustrated in FIG. 2 to be understood.

(33) Firstly, it is necessary to extract the high cut-off frequency of the Doppler spectrum f.sub.dR, i.e. the maximum Doppler frequency (or maximum frequency in absolute value, because the radar beam may also be directed in the opposite direction to the velocity vector), corresponding to one or more distance values R (or, equivalently, to one or more delay values T.sub.R=2R/c); this allows contributions to the echo signals that originate from points in the footprint EF on the ground that lie solely on the x-axis to be isolated. To do this, it is possible to plot the amplitude S(R) of the echo signal received with a delay T.sub.R as a function of Doppler frequency f.sub.d and to place the cut-off at an inflection point that maximizes the derivative dS/df.sub.d. As a variant, any edge-detecting algorithm may be applied; specifically, determining the high cut-off frequency of the Doppler spectrum for all the values of T.sub.R corresponds to finding the top portion of the edge of the high intensity “spot” of the delay/Doppler spectrum of FIG. 2.

(34) If the cut-off frequency thus determined is called f.sub.DR, the velocity of the carrier measured for the delay T.sub.R corresponding to the distance R is given by:

(35) $\begin{array}{cc}{v}_{r/s,R}=\frac{c.Math.f_{dR}}{2f_{em}.Math.\cos \left({\alpha }_R\right)}& \left[\mathrm{Math}.6\right]\end{array}$
where f.sub.em is the emission frequency of the radar pulses. Taking (2) into account, Equation (3) may also be written

(36) $\begin{array}{cc}{v}_{r/s,R}=\frac{c.Math.f_{dR}}{2f_{em}.Math.\sqrt{1-{\left(\frac{h}{R}\right)}^2}}& \left[\mathrm{Math}.7\right]\end{array}$

(37) Ideally, Equation (3) or (3′) should deliver the same result for the velocity v.sub.r/s whatever the chosen distance value R. In practice, this is not the case because of the many perturbations that affect the echo signals (for example, obstacles present on the ground, different ground reflectivity levels or simply electronic noise). Therefore, it is advantageous to compute v.sub.r/s,R for a plurality of different values of R and to make use thereof to compute a final estimation of the velocity v.sub.r/s, for example by taking an average or weighted average of the obtained results. It is also possible to compute an index of the quality of the estimation of the velocity—it may for example be a question of the standard deviation σ.sub.V of the sequence of estimations corresponding to the various values of R. It is for this reason that having an emission and reception cone with a non-negligible angular aperture in the xOy plane is an advantage. In contrast, the angular aperture in the zOx plane must preferably be minimized as far as is possible given the constraints of the hardware used (typically the size of the radar antenna).

(38) FIG. 7 illustrates a velocity-measuring algorithm implementing the principles described above. After the echo signals have been acquired and processed to obtain a delay/Doppler matrix (A), N angular values α.sub.R are defined to sample the range [α.sub.0−δ′/2; α.sub.0+δ′/2] and the corresponding distances R=(h/sin(α.sub.R)) are computed (C). For each distance value, the high cut-off frequency f.sub.DR of the corresponding Doppler spectrum is computed by seeking the maximum of the derivative dS/df.sub.d (D), then Equation (3) or (3′) is used to compute v.sub.s/r,R (E). These operations are repeated for all the angular values α.sub.R. Lastly, the velocity v.sub.s/r of the carrier and the index of the quality of the estimation are computed (F) and (G) depending (functions g(⋅) and q(⋅)) on the values v.sub.s/r,R.

(39) Application of Equation (3) or (3′) presupposes that the height h of the carrier is known, which is not necessarily the case. However, if necessary, this information may be deduced from the delay/Doppler spectrum, as illustrated in FIG. 8.

(40) The minimum distance R.sub.min and the maximum distance R.sub.max both depend on the height h, which is assumed to be unknown, and on the angle α.sub.0, which is also generally unknown:

(41) $\begin{array}{cc}\{\begin{array}{c}{R}_{\min }=\frac{h}{\sin \left({\alpha }_0+\frac{\delta }{2}\right)}\\ R_{\max }=\frac{h}{\sin \left({\alpha }_0-\frac{\delta }{2}\right)}\end{array}\hspace{1em}& \left[\mathrm{Math}.8\right]\end{array}$

(42) If R.sub.min and R.sub.max are known, h and α.sub.0 may be found by solving the system (4). Now, R.sub.min and R.sub.max are associated with the shortest and longest delay for which the echo signal is “significant” (substantially higher than the noise level), respectively. These two values may be found via a thresholding method: firstly the quantity E(R), which corresponds to the total energy received for a given distance and for positive Doppler frequencies, E.sub.s(R)={∥S(R)∥.sup.2, d≥0}, is found. This quantity is compared to a threshold in order to determine the distance interval [R.sub.min, R.sub.max] in which the received energy is significant. It is also possible to use other methods, edge detection for example.