CN116224320B - A radar target tracking method that processes Doppler measurements in polar coordinates - Google Patents

A radar target tracking method that processes Doppler measurements in polar coordinates Download PDF

Info

Publication number
CN116224320B
CN116224320B CN202310136909.9A CN202310136909A CN116224320B CN 116224320 B CN116224320 B CN 116224320B CN 202310136909 A CN202310136909 A CN 202310136909A CN 116224320 B CN116224320 B CN 116224320B
Authority
CN
China
Prior art keywords
linear motion
coordinate system
state
measurement
motion model
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202310136909.9A
Other languages
Chinese (zh)
Other versions
CN116224320A (en
Inventor
赵宣植
赵显�
刘增力
张文
刘康
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Kunming University of Science and Technology
Original Assignee
Kunming University of Science and Technology
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Kunming University of Science and Technology filed Critical Kunming University of Science and Technology
Priority to CN202310136909.9A priority Critical patent/CN116224320B/en
Publication of CN116224320A publication Critical patent/CN116224320A/en
Priority to US18/450,434 priority patent/US20240094343A1/en
Application granted granted Critical
Publication of CN116224320B publication Critical patent/CN116224320B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/66Radar-tracking systems; Analogous systems
    • G01S13/72Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar
    • G01S13/723Radar-tracking systems; Analogous systems for two-dimensional tracking, e.g. combination of angle and range tracking, track-while-scan radar by using numerical data
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S13/00Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
    • G01S13/02Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
    • G01S13/50Systems of measurement based on relative movement of target
    • G01S13/58Velocity or trajectory determination systems; Sense-of-movement determination systems
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S7/00Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
    • G01S7/02Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
    • G01S7/41Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00 using analysis of echo signal for target characterisation; Target signature; Target cross-section
    • G01S7/418Theoretical aspects
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02ATECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
    • Y02A90/00Technologies having an indirect contribution to adaptation to climate change
    • Y02A90/10Information and communication technologies [ICT] supporting adaptation to climate change, e.g. for weather forecasting or climate simulation

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar Systems Or Details Thereof (AREA)

Abstract

The invention discloses a method for realizing target tracking by Doppler measurement under a polar coordinate system, and relates to the field of Doppler radar target tracking. The motion equation in the Cartesian coordinate system is converted into a polar coordinate system, doppler measurement is introduced, and the Doppler measurement is combined with the radial distance and azimuth angle equivalent value to form a state vector, so that the state and observation are in a linear relation, and the posterior estimation of the target state at each moment is obtained through the least square error linear fusion in the fusion stage, so that the influence of nonlinear filtering on estimation precision is avoided, and the target tracking performance is effectively improved.

Description

一种极坐标系下处理多普勒量测的雷达目标跟踪方法A radar target tracking method for processing Doppler measurements in polar coordinates

技术领域Technical Field

本发明涉及多普勒雷达目标跟踪领域,特别涉及一种极坐标系下处理多普勒量测的雷达目标跟踪方法。The invention relates to the field of Doppler radar target tracking, and in particular to a radar target tracking method for processing Doppler measurements in a polar coordinate system.

背景技术Background Art

多普勒雷达是侦测目标移动的常见方法,可利用多普勒效应对运动目标进行检测并跟踪。因其工作体制和系统环境的特殊性,可获得目标到观测点的距离、方位角、多普勒量测(径向速度)等信息。目前,多普勒雷达在机载火力控制、防空警戒、指挥系统等领域中已被广泛运用。Doppler radar is a common method for detecting target movement. It can detect and track moving targets using the Doppler effect. Due to the particularity of its working system and system environment, it can obtain information such as the distance from the target to the observation point, azimuth, and Doppler measurement (radial velocity). At present, Doppler radar has been widely used in the fields of airborne fire control, air defense warning, and command systems.

在实际目标跟踪应用中,目标运动方程通常在笛卡尔坐标系中建模,而雷达测量通常在极坐标下获得。因此,解决目标状态和测量非线性是目标跟踪的主要问题。由于多普勒量测的强非线性,当目标跟踪中加入这一测量信息时,问题变得更加复杂,在包含杂波的环境下,杂波会产生大量虚假信息,量测的非线性无疑会增加跟踪系统复杂度、导致算法估计性能下降。目前,大部分跟踪系统中仅考虑了雷达的位置量测(距离和角度),并没有充分利用多普勒量测,事实上,包含目标速度信息的多普勒量测也具有提高跟踪性能的潜在能力。多普勒量测通常是唯一包含目标速度信息的测量,从信息的角度来看,更多的观测信息有助于提高精度,且研究已经表明,充分利用多普勒量测可以有效提高目标的跟踪精度。In actual target tracking applications, the target motion equation is usually modeled in a Cartesian coordinate system, while radar measurements are usually obtained in polar coordinates. Therefore, solving the target state and measurement nonlinearity is the main problem in target tracking. Due to the strong nonlinearity of Doppler measurement, when this measurement information is added to target tracking, the problem becomes more complicated. In an environment containing clutter, clutter will generate a lot of false information. The nonlinearity of measurement will undoubtedly increase the complexity of the tracking system and lead to a decrease in the algorithm estimation performance. At present, most tracking systems only consider the radar position measurement (distance and angle) and do not make full use of Doppler measurement. In fact, Doppler measurement containing target velocity information also has the potential to improve tracking performance. Doppler measurement is usually the only measurement that contains target velocity information. From the perspective of information, more observation information helps to improve accuracy, and research has shown that making full use of Doppler measurement can effectively improve the tracking accuracy of the target.

为解决带多普勒量测的雷达目标跟踪问题,通常采用以下非线性滤波:To solve the problem of radar target tracking with Doppler measurement, the following nonlinear filtering is usually used:

(1)序贯扩展卡尔曼滤波(SEKF),该方法先对位置量测进行线性的去偏量测转换滤波,再对多普勒量测用扩展卡尔曼滤波直接进行处理。缺点是扩展卡尔曼滤波线性化过程中舍弃了二阶以上的高阶项,当遇到多普勒量测这样强非线性时,引起的误差较大,甚至会出现滤波发散的情况。(1) Sequential Extended Kalman Filter (SEKF): This method first performs a linear debiasing measurement conversion filter on the position measurement, and then directly processes the Doppler measurement using the extended Kalman filter. The disadvantage is that the extended Kalman filter discards higher-order terms above the second order during the linearization process. When encountering strong nonlinearities such as Doppler measurements, the error caused is large, and even filter divergence may occur.

(2)序贯无迹卡尔曼滤波(SUKF),该方法基于无迹卡尔曼滤波对位置量测和多普勒量测进行顺序处理。缺点是无迹卡尔曼滤波参数的选择问题尚没有得到完全解决,而且其滤波效果与扩展卡尔曼滤波一样也受到滤波初值的影响。(2) Sequential Unscented Kalman Filter (SUKF): This method processes the position measurement and Doppler measurement sequentially based on the unscented Kalman filter. The disadvantage is that the problem of selecting the parameters of the unscented Kalman filter has not been completely solved, and its filtering effect is also affected by the initial value of the filter like the extended Kalman filter.

(3)基于预测值量测转换的静态融合(SFPRE),该方法为了减弱多普勒量测与目标状态之间的强非线性关系,用距离量测和多普勒量测的乘积构建多普勒伪量测,位置量测和多普勒伪量测分别使用无偏量测转换和去偏量测转换进行处理。缺点是构造的伪量测并非真实的多普勒量测,且在测量转换过程中会出现偏差,导致卡尔曼滤波器性能的退化。(3) Static fusion based on predicted value measurement conversion (SFPRE): In order to weaken the strong nonlinear relationship between Doppler measurement and target state, this method constructs Doppler pseudo-measurement by multiplying the distance measurement and Doppler measurement. Position measurement and Doppler pseudo-measurement are processed by unbiased measurement conversion and debiased measurement conversion, respectively. The disadvantage is that the constructed pseudo-measurement is not the real Doppler measurement, and there will be deviations in the measurement conversion process, which will lead to the degradation of Kalman filter performance.

在上述的滤波中,对于非线性的观测模型,采取一些方法如泰勒展开、sigma点去线性化,从而导致部分信息缺失。之外,由于采取额外的方法将非线性关系近似化线性关系,计算复杂度也比标准卡尔曼滤波高。转换测量卡尔曼滤波虽然在转换后可以使用标准卡尔曼处理,但在其转换过程中,转换状态一直包含噪声,影响了目标定位的精度。In the above filtering, for nonlinear observation models, some methods such as Taylor expansion and sigma point delinearization are adopted, which leads to partial information loss. In addition, due to the additional method of approximating nonlinear relationships to linear relationships, the computational complexity is also higher than that of standard Kalman filtering. Although the conversion measurement Kalman filter can use standard Kalman processing after conversion, the conversion state always contains noise during its conversion process, which affects the accuracy of target positioning.

因此,如何消除多普勒量测的强非线性对跟踪精度带来的影响是本领域技术人员亟需解决的问题。Therefore, how to eliminate the influence of the strong nonlinearity of Doppler measurement on tracking accuracy is an urgent problem to be solved by those skilled in the art.

发明内容Summary of the invention

有鉴于此,本发明提供了一种极坐标系下利用多普勒量测实现目标跟踪的方法,解决现有技术中存在的技术问题。In view of this, the present invention provides a method for realizing target tracking by using Doppler measurement in a polar coordinate system, so as to solve the technical problems existing in the prior art.

为了实现上述目的,本发明采用如下技术方案:In order to achieve the above object, the present invention adopts the following technical solution:

一种极坐标系下利用多普勒量测实现目标跟踪的方法,包括以下步骤:A method for realizing target tracking by using Doppler measurement in a polar coordinate system comprises the following steps:

步骤1、确定极坐标下含有径向速度并与多普勒雷达测量呈线性关系的匀速直线运动模型和匀加速直线运动模型的状态方程;Step 1, determine the state equations of the uniform linear motion model and the uniform accelerated linear motion model containing radial velocity in polar coordinates and having a linear relationship with Doppler radar measurement;

步骤2、将匀速直线运动模型和匀加速直线运动模型笛卡尔坐标系下的过程噪声转换到极坐标,使用Unscented变换计算过程噪声的均值和协方差;Step 2: Convert the process noise in the Cartesian coordinate system of the uniform linear motion model and the uniformly accelerated linear motion model to polar coordinates, and use the Unscented transformation to calculate the mean and covariance of the process noise;

步骤3、基于笛卡尔坐标下的先验信息,对获得的匀速直线运动模型和匀加速直线运动模型的状态方程进行状态初始化,利用蒙特卡洛方法初始化目标在极坐标中的目标状态和协方差;Step 3: Based on the prior information in Cartesian coordinates, the state equations of the uniform linear motion model and the uniform accelerated linear motion model are initialized, and the target state and covariance of the target in polar coordinates are initialized using the Monte Carlo method;

步骤4、在当前时刻,根据运动目标加速度的先验信息选择运动模型,计算极坐标下状态方程的状态转移矩阵,过程噪声驱动矩阵和过程噪声的统计特性;Step 4: At the current moment, a motion model is selected according to the prior information of the acceleration of the moving target, and the state transfer matrix of the state equation in polar coordinates, the process noise driving matrix and the statistical characteristics of the process noise are calculated;

步骤5、在极坐标下对目标状态和协方差一步预测;Step 5: One-step prediction of the target state and covariance in polar coordinates;

步骤6、结合多普勒雷达测量值,通过最小方差线性融合完成当前时刻目标跟踪状态和协方差的更新;Step 6: Combine the Doppler radar measurement value and complete the update of the target tracking state and covariance at the current moment through minimum variance linear fusion;

步骤7、循环执行步骤4-6,直至目标跟踪结束。Step 7: Loop through steps 4-6 until target tracking is complete.

可选的,确定极坐标下匀速直线运动模型的状态方程的具体过程为:将笛卡尔坐标系下的状态方程转换到极坐标系下,含有径向速度的匀速直线运动模型在极坐标系中的状态方程表示为:Optionally, the specific process of determining the state equation of the uniform linear motion model in polar coordinates is: converting the state equation in the Cartesian coordinate system to the polar coordinate system, and the state equation of the uniform linear motion model containing radial velocity in the polar coordinate system is expressed as:

ηRV-CV(k+1)=ΦRV-CV(k)ηRV-CV(k)+ΓRV-CV(k)ωRV-CV(k);η RV-CV (k+1)=Φ RV-CV (k) η RV-CV (k) + Γ RV-CV (k) ω RV-CV (k);

式中,表示k时刻目标的状态,θ(k)、r(k)分别为方位角量测真实值、距离量测真实值,分别为角速度和径向速度;代表r(k),之间的协方差,Var[r(k)]分别代表r(k)的方差,ΦRV-CV(k)为状态转移矩阵,ΓRV-CV(k)为过程噪声驱动矩阵,ωRV-CV(k)为过程噪声。In the formula, represents the state of the target at time k, θ(k) and r(k) are the true values of azimuth and distance respectively. are the angular velocity and radial velocity respectively; represents r(k), The covariance between Var[r(k)] represents where Φ RV-CV (k) is the variance of r(k), Φ RV -CV (k) is the state transfer matrix, Γ RV-CV (k) is the process noise driving matrix, and ω RV-CV (k) is the process noise.

可选的,确定极坐标下匀加速直线运动模型的状态方程的具体过程为:将笛卡尔坐标系下的状态方程转换到极坐标系下,含有径向速度的匀加速直线运动模型在极坐标系中的状态方程表示为:Optionally, the specific process of determining the state equation of the uniformly accelerated linear motion model in polar coordinates is: converting the state equation in the Cartesian coordinate system to the polar coordinate system, and the state equation of the uniformly accelerated linear motion model containing radial velocity in the polar coordinate system is expressed as:

ηRV-CA(k+1)=ΦRV-CA(k)ηRV-CA(k)+ΓRV-CA(k)ωRV-CA(k);η RV-CA (k+1)=Φ RV-CA (k)n RV -CA (k)+Γ RV-CA (k)ω RV-CA (k);

式中,表示k时刻目标的状态,T为多普勒雷达采样时间间隔,θ(k)、r(k)分别为方位角量测真实值、距离量测真实值,分别为角速度和径向速度,分别为角加速度和径向加速度;代表r(k),之间的协方差,代表的方差,ΦRV-CA(k)为状态转移矩阵,ΓRV-CA(k)为过程噪声驱动矩阵,ωRV-CA(k)为过程噪声。In the formula, represents the state of the target at time k, T is the sampling time interval of the Doppler radar, θ(k) and r(k) are the true values of azimuth measurement and distance measurement, respectively. are the angular velocity and radial velocity respectively, are angular acceleration and radial acceleration respectively; represents r(k), The covariance between represent , Φ RV-CA (k) is the state transfer matrix, Γ RV-CA (k) is the process noise driving matrix, and ω RV-CA (k) is the process noise.

可选的,多普勒雷达位置位于极坐标系坐标原点,所述多普勒雷达测量方程具体表示为:Optionally, the Doppler radar position is located at the origin of the polar coordinate system, and the Doppler radar measurement equation is specifically expressed as:

Zm(k)=f(X(k))+Vm(k);Z m (k) = f (X (k)) + V m (k);

θ(k)=arctan(y(k)/x(k));θ(k)=arctan(y(k)/x(k));

式中,θm(k)、rm(k)和分别为方位角量测、距离量测和多普勒量测;θ(k)、r(k)和分别为方位角量测真实值、距离量测真实值和多普勒量测真实值;分别为方位角量测噪声、距离量测噪声和多普勒量测噪声,均为零均值高斯白噪声,方差分别为θ、σr为其对应标准差),且不相关,不相关,的相关系数为ρ,即有 Where θ m (k), r m (k) and are azimuth measurement, distance measurement and Doppler measurement respectively; θ(k), r(k) and They are the true value of azimuth measurement, the true value of distance measurement and the true value of Doppler measurement respectively; and They are azimuth measurement noise, distance measurement noise and Doppler measurement noise, all of which are zero-mean Gaussian white noise, with variances of and θ , σ r and is its corresponding standard deviation), and and Not relevant, and Not relevant, and The correlation coefficient is ρ, that is,

