一种基于近距离地标测距的组合导航方法

摘要

本发明公开了一种基于近距离地标测距的组合导航方法，方法包括以下步骤：S1、将捷联惯导系统和两个测距装置安装在载体上，采集捷联惯导系统惯性测量单元正常工作状态下输出的载体运动信息以进行惯导解算；S2、载体行驶至预设地标区域内，采集两个测距装置到地标点的距离以及地标点的位置信息；S3、建立状态方程；S4、建立量测方程，将两个测距装置测量距离的平方差作为量测信息；S5、利用状态方程和量测方程，进行卡尔曼滤波，以实时修正惯性导航系统参数误差和器件参数误差，实现组合导航。实施本发明方法可有效避免信号干扰，具备较强的隐蔽性和自主性，且消除了误差累积的问题。