买专利,只认龙图腾
首页 专利交易 科技果 科技人才 科技服务 商标交易 会员权益 IP管家助手 需求市场 关于龙图腾
 /  免费注册
到顶部 到底部
清空 搜索

【发明授权】一种基于MEMS技术的捷联式垂直陀螺仪解算方法_陕西瑞特测控技术有限公司_201710326078.6 

申请/专利权人:陕西瑞特测控技术有限公司

申请日:2017-05-10

公开(公告)日:2020-11-24

公开(公告)号:CN107202578B

主分类号:G01C21/18(20060101)

分类号:G01C21/18(20060101);G01C25/00(20060101)

优先权:

专利状态码:有效-授权

法律状态:2020.11.24#授权;2017.10.27#实质审查的生效;2017.09.26#公开

摘要:本发明公开了一种基于MEMS技术的捷联式垂直陀螺仪解算方法,具体按照以下步骤实施:步骤1,互补对称加速度传感器的布局与各角度解算,步骤2,进行捷联解算,在步骤1中解算出的俯仰角和横滚角基础上,把三轴陀螺仪测得载体的角速度信息按俯仰轴和横滚轴二次旋转,变换到水平地理坐标系,按捷联算法求出俯仰角和横滚角,步骤3,利用Kalman滤波器进行信息融合,解决了现有机械式垂直陀螺仪在载体加速过程中的测量不准确问题和捷联式惯导系统的高成本问题。

主权项:1.一种基于MEMS技术的捷联式垂直陀螺仪解算方法,基于如下定义的坐标系:垂直陀螺仪的导航坐标系取为地理坐标系,建立载体所在位置的地理坐标系为北-东-地,即N-E-D,固连在载体上的载体坐标系为X-Y-Z,X处于载体对称平面内,由质心指向载体运动前向;Y垂直于载体对称平面并指向右方;Z在载体对称平面内且垂直于X轴指向下方,其特征在于,具体按照以下步骤实施:步骤1,互补对称加速度传感器的布局与各角度解算,具体为,步骤1.1,互补对称加速度传感器的布局,将在载体的X-Z和Y-Z平面沿X轴和Y轴方向,且与X轴和Y轴的夹角分别为α角度分别布置2对加速度传感器,在X-Y-Z轴三个方向上,各布置一个陀螺仪;步骤1.2,俯仰角度的解算,设载体X轴方向有加速度xa和俯仰角度xt时,从两个加速度传感器上采集到的加速度的输出值ax1和ax2分别为: 经过推导,可以求得: 其中中间变量: 步骤1.3,横滚角的解算,当载体Y轴方向有加速度ya和横滚角度yt时,利用同样的原理,借助公式1、2在求出横滚角度yt的基础之上除以cosxt即可,步骤2,进行捷联解算,在步骤1中解算出的俯仰角和横滚角基础上,把三轴陀螺仪测得载体的角速度信息按俯仰轴和横滚轴二次旋转,变换到水平地理坐标系,按捷联算法求出俯仰角和横滚角,步骤3,利用Kalman滤波器进行信息融合。

