捷联惯性导航原理课件

单击此处编辑母版文本样式,第二级,第三级,第四级,第五级,单击此处编辑母版标题样式,单击此处编辑母版文本样式,第二级,第三级,第四级,第五级,单击此处编辑母版标题样式,*,捷联惯性导航原理,2010.11.30,北航通信导航与自动测试实验室,如果载体真实地理位置以纬度、经度、高度 表示，则与此对应的载体在地球坐标系中的真实位置,(x,，,y,，,z),可通过下式求得,:,捷联惯性导航原理2010.11.30北航通信导航与自动测,1,地球各点重力加速度近似计算公式,:g=g0(1-0.00265cos&)/1+(2h/R)g0:,地球标准重力加速度,9.80665(m/,平方秒,)&:,测量点的地球纬度,h:,测量点的海拔高度,R:,地球的平均半径,(R=6370km)s:,时间？,地球各点重力加速度近似计算公式:g=g0(1-0.002,内容,惯性导航中的,常用坐标系,1,捷联惯导力学编排方程,2,捷联惯导系统的算法,3,捷联惯导系统的误差分析,4,内容惯性导航中的常用坐标系1捷联惯导力学编排方程 2捷联惯导,1.,惯性导航中的,常用坐标系,地心,惯性,坐标系,(,下标为,i),-,惯性坐标系是符合牛顿力学定律的坐标系，即是绝对静止或只做匀速直线运动的坐标系。,以地心 为原点作右手坐标系，轴沿地轴指向地球的北极，轴在地球赤道平面内与地轴垂直,并不随地球自转,，其中，轴指向春分点。（惯性,-,不随地球自转，所以指向春分点,）,春分点是天文测量中确定恒星时的起始点，因此,、均指向惯性空间某一方向不变。,1.惯性导航中的常用坐标系地心惯性坐标系(下标为i)-,1.,惯性导航中的,常用坐标系,地球坐标系,(,下标为,e),地球坐标系的原点在地球中心 ，轴与 轴重合，在赤道平面内，轴指向格林威治经线，轴指向东经,90,方向。又称为空间直角坐标系或地心地固坐标系。（,地球,-x,轴指向,0,子午线,）,地理坐标系,(,东北天,)(,下标为,t),原点选在载体重心处 ，指向东，指向北，沿垂线方向指向天。,是在载体上用来表示载体所在位置的东向、北向和垂线方向的坐标系。,1.惯性导航中的常用坐标系地球坐标系(下标为e),1.,惯性导航中的,常用坐标系,导航坐标系,(,下标为,n),导航坐标系是在导航时根据导航系统工作的需要而选取的作为导航基准的坐标系。,指北方位系统，游离方位系统；,载体坐标系（下标为,b,）,坐标原点位于载体的重心，轴沿载体纵轴指向前，轴沿载体横轴指向右，轴垂直于平面指向上。,1.惯性导航中的常用坐标系导航坐标系(下标为n),1.,惯性导航中的,常用坐标系,1.惯性导航中的常用坐标系,地球坐标系到地理坐标系转换矩阵,Ce-g=,若为,地理坐标系转为地球坐标系,则为转置阵,地球坐标系到地理坐标系转换矩阵,2.,捷联惯导力学编排方程,2.捷联惯导力学编排方程,上图理解,上图理解：由陀螺仪的角速度（以及地球自转等角速度 得到四元数微分方程，求解出 姿态矩阵：一方面提取姿态角，一方面 把加速度计比力转化为导航坐标系；再由比力方程得到 速度，由速度得到位置。）,上图理解上图理解：由陀螺仪的角速度（以及地球自转等角速度,2.,捷联惯导力学编排方程,姿态角定义：,航向角,-,载体纵轴在水平面的投影与地理子午线之间的夹角，用,表示，规定以地理北向为起点，偏,东,方向为正，定义域,0360,。,俯仰角,-,载体纵轴与纵向水平轴之间的夹角，用,表示，规定以纵向水轴为起点，向上为正，向下为负，定义域,-90 +90,。,横滚角,-,载体纵向对称面与纵向铅垂面之间的夹角，用,表示，规定从铅垂面算起，,右倾,为正，左倾为负，定义域,-180 +180,。（载体纵向对称面和 纵轴空间 铅垂面）,2.捷联惯导力学编排方程姿态角定义：,2.,捷联惯导力学编排方程,载体坐标系与地理坐标系之间的关系,-,姿态矩阵,地理坐标系 绕 轴,负向（拇指指,z,负旋转）,转角,得,oxyz,，,oxyz,绕,x,轴转角,得,oxyz,，,oxyz,再绕,y,轴转角,则得到载体坐标系 。（地理到载体即是,z,负,xy,正正，,形式,）,2.捷联惯导力学编排方程载体坐标系与地理坐标系之间的关系-,2.,捷联惯导力学编排方程,姿态矩阵：从导航坐标系,(n,系,),到载体坐标系,(b,系,),的变换矩阵；,为航向角，,为俯仰角，,为横滚角,程序中转换采用这一矩阵形式,2.捷联惯导力学编排方程姿态矩阵：从导航坐标系(n系)到载体,导航坐标系绕三轴（,zxy,）依次旋转,角,角,角，则得到机体坐标系。由此，导航坐标系和机体坐标系之间的转换矩阵为,（,和前面的不一样？）,导航坐标系绕三轴（zxy）依次旋转 角角角，则得到机体,2.,捷联惯导力学编排方程,当载体姿态发生变化时，,陀螺仪就能敏感出相应的角速率,，姿态矩阵亦之发生了变化，其微分方程为,即,更新,式中，为姿态角速度 构成的,反对称,阵。,-,看陀螺加速度输出是哪个坐标系，就看小上标。,，而且解算欧拉角的积分运算随着时,间的增加会带来误差的累积,2.捷联惯导力学编排方程当载体姿态发生变化时，陀螺仪就能敏感,2.,捷联惯导力学编排方程,也就是,wnbb=wibb-winb,式中：为,地球（坐标系相对于惯性坐标系,的）自转角速率在导航坐标系中的投影；为导航坐标系中相对地球坐标系的角速率在导航坐标系上的投影。（由,瞬时速度,求得）,导航相对于地球，地球相对于惯性，相加,=,导航相对于惯性在,n,上投影。再经姿态矩阵，得到相对于,b,上。（如后面一页中图所示）,2.捷联惯导力学编排方程,2.,捷联惯导力学编排方程,0,+,90,0,-,-90,+,+,+,-,-,+,+180,+,-,-180,+,+,-,+,-,-180,-,-,+180,航向角真值表（多值问题）,横滚角真值表,2.捷联惯导力学编排方程 0+900-90+,2.,捷联惯导力学编排方程,速度更新计算,比力方程,：,里面的值在前面都已列出,有害加速度,（即上式中所提到的加速度）,哥氏加速度,向心加速度,重力加速度,g,速度方程：,比例方程展开,2.捷联惯导力学编排方程速度更新计算,2.,捷联惯导力学编排方程,位置更新计算（航向推算）,考虑地球的椭球型：载体,地理位置,如下,求导如右得位置更新方程,式中：,为载体所在的子午圈的曲率半径,，,为载体所在的卯酉圈的曲率半径,，,为地球椭球模型的半长轴，,f,为地球椭球模型的椭圆度,，,f=,1/298.257223563,2.捷联惯导力学编排方程位置更新计算（航向推算）,注意从瞬时速度过来那条线，用来计算,w,（,enn,）,注意从瞬时速度过来那条线，用来计算w（enn）,3,、捷联惯导系统的算法,3.1,姿态更新算法,四元数法：,四元数的三角式为：,四元数与姿态矩阵之间的关系,：,3、捷联惯导系统的算法3.1 姿态更新算法,3,、捷联惯导系统的算法,3.1,姿态更新算法,四元数微分方程及计算,表征,n,系至,b,系的旋转四元数为,通过求导变换可得四元数微分方程,（姿态角速率在变（更新），但是每一值都知道）,表示成矩阵形式，则有：,3、捷联惯导系统的算法3.1 姿态更新算法,3,、捷联惯导系统的算法,四元数微分方程 的解法,-,四阶龙格,-,库塔法,(,适用于陀螺输出为角速度）,-,应将,(h/6),（,1/2,）等括起来,实质：就是在（）时间间隔内求取多个斜率值，加权求平均得到更精确的平均斜率。,3、捷联惯导系统的算法四元数微分方程 的解法-四阶龙格-,3,、捷联惯导系统的算法,速度更新算法,-,二阶龙格库塔法,速度更新微分方程为：,二阶龙格库塔法求取速度增量的表达式为（,加速度的均值*时间差,）,ak,是,k,时刻速度微分,一小段时间后的速度表示,其实不是，因为不匀加速）,a k+1,就是,k+1,时刻速度微分，,注意此时 括号内变成了,v,其中：为采样周期，、分别为,k,时刻及,k+1,时刻的加速度。,则,k+1,时刻的速度为：,3、捷联惯导系统的算法速度更新算法-二阶龙格库塔法,3,、捷联惯导系统的算法,位置更新算法,一阶龙格库塔法,其中，为更新周期。,3、捷联惯导系统的算法位置更新算法一阶龙格库塔法,初始对准,对于平台式惯导系统而言，初始对准的任务是,控制平台使其跟踪导航坐标系,而捷联惯性导航系统没有实体平台，其初始对准的目的是,建立姿态矩阵的初始值,初始对准 对于平台式惯导系统而言，初始对准的任务是控制平台使,4,、捷联惯导系统的误差分析,误差来源,数学模型的近似性所引起的误差,惯性敏感元件的误差,-,占,系统误差的,90%,左右,算法误差,初始对准误差,-,一旦出现初始对准误差，它将在系统中以,舒拉周期,的形式传播,4、捷联惯导系统的误差分析误差来源,4,、捷联惯导系统的误差分析,位置、速度、,姿态,误差方程：,误差传播,方程,（,惯导平台,应,模拟导航坐标系（这里模拟地理坐标系），但由于平台有误差，故平台坐标系（,p,）和导航坐标系（,n,）之间存在误差角,）,（即对位置速度姿态角更新方程求导）,4、捷联惯导系统的误差分析位置、速度、姿态误差方程：误差传播,4,、捷联惯导系统的误差分析,4、捷联惯导系统的误差分析,4,、捷联惯导系统的误差分析,4、捷联惯导系统的误差分析,4,、捷联惯导系统的误差分析,假定载体处于地面,静止,状态，,将地球近似看做半径为,R,的球体，不考虑经度误差方程（东向速度和纬度可导出）和高度通道（发散），则,惯性导航系统误差方程式可简化为,：,惯导系统的误差方程式,组,。,4、捷联惯导系统的误差分析假定载体处于地面静止状态，将地球近,4,、捷联惯导系统的误差分析,得系统的特征行列式：,式中：，称为舒拉频率。,式中：,4、捷联惯导系统的误差分析得系统的特征行列式：式中：,4,、捷联惯导系统的误差分析,系统的特征方程式,为：,由 得系统的一组特征根为：,为地球自转角速度，与其对应的周期为 ，为此，称其为,地球振荡周期,。,由,得：,由此得系统的特征根还有：,4、捷联惯导系统的误差分析系统的特征方程式为：,4,、捷联惯导系统的误差分析,系统振荡包含两个频率相近的正弦分量，它们合在一起就产生差拍，如以下两个正弦分量之和，即：,上式表示频率相近的两个正弦分量合成之后形成的差拍，产生了的,正弦,振荡，其幅值为 新形成的正弦振荡具有调制波的性质。,对应的振荡周期为舒拉周期：,对应的调制周期为傅科周期：,傅科周期是由于未能全部有效补偿有害加速度而带来的交叉耦合速度误差造成的，对,舒拉周期起调制作用,。,4、捷联惯导系统的误差分析系统振荡包含两个频率相近的正弦分量,惯导系统误差传播方程 的特征根。可见 惯导输出受 舒拉周期 傅科周期 地球振荡周期 的影响，所以姿态角输出误差随时间 有正弦形式的变化。,惯导系统误差传播方程 的特征根。可见 惯导输出受,Thank You!,Thank You!,36,