公开/公告号CN102508818A
专利类型发明专利
公开/公告日2012-06-20
原文格式PDF
申请/专利权人 西安费斯达自动化工程有限公司;
申请/专利号CN201110280618.4
发明设计人 史忠科;
申请日2011-09-20
分类号G06F17/11;
代理机构
代理人
地址 710075 陕西省西安市高新区科技路金桥国际广场12101号
入库时间 2023-12-18 05:34:25
法律状态公告日
法律状态信息
法律状态
2015-01-21
授权
授权
2012-07-18
实质审查的生效 IPC(主分类):G06F17/11 申请日:20110920
实质审查的生效
2012-06-20
公开
公开
技术领域
本发明涉及空间运动刚体模型,特别涉及飞行器大机动飞行状态输出问题。
背景技术
机体轴系刚体运动微分方程是描述飞行器、鱼雷、航天器等空间运动的基本方程。通常, 在数据处理等应用中,体轴系的状态变量主要包含3个速度分量、三个欧拉角、以及地面坐标 系的XE,YE,ZE等,由于ZE定义为垂直地面指向地球中心,因此ZE实际为负的飞行高度; XE,YE通常主要依赖GPS、GNSS、北斗等直接给出;欧拉角表示刚体空间运动姿态,而刻画 刚体姿态的微分方程又是其中的核心,通常以三个欧拉角即俯仰、滚转和偏航角来描述。当 刚体的俯仰角为±90°时,滚转角和偏航角无法定值,同时临近该奇点的区域求解误差过大, 导致工程上不可容忍的误差而不能使用;为了避免这一问题,人们首先采用限制俯仰角取值 范围的方法,这使得方程式退化,不能全姿态工作,因而难以广泛用于工程实践。随着对飞 行器极限飞行的研究,人们又相继采用了方向余弦法、等效转动矢量法、四元数法等推算刚 体运动姿态。
方向余弦法避免了欧拉角描述方法的“奇异”现象,用方向余弦法计算姿态矩阵没有方 程退化问题,可以全姿态工作,但需要求解9个微分方程,计算量较大,实时性较差,无法满 足工程实践要求。等效转动矢量法如单子样递推、双子样转动矢量、三子样转动矢量和四子 样旋转矢量法以及在此基础上的各种修正算法和递推算法等。文献中研究旋转矢量时,都是 基于速率陀螺输出为角增量的算法。然而在实际工程中,一些陀螺的输出是角速率信号,如 光纤陀螺、动力调谐陀螺等。当速率陀螺输出为角速率信号时,旋转矢量法的算法误差明显 增大。四元数法是定义4个欧拉角的函数来计算航姿,能够有效弥补欧拉角描述方法的奇异性, 只要解4个一阶微分方程式组即可,比方向余弦姿态矩阵微分方程式计算量有明显的减少,能 满足工程实践中对实时性的要求。其常用的计算方法有毕卡逼近法、二阶、四阶龙格-库塔法 和三阶泰勒展开法等。毕卡逼近法实质是单子样算法,对有限转动引起的不可交换误差没有 补偿,在高动态情况下姿态解算中的算法漂移会十分严重。采用四阶龙格-库塔法求解四元数 微分方程时,随着积分误差的不断积累,会出现三角函数取值超出±1的现象,从而导致计算 发散;泰勒展开法也因计算精度的不足而受到制约。当刚体大机动时,角速率较大导致上述 方法的误差更大;不仅如此,姿态估计的误差常常会导致速度4个分量、高度输出的误差急剧 增大。
发明内容
为了克服现有刚体运动模型输出误差大的问题,本发明提供一种刚体空间运动状态的任 意步长正交级数输出方法,该方法通过定义三元数,使得机体轴系三个速度分量和三元数构 成线性微分方程组,并采用任意步长正交多项式对滚转、俯仰、偏航角速度p,q,r进行近似 逼近描述,可以按照任意阶保持器的方式求解系统的状态转移矩阵,进而得到刚体运动离散 状态方程的表达式,避免了姿态方程奇异问题,从而得到刚体主要运动状态。
本发明解决其技术问题采用的技术方案是,一种刚体空间运动状态的任意步长正交级数 输出方法,其特征包括以下步骤:
1、机体轴系三个速度分量输出为:
其中:u,v,w分别为沿刚体机体轴系x,y,z轴的速度分量,nx,ny,nz分别为沿x,y,z轴的过载, g为重力加速度,s1、s2、s3为定义的三元数,且
p,q,r分别为滚转、俯仰、偏航角速度,T为采样周期;全文参数定义相同;
为基于Chebyshev(切比雪夫)正交多项式得到的任意步长正交多项式的递推形式,a为任意 实数,滚转、俯仰、偏航角速度p,q,r的展开式分别为
p(t)=[p0 p1…pn-1 pn][ξ0(t)ξ1(t)…ξn-1(t)ξn(t)]T
q(t)=[q0 q1…qn-1 qn][ξ0(t)ξ1(t)…ξn-1(t)ξn(t)]T
r(t)=[r0 r1…rn-1 rn][ξ0(t)ξ1(t)…ξn-1(t)ξn(t)]T
2、高度输出为:
其中:h为高度;
3、姿态角的输出为:
其中:θ,ψ分别表示滚转、俯仰、偏航角,
本发明的有益效果是:通过引入三元数使得状态转移矩阵为分块上三角形式,可以降阶求 解状态转移矩阵,大大简化了计算复杂度,便于工程使用。
下面结合实施例对本发明作详细说明。
具体实施方式
1、机体轴系三个速度分量输出为:
其中:u,v,w分别为沿刚体机体轴系x,y,z轴的速度分量,nx,ny,nz分别为沿x,y,z轴的过载, g为重力加速度,s1、s2、s3为定义的三元数,且
p,q,r分别为滚转、俯仰、偏航角速度,T为采样周期;全文参数定义相同;
p(t)=[p0 p1…pn-1 pn][ξ0(t)ξ1(t)…ξn-1(t)ξn(t)]T
q(t)=[q0 q1…qn-1 qn][ξ0(t)ξ1(t)…ξn-1(t)ξn(t)]T
r(t)=[r0 r1…rn-1 rn][ξ0(t)ξ1(t)…ξn-1(t)ξn(t)]T
2、高度输出为:
其中:h为高度;
3、姿态角的输出为:。
其中:θ,ψ分别表示滚转、俯仰、偏航角,
机译: 共享的多级数据编码设备,共享的多级数据解码设备,多级数据处理设备,共享的多级数据编码方法,共享的多级数据解码方法,多级数据处理方法,以及一种计算方法
机译: 一种用于将任意长度的信息分别插入和输出到磁芯移位寄存器中以及从中输出的方法
机译: 一种用于将任意长度的信息分别插入和输出到磁芯移位寄存器中以及从中输出的方法