全文数据:一种基于MEMS技术的捷联式垂直陀螺仪解算方法技术领域[0001]本发明属于电子信息和导航技术领域,涉及基于MEMS技术的捷联式垂直陀螺仪解算方法。背景技术[0002]垂直陀螺仪VerticalGyroscope,VG是无人机、稳定云台和“动中通”天线等重要的姿态传感器,其在载体运动过程中实时获取载体的姿态信息,即俯仰角和横滚角。[0003]机械式垂直陀螺仪:机械式垂直陀螺仪是一个框架式双自由度陀螺和液体摆构成的闭环控制系统,使陀螺的自转轴稳定在当地地垂线方向上,它的原理就是利用陀螺的定轴性和进动性可测量载体的俯仰角和横滚角。机械螺仪由于其结构复杂、制造困难、漂移误差大和使用环境要求高等,现在已经很少应用。[0004]捷联式惯导系统:捷联式惯导系统不采用实体平台,把三轴加速度计与三轴陀螺仪直接固连在载体上,利用计算机实时计算姿态矩阵,通过姿态矩阵把加速度计测得的机体的加速度信息,变化到导航坐标系,然后进行导航解算,同时从姿态矩阵的元素中提取航向角和姿态角信息。缺点一是捷联式惯导系统依靠高精度的陀螺和加速度计,才能在初始对准过程中,通过敏感当地的地球自传角速度,才能给出航向角信息;二是由于陀螺仪和加速度计长时间会产生漂移,需要外部信息修正,比如GPS和北斗信息。发明内容[0005]本发明的目的是提供一种基于MEMS技术的捷联式垂直陀螺仪解算方法,解决了现有机械式垂直陀螺仪在载体加速过程中的测量不准确问题和捷联式惯导系统的高成本问题。[0006]本发明所采用的技术方案是,一种基于MEMS技术的捷联式垂直陀螺仪解算方法,基于如下定义的坐标系:垂直陀螺仪的导航坐标系取为地理坐标系,建立载体所在位置的地理坐标系为北-东-地,S卩N-E-D,固连在载体上的载体坐标系为X-Y-Z,x处于载体对称平面内,由质心指向载体运动前向;Y垂直于载体对称平面并指向右方;Z在载体对称平面内且垂直于X轴指向下方,其特征在于,具体按照以下步骤实施:[0007]步骤1,互补对称加速度传感器的布局与各角度解算,[0008]步骤2,进行捷联解算,在步骤1中解算出的俯仰角和横滚角基础上,把三轴陀螺仪测得载体的角速度信息按俯仰轴和横滚轴二次旋转,变换到水平地理坐标系,按捷联算法求出俯仰角和横滚角,[0009]步骤3,利用Kalman滤波器进行信息融合。[0010]本发明的特点还在于,[0011]所述的步骤1具体为,[0012]步骤1.1,互补对称加速度传感器的布局,将在载体的X-Z和Y-Z平面沿X轴和Y轴方向,且与X轴和Y轴的夹角分别为α角度分别布置2对加速度传感器,在X-Y-Z轴三个方向上,各布置一个陀螺仪;[0013]步骤1.2,俯仰角度的解算,[0014]设载体X轴方向加速度Xa和俯仰角度Xt时,从两个加速度传感器上采集到的加速度的输出值ax1和ax2分别为:[0015]1[0016]经过推导,可以求得:[0017]2[0018]其中中间变量:[0019][0020]步骤1.3,横滚角的解算,[0021]当载体Y轴方向有加速度73和横滚角度yt时,利用同样的原理,借助公[0022]式⑴、⑵在求出横滚角度yt的基础之上除以cosXt即可。[0023]所述的步骤2具体为:[0024]设载体坐标系下的俯仰角Θ,横滚角γ,载体坐标系与地理坐标系经过两次旋转变换,变换阵为:[0025]3[0026]载体坐标系上,按步骤1.1方法布置的三个陀螺的测量值分别为:ωχ、ω4卩ωζ,把载体系测量得到的三维角速度转换到地理坐标系,得到:[0027]4[0028]式中®Γ、Μ和你〗为水平地理系下对应的角速度,βί对应横滚轴;©ΧΗ对应俯仰轴;[0029]角速度在采样周期内积分,根据4,结合初始条件可以得到水平地理坐标系下的俯仰角增量Θ和横滚角增量γ分别为:[0030]0=5γ=〇"XT[0031]式中T为解算周期。[0032]步骤3具体为,以俯仰角误差Φχ=Χι_θ和横滚角误差φy=yi-γ以及三个的漂移误差作为Kalman滤波器的状态方量的变量;[0033]步骤3.1,建立系统状态方程,[0034]取垂直陀螺仪系统的状态量X为:[0035]X=[φχφγεχεγεζ]τ,[0036]式中:Φθ和Φγ是俯仰角和横滚角的测量误差;εχ、ε4Ρεζ为三轴陀螺仪的漂移误差,[0037]这三个误差可以事前通过静态测试得到,用一阶马尔科夫过程描述,则垂直陀螺仪的状态方程为:[0038]X=FX+Gw[0039]式中:系统状态转移矩阵.[0040]系统噪声驱动矩阵:[0041]系统激励噪声矩阵W=[wxWywz]τ,[0042]ix、Ty、Tz和Wx、Wy、Wz分别为Χ、Υ和Z周陀螺的一阶马尔科夫时间和方差。[0043]步骤3.2,建立系统量测方程,[0044]以互补对称加速度传感器解算的角度Xt、yt和捷联解算得到的角度θ、γ之差作为观测量:[0045]所以量测方程为:Z=HX+V[0046]式中:量测矩阵为加速度测量角度的方差。[0047]本发明的有益效果是,通过传感器的布局、姿态角度的捷联式算法、载体加速度对角度解算误差的消除和捷联式解算数据与倾角解算的数据融合等技术,最终给出动态环境下的载体俯仰角和横滚角的测量值。附图说明[0048]图1是本发明基于MEMS技术的捷联式垂直陀螺仪解算方法中的互补对称加速度传感器的布置图;[0049]图2是本发明基于MEMS技术的捷联式垂直陀螺仪解算方法中的三轴陀螺仪的布置图。具体实施方式[0050]下面结合附图和具体实施方式对本发明进行详细说明。[0051]一种基于MEMS技术的捷联式垂直陀螺仪解算方法,基于如下定义的坐标系:垂直陀螺仪的导航坐标系取为地理坐标系,建立载体所在位置的地理坐标系为北-东-地(WN-E-D、固连在载体上的载体坐标系为X-Y-Z,X处于载体对称平面内,由质心指向载体运动前向;Y垂直于载体对称平面并指向右方;Z在载体对称平面内且垂直于X轴指向下方,[0052]具体按照以下步骤实施:[0053]步骤1,互补对称加速度传感器的布局与各角度解算,[0054]步骤1.1,互补对称加速度传感器的布局,按照如图1所示,将在载体的X-Z和Y-Z平面沿X轴和Y轴方向,且与X轴和Y轴的夹角分别为α角度分别布置2对加速度传感器,在X-Y-Z轴三个方向上,各布置一个陀螺仪;[0055]步骤1.2,俯仰角度的解算,[0056]设载体X轴方向加速度Xa和俯仰角度Xt时,从两个加速度传感器上采集到的加速度的输出值ax1和ax2分别为:1[0058]经过推导,可以求得:2;[0060]其中中间变量:[0061][0062]步骤1.3,横滚角的解算,[0063]当载体Y轴方向有加速度73和横滚角度yt时,利用同样的原理,借助公式1、⑵在求出横滚角度yt的基础之上除以cosXt即可。[0064]步骤2,进行捷联解算,在步骤1.2中解算出的俯仰角和横滚角基础上,把三轴陀螺仪测得载体的角速度信息按俯仰轴和横滚轴二次旋转,变换到水平地理坐标系,按捷联算法求出俯仰角和横滚角,设此方法解算出的俯仰角为Θ,横滚角为γ,与之前解算出的俯仰角Xt和横滚角yt代表的是同一角度,只是表示方法不同。[0065]步骤2.1,设载体坐标系下的俯仰角Θ,横滚角γ,载体坐标系与地理坐标系经过两次旋转变换,变换阵为:3[0067]载体坐标系上,按步骤1.1方法布置的三个陀螺的测量值分别为:ωχ、ωJPωζ,把载体系测量得到的三维角速度转换到地理坐标系,得到:[0068]4[0069]式中、《!丨和为水平地理系下对应的角速度,对应横滚轴;对应俯仰轴。[0070]角速度在采样周期内积分,根据⑷,结合初始条件可以得到水平地理坐标系下的俯仰角增量Θ和横滚角增量γ分别为[0071]Θ—ofXTyC5γ=ω"χΤ[0072]式中T为解算周期。[0073]步骤3,利用Kalman滤波器进行信息融合,以俯仰角误差Φχ=^-Θ和横滚角误差Φy=yi-γ以及三个的漂移误差作为Kalman滤波器的状态方量的变量。[0074]步骤3.1,建立系统状态方程,[0075]取垂直陀螺仪系统的状态量X为:[0076]X=[φχφΥεχεΥεζ]τ[0077]式中:Φθ和Φγ是俯仰角和横滚角的测量误差;εχ、ε4Ρεζ为三轴陀螺仪的漂移误差,这三个误差可以事前通过静态测试得到,用一阶马尔科夫过程描述,则垂直陀螺仪的状态方程为:[0078]X=ρ-χ+〇'w[0079]式中:系统状态转移矩阵[0080]系统噪声驱动矩阵:[0081]系统激励噪声矩阵W=[wxWywz]τ,[0082]、、\、'和1、%、1分别为乂、¥和2周陀螺的一阶马尔科[0083]夫时间和方差。[0084]步骤3.2,建立系统量测方程,[0085]以互补对称加速度传感器解算的角度xt、yt和捷联解算得到的角度θ、γ之差作为观测量:[0086]所以量测方程为:Z=HX+V[0087]式中:量测矩阵;V为加速度测量角度的方差。[0088]通过以上的实施方式的描述,本领域的技术人员可以清楚地了解到本发明可借助三轴MEME技术的陀螺仪和四个MEMS技术的加速度传感器,在ARM或DSP硬件平台实现。[0089]本发明的有益效果是:[0090]1本发明的垂直陀螺仪,利用了对称互补的加速度原理,可以有效消除载体加速度信息对角度解算的影响。[0091]2本发明利用三轴陀螺仪按捷联算法解算,可以与加速度解算出的角度信息形成互补滤波,防止角度解算出错,同时也系统的相应带宽。[0092]3本发明以加速度传感器解算出的角度信息作为Kalman滤波器的观测量,设计Kalman滤波器,通过滤波后可以消除角度和陀螺仪的漂移误差。[0093]⑷适用范围广泛,适用于无人机和稳定平台。[0094]本发明利用低成本的MEMS技术的三轴陀螺仪和四轴的加速度,三轴陀螺仪按照载体的OXYZ轴安装,四个加速度计分别安装在OXZ两个和OYZ平面两个,两个加速度计对称安装,与各自的X轴和Y轴成统一的对称角度,这样就能够克服载体加速度和载体非直线运动时离心加速度信息对姿态角度信息解算带来的影响。同时提出了一种基于捷联解算角度信息与姿态角的信息融合方法。一方面,该算法能够克服姿态角度解算动态和静态测量精度不足问题;另一方面利用陀螺仪解算能够克服载体非直线运动离心加速度对姿态角解算精度的影响问题,最后该方法不需要任何外部信息,利用自身的姿态角度信息利用KaIman滤波器对陀螺的漂移误差进行修正,能够保证垂直陀螺仪的长时间精度。

