捷联惯导.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来表示 从而四元数的微分方程为将上式写成矩阵形式 得 对它求解便可实时地求出 用四元数法对捷联矩阵进行即时修正 简称四元数的即时修正 姿态速率计算 四元数的最佳正交化 转动四元数变换定理可知 由于计算误差的存在使得 从而归一化条件不再存在 应进行归一化处理 设即时修正获得的四元数为 其模为除以它的模可得 四元数的最佳正交化 简略的公式 接上页 四元数最佳正交化 由上式四元数的模方可得 显然满足四元数的归一条件 同时也完成了捷联矩阵T的的正交化 接上页 四元数最佳正交化 捷联矩阵也可表示为 四元数初始值的确定 捷联惯导系统程序流程图 轨迹发生器的生成 导航解算算法是建立在惯性仪表的输出的基础上 为了验证导航解算的正确与否 及后续的组合导航研究 需要设计模拟载体运动的轨迹发生器 轨迹发生器的设计思路是根据假定载体运动轨迹 在特定的坐标系下 采用适当的姿态矩阵算法推导出惯性仪表的理论输出值 同时模拟出载体运动的位置 速度 姿态以及陀螺仪的输出值 加速度计的输出值 再加上相应的随机误差值 捷联惯导初值的给定 1 给定初始位置其中 2 给定初始位置其中 3 给定初始姿态角其中 上述初始误差由惯导系统初始对准条件决定 比力的模拟计算 载体在导航坐标系中的真实速度变化矢量及载体姿态角的真实变化按一定规律给出 载体的真实位置初值 真实速度初值 真实姿态初值 均给定 则有 接上文 比力模拟计算 上式中 加速度计测量值的模拟计