可选的,步骤2具体包括:Optionally, step 2 specifically includes:

已知三维随机向量的均值和方差,经sigma点采样后代入非线性函数f(·),再经加权和求取极坐标下过程噪声的统计特性;The mean and variance of the three-dimensional random vector are known. After sampling at the sigma point, it is inserted into the nonlinear function f(·), and then the process noise in polar coordinates is obtained by weighted summation. and Statistical properties of

匀速直线运动模型和匀加速直线运动模型求取均值和协方差过程的具体步骤为:The specific steps for obtaining the mean and covariance of the uniform linear motion model and the uniformly accelerated linear motion model are as follows:

(1)根据sigma点采样规则,由三维随机向量的均值和方差,生成2n+1个3维样本点;(1) According to the sigma point sampling rule, 2n+1 3D sample points are generated from the mean and variance of the 3D random vector;

(2)计算(1)中非线性函数变换产生的样本点;(2) Calculate the sample points generated by the nonlinear function transformation in (1);

(3)确定各个三维样本点均值和协方差的权值;(3) Determine the weights of the mean and covariance of each three-dimensional sample point;

(4)基于(3)中获得的权值,确定映射的均值和方差阵。(4) Based on the weights obtained in (3), determine the mean and variance matrix of the mapping.

可选的,在匀速直线运动模型和匀加速直线运动模型中非线性函数f(·)为:Optionally, the nonlinear function f(·) in the uniform linear motion model and the uniformly accelerated linear motion model is:

