Radar target tracking device and radar target tracking program
By using Doppler velocity-based gate processing to align position and velocity gates with predicted speed directions, the system effectively tracks multiple radar targets with high precision, addressing the issue of erroneous linking during target approach.
Patent Information
- Application Number
- JP2021002649
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2021-01-12
- Publication Date
- 2024-12-09
- Estimated Expiration
- 2041-01-12
AI Technical Summary
Existing radar systems face challenges in accurately tracking multiple targets when they approach each other, leading to erroneous linking of predicted and observed positions.
The system employs gate processing techniques that utilize Doppler velocity information to select the radar target with the closest observed Doppler velocity component, linking its predicted position with the observed position, and sets position and velocity gates to align with the predicted speed direction, thereby reducing noise and ensuring precise tracking.
This method allows for accurate determination and linking of predicted and observed positions of multiple radar targets, even when they are close, enhancing tracking precision.
Smart Images

Figure 0007596155000003 
Figure 0007596155000004 
Figure 0007596155000005
Abstract
Description
[Technical field]
[0001] The present disclosure relates to techniques for tracking multiple radar targets. [Background technology]
[0002] A technique for detecting new targets in addition to already tracked targets using gate processing is disclosed in Patent Document 1 etc. A specific example of gate processing in the conventional technique is shown in FIG.
[0003] In the left column of FIG. 1, the radar system R detects a radar target T1. The observed position of the radar target T1 is indicated by a black circle, and the observed Doppler velocity of the radar target T1 is v o <0 (direction approaching the radar system R). The gate G1 is set around the observation position of the radar target T1, and the gate width is set wider for the same direction relative to the observed Doppler velocity of the radar target T1 than for the opposite direction. The radar system R detects the tracked target T2. The predicted position of the tracked target T2 is indicated by a white circle (inside the gate G1), and the predicted Doppler velocity of the tracked target T2 is v p It is. |v o -v p |≦v c (v c is the threshold Doppler velocity difference) is satisfied, the radar target T1 is determined to be the same target as the already-tracked target T2.
[0004] In the right column of FIG. 1, the radar system R detects a radar target T3. The observed position of the radar target T3 is indicated by a black circle, and the observed Doppler velocity of the radar target T3 is v o >0 (direction moving away from the radar system R). The gate G3 is set around the observation position of the radar target T3, and the gate width is set wider for the same direction compared to the opposite direction with respect to the observed Doppler velocity of the radar target T3. The radar system R detects the tracked target T4. The predicted position of the tracked target T4 is indicated by a white circle (inside the gate G3), and the predicted Doppler velocity of the tracked target T4 is v p It is. |v o -v p|>v c (v c is the threshold Doppler velocity difference) is satisfied, the radar target T3 is determined to be a new target different from the already tracked target T4. [Prior art documents] [Patent documents]
[0005] [Patent Document 1] JP 2002-156449 A Summary of the Invention [Problem to be solved by the invention]
[0006] A technology for tracking not only one target but multiple targets using gate processing can be considered as follows. A specific example of gate processing to be solved is shown in Figure 2.
[0007] In the left column of FIG. 2, the radar system R detects the tracked objects T5 and T6. The predicted position of the tracked object T5 is indicated by a black circle, and the observed position of the tracked object T5 is indicated by a black square. A gate G5 is set around the predicted position of the tracked object T5. The predicted position of the tracked object T6 is indicated by a white circle, and the observed position of the tracked object T6 is indicated by a white square. A gate G6 is set around the predicted position of the tracked object T6. The predicted positions of the tracked objects T5 and T6 are not very close to each other, the gates G5 and G6 do not overlap each other, the observed position of the tracked object T5 exists only inside the gate G5, and the observed position of the tracked object T6 exists only inside the gate G6. Therefore, the predicted position of the already tracked target T5 can be correctly linked to the observed position of the already tracked target T5, and the predicted position of the already tracked target T6 can be correctly linked to the observed position of the already tracked target T6.
[0008] In the right column of FIG. 2, the radar system R detects the tracked objects T7 and T8. The predicted position of the tracked object T7 is indicated by a black circle, and the observed position of the tracked object T7 is indicated by a black square. A gate G7 is set around the predicted position of the tracked object T7. The predicted position of the tracked object T8 is indicated by a white circle, and the observed position of the tracked object T8 is indicated by a white square. A gate G8 is set around the predicted position of the tracked object T8. The predicted positions of the tracked objects T7 and T8 are quite close to each other, and the gates G7 and G8 overlap each other, and the observed position of the tracked object T7 is inside the gates G7 and G8, and the observed position of the tracked object T8 is inside the gates G7 and G8. Therefore, the predicted position of the already tracked target T7 may be erroneously linked to the observed position of the already tracked target T8. Also, the predicted position of the already tracked target T8 may be erroneously linked to the observed position of the already tracked target T7.
[0009] Therefore, in order to solve the above-mentioned problem, an object of the present disclosure is to track multiple radar targets with high accuracy by correctly linking the predicted position and observed position of each radar target, even when the multiple radar targets are close to each other. [Means for solving the problem]
[0010] In order to solve the above problem, when the observed positions of multiple radar targets exist within a position gate set around the predicted position of a single radar target, a radar target having an observed Doppler velocity closest to the Doppler component of the predicted velocity of the single radar target is selected, and the predicted position of the single radar target is linked to the observed position of the selected radar target.
[0011] Specifically, the present disclosure provides a radar target tracking device comprising: a target tracking unit that calculates a current smoothed position of the radar target based on a current predicted position and observed position of the radar target, calculates a current smoothed velocity of the radar target based on the current predicted position, observed position and predicted velocity of the radar target, calculates a next predicted position of the radar target based on the current smoothed position and smoothed velocity of the radar target, and calculates a next predicted velocity of the radar target based on the current smoothed velocity of the radar target; and a gate processing unit that, when current observed positions of a plurality of radar targets exist within a position gate set around a current predicted position of one of the radar targets, selects the radar target having a current observed Doppler velocity that is closest to a Doppler component of the current predicted velocity of the one of the radar targets, and links the current predicted position of the one of the radar targets with the current observed position of the selected radar target, and outputs the linked current predicted position of the one of the radar targets to the target tracking unit.
[0012] The present disclosure also relates to a radar target tracking program for causing a computer to execute a target tracking step of: calculating a current smoothed position of the radar target based on a current predicted position and observed position of the radar target; calculating a current smoothed velocity of the radar target based on the current predicted position, observed position and predicted velocity of the radar target; calculating a next predicted position of the radar target based on the current smoothed position and smoothed velocity of the radar target; and calculating a next predicted velocity of the radar target based on the current smoothed velocity of the radar target; and a gate processing step of, when current observed positions of a plurality of the radar targets exist within a position gate set around a current predicted position of one of the radar targets, selecting the radar target having a current observed Doppler velocity closest to a Doppler component of the current predicted velocity of the one of the radar targets, and linking the current predicted position of the one of the radar targets with the current observed position of the selected radar target, and outputting the linked current predicted position of the one of the radar targets to the target tracking step.
[0013] According to these configurations, even when multiple radar targets are close to each other, the multiple radar targets can be tracked with high accuracy by using the Doppler velocity information of each radar target and correctly linking the predicted position and observed position of each radar target.
[0014] The present disclosure also relates to a radar target tracking device, wherein the gate processing unit sets the width of the position gate wider for the same direction for the current predicted speed of the one radar target than for the opposite direction.
[0015] According to this configuration, the observation position of each radar target can be reliably linked in the same direction as the predicted speed of each radar target, and the probability of picking up noise in the opposite direction to the predicted speed of each radar target can be reliably reduced, and the area of the position gate can be suppressed. The predicted speed of each radar target is in any direction over 360° as seen from the radar, and the direction in which the position gate is narrowed is not limited to two directions.
[0016] The present disclosure also relates to a radar target tracking device, wherein the gate processing unit selects the radar target having a current observed Doppler velocity within a velocity gate set around a Doppler component of a current predicted velocity of the one of the radar targets as the one of the multiple radar targets.
[0017] According to this configuration, even when multiple radar targets are close to each other, by setting not only a position gate but also a speed gate for each radar target and then correctly linking the predicted position and observed position of each radar target, multiple radar targets can be tracked with high accuracy.
[0018] The present disclosure also relates to a radar target tracking device, characterized in that the gate processing unit sets the width of the velocity gate wider for an observation signal point cluster of the radar target as the variance value of the currently observed Doppler velocity becomes larger.
[0019] According to this configuration, even when each radar target suddenly changes speed, the observed Doppler velocity of each radar target can be prevented from departing from the inside of each speed gate, and each radar target can be prevented from being determined to be a new target that has suddenly appeared.
[0020] The present disclosure also relates to a radar target tracking device, wherein the gate processing unit sets a width of the speed gate wider for the current predicted speed of the one radar target in the same direction than for the opposite direction.
[0021] According to this configuration, the observed Doppler velocity of each radar target can be reliably linked in the same direction as the predicted velocity of each radar target, and the probability of picking up noise in the opposite direction to the predicted velocity of each radar target can be reliably reduced, and the volume of the speed gate can be suppressed. The predicted velocity of each radar target is in any direction over 360° as seen from the radar, and the direction in which the speed gate is narrowed is not limited to two directions. Effect of the Invention
[0022] In this way, the present disclosure enables tracking of multiple radar targets with high accuracy, even when the multiple radar targets are close to each other, by correctly linking the predicted position and observed position of each radar target. [Brief description of the drawings]
[0023] [Figure 1] FIG. 1 is a diagram showing a specific example of gate processing in the prior art; [Diagram 2] FIG. 1 is a diagram showing a specific example of gate processing to be solved. [Diagram 3] FIG. 1 is a diagram illustrating a configuration of a radar system according to the present disclosure. [Figure 4] FIG. 2 is a diagram showing a specific example of the target tracking process of the present disclosure. [Diagram 5] FIG. 4 is a diagram showing a procedure of a first gate processing according to the present disclosure. [Figure 6]FIG. 2 is a diagram showing a specific example of a first gate process of the present disclosure. [Figure 7] FIG. 2 is a diagram showing a specific example of a first gate process of the present disclosure. [Figure 8] FIG. 2 is a diagram showing a specific example of a first gate process of the present disclosure. [Figure 9] FIG. 13 is a diagram showing a specific example of a position gate setting according to the present disclosure. [Figure 10] FIG. 11 is a diagram showing a procedure of a second gate processing according to the present disclosure. [Figure 11] FIG. 11 is a diagram showing a specific example of a second gate process according to the present disclosure. [Figure 12] FIG. 13 is a diagram showing a specific example of a speed gate setting according to the present disclosure. [Figure 13] FIG. 13 is a diagram showing a specific example of a speed gate setting according to the present disclosure. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0024] DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS The present disclosure will be described with reference to the accompanying drawings. The embodiments described below are examples of the present disclosure, and the present disclosure is not limited to the following embodiments.
[0025] (Overview of the radar system of the present disclosure) The configuration of the radar system of the present disclosure is shown in Fig. 3. The radar system R includes a radar transmitting / receiving device 1, a radar target observation device 2, and a radar target tracking device 3. The radar target observation device 2 includes a signal processing unit 21, a signal point extraction unit 22, a clustering unit 23, and a representative point extraction unit 24. The radar target tracking device 3 includes a gate processing unit 31 and a target tracking unit 32, and is a computer on which the radar target tracking program shown in Fig. 5 or 10 is installed.
[0026] The radar transceiver 1 irradiates a radar transmission signal toward a radar target T and receives a radar reflection signal from the radar target T. A signal processing unit 21 processes the radar reflection signal for each distance bin, each azimuth sector, and each Doppler velocity bin. A signal point extraction unit 22 extracts signal points from the radar reflection signal based on intensity threshold processing. A clustering unit 23 extracts clusters from the extracted signal points based on a signal point density determination. A representative point extraction unit 24 extracts representative points from the extracted clusters based on the signal point density and intensity, and calculates the observed position and observed Doppler velocity of the radar target T.
[0027] A specific example of the target tracking process of the present disclosure is shown in FIG. pk and the observation position x ok Based on this, the current smoothed position x of the radar target T is sk Then, the current predicted position x of the radar target T is calculated. pk , observation position x ok and the predicted speed v pk Based on this, the current smoothed velocity v of the radar target T is sk Furthermore, the current predicted position x of the radar target T is calculated. pk , observation position x ok and predicted acceleration a pk Based on this, the current smooth acceleration a of the radar target T is sk In the αβγ filter, the calculation is performed as shown in Equation 1, where α is the position gain, β is the velocity gain, γ is the acceleration gain, and T is the sampling period. The calculation for the y direction is performed as shown in Equation 1, almost similar to the x direction.
number
[0028] The target tracking unit 32 calculates the current smoothed position x of the radar target T. sk , smooth velocity v sk and smooth acceleration a sk Based on this, the next predicted position x of the radar target T is pk+1 Then, the current smoothed velocity v of the radar target T is calculated.sk and smooth acceleration a sk Based on this, the next predicted speed v of the radar target T is pk+1 Furthermore, the current smoothed acceleration a sk Based on this, the next predicted acceleration a of the radar target T is pk+1 In the αβγ filter, the calculation is performed as shown in Equation 2, where α is the position gain, β is the velocity gain, γ is the acceleration gain, and T is the sampling period. The calculation for the y direction is performed as shown in Equation 2, almost similar to the x direction.
number
[0029] Therefore, when tracking each radar target T, the radar target trajectory can be smoothed and the radar observation noise can be suppressed. However, when tracking multiple radar targets T, it is necessary to prevent target jumping between targets when the targets approach each other as described below.
[0030] In the upper part of Figure 4, the current time t k The target tracking unit 32 detects the first and second radar targets T at time t k Predicted position at x 1、pk , x 2、pk The representative point extraction unit 24 calculates the representative point for the first and second radar targets T at time t k Observation position x at 1、ok , x 2、ok The gate processing unit 31 calculates the time t k Predicted position at x 1、pk and the observation position x 1、ok and for the second radar target T, k Predicted position at x 2、pk and the observation position x 2、ok The target tracking unit 32 links the first and second radar targets T at time t k Smoothing position at x 1、sk , x 2、sk Calculate.
[0031] In the lower part of Figure 4, the next time t k+1 The target tracking unit 32 detects the first and second radar targets T at time t k+1 Predicted position at x 1、pk+1 , x 2、pk+1 The representative point extraction unit 24 calculates the representative point for the first and second radar targets T at time t k+1 Observation position x at 1、ok+1 , x 2、ok+1 The gate processing unit 31 calculates the time t k+1 Predicted position at x 1、pk+1 and the observation position x 1、ok+1 and for the second radar target T, k+1 Predicted position at x 2、pk+1 and the observation position x 2、ok+1 The target tracking unit 32 links the first and second radar targets T at time t k+1 Smoothing position at x 1、sk+1 , x 2、sk+1 The subsequent processing is almost the same as that described above.
[0032] (Details of the first gate process of the present disclosure) The first gate processing of the present disclosure will be described in detail. The procedure of the first gate processing of the present disclosure is shown in Fig. 5. The gate processing unit 31 sets a position gate around the current predicted position of one radar target T (step S1). Then, it is confirmed whether or not the current observed positions of multiple radar targets T exist within the position gate (step S2).
[0033] When the current observation positions of multiple radar targets T exist within the position gate (step S2, YES), the gate processing unit 31 selects the radar target T having the current observation Doppler velocity closest to the Doppler component of the current predicted velocity of the one radar target T (step S3). Then, the current predicted position of the one radar target T and the current observation position of the selected radar target T are linked to each other and output to the target tracking unit 32 (step S4).
[0034] When there are no current observation positions of multiple radar targets T inside the position gate, and only the current observation position of the one radar target T exists (step S2, NO), the gate processing unit 31 links the current predicted position of the one radar target T with the current observation position of the one radar target T and outputs them to the target tracking unit 32 (step S5).
[0035] As a specific example of the first gate processing of the present disclosure, a case of passing each other is shown in Fig. 6. In the XY plane in the left column of Fig. 6, radar target T9 is a person moving away from the radar system R, and radar target T10 is a person approaching the radar system R. When radar target T9 and radar target T10 approach each other and pass each other, this prevents the radar target T9 and radar target T10 from being erroneously recognized as a change of direction.
[0036] In the XY plane in the center column of FIG. 6, the predicted position of the radar target T9 is indicated by a black circle, and the observed position of the radar target T9 is indicated by a black square. A position gate PG9 is set around the predicted position of the radar target T9. The predicted position of the radar target T10 is indicated by a white circle, and the observed position of the radar target T10 is indicated by a white square. A position gate PG10 is set around the predicted position of the radar target T10. The predicted positions of the radar targets T9 and T10 are quite close to each other, and the position gates PG9 and PG10 overlap each other, the observed position of the radar target T9 exists inside the position gates PG9 and PG10, and the observed position of the radar target T10 exists inside the position gates PG9 and PG10.
[0037] In the XYV space (V is Doppler velocity) in the right column of FIG. 6, the Doppler component (>0) of the predicted velocity of the radar target T9 is indicated by a black circle, and the observed Doppler velocity (>0) of the radar target T9 is indicated by a black square. The Doppler component (<0) of the predicted velocity of the radar target T10 is indicated by a white circle, and the observed Doppler velocity (<0) of the radar target T10 is indicated by a white square. Here, the degree of agreement between the Doppler components of the predicted velocities of the radar targets T9 and T10 and the observed Doppler velocities of the radar targets T9 and T10 is confirmed. Therefore, the predicted position of the radar target T9 can be correctly linked to the observed position of the radar target T9. And, the predicted position of the radar target T10 can be correctly linked to the observed position of the radar target T10.
[0038] As a specific example of the first gate processing of the present disclosure, the case of overtaking is shown in Fig. 7. In the XY plane in the left column of Fig. 7, the radar target T11 is a person moving away from the radar system R, and the radar target T12 is also a person moving away from the radar system R. The radar target T11 approaches and overtakes the radar target T12, preventing it from being erroneously recognized as a speed swap.
[0039] In the XY plane in the center column of FIG. 7, the predicted position of the radar target T11 is indicated by a black circle, and the observed position of the radar target T11 is indicated by a black square. A position gate PG11 is set around the predicted position of the radar target T11. A predicted position of the radar target T12 is indicated by a white circle, and the observed position of the radar target T12 is indicated by a white square. A position gate PG12 is set around the predicted position of the radar target T12. The predicted positions of the radar targets T11 and T12 are quite close to each other, and the position gates PG11 and PG12 overlap each other, so that the observed position of the radar target T11 exists inside the position gates PG11 and PG12, and the observed position of the radar target T12 exists inside the position gates PG11 and PG12.
[0040] In the XYV space (V is Doppler velocity) in the right column of FIG. 7, the Doppler component (high speed) of the predicted velocity of the radar target T11 is indicated by a black circle, and the observed Doppler velocity (high speed) of the radar target T11 is indicated by a black square. The Doppler component (low speed) of the predicted velocity of the radar target T12 is indicated by a white circle, and the observed Doppler velocity (low speed) of the radar target T12 is indicated by a white square. Here, the degree of agreement between the Doppler components of the predicted velocities of the radar targets T11 and T12 and the observed Doppler velocities of the radar targets T11 and T12 is confirmed. Therefore, the predicted position of the radar target T11 can be correctly linked to the observed position of the radar target T11. And, the predicted position of the radar target T12 can be correctly linked to the observed position of the radar target T12.
[0041] As a specific example of the first gate processing of the present disclosure, the case of walking along a wall is shown in Fig. 8. In the XY plane in the left column of Fig. 8, radar target T13 is a wall that should be recognized as stationary clutter, and radar target T14 is a person moving away from the radar system R. The radar target T14 walks along the radar target T13, but is prevented from being erroneously recognized as a stationary state.
[0042] In the XY plane in the center column of FIG. 8, the predicted position of the radar target T13 is indicated by a black circle, and the observed position of the radar target T13 is indicated by a black square. A position gate PG13 is set around the predicted position of the radar target T13. A predicted position of the radar target T14 is indicated by a white circle, and the observed position of the radar target T14 is indicated by a white square. A position gate PG14 is set around the predicted position of the radar target T14. The predicted positions of the radar targets T13 and T14 are quite close to each other, and the position gates PG13 and PG14 overlap each other, so that the observed position of the radar target T13 exists inside the position gates PG13 and PG14, and the observed position of the radar target T14 exists inside the position gates PG13 and PG14.
[0043] In the XYV space (V is Doppler velocity) in the right column of FIG. 8, the Doppler component (=0) of the predicted velocity of the radar target T13 is indicated by a black circle, and the observed Doppler velocity (=0) of the radar target T13 is indicated by a black square. The Doppler component (>0) of the predicted velocity of the radar target T14 is indicated by a white circle, and the observed Doppler velocity (>0) of the radar target T14 is indicated by a white square. Here, the degree of agreement between the Doppler components of the predicted velocities of the radar targets T13 and T14 and the observed Doppler velocities of the radar targets T13 and T14 is confirmed. Therefore, the predicted position of the radar target T13 can be correctly linked to the observed position of the radar target T13. And, the predicted position of the radar target T14 can be correctly linked to the observed position of the radar target T14.
[0044] In this way, even when multiple radar targets T are close to each other, the multiple radar targets T can be tracked with high accuracy by using information on the Doppler velocity of each radar target T and correctly linking the predicted position and observed position of each radar target T. Note that when multiple radar targets T are in parallel, it is sufficient to track the multiple radar targets T collectively without correctly linking the predicted position and observed position of each radar target T.
[0045] A specific example of the setting of a position gate according to the present disclosure is shown in Fig. 9. In the left column of Fig. 9, the position gate PG is a circle set around the predicted position of the radar target T. That is, the gate width of the position gate PG is set similarly for both the same direction and the opposite direction with respect to the predicted speed of the radar target T. Here, the gate width of the position gate PG may be set wider as the variance value of the observation position of the cluster of the radar target T increases.
[0046] 9, the position gate PG is a circle set around the predicted position of the radar target T, not centered thereon. In other words, the gate width of the position gate PG is set wider in the same direction as the predicted speed of the radar target T than in the opposite direction. Here, the position gate PG in the left column of FIG. 9 can be moved parallel to the same direction as the predicted speed of the radar target T.
[0047] 9, the position gate PG is an ellipse that is set around the predicted position of the radar target T, not at its center. In other words, the gate width of the position gate PG is set wider in the same direction as the predicted speed of the radar target T than in the opposite direction. Here, the position gate PG in the center column of FIG. 9 is compressed in the direction perpendicular to the predicted speed of the radar target T.
[0048] In this way, the observation position of each radar target T can be reliably linked in the same direction as the predicted speed of each radar target T, and the probability of picking up noise in the opposite direction to the predicted speed of each radar target T can be reliably reduced, and the area of the position gate PG can be suppressed.
[0049] The predicted speed of each radar target T is in any direction over 360° as seen from the radar system R, and the direction in which the position gate PG is narrowed is not limited to two directions.
[0050] (Details of the second gate process of the present disclosure) The second gate processing of the present disclosure will be described in detail. The procedure of the second gate processing of the present disclosure is shown in Fig. 10. The gate processing unit 31 sets a position gate around the current predicted position of one radar target T (step S11). Then, it is confirmed whether or not the current observation positions of multiple radar targets T exist within the position gate (step S12).
[0051] When the current observation positions of multiple radar targets T exist within the position gate (step S12, YES), the gate processing unit 31 sets a speed gate around the Doppler component of the current predicted speed of one radar target T (step S13). Then, within the speed gate, the radar target T having the current observed Doppler speed is selected (step S14). Furthermore, the current predicted position of the one radar target T and the current observation position of the selected radar target T are linked and output to the target tracking unit 32 (step S15).
[0052] When there are no current observation positions of multiple radar targets T within the position gate, and only the current observation position of the one radar target T exists (step S12, NO), the gate processing unit 31 links the current predicted position of the one radar target T with the current observation position of the one radar target T and outputs them to the target tracking unit 32 (step S16).
[0053] As a specific example of the second gate processing of the present disclosure, a case of passing each other is shown in the left column of Fig. 11. The passing shown in the left column of Fig. 11 is similar to the passing shown in Fig. 6.
[0054] The predicted position and Doppler components of the predicted speed of the radar target T9 are indicated by black circles, and the observed position and observed Doppler speed of the radar target T9 are indicated by black squares. A cross section of the speed gate VG9 including the XY plane is set around the predicted position of the radar target T9. A cross section of the speed gate VG9 including the V axis (V is Doppler speed) is set around the Doppler components of the predicted speed of the radar target T9. The observed position and observed Doppler speed of the radar target T10 are indicated by white squares. The predicted position, Doppler components of the predicted speed, and speed gate of the radar target T10 are not shown to simplify the left column of FIG. 11.
[0055] The observed position and observed Doppler velocity of the radar target T9 are inside the speed gate VG9, but the observed position and observed Doppler velocity of the radar target T10 are not inside the speed gate VG9. Therefore, the predicted position of the radar target T9 and the observed position of the radar target T9 can be correctly linked. And, the predicted position of the radar target T10 and the observed position of the radar target T10 can be correctly linked (not shown in the left column of FIG. 11).
[0056] As a specific example of the second gate processing of the present disclosure, the case of overtaking is shown in the middle column of Fig. 11. The overtaking shown in the middle column of Fig. 11 is similar to the overtaking shown in Fig. 7.
[0057] The predicted position and Doppler components of the predicted speed of the radar target T12 are indicated by white circles, and the observed position and observed Doppler speed of the radar target T12 are indicated by white squares. A cross section of the speed gate VG12 including the XY plane is set around the predicted position of the radar target T12. A cross section of the speed gate VG12 including the V axis (V is Doppler speed) is set around the Doppler components of the predicted speed of the radar target T12. The observed position and observed Doppler speed of the radar target T11 are indicated by black squares. The predicted position, Doppler components of the predicted speed, and speed gate of the radar target T11 are not shown for simplification of the center column of FIG.
[0058] The observed position and observed Doppler velocity of the radar target T12 are inside the speed gate VG12, but the observed position and observed Doppler velocity of the radar target T11 are not inside the speed gate VG12. Therefore, the predicted position of the radar target T12 and the observed position of the radar target T12 can be correctly linked. And, the predicted position of the radar target T11 and the observed position of the radar target T11 can be correctly linked (not shown in the middle column of FIG. 11).
[0059] As a specific example of the second gate processing of the present disclosure, the case of wall walking is shown in the right column of Fig. 11. The wall walking shown in the right column of Fig. 11 is similar to the wall walking shown in Fig. 8.
[0060] The predicted position and Doppler components of the predicted speed of the radar target T14 are shown by white circles, and the observed position and observed Doppler speed of the radar target T14 are shown by white squares. A cross section of the speed gate VG14 including the XY plane is set around the predicted position of the radar target T14. A cross section of the speed gate VG14 including the V axis (V is Doppler speed) is set around the Doppler components of the predicted speed of the radar target T14. The observed position and observed Doppler speed of the radar target T13 are shown by black squares. The predicted position, Doppler components of the predicted speed, and speed gate of the radar target T13 are not shown to simplify the right column of FIG. 11.
[0061] The observed position and observed Doppler velocity of the radar target T14 are inside the speed gate VG14, but the observed position and observed Doppler velocity of the radar target T13 are not inside the speed gate VG14. Therefore, the predicted position of the radar target T14 and the observed position of the radar target T14 can be correctly linked. And, the predicted position of the radar target T13 and the observed position of the radar target T13 can be correctly linked (not shown in the right column of FIG. 11).
[0062] In this way, even when multiple radar targets T are close to each other, it is possible to track multiple radar targets T with high accuracy by setting not only the position gates but also the speed gates of each radar target T and then correctly linking the predicted position and observed position of each radar target T. Note that when multiple radar targets T are in parallel, it is sufficient to track multiple radar targets T collectively without correctly linking the predicted position and observed position of each radar target T.
[0063] Specific examples of speed gate settings of the present disclosure are shown in Figures 12 and 13. Figure 12 deals with sudden speed changes, and Figure 13 reduces the probability of picking up noise.
[0064] In the left column of FIG. 12, the variance value of the observed Doppler velocity for the observation signal point cluster of the radar target T15 is small. Therefore, the gate width of the velocity gate VG15 in the V-axis direction (V is Doppler velocity) is set narrower. Specifically, the velocity gate width is set as the sum of the Doppler component of the predicted velocity of the radar target T15 and a variable (a small variable corresponding to a small variance value) that changes based on the variance value of the observed Doppler velocity of the radar target T15. Furthermore, a constant may be added to this sum as the velocity gate width. In other words, since the velocity gate width mainly includes the Doppler component of the predicted velocity of the radar target T15, it becomes a stable gate width that reflects the actual almost constant velocity.
[0065] In the right column of FIG. 12, the variance value of the observed Doppler velocity is large for the observed signal point cluster of the radar target T16. Therefore, the gate width of the velocity gate VG16 in the V-axis direction (V is Doppler velocity) is set to be wide. Specifically, the velocity gate width is set as the sum of the Doppler component of the predicted velocity of the radar target T16 and a variable (a large variable corresponding to a large variance value) that changes based on the variance value of the observed Doppler velocity of the radar target T15. Furthermore, a constant may be added to this sum as the velocity gate width. In other words, since the velocity gate width includes a large variance value of the observed Doppler velocity of the radar target T16, it becomes a flexible gate width without being influenced by the almost constant velocity in the past.
[0066] In this way, even when each radar target T changes speed suddenly, it is possible to prevent the observed Doppler speed of each radar target T from going outside the inside of each speed gate, and to prevent each radar target T from being determined to be a new target that has suddenly appeared. Examples of such radar targets T include pedestrians and animals (birds, bears, etc.).
[0067] In each column of FIG. 12, the speed gates VG15 and VG16 are ellipsoids in the XYV space (V is Doppler velocity). The cross sections of the speed gates VG15 and VG16 including the XY plane are circles set around the predicted positions of the radar targets T15 and T16. The cross sections of the speed gates VG15 and VG16 including the V axis are ellipses set around the Doppler components of the predicted speeds of the radar targets T15 and T16. That is, the gate widths of the speed gates VG15 and VG16 in the XY and V directions are set in the same manner with respect to the predicted speeds of the radar targets T15 and T16, both in the same direction and in the opposite direction. Here, the gate widths of the speed gates VG15 and VG16 in the XY directions may be set wider as the variance value of the observation positions of the clusters of the radar targets T15 and T16 increases, as in the case of each column of FIG. 9.
[0068] In each column of FIG. 13, the velocity gate VG is also an ellipsoid in the XYV space (V is Doppler velocity). The cross section of the velocity gate VG including the XY plane is a circle set around the predicted position of the radar target T, not centered thereon. The cross section of the velocity gate VG including the V axis is an ellipse set around the Doppler component of the predicted velocity of the radar target T. In other words, the gate width of the velocity gate VG in each of the XYV directions is set wider in the same direction as the predicted velocity of the radar target T, compared to the opposite direction. Here, the velocity gates VG15 and VG16 in each column of FIG. 12 may be translated in the same direction as the predicted velocity of the radar targets T15 and T16.
[0069] In this way, the observed Doppler velocity of each radar target T can be reliably linked in the same direction as the predicted velocity of each radar target T, and the probability of picking up noise in the opposite direction to the predicted velocity of each radar target T can be reliably reduced, and the volume of the velocity gate VG can be suppressed.
[0070] The predicted velocity of each radar target T is in any direction over 360° as seen from the radar system R, and the direction in which the velocity gate VG is narrowed is not limited to two directions. [Industrial Applicability]
[0071] The radar target tracking device and radar target tracking program disclosed herein can be applied to in-vehicle wideband MIMO radar, advanced driver assistance systems (ADAS), and the like. [Explanation of symbols]
[0072] R: Radar system T1, T3, T, T9, T10, T11, T12, T13, T14, T15, T16: Radar target T2, T4, T5, T6, T7, T8: Tracked target G1, G3, G5, G6, G7, G8: Gates PG9, PG10, PG11, PG12, PG13, PG14, PG: Position gate VG9, VG12, VG14, VG15, VG16, VG: Speed Gate 1: Radar transmitter and receiver 2: Radar target observation device 3: Radar target tracking device 21: Signal processing section 22: Signal point extraction unit 23: Clustering section 24: Representative point extraction part 31: Gate processing section 32:Target tracking part
Claims
1. a target tracking unit that calculates a current smoothed position of the radar target based on a current predicted position and observed position of the radar target, calculates a current smoothed velocity of the radar target based on a current predicted position, observed position and predicted velocity of the radar target, calculates a next predicted position of the radar target based on the current smoothed position and smoothed velocity of the radar target, and calculates a next predicted velocity of the radar target based on the current smoothed velocity of the radar target; a gate processing unit that, when current observation positions of a plurality of radar targets exist within a position gate set around a current predicted position of one of the radar targets, selects the radar target having a current observed Doppler velocity closest to a Doppler component of a current predicted velocity of the one of the radar targets, and links the current predicted position of the one of the radar targets with the current observed position of the selected radar target, and outputs the linked current predicted position of the one of the radar targets to the target tracking unit; The gate processing unit sets a width of the position gate wider in the same direction for the current predicted speed of the one radar target than in the opposite direction. A radar target tracking device comprising:
2. a target tracking unit that calculates a current smoothed position of the radar target based on a current predicted position and observed position of the radar target, calculates a current smoothed velocity of the radar target based on a current predicted position, observed position and predicted velocity of the radar target, calculates a next predicted position of the radar target based on the current smoothed position and smoothed velocity of the radar target, and calculates a next predicted velocity of the radar target based on the current smoothed velocity of the radar target; a gate processing unit that, when current observation positions of a plurality of radar targets exist within a position gate set around a current predicted position of one of the radar targets, selects the radar target having a current observed Doppler velocity closest to a Doppler component of a current predicted velocity of the one of the radar targets, and links the current predicted position of the one of the radar targets with the current observed position of the selected radar target, and outputs the linked current predicted position of the one of the radar targets to the target tracking unit; the gate processing unit selects the radar target having a current observed Doppler velocity within a velocity gate set around a Doppler component of a current predicted velocity of the one radar target as the one radar target among the plurality of radar targets; The gate processing unit further sets a width of the speed gate wider for the same direction for the current predicted speed of the one radar target than for the opposite direction. A radar target tracking device comprising:
3. The gate processing unit sets a width of the velocity gate wider as the variance value of the currently observed Doppler velocity for the one of the radar target observation signal point clusters increases.
3. The radar target tracking device according to claim 2 .
4. a target tracking step of calculating a current smoothed position of the radar object based on a current predicted position and observed position of the radar object, calculating a current smoothed velocity of the radar object based on a current predicted position, observed position and predicted velocity of the radar object, calculating a next predicted position of the radar object based on the current smoothed position and smoothed velocity of the radar object, and calculating a next predicted velocity of the radar object based on the current smoothed velocity of the radar object; a gate processing step of selecting, when current observation positions of a plurality of radar targets exist within a position gate set around a current predicted position of one of the radar targets, the radar target having a current observed Doppler velocity closest to a Doppler component of a current predicted velocity of the one of the radar targets, and linking the current predicted position of the one of the radar targets with the current observed position of the selected radar target, and outputting the linked current predicted position of the one of the radar targets to the target tracking step; Run the following on your computer: The gate processing step sets the width of the position gate wider in the same direction for the current predicted speed of the one radar target than in the opposite direction. A radar target tracking program comprising:
5. a target tracking step of calculating a current smoothed position of the radar object based on a current predicted position and observed position of the radar object, calculating a current smoothed velocity of the radar object based on a current predicted position, observed position and predicted velocity of the radar object, calculating a next predicted position of the radar object based on the current smoothed position and smoothed velocity of the radar object, and calculating a next predicted velocity of the radar object based on the current smoothed velocity of the radar object; a gate processing step of selecting, when current observation positions of a plurality of radar targets exist within a position gate set around a current predicted position of one of the radar targets, the radar target having a current observed Doppler velocity closest to a Doppler component of a current predicted velocity of the one of the radar targets, and linking the current predicted position of the one of the radar targets with the current observed position of the selected radar target, and outputting the linked current predicted position of the one of the radar targets to the target tracking step; on the computer, The gate processing step includes selecting, as the one of the plurality of radar targets, the radar target having a current observed Doppler velocity within a velocity gate set around a Doppler component of a current predicted velocity of the one of the radar targets; The gate processing step further includes setting a width of the speed gate wider for the same direction for the current predicted speed of the one radar target than for the opposite direction. A radar target tracking program comprising:
6. The gate processing step sets a width of the velocity gate wider as the variance value of the currently observed Doppler velocity for the one of the radar target observation signal point clusters increases.
6. The radar target tracking program according to claim 5,
Citation Information
Patent Citations
Method and apparatus for tracking target
JP1999281737A
Radar device
JP2002156449A
Target tracking device
JP2002341025A
Equipment, method, and program for tracking target
JP2004012351A
Radar device
JP2012002686A
