Determining object motion and acceleration vector in a vehicle radar system
11536830 · 2022-12-27
Assignee
Inventors
Cpc classification
G01S13/72
PHYSICS
International classification
G01S13/58
PHYSICS
G01S13/42
PHYSICS
Abstract
A vehicle radar system (3) which, for each one of a plurality of radar cycles, is arranged to, provide a measured azimuth angle (θ.sub.m) and radial velocity (v.sub.dm) for a first plurality of detections (9, 20). For each one of the plurality of radar cycles, the radar system (3) is arranged to select one of these detections for each one of two velocity components (v.sub.x, v.sub.y) in a set of components (v.sub.x, v.sub.y, a.sub.x, a.sub.y; a) to be determined; select one detection from a second plurality of detections (9, 20) for each one of at least one corresponding acceleration component (a.sub.x, a.sub.y; a); calculate the components (v.sub.x, v.sub.y, a.sub.x, a.sub.y; a) for the selected detections; determine a calculated radial velocity (v.sub.dc) for each one of at least a part of the other detections in the first plurality of detections (9, 20) using the calculated components (v.sub.x, v.sub.y, a.sub.x, a.sub.y; a); determine an error between each calculated and measured radial velocity (v.sub.dc, v.sub.dm); and determine the number of inliers. The set of components (v.sub.x, v.sub.y, a.sub.x, a.sub.y; a) that results in the largest number of inliers is then chosen.
Claims
1. A vehicle radar system, comprising: processing circuitry configured to: acquire, for each one of a plurality of radar cycles, a plurality of detections including a corresponding measured azimuth angle and a corresponding measured radial velocity for each detection thereof; for each cycle of the plurality of radar cycles: select one detection from a first plurality of detections of the corresponding cycle for each one of two velocity components comprised in a set of components to be determined for a target, where the two velocity components define a full velocity vector for a relative velocity of the target; select one detection from a second plurality of detections for each one of at least one corresponding acceleration component comprised in the set of components; calculate the set of components based on the selected detections; determine a calculated radial velocity for each one of at least a part of non-selected detections in the first plurality of detections based on the calculated set of components; determine an error between each calculated radial velocity and the measured radial velocity for each one of at least the part of non-selected detections; and determine a number of inliers for the corresponding cycle, where an inlier corresponds to a detection with the corresponding error that falls below an inlier threshold; and choose, as a determined set of components for the target, the set of components from the calculated sets of components of the plurality of radar cycles that corresponds to a largest number of inliers among the determined numbers of inliers of the plurality of radar cycles.
2. The vehicle radar system according to claim 1, wherein the processing circuitry is further configured to group detections that correspond to inliers resulting from the chosen set of components, the grouped detections being identified as belonging to the target that is an extended object.
3. The vehicle radar system according to claim 1, wherein the second plurality of detections is the same as the first plurality of detections.
4. The vehicle radar system according to claim 1, wherein the first plurality of detections and the second plurality of detections belong to different radar cycles, and the processing circuitry is configured to, for each cycle of the plurality of radar cycles: first calculate velocity components for the selected detections; and then calculate the at least one acceleration component based on the calculated velocity components for the selected detections.
5. The vehicle radar system according to claim 4, wherein the second plurality of detections belongs to a previous radar cycle prior to the corresponding radar cycle which the first plurality of detections belongs.
6. The vehicle radar system according to claim 1, wherein the processing circuitry is configured to calculate the set of components by solving an expression of
V.sub.dm=(V.sub.x+a.sub.xΔt)cos(θ.sub.m)+(V.sub.y+a.sub.yΔt)sin(θ.sub.m) for each selected detection, where θ.sub.m constitutes the measured azimuth angle between a radar system reference line and a direction towards the corresponding detection in question, V.sub.dm represents the measured radial velocity of the corresponding detection, V.sub.x represents an x-component of velocity of the set of components, V.sub.y represents a y-component of velocity of the set of components, a.sub.x represents an x-component of acceleration of the set of components, a.sub.y represents a y-component of acceleration of the set of components, and Δt represents a time difference of the selected detections.
7. The vehicle radar system according to claim 1, wherein the processing circuitry is configured to calculate the set of components by solving an expression of
8. The method according to claim 1, wherein the set of components is calculated by solving an expression of
9. A method for a vehicle radar system, comprising: acquiring, for each one of a plurality of radar cycles, a plurality of detections including a corresponding measured azimuth angle and a corresponding measured radial velocity for each detection thereof; for each cycle of the plurality of radar cycles: selecting one detection from a first plurality of detections of the corresponding cycle for each one of two velocity components comprised in a set of components to be determined for a target, where the two velocity components define a full velocity vector for a relative velocity of the target; selecting one detection from a second plurality of detections for each one of at least one corresponding acceleration component comprised in the set of components; calculating the set of components based on the selected detections; determining a calculated radial velocity for each one of at least a part of non-selected detections in the first plurality of detections based on the calculated set of components; determining an error between each calculated radial velocity (v.sub.dc) and the measured radial velocity for each one of at least the part of non-selected detections; and determining a number of inliers for the corresponding cycle, where an inlier corresponds to a detection with the corresponding error that falls below an inlier threshold; and choosing, as a determined set of components for the target, the set of components from the calculated sets of components of the plurality of radar cycles that corresponds to a largest number of inliers among the determined numbers of inliers of the plurality of radar cycles.
10. The method according to claim 9, wherein the method further comprises: grouping detections that correspond to inliers resulting from the chosen set of components, the grouped detections being identified as belonging to the target that is an extended object.
11. The method according to claim 9, wherein the second plurality of detections is the same as the first plurality of detections.
12. The method according to claim 9, wherein the first plurality of detections and the second plurality of belong to different radar cycles, and the method comprises, for each cycle of the plurality of radar cycles: first calculating velocity components for the selected detections; and then calculate the at least one acceleration component based on the calculated velocity components for the selected detections.
13. The method according to claim 12, wherein the second plurality of detections belongs to a previous radar cycle prior to the corresponding radar cycle which the first plurality of detections belongs.
14. The method according to claim 9, wherein the set of components is calculated by solving an expression of
V.sub.dm=(V.sub.x+a.sub.xΔt)cos(θ.sub.m)+(V.sub.y+a.sub.yΔt)sin(θ.sub.m) for each selected detection, where θ.sub.m constitutes the measured azimuth angle between a radar system reference line and a direction towards the corresponding detection in question, V.sub.dm represents the measured radial velocity of the corresponding detection, V.sub.x represents an x-component of velocity of the set of components, V.sub.y represents a y-component of velocity of the set of components, a.sub.x represents an x-component of acceleration of the set of components, a.sub.y represents a y-component of acceleration of the set of components, and Δt represents a time difference of the selected detections.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1) The present disclosure will now be described more in detail with reference to the appended drawings, where:
(2)
(3)
(4)
(5)
DETAILED DESCRIPTION
(6)
(7) By use of the vehicle radar system 3, a measured radial velocity v.sub.dm, the Doppler velocity, is determined, for example from the Doppler frequency and the Doppler phase shift. Furthermore, a measured azimuth angle θ.sub.m between a radial direction of observation and a radar system reference line such as the x-axis 21, as well as a measured radial distance r.sub.m between the transceiver arrangement 4 and a detection 9, are acquired for each one of a plurality of detections 9, 20 (only a few indicated in
(8) The motion state of an object describes, e.g., the distance from the ego vehicle 1 to a target object 6, a complete, relative or absolute, velocity vector of the object in relation to the ego vehicle, and a complete, relative or absolute, acceleration vector of the object in relation to the ego vehicle. The motion state of tracked objects is updated continuously to reflect changes in object motion.
(9) In order to be able to identify and group those detections 9 that belong to a certain extended object 10, it is desired to determine which detections that have the same velocity vector, which now will be described for a first example.
(10) The target object 6 and its corresponding detections 9 have a relative velocity v.sub.t that has a velocity x-component v.sub.x and a velocity y-component v.sub.y. The x-component v.sub.x runs parallel to the x-axis 21 and the y-component v.sub.y runs parallel to a y-axis 22, which in turn runs perpendicular to the x-axis 21. For the velocity x-component v.sub.x there is a corresponding acceleration x-component a.sub.x, and for the velocity y-component v.sub.y, there is a corresponding acceleration y-component a.sub.y.
(11) Assuming that all the detections 9 which are received from an extended object have the same direction of velocity, then the measured radial velocity V.sub.dm of each one of these detections 9 is given by projecting the relative velocity vector v.sub.t onto the radial direction. This is given by:
V.sub.dm=V.sub.xcos(θ.sub.m)+V.sub.ysin(θ.sub.m)+w (1)
as illustrated more in detail in the lower left part of
(12) For an extended object, multiple detections 9 originate from the same target object 6, and each detection has its individual measured radial velocity V.sub.dm. For all N detections 9 that originate from the same target object 6, a set of equations will be:
(13)
(14) It is desired to solve equation (2) for all M detections 9, 20 and to find the N detections 9 that originate from the same target object 6 and that correctly satisfy equation (2).
(15) As there are two unknowns, at least two equations are needed so solve for the full velocity vector v.sub.x, v.sub.y. In case more detections are available, and hence more equations are available, the system becomes overdetermined and a least squares inversion can give the solution for the full velocity vector v.sub.x, v.sub.y.
(16) The Random Sample Consensus (RANSAC) approach can be used to find the optimal solution, and it is robust to noise and outliers. This algorithm successively picks two random detections, and solves the above equation for the velocity components v.sub.x, v.sub.y using only these two detections.
(17) Each one of the resulting random hypotheses is evaluated and the best fit which best describes the remaining detections is selected. To increase robustness, detections from multiple radar cycles from the past can be added to increase the number of detections, and hence the number of equations. This, however, is only applicable if the velocity vector does not change.
(18) In this context, a radar cycle is one observation phase during which the vehicle radar system 3 is arranged to acquire data, process the data on several signal processing levels and to send out available results. This can be a fixed time interval, or it can be a dynamic time interval depending on environment conditions and processing load.
(19) When the target object 6 is moving with an acceleration, the Doppler velocity of the detections 9 changes rapidly in each radar cycle, and therefore a standard RANSAC fit on data from multiple radar cycles does not give an accurate solution. With reference to
(20) The detections 9′, 9″, 9′″, 9″″ for each radar cycle are shown with corresponding circles, crosses, squares and triangles.
(21) Correspondingly,
(22) Therefore, in the cases where the target object 6 has a constant acceleration a.sub.x, a.sub.y, equation (1) becomes:
V.sub.dm=(V.sub.x+a.sub.xΔt)cos(θ.sub.m)+(V.sub.y+a.sub.yΔt)sin(θ.sub.m) (3)
(23) For all N detections 9 that originate from the same target object 6, a set of equations will be:
(24)
(25) As for equation (2), it is desired to solve equation (4) for all M detections 9, 20 and to find the N detections 9 that originate from the same target object 6 and that correctly satisfy equation (4).
(26) Thus, the four unknowns for the target velocity's and acceleration's x- and y-components v.sub.x, v.sub.y, a.sub.x, a.sub.y need to be solved for. This is possible with at least four equations. Similar to the example described above for velocity only, the RANSAC method can be used to robustly estimate the four unknowns.
(27) According to the present disclosure, for a certain radar cycle, the control unit 5 is adapted to consecutively select four detections 9 at random by use of which the four unknowns are solved. Out of the random hypotheses which are created this way, the control unit 5 is adapted to select the one which best describes the remaining detections.
(28) This is accomplished by the control unit 5 that is adapted to:
(29) Determine a calculated radial velocity v.sub.dc for each one of the selected detections by use of the calculated components v.sub.x, v.sub.y, a.sub.x, a.sub.y using equation (3) for v.sub.dc instead of v.sub.dm.
(30) Determine an error between the calculated radial velocity v.sub.dc and the measured radial velocity v.sub.dm.
(31) Determine the number of inliers, where an inlier corresponds to an error that falls below an inlier threshold.
(32) This is performed for a plurality of radar cycles such that a corresponding plurality of sets of components v.sub.x, v.sub.y, a.sub.x, a.sub.y is acquired. The control unit 5 is then adapted to choose the set of components v.sub.x, v.sub.y, a.sub.x, a.sub.y that results in the largest number of inliers.
(33) An important advantage for this approach is its robustness to noise. This is achieved because all of the four unknowns are optimized simultaneously by solving a single globally optimal equation.
(34) Inverting the above equation is feasible in the general case, but it is computationally expensive. Therefore, according to some aspects of the present disclosure, to simplify the calculations only detections which are measured at the same cycle are used in a first processing stage for solving the velocity components v.sub.x, v.sub.y. Then, additional detections from another radar cycle, for example a previous radar cycle, are used to solve the acceleration components a.sub.x, a.sub.y.
(35) According to some aspects, the complexity can be reduced by using only three unknowns according to a following second example.
(36) In practical applications, the most relevant case of acceleration is in a longitudinal direction, in a driving direction. Assuming that acceleration always is in the driving direction and there is no lateral movement, the acceleration components a.sub.x, a.sub.y are substituted according to
(37)
where |V.sub.r| is the magnitude of the relative velocity v.sub.r.
(38) Then rewriting equation (3) results in:
(39)
(40) Simplifying equation (5) results in:
(41)
and finally:
(42)
(43) In order to make a fit, at least three detections are needed, either all from different radar cycles, or two detections from one radar cycle, i.e. the current radar cycle, and one detection from another radar cycle, i.e. the previous radar cycle. In that case, as in the previous first example, only detections which are measured at the same cycle are used in a first processing stage for solving the velocity components v.sub.x, v.sub.y. Then, additional detections from another radar cycle, for example a previous radar cycle, are used to solve the acceleration component a.
(44) Optimization is achieved for three unknown variables, the target velocity's x- and y-components v.sub.x, v.sub.y and the simplified acceleration component a simultaneously.
(45) An important advantage for the approach according to the present disclosure is the fact that detections from multiple cycles can be used at the same time, which makes the algorithm robust even in case of low number of detections and in the presence of noise and outliers.
(46) With reference to
(47) Step 12: Acquiring a measured azimuth angle θ.sub.m and a measured radial velocity v.sub.dm for a plurality of detections 9 associated with an object 6.
(48) Step 13: Selecting one detection from the first plurality of detections 9, 20 for each one of two velocity components v.sub.x, v.sub.y included in a set of components v.sub.x, v.sub.y, a.sub.x, a.sub.y; a to be determined, where the two velocity components v.sub.x, v.sub.y define a full velocity vector for a relative velocity v.sub.r.
(49) Step 14: Selecting one detection a second plurality of detections 9, 20 for each one of at least one corresponding acceleration component a.sub.x, a.sub.y; a.
(50) Step 15: Calculating the components v.sub.x, v.sub.y, a.sub.x, a.sub.y; a for the selected detections.
(51) Step 16: Determining a calculated radial velocity v.sub.dc for each one of at least a part of the other detections in the first plurality of detections 9, 20 by use of the calculated components v.sub.x, v.sub.y, a.sub.x, a.sub.y; a.
(52) Step 17: Determining an error between each calculated radial velocity v.sub.dc and the measured radial velocity v.sub.dm.
(53) Step 18: Determining the number of inliers, where an inlier corresponds to an error that falls below an inlier threshold.
(54) Step 19: Repeating the above for all radar cycles in the plurality of radar cycles.
(55) When all radar cycles in the plurality of radar cycles have been processed according to the above, when there are no radar cycles left in the plurality of radar cycles, the method then includes the steps of:
(56) Step 23: Choosing the set of components v.sub.x, v.sub.y, a.sub.x, a.sub.y; a that results in the largest number of inliers.
(57) According to some aspects, the method further includes the step of:
(58) Step 24: Grouping those detections 9 that correspond to inliers resulting from the chosen set of components v.sub.x, v.sub.y, a.sub.x, a.sub.y; a, such that these detections 9 form an extended object 10.
(59) The present disclosure is not limited to the examples above, but may vary freely within the scope of the appended claims. For example, the radar system may be implemented in any type of vehicles such as cars, trucks and buses as well as boats and aircraft.
(60) The radar transceiver 4 is adapted for any suitable type of Doppler radar in a Doppler radar system. There may be any number of radar transceivers 4 in the vehicle radar system 3, and they may be arranged for transmission and signals in any suitable direction. The plurality of sensing sectors or sensing bins may thus be directed in other desirable directions, such as rearwards or at the sides of the vehicle 1.
(61) Radar signal processing is performed in any kind of suitable control unit 5-of the vehicle radar system 3, such as a DSP (Digital Signal Processor) or an RCU (Radar Control Unit) which according to some aspects includes a DSP, or combination with separate or combined control unit arrangements.
(62) Generally, the present disclosure relates to a vehicle radar system 3 where, for each one of a plurality of radar cycles, the radar system 3 is arranged to provide a measured azimuth angle θ.sub.m and a measured radial velocity v.sub.dm for a first plurality of detections 9, 20. For each one of the plurality of radar cycles, the radar system 3 is arranged to:
(63) select, one detection from the first plurality of detections 9, 20 for each one of two velocity components v.sub.x, v.sub.y included in a set of components v.sub.x, v.sub.y, a.sub.x, a.sub.y; a to be determined, where the two velocity components v.sub.x, v.sub.y define a full velocity vector for a relative velocity v.sub.r;
(64) select, one detection from a second plurality of detections 9, 20 for each one of at least one corresponding acceleration component a.sub.x, a.sub.y; a;
(65) calculate the components v.sub.x, v.sub.y, a.sub.x, a.sub.y; a for the selected detections;
(66) determine a calculated radial velocity v.sub.dc for each one of at least a part of the other detections in the first plurality of detections 9, 20 by use of the calculated components v.sub.x, v.sub.y, a.sub.x, a.sub.y; a;
(67) determine an error between each calculated radial velocity v.sub.dc and the measured radial velocity v.sub.dm;
(68) determine the number of inliers, where an inlier corresponds to an error that falls below an inlier threshold;
(69) where the radar system 3 furthermore is arranged to choose the set of components v.sub.x, v.sub.y, a.sub.x, a.sub.y; a that results in the largest number of inliers.
(70) According to some aspects, the radar system 3 is adapted to group those detections 9 that correspond to inliers resulting from the chosen set, of components v.sub.x, v.sub.y, a.sub.x, a.sub.y; a such that these detections 9 form an extended object 10.
(71) According to some aspects, the second plurality of detections 9, 20 is the same as the first plurality of detections.
(72) According to some aspects, the second plurality of detections belongs to another radar cycle, where the radar system 3 is arranged to:
(73) first calculate the velocity components v.sub.x, v.sub.y for the selected detections;
(74) then calculate the at least one acceleration component a.sub.x, a.sub.y; a by use of the calculated velocity components v.sub.x, v.sub.y.
(75) According to some aspects, the second plurality of detections belongs to a previous radar cycle.
(76) According to some aspects, the radar system 3 is arranged to calculate the components v.sub.x, v.sub.y, a.sub.x, a.sub.y; a by solving for these from the expression
V.sub.dm=(V.sub.x+a.sub.xΔt)cos(θ.sub.m)+(V.sub.y+a.sub.yΔt)sin(θ.sub.m)
for each selected detection, where θ.sub.m constitutes a measured angle between a radar system reference line 21 and a direction towards the detection 9 in question.
(77) According to some aspects, the radar system 3 is adapted to substitute
(78)
where |V.sub.r| is the magnitude of the relative velocity v.sub.r, such that the components v.sub.x, v.sub.y, a.sub.x, a.sub.y; a are calculated by salving for these from the expression
(79)
(80) Generally, the present disclosure relates to method for a vehicle radar system 3, where, for each one of a plurality of radar cycles, the method includes the steps of:
(81) Step 12: acquiring a measured azimuth angle θ.sub.m and a measured radial velocity v.sub.dm for a plurality of detections 9 associated with an object 6.
(82) For each one of the plurality of radar cycles, the method further includes:
(83) Step 13: selecting one detection from the first plurality of detections 9, 20 for each one of two velocity components v.sub.x, v.sub.y included in a set of components v.sub.x, v.sub.y, a.sub.x, a.sub.y; a to be determined, where the two velocity components v.sub.x, v.sub.y define a full velocity vector for a relative velocity v.sub.r;
(84) Step 14: selecting one detection from a second plurality of detections 9, 20 for each one of at least one corresponding acceleration component a.sub.x, a.sub.y; a;
(85) Step 15: calculating the components v.sub.x, v.sub.y, a.sub.x, a.sub.y; a for the selected detections;
(86) Step 16: determining a calculated radial velocity v.sub.dc for each one of at least a part of the other detections in the first plurality of detections 9, 20 by use of the calculated components v.sub.x, v.sub.y, a.sub.x, a.sub.y; a;
(87) Step 17: determining a error between each calculated radial velocity v.sub.dc and the measured radial velocity v.sub.dm; and
(88) Step 18: determining the number of inliers, where an inlier corresponds an error that falls below an inlier threshold; and
(89) Step 19: repeating the above for all radar cycles in the plurality of radar cycles; where the method then includes:
(90) Step 23: choosing the set of components v.sub.x, v.sub.y, a.sub.x, a.sub.y; a that results in the largest number of inliers.
(91) According to some aspects, the method further includes the step of:
(92) Step 24: grouping those detections 9 that correspond to inliers resulting from the chosen set of components v.sub.x, v.sub.y, a.sub.x, a.sub.y; a, such that these detections 9 form an extended object 10.
(93) According to some aspects, the second plurality of detections 9, 20 is the same as the first plurality of detections.
(94) According to some aspects, the second plurality of detections belongs to another radar cycle, where the radar system 3 is arranged to:
(95) first calculate the velocity components v.sub.x, v.sub.y for the selected detections;
(96) then calculate the at least one acceleration component a.sub.x, a.sub.y; a by use of the calculated velocity components v.sub.x, v.sub.y.
(97) According to some aspects, the second plurality of detections belongs to a previous radar cycle.
(98) According to some aspects, the method includes calculating the components v.sub.x, v.sub.y, a.sub.x, a.sub.y; a by solving for these from the expression:
V.sub.dm=(V.sub.x+a.sub.xΔt)cos(θ.sub.m)+(V.sub.y+a.sub.yΔt)sin(θ.sub.m)
for each selected detection, where θ.sub.m constitutes a measured angle between a radar system reference line 21 and a direction towards the detection 9 in question.
(99) According to some aspects, the radar system (3) is adapted to substitute
(100)
where |V.sub.r| is the magnitude of the relative velocity v.sub.r, such that the components v.sub.x, v.sub.y, a.sub.x, a.sub.y; a are calculated by solving for these from the expression
(101)
(102) While the above description constitutes the preferred embodiment of the present invention, it will be appreciated that the invention is susceptible to modification, variation and change without departing from the proper scope and fair meaning of the accompanying claims.