其中,是匀速直线运动模型切向过程噪声和径向过程噪声;是匀加速直线运动模型切向过程噪声和径向过程噪声;是匀速直线运动模型X和Y方向上的零均值高斯白噪声;是匀加速直线运动模型X和Y方向上的零均值高斯白噪声;θ(k)为服从正态分布的随机变量。in, and are the tangential process noise and radial process noise of the uniform linear motion model; and are the tangential process noise and radial process noise of the uniformly accelerated linear motion model; and is the zero-mean Gaussian white noise in the X and Y directions of the uniform linear motion model; and is the zero-mean Gaussian white noise in the X and Y directions of the uniformly accelerated linear motion model; θ(k) is a random variable that obeys the normal distribution.

可选的,进行状态初始化的具体过程为:Optionally, the specific process of state initialization is:

(1)当模型为匀速直线运动时,根据笛卡尔坐标系下初始目标状态的均值s(0)和协方差S(0),随机生成N个四维样本点j=1,2,3…N;模型为匀加速直线运动时,根据笛卡尔坐标系下初始目标状态的均值b(0)和协方差B(0),随机生成N个六维样本点xj和yj是随机样本点的位置,是随机样本点的速度,是随机样本点的加速度;(1) When the model is in uniform linear motion, N four-dimensional sample points are randomly generated according to the mean s(0) and covariance S(0) of the initial target state in the Cartesian coordinate system. j=1,2,3…N; when the model is uniformly accelerated linear motion, N six-dimensional sample points are randomly generated according to the mean b(0) and covariance B(0) of the initial target state in the Cartesian coordinate system. xj and yj are the locations of random sample points, and is the velocity of the random sample point, and is the acceleration of the random sample point;

(2)计算极坐标中每个状态点的值ηj(2) Calculate the value η j of each state point in polar coordinates;

(3)计算极坐标中状态点的均值和协方差;(3) Calculate the mean and covariance of the state points in polar coordinates;

可选的,在匀速直线运动模型下计算极坐标中每个状态点的值的公式为:Optionally, the formula for calculating the value of each state point in polar coordinates under the uniform linear motion model is:

θj=arctan(yj/xj);θ j =arctan(y j /x j );

在匀加速直线运动模型下计算极坐标中每个状态点的值的公式为:The formula for calculating the value of each state point in polar coordinates under the uniformly accelerated linear motion model is:

θj=arctan(yj/xj);θ j =arctan(y j /x j );

可选的,对目标状态和协方差一步预测的具体公式为:Optionally, the specific formula for one-step prediction of the target state and covariance is:

η(k+1,k)=Φ(k)η(k,k)+Γ(k)ω(k);η(k+1,k)=Φ(k)η(k,k)+Γ(k)ω(k);

P(k+1,k)=Φ(k)P(k,k)Φ(k)T+Γ(k)Q(k)Γ(K)TP(k+1,k)=Φ(k)P(k,k)Φ(k) T +Γ(k)Q(k)Γ(K) T ;

式中,η(k+1,k)和P(k+1,k)分别为k时刻预测的目标状态和协方差,Q(k)为过程噪声协方差矩阵。Where η(k+1,k) and P(k+1,k) are the target state and covariance predicted at time k, respectively, and Q(k) is the process noise covariance matrix.

可选的,所述通过最小方差线性融合完成当前时刻目标跟踪状态和协方差更新的具体步骤为:Optionally, the specific steps of completing the target tracking state and covariance update at the current moment through minimum variance linear fusion are:

η(k+1,k+1)=P(k+1,k+1)[P(k+1,k)-1η(k+1,k)+Pz(k+1,k+1)-1ηz(k+1,k)];η(k+1,k+1)=P(k+1,k+1)[P(k+1,k) -1 η(k+1,k)+P z (k+1,k+ 1) -1 η z (k+1,k)];

P(k+1,k+1)=[P(k+1,k)-1+Pz(k+1,k+1)-1]-1P(k+1,k+1)=[P(k+1,k) -1 +P z (k+1,k+1) -1 ] -1 ;

在计算中,对观测矢量及其协方差扩维并对缺损元素置零,以适于实施矩阵运算;In the calculation, the observation vector and its covariance are expanded and the missing elements are set to zero to be suitable for matrix operations;

其中,当模型为匀速直线运动时, Among them, when the model is in uniform linear motion,

当模型为匀加速直线运动时, When the model is in uniformly accelerated linear motion,

经由上述的技术方案可知,与现有技术相比,本发明公开提供了一种极坐标系下利用多普勒量测实现目标跟踪的方法,区别于目前现有技术所有带多普勒量测的非线性滤波算法,采用与以往算法完全不同的技术思路,直接在极坐标下构建目标状态方程,将多普勒量测强非线性问题转换为线性滤波问题,再结合标准卡尔曼滤波器便可完成跟踪,克服了多普勒量测和目标状态间的强非线性,能够以较小的计算量对目标跟踪,可以很好地提高目标跟踪精度。Through the above technical solution, it can be known that compared with the prior art, the present invention discloses a method for realizing target tracking by using Doppler measurement in a polar coordinate system, which is different from all the nonlinear filtering algorithms with Doppler measurement in the prior art. It adopts a technical idea that is completely different from the previous algorithms, directly constructs the target state equation in polar coordinates, converts the strong nonlinear problem of Doppler measurement into a linear filtering problem, and then combines with the standard Kalman filter to complete the tracking, thus overcoming the strong nonlinearity between Doppler measurement and target state, being able to track the target with a smaller amount of calculation, and being able to greatly improve the target tracking accuracy.

附图说明BRIEF DESCRIPTION OF THE DRAWINGS

为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据提供的附图获得其他的附图。In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings required for use in the embodiments or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are only embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on the provided drawings without paying creative work.

图1附图为本发明的方法流程简图;Figure 1 is a simplified flow chart of the method of the present invention;

