基于MEMS振动陀螺的旋翼无人机组合导航算法设计.pdf
《基于MEMS振动陀螺的旋翼无人机组合导航算法设计.pdf》由会员分享,可在线阅读,更多相关《基于MEMS振动陀螺的旋翼无人机组合导航算法设计.pdf(5页珍藏版)》请在咨信网上搜索。
1、第4 5卷第4期压 电 与 声 光V o l.4 5N o.42 0 2 3年8月P I E Z O E L E C T R I C S&A C OU S TOO P T I C SA u g.2 0 2 3 收稿日期:2 0 2 3-0 2-1 5 作者简介:刘昕(1 9 7 9-),男,河北省石家庄市人,高级工程师,硕士,主要从事卫星通信、伺服控制和组合导航算法的研究。文章编号:1 0 0 4-2 4 7 4(2 0 2 3)0 4-0 5 1 7-0 5D O I:1 0.1 1 9 7 7/j.i s s n.1 0 0 4-2 4 7 4.2 0 2 3.0 4.0 0 7基于MEM
2、 S振动陀螺的旋翼无人机组合导航算法设计刘 昕1,秦 超1,2(1.中国电子科技集团公司 第五十四研究所,河北 石家庄0 5 0 0 8 1;2.哈尔滨工程大学 智能科学与工程学院,黑龙江 哈尔滨1 5 0 0 0 1)摘 要:旋翼无人机需要惯导提供准确的角速度和加速度测量信息,而由于无人机的振动会对陀螺输出噪声产生影响,进而影响无人机的飞行平稳性。因此,该文提出了一种面向旋翼无人机的组合导航算法,基于扩展卡尔曼滤波,结合全球导航卫星系统/惯性导航系统(G N S S/I N S)组合导航算法和无地磁传感器的航姿参考系统算法,在一定程度上解决了GN S S失效情况下的姿态稳定问题。针对旋翼无人
3、机对导航系统输出信息平稳性的要求,采用自适应陀螺采样平滑方法,在少量增加数据处理复杂度的前提下,降低了航姿和角速度信息的噪声,在无人机应用中实现了良好的飞行轨迹重复性和控制平稳性。关键词:自适应平滑采样;扩展卡尔曼滤波;组合导航;旋翼无人机中图分类号:T N 8 0 4;V 2 4 9.3 2+8 文献标志码:A D e s i g no f I n t e g r a t e dN a v i g a t i o nA l g o r i t h mf o rR o t o rU A VB a s e do nMEM SV i b r a t i n gG y r oL I UX i n1,
4、Q I NC h a o1,2(1.T h e5 4 t hI n s t i t u t eo fC h i n aE l e c t r o n i c sT e c h n o l o g yG r o u pC o r p o r a t i o n,S h i j i a z h u a n g0 5 0 0 8 1,C h i n a;2.C o l l e g eo f I n t e l l i g e n tS c i e n c ea n dE n g i n e e r i n g,H a r b i nE n g i n e e r i n gU n i v e r s
5、 i t y,H a r b i n1 5 0 0 0 1,C h i n a)A b s t r a c t:T h er o t o rUAV sr e q u i r e t h e i n e r t i a l n a v i g a t i o ns y s t e mt op r o v i d ea c c u r a t ea n g u l a rv e l o c i t ya n da c c e l-e r a t i o nm e a s u r e m e n t i n f o r m a t i o n,w h i l et h ev i b r a t i
6、o no fUAV w i l la f f e c tt h eo u t p u tn o i s eo fg y r o s c o p e,w h i c hi nt u r na f f e c t s t h e f l i g h t s t a b i l i t yo fUAV.I n t h i sp a p e r,a n i n t e g r a t e dn a v i g a t i o na l g o r i t h mf o r r o t o rUAVi sp r o p o s e d.T h ea l g o r i t h mc o m b i n
7、e s t h e i n t e g r a t e dn a v i g a t i o na l g o r i t h mo f t h eg l o b a l n a v i g a t i o ns a t e l l i t e s y s t e m/i n e r t i a l n a v i g a-t i o ns y s t e m(G N S S/I N S)a n dt h e a l g o r i t h mo f t h e a t t i t u d e r e f e r e n c e s y s t e mw i t h o u t g e o m
8、 a g n e t i c s e n s o r,w h i c ht oac e r t a i ne x t e n t s o l v e s t h ea t t i t u d es t a b i l i t yp r o b l e mi nt h ec a s eo fG N S Sf a i l u r e.I no r d e r t om e e t t h er e q u i r e m e n to ft h es t a b i l i t yo f t h eo u t p u t i n f o r m a t i o no f t h en a v i
9、g a t i o ns y s t e m,t h ea d a p t i v eg y r o-s a m p l i n gs m o o t h i n gm e t h o d i sa-d o p t e dt or e d u c e t h en o i s e so f t h ea t t i t u d ea n da n g u l a rv e l o c i t y i n f o r m a t i o no nt h ep r e m i s eo f s l i g h t l y i n c r e a s i n gt h ec o m p l e x
10、i t yo fd a t ap r o c e s s i n g,a n da c h i e v eg o o dr e p e a t a b i l i t yo f f l i g h t t r a j e c t o r ya n dc o n t r o l s t a b i l i t y i nt h eUAV.K e yw o r d s:a d a p t i v es m o o t h-s a m p l i n g;e x t e n d e dK a l m a nf i l t e r i n g;i n t e g r a t e dn a v i g
11、a t i o n;r o t o rUAV 0 引言近年来国内四旋翼飞行器产业的发展迅猛,与传统的直升机和固定翼相比,旋翼无人机的易用性(运动相互解耦)、可靠性(机械磨损小)和维护性(结构简单、模块化)等刚性体验让人们的选择成为必然1。旋翼无人机实现精准姿态控制与位置控制的前提是导航模块提供稳定可靠的姿态、位置数据,目前多采取组合导航技术,将多种传感器对姿态、位置等数据进行信息融合2。文献3 介绍了过去1 0年中提出的解决方案。文献4-5 在旋翼无人机控制中应用了传统的导航算法。针对如何确保无人机控制平稳性的问题,本文使用微机电系统(MEM S)振动陀螺提出了一种基于扩展卡尔曼滤波(E K
12、F)的导航算法,融合全球导航卫星系统(GN S S)观测和自身加速度计输出观测,克服GN S S数据失效时的姿态稳定问题。同时引入自适应平滑采样方法,降低了角速度输出噪声。1 系统模型组合导航算法基于扩展卡尔曼滤波模型,以全球导航卫星系统/惯性导航系统(GN S S/I N S)组合导航的框架为基础,结合了无地磁传感器的航姿参考系统算法6。算法以加速度计的输出值和GN S S测量的位置Pm、速度Vm为观测量,估计出四元数偏差和陀螺零偏b。组合导航系统框架如图1所示,图中m、am分别为三轴MEM S陀螺仪和加速度的输出,P、V和q分别为惯性解算得到的位置、速度和四元数,、和为组合导航系统输出的航
13、向、俯仰和横滚。图1 组合导航系统框架1.1 惯性测量单元(I MU)误差模型I MU的误差包括系统误差和随机误差。系统误差可通过器件常规标定方法进行消除或降低,包括零偏、刻度系数误差及非正交性误差等。本文选用的高解耦微型陀螺如图2所示。微型陀螺敏感芯片采用多质量块解耦设计方案,驱动与检测音叉分离,通过挠性支撑结构连接,避免了各模态的机械耦合误差,达到解耦效果,隔离框的设计可有效地提升敏感芯片的环境适应性7。图2 高解耦微型陀螺总体结构示意图随机误差包括高斯白噪声及随机游走噪声,其中白噪声在概率上服从高斯分布,其功率谱密度为均匀分布。偏置随机游走被认为是离散化的维纳过程,由于I MU每次更新位
14、置时都会叠加一个新的白噪声,故将其偏置噪声建模为随机游走噪声8。I MU误差模型为m=-w+bam=a-wa-Cbn0 0 gT(1)式中:m,am分别为陀螺仪和加速度计的输出;,a分别为陀螺仪敏感的真实角速度和加速度计敏感的真实比力;w,wa为传感器噪声矢量;g为重力加速度;Cbn是地理系(n系)至载体系(b系)的姿态旋转矩阵。1.2 航姿表示形式四元数可完美描述物体在空间的姿态,其没有奇异性,无人机的每种姿态都对应一个唯一的四元数。以四元数q=q0 q1 q2 q3T描述无人机的姿态,其与姿态旋转矩阵Cbn的转换关系为 Cbn=q20+q21-q22-q232q1q2+q0q3()2q1q
15、3-q0q2()2q1q2-q0q3()q20-q21+q22-q232q2q3+q0q1()2q1q3+q0q2()2q2q3-q0q1()q20-q21-q22+q23(2)航向角、俯仰角、横滚角为=at a n2(Cbn(2,1),Cbn(2,2)as i n(Cbn(2,3)-at a n2(Cbn(1,3),Cbn(3,3)(3)2 基于E K F的组合导航算法设计2.1 状态方程以位置、速度、四元数和陀螺零偏为状态变量,建立状态方程x=f(x,w),且:x=PVqb =VCnb(am+wa)+(0 0 g)T12(m+w-b)wb(4)式中:b为陀螺零偏矢量;w为噪声矢量;为简化的
16、四元数乘法矩阵,且:815压 电 与 声 光2 0 2 3年=-q1-q2-q3q0-q3q2q3q0-q1-q2q1q0(5)2.2 量测方程GN S S系统是辅助I N S进行姿态保持的良好互补系统,此处以其输出位置、速度为观测量建立输出方程1:y1=h1(x)=PV(6)由于无人机的运动形式有别于地面车辆,当GN S S系统失效时,无法引入车辆的运动学约束来抑制导航系统的误差9,因此,参照常规的航姿参考系统算法,即以陀螺仪和加速度计输出、航姿变化量等参数为判断条件,当判定无人机处于静态、准静态和低动态条件下,以加速度计输出为观测量建立输出方程2:y2=h2(x)=am xam yam z
17、T(7)2.3 滤波算法依照E K F的工作流程,将连续时间模型进行离散化,得到:xk=xk-1+wk-1zk=H xk+vk(8)式中:wk为过程噪声矢量;vk为量测噪声。假定wk,vk均为白噪声,各自的协方差矩阵分别为Q、R。离散化计算采用一阶近似:I+F TG T(9)式中:T为滤波周期。F=fx=03 3I3 303 7 01 0 6FV q03 3Fq q/2-/203 7 G=fw=03 903 3Cnb/2 04 307 303 6I3 3(1 0)中间过程矩阵计算如下:FV q=FV q0FV q1FV q2FV q3-FV q3-FV q2FV q1FV q0FV q2-FV
18、 q3-FV q0FV q1(1 1)FV q0=2q0am x-q3am y+q2am z()(1 2)FV q1=2q1am x+q2am y+q3am z()(1 3)FV q2=2-q2am x+q1am y+q0am z()(1 4)FV q3=2-q3am x-q0am y+q1am z()(1 5)Fq q=0b x-m xb y-m yb z-m zx-b x0z-b zb y-m yy-b yb z-m z0 x-b xz-b zy-b yb x-m x0(1 6)量测矩阵H为H=I6 606 703 62gHq q03 3(1 7)Hq q=-q2q3-q0q1q1q0q3
19、q2q0-q1-q2q3(1 8)以GN S S系统的位置、速度为观测量时,使用此矩阵的前6行;以航姿参考系统算法中的加速度计输出为观测量时,使用此矩阵的后3行。3 陀螺数据的自适应平滑采样旋翼无人机控制要求导航系统输出的姿态和角速度信息平稳,数据噪声会影响控制的稳定性。在尽量降低数据处理复杂度的前提下,将组合导航算法划分为机械编排、卡尔曼滤波预测过程和卡尔曼滤波更新过程3个主要耗时模块。分别在机械编排前、机械编排与卡尔曼滤波预测过程之间、卡尔曼滤波预测与更新之间进行采样,并依次将陀螺输出分别记为1、2和3,在下次机械编排前进行陀螺数据的自适应平滑,算法流程图如图3所示。图3 基于自适应平滑采
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 基于 MEMS 振动 陀螺 无人机 组合 导航 算法 设计
1、咨信平台为文档C2C交易模式,即用户上传的文档直接被用户下载,收益归上传人(含作者)所有;本站仅是提供信息存储空间和展示预览,仅对用户上传内容的表现方式做保护处理,对上载内容不做任何修改或编辑。所展示的作品文档包括内容和图片全部来源于网络用户和作者上传投稿,我们不确定上传用户享有完全著作权,根据《信息网络传播权保护条例》,如果侵犯了您的版权、权益或隐私,请联系我们,核实后会尽快下架及时删除,并可随时和客服了解处理情况,尊重保护知识产权我们共同努力。
2、文档的总页数、文档格式和文档大小以系统显示为准(内容中显示的页数不一定正确),网站客服只以系统显示的页数、文件格式、文档大小作为仲裁依据,平台无法对文档的真实性、完整性、权威性、准确性、专业性及其观点立场做任何保证或承诺,下载前须认真查看,确认无误后再购买,务必慎重购买;若有违法违纪将进行移交司法处理,若涉侵权平台将进行基本处罚并下架。
3、本站所有内容均由用户上传,付费前请自行鉴别,如您付费,意味着您已接受本站规则且自行承担风险,本站不进行额外附加服务,虚拟产品一经售出概不退款(未进行购买下载可退充值款),文档一经付费(服务费)、不意味着购买了该文档的版权,仅供个人/单位学习、研究之用,不得用于商业用途,未经授权,严禁复制、发行、汇编、翻译或者网络传播等,侵权必究。
4、如你看到网页展示的文档有www.zixin.com.cn水印,是因预览和防盗链等技术需要对页面进行转换压缩成图而已,我们并不对上传的文档进行任何编辑或修改,文档下载后都不会有水印标识(原文档上传前个别存留的除外),下载后原文更清晰;试题试卷类文档,如果标题没有明确说明有答案则都视为没有答案,请知晓;PPT和DOC文档可被视为“模板”,允许上传人保留章节、目录结构的情况下删减部份的内容;PDF文档不管是原文档转换或图片扫描而得,本站不作要求视为允许,下载前自行私信或留言给上传者【自信****多点】。
5、本文档所展示的图片、画像、字体、音乐的版权可能需版权方额外授权,请谨慎使用;网站提供的党政主题相关内容(国旗、国徽、党徽--等)目的在于配合国家政策宣传,仅限个人学习分享使用,禁止用于任何广告和商用目的。
6、文档遇到问题,请及时私信或留言给本站上传会员【自信****多点】,需本站解决可联系【 微信客服】、【 QQ客服】,若有其他问题请点击或扫码反馈【 服务填表】;文档侵犯商业秘密、侵犯著作权、侵犯人身权等,请点击“【 版权申诉】”(推荐),意见反馈和侵权处理邮箱:1219186828@qq.com;也可以拔打客服电话:4008-655-100;投诉/维权电话:4009-655-100。