一种紧耦合陆地组合导航方法、装置、计算机设备和介质
A tightly coupled land integrated navigation method, apparatus, computer equipment and medium

Abstract

本申请属于组合导航技术领域，涉及一种紧耦合陆地组合导航方法、装置、计算机设备和介质，方法包括：获取二维激光多普勒测速仪的相关参数，得到二维激光多普勒测速仪坐标系与光束坐标系的转换矩阵；获取捷联惯性导航系统在导航坐标系下的输出速度，得到捷联惯性导航系统在二维激光多普勒测速仪坐标系的输出速度；根据转换矩阵和捷联惯性导航系统在二维激光多普勒测速仪坐标系的输出速度，得到捷联惯性导航系统在光束坐标系的输出速度；构建卡尔曼滤波器，令捷联惯性导航系统在光束坐标系下的输出速度与二维激光多普勒测速仪在光束方向速度之差为滤波观测量，估计组合导航系统的状态向量并导航。本方法提高了组合导航系统的鲁棒性。