图2a附图为匀速直线运动模型下跟踪位置不同算法的误差曲线图;FIG. 2a is a graph showing the error curves of different position tracking algorithms under a uniform linear motion model;

图2b附图为匀速直线运动模型下跟踪速度不同算法的误差曲线图;FIG2b is a graph showing the error curves of different tracking speed algorithms under a uniform linear motion model;

图3a附图为匀加速直线运动模型下跟踪位置不同算法的误差曲线图;FIG3a is a graph showing the error curves of different position tracking algorithms under a uniformly accelerated linear motion model;

图3b附图为匀加速直线运动模型下跟踪速度不同算法的误差曲线图。FIG3 b is a graph showing error curves of different tracking speed algorithms under a uniformly accelerated linear motion model.

具体实施方式DETAILED DESCRIPTION

下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

本发明实施例公开了一种极坐标系下利用多普勒量测实现目标跟踪的方法,如图1所示,包括以下步骤:The embodiment of the present invention discloses a method for implementing target tracking by using Doppler measurement in a polar coordinate system, as shown in FIG1 , comprising the following steps:

步骤1、确定极坐标下含有径向速度并与多普勒雷达测量呈线性关系的匀速直线运动模型和匀加速直线运动模型的状态方程;Step 1, determine the state equations of the uniform linear motion model and the uniform accelerated linear motion model containing radial velocity in polar coordinates and having a linear relationship with Doppler radar measurement;

步骤2、将匀速直线运动模型和匀加速直线运动模型笛卡尔坐标系下的过程噪声转换到极坐标,使用Unscented变换计算过程噪声的均值和协方差;Step 2: Convert the process noise in the Cartesian coordinate system of the uniform linear motion model and the uniformly accelerated linear motion model to polar coordinates, and use the Unscented transformation to calculate the mean and covariance of the process noise;

步骤3、基于笛卡尔坐标下的先验信息,对获得的匀速直线运动模型和匀加速直线运动模型的状态方程进行状态初始化,利用蒙特卡洛方法初始化目标在极坐标中的目标状态和协方差;Step 3: Based on the prior information in Cartesian coordinates, the state equations of the uniform linear motion model and the uniform accelerated linear motion model are initialized, and the target state and covariance of the target in polar coordinates are initialized using the Monte Carlo method;

步骤4、在当前时刻,根据运动目标加速度的先验信息选择运动模型,计算极坐标下状态方程的状态转移矩阵,过程噪声驱动矩阵和过程噪声的统计特性;Step 4: At the current moment, a motion model is selected according to the prior information of the acceleration of the moving target, and the state transfer matrix of the state equation in polar coordinates, the process noise driving matrix and the statistical characteristics of the process noise are calculated;

步骤5、在极坐标下对目标状态和协方差一步预测;Step 5: One-step prediction of the target state and covariance in polar coordinates;

步骤6、结合多普勒雷达测量值,通过最小方差线性融合完成当前时刻目标跟踪状态和协方差的更新;Step 6: Combine the Doppler radar measurement value and complete the update of the target tracking state and covariance at the current moment through minimum variance linear fusion;

步骤7、循环执行步骤4-6,直至目标跟踪结束。Step 7: Loop through steps 4-6 until target tracking is complete.

在一个具体的实施例中,确定极坐标下匀速直线运动模型的状态方程的具体过程为:将笛卡尔坐标系下的状态方程转换到极坐标系下,含有径向速度的匀速直线运动模型在极坐标系中的状态方程表示为:In a specific embodiment, the specific process of determining the state equation of the uniform linear motion model in polar coordinates is: converting the state equation in the Cartesian coordinate system to the polar coordinate system, and the state equation of the uniform linear motion model containing radial velocity in the polar coordinate system is expressed as:

ηRV-CV(k+1)=ΦRV-CV(k)ηRV-CV(k)+ΓRV-CV(k)ωRV-CV(k);η RV-CV (k+1)=Φ RV-CV (k) η RV-CV (k) + Γ RV-CV (k) ω RV-CV (k);

式中,表示k时刻目标的状态,θ(k)、r(k)分别为方位角量测真实值、距离量测真实值,分别为角速度和径向速度;代表r(k),之间的协方差,Var[r(k)]分别代表r(k)的方差,ΦRV-CV(k)为状态转移矩阵,ΓRV-CV(k)为过程噪声驱动矩阵,ωRV-CV(k)为过程噪声。In the formula, represents the state of the target at time k, θ(k) and r(k) are the true values of azimuth and distance respectively. are the angular velocity and radial velocity respectively; represents r(k), The covariance between Var[r(k)] represents where Φ RV-CV (k) is the variance of r(k), Φ RV -CV (k) is the state transfer matrix, Γ RV-CV (k) is the process noise driving matrix, and ω RV-CV (k) is the process noise.

在一个具体的实施例中,确定极坐标下匀加速直线运动模型的状态方程的具体过程为:将笛卡尔坐标系下的状态方程转换到极坐标系下,含有径向速度的匀加速直线运动模型在极坐标系中的状态方程表示为:In a specific embodiment, the specific process of determining the state equation of the uniformly accelerated linear motion model in polar coordinates is: converting the state equation in the Cartesian coordinate system to the polar coordinate system, and the state equation of the uniformly accelerated linear motion model containing radial velocity in the polar coordinate system is expressed as:

ηRV-CA(k+1)=ΦRV-CA(k)ηRV-CA(k)+ΓRV-CA(k)ωRV-CA(k);η RV-CA (k+1)=Φ RV-CA (k)n RV -CA (k)+Γ RV-CA (k)ω RV-CA (k);

式中,表示k时刻目标的状态,T为多普勒雷达采样时间间隔,θ(k)、r(k)分别为方位角量测真实值、距离量测真实值,分别为角速度和径向速度,分别为角加速度和径向加速度;代表r(k),之间的协方差,代表的方差,ΦRV-CA(k)为状态转移矩阵,ΓRV-CA(k)为过程噪声驱动矩阵,ωRV-CA(k)为过程噪声。In the formula, represents the state of the target at time k, T is the sampling time interval of the Doppler radar, θ(k) and r(k) are the true values of azimuth measurement and distance measurement, respectively. are the angular velocity and radial velocity respectively, are angular acceleration and radial acceleration respectively; represents r(k), The covariance between represent , Φ RV-CA (k) is the state transfer matrix, Γ RV-CA (k) is the process noise driving matrix, and ω RV-CA (k) is the process noise.

在一个具体的实施例中,多普勒雷达位置位于极坐标系坐标原点,所述多普勒雷达测量方程具体表示为:In a specific embodiment, the Doppler radar position is located at the origin of the polar coordinate system, and the Doppler radar measurement equation is specifically expressed as:

Zm(k)=f(X(k))+Vm(k);Z m (k) = f (X (k)) + V m (k);

θ(k)=arctan(y(k)/x(k));θ(k)=arctan(y(k)/x(k));

式中,θm(k)、rm(k)和分别为方位角量测、距离量测和多普勒量测;θ(k)、r(k)和分别为方位角量测真实值、距离量测真实值和多普勒量测真实值;分别为方位角量测噪声、距离量测噪声和多普勒量测噪声,均为零均值高斯白噪声,方差分别为θ、σr为其对应标准差),且不相关,不相关,的相关系数为ρ,即有 Where θ m (k), r m (k) and are azimuth measurement, distance measurement and Doppler measurement respectively; θ(k), r(k) and They are the true value of azimuth measurement, the true value of distance measurement and the true value of Doppler measurement respectively; and They are azimuth measurement noise, distance measurement noise and Doppler measurement noise, all of which are zero-mean Gaussian white noise, with variances of and θ , σ r and is its corresponding standard deviation), and and Not relevant, and Not relevant, and The correlation coefficient is ρ, that is,

在一个具体的实施例中,步骤2具体包括:In a specific embodiment, step 2 specifically includes:

