Transverse target motion state estimation method, system and device based on polar coordinate system

By directly calculating the target radial velocity and cross-border velocity in vehicle-mounted radar under polar coordinate system, the accuracy loss problem caused by coordinate conversion is solved, and efficient target motion state estimation is achieved.

CN118938225APending Publication Date: 2024-11-12ROBERT BOSCH GMBH
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202310530157.4
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2023-05-11
Publication Date
2024-11-12

AI Technical Summary

Technical Problem

In vehicle-mounted radar, when target tracking is used using Kalman filtering algorithm, the nonlinear effect caused by coordinate system conversion leads to large tracking accuracy loss and calculation amount, making it difficult to accurately estimate the motion state across the target.

Method used

Directly use radar measurement data in polar coordinate systems, calculate the target's radial velocity and cross-border velocity through the Kalman filtering algorithm, avoid the accuracy loss caused by coordinate transformation, and improve the accuracy of state estimation.

Benefits of technology

It realizes the direct and accurate estimation of the cross-moving state of the target under the polar coordinate system, reduces the accuracy loss of coordinate transformation, reduces the calculation amount, and improves the accuracy and efficiency of target tracking.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118938225A_ABST
    Figure CN118938225A_ABST
Patent Text Reader

Abstract

The invention relates to a transverse target motion state estimation method based on a polar coordinate system, and the method comprises the steps: obtaining a target radial distance, a target radial speed and a target azimuth angle obtained based on the radar measurement data at a k moment, and exporting the radial acceleration of the target at the k moment; according to the target radial distance, the target radial speed, the radial acceleration and the azimuth angle at the moment k as well as a state equation and an observation equation of a Kalman filtering algorithm under a polar coordinate system, calculating the target radial speed subjected to filtering correction at the moment k; and calculating a target traverse velocity at the moment k based on the filter-corrected target radial velocity and the azimuth angle at the moment k; wherein the state variables of the state equation comprise the target radial distance, the target radial velocity, the radial acceleration and the azimuth angle, and wherein the observation variables of the observation equation comprise the target radial distance, the target radial velocity and the azimuth angle.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of speed detection technology, and in particular to a method, system, device and readable storage medium for estimating the motion state of a traversing target based on a polar coordinate system. Background Art

[0002] Compared with traditional radars such as ultrasonic radar and lidar, vehicle-mounted millimeter-wave radar has the advantages of small size, high resolution, and strong anti-interference ability, and is widely used in advanced driver assistance systems, adaptive cruise control and other fields. In daily driving environments, the speed of nearby vehicles (especially target vehicles crossing from the side lane to merge) is one of the important parameters of radar detection.

[0003] It is known that the speed of the target vehicle is tracked by the Kalman filter (KF) algorithm. Generally speaking, the effect of target tracking using the Kalman filter algorithm is affected by the state equation and the measurement equation, and both equation models depend on the selection of the coordinate system. In the application of millimeter wave radar target tracking, the traditional method generally observes the target in the polar coordinate system, and after the coordinate conversion, the Kalman filter algorithm is used in the rectangular coordinate system for target tracking. However, the inventors of the present application have noticed that nonlinear coordinate transformation will result in a loss of tracking accuracy. Summary of the invention

[0004] In view of the above problems in the prior art, the embodiments of the present application specification provide a method, system, device and readable storage medium for estimating the motion state of a crossing target based on a polar coordinate system, which avoids the loss of tracking accuracy caused by nonlinear coordinate transformation and can accurately estimate the motion state of the crossing target.

[0005] According to one aspect of an embodiment of the present invention, a method for estimating a motion state of a traversing target based on a polar coordinate system is provided, comprising:

[0006] Obtaining the radial distance of the target at time k, the radial velocity of the target at time k, and the azimuth of the target at time k based on the radar measurement data at time k, and deriving the radial acceleration of the target at time k;

[0007] Calculate the target radial velocity corrected by filtering at time k according to the target radial distance, the target radial velocity, the radial acceleration and the azimuth at time k and the state equation and observation equation of the Kalman filter algorithm in the polar coordinate system; and

[0008] Calculate the target traversing speed at time k based on the filtered corrected target radial speed and the azimuth angle at time k;

[0009] The state variables of the state equation include the target radial distance, the target radial velocity, the radial acceleration and the azimuth angle, and

[0010] Wherein, the observation variables of the observation equation include the target radial distance, the target radial velocity and the azimuth angle.

[0011] In one example, the method further includes:

[0012] Calculate the target radial distance corrected by filtering at time k according to the target radial distance, the target radial velocity, the radial acceleration and the azimuth at time k and the state equation and observation equation of the Kalman filter algorithm in the polar coordinate system; and

[0013] The target lateral distance at time k is calculated based on the filtered and corrected target radial distance and the azimuth angle at time k.

