【技术实现步骤摘要】
一种切换拓扑条件下目标运动状态的估计方法
本专利技术属于切换通信拓扑条件下的分布式滤波算法以及低通一致性滤波算法,具体涉及一种切换拓扑条件下目标运动状态的估计方法。
技术介绍
在目标跟踪、工业设备监控和环境监测等领域通常应用传感器网络对其进行分布式状态估计。而在目标跟踪中由于目标运动的不确定性很大,采用固定的传感器网络对其运动状态进行分布式滤波有些不太实用。因此,采用无人机编队对目标进行跟踪并进行状态估计是较为理想的方法。而无人机编队的通信系统在受到环境因素的影响时可能导致通信链路的中断,进而导致通信拓扑不含生成树;在一定的时间段内,通信拓扑通过编队通信系统的恢复或自组织连接将再次含有生成树。因此,采用一种在这种通信拓扑切换条件下稳定的分布式滤波算法是有必要的。并且,在编队控制算法中基本要求每架无人机都知道目标的运动加速度。即使无人机通过某种传感器可以量测到目标的运动加速度,也必然是含有很大噪声的,从而导致每架无人机量测到的目标运动加速度相差很大。因此,有必要采用一种低通一致性滤波算法对量测到的目标运动加速度进行低通 ...
【技术保护点】
1.一种切换拓扑条件下目标运动状态的估计方法,其特征在于,地面移动目标的运动状态模型为:/n
【技术特征摘要】
1.一种切换拓扑条件下目标运动状态的估计方法,其特征在于,地面移动目标的运动状态模型为:
其中,u(t)∈R2为目标在水平方向的控制输入,系统矩阵A和输入B满足:
A为过程噪声驱动阵,状态变量x=[pxpyvxvy]T代表目标水平方向的位置和速度;过程噪声ω~(0,Q),量测噪声v~(0,R),z为目标位置、速度状态的观测量,观测矩阵H∈I4×4为4阶单位阵,具体步骤如下:
无人机编队在跟踪目标的初始时刻通信拓扑图含有生成树;
(1)将每架无人机量测到的目标含噪声的运动加速度进行低通一致性滤波:
其中,为无人机i对目标运动加速度的估计,为无人机i量测到的目标运动加速度,aij=1表示无人机i与无人机j有通讯链接,aij=0无人机i与无人机j无通讯链接,且Ji=Ni∪{i},Ni为无人机i的邻居;
为了使滤波后的加速度在更小的范...
【专利技术属性】
技术研发人员:徐光延,张华卿,刘皓,张红梅,
申请(专利权)人:沈阳航空航天大学,
类型:发明
国别省市:辽宁;21
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。