已知三维随机向量的均值和方差,经sigma点采样后代入非线性函数f(·),再经加权和求取极坐标下过程噪声的统计特性;Given a three-dimensional random vector and The mean and variance of the sigma point are sampled and then input into the nonlinear function f(·), and then the process noise in polar coordinates is obtained by weighted summation. and Statistical properties of

以匀速直线运动模型为例,求取的过程具体步骤为:Taking the uniform linear motion model as an example, find and The specific steps of the process are:

(1)根据sigma点采样规则,由生成2n+1个3维样本点;(1) According to the sigma point sampling rule, and Generate 2n+1 3D sample points;

其中,n=3;表示矩阵的下三角分解平方根的第i列;λ=α2(n+k)-n;α为正数,取10-4≤α≤1;k=3-n;Wherein, n=3; Representation Matrix The i-th column of the square root of the lower triangular decomposition of ; λ=α 2 (n+k)-n; α is a positive number, 10 -4 ≤α≤1; k=3-n;

(2)计算非线性函数变换产生的样本点;(2) Calculate the sample points generated by the nonlinear function transformation;

Y(i)=f[χ(i)],i=0~2nY (i) = f[χ (i) ], i = 0~2n

(3)确定各个三维样本点均值和协方差的权值;(3) Determine the weights of the mean and covariance of each three-dimensional sample point;

其中,上标m为均值,c为协方差;下标为第几个采样点;对于正态分布,β=2为最优值;Among them, the superscript m is the mean, c is the covariance; the subscript is the sampling point; for the normal distribution, β = 2 is the optimal value;

(4)基于(3)中获得的权值,确定映射的均值和方差阵;(4) Based on the weights obtained in (3), determine the mean and variance matrix of the mapping;

这里以匀速直线运动模型为例,给出的求取过程,当为匀加速直线运动模型时,的求取过程与之上述求解过程相同。Here we take the uniform linear motion model as an example, and The process of obtaining , when it is a uniformly accelerated linear motion model, and The process of obtaining is the same as the above solution process.

在一个具体实施例中,在匀速直线运动模型和匀加速直线运动模型中非线性函数f(·)为:In a specific embodiment, the nonlinear function f(·) in the uniform linear motion model and the uniform accelerated linear motion model is:

其中,是匀速直线运动模型切向过程噪声和径向过程噪声;是匀加速直线运动模型切向过程噪声和径向过程噪声;是匀速直线运动模型X和Y方向上的零均值高斯白噪声;是匀加速直线运动模型X和Y方向上的零均值高斯白噪声;θ(k)为服从正态分布的随机变量。in, and are the tangential process noise and radial process noise of the uniform linear motion model; and are the tangential process noise and radial process noise of the uniformly accelerated linear motion model; and is the zero-mean Gaussian white noise in the X and Y directions of the uniform linear motion model; and is the zero-mean Gaussian white noise in the X and Y directions of the uniformly accelerated linear motion model; θ(k) is a random variable that obeys the normal distribution.

在一个具体的实施例中,进行状态初始化的具体过程为:In a specific embodiment, the specific process of initializing the state is:

(1)当模型为匀速直线运动时,根据笛卡尔坐标系下初始目标状态的均值s(0)和协方差S(0),随机生成N个四维样本点j=1,2,3…N;模型为匀加速直线运动时,根据笛卡尔坐标系下初始目标状态的均值b(0)和协方差B(0),随机生成N个六维样本点xj和yj是随机样本点的位置,是随机样本点的速度,是随机样本点的加速度;(1) When the model is in uniform linear motion, N four-dimensional sample points are randomly generated according to the mean s(0) and covariance S(0) of the initial target state in the Cartesian coordinate system. j=1,2,3…N; when the model is uniformly accelerated linear motion, N six-dimensional sample points are randomly generated according to the mean b(0) and covariance B(0) of the initial target state in the Cartesian coordinate system. xj and yj are the locations of random sample points, and is the velocity of the random sample point, and is the acceleration of the random sample point;

(2)计算极坐标中每个状态点的值ηj(2) Calculate the value η j of each state point in polar coordinates;

(3)计算极坐标中状态点的均值和协方差;(3) Calculate the mean and covariance of the state points in polar coordinates;

在一个具体的实施例中,在匀速直线运动模型下计算极坐标中每个状态点的值的公式为:In a specific embodiment, the formula for calculating the value of each state point in polar coordinates under the uniform linear motion model is:

θj=arctan(yj/xj);θ j =arctan(y j /x j );

在匀加速直线运动模型下计算极坐标中每个状态点的值的公式为:The formula for calculating the value of each state point in polar coordinates under the uniformly accelerated linear motion model is:

θj=arctan(yj/xj);θ j =arctan(y j /x j );

在一个具体的实施例中,对目标状态和协方差一步预测的具体公式为:In a specific embodiment, the specific formula for one-step prediction of the target state and covariance is:

η(k+1,k)=Φ(k)η(k,k)+Γ(k)ω(k);η(k+1,k)=Φ(k)η(k,k)+Γ(k)ω(k);

P(k+1,k)=Φ(k)P(k,k)Φ(k)T+Γ(k)Q(k)Γ(K)TP(k+1,k)=Φ(k)P(k,k)Φ(k) T +Γ(k)Q(k)Γ(K) T ;

式中,η(k+1,k)和P(k+1,k)分别为k时刻预测的目标状态和协方差,Q(k)为过程噪声协方差矩阵。Where η(k+1,k) and P(k+1,k) are the target state and covariance predicted at time k, respectively, and Q(k) is the process noise covariance matrix.

在一个具体的实施例中,通过最小方差线性融合完成当前时刻目标跟踪状态和协方差更新的具体步骤为:In a specific embodiment, the specific steps of completing the target tracking state and covariance update at the current moment through minimum variance linear fusion are:

η(k+1,k+1)=P(k+1,k+1)[P(k+1,k)-1η(k+1,k)+Pz(k+1,k+1)-1ηz(k+1,k)];η(k+1,k+1)=P(k+1,k+1)[P(k+1,k) -1 η(k+1,k)+P z (k+1,k+ 1) -1 η z (k+1,k)];

P(k+1,k+1)=[P(k+1,k)-1+Pz(k+1,k+1)-1]-1P(k+1,k+1)=[P(k+1,k) -1 +P z (k+1,k+1) -1 ] -1 ;

在计算中,对观测矢量及其协方差扩维并对缺损元素置零,以适于实施矩阵运算;其中,当模型为匀速直线运动时, In the calculation, the observation vector and its covariance are expanded and the missing elements are set to zero to be suitable for matrix operations; when the model is uniform linear motion,

当模型为匀加速直线运动时, When the model is in uniformly accelerated linear motion,

在一个具体的实施例中,运用本发明的雷达目标跟踪方法,跟踪目标在二维空间做匀速直线运动运动,目标初始位置为(10km,10km),初始速度为(8m/s,10m/s),位于坐标原点的多普勒雷达以1s的采样周期提供目标的距离、方位角和多普勒量测。将本专利所提方法与带多普勒量测的SEKF、SUKF和SFPRE算法进行比较。其量测噪声的标准差分别为σr=100m,σθ=1°,相关系数ρ=0.5,不同算法位置和速度均方根误差仿真结果如图2a、图2b所示。In a specific embodiment, the radar target tracking method of the present invention is used to track a target moving in a uniform linear motion in a two-dimensional space. The initial position of the target is (10km, 10km), the initial velocity is (8m/s, 10m/s), and the Doppler radar located at the origin of the coordinates provides the distance, azimuth and Doppler measurement of the target with a sampling period of 1s. The method proposed in this patent is compared with the SEKF, SUKF and SFPRE algorithms with Doppler measurement. The standard deviations of the measurement noise are σ r = 100m, σ θ = 1°, The correlation coefficient ρ = 0.5, and the simulation results of the root mean square error of position and velocity of different algorithms are shown in Figure 2a and Figure 2b.

