法律状态公告日
法律状态信息
法律状态
2019-11-19
授权
授权
2017-03-22
实质审查的生效 IPC(主分类):G06F17/50 申请日:20160928
实质审查的生效
2017-02-22
公开
公开
技术领域
本发明涉及自动控制和信息技术领域,可用于在军事和民用领域中对高机动运动目标的实时定位跟踪,具体涉及一种基于对数似然估计的无源定位跟踪新方法。
背景技术
无源定位技术是一种定位设备本身不发射信号,仅仅是依靠被动地接收辐射源的信息来实现定位的技术。它可以利用未知位置的辐射源的辐射信息,确定出该辐射源的类型、空间和地理位置;或者利用已知地理位置的辐射源来确定航行中物体的空间和地理位置,这也是导航和制导定位中的一项重要技术手段。与有源定位技术相比,无源定位技术具有作用距离远、隐蔽接收、不易被对方发觉等优点,是现代一体化防空系统、机载对地对海攻击以及对付隐身目标的远程预警系统的重要组成部分,对于提高系统在电子战环境下的生存能力和作战能力具有重要作用,因此无源定位跟踪技术一直是研究的热点和难点。
无源定位是通过观测站接收来自目标的无线电信号,并从信号中挖掘出用于定位的观测量。一般的观测量包括到达时间(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)表示:
这里定义
重新定义测量序列,用向量ak表示为式(5),
ak=[A1,k,A2,k,…,AN,k,E1,k,E2,k,…,EN,k]T>
同时测量真值序列用向量
根据式(2)、(5)、(6),可以得出下式(7),
这里
bk=[n1,k,n2,k,…,nN,k,e1,k,e2,k,…,eN,k]T
由于噪声序列ni,k和ei,k是互不相关的零均值高斯随机变量,方差分别为
这里
为了利用含噪声项向量ak估计飞行目标在k时刻的位置(xk,yk,zk),定义如下向量sk,向量sk由式(9)表示:
向量元素(xk,yk,zk)给出了飞行器在k时刻的位置,
假定sk的最大似然估计
2)利用新的量测序列ak更新sk的最大似然估计
因为最大似然估计是渐近的高斯函数分布,因此我们可以假定估计值
这里ρ1为:
因为在式(7)中,bk是均值为0,方差为Rk的高斯高斯随机向量,所以向量ak是均值为
这里ρ2为:
在给定
由此,负对数似然函数L(sk)经计算等于式(15):
这里常数项被省略,在给定
3)为了便于快速实时滤波,利用对数似然估计将多站测角无源定位非线性观测方程进行伪线性化处理,给出了目标位置计算的闭式解;
根据(13)式和(14)式,飞行目标位置坐标状态变量xk,yk,zk与测量值Ai,k和Ei,k存在非线性形式,为了得到状态变量与测量之间的线性关系,我们将在
对(13)式在
这里
符号
这里
其中
其中
向量
这里
将上式计算结果代入(15)式,可以得到-L(sk)另外一个表达式(23),
因此,为了得到状态向量sk在k时刻的最大似然估计,必须最小化-L(sk);
4)通过伪线性化处理,给出了目标位置状态变量真实值与预测值之间的关系式,在此基础上建立目标定位跟踪状态方程;
为了求解sk的估计值
因为
所以(23)式求出的
矩阵Gk叫增益矩阵,经变换后得到下面的等式(26),
由上述推导结果可以看出,在给定
第一步:计算
第二步:计算
第三步:计算pk/k=(I-GkHk)pk/k-1;
5)运用“当前”统计模型和卡尔曼滤波,结合测量方程和状态方程,建立机动目标定位跟踪的递推关系式,实现基于测角的机动目标无源定位跟踪;
在上述中,当计算
这里状态转移矩阵F由式(29)表示,
其中
U由
U=[u1>2>3>4>5>6>7>8>9]T>
其中
这里,F表示状态转移矩阵,T表示采样间隔,(ax,ay,az)表示(x,y,z)方向机动,
本发明的有益效果是:
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)表示:
这里定义
重新定义测量序列,用向量ak表示为式(5),
同时测量真值序列用向量
根据式(2)、(5)、(6),可以得出下式(7),
这里
bk=[n1,k,n2,k,…,nN,k,e1,k,e2,k,…,eN,k]T
由于噪声序列ni,k和ei,k是互不相关的零均值高斯随机变量,方差分别为
E[bkbl]=δklRk>
这里
为了利用含噪声项向量ak估计飞行目标在k时刻的位置(xk,yk,zk),定义如下向量sk,向量sk由式(9)表示:
向量元素(xk,yk,zk)给出了飞行器在k时刻的位置,
假定sk的最大似然估计
2)利用新的量测序列ak更新sk的最大似然估计
因为最大似然估计是渐近的高斯函数分布,因此我们可以假定估计值
这里ρ1为:
因为在式(7)中,bk是均值为0,方差为Rk的高斯高斯随机向量,所以向量ak是均值为
这里ρ2为:
在给定
由此,负对数似然函数L(sk)经计算等于式(15):
这里常数项被省略,在给定
3)为了便于快速实时滤波,利用对数似然估计将多站测角无源定位非线性观测方程进行伪线性化处理,给出了目标位置计算的闭式解;
根据(13)式和(14)式,飞行目标位置坐标状态变量xk,yk,zk与测量值Ai,k和Ei,k存在非线性形式,为了得到状态变量与测量之间的线性关系,我们将在
对(13)式在
这里
符号
这里
其中
其中
向量
这里
将上式计算结果代入(15)式,可以得到-L(sk)另外一个表达式(23),
因此,为了得到状态向量sk在k时刻的最大似然估计,必须最小化-L(sk);
4)通过伪线性化处理,给出了目标位置状态变量真实值与预测值之间的关系式,在此基础上建立目标定位跟踪状态方程;
为了求解sk的估计值
因为
所以(23)式求出的
矩阵Gk叫增益矩阵,经变换后得到下面的等式(26),
由上述推导结果可以看出,在给定
第一步:计算
第二步:计算
第三步:计算pk/k=(I-GkHk)pk/k-1;
5)运用“当前”统计模型和卡尔曼滤波,结合测量方程和状态方程,建立机动目标定位跟踪的递推关系式,实现基于测角的机动目标无源定位跟踪;
在上述中,当计算
这里状态转移矩阵F由式(29)表示,
其中
U由
U=[u1>2>3>4>5>6>7>8>9]T>
其中
这里,F表示状态转移矩阵,T表示采样间隔,(ax,ay,az)表示(x,y,z)方向机动,a表示随机加速度的均值(加速据)时间常数的倒数,W表示状态噪声,服从零均值高斯分布,方差为Q,U表示加速度系数矩阵。
实施例
为了验证算法的可行性,我们作以下三种仿真分析。
第一种:设目标在平面上作匀加速运动,起始坐标在原点,起始速度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)。
机译: 基于警卫队服线的信道估计误差的对数似然估计
机译: 基于安全范围确定的通道估计误差的对数似然估计
机译: 基于警卫队服线的信道估计误差的对数似然估计