[0014] In this example, the state equation in the polar coordinate system is expressed as follows:

[0015] x k+1 =F k x k +w k

[0016] where x k is the state vector at time k, x k+1 is the state vector at time k+1, F k is the state transfer matrix at time k, w k is the system process noise matrix at time k, and

[0017] Among them, the state vector at time k is x k =[drk,vrk,ark,αk],

[0018] Wherein drk is the radial distance of the target at time k, vrk is the radial velocity of the target at time k, ark is the radial acceleration of the target at time k, and αk is the azimuth angle of the target at time k.

[0019] In this example, the observation equation in the polar coordinate system is expressed as follows:

[0020] z k =H k x k +v k

[0021] where x k is the state vector at time k, z k is the observation vector at time k, H kis the output transfer matrix at time k, v k is the measurement noise matrix at time k, and

[0022] Among them, the observation vector at time k is z k =[dr k ,vr k ,α k ],

[0023] Wherein drk is the radial distance of the target at time k, vrk is the radial velocity of the target at time k, and αk is the azimuth angle of the target at time k.

[0024] In one example, the method further includes: before estimating the motion state of the crossing target, determining whether the target is in a crossing scene based on at least one or more of the existence probability, longitudinal velocity, lateral velocity and variance thereof of the target.

[0025] In this example, the lateral speed of the target is the target traversing speed, and the variance is obtained in the process of calculating the target traversing speed.

[0026] According to another aspect of an embodiment of the present invention, there is provided a system for estimating a motion state of a traversing target based on a polar coordinate system, comprising:

[0027] A memory for storing instruction codes; and

[0028] at least one processor coupled to the memory for executing the stored instruction code, the instruction code being configured to:

[0029] Obtaining the radial distance of the target at time k, the radial velocity of the target at time k, and the azimuth of the target at time k based on the radar measurement data at time k, and deriving the radial acceleration of the target at time k;

[0030] Calculate the target radial velocity corrected by filtering at time k according to the target radial distance, the target radial velocity, the radial acceleration and the azimuth at time k and the state equation and observation equation of the Kalman filter algorithm in the polar coordinate system; and

[0031] Calculating the target traversing speed at time k based on the filtered corrected target radial speed and the azimuth at time k;

[0032] The state variables of the state equation include the target radial distance, the target radial velocity, the radial acceleration and the azimuth angle, and

[0033] Wherein, the observation variables of the observation equation include the target radial distance, the target radial velocity and the azimuth angle.

[0034] According to another aspect of an embodiment of the present invention, there is provided a device for estimating a motion state of a traversing target based on a polar coordinate system, comprising:

[0035] A data acquisition unit, used to obtain the radial distance of the target at time k, the radial velocity of the target at time k and the azimuth of the target at time k based on the radar measurement data at time k, and derive the radial acceleration of the target at time k;

[0036] a filtering unit, configured to calculate the target radial velocity corrected by filtering at time k according to the target radial distance, the target radial velocity, the radial acceleration and the azimuth at time k and the state equation and observation equation of the Kalman filter algorithm in the polar coordinate system; and

[0037] a calculation unit, configured to calculate a target crossing speed at time k based on the filtered and corrected target radial speed and the azimuth angle at time k;

[0038] The state variables of the state equation include the target radial distance, the target radial velocity, the radial acceleration and the azimuth angle, and

[0039] Wherein, the observation variables of the observation equation include the target radial distance, the target radial velocity and the azimuth angle.

[0040] According to another aspect of an embodiment of the present invention, a machine-readable storage medium is provided, on which executable instructions are stored, wherein the executable instructions, when executed, cause the machine to perform the method described in the preceding paragraphs.

[0041] From the above, it can be seen that the solution of the embodiment of the present application can directly use the measurement information in the polar coordinate system provided by the vehicle-mounted radar to directly and accurately estimate the lateral motion state of the target in the vehicle coordinates, reducing the accuracy loss caused by coordinate transformation and linear transformation, and at the same time, improving the accuracy of state estimation. BRIEF DESCRIPTION OF THE DRAWINGS

[0042] The features, characteristics, advantages and benefits of the present invention will become more apparent from the following detailed description taken in conjunction with the accompanying drawings.

[0043] Figure 1 An exemplary situation of two vehicles meeting each other while passing through a T-junction is shown;

[0044] Figure 2 shows an overall flow chart of a method 200 for estimating a target motion state according to an embodiment of the present invention;

[0045] Figure 3 An example diagram of a target state at time k according to an embodiment of the present invention is shown;

[0046] Figure 4 A schematic diagram of a target motion state estimation system 300 according to an embodiment of the present invention is shown;

[0047] Figure 5 A schematic diagram of a target motion state estimation device 400 according to an embodiment of the present invention is shown;