在一个具体的实施例中,运用本发明的雷达目标跟踪方法,跟踪目标在二维空间做匀加速直线运动运动,目标初始位置为(10km,10km),初始速度为(8m/s,10m/s),初始加速度为(2m/s2,2m/s2),位于坐标原点的多普勒雷达以1s的采样周期提供目标的距离、方位角和多普勒量测。将本专利所提方法与带多普勒量测的SEKF、SUKF和SFPRE算法进行比较。其量测噪声的标准差分别为σr=100m,σθ=1°,相关系数ρ=0.5,不同算法位置和速度均方根误差仿真结果如图3a、图3b所示。In a specific embodiment, the radar target tracking method of the present invention is used to track a target moving in a uniformly accelerated linear motion in a two-dimensional space. The target initial position is (10km, 10km), the initial velocity is (8m/s, 10m/s), and the initial acceleration is (2m/s 2 , 2m/s 2 ). The Doppler radar located at the origin of the coordinate system provides the distance, azimuth, and Doppler measurements of the target with a sampling period of 1s. The method proposed in this patent is compared with the SEKF, SUKF, and SFPRE algorithms with Doppler measurement. The standard deviations of the measurement noise are σ r = 100m, σ θ = 1°, The correlation coefficient ρ = 0.5, and the simulation results of the root mean square error of position and velocity of different algorithms are shown in Figure 3a and Figure 3b.

由图2a、图2b、图3a、图3b可知,随时间推进,各方法的位置与速度估计精度均不断提高,在不同运动模型下,本发明所提方法均可以降低多普勒量测强非线性的影响,在跟踪精度和收敛速度上都有所提高。对于本发明所提方法,可以使用线性卡尔曼滤波器处理状态向量和测量向量,确保了动态估计的收敛性。As shown in Figures 2a, 2b, 3a and 3b, the position and velocity estimation accuracy of each method is continuously improved over time. Under different motion models, the method proposed in the present invention can reduce the influence of strong nonlinearity of Doppler measurement, and improve tracking accuracy and convergence speed. For the method proposed in the present invention, a linear Kalman filter can be used to process the state vector and the measurement vector to ensure the convergence of dynamic estimation.

本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。对于实施例公开的装置而言,由于其与实施例公开的方法相对应,所以描述的比较简单,相关之处参见方法部分说明即可。In this specification, each embodiment is described in a progressive manner, and each embodiment focuses on the differences from other embodiments. The same or similar parts between the embodiments can be referred to each other. For the device disclosed in the embodiment, since it corresponds to the method disclosed in the embodiment, the description is relatively simple, and the relevant parts can be referred to the method part.

对所公开的实施例的上述说明,使本领域专业技术人员能够实现或使用本发明。对这些实施例的多种修改对本领域的专业技术人员来说将是显而易见的,本文中所定义的一般原理可以在不脱离本发明的精神或范围的情况下,在其它实施例中实现。因此,本发明将不会被限制于本文所示的这些实施例,而是要符合与本文所公开的原理和新颖特点相一致的最宽的范围。The above description of the disclosed embodiments enables one skilled in the art to implement or use the present invention. Various modifications to these embodiments will be apparent to one skilled in the art, and the general principles defined herein may be implemented in other embodiments without departing from the spirit or scope of the present invention. Therefore, the present invention will not be limited to the embodiments shown herein, but rather to the widest scope consistent with the principles and novel features disclosed herein.

Claims (10)

