《《捷联姿态算法》ppt课件》由会员分享,可在线阅读,更多相关《《捷联姿态算法》ppt课件(14页珍藏版)》请在金锄头文库上搜索。
1、惯性导航原玲第五讲捷联惯导系统姿态算法E一、接联惯导系统囱频二、捷联姿态矩阵和姿态用三、捷联姿态算法|捷联惯导系统1平台惯导系统的组成及工作原理innii|282、据联惯导系统的组成及工作原理|G020sgpaTe对陆蝎施加进。动角速度:M=eosp+志白=Qeosp+口麟=n蝈飘*畏恤飘|捷联姿态矩阵和姿态角捷联姿态矩阵捷联矩阵Ci为载体坂标系到导航坐标系的坐标变换方名余弥矩阵。载体坐标系OxZ:导航坐标系ox.Xx|捷联姿态矩阵和姿态角捷联姿态矩GCG=(CJ=|G,CG,CE】nPacosyeosy+sinysinysin9snycosg“sinycosy-cosysinysinb人刀-
2、Gbsysiny+Sn7isysin0tosyeos9-sinsiny-eosycos/sin0E-SnycoslEclsyenib|捷联姿态矩阵和姿态角姿态角捷联矩阵是姿态角的函数。即由捷联矩阵的元素可以确定姿态为主值B坤q虞囊罐囊w+蕴y】庸】魔Snyoxsgsoesy-esyinysnl掩联矩阵:C=|G,C。C门-ewpsnyhsinyeysingawyewb-snsny-ewyewgin&的ea5n0E知sarctan(-EC0=arcsinC户0航向角:y=iy,+36缨)0辜:时吴8g一0练播角:0=028:7-E办2园横播角:7=1x.-c”)”【】日2iCo日|捷联姿态算法1
3、欧拉角法:一算水一2方向余弦法捷联威态算法2高肉余骄4旋转矢量法|捷联姿态算法欧拉角法欧拉角微分方程切n7singcox6-cosysing圣9|-cosycos00-sinycosg|仪|cosge外-sny0eosy儿弊端,数僧积分时迹行超越函数运彗纵播角为0度,微分方程出现奇点|捷联姿态算法方向余弦法方向余弦姿态矩阵微分方程的形式为写成矩阵的形式有5。0h仪,6国gI(CaCac-50弊端。震要联立求解9个微分方程,计算量大。需对求解结果进行正交化,正交化的过程中存在误差|捷联姿态算法四元数法毛四元数的一航形式=4,+6f+4.1+9h毛四元数的哈密尔顿表示法Q=0+7毛四元数的三角丽数表示法Q=h(cosb+sing)co8b=垫.n8二4+一绍J2J+Qk+吴