[0048] Figure 6 A comparison diagram of estimated and actual values ​​of target crossing speed according to one embodiment of the present invention is shown.

[0049] Reference numerals list :

[0050] 110: Vehicles

[0051] 120: Target vehicle

[0052] 200: Target motion state estimation method

[0053] 210: Start

[0054] 220: Identify the target crossing the scene

[0055] 230: Estimating target motion state in polar coordinates

[0056] 240: Transform the target motion state to rectangular coordinates

[0057] 250: End

[0058] 300: Target Motion State Estimation System

[0059] 310: Memory

[0060] 320: Processor

[0061] 400: Target motion state estimation device

[0062] 410: Data acquisition unit

[0063] 420: Judgment unit

[0064] 430: Filter unit

[0065] 440: Computational Unit DETAILED DESCRIPTION

[0066] Hereinafter, various embodiments of the present invention will be described in detail with reference to the accompanying drawings.

[0067] According to Figure 1In the direction shown, vehicle 110 travels from bottom to top to a T-junction, and at this time, vehicle 120 also travels from left to right to a T-junction. In the context of this application, vehicle 120 is defined as a target vehicle (ie, "target") relative to vehicle 110. Figure 1 An exemplary "crossing scenario" as referred to in the context of the present application is shown (i.e., the target vehicle 120 crosses the direction of travel of the vehicle 110). In another example, such a "crossing scenario" may also occur at an intersection. In yet another example, the "crossing scenario" may also indicate that the target vehicle changes from one lane to another lane traveling in the same direction (i.e., "changing lanes"). Those skilled in the art may also appreciate other "crossing scenarios".

[0068] In daily driving environments (such as vehicle assisted driving), vehicle 110 needs to detect and estimate the speed, position and other information of nearby target vehicles (such as vehicle 120) through its on-board radar (such as millimeter wave radar), perform target fusion and screening, and thus realize auxiliary functions such as automatic braking and cruising. In order to restore the true motion state of nearby target vehicles, it is not enough to simply estimate their radial speed and radial distance. In some scenarios, such as the target "crossing scenario", it is also necessary to accurately estimate the target vehicle's crossing speed, lateral distance and other information. When detecting a moving target vehicle, the on-board radar can estimate the target vehicle's radial speed and radial distance through the Doppler frequency shift generated by the target vehicle's motion, but the target vehicle's crossing speed and lateral distance are difficult to estimate.

[0069] In order to estimate the lateral velocity of a target based on radar data, a lateral velocity estimation method based on Kalman Filter (KF) is known. This method observes the target in the radar polar coordinate system, and then uses Kalman Filter to filter and predict the observed values ​​in the radar polar coordinate system in the rectangular coordinate system after coordinate conversion. However, the inventor of the present application has noticed that the coordinate conversion will lead to a loss in tracking accuracy, and at the same time, the calculation amount of this algorithm is relatively large.

[0070] In order to estimate the motion state of a target more accurately, the present invention aims to provide a method, system, device and readable storage medium for estimating the motion state of a crossing target based on a polar coordinate system, which avoids the tracking accuracy loss caused by nonlinear coordinate transformation, and can accurately estimate the motion state of the crossing target (including the target crossing speed and the target lateral distance), and at the same time, can greatly reduce the calculation amount of target tracking. In the context of this application, the term "target" can be any object that can be detected by a radar (e.g., a millimeter wave radar), including, but not limited to, a target (motor) vehicle. The "target" can also be a non-motor vehicle, a pedestrian, an animal, etc.