权利要求:1.一种基于MEMS技术的捷联式垂直陀螺仪解算方法,基于如下定义的坐标系:垂直陀螺仪的导航坐标系取为地理坐标系,建立载体所在位置的地理坐标系为北-东-地,即N-E-D,固连在载体上的载体坐标系为X-Y-Z,X处于载体对称平面内,由质心指向载体运动前向;Y垂直于载体对称平面并指向右方;Z在载体对称平面内且垂直于X轴指向下方,其特征在于,具体按照以下步骤实施:步骤1,互补对称加速度传感器的布局与各角度解算,步骤2,进行捷联解算,在步骤1中解算出的俯仰角和横滚角基础上,把三轴陀螺仪测得载体的角速度信息按俯仰轴和横滚轴二次旋转,变换到水平地理坐标系,按捷联算法求出俯仰角和横滚角,步骤3,利用Kalman滤波器进行信息融合。2.根据权利要求1所述的基于MEMS技术的捷联式垂直陀螺仪解算方法,其特征在于,所述的步骤1具体为,步骤1.1,互补对称加速度传感器的布局,将在载体的X-Z和Y-Z平面沿X轴和Y轴方向,且与X轴和Y轴的夹角分别为α角度分别布置2对加速度传感器,在X-Y-Z轴三个方向上,各布置一个陀螺仪;步骤1.2,俯仰角度的解算,设载体X轴方向加速度xa和俯仰角度xt时,从两个加速度传感器上采集到的加速度的输出值axl和ax2分别为:经过推导,可以求得:其中中间变量:步骤1.3,横滚角的解算,当载体Y轴方向有加速度73和横滚角度yt时,利用同样的原理,借助公式(1、⑵在求出横滚角度yt的基础之上除以cosxt即可。3.根据权利要求1所述的基于MEMS技术的捷联式垂直陀螺仪解算方法,其特征在于,所述的步骤2具体为:设载体坐标系下的俯仰角Θ,横滚角γ,载体坐标系与地理坐标系经过两次旋转变换,变换阵为:载体坐标系上,按步骤1.1方法布置的三个陀螺的测量值分别为:ωχ、ω4Ρωζ,把载体系测量得到的三维角速度转换到地理坐标系,得到:式中《丨、和为水平地理系下对应的角速度,对应横滚轴;对应俯仰轴;角速度在采样周期内积分,根据⑷,结合初始条件可以得到水平地理坐标系下的俯仰角增量θ和横滚角增量γ分别为:式中T为解算周期。4.根据权利要求1所述的基于MEMS技术的捷联式垂直陀螺仪解算方法,其特征在于,所述的步骤3具体为,以俯仰角误差Φχ=Χι_θ和横滚角误差Φy=yi-γ以及三个的漂移误差作为KaIman滤波器的状态方量的变量;步骤3.1,建立系统状态方程,取垂直陀螺仪系统的状态量X为:式中:ΦΘ和Φγ是俯仰角和横滚角的测量误差;εχ、ε4ρεζ为三轴陀螺仪的漂移误差,这三个误差可以事前通过静态测试得到,用一阶马尔科夫过程描述,则垂直陀螺仪的状态方程为:式中:系统状态转移矩罔系统噪声驱动矩阵系统激励噪声矩罔^、1\、1:2和1、^、¥2分别为乂、¥和2周陀螺的一阶马尔科夫时间和方差;步骤3.2,建立系统量测方程,以互补对称加速度传感器解算的角度Xt、yt和捷联解算得到的角度θ、γ之差作为观测量所以量测方程为:Z=HX+V式中:量测矩阵;V为加速度测量角度的方差。

百度查询: 陕西瑞特测控技术有限公司 一种基于MEMS技术的捷联式垂直陀螺仪解算方法

免责声明
1、本报告根据公开、合法渠道获得相关数据和信息,力求客观、公正,但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解,仅供参考使用,不能作为本公司承担任何法律责任的依据或者凭证。

相关技术
相关技术
相关技术
相关技术