一种飞行器陀螺仪的零点漂移偏差和姿态估计方法技术

本发明专利技术公开了一种飞行器陀螺仪的零点漂移偏差和姿态估计方法，基于飞行器的姿态运动学方程设计有限时间观测器；将飞行器的期望姿态和陀螺仪测出的角速度测量值输入有限时间观测器中，通过有限时间观测器将零点漂移偏差在有限的时间内估计出来；所述飞行器的期望姿态为人为设定的期望飞行器所达到的目标姿态；将陀螺仪测出的角速度测量值减去零点漂移偏差，即可得到角速度的真实值。本发明专利技术中的有限时间观测器是基于飞行器姿态运动学方程所设计的数学模型，更具有针对性，且具有更高的抗干扰性能和更快的收敛性，因此本发明专利技术的精度高、收敛性快，能够实时快速、准确地估计零点漂移偏差。

【技术实现步骤摘要】
一种飞行器陀螺仪的零点漂移偏差和姿态估计方法
本专利技术涉及飞行器陀螺仪校准的
，尤其是一种飞行器陀螺仪的零点漂移偏差和姿态估计方法。
技术介绍
飞行器在姿态控制的时候，需要用到角速度和姿态。角速度一般可以由陀螺仪测量得到，但是由于供电和器件自身的原因，陀螺仪在每次上电的初始时刻将有一个不固定的常值，称之为零点漂移值，零点漂移值受供电电源和环境温度等因素的影响，会大大影响陀螺仪的精度。飞行器姿态可以通过陀螺仪的角速度数据对飞行器姿态运动学方程解算获得，也可以通过加速度计获取，但陀螺仪角速度数据存在误差，加速度计存在噪声干扰，导致了其获得的姿态并不精确。在飞行器姿态控制的时候，由于飞行器姿态和角速度数据获取的不精确，导致飞行器的控制力矩将会有偏差，可能会导致飞行器的控制失效。另外飞行器在平稳飞行的时候，期望角速度一般为0，但由于存在零点漂移值，其所测得的角速度将不为0，会对飞行器的平稳控制产生极大的威胁，严重可能导致飞行器的震颤从而造成控制失效。在现有的技术中，一般针对飞行器零点漂移采用物理标定偏差的办法，如“四旋翼飞行器航本文档来自技高网...

【技术保护点】
1.一种飞行器陀螺仪的零点漂移偏差和姿态估计方法，其特征在于，包括以下步骤：/nS1，设计有限时间观测器，所述有限时间观测器用于根据由加速度计测出的姿态测量值和由陀螺仪测出的角速度测量值，在有限的时间内估计出零点漂移偏差和飞行器姿态值；/nS2，将由加速度计测出的姿态测量值和由陀螺仪测出的角速度测量值输入有限时间观测器中，通过有限时间观测器将零点漂移偏差和飞行器姿态值在有限的时间内估计出来；/nS3，将陀螺仪测出的角速度测量值减去零点漂移偏差，即可得到角速度的真实值；有限时间观测器估计输出的飞行器姿态值即为飞行器真实姿态值。/n

【技术特征摘要】
1.一种飞行器陀螺仪的零点漂移偏差和姿态估计方法，其特征在于，包括以下步骤：
S1，设计有限时间观测器，所述有限时间观测器用于根据由加速度计测出的姿态测量值和由陀螺仪测出的角速度测量值，在有限的时间内估计出零点漂移偏差和飞行器姿态值；
S2，将由加速度计测出的姿态测量值和由陀螺仪测出的角速度测量值输入有限时间观测器中，通过有限时间观测器将零点漂移偏差和飞行器姿态值在有限的时间内估计出来；
S3，将陀螺仪测出的角速度测量值减去零点漂移偏差，即可得到角速度的真实值；有限时间观测器估计输出的飞行器姿态值即为飞行器真实姿态值。


2.根据权利要求1所述的一种飞行器陀螺仪的零点漂移偏差和姿态估计方法，其特征在于，步骤S1中，基于飞行器的姿态运动学方程设计所述有限时间观测器，具体过程如下所示：
飞行器的姿态运动学方程：



其中，σ为基于修正的罗德里格参数MRPs所表示的姿态，σ为三维向量，σ＝[σ1,σ2,σ3]；为姿态σ对时间的导数；ω为实际角速度即角速度真实值；
G(·)为姿态矩阵，如下所示：



其中，I3为三阶单位矩阵；σ×为如下所示矩阵：σT为σ的转置矩阵；



所设计的有限时间观测器，如下所示：



其中，为姿态估计值；为姿态估计值对时间的导数；
b为零点偏移偏差真实值；为零点偏移偏差估计值；为零点偏移偏差估计值对时间的导数；
k1为常数，k1＞0；k2为常数，k2＞0；α1为常数，0＜α1＜0.5；α2为常数，α2＝2α1-1；
ωg为陀螺仪的角速度测量值，角速度测量值ωg包括角速度真实值ω和零点偏移偏差真实值b，ωg＝ω+b；
...

【专利技术属性】
技术研发人员：都海波，王利楠，温广辉，周俊，俞波，从永正，殷礼胜，
申请(专利权)人：合肥工业大学，
类型：发明
国别省市：安徽;34