[0071] Now refer to the attached Figure 2Considering the amount of calculation required to perform Kalman filtering, the traversing target motion state estimation method 200 of the present invention, after starting 210, preferably in step 220, first determines the target (e.g., Figure 1 In the context of the present application, the term "target vehicle 120" refers to whether the target vehicle 120 is in a crossing scene (for example, the target vehicle 120 crosses its lane relative to the normally traveling vehicle 110). According to one embodiment of the present application, before actually performing the estimation of the motion state of the crossing target, it is determined whether the target is in a crossing scene based on at least one or more of the target's existence probability, longitudinal velocity, lateral velocity, and variance thereof. In the context of the present application, the term "target existence probability" refers to the target (for example, Figure 1 The probability that the target vehicle 120 in the image actually exists can be obtained by various known methods. In the context of this application, the term "lateral velocity of the target" refers to the lateral velocity of the target (e.g., Figure 1 The target vehicle 120 in the figure is perpendicular to the travel direction of the vehicle 110, which can be obtained by various known methods or by the estimation method described in detail below in this application. In the context of this application, the term "longitudinal speed of the target" refers to the longitudinal speed of the target (e.g., Figure 1 The target vehicle 120 in the figure is parallel to the speed of the driving direction of the vehicle 110, which can be obtained by various known methods. In the context of the present application, the term "variance" is used to measure the credibility of the calculated physical properties of the target (including, for example, the lateral speed of the target), which can be obtained by various known methods, or by the estimation method described in detail below in the present application. In one example, it is possible to determine whether the target is in the crossing scene based only on the lateral speed of the target. In another example, it is also possible to determine whether the target is in the crossing scene based on the lateral speed and longitudinal speed of the target. In yet another example, it is possible to better determine whether the target is in the crossing scene based on the probability of existence of the target, the longitudinal speed, the lateral speed and its variance. Based on the above-mentioned concept of the present invention, more parameters other than these four parameters can be used to determine whether the target is in the crossing scene.

[0072] If it is determined at step 220 that the target is not in a crossing scene, then the method 200 does not actually perform the crossing target motion state estimation described in detail below and the method ends 250 .

[0073] In another example, the method 200 may not include the step 220 of identifying a target crossing the scene, but directly perform the step 230 of estimating the motion state of the crossing target in the polar coordinate system.

[0074] If it is determined at step 220 that the target is in a traversing scene, then the method 200 jumps to step 230 to perform traversing target motion state estimation in a polar coordinate system.

[0075] Reference now Figure 3 Combined with Figure 1-2 , assuming that the radar (e.g., millimeter wave radar) of the vehicle 110 is at the origin of the coordinate system, the positive direction of the X-axis represents Figure 1 In the T-junction from bottom to top, the positive direction of the Y axis represents Figure 1 The vehicle 110 travels from bottom to top to the T-junction, that is, the vehicle 110 travels along the positive direction of the X axis. The target vehicle 120 is at Figure 1 The target vehicle 120 travels from left to right in the T-junction, that is, the target vehicle 120 travels along the negative direction of the Y axis.

[0076] The method for estimating the motion state of a traversing target based on a polar coordinate system according to the present invention includes: determining the target radial distance dr (relative to the vehicle 110 and its radar) of the target (e.g., the target vehicle 120) at time k according to the radar measurement data (e.g., point cloud data, etc.) of the vehicle 110 at time k (e.g., Figure 3 as shown) or dr k , the target radial velocity vr (relative to the vehicle 110 and its radar) of the target (e.g., the target vehicle 120) at time k (e.g., Figure 3 shown) or VR k , and the azimuth angle α (e.g., target vehicle 120) of the target at time k Figure 3 as shown) or α k . These physical quantities can be obtained by various known techniques. In the context of the present application, the term "azimuth" refers to the angle between the target radial velocity vr of the target (e.g., the target vehicle 120) and the driving direction of the vehicle 110. Further, based on the radar measurement data at time k, the radial acceleration ar (not shown) of the target (e.g., the target vehicle 120) at time k can also be derived. In another example, based on the radar measurement data at time k, other physical quantities of the target (e.g., the target vehicle 120) at time k can also be derived.

[0077] In this example, according to the target radial distance dr at time k k , the target radial velocity vr k , the radial acceleration ar k and the azimuth angle α k As well as the state equation and observation equation of the Kalman filter algorithm in the polar coordinate system, calculate the radial velocity of the target after filtering correction

[0078] Kalman Filter (KF) is the best linear filter under the minimum mean square error criterion. The estimated signal is regarded as the output of a linear system under the action of Gaussian white noise, and its output is given in the time domain by the state transfer equation, observation equation and white noise, so it is also applicable to non-stationary random signals. Its calculation process is constantly "predicting-correcting". Each iteration only needs the estimated value of the previous moment and the observed value of the current moment to calculate the state estimate of the current moment, without storing a large amount of data.

[0079] Specifically, let the state variable x of the target (e.g., target vehicle 120) at time k be k =[drk,vrk,ark,αk], observed variable z k =[drk,vrk,αk], where drk is the radial distance of the target at time k, vrk is the radial velocity of the target at time k, ark is the radial acceleration of the target at time k, and αk is the azimuth of the target at time k.

[0080] The state equation in polar coordinates is expressed as follows:

[0081] x k+1 =F k x k +w k (1)

[0082] where x k is the state vector at time k, x k+1 is the state vector at time k+1, F k is the state transfer matrix at time k, w k is the system process noise matrix (e.g., Gaussian white noise) at time k.

[0083] The observation equation in polar coordinates is expressed as follows:

[0084] Z k =H k x k +v k (2)

[0085] where x k is the state vector at time k, z k is the observation vector at time k, H k is the output transfer matrix at time k, v k is the measurement noise matrix at time k (which is independent of the system process noise matrix, for example, Gaussian white noise).

[0086] State prediction value:

[0087]

[0088] in is the predicted state vector at time k, is the predicted state vector at time k+1.

[0089] Prior covariance matrix:

[0090]

