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

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

【技术实现步骤摘要】
一种飞行器陀螺仪的零点漂移偏差和姿态估计方法
本专利技术涉及飞行器陀螺仪校准的
，尤其是一种飞行器陀螺仪的零点漂移偏差和姿态估计方法。
技术介绍
飞行器在姿态控制的时候，需要用到角速度和姿态。角速度一般可以由陀螺仪测量得到，但是由于供电和器件自身的原因，陀螺仪在每次上电的初始时刻将有一个不固定的常值，称之为零点漂移值，零点漂移值受供电电源和环境温度等因素的影响，会大大影响陀螺仪的精度。飞行器姿态可以通过陀螺仪的角速度数据对飞行器姿态运动学方程解算获得，也可以通过加速度计获取，但陀螺仪角速度数据存在误差，加速度计存在噪声干扰，导致了其获得的姿态并不精确。在飞行器姿态控制的时候，由于飞行器姿态和角速度数据获取的不精确，导致飞行器的控制力矩将会有偏差，可能会导致飞行器的控制失效。另外飞行器在平稳飞行的时候，期望角速度一般为0，但由于存在零点漂移值，其所测得的角速度将不为0，会对飞行器的平稳控制产生极大的威胁，严重可能导致飞行器的震颤从而造成控制失效。在现有的技术中，一般针对飞行器零点漂移采用物理标定偏差的办法，如“四旋翼飞行器航姿参考系统的误差补偿方法研究，杨志永,《计算机测量与控制》,2016年02期”，即在陀螺仪每次上电时候，对陀螺仪进行物理标定，该标定方法需要采集大量陀螺仪的数据，该标定方法不仅费时费力，而且精度不是很高。现有的技术中，姿态估计一般采用卡尔曼滤波算法，卡尔曼滤波对高斯噪声具有一定的抑制作用，但在实际飞行器系统中，传感器测量数据存在大量非高斯噪声。
技术实现思路
>为了克服上述现有技术中的缺陷，本专利技术提供一种飞行器陀螺仪的零点漂移偏差和姿态估计方法，基于飞行器姿态运动学方程设计有限时间观测器的数学模型，使得有限时间观测器更具有针对性，且具有更高的抗干扰性能和更快的收敛性，本专利技术的精度高、收敛性快，能够实时快速、准确地估计零点漂移偏差和飞行器姿态值。为实现上述目的，本专利技术采用以下技术方案，包括：一种飞行器陀螺仪的零点漂移偏差和姿态估计方法，包括以下步骤：S1，设计有限时间观测器，所述有限时间观测器用于根据由加速度计测出的姿态测量值和由陀螺仪测出的角速度测量值，在有限的时间内估计出零点漂移偏差和飞行器姿态值；S2，将由加速度计测出的姿态测量值和由陀螺仪测出的角速度测量值输入有限时间观测器中，通过有限时间观测器将零点漂移偏差和飞行器姿态值在有限的时间内估计出来；S3，将陀螺仪测出的角速度测量值减去零点漂移偏差，即可得到角速度的真实值；有限时间观测器估计输出的飞行器姿态值即为飞行器真实姿态值。步骤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；sig(·)表示符号函数；是指sig(e1)的α1次方；是指sig(e1)的α2次方；G(·)为姿态矩阵；e1为由加速度计测出的姿态测量值σ与姿态估计值之间的相对误差，即飞行器期望姿态值σE与姿态估计值之间的向量差；σ为输入有限时间观测器中的由加速度计测出的姿态测量值；R(e1)为旋转矩阵；H(·)为矩阵，无实意，仅用于表示旋转矩阵为R(e1)为两个矩阵即H(σE)、相乘得到；I3为三阶单位矩阵；符号用于计算两个姿态之间即由加速度计测出的姿态测量值σ与姿态估计值的相对误差e1，符号的具体计算方式如下所示：其中，设则为如下所示的矩阵：对所设计的有限时间观测器的合理性即收敛性进行分析，具体如下所示：令从而得出有限时间观测器的误差系统的动态方程为：其中，为零点偏移偏差真实值b对时间的导数；为零点偏移偏差估计值对时间的导数；为e1对时间的导数；为e2对时间的导数；e2为零点偏移偏差估计值与零点偏移偏差真实值b之间的差值；所述误差系统包括两个误差状态即e1、e2；由于零点偏移偏差真实值b为常数值，从而可以得到：根据有限时间的稳定性理论，可以得到误差系统中误差状态(e1,e2)将在有限时间T内收敛到零，即收敛时间在达到该有限时间T后，使得e1(t)≡0，e2(t)≡0，从而使得零点偏移偏差估计值在有限时间T内收敛到零点偏移偏差真实值b；且姿态估计值在有限时间T内收敛到由加速度计测出的姿态测量值σ，即收敛到飞行器真实姿态值。本专利技术的优点在于：(1)本专利技术首先设计飞行器的有限时间观测器，将飞行器陀螺仪测量出的带零点漂移误差的角速度测量值和飞行器的期望姿态输入有限时间观测器中，通过有限时间观测器可以估计零点漂移的偏差。本专利技术中的有限时间观测器是基于飞行器姿态运动学的数学模型，更具有针对性，且具有更高的抗干扰性能和更快的收敛性，因此本专利技术的精度高、收敛性快，能够实时快速、准确地估计负载值。附图说明图1为本专利技术的一种飞行器陀螺仪的零点漂移偏差和姿态估计方法的流程图。图2为本实施例中的零点漂移偏差估计值的响应曲线。图3为本实施例中的飞行器姿态估计值的响应曲线。具体实施方式下面将结合本专利技术实施例中的附图，对本专利技术实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本专利技术保护的范围。由图1所示，本专利技术的一种飞行器陀螺仪的零点漂移偏差和姿态估计方法，包括以下步骤：S1，设计一个有限时间观测器，所述有限时间观测器用于根据由加速度计测出的姿态测量值和由陀螺仪测出的角速度测量值，在有限的时间内估计出零点漂移偏差和飞行器姿态值。S2，将由加速度计测出的姿态测量值和由陀螺仪测出的角速度测量值输入有限时间观测器中，通过有限时间观测器将零点漂移偏差和飞行器姿态值在有限的时间内估计出来；通过估计陀螺仪的零点漂移偏差获得陀螺仪角速度的真实值，可通过飞行器姿态运动学，获得飞行器姿态估计值，即观测器的输出结果。该值通过真实陀螺仪角速度值计算所得，有较高的精度，可以用作飞行器的控制。S3，将陀螺仪测出的角速度测量值减去零点漂移偏本文档来自技高网...

【技术保护点】
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