捷联惯导.ppt

坐标系的定义 1. 地理坐标系（下标为t）—— ： 取载体质心， 轴指向东， 轴指向北， 轴沿垂线指向天。 2. 导航坐标系（下标为n）—— ： 取载体质心， 与 重合， 与 ， 与 相差一个游动方位角 。 3. 平台坐标系（小标为p）—— ： 取载体质心，当惯导系统不存在误差时，平台坐标系与导航坐标系重合；存在误差时平台坐标系相对导航坐标系存在三个姿态失准角 ， ， 。 4. 机体坐标系（下标为b）—— ： 取载体质心， 沿载体横轴指向右， 沿载体纵轴向前， 垂至于 ，并沿载体指向上。 5.地心惯性坐标系—— ：坐标原点取在地心， 6.地球坐标系—— ：地球坐标系固连在地球的坐标系,它相对于地心惯性坐标系以地球自传角速度 以上坐标系间关系见下图 捷联式惯导系统数学模型的推导 1.系统的速率 地球自转引起地理坐标系转动的三个方向的角速度分量为： 其中 为地球自转角速度，L为纬度。 E，N，U分别表示东北天三个方向 飞行器运动引起地理坐标系相对于地球坐标系的三个角速度分量为： 接上文 将前两式求和得： 上式为指北方位系统跟踪角速率。 其中： 方向余弦矩阵（位置矩阵） 平台坐标系与地球坐标系转动关系为： 其中 导航坐标系到平台坐标系的转换矩阵 由于姿态角 是小角度,则 可近似表示为: 确定纬度L和经度 利用方向余弦矩阵可确定纬度和经度的真值。先求其主值： 又因定义域： 1.求纬度的真值L 反正弦函数的主值域与L的定义域一致，因此： 2.求经度的真值 反正切函数的主值域是 与 的定义域不一致，因此需要在 的定义域内确定经度的真值。 由： 由于在L的定义域内cosL永远为正，所以 利用 的正负值可确定真值 ： 方向余弦矩阵 的即时修正 方向余弦矩阵的变化是由平台坐标系相对地球坐标系运动的角速率（又称位置速率） 引起的 位置速率 位置速率是由飞行器地速的水平分量引起的，由于平台坐标系与地理坐标系相差一个游动方位角， 可得： 可写成 综合上两式得： 指令角速率 将上式写成投影分量形式，并结合位置矩阵的形式可得： 速度方程 惯导基本方程： 其中： 整理上式可得： 捷联矩阵（姿态矩阵） 实现由机体坐标系到平台坐标系的坐标转换的方向余弦矩阵称为捷联矩阵，用T表示； 根据捷联矩阵的元素可以确定飞行器姿态角，因此捷联矩阵又称姿态矩阵。满足方程： 得到矩阵T后，沿机体坐标系测量的比力就可以转换到平台坐标系上，得到： 由姿态矩阵T确定飞行器姿态角 根据矩阵T中的元素可以确定各角的主值： 再根据定义域与T中元素的符号得到各角真值： 高度及重力加速度g的计算 1.捷联式惯导系统的高度通道是发散的，需要引入外部高度信息进行阻尼。 2.重力加速度g的计算 其中h为载体飞行高度 用四元数法对捷联矩阵进行即时修正 机体坐标系相对平台坐标系的转动可用转动四元数Q来表示： 从而四元数的微分方程为 将上式写成矩阵形式，得： 对它求解便可实时地求出 用四元数法对捷联矩阵进行即时修正 四元数的最佳正交化 转动四元数变换定理可知： 由于计算误差的存在使得： 从而归一化条件不再存在，应进行归一化处理，设即时修正获得的四元数为： 其模为 除以它的模可得： 四元数最佳正交化 由上式四元数的模方可