CN106446422B - 一种基于对数似然估计的无源定位跟踪新方法 - Google Patents
一种基于对数似然估计的无源定位跟踪新方法 Download PDFInfo
- Publication number
- CN106446422B CN106446422B CN201610858925.9A CN201610858925A CN106446422B CN 106446422 B CN106446422 B CN 106446422B CN 201610858925 A CN201610858925 A CN 201610858925A CN 106446422 B CN106446422 B CN 106446422B
- Authority
- CN
- China
- Prior art keywords
- formula
- target
- estimation
- vector
- moment
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 29
- 238000005259 measurement Methods 0.000 claims abstract description 44
- 230000001133 acceleration Effects 0.000 claims abstract description 20
- 238000001914 filtration Methods 0.000 claims abstract description 9
- 239000011159 matrix material Substances 0.000 claims description 36
- 238000013179 statistical model Methods 0.000 claims description 7
- 238000009795 derivation Methods 0.000 claims description 6
- 238000005070 sampling Methods 0.000 claims description 4
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 claims description 3
- 230000033001 locomotion Effects 0.000 description 12
- 238000005516 engineering process Methods 0.000 description 7
- 230000005855 radiation Effects 0.000 description 5
- 238000002474 experimental method Methods 0.000 description 3
- 238000004088 simulation Methods 0.000 description 3
- 238000000342 Monte Carlo simulation Methods 0.000 description 2
- 230000008901 benefit Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Computer Hardware Design (AREA)
- Evolutionary Computation (AREA)
- Geometry (AREA)
- General Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
一种基于对数似然估计的无源定位跟踪新方法,利用对数似然估计将多站测角无源定位非线性观测方程进行伪线性化处理,用最大似然估计求出目标的位置并给出了目标定位算法的闭式解,接着利用“当前”统计机动模型和卡尔曼滤波,在线实时计算目标位置、速度和加速度,实现对目标的实时精确定位跟踪。
Description
技术领域
本发明涉及自动控制和信息技术领域,可用于在军事和民用领域中对高机动运动目标的实时定位跟踪,具体涉及一种基于对数似然估计的无源定位跟踪新方法。
背景技术
无源定位技术是一种定位设备本身不发射信号,仅仅是依靠被动地接收辐射源的信息来实现定位的技术。它可以利用未知位置的辐射源的辐射信息,确定出该辐射源的类型、空间和地理位置;或者利用已知地理位置的辐射源来确定航行中物体的空间和地理位置,这也是导航和制导定位中的一项重要技术手段。与有源定位技术相比,无源定位技术具有作用距离远、隐蔽接收、不易被对方发觉等优点,是现代一体化防空***、机载对地对海攻击以及对付隐身目标的远程预警***的重要组成部分,对于提高***在电子战环境下的生存能力和作战能力具有重要作用,因此无源定位跟踪技术一直是研究的热点和难点。
无源定位是通过观测站接收来自目标的无线电信号,并从信号中挖掘出用于定位的观测量。一般的观测量包括到达时间(Time of Arrival,TOA),接受信号强度(ReceivedSignal Strength,RSS),到达时间差(Time Difference of Arrival,TDOA),到达方位角和俯仰角(Angle of Arrival,AOA)[8,9],到达频率差(FrequencyDifference of Arrival,FDOA)等。根据上述观测信息均能够建立关于目标位置或速度与观测站位置之间的(非线性)方程,再通过优化求解该方程即可获得关于目标位置或速度的参数信息。近些年来,基于上述观测量的目标定位算法已相继提出,其中包括Taylor级数迭代算法,总体最小二乘(Total Least Squares,TLS)算法,约束加权最小二乘(Constrained Weighted LeastSquares,CWLS)算法,约束总体最小二乘(Constrained Total Least Squares,CTLS)算法,结构总体最小二乘(Structured Total Least Squares,STLS)算法。然而,上述算法大都需要迭代运算,这除了带来较复杂的运算量外,还会出现迭代发散和局部收敛等问题。
发明内容
为了克服上述现有技术的不足,本发明的目的是提供一种基于对数似然估计的无源定位跟踪新方法,解决了传统无源定位跟踪方法中迭代运算出现迭代发散、收敛于局部解以及运算量大的问题。本发明针对多基站测角无源定位跟踪技术,利用对数似然估计将多站测角无源定位非线性观测方程进行伪线性化处理,用最大似然估计求出目标的位置并给出了目标定位算法的闭式解,接着利用“当前”统计机动模型和卡尔曼滤波,在线实时计算目标位置、速度和加速度,实现对目标的实时精确定位跟踪。通过理论证明和仿真实验证明本发明提出闭式解的定位性能均能够达到克拉美罗下限(Cramér-Rao Bound,CRB),从而验证文中理论分析的有效性。
一种基于对数似然估计的无源定位跟踪新方法,其特征在于,包括如下步骤:
1)根据基站测角与目标位置之间数学关系,建立目标定位跟踪测量方程,测量噪声服从高斯分布,同时确定目标状态变量;
在直角坐标系下,假设观测站i的位置分别为(xi,yi,zi),i=1,2,…,N,飞行目标的空间位置在k时刻为(xk,yk,zk),观测站i测得飞行目标在k时刻的方位角为Ai,k和俯仰角为Ei,k,在存在测量噪声情况下,Ai,k和Ei,k可以用下式(1)、式(2)表示:
这里定义和以式(3)、式(4)表示:
和表示观测站i测得方位角和俯仰角的真值,ni,k和ei,k是互不相关的测量噪声序列,服从均值为0的高斯分布,其方差分别由下式给出:
重新定义测量序列,用向量ak表示为式(5),
ak=[A1,k,A2,k,…,AN,k,E1,k,E2,k,…,EN,k]T (5)
同时测量真值序列用向量表示为式(6),
根据式(2)、(5)、(6),可以得出下式(7),
这里
bk=[n1,k,n2,k,…,nN,k,e1,k,e2,k,…,eN,k]T
由于噪声序列ni,k和ei,k是互不相关的零均值高斯随机变量,方差分别为和噪声序列bk是2N维向量,均值为0,方差矩阵由式(8)给出:
这里
为了利用含噪声项向量ak估计飞行目标在k时刻的位置(xk,yk,zk),定义如下向量sk,向量sk由式(9)表示:
向量元素(xk,yk,zk)给出了飞行器在k时刻的位置,给出了k时刻飞行器在(x,y,z)方向上的飞行速度,给出了k时刻飞行器在(x,y,z)方向上的飞行加速度,
假定sk的最大似然估计和它的误差协方差矩阵pk/k-1先于ak被计算出来,和pk/k-1定义如下形式向量,由式(10)、式(11)表示,
2)利用新的量测序列ak更新sk的最大似然估计和误差协方差矩阵pk/k-1。sk的更新估计将用表示,更新误差协方差矩阵用pk/k表示,根据最大似然估计原理,建立求解目标状态变量的对数似然函数,通过求导可以计算出目标位置的全局最优解;
因为最大似然估计是渐近的高斯函数分布,因此我们可以假定估计值的概率密度函数是均值为sk,方差为pk/k-1的高斯函数,的概率密度函数定义由式(12)表示:
这里ρ1为:
因为在式(7)中,bk是均值为0,方差为Rk的高斯高斯随机向量,所以向量ak是均值为方差为Rk的高斯随机向量,因此ak的概率密度函数g(ak)由式(13)给出,
这里ρ2为:
在给定和ak的条件下,sk的似然函数l(sk)表示如式(14):
由此,负对数似然函数L(sk)经计算等于式(15):
这里常数项被省略,在给定和ak的条件下,为了得到sk的最大似然估计,必须最小化-L(sk),由式(16)表示:
3)为了便于快速实时滤波,利用对数似然估计将多站测角无源定位非线性观测方程进行伪线性化处理,给出了目标位置计算的闭式解;
根据(13)式和(14)式,飞行目标位置坐标状态变量xk,yk,zk与测量值Ai,k和Ei,k存在非线性形式,为了得到状态变量与测量之间的线性关系,我们将在线性化这两个等式,
对(13)式在进行泰勒级数展开,忽略掉高次项,得式(17):
这里
符号和表示估计的观测站与目标的方位角和水平距离,观测站位于(xi,yi,zi),为从(17)式估计目标在k时刻的位置,将(17)式进行数学变换得到下式:
这里
对(14)式在进行泰勒级数展开,忽
略掉高次项,得到下式:
其中
和同上,表示估计的观测站与目标的距离和方位角。为从(19)式估计目标在k时刻的位置,将(19)式进行数学变换,得到下面的关系式(20):
其中
通过对量测Ai,k和Ei,k重复上面提到的线性化过程,可以得到下面伪测量向量,由式(21)表示:
向量也可以表示成矩阵形式,如式(22),
这里
将上式计算结果代入(15)式,可以得到-L(sk)另外一个表达式(23),
因此,为了得到状态向量sk在k时刻的最大似然估计,必须最小化-L(sk);
4)通过伪线性化处理,给出了目标位置状态变量真实值与预测值之间的关系式,在此基础上建立目标定位跟踪状态方程;
为了求解sk的估计值求-L(sk)对sk的梯度▽(-L(sk)),令▽(-L(sk))=0,得到式(24),
因为
所以(23)式求出的是全局最小值,在(23)式中Gk由式(25)表示,
矩阵Gk叫增益矩阵,经变换后得到下面的等式(26),
的误差协方差矩阵pk/k由式(27)给出
由上述推导结果可以看出,在给定pk/k-1和ak时,和pk/k计算过程如下:
第一步:计算
第二步:计算
第三步:计算pk/k=(I-GkHk)pk/k-1;
5)运用“当前”统计模型和卡尔曼滤波,结合测量方程和状态方程,建立机动目标定位跟踪的递推关系式,实现基于测角的机动目标无源定位跟踪;
在上述中,当计算和pk/k,假定和它的误差协方差矩阵pk/k-1已经给定,因此在k+1时刻计算和pk+1/k+1时,必须事先给定和pk+1/k的最大似然估计,在这部分将给出如何利用和pk/k估计和pk+1/k值,运动目标从k时刻到k+1时刻机动模型采用“当前”统计模型,即式(28)所表示,
这里状态转移矩阵F由式(29)表示,
其中
U由
U=[u1 u2 u3 u4 u5 u6 u7 u8 u9]T (30)
其中
这里,F表示状态转移矩阵,T表示采样间隔,(ax,ay,az)表示(x,y,z)方向机动,表示随机加速度的均值(加速据)时间常数的倒数,W表示状态噪声,服从零均值高斯分布,方差为Q,U表示加速度系数矩阵。
是加速度的方差,由估计理论,可以求出和pk+1/k,由式(32)、式(33)表示,
本发明的有益效果是:
1)运用最大似然估计及对数似然函数伪线性化处理,使得目标位置计算具有闭式解,而且计算结果具有全局最优解,避免了传统无源定位方法中迭代运算出现迭代发散、收敛于局部解的问题;
2)在利用对数似然估计将多站测角无源定位非线性观测方程进行伪线性化处理的基础上,运用“当前”统计模型和卡尔曼滤波算法,实现了在线实时的目标定位跟踪,解决了传统迭代计算复杂度高的问题;
3)通过理论证明和仿真实验验证,本发明提出闭式解的定位性能均能够达到克拉美罗下限(Cramér-Rao Bound,CRB),从而验证本方法的有效性。
附图说明
图1为本发明的第一种仿真位置估计曲线;
图2为本发明的第一种仿真速度估计曲线;
图3为本发明的第一种仿真加速的估计曲线;
图4为本发明的第二种仿真位置估计曲线;
图5为本发明的第二种仿真速度估计曲线;
图6为本发明的第二种仿真加速度估计曲线;
图7为本发明的位置估计RMS与Cramér Rao Bound下限。
具体实施方式
以下结合实施例对本发明进一步叙述。
一种基于对数似然估计的无源定位跟踪新方法,其特征在于,包括如下步骤:
1)根据基站测角与目标位置之间数学关系,建立目标定位跟踪测量方程,测量噪声服从高斯分布,同时确定目标状态变量;
在直角坐标系下,假设观测站i的位置分别为(xi,yi,zi),i=1,2,…,N,飞行目标的空间位置在k时刻为(xk,yk,zk),观测站i测得飞行目标在k时刻的方位角为Ai,k和俯仰角为Ei,k,在存在测量噪声情况下,Ai,k和Ei,k可以用下式(1)、式(2)表示:
这里定义和以式(3)、式(4)表示:
和表示观测站i测得方位角和俯仰角的真值,ni,k和ei,k是互不相关的测量噪声序列,服从均值为0的高斯分布,其方差分别由下式给出:
重新定义测量序列,用向量ak表示为式(5),
同时测量真值序列用向量表示为式(6),
根据式(2)、(5)、(6),可以得出下式(7),
这里
bk=[n1,k,n2,k,…,nN,k,e1,k,e2,k,…,eN,k]T
由于噪声序列ni,k和ei,k是互不相关的零均值高斯随机变量,方差分别为和噪声序列bk是2N维向量,均值为0,方差矩阵由式(8)给出:
E[bkbl]=δklRk (8)
这里
为了利用含噪声项向量ak估计飞行目标在k时刻的位置(xk,yk,zk),定义如下向量sk,向量sk由式(9)表示:
向量元素(xk,yk,zk)给出了飞行器在k时刻的位置,给出了k时刻飞行器在(x,y,z)方向上的飞行速度,给出了k时刻飞行器在(x,y,z)方向上的飞行加速度,
假定sk的最大似然估计和它的误差协方差矩阵pk/k-1先于ak被计算出来,和pk/k-1定义如下形式向量,由式(10)、式(11)表示,
2)利用新的量测序列ak更新sk的最大似然估计和误差协方差矩阵pk/k-1。sk的更新估计将用表示,更新误差协方差矩阵用pk/k表示,根据最大似然估计原理,建立求解目标状态变量的对数似然函数,通过求导可以计算出目标位置的全局最优解;
因为最大似然估计是渐近的高斯函数分布,因此我们可以假定估计值的概率密度函数是均值为sk,方差为pk/k-1的高斯函数,的概率密度函数定义由式(12)表示:
这里ρ1为:
因为在式(7)中,bk是均值为0,方差为Rk的高斯高斯随机向量,所以向量ak是均值为方差为Rk的高斯随机向量,因此ak的概率密度函数g(ak)由式(13)给出,
这里ρ2为:
在给定和ak的条件下,sk的似然函数l(sk)表示如式(14):
由此,负对数似然函数L(sk)经计算等于式(15):
这里常数项被省略,在给定和ak的条件下,为了得到sk的最大似然估计,必须最小化-L(sk),由式(16)表示:
3)为了便于快速实时滤波,利用对数似然估计将多站测角无源定位非线性观测方程进行伪线性化处理,给出了目标位置计算的闭式解;
根据(13)式和(14)式,飞行目标位置坐标状态变量xk,yk,zk与测量值Ai,k和Ei,k存在非线性形式,为了得到状态变量与测量之间的线性关系,我们将在线性化这两个等式,
对(13)式在进行泰勒级数展开,忽略掉高次项,得式(17):
这里
符号和表示估计的观测站与目标的方位角和水平距离,观测站位于(xi,yi,zi),为从(17)式估计目标在k时刻的位置,将(17)式进行数学变换得到下式:
这里
对(14)式在进行泰勒级数展开,忽略掉高次项,得到下式:
其中
和同上,表示估计的观测站与目标的距离和方位角。为从(19)式估计目标在k时刻的位置,将(19)式进行数学变换,得到下面的关系式(20):
其中
通过对量测Ai,k和Ei,k重复上面提到的线性化过程,可以得到下面伪测量向量,由式(21)表示:
向量也可以表示成矩阵形式,如式(22),
这里
将上式计算结果代入(15)式,可以得到-L(sk)另外一个表达式(23),
因此,为了得到状态向量sk在k时刻的最大似然估计,必须最小化-L(sk);
4)通过伪线性化处理,给出了目标位置状态变量真实值与预测值之间的关系式,在此基础上建立目标定位跟踪状态方程;
为了求解sk的估计值求-L(sk)对sk的梯度▽(-L(sk)),令▽(-L(sk))=0,得到式(24),
因为
所以(23)式求出的是全局最小值,在(23)式中Gk由式(25)表示,
矩阵Gk叫增益矩阵,经变换后得到下面的等式(26),
的误差协方差矩阵pk/k由式(27)给出
由上述推导结果可以看出,在给定pk/k-1和ak时,和pk/k计算过程如下:
第一步:计算
第二步:计算
第三步:计算pk/k=(I-GkHk)pk/k-1;
5)运用“当前”统计模型和卡尔曼滤波,结合测量方程和状态方程,建立机动目标定位跟踪的递推关系式,实现基于测角的机动目标无源定位跟踪;
在上述中,当计算和pk/k,假定和它的误差协方差矩阵pk/k-1已经给定,因此在k+1时刻计算和pk+1/k+1时,必须事先给定和pk+1/k的最大似然估计,在这部分将给出如何利用和pk/k估计和pk+1/k值,运动目标从k时刻到k+1时刻机动模型采用“当前”统计模型,即式(28)所表示,
这里状态转移矩阵F由式(29)表示,
其中
U由
U=[u1 u2 u3 u4 u5 u6 u7 u8 u9]T (30)
其中
这里,F表示状态转移矩阵,T表示采样间隔,(ax,ay,az)表示(x,y,z)方向机动,a表示随机加速度的均值(加速据)时间常数的倒数,W表示状态噪声,服从零均值高斯分布,方差为Q,U表示加速度系数矩阵。
是加速度的方差,由估计理论,可以求出和pk+1/k,由式(32)、式(33)表示,
实施例
为了验证算法的可行性,我们作以下三种仿真分析。
第一种:设目标在平面上作匀加速运动,起始坐标在原点,起始速度v0=2m/s,加速度a0=0.2m/s2。角度测量误差服从均值为0,方差为0.001o的高斯分布。仿真中取T=1s,机动常数为10,两个观测站的位置o1(0,50)、o2(0,100)。图(1)给出了跟踪曲线结果,图(2)给出了速度估计结果,图(3)给出了加速度估计结果。由图可以看出位置、速度,加速度估计值和理论值很接近。位置的均方根误差0.032,速度的均方根误差为0.0897,加速度均方根误差0.176。
第二种:设目标在平面上作s型运动,起始坐标在原点。其运动曲线由下面方程决定:
x=10sin(5tpi/180)
初始条件同上。图(4)给出了跟踪曲线结果,图(5)给出了速度估计结果,图(6)给出了加速度估计结果。由图可以看出位置、速度,估计值和理论值很接近,加速度估计值与理论值相差25%,在一定误差范围内,这种估计结果可以接受。经过计算位置的均方根误差0.16,速度的均方根误差为0.267,加速度均方根误差0.47。
在经过100次蒙特卡罗仿真后,虽然每次估计的曲线不同,但统计结果基本相同,尤其是位置估计相对误差小于4%。这说明采用上述不仅可以获得高精度目标定位精度,而且提供了精度较高的速度和加速度估计。但是,当目标运动非常复杂时,加速度的估计精度可能下降。
第三种,仿真条件两观测站的位置坐标分别为:(-40km,0,0),(-40km,0,0),采样时间间隔为1s,方位角和俯仰角的观测误差为5mrad,目标的初始位置是(-10km,50km,10km)。运动轨迹分三个阶段:
运动阶段1:匀速直线运动,各方向分速度为:vx=0.2m/s,vy=0.1m/s,vz=0m/s,运行时间为1500s;
运动阶段2:匀速圆周运动,角速度为0.157rard/s,向心加速度为74m/s2,线速度为471m/s,圆半径为3km,运行时间为500s;
运动阶段3:匀速直线运动,各方向分速度为:vx=0.2m/s,vy=0.2m/s,vz=0.2m/s,运行时间为1000s。
本文经过100次蒙特卡罗仿真实验,实验结果如图7所示,由实验结果可以看出,利用本文方法对目标位置进行计算,其位置估计均方根误差(RMS)渐近达到了克拉美罗下限(Cramér-Rao Bound,CRB)。
Claims (1)
1.一种基于对数似然估计的无源定位跟踪新方法,其特征在于,包括如下步骤:
1)根据基站测角与目标位置之间数学关系,建立目标定位跟踪测量方程,测量噪声服从高斯分布,同时确定目标状态变量;
在直角坐标系下,假设观测站i的位置分别为(xi,yi,zi),i=1,2,…,N,飞行目标的空间位置在k时刻为(xk,yk,zk),观测站i测得飞行目标在k时刻的方位角为Ai,k和俯仰角为Ei,k,在存在测量噪声情况下,Ai,k和Ei,k可以用下式(1)、式(2)表示:
这里定义和以式(3)、式(4)表示:
和表示观测站i测得方位角和俯仰角的真值,ni,k和ei,k是互不相关的测量噪声序列,服从均值为0的高斯分布,其方差分别由下式给出:
重新定义测量序列,用向量ak表示为式(5),
ak=[A1,k,A2,k,…,AN,k,E1,k,E2,k,…,EN,k]T (5)
同时测量真值序列用向量表示为式(6),
根据式(2)、(5)、(6),可以得出下式(7),
这里
bk=[n1,k,n2,k,…,nN,k,e1,k,e2,k,…,eN,k]T
由于噪声序列ni,k和ei,k是互不相关的零均值高斯随机变量,方差分别为和噪声序列bk是2N维向量,均值为0,方差矩阵由式(8)给出:
E[bkbl]=δklRk (8)
这里
为了利用含噪声项向量ak估计飞行目标在k时刻的位置(xk,yk,zk),定义如下向量sk,向量sk由式(9)表示:
向量元素(xk,yk,zk)给出了飞行器在k时刻的位置,给出了k时刻飞行器在(x,y,z)方向上的飞行速度,给出了k时刻飞行器在(x,y,z)方向上的飞行加速度,
假定sk的最大似然估计和它的误差协方差矩阵pk/k-1先于ak被计算出来,和pk/k-1定义如下形式向量,由式(10)、式(11)表示,
2)利用新的量测序列ak更新sk的最大似然估计和误差协方差矩阵pk/k-1,sk的更新估计将用表示,更新误差协方差矩阵用pk/k表示,根据最大似然估计原理,建立求解目标状态变量的对数似然函数,通过求导可以计算出目标位置的全局最优解;
因为最大似然估计是渐近的高斯函数分布,因此我们可以假定估计值的概率密度函数是均值为sk,方差为pk/k-1的高斯函数,的概率密度函数定义由式(12)表示:
这里ρ1为:
因为在式(7)中,bk是均值为0,方差为Rk的高斯高斯随机向量,所以向量ak是均值为方差为Rk的高斯随机向量,因此ak的概率密度函数g(ak)由式(13)给出,
这里ρ2为:
在给定和ak的条件下,sk的似然函数l(sk)表示如式(14):
由此,负对数似然函数L(sk)经计算等于式(15):
这里常数项被省略,在给定和ak的条件下,为了得到sk的最大似然估计,必须最小化-L(sk),由式(16)表示:
3)为了便于快速实时滤波,利用对数似然估计将多站测角无源定位非线性观测方程进行伪线性化处理,给出了目标位置计算的闭式解;
根据(13)式和(14)式,飞行目标位置坐标状态变量xk,yk,zk与测量值Ai,k和Ei,k存在非线性形式,为了得到状态变量与测量之间的线性关系,我们将在线性化这两个等式,
对(13)式在进行泰勒级数展开,忽略掉高次项,得式(17):
这里
符号和表示估计的观测站与目标的方位角和水平距离,观测站位于(xi,yi,zi),为从(17)式估计目标在k时刻的位置,将(17)式进行数学变换得到下式:
这里
对(14)式在进行泰勒级数展开,忽略掉高次项,得到下式:
其中
和同上,表示估计的观测站与目标的距离和方位角,为从(19)式估计目标在k时刻的位置,将(19)式进行数学变换,得到下面的关系式(20):
其中
通过对量测Ai,k和Ei,k重复上面提到的线性化过程,可以得到下面伪测量向量,由式(21)表示:
向量也可以表示成矩阵形式,如式(22),
这里
将上式计算结果代入(15)式,可以得到-L(sk)另外一个表达式(23),
因此,为了得到状态向量sk在k时刻的最大似然估计,必须最小化-L(sk);
4)通过伪线性化处理,给出了目标位置状态变量真实值与预测值之间的关系式,在此基础上建立目标定位跟踪状态方程;
为了求解sk的估计值求-L(sk)对sk的梯度▽(-L(sk)),令▽(-L(sk))=0,得到式(24),
因为
所以(23)式求出的是全局最小值,在(23)式中Gk由式(25)表示,
矩阵Gk叫增益矩阵,经变换后得到下面的等式(26),
的误差协方差矩阵pk/k由式(27)给出
由上述推导结果可以看出,在给定pk/k-1和ak时,和pk/k计算过程如下:
第一步:计算
第二步:计算
第三步:计算pk/k=(I-GkHk)pk/k-1;
5)运用“当前”统计模型和卡尔曼滤波,结合测量方程和状态方程,建立机动目标定位跟踪的递推关系式,实现基于测角的机动目标无源定位跟踪;
在上述中,当计算和pk/k,假定和它的误差协方差矩阵pk/k-1已经给定,因此在k+1时刻计算和pk+1/k+1时,必须事先给定和pk+1/k的最大似然估计,在这部分将给出如何利用和pk/k估计和pk+1/k值,运动目标从k时刻到k+1时刻机动模型采用“当前”统计模型,即式(28)所表示,
这里状态转移矩阵F由式(29)表示,
其中
U=[u1 u2 u3 u4 u5 u6 u7 u8 u9]T (30)
其中
这里,F表示状态转移矩阵,T表示采样间隔,(ax,ay,az)表示(x,y,z)方向机动,表示随机加速度的均值,即加速据时间常数的倒数,W表示状态噪声,服从零均值高斯分布,方差为Q,U表示加速度系数矩阵;
是加速度的方差,由估计理论,可以求出和pk+1/k,由式(32)、式(33)表示,
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610858925.9A CN106446422B (zh) | 2016-09-28 | 2016-09-28 | 一种基于对数似然估计的无源定位跟踪新方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610858925.9A CN106446422B (zh) | 2016-09-28 | 2016-09-28 | 一种基于对数似然估计的无源定位跟踪新方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106446422A CN106446422A (zh) | 2017-02-22 |
CN106446422B true CN106446422B (zh) | 2019-11-19 |
Family
ID=58170821
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610858925.9A Expired - Fee Related CN106446422B (zh) | 2016-09-28 | 2016-09-28 | 一种基于对数似然估计的无源定位跟踪新方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106446422B (zh) |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107102295A (zh) * | 2017-04-13 | 2017-08-29 | 杭州电子科技大学 | 基于glmb滤波的多传感器tdoa无源定位方法 |
CN107219498B (zh) * | 2017-05-22 | 2019-08-27 | 杭州电子科技大学 | 基于mml-pmht的多基站单频网无源协同定位方法 |
CN108279007B (zh) * | 2018-01-23 | 2020-03-17 | 哈尔滨工业大学 | 一种基于随机信号的定位方法及装置 |
CN108445446B (zh) * | 2018-02-06 | 2020-04-28 | 中国人民解放军战略支援部队信息工程大学 | 一种无源测速定位方法及装置 |
CN109298388B (zh) * | 2018-08-21 | 2020-09-18 | 中国人民解放军战略支援部队信息工程大学 | 基于方位信息的超视距目标地理坐标直接估计方法 |
CN109542215B (zh) * | 2018-10-09 | 2022-03-08 | 中国矿业大学 | 安全帽佩戴监测方法 |
CN110133609B (zh) * | 2019-04-04 | 2020-10-16 | 杭州电子科技大学 | 一种机载外辐射源状态未知下移动接收源路径优化方法 |
CN110113287B (zh) * | 2019-05-10 | 2020-06-05 | 北京邮电大学 | 一种信号确定方法、装置、电子设备及存储介质 |
CN111239718B (zh) * | 2020-01-17 | 2022-11-15 | 电子科技大学 | 一种基于单星辐射源的多基站目标定位方法 |
CN111965594B (zh) * | 2020-07-14 | 2023-06-06 | 杭州电子科技大学 | 一种基于特征值搜索的轻量级直接跟踪方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103176164A (zh) * | 2013-04-11 | 2013-06-26 | 北京空间飞行器总体设计部 | 基于无线传感器网络的多目标无源跟踪方法 |
CN105954741A (zh) * | 2016-04-26 | 2016-09-21 | 杭州电子科技大学 | 一种基于多假设拟蒙特卡罗的多目标无源协同定位方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7551139B1 (en) * | 2006-05-12 | 2009-06-23 | Northrop Grumman Corporation | Multi-platform precision passive location of continuous wave emitters |
-
2016
- 2016-09-28 CN CN201610858925.9A patent/CN106446422B/zh not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103176164A (zh) * | 2013-04-11 | 2013-06-26 | 北京空间飞行器总体设计部 | 基于无线传感器网络的多目标无源跟踪方法 |
CN105954741A (zh) * | 2016-04-26 | 2016-09-21 | 杭州电子科技大学 | 一种基于多假设拟蒙特卡罗的多目标无源协同定位方法 |
Non-Patent Citations (2)
Title |
---|
A new location estimation method based on maximum likelihood function in cellular systems;Aso M 等;《IEEE Vehicular Technology Conference Fall》;20011231;第106-110页 * |
一种改进的UWSAN最大似然目标定位方法;孔燕 等;《计算机仿真》;20120713(第4期);第146-148页 * |
Also Published As
Publication number | Publication date |
---|---|
CN106446422A (zh) | 2017-02-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106446422B (zh) | 一种基于对数似然估计的无源定位跟踪新方法 | |
CN110375730B (zh) | 基于imu和uwb融合的室内定位导航*** | |
CN109917333B (zh) | 融合aoa观测量与tdoa观测量的无源定位方法 | |
CN103744052B (zh) | 一种应用于空中目标定位的双星测时差测向方法及装置 | |
CN108761387B (zh) | 一种固定辐射源的双站时差频差联合定位方法 | |
CN107015199A (zh) | 一种考虑无人机姿态角的双无人机测向时差定位方法 | |
CN105353351A (zh) | 一种基于多信标到达时间差改进型定位方法 | |
CN104569915A (zh) | 多光电探测***中基于目标运动模型的定位方法 | |
CN109724593A (zh) | 一种气浮模拟器位姿状态跟踪测量方法 | |
Chen et al. | TDOA/FDOA mobile target localization and tracking with adaptive extended Kalman filter | |
CN106646413B (zh) | 一种雷达组网垂线交叉融合定位方法及误差解算方法 | |
Liang et al. | A passive localization method of single satellite using TOA sequence | |
CN108828509B (zh) | 一种多平台多辐射源承载关系判定方法 | |
CN104391272B (zh) | 利用测向数据进行目标定位的方法与*** | |
Zhang et al. | Geolocation algorithm of interference sources from FDOA measurements using satellites based on Taylor series expansion | |
Jie et al. | Continuous passive TDOA location method based on multi-flight-vehicle cooperation | |
Hejazi et al. | Lower bound of error in aoa based passive source localization using single moving platform | |
Jian et al. | Algorithm for passive localization with single observer based on ambiguous phase differences measured by rotating interferometer | |
CN104950286A (zh) | 单被动雷达限制条件下最优拐点的确定方法 | |
CN106873016B (zh) | 一种四星对空中目标的时差定位方法 | |
Nikoo et al. | A disambiguation technique for passive localization using trajectory analysis | |
Wang et al. | Passive localization method based on cubature Kalman filter | |
CN105572634B (zh) | 双星时差频差定位缩比试验方法 | |
Nie et al. | Adaptive tracking algorithm based on 3D variable turn model | |
Shang et al. | UAV Ill-conditioned target localization method based on genetic algorithm |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20191119 |
|
CF01 | Termination of patent right due to non-payment of annual fee |