[0091] in is the estimated value of the covariance matrix used at the last k moment, P k+1|k is the k-time prior covariance matrix, Yes F k The transposed matrix, Q k is the system process noise matrix at time k (corresponding to w in formula (1) k ).

[0092] Kalman gain matrix:

[0093]

[0094] Among them, H k is the observation matrix at time k (corresponding to z in formula (2) k ), is the transpose of the observation matrix at time k, R k is the observation noise matrix at time k (corresponding to v in formula (2) k ), K k is the Kalman gain matrix at time k

[0095] Posterior state estimate:

[0096]

[0097] in is the target motion state after filtering and correction at time k.

[0098] The posterior covariance matrix:

[0099] P k+1|k+1 =(I = K k H k ) k+1|k (7)

[0100] in:

[0101]

[0102]

[0103]

[0104]

[0105] where q is the process noise power density.

[0106] Accordingly, in this example, according to the target radial distance dr at time k k , the target radial velocity vr k , the radial acceleration ar k and the azimuth angle α k As well as the state equation and observation equation of the Kalman filter algorithm in the polar coordinate system, it can also calculate the radial distance of the target corrected by filtering.

[0107] Then, based on the filtered corrected target radial velocity and the azimuth angle α at time k k Calculate the target crossing speed v at time k y|k :

[0108]

[0109] Accordingly, in this example, based on the filtered corrected target radial distance and the azimuth angle α at time k k Calculate the target lateral distance d at time k y|k :

[0110]

[0111] After estimating the motion state of the target (eg, target vehicle 120 ) in the polar coordinate system (eg, including target crossing speed and target lateral distance) in step 230 , the target motion state in the polar coordinate system is converted to a Cartesian coordinate system or a rectangular coordinate system in step 240 , and the method ends 250 .

[0112] In another example, after estimating the target motion state in the polar coordinate system in step 230 , the method may directly end 250 .

[0113] Figure 4 A schematic diagram of a target motion state estimation system 300 according to an embodiment of the present invention is shown. Figure 2 The system 300 is described in detail with reference to the method 200 .

[0114] System 300 includes a memory 310 and at least one processor 320. Figure 4 As shown, at least one processor 320 is coupled to a memory 310. The memory 310 is configured to store instruction codes. When the instruction codes are executed, the at least one processor 320 executes Figure 2Method 200 is shown.

[0115] Specifically, the instruction code may enable the at least one processor 320 to:

[0116] Get the target radial distance dr at time k based on the radar measurement data at time k k 、The target radial velocity vr at time k k and the target's azimuth α at time k k , and derive the radial acceleration ar of the target at time k k ;

[0117] According to the target radial distance dr at time k k , the target radial velocity vr k , the radial acceleration ar k and the azimuth angle α k As well as the state equation and observation equation of the Kalman filter algorithm in the polar coordinate system, calculate the radial velocity of the target after filtering correction and

[0118] Based on the filtered corrected target radial velocity and the azimuth angle α at time k k Calculate the target crossing speed v at time k y|k ;

[0119] Wherein, the state variables of the state equation include the target radial distance dr k , the target radial velocity vr k , the radial acceleration ar k and the azimuth angle α k ,and

[0120] The observed variables of the observation equation include the target radial distance dr k , the target radial velocity vr k and the azimuth angle α k .

[0121] In one example, the instruction code is further configured to:

[0122] According to the target radial distance dr at time k k , the target radial velocity vr k , the radial acceleration ar k and the azimuth angle α k As well as the state equation and observation equation of the Kalman filter algorithm in the polar coordinate system, calculate the radial distance of the target corrected by filtering and

[0123] Based on the filtered corrected target radial distance and the azimuth angle α at time k k Calculate the target lateral distance d at time k y|k .

[0124] In this example, the state equation in the polar coordinate system is expressed as follows:

[0125] x k+1 =F k x k +w k

[0126] where x k is the state vector at time k, x k+1 is the state vector at time k+1, F k is the state transfer matrix at time k, w k is the system process noise matrix at time k, and

[0127] Among them, the state vector at time k is x k =[drk,vrk,ark,αk],

[0128] Wherein drk is the radial distance of the target at time k, vrk is the radial velocity of the target at time k, ark is the radial acceleration of the target at time k, and αk is the azimuth angle of the target at time k.

[0129] In this example, the observation equation in the polar coordinate system is expressed as follows:

[0130] Z k =H k x k +v k

[0131] where x k is the state vector at time k, z k is the observation vector at time k, H k is the output transfer matrix at time k, v k is the measurement noise matrix at time k, and

[0132] Among them, the observation vector at time k is z k =[drk,vrk,αk],

[0133] Wherein drk is the radial distance of the target at time k, vrk is the radial velocity of the target at time k, and αk is the azimuth angle of the target at time k.

[0134] In one example, the instruction code is further configured to:

