[发明专利]一种基于中心对称多面体的机动目标运动坐标区间估计方法在审
申请号: | 202111185198.1 | 申请日: | 2021-10-12 |
公开(公告)号: | CN113885354A | 公开(公告)日: | 2022-01-04 |
发明(设计)人: | 费中阳;唐琦;陈伟重;吴玉虎;孙希明 | 申请(专利权)人: | 大连理工大学 |
主分类号: | G05B17/02 | 分类号: | G05B17/02 |
代理公司: | 辽宁鸿文知识产权代理有限公司 21102 | 代理人: | 苗青 |
地址: | 116024 辽*** | 国省代码: | 辽宁;21 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 基于 中心对称 多面体 机动 目标 运动 坐标 区间 估计 方法 | ||
1.一种基于中心对称多面体的机动目标运动坐标区间估计方法,其特征在于,包括以下步骤:
S1.建立多转弯率的飞行器运动坐标的状态空间模型;
S1.1建立离散时间下的运动学方程描述:
vx(k+1)=cos(wiTs)vx(k)-sin(wiTs)vy(k)+Tsv1(k)
vy(k+1)=sin(wiTs)vx(k)+cos(wiTs)vy(k)+Tsv2(k)
其中sx为X轴上的位移分量,vx为X轴上的速度分量,sy为Y轴上的位移分量,vy为Y轴上的速度分量,ω为转弯率,Ts为采样时间间隔,v1和v2建模为高斯白噪声;
定义机动目标的状态向量x=[sx vx sy vy]T,扰动向量为v=[v1 v2]T,由上述运动学方程得到:
x(k+1)=Aix(k)+DiV(k)
其中T表示转置,Ai和Di为与wi相关的系统矩阵;
考虑系统的测量输出,假设只有系统的位置作为测量输出,系统的状态空间模型写成如下形式:
其中y为系统的测量输出向量,Ai,Ci和Di为系统的参数矩阵,表达式如下:
S1.2建立系统的模态转移矩阵;考虑部分转移概率已知的情况,将转移概率矩阵表示为:
其中πij表示系统由模态i跳向模态j的概率,S为系统模态数目,“未知”表示转移概率完全未知,定义更进一步表示显然有m+n=S,其中表示转移概率矩阵第i行第m个已知的元素的索引位置,表示转移概率矩阵第i行第n个未知的元素的索引位置,
S2.对S1获得的状态空间模型使用龙伯格观测器,获得动态误差系统;
对状态空间模型使用龙伯格观测器,考虑如下观测器:
其中是状态估计向量,Li(i=1,2,...,S)是需要设计的观测器增益矩阵;
定义估计误差为:
从而得到动态误差系统:
ek+1=(Ai-LiCi)ek+DiVk (4)
S3.基于李雅普诺夫第二方法,针对S2获得的动态误差系统求取观测器增益矩阵;
设计的观测器增益矩阵需要使得动态误差系统满足两个条件:
(i)动态误差系统(4)是随机稳定的,即在vk=0的情况下,初始值e0和r0任意给定.成立;
(ii)在零初始条件下,对于所有不为0的vk,给定扰动抑制指标γ>0,使得系统(4)满足
设计的观测器增益矩阵其中Qi和Fi需要满足以下的线性矩阵不等式条件,使用优化工具箱进行计算可求得具体数值:
对于考虑两种情况,即:
情况1:
情况2:
其中Ωi=QiAi-FiCi,j=1,2,...,S,φ为空集,Qi为4×4的实矩阵,Pi为对称正定矩阵,Fi为4×2的实矩阵;
S4.使用S3获得的观测器增益矩阵建立基于中心对称多面体的区间观测的迭代计算过程;
根据具体的转移概率矩阵求解矩阵不等式(5)或矩阵不等式(6),可获得一组{Li}的可行解,即观测器增益,则观测状态的上下界由下式给出:
其中为xk的估计值,由S2中的式(2)计算可得,Hk为4×m的实矩阵,其计算过程由下式给出:
Hk+1=[(Ai-LiCi)HkDiV] (8)
其中H0、V为已知的矩阵,通过式(8)进行迭代计算得到Hk。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于大连理工大学,未经大连理工大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202111185198.1/1.html,转载请声明来源钻瓜专利网。