[发明专利]一种舰船动态对准位置杆臂补偿方法

说明书

本发明涉及一种舰船动态对准位置杆臂补偿方法，其技术特点是包括以下步骤：以惯导系统为中心，测得卫导接收天线所处位置与惯导的三维空间距离；根据姿态矩阵计算位置杆臂投影；位置杆臂在卡尔曼滤波观测矩阵的补偿。本发明基于位置杆臂在载体坐标系和导航坐标系投影值的关系进行位置杆臂补偿，较好地解决了惯性导航系统动态初始对准这一实际工程应用问题，使得系统初始对准动态适应性有了保证，提高动态对准精度；同时，本发明在补偿位置杆臂误差时，计算方法简单，能够有效补偿位置杆臂引起的动态初始对准误差，提高初始对准载体机动适应性，可广泛用于舰船导航领域。

技术领域

本发明属于惯性导航技术领域，尤其是一种舰船动态对准位置杆臂补偿方法。

背景技术

在大型舰船上，惯导与卫导接收天线的安装位置通常相距很远，两个系统之间安装位置的三维空间差称之为杆臂。由于杆臂的存在，当载体摇摆时，惯性导航系统的加速度计会产生离心加速度和切向加速度，导致加速度计产生测量误差，进而产生额外的速度误差。现有对杆臂效应的研究大都集中在杆臂效应对速度匹配方法的影响，很少涉及到位置匹配初始对准影响。

实际上，由于舰船的运动，尤其是航向的变化，会导致位置杆臂投影到导航坐标系后是变化的，会在位置匹配观测模式下引入较大的观测误差，进而引起初始对准效果变差，因此有必要对位置匹配模式下的位置杆臂进行补偿。

发明内容

本发明的目地在于克服现有技术的不足，提出一种舰船动态对准位置杆臂补偿方法，解决位置杆臂对舰船动态对准影响大的问题。

本发明解决其技术问题是采取以下技术方案实现的：

一种舰船动态对准位置杆臂补偿方法，包括以下步骤：

步骤1：以惯导系统为中心，测得卫导接收天线所处位置与惯导的三维空间距离；

步骤2、根据姿态矩阵计算位置杆臂投影；

步骤3、位置杆臂在卡尔曼滤波观测矩阵的补偿。

所述步骤2计算位置杆臂投影采用如下公式：

x_b,y_b,z_b为卫导接收天线所处坐标在惯导系统所定义的坐标，x_n,y_n,z_n为卫导接收天线在导航坐标系的投影。

所述步骤3采用如下公式进行补偿：

δL为纬度误差；δλ为经度误差；δh为高程误差；L_ins为惯导纬度；L_gnss为卫导纬度；π为圆周率，取为3.141592653589793；λ_ins为惯导经度；λ_gnss为卫导经度；h_ins为惯导高程；h_gnss为卫导高程。

本发明的优点和积极效果是：

本发明基于位置杆臂在载体坐标系和导航坐标系投影值的关系进行位置杆臂补偿，较好地解决了惯性导航系统动态初始对准这一实际工程应用问题，使得系统初始对准动态适应性有了保证，提高动态对准精度；同时，本发明在补偿位置杆臂误差时，计算方法简单，能够有效补偿位置杆臂引起的动态初始对准误差，提高初始对准载体机动适应性。

附图说明

图1是本发明的处理流程图；

图2是本发明的卫导接收天线与惯导位置示意图。

具体实施方式

以下结合附图对本发明实施例做进一步详述。

一种舰船动态对准位置杆臂补偿方法，如图1所示，包括以下步骤：