[0135] Before estimating the motion state of the traversing target, it is determined whether the target is in the traversing scene based on at least one or more of the existence probability, longitudinal velocity, lateral velocity and variance thereof of the target.

[0136] In this example, the lateral speed of the target is the target traversing speed, and the variance is obtained in the process of calculating the target traversing speed.

[0137] Figure 5 FIG. 4 is a schematic diagram showing a target motion state estimation device 400 according to an embodiment of the present invention. Figure 5 The device 400 shown can be implemented by software, hardware, or a combination of software and hardware. Figure 5 The device 400 shown can be integrated, for example, in Figure 4 system 300.

[0138] like Figure 5 As shown, the device 400 for estimating the motion state of a traversing target based on a polar coordinate system includes a data acquisition unit 410 , a filtering unit 430 and a calculation unit 440 .

[0139] The data acquisition unit 410 is configured to obtain the target radial distance dr at time k based on the radar measurement data at time k. k 、The target radial velocity vr at time k k and the target's azimuth α at time k k , and derive the radial acceleration ar of the target at time k k .

[0140] The filtering unit 430 is configured to calculate the target radial distance dr at time k. k , the target radial velocity vr k , the radial acceleration ar k and the azimuth angle α k As well as the state equation and observation equation of the Kalman filter algorithm in the polar coordinate system, calculate the radial velocity of the target after filtering correction In this example, the state variables of the state equation include the target radial distance dr k , the target radial velocity vr k , the radial acceleration ar k and the azimuth angle α k , and the observation variables of the observation equation include the target radial distance dr k , the target radial velocity vr k and the azimuth angle α k .

[0141] The calculation unit 440 is configured to calculate the target radial velocity based on the filtered corrected target radial velocity. and the azimuth angle α at time k k Calculate the target crossing speed v at time k y|k .

[0142] In another example, the filtering unit 430 is further configured to: k , the target radial velocity vr k , the radial acceleration ar k and the azimuth angle α k As well as the state equation and observation equation of the Kalman filter algorithm in the polar coordinate system, calculate the radial distance of the target corrected by filtering The calculation unit 440 is further configured to calculate the target radial distance based on the filtered corrected target radial distance. and the azimuth angle α at time k k Calculate the target lateral distance d at time k y|k .

[0143] In this example, the state equation in the polar coordinate system is expressed as follows:

[0144] x k+1 =F k x k +w k

[0145] where x k is the state vector at time k, x k+1 is the state vector at time k+1, F k is the state transfer matrix at time k, w k is the system process noise matrix at time k, and

[0146] Among them, the state vector at time k is x k =[drk,vrk,ark,αk],

[0147] Wherein drk is the radial distance of the target at time k, vrk is the radial velocity of the target at time k, ark is the radial acceleration of the target at time k, and αk is the azimuth angle of the target at time k.

[0148] In this example, the observation equation in the polar coordinate system is expressed as follows:

[0149] Z k ==H k x k +v k

[0150] where x k is the state vector at time k, z kis the observation vector at time k, H k is the output transfer matrix at time k, v k is the measurement noise matrix at time k, and

[0151] Among them, the observation vector at time k is z k =[drk,vrk,αk],

[0152] Wherein drk is the radial distance of the target at time k, vrk is the radial velocity of the target at time k, and αk is the azimuth angle of the target at time k.

[0153] In another example, the device 400 further includes a judgment unit 420. The judgment unit 420 is configured to judge whether the target is in a crossing scene based on at least one or more of the existence probability, longitudinal speed, lateral speed and variance of the target before estimating the motion state of the crossing target. In this example, the lateral speed of the target is the target crossing speed, and the variance is obtained in the process of calculating the target crossing speed.

[0154] According to another embodiment of the present specification, a machine-readable storage medium is provided, on which executable instructions are stored, wherein when the executable instructions are executed, the machine executes Figure 2 Method 200 is shown.

[0155] Simulation Analysis

[0156] In the simulation, the radar transmission waveform center frequency f0 is 77GHz, the frequency modulation bandwidth B is 1.5GHz, the chirp period Tc is 20μs, and the time division multiplexing (TDM) transmission mode is adopted. The target observation time is 5s, the observation time interval Δt is 0.1s, and 50 iterations are performed. Figure 6 The estimated value (dashed line in the figure) and the actual value (solid line in the figure) of the target (vehicle) crossing speed estimated according to the method proposed in this application are shown. Figure 6 As shown, the method for estimating the speed of a crossing target based on a polar coordinate system of the present application has high estimation accuracy.

