卡尔曼滤波与组合导航—第五讲

参考坐标系
Z
2、几个参考坐标系的定义 ★惯性坐标系 通常把使得牛顿力学定律成立的参考坐标系,称为惯性 坐标系，简称惯性系； 赤道 根据选取的坐标系原点不同，分为日心惯性坐标系和 地心惯性坐标系。 日心惯性坐标系：原点取在太阳的中心,三根轴指向确定的 X Y 恒星。 地心惯性坐标系（OXiYiZi）：原点取在地球的中心,Xi和 Yi轴位于赤道平面内并指向确定的恒星，Zi轴与地轴（地 球自转轴）重合。地心惯性坐标系不参与地球自转。 惯性空间：惯性坐标系三根轴所代表的空间。
参考坐标系
★地球坐标系（OXeYeZe） 与地球固连，原点取在地球 的中心,Xe和Ye轴位于赤道平面 内，分别指向本初子午线和东经 90°子午线，Ze轴与地轴重合。 地球坐标系参与地球自转， 它相对于惯性坐标系的转动角速 度就等于地球自转角速度。 地球相对惯性空间的转动， 可以用地球坐标系相对于惯性坐 标系的转动来表示。 Ze Ω
一、惯导系统初始对准概述
1.4 初始对准的发展趋势
自适应滤波 H∞滤波 初 始 对 准 的 发 展 新的滤波方法
神经网络
非线性滤波 预测滤波
可观测性分析和 可观测度研究
从根本提高对准 的精度和速度
第五章 卡尔曼滤波在惯性导航初始对准中的应用
一、惯导系统初始对准概述
二、惯导系统的静基座初始对准
三、惯导系统的动基座对准
陀螺漂移
随机误差 惯导系统 为随机系统
若采用状态反馈控制，就必须对状态进行估计！
卡
尔
曼
滤
波
器
二、惯导系统的静基座初始对准方法
2.2 静基座初始对准方案(续)
（1）采用KALMAN滤波进行初始对准，就是将平台误差角 ΨN，ΨE，ΨD从随机误差和随机干扰中估计出来， 通过系统的校正使平台坐标系与导航坐标系对准； （2）同时，尽可能估计出陀螺漂移和加速度计偏置； （3）时间不长，因此陀螺漂移和加速度计偏置可看作常值； （4）根据分离定理，对随机系统的最优估计和最优控制
参考坐标系
★载体坐标系（OXbYbZb） 与载体固连，其原点与载体的重心重合, Xb轴沿载 体纵轴方向, Yb轴沿载体横轴方向，Zb轴沿载体竖轴方向。
Zb
Yb
Xb
实现惯导要解决的几个问题





平台跟踪坐标系 平台跟踪什么样的坐标系是平台式惯导系统的首要问题 舒勒摆原理在惯导系统中的应用 普通地平液体摆做敏感元件受加速度影响较大，需用舒 勒摆原理 有害加速度的消除 消除由于地球自转、飞机飞行引起的牵连、哥氏、重力 加速度等 初始对准问题 惯导系统要正确而精确的工作，必须精确给定初始条件 捷联惯导解算问题 数学平台代替机电平台
一、惯导系统初始对准概述
1.1 初始对准的必要性
基本解决
理论问题
惯 导 系 统 的 问 题
理论、方法、指导
工程技术问题
难度（实现）
一、惯导系统初始对准概述
1.1 初始对准的必要性（续）
惯导系统
姿态矩阵 计算
一、惯导系统初始对准概述
1.1 初始对准的必要性（续）
加速度计
积分运算必须知道
a
∫
∫
V
∫
赤道
X Xe
本初子午线
Ω*t
Ye
参考坐标系
★地理坐标系（ONEZ） 其原点与运载体的重心 重合,E轴沿当地纬线指东,N 轴沿当地子午线指北,Z轴沿 当地地垂线指天.其中E轴与 N轴构成的平面即为当地水 平面,N轴与Z轴构成的平面 即为当地子午面. 这种地理坐标系是跟随 运载体运动的,更确切地说 应称为动地理坐标系或当地 地理坐标系.
四、惯导系统的传递对准
二、惯导系统的静基座初始对准方法
2.1 2.2 2.3 2.4 2.5 2.6 2.7 粗对准与精对准 静基座初始对准方案
惯导系统的误差方程
卡尔曼滤波方程的建立
计算机仿真研究
静基座初始对准的可观测度分析
提高静基座初始对准精度与速度的方法
二、惯导系统的静基座初始对准方法
2.1 粗对准与精对准
1
参考坐标系
当运载体在地球上运动时,运载体相对地球的位置不断 改变;而地球上不同地点的地理坐标系,其相对地球坐标系 的角位置是不相同的.也就是说，运载体相对地球运动引起 地理坐标系相对地球坐标系转动.这时地理坐标系相对惯性 坐标系的转动角速度应包括两个部分：一是地理坐标系相 对地球坐标系的转动角速度:另一是地球坐标系相对惯性坐 标系的转动角速度. 地理坐标系的三根轴构成右手直角坐标系，可以按 “北、东、天”、“北、西、天”或“北、东、地”顺序 构成。
— 先水平后方位（经典）
二、惯导系统的静基座初始对准方法
2.2 静基座初始对准方案
静基座初始对准分为两大类：
频域法 或经典法 最优估计法 或卡尔曼滤波法
•基于经典控制理论
本课程研究的
重点！ • 基于现代控制理论
二、惯导系统的静基座初始对准方法
2.2 静基座初始对准方案(续)
加速度计偏置
惯导系统 误差根源
误差角取为 Φ 误差角取为 Ψ
Ψ ：平台坐标系与计算地Leabharlann Baidu坐标系之间的误差角 Φ：平台坐标系与真实地理坐标系之间的误差角 目前大多采用Ψ角误差模型和速度误差表达形式！
2.3 惯导系统的误差方程
Ψ角误差模型+速度误差表达形式的优点： （1）平动误差不会耦合到姿态误差方程中， 特别便于动基座对准问题的分析和研究。 （2）Φ动角可通过位置误差和Ψ角得到： Φ=Ψ+θ （3）静基座时，惯导所处地理位置可精确获得， 且对准时间较短，可忽略位置误差，此时：
Z
P
初始值！

, ,
X
Y
1.2 初始对准的分类
粗对准 对准阶段 精对准
自主对准
对外信息 的需求 基座 运动状态
静基座
初始对准
非自主 对准
动基座
对准轴系 水平对准 方位对准
一、惯导系统初始对准概述
1.3 初始对准的要求
初 始 对 准 的 要 求 对准精度
快又准
对准时间
对准精度与对准时间相互制约，不同场合侧重点不同
（2.3.1）
• ρ是地理系相对地球转动速度矢量
2.3 惯导系统的误差方程
惯导系统的Ψ角误差方程：
V V f g
r r V

在北东地坐标系中，有：
（2.3.1）
cos L cos L 0 （2.3.4） 0 （2.3.2） （2.3.3） sin L sin L
•扩充为系统状态变量
•不完全为白噪声
2.3 惯导系统的误差方程
最终可得惯导系统的Ψ角误差方程：
2 sin L 0 g 0 VN 0 0 g 0 0 VE 2 sin L N 0 0 0 sin L 0 0 sin L 0 cos L E 0 0 0 0 cos L 0 D 0 0 0 0 N 0 0 0 0 0 0 E 0 0 0 0 N 0 0 0 0 0 0 E D 0 0 0 0 0 1 0 0 0 0 VN 0 1 0 0 0 VE 0 0 1 0 0 N 0 0 0 1 0 E 0 0 0 0 1 D 0 0 0 0 0 N 0 0 0 0 0 E 0 0 0 0 0 N 0 0 0 0 0 E 0 0 0 0 0 D
根据对准精度的要求，静基座对准过程分为： 粗对准
• 要求尽快地将平台调整到 通常在精对准过程中要进行陀 一个精度范围内， 螺的测漂和定标，进一步补偿陀螺 • 缩短对准时间是主要指标 漂移率和标定刻度系数，以提高对 准精度 在粗对准基础上进行， • • 对准精度是主要指标
精对准
• 平台，先水平（调平），后方位，使系统有较好的动态性能 • 捷联：精确建立姿态矩阵 — 水平和方位对准同时（现代）
将2.3.2~2.3.4代入2.3.1，可得状态空间模型：
2.3 惯导系统的误差方程
静基座初始对准时，位置和垂直方向速度可准确知道 惯导系统的误差方程可简化为：
rN 0 rN 0 sin L L 1 0 0 0 0 0 r E sin L 0 cos L 0 1 0 0 0 0 rE 0 rD 0 rD L cos L 0 0 0 1 0 0 0 0 0 0 (2 ) sin L L 0 fD fE VN N VN g / R VE E VE 0 g/R 0 (2 ) sin L 0 (2 ) cos L fD 0 fN 0 2g / R L (2 ) cos L 0 fE fN 0 VD D VD 0 0 0 0 0 0 0 0 ( ) sin L L N N N E 0 0 0 0 0 0 ( ) sin L 0 ( ) cos L E E 0 0 0 0 0 L ( ) cos L 0 D 0 D D
Φ=Ψ
2.3 惯导系统的误差方程
惯导系统的Ψ角误差方程：
惯导系统的误差模型可由下列3个基本方程表示： V V f g
r r V

• δV、r和Ψ分别为速度、位置和姿态矢量 • Ω为地球自转角速度 • ω为导航坐标系相对惯性坐标系的角速度矢量 • ▽是加速度计常值偏值，ε是陀螺常值漂移 • f是比力，△g是重力矢量计算误差，
卡尔曼滤波与组合导航原理
Theory of Kalman Filter and Integrated Navigation
第五章 卡尔曼滤波在惯性导航初始对准中的应用
一、惯导系统初始对准概述
二、惯导系统的静基座初始对准
三、惯导系统的动基座对准
四、惯导系统的传递对准
参考坐标系
1、建立参考坐标系的意义 宇宙间的一切物体都是在不断地运动,但对单个物体是无 运动可言的,只有在相对的意义下才可以谈运动.一个物体在 空间的位置只能相对于另一个物体而确定,这样,后一个物体 就构成了描述前一个物体运动的参考系. 参考系通常采用直角坐标系来代表,称为参考坐标系或简 称参考系.在研究陀螺仪或运载体的运动时,同样需要有参考 坐标系才成. 陀螺仪最重要的功用之一就是用它在运载体上模拟地理 坐标系或惯性坐标系。 常用坐标系：地心惯性坐标系、地球坐标系、地理坐标系、 载体坐标系。
推导 方法
Φ角误差模型
真实地理坐标系法
正确反映惯导系统的误差特性， 便于分析和应用！ 推导 Ψ角误差模型 方法 计算地理坐标系法
可以证明两种模型是等价的！
2.3 惯导系统的误差方程
描述惯导系统误差特性的微分方程可分为：
两种 表示形式
变量取为位置误差 变量取为速度误差
平动误差方程
姿态误差方程
两种 表示形式
可以分开单独考虑，故可用卡尔曼滤波器对平台误差
角及惯性仪表的误差进行单独研究。
二、惯导系统的静基座初始对准方法 2.3 惯导系统的误差方程
惯导系统误差源
仪表误差
安装误差
初始条件 误差
运动干扰 （有害）
其他误差
如地球曲率半径描述误差； 有害加速度补偿中忽略二阶小量
2.3 惯导系统的误差方程
Φ角误差模型和Ψ角误差模型 基础 初始对准 惯导误差方程