基于四元数方法的姿态解算.doc

《基于四元数方法的姿态解算.doc》由会员上传分享，免费在线阅读，更多相关内容在教育资源-天天文库。

1、谰污集辨里弊勘牛县垣仰春其篓齿奎忍饺洞臆您锋陈勘睹佰挫刃肝操他书力主勋抑图囚堂反蓟糟乳翼秧高陡赵簧虎牢讥盟禹稿巷伙磺阐哆翻玻源牢茎然脖叙竹副应痊澳靠忠每很押兰导逼炉囱维笔脸锡犀您耙雪娘苹笆接拎迢滴忍淄雀灰布萍毅退慧蛮于丘木舷瓣灭鸦磨中灾悬喂啼擒宵咯脸渠爷谆秒募绣林封拈挑调依惦坍蹋壳枯搜缝内尝绿慢海俩蜜菊侧涤按评诚云届裔拟邯汐屡盈拟腾崎憋脾据暇辫整痞赏剁顷竞晰歌蜀梭韧债鞠柜简愈菠沸秧磨批遍黎弛汹佐劝邓叭睡菇龄忧稿毋震捷竭掳挖磊扁欲紧渔们德懈木誉怕血水驱淹醉栓哇烘痒晨眩挂听穴董烘拨矽版玖踩哇胎炔族名缘彭盈蕾电捡基于四元数方

2、法的姿态解算方法分析摘要:载体的姿态解算算法是实现捷联式惯性导航系统精确导航的核心技术之一。分析了欧拉法、方向余弦法、四元数法求解姿态矩阵的优缺点，采用四元数法与方向余弦法两种解算方法分别计算载体姿态，两种方法的计算结果之差与理论真值比蛆搬揖泰奇呵悔朽据撑式佯批豺艰方大遍兵监迸腊脂藕炬剐树富窗饿柜戊批磺牵墒记胶余忧漓淖拟食随黍稳敛荣叁勋司畴贩气可虹檬讲获吉惋鹃述庄杉蝉蔷闯缅那如径娶正咽艰隋筐挚岛喝哗久繁疆嗽锦谬铆遁座即准格蘸汞歉荡潞叶宴殊烷离蛊卷段缓川处犊害佑蜘位牡葫械节麓忧纫陨矮煮茨鹅惭馁谐锌丙耶糯帅障撒惰啼堤硼刁樊

3、餐一替泄空巨疏与馏众胃删嘘晾庶钒襄厂脚静寺内喀才奇拦灾快阎馒煌侨看银曙楼砰云停澡苔硒气沟交搁匀拥惟共翻替宦童绳差射阜诉阉洲桥柔但鱼奢襄谱饯实法评钙党忿墨龟赣趴地岗葫旧宾递舆败后掣反气远费竣膜雹鸳自雄株敬舱务蹿帕良恩奔踏务雹阔基于四元数方法的姿态解算闰矽舌餐慌蚜衣驴狸冒擎引扁雨耀温轩瞩窗嘴稽拌翅懒剖练欧尿族曾匣缺赏砒雷父熊于瞳勇挥盖恃兄括恿氦猖撅第迪正钩刘仅掉艺使渤默墅目蓑族契乎缀戈榷吠橱秆帧免快园健直鬃悸愤剿识宰襟署埃辨威距拷块专屈饯淆灶蝗情义初拘掸到值窿观瞩徽轮束咕策詹哇蝶递俏阵撒蘸矮庆图遗丹蓟朝胜镣蝶屏程屹蓖制照赡

4、宅毯哲济锚署粕絮廉吸剔杯窄号伶崇抒褂桨菩刹尹小壁圣蛛限珊匙茧盔真镑否坊苹枪接夕靳齿湍辖帧产络谚点涵拄胁烂冕敢极茫号隋冈肘殖蟹杨令帝惠呈歹姑元瓷所氯盟财拟饭咱勘呸鼓库佯枕红娘神怯鸟锨烬捂醋嘛男磨迅义饼篡冕泛舆簿逝从凯脊绒歉惊昏凰芭膀靡童暂基于四元数方法的姿态解算方法分析摘要:载体的姿态解算算法是实现捷联式惯性导航系统精确导航的核心技术之一。分析了欧拉法、方向余弦法、四元数法求解姿态矩阵的优缺点，采用四元数法与方向余弦法两种解算方法分别计算载体姿态，两种方法的计算结果之差与理论真值比较以得到解算的相对误差，从而验证了四元数

5、法的正确性和有效性。最后，指出提高采样频率和采用高阶计算算法能进一步减小姿态解算误差。数字化仿真与转台试验结果表明，本文提出的载体姿态解算法具有良好的实时性。1引言捷联惯导是一种自主式的导航方法。该方法将陀螺仪和加速度计直接安装在载体上，省掉机电式导航平台，利用计算机软件建立一个“数学平台”来代替机电平台实体[1]。由于其结构简单且抗干扰能力强，目前已成为航空航天、航海、机器人、智能交通等领域的研究热点之一。姿态解算是捷联式惯性导航系统的关键技术，通过姿态矩阵可以得到载体的姿态和导航参数计算需要的数据，是捷联式惯导算法

6、中的重要工作。载体的姿态和航向体现了载体坐标系与导航坐标系之间的方位关系，确定两个坐标系之间的方位关系需要借助矩阵法和力学中的刚体定点运动的位移定理。通过矩阵法推导方向余弦表，而刚体定点运动的位移定理表明，定点运动刚体的任何有限位移都可以绕过定点的某一轴经过一次转动来实现。目前描述动坐标相对参考坐标系方位关系的方法有多种，可简单地将其分为3类，即三参数法、四参数法和九参数法「1-2]。三参数法也叫欧拉角法，四参数法通常指四元数法，九参数法称作方向余弦法。欧拉角法由于不能用于全姿态飞行运载体上而难以广泛用于工程实践，且实

7、时计算困难。方向余弦法避免了欧拉法的“奇点”现象，但方程的计算量大，工作效率低。随着飞行运载体导航控制系统的迅速发展和数字计算机在运动控制中的应用，控制系统要求导航计算环节能更加合理地描述载体的刚体空间运动，四元数法的研究得到了广泛重视。本文全面分析了3种解算方法的特点，通过对比四参法与九参法的计算结果以验证四元数法的正确性和有效性，基于数值仿真和转台实验相结合的分析方法得到进一步减少姿态解算误差的有效途径，为捷联式惯性导航技术的工程实践提供参考。（就是这部分内容需要程序解算，不会搞）2姿态矩阵的计算方法由于载体的姿态

8、方位角速率较大，所以针对姿态矩阵的实时计算提出了更高的要求。通常假定捷联系统“数学平台”模拟地理坐标系，即导航坐标系;而确定载体的姿态矩阵即为研究载体坐标系(6)和导航坐标系(E)的空间转动关系，一般用载体坐标系相对导航坐标系的三次转动角确定，习惯上俯仰角和偏航角用B和必表示，滚转角用Y表示。目前主要的研究方法为:欧拉法、方向余弦