[0157] The specific embodiments described above in conjunction with the accompanying drawings describe exemplary embodiments, but do not represent all embodiments that can be implemented or fall within the scope of protection of the claims. The term "exemplary" used throughout this specification means "used as an example, instance or illustration" and does not mean "preferred" or "having advantages" over other embodiments. For the purpose of providing an understanding of the described technology, the specific embodiments include specific details. However, these technologies can be implemented without these specific details. In some instances, in order to avoid making the concepts of the described embodiments difficult to understand, well-known structures and devices are shown in block diagram form.

[0158] The above description of the present disclosure is provided to enable any person of ordinary skill in the art to implement or use the present disclosure. Various modifications to the present disclosure will be apparent to those of ordinary skill in the art, and the general principles defined herein may be applied to other variations without departing from the scope of protection of the present disclosure. Therefore, the present disclosure is not limited to the examples and designs described herein, but is consistent with the widest range of principles and novel features disclosed herein.

Claims

1. A method for estimating the motion state of a traversing target based on a polar coordinate system, comprising: The radial distance of the target at time k (dr) is obtained based on the radar measurement data at time k. k ), target radial velocity at time k (vr k ) and the target’s azimuth (α k ), and derive the radial acceleration of the target at time k (ar k ); According to the target radial distance (dr k ), the target radial velocity (vr k ), the radial acceleration (ar k ) and the azimuth angle (α k ) and the state equation and observation equation of the Kalman filter algorithm in the polar coordinate system, calculate the target radial velocity corrected by filtering at time k and Based on the filtered corrected target radial velocity and the azimuth angle (α k ) Calculate the target crossing speed (v) at time k y|k ); The state variables of the state equation include the target radial distance (drk), the target radial velocity (vr k ), the radial acceleration (ar k ) and the azimuth angle (α k ),and The observed variables of the observation equation include the target radial distance (dr k ), the target radial velocity (vr k ) and the azimuth angle (α k ).

2. The method of claim 1, further comprising: According to the target radial distance (drk) and the target radial velocity (vr k ), the radial acceleration (ar k ) and the azimuth angle (α k ) and the state equation and observation equation of the Kalman filter algorithm in the polar coordinate system, calculate the radial distance of the target corrected by filtering at time k and Based on the filtered corrected target radial distance and the azimuth angle (α k ) Calculate the target lateral distance (d) at time k y|k ).

3. The method according to claim 1 or 2, in, The state equation in polar coordinate system is expressed as follows: x k+1 =F k x k +w k where x k is the state vector at time k, x k+1 is the state vector at time k+1, F k is the state transfer matrix at time k, w k is the system process noise matrix at time k, and Among them, the state vector at time k is x k =[drk,vrk,ark,αk], Wherein drk is the radial distance of the target at time k, vrk is the radial velocity of the target at time k, ark is the radial acceleration of the target at time k, and αk is the azimuth angle of the target at time k.

4. The method according to claim 1 or 2, in, The observation equation in polar coordinate system is expressed as follows: z k =H k x k +v k where x k is the state vector at time k, z k is the observation vector at time k, H k is the output transfer matrix at time k, v k is the measurement noise matrix at time k, and Among them, the observation vector at time k is z k =[drk,vrk,αk], Wherein drk is the radial distance of the target at time k, vrk is the radial velocity of the target at time k, and αk is the azimuth angle of the target at time k.

5. The method according to claim 1 or 2, further comprising: Before estimating the motion state of the traversing target, it is determined whether the target is in the traversing scene based on at least one or more of the existence probability, longitudinal velocity, lateral velocity and variance thereof of the target.

6. The method of claim 5, wherein: The lateral speed of the target is the target traversing speed, and the variance is obtained in the process of calculating the target traversing speed.

7. A traversing target motion state estimation system (300) based on a polar coordinate system, comprising: A memory (310) for storing instruction codes; as well as at least one processor (320) coupled to the memory for executing the stored instruction code, the instruction code being configured to: The radial distance of the target at time k (dr) is obtained based on the radar measurement data at time k. k ), target radial velocity at time k (vr k ) and the target’s azimuth (α k ), and derive the radial acceleration of the target at time k (ar k ); According to the target radial distance (drk) and the target radial velocity (vr k ), the radial acceleration (ar k ) and the azimuth angle (α k ) and the state equation and observation equation of the Kalman filter algorithm in the polar coordinate system, calculate the target radial velocity corrected by filtering at time k and Based on the filtered corrected target radial velocity and the azimuth angle (α k ) Calculate the target crossing speed (v) at time k y|k ); The state variables of the state equation include the target radial distance (drk), the target radial velocity (vr k ), the radial acceleration (ar k ) and the azimuth angle (α k ),and The observed variables of the observation equation include the target radial distance (dr k ), the target radial velocity (vr k ) and the azimuth angle (α k ).

8. The system of claim 7, wherein: The instruction code is also configured to: According to the target radial distance (dr k ), the target radial velocity (vr k ), the radial acceleration (ar k ) and the azimuth angle (α k ) and the state equation and observation equation of the Kalman filter algorithm in the polar coordinate system, calculate the radial distance of the target corrected by filtering at time k and Based on the filtered corrected target radial distance and the azimuth angle (α k ) Calculate the target lateral distance (d) at time k y|k ).

9. The system according to claim 7 or 8, in, The state equation in polar coordinate system is expressed as follows: x k+1 =F k x k +w k where x k is the state vector at time k, x k+1 is the state vector at time k+1, F k is the state transfer matrix at time k, w k is the system process noise matrix at time k, and Among them, the state vector at time k is x k =[drk,vrk,ark,αk], Wherein drk is the radial distance of the target at time k, vrk is the radial velocity of the target at time k, ark is the radial acceleration of the target at time k, and αk is the azimuth angle of the target at time k.

10. The system according to claim 7 or 8, in, The observation equation in polar coordinate system is expressed as follows: z k =H k x k +v k where x k is the state vector at time k, z k is the observation vector at time k, H k is the output transfer matrix at time k, v k is the measurement noise matrix at time k, and Among them, the observation vector at time k is z k =[drk,vrk,αk], Wherein drk is the radial distance of the target at time k, vrk is the radial velocity of the target at time k, and ak is the azimuth angle of the target at time k.

11. The system of claim 7 or 8, wherein: The instruction code is also configured to: Before estimating the motion state of the traversing target, it is determined whether the target is in the traversing scene based on at least one or more of the existence probability, longitudinal velocity, lateral velocity and variance thereof of the target.

12. The system of claim 11, wherein: The lateral speed of the target is the target traversing speed, and the variance is obtained in the process of calculating the target traversing speed.

13. A device (400) for estimating a motion state of a traversing target based on a polar coordinate system, comprising: A data acquisition unit (410) is used to obtain a target radial distance (dr) at time k based on radar measurement data at time k. k ), target radial velocity at time k (vr k ) and the target’s azimuth (α k ), and derive the radial acceleration of the target at time k (ar k ); A filtering unit (430) is used to filter the target radial distance (dr k ), the target radial velocity (vr k ), the radial acceleration (ar k ) and the azimuth angle (a k ) and the state equation and observation equation of the Kalman filter algorithm in the polar coordinate system, calculate the target radial velocity corrected by filtering at time k as well as A calculation unit (440) is used to calculate the target radial velocity based on the filtered corrected target radial velocity. and the azimuth angle (α k ) Calculate the target crossing speed (v) at time k y|k ); The state variables of the state equation include the target radial distance (dr k ), the target radial velocity (vr k ), the radial acceleration (ar k ) and the azimuth angle (α k ),and The observed variables of the observation equation include the target radial distance (dr k ), the target radial velocity (vr k ) and the azimuth angle (α k ).

14. The device of claim 13, wherein: The filtering unit is also used to calculate the target radial distance (dr k ), the target radial velocity (vr k ), the radial acceleration (ar k ) and the azimuth angle (α k ) and the state equation and observation equation of the Kalman filter algorithm in the polar coordinate system, calculate the radial distance of the target corrected by filtering at time k and The calculation unit is further configured to calculate the target radial distance based on the filtered corrected target radial distance. and the azimuth angle (α k ) Calculate the target lateral distance (d) at time k y|k ).

15. The device according to claim 13 or 14, in, The state equation in polar coordinate system is expressed as follows: x k+1 =F k x k +w k where x k is the state vector at time k, x k+1 is the state vector at time k+1, F k is the state transfer matrix at time k, w k is the system process noise matrix at time k, and Among them, the state vector at time k is x k =[drk,vrk,ark,ak], Wherein drk is the radial distance of the target at time k, vrk is the radial velocity of the target at time k, ark is the radial acceleration of the target at time k, and ak is the azimuth of the target at time k.

16. The device according to claim 13 or 14, in, The observation equation in polar coordinate system is expressed as follows: z k =H k x k +v k where x k is the state vector at time k, z k is the observation vector at time k, H k is the output transfer matrix at time k, v k is the measurement noise matrix at time k, and Among them, the observation vector at time k is z k =[drk,vrk,αk], Wherein drk is the radial distance of the target at time k, vrk is the radial velocity of the target at time k, and αk is the azimuth angle of the target at time k.

17. The apparatus of claim 13 or 14, further comprising: A judgment unit (420) is used to judge whether the target is in a crossing scene based on at least one or more of the target's existence probability, longitudinal speed, lateral speed and variance thereof before estimating the motion state of the crossing target.

18. The device of claim 17, wherein: The lateral speed of the target is the target traversing speed, and the variance is obtained in the process of calculating the target traversing speed.

19. A machine-readable storage medium having executable instructions stored thereon, wherein: When the executable instructions are executed, the machine performs the method of any one of claims 1-6.