1.一种极坐标系下利用多普勒量测实现目标跟踪的方法,其特征在于,包括以下步骤:1. A method for tracking a target using Doppler measurement in a polar coordinate system, comprising the following steps: 步骤1、确定极坐标下含有径向速度并与多普勒雷达测量呈线性关系的匀速直线运动模型和匀加速直线运动模型的状态方程;Step 1, determine the state equations of the uniform linear motion model and the uniform accelerated linear motion model containing radial velocity in polar coordinates and having a linear relationship with Doppler radar measurement; 步骤2、将匀速直线运动模型和匀加速直线运动模型笛卡尔坐标系下的过程噪声转换到极坐标,使用Unscented变换计算过程噪声的均值和协方差;Step 2: Convert the process noise in the Cartesian coordinate system of the uniform linear motion model and the uniformly accelerated linear motion model to polar coordinates, and use the Unscented transformation to calculate the mean and covariance of the process noise; 步骤3、基于笛卡尔坐标下的先验信息,对获得的匀速直线运动模型和匀加速直线运动模型的状态方程进行状态初始化,利用蒙特卡洛方法初始化目标在极坐标中的目标状态和协方差;Step 3: Based on the prior information in Cartesian coordinates, the state equations of the uniform linear motion model and the uniform accelerated linear motion model are initialized, and the target state and covariance of the target in polar coordinates are initialized using the Monte Carlo method; 步骤4、在当前时刻,根据运动目标加速度的先验信息选择运动模型,计算极坐标下状态方程的状态转移矩阵,过程噪声驱动矩阵和过程噪声的统计特性;Step 4: At the current moment, a motion model is selected according to the prior information of the acceleration of the moving target, and the state transfer matrix of the state equation in polar coordinates, the process noise driving matrix and the statistical characteristics of the process noise are calculated; 步骤5、在极坐标下对目标状态和协方差一步预测;Step 5: One-step prediction of the target state and covariance in polar coordinates; 步骤6、结合多普勒雷达测量值,通过最小方差线性融合完成当前时刻目标跟踪状态和协方差的更新;Step 6: Combine the Doppler radar measurement value and complete the update of the target tracking state and covariance at the current moment through minimum variance linear fusion; 步骤7、循环执行步骤4-6,直至目标跟踪结束。Step 7: Loop through steps 4-6 until target tracking is complete. 2.根据权利要求1所述的一种极坐标系下利用多普勒量测实现目标跟踪的方法,其特征在于,确定极坐标下匀速直线运动模型的状态方程的具体过程为:将笛卡尔坐标系下的状态方程转换到极坐标系下,含有径向速度的匀速直线运动模型在极坐标系中的状态方程表示为:2. The method for realizing target tracking by using Doppler measurement in polar coordinate system according to claim 1 is characterized in that the specific process of determining the state equation of the uniform linear motion model in polar coordinate system is: converting the state equation in Cartesian coordinate system to polar coordinate system, and the state equation of the uniform linear motion model containing radial velocity in polar coordinate system is expressed as: ηRV-CV(k+1)=ΦRV-CV(k)ηRV-CV(k)+ΓRV-CV(k)ωRV-CV(k);η RV-CV (k+1)=Φ RV-CV (k) η RV-CV (k) + Γ RV-CV (k) ω RV-CV (k); 式中,表示k时刻目标的状态,θ(k)、r(k)分别为方位角量测真实值、距离量测真实值,分别为角速度和径向速度;代表r(k),之间的协方差,Var[r(k)]分别代表r(k)的方差,ΦRV-CV(k)为状态转移矩阵,ΓRV-CV(k)为过程噪声驱动矩阵,ωRV-CV(k)为过程噪声。In the formula, represents the state of the target at time k, θ(k) and r(k) are the true values of azimuth and distance respectively. are the angular velocity and radial velocity respectively; represents r(k), The covariance between Var[r(k)] represents where Φ RV-CV (k) is the variance of r(k), Φ RV -CV (k) is the state transfer matrix, Γ RV-CV (k) is the process noise driving matrix, and ω RV-CV (k) is the process noise. 3.根据权利要求1所述的一种极坐标系下利用多普勒量测实现目标跟踪的方法,其特征在于,确定极坐标下匀加速直线运动模型的状态方程的具体过程为:将笛卡尔坐标系下的状态方程转换到极坐标系下,含有径向速度的匀加速直线运动模型在极坐标系中的状态方程表示为:3. The method for realizing target tracking by using Doppler measurement in polar coordinate system according to claim 1 is characterized in that the specific process of determining the state equation of the uniformly accelerated linear motion model in polar coordinate system is: converting the state equation in Cartesian coordinate system to polar coordinate system, and the state equation of the uniformly accelerated linear motion model containing radial velocity in polar coordinate system is expressed as: ηRV-CA(k+1)=ΦRV-CA(k)ηRV-CA(k)+ΓRV-CA(k)ωRV-CA(k);η RV-CA (k+1)=Φ RV-CA (k)n RV -CA (k)+Γ RV-CA (k)ω RV-CA (k); 式中,表示k时刻目标的状态,T为多普勒雷达采样时间间隔,θ(k)、r(k)分别为方位角量测真实值、距离量测真实值,分别为角速度和径向速度,分别为角加速度和径向加速度;代表r(k),之间的协方差,代表的方差,ΦRV-CA(k)为状态转移矩阵,ΓRV-CA(k)为过程噪声驱动矩阵,ωRV-CA(k)为过程噪声。In the formula, represents the state of the target at time k, T is the sampling time interval of the Doppler radar, θ(k) and r(k) are the true values of azimuth measurement and distance measurement, respectively. are the angular velocity and radial velocity respectively, are angular acceleration and radial acceleration respectively; represents r(k), The covariance between represent , Φ RV-CA (k) is the state transfer matrix, Γ RV-CA (k) is the process noise driving matrix, and ω RV-CA (k) is the process noise. 4.根据权利要求1所述的一种极坐标系下利用多普勒量测实现目标跟踪的方法,其特征在于,多普勒雷达位置位于极坐标系坐标原点,所述多普勒雷达测量的方程具体表示为:4. The method for realizing target tracking by using Doppler measurement in a polar coordinate system according to claim 1, wherein the Doppler radar position is located at the origin of the polar coordinate system, and the equation for Doppler radar measurement is specifically expressed as: Zm(k)=f(X(k))+Vm(k);Z m (k) = f (X (k)) + V m (k); θ(k)=arctan(y(k)/x(k));θ(k)=arctan(y(k)/x(k)); 式中,θm(k)、rm(k)和分别为方位角量测、距离量测和多普勒量测;θ(k)、r(k)和分别为方位角量测真实值、距离量测真实值和多普勒量测真实值;分别为方位角量测噪声、距离量测噪声和多普勒量测噪声,均为零均值高斯白噪声,方差分别为σθ、σr为其对应标准差,且不相关,不相关,的相关系数为ρ,即有 Where θ m (k), r m (k) and are azimuth measurement, distance measurement and Doppler measurement respectively; θ(k), r(k) and They are the true value of azimuth measurement, the true value of distance measurement and the true value of Doppler measurement respectively; and They are azimuth measurement noise, distance measurement noise and Doppler measurement noise, all of which are zero-mean Gaussian white noise, with variances of and σθ , σr and is its corresponding standard deviation, and and Not relevant, and Not relevant, and The correlation coefficient is ρ, that is, 5.根据权利要求1所述的一种极坐标系下利用多普勒量测实现目标跟踪的方法,其特征在于,所述步骤2具体包括:5. The method for realizing target tracking by using Doppler measurement in a polar coordinate system according to claim 1, wherein step 2 specifically comprises: 已知三维随机向量的均值和方差,经sigma点采样后代入非线性函数f(),再经加权和求取极坐标下过程噪声的统计特性;The mean and variance of the three-dimensional random vector are known. After sampling at the sigma point, it is input into the nonlinear function f(), and then the process noise in polar coordinates is obtained by weighted sum. and Statistical properties of 匀速直线运动模型和匀加速直线运动模型求取均值和协方差过程的具体步骤为:The specific steps for obtaining the mean and covariance of the uniform linear motion model and the uniformly accelerated linear motion model are as follows: (1)根据sigma点采样规则,由三维随机向量的均值和方差,生成2n+1个3维样本点;(1) According to the sigma point sampling rule, 2n+1 3D sample points are generated from the mean and variance of the 3D random vector; (2)计算(1)中非线性函数变换产生的样本点;(2) Calculate the sample points generated by the nonlinear function transformation in (1); (3)确定各个三维样本点均值和协方差的权值;(3) Determine the weights of the mean and covariance of each three-dimensional sample point; (4)基于(3)中获得的权值,确定映射的均值和方差阵。(4) Based on the weights obtained in (3), determine the mean and variance matrix of the mapping. 6.根据权利要求5所述的一种极坐标系下利用多普勒量测实现目标跟踪的方法,其特征在于,在匀速直线运动模型和匀加速直线运动模型中所述非线性函数f()为:6. The method for realizing target tracking by using Doppler measurement in a polar coordinate system according to claim 5, characterized in that the nonlinear function f() in the uniform linear motion model and the uniform accelerated linear motion model is: 其中,是匀速直线运动模型切向过程噪声和径向过程噪声;是匀加速直线运动模型切向过程噪声和径向过程噪声;是匀速直线运动模型X和Y方向上的零均值高斯白噪声;是匀加速直线运动模型X和Y方向上的零均值高斯白噪声;θ(k)为服从正态分布的随机变量。in, and are the tangential process noise and radial process noise of the uniform linear motion model; and are the tangential process noise and radial process noise of the uniformly accelerated linear motion model; and is the zero-mean Gaussian white noise in the X and Y directions of the uniform linear motion model; and is the zero-mean Gaussian white noise in the X and Y directions of the uniformly accelerated linear motion model; θ(k) is a random variable that obeys the normal distribution. 7.根据权利要求1所述的一种极坐标系下利用多普勒量测实现目标跟踪的方法,其特征在于,进行状态初始化的具体过程为:7. The method for realizing target tracking by using Doppler measurement in a polar coordinate system according to claim 1, wherein the specific process of performing state initialization is: (1)当模型为匀速直线运动时,根据笛卡尔坐标系下初始目标状态的均值s(0)和协方差S(0),随机生成N个四维样本点模型为匀加速直线运动时,根据笛卡尔坐标系下初始目标状态的均值b(0)和协方差B(0),随机生成N个六维样本点xj和yj是随机样本点的位置,是随机样本点的速度,是随机样本点的加速度;(1) When the model is in uniform linear motion, N four-dimensional sample points are randomly generated according to the mean s(0) and covariance S(0) of the initial target state in the Cartesian coordinate system. When the model is uniformly accelerated linear motion, N six-dimensional sample points are randomly generated according to the mean b(0) and covariance B(0) of the initial target state in the Cartesian coordinate system. xj and yj are the locations of random sample points, and is the velocity of the random sample point, and is the acceleration of the random sample point; (2)计算极坐标中每个状态点的值ηj(2) Calculate the value η j of each state point in polar coordinates; (3)计算极坐标中状态点的均值和协方差;(3) Calculate the mean and covariance of the state points in polar coordinates; 8.根据权利要求1所述的一种极坐标系下利用多普勒量测实现目标跟踪的方法,其特征在于,在匀速直线运动模型下计算极坐标中每个状态点的值的公式为:8. The method for realizing target tracking by using Doppler measurement in a polar coordinate system according to claim 1, characterized in that the formula for calculating the value of each state point in the polar coordinate system under the uniform linear motion model is: θj=arctan(yj/xj);θ j =arctan(y j /x j ); 在匀加速直线运动模型下计算极坐标中每个状态点的值的公式为:The formula for calculating the value of each state point in polar coordinates under the uniformly accelerated linear motion model is: θj=arctan(yj/xj);θ j =arctan(y j /x j ); 9.根据权利要求1所述的一种极坐标系下利用多普勒量测实现目标跟踪的方法,其特征在于,对目标状态和协方差一步预测的具体公式为:9. The method for realizing target tracking by using Doppler measurement in a polar coordinate system according to claim 1, characterized in that the specific formula for one-step prediction of the target state and covariance is: η(k+1,k)=Φ(k)η(k,k)+Γ(k)ω(k);η(k+1,k)=Φ(k)η(k,k)+Γ(k)ω(k); P(k+1,k)=Φ(k)P(k,k)Φ(k)T+Γ(k)Q(k)Γ(K)TP(k+1,k)=Φ(k)P(k,k)Φ(k) T +Γ(k)Q(k)Γ(K) T ; 式中,η(k+1,k)和P(k+1,k)分别为k时刻预测的目标状态和协方差,Q(k)为过程噪声协方差矩阵。Where η(k+1,k) and P(k+1,k) are the target state and covariance predicted at time k, respectively, and Q(k) is the process noise covariance matrix. 10.根据权利要求1所述的一种极坐标系下利用多普勒量测实现目标跟踪的方法,其特征在于,所述通过最小方差线性融合完成当前时刻目标跟踪状态和协方差更新的具体步骤为:10. The method for realizing target tracking by using Doppler measurement in a polar coordinate system according to claim 1, characterized in that the specific steps of completing the target tracking state and covariance update at the current moment by minimum variance linear fusion are: η(k+1,k+1)=P(k+1,k+1)[P(k+1,k)-1η(k+1,k)+Pz(k+1,k+1)-1ηz(k+1,k)];η(k+1,k+1)=P(k+1,k+1)[P(k+1,k) -1 η(k+1,k)+P z (k+1,k+ 1) -1 η z (k+1,k)]; P(k+1,k+1)=[P(k+1,k)-1+Pz(k+1,k+1)-1]-1P(k+1,k+1)=[P(k+1,k) -1 +P z (k+1,k+1) -1 ] -1 ; 在计算中,对观测矢量及其协方差扩维并对缺损元素置零,以适于实施矩阵运算;In the calculation, the observation vector and its covariance are expanded and the missing elements are set to zero to be suitable for matrix operations; 其中,当模型为匀速直线运动时,Among them, when the model is in uniform linear motion, 当模型为匀加速直线运动时,When the model is in uniformly accelerated linear motion, 式中,θm(k)、rm(k)和分别为方位角量测、距离量测和多普勒量测;分别为方位角量测噪声、距离量测噪声和多普勒量测噪声,均为零均值高斯白噪声,方差分别为σθ、σr为其对应标准差,且不相关,不相关,的相关系数为ρ,即有 Where θ m (k), r m (k) and They are azimuth measurement, distance measurement and Doppler measurement respectively; and They are azimuth measurement noise, distance measurement noise and Doppler measurement noise, all of which are zero-mean Gaussian white noise, with variances of and σθ , σr and is its corresponding standard deviation, and and Not relevant, and Not relevant, and The correlation coefficient is ρ, that is,
CN202310136909.9A 2022-09-09 2023-02-17 A radar target tracking method that processes Doppler measurements in polar coordinates Active CN116224320B (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN202310136909.9A CN116224320B (en) 2023-02-17 2023-02-17 A radar target tracking method that processes Doppler measurements in polar coordinates
US18/450,434 US20240094343A1 (en) 2022-09-09 2023-08-16 Method, device, system, and storage medium for tracking moving target

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202310136909.9A CN116224320B (en) 2023-02-17 2023-02-17 A radar target tracking method that processes Doppler measurements in polar coordinates

Publications (2)

Publication Number Publication Date
CN116224320A CN116224320A (en) 2023-06-06
CN116224320B true CN116224320B (en) 2023-09-22

Family

ID=86576343

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202310136909.9A Active CN116224320B (en) 2022-09-09 2023-02-17 A radar target tracking method that processes Doppler measurements in polar coordinates

Country Status (1)

Country Link
CN (1) CN116224320B (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117784064B (en) * 2023-12-28 2024-11-08 昆明理工大学 Pre-observation integral fusion tracking method for Doppler measurement

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106950562A (en) * 2017-03-30 2017-07-14 电子科技大学 A kind of state fusion method for tracking target based on predicted value measurement conversion
CN107688179A (en) * 2017-08-07 2018-02-13 上海无线电设备研究所 Combined chance data interconnection method based on doppler information auxiliary
CN108226920A (en) * 2018-01-09 2018-06-29 电子科技大学 A kind of maneuvering target tracking system and method based on predicted value processing Doppler measurements
CN111650577A (en) * 2020-06-12 2020-09-11 电子科技大学 A Maneuvering Target Tracking Method with Doppler Measurement in Polar Coordinate System
CN111965618A (en) * 2020-08-18 2020-11-20 中国电子科技集团公司第三十八研究所 Conversion measurement tracking method and system integrating Doppler measurement
CN115201799A (en) * 2022-09-09 2022-10-18 昆明理工大学 A Time-varying Kalman Filter Tracking Method for Sonar

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106950562A (en) * 2017-03-30 2017-07-14 电子科技大学 A kind of state fusion method for tracking target based on predicted value measurement conversion
CN107688179A (en) * 2017-08-07 2018-02-13 上海无线电设备研究所 Combined chance data interconnection method based on doppler information auxiliary
CN108226920A (en) * 2018-01-09 2018-06-29 电子科技大学 A kind of maneuvering target tracking system and method based on predicted value processing Doppler measurements
CN111650577A (en) * 2020-06-12 2020-09-11 电子科技大学 A Maneuvering Target Tracking Method with Doppler Measurement in Polar Coordinate System
CN111965618A (en) * 2020-08-18 2020-11-20 中国电子科技集团公司第三十八研究所 Conversion measurement tracking method and system integrating Doppler measurement
CN115201799A (en) * 2022-09-09 2022-10-18 昆明理工大学 A Time-varying Kalman Filter Tracking Method for Sonar

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
基于预测信息的量测转换序贯滤波目标跟踪;彭瀚,程婷;系统工程与电子技术;第41卷(第3期);449-554 *

Also Published As

Publication number Publication date
CN116224320A (en) 2023-06-06

Similar Documents

Publication Publication Date Title
CN109284677B (en) A Bayesian Filter Target Tracking Algorithm
CN108226920B (en) A Maneuvering Target Tracking System and Method Based on Predicted Value Processing Doppler Measurement
CN107045125B (en) Interactive multi-model radar target tracking method based on predicted value measurement conversion
Liu et al. Unscented extended Kalman filter for target tracking
CN111722214B (en) Method for realizing radar multi-target tracking PHD
CN110208792B (en) Arbitrary straight line constraint tracking method for simultaneously estimating target state and track parameters
CN106646453B (en) A kind of Doppler radar method for tracking target based on predicted value measurement conversion
Shi et al. Adaptive UKF for target tracking with unknown process noise statistics
CN111983927B (en) An Ellipsoid Set Membership Filtering Method Based on Maximum Coentropy MCC Criterion
CN104182609B (en) The three-dimensional target tracking method that unbiased transformation based on decorrelation is measured
CN110231620B (en) Noise-related system tracking filtering method
CN116047495B (en) A State Transformation Fusion Filtering Tracking Method for Three-coordinate Radar
CN111708013B (en) Target tracking filtering method for distance coordinate system
Yang et al. UGHF for acoustic tracking with state-dependent propagation delay
CN111693984B (en) Improved EKF-UKF moving target tracking method
CN110516193A (en) Maneuvering Target Tracking Method Based on Transformed Rayleigh Filter in Cartesian Coordinate System
CN116224320B (en) A radar target tracking method that processes Doppler measurements in polar coordinates
CN117784064A (en) Pre-observation integral fusion tracking method for Doppler measurement
CN111736144B (en) Maneuvering turning target state estimation method only by distance observation
CN118759514A (en) A multi-target tracking method
Zhou et al. State estimation with destination constraints
CN111504327B (en) Generalized label multiple Bernoulli target tracking method based on track smoothing technology
Garapati Vaishnavi et al. Underwater bearings-only tracking using particle filter
Xiong et al. The linear fitting Kalman filter for nonlinear tracking
Li et al. A cphd filter based on em star-convex random hypersurface model for multiple extended targets

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant