针对惯性导航的雷达高度表辅助方法
【专利摘要】本发明提供一种针对惯性导航的雷达高度表辅助方法，该方法中量测量的构建方法是，根据惯性导航输出的位置矢量计算得到飞行器地心高度，减去地球椭球半径获得飞行器计算海拔高度，雷达高度表测量值结合其它算法获得观测海拔高度，计算海拔高度减去观测海拔高度得到的差值作为量测量，并推导出量测量的全微分方程。本发明给出了一个【具体实施方式】，基于该量测量组成捷联惯导/雷达高度表组合导航系统，利用间接法带反馈校正的卡尔曼滤波实现了对位置误差状态量的估计，抑制了位置误差的发散，提高了定位精度。
【专利说明】
针对惯性导航的雷达高度表辅助方法 (一)
技术领域
[0001] 本发明提供一种针对惯性导航的雷达高度表辅助方法，属于导航领域，为提高飞 行器导航定位精度提供了一种有效方法。 (二)
【背景技术】
[0002] 惯性导航作为一种完全自主导航系统，其基本原理是通过陀螺仪和加速度计敏感 载体的旋转和平移信息，经过公式编排完成飞行器的姿态、速度和位置解算，具有输出连 续、可靠性强、短时精度高等显著优点，但也存在着误差随时间发散的缺点。
[0003] 雷达高度表是一种主动式距离传感器，雷达有不同的体制，比如:激光雷达或无线 电雷达，用以测量飞行器和某一目标物体的距离。随着制导导航与控制技术在深空探测、航 天航空的迅猛发展，雷达测距技术己经成功应用于轨道测量、弹道修正、卫星定位、交会对 接、巡航制导、航天着陆、大地测量、微波遥感等方面。
[0004] 如何在自主飞行过程中提高导航精度一直以来都是热点研究问题，惯性导航与星 敏感器的组合是一种常用的自主导航解决方案，该方案机理在于通过融合星敏感器高精度 定姿结果从而提高惯导系统基准坐标系的精度，并降低加速度计的交叉耦合效应，一定程 度上可以减小加速度积分法带来的速度及位置误差，但不能从根本上解决速度和位置误差 的发散问题。惯性导航也可以和GPS组合，GPS定位结果没有漂移误差，但通常不认为GPS是 完全自主的导航方式，两者组合也就不是完全自主导航方式。本发明针对惯导系统提供一 种雷达高度表与惯组的卡尔曼滤波数据融合方法。 (三)
【发明内容】
[0005] 本发明的目的在于提供一种基于雷达高度表的量测模型，利用卡尔曼滤波辅助惯 性导航系统获取更高的速度、位置精度。
[0006] 飞行器在飞行过程中，利用雷达测得飞行器至反射表面(海平面或地表平面）的垂 直高度值。结合其它方法进一步获得飞行器观测海拔高度，如图1所示。根据惯性导航系统 输出的位置矢量计算得到飞行器地心高度，减去地球椭球半径获得飞行器计算海拔高度， 计算海拔高度减去观测海拔高度得到的差值作为量测量。
[0007]惯性导航系统解算的飞行器位置有随时间不断加大的漂移误差，本发明方法提供 的量测量与位置漂移误差具有函数关系，结合惯性导航系统状态方程进行卡尔曼滤波，可 以起到补偿位置漂移误差的作用，提高飞行器的定位精度。其组合导航系统原理图如图2所 不。 (四）
【附图说明】
[0008] 图1为发射惯性系下飞行器位置P与雷达测距获得海拔观测高度H。的几何关系。
[0009] 图2为雷达高度表辅助惯性导航系统的组合导航系统原理图。 (五)【具体实施方式】
[0010]针对捷联惯性导航系统（SINS)，利用本发明基于雷达高度表（RA，Radar Altimeter)获得的系统量测量建立了SINS/RA组合导航系统，采用间接反馈校正式Kalman 滤波，滤波结果一方面反馈到惯导系统修正偏差，另一方面校正当前时刻状态输出量，实现 了对飞行器位置量的估计，减小了位置漂移误差。
[0011] (1)建立量测模型
[0012]如图1所示，Re为地球半径。在发射惯性坐标系O1-X1Y 1Z1(以下简称1系，并作为导航 坐标系)下，位置矢量r与发射点水平面夹角Θ满足
[0013]
⑴
[0014]式中，X、y、Z分别为SINS位置解算结果在1系下的坐标。则该时刻海拔高度H。为：
[0015]
(2)
[0016] 设由雷达高度表获得的海拔高度测量值为H。，则SINS解算高度H。与H。之差Δ H满足 如下关系：
[0017]
(3)
[0018] 其中：
[0019]
(4)
[0020] Wh为雷达高度表的量测噪声，其大小受姿态误差及反射面起伏影响。δχ、δγ、δζ分 别为捷联解算与标称轨道的位置误差。
[0021] (2)建立卡尔曼滤波方程
[0022] 采用间接法带反馈校正的卡尔曼滤波器，因此选取系统导航误差参数作为状态变 量，包含的具体元素为:捷联惯导系统数学平台失准角Φχ，Φγ，Φ ζ，1系三个轴上的速度误 差δνχ，δνγ，δνζ和位置误差51，5 7,52;，陀螺仪常值漂移6)[々々和加速度计常值偏置％，％， ▽ ζ，即：
[0023] (5)
[0024] 系统状态方程为：
[0025]
(6)
[0026] 其中，F(t)为状态转移矩阵，G(t)为系统噪声驱动阵，W(t)为系统噪声。
[0027] 以ΔΗ为观测量，系统量测方程为：
[0028] Z(t)= AH=HX(t)+V(t) (7)
[0029] 式中，
[0030]
[0031] v(t) =Wh，为量测噪声。
【主权项】
1. 针对惯性导航的雷达高度表辅助方法，其特征在于:根据惯性导航输出的位置矢量 计算得到飞行器地心高度，减去地球椭球半径获得飞行器计算海拔高度，雷达高度表测量 值结合其它算法获得观测海拔高度，计算海拔高度减去观测海拔高度得到的差值作为量测 量。2. 根据权利要求1所述的针对惯性导航的雷达高度表辅助方法，其特征在于:基于该量 测量建立捷联惯导/雷达高度表组合导航算法，将该量测量作为Kalman滤波的一维观测量。3. 根据权利要求1所述的针对惯性导航的雷达高度表辅助方法，其特征在于:基于该量 测量建立捷联惯导/星敏感器/雷达高度表组合导航算法，由惯性导航系统和星敏感器测量 所获得的平台失准角与该量测量合并，作为Kalman滤波的四维观测量。
【文档编号】G01C21/16GK105841699SQ201610180539
【公开日】2016年8月10日
【申请日】2016年3月28日
【发明人】王海涌, 高自谦
【申请人】北京航空航天大学