一种基于容积卡尔曼滤波的舰船大方位失准角传递对准方法技术

本发明专利技术公开了一种基于容积卡尔曼滤波的舰船大方位失准角传递对准方法。首先，将子惯导加速度计的比力输出转换到导航坐标系，利用巴特沃斯数字低通滤波器对其进行滤波处理；其次，主、子惯导分别进行惯导解算，主惯导的速度、姿态和角速度信息传输到子惯导的导航计算机，利用主、子惯导系统之间的速度误差、姿态误差和角速度误差构造量测量；然后，采用速度加姿态加角速度的匹配方式，建立大方位失准角情况下的状态方程和量测方程；最后，利用所建立的状态方程和量测方程，进行容积卡尔曼滤波解算，估计子惯导系统与主惯导系统间的安装误差角，完成传递对准。本发明专利技术解决了舰船在大方位失准角与大杆臂误差情况下的快速高精度对准问题。

A transfer alignment method for large azimuth misalignment based on volume Calman filtering

The invention discloses a ship's large azimuth misalignment transfer alignment method based on volumetric Calman filtering. First, the output of the sub inertial navigation accelerometer is converted to the navigation coordinate system, and the Butterworth digital low pass filter is used to filter it. Secondly, the inertial navigation system of the main and sub inertial navigation systems is calculated respectively. The speed, attitude and angular velocity information of the main inertial navigation system is transmitted to the navigation computer of the subinertial navigation system, and the main and sub inertial navigation systems are used. The velocity error, the attitude error and the angular velocity error between the systems are measured, and then the state equation and the measurement equation are established by using the matching mode of velocity plus the angular velocity of attitude and angular velocity. Finally, the volume Calman filter is used to calculate the volume Calman filter by using the established state equation and the measurement square process. The installation error angle between the ins and the INS is estimated and the transfer alignment is completed. The invention solves the problem of fast and high-precision alignment of ships in the condition of large azimuth misalignment angle and large arm error.

【技术实现步骤摘要】
一种基于容积卡尔曼滤波的舰船大方位失准角传递对准方法
本专利技术涉及捷联惯导
，特别是涉及一种基于容积卡尔曼滤波的舰船大方位失准角传递对准方法。
技术介绍
惯性导航系统是一种基于惯性原理的自主式导航系统。捷联惯导系统将陀螺和加速度计直接固连在运载体上来测量运载体的角运动和线运动信息，经过积分运算推算出运载体相对于地球的速度、位置以及姿态和航向信息。初始对准是捷联惯导系统的一项关键技术，对准的精度直接影响到导航系统的精度，而完成对准的时间则直接影响到系统的快速反应能力。传递对准是利用主惯导的输出信息来对准子惯导的一种初始对准方式，对准速度快，且对载体的机动不加限制。由于舰船在海上航行会受到海浪影响，尤其是海况不佳的情况下，基于大方位失准角的非线性模型更能准确地描述真实的系统。对于大型舰船而言，舰船上的主惯导往往安装在其摇摆中心，而舰载设备上的子惯导的安装位置与主惯导有很长一段距离，当载体存在角运动时，主、子惯导加速度计会敏感到不同的加速度，从而导致主、子惯导之间存在杆臂速度差，这就是传递对准中的杆臂效应现象。杆臂效应会严重影响传递对准的精度和收敛速度，必须进行补偿。高伟等人在《传递对准中杆臂效应的误差分析与补偿》(发表于期刊《仪器仪表学报》，2013年，第34卷，03期)一文中，针对大方位失准角条件下的非线性系统提出了一种直接计算的补偿方法，方位失准角可在120s内收敛至0.381°。黄湘远等人在《基于简化CKF/降维CKF混合滤波的非线性对准技术研究》(发表于期刊《弹箭与制导学报》，2015年，第35卷，01期)一文中，提出了基于简化CKF/降维CKF混合滤波的非线性对准方法，大大减小了计算量，水平对准精度达到1′以下，方位对准精度达到5′以下。徐晓苏等人在《基于改进型CKF的SINS初始对准方法》(华中科技大学学报(自然科学版)，2016年，第44卷，01期)一文中，提出了一种改进型CKF方法用于大方位失准角条件下的传递对准，方位对准精度达到3′以下。本专利技术设计了一种基于容积卡尔曼滤波的速度加姿态加角速度传递对准方法，可用于舰船存在大方位失准角与大杆臂误差的情况，对准的速度和精度比现有方法均有很大程度的提高。
技术实现思路
本专利技术的目的在于提供一种可应用于舰船存在大方位失准角以及大杆臂误差情况下的快速高精度传递对准方法。实现本专利技术目的的技术方案为：一种基于容积卡尔曼滤波的舰船大方位失准角传递对准方法，包括以下步骤：步骤一：完成子惯导系统的启动、预热准备；步骤二：将子惯导加速度计的比力输出转换到导航坐标系，利用巴特沃斯数字低通滤波器对其进行滤波处理，以达到消除杆臂效应误差影响的目的；步骤三：主、子惯导系统分别进行惯导解算，主惯导的速度、姿态和角速度信息传输到子惯导的导航计算机；步骤四：在舰船存在大方位失准角的情况下，采用速度加姿态加角速度的匹配方式，认为主、子惯导载体坐标系不同而导航坐标系相同，选取主、子惯导系统之间的速度误差、姿态误差和角速度误差作为量测量，建立系统的状态方程和量测方程；步骤五：利用所建立的状态方程和量测方程，进行容积卡尔曼滤波解算，估计子惯导系统与主惯导系统间的安装误差角，完成传递对准。在步骤二中，巴特沃斯数字低通滤波器的技术要求为：通带截止频率为fp＝0.01Hz，通带波纹为αp＝2dB，阻带截止频率为fs＝0.15Hz，阻带衰减为αs＝40dB。设计出二阶巴特沃斯数字滤波器的离散传递函数为：则滤波器的状态方程为：输出方程为：其中，u(n)表示滤波器的输入，c＝[0.001660.70710]，d＝5.53551e-06。在步骤三中，建立的速度加姿态加角速度匹配传递对准数学模型如下：忽略垂向通道，选取的状态变量为：系统状态方程为：其中，n为导航坐标系；m系为主惯导载体坐标系；s系为子惯导载体坐标系；为子惯导计算载体坐标系；δVn为速度误差在导航坐标系的投影；为主惯导载体坐标系到子惯导载体坐标系的方向余弦矩阵；为主惯导载体坐标系到子惯导计算载体坐标系的方向余弦矩阵；为主惯导载体坐标系到导航坐标系的方向余弦矩阵；为子惯导测量的比力在其载体坐标系的投影；为地球自转角速度在导航坐标系的投影；为n系相对于地球坐标系的角速度在n系的投影；为s系和m系之间的安装误差角；为系和m系之间的量测失准角；为主惯导相对于导航坐标系的角速度在m系的投影；为加速度计常值漂移；wv为加速度计随机漂移；εs为陀螺常值漂移；为陀螺随机漂移。采用速度加姿态加角速度的匹配方式，将主、子惯导间的速度误差δVn、量测失准角以及角速度误差作为观测量：量测方程为：Z＝h(X)+V其中，V为系统的量测噪声。利用三自由度Spherical-Radial求容积规则，采用一组2n个等权值的容积点设计非线性滤波算法即容积卡尔曼滤波，具体如下：对于如下一个连续非线性系统：采用4阶龙格库塔(RungeKutta)法将系统模型进行离散化，得到一个离散非线性系统：其中，Xk为系统状态矢量；Zk为观测矢量；Wk为系统噪声矢量，Vk为量测噪声矢量，二者均为零均值的高斯白噪声序列，且互不相关，即满足：其中，Qk为系统噪声序列的方差阵；Rk为量测噪声序列的方差阵；δkj为克罗内克函数。容积卡尔曼滤波的具体实现步骤如下：a.时间更新假设k-1时刻的状态xk-1的统计特性已知，先对Pk-1做Cholesky分解：计算容积点：计算经系统状态方程传递后的容积点：估计k时刻的状态预测值：估计k时刻的状态预测协方差阵：b.量测更新对Pk/k-1做Cholesky分解：计算容积点：计算经系统量测方程传递后的容积点：Zi,k/k-1＝h(Xi,k/k-1)i＝1,2…,2n估计k时刻的量测预测值：估计k时刻的量测预测协方差阵：估计k时刻的一步预测互相关协方差阵：估计k时刻的滤波增益：求取k时刻的状态估计值：求取k时刻的状态误差协方差阵：根据建立的速度加姿态加角速度匹配传递对准的状态方程和量测方程，进行容积卡尔曼滤波解算，估计出子惯导系统与主惯导系统间的安装误差角，完成传递对准。与现有技术相比，本专利技术的有益效果是：本专利技术在舰船存在大方位失准角的情况下，将系统考虑为非线性模型，并且设计巴特沃斯数字低通滤波器对子惯导加速度计的输出进行滤波处理，采用速度加姿态加角速度的匹配方式，建立滤波模型，进行容积卡尔曼滤波解算，有效地消除了杆臂效应的影响，大幅度地提高了舰船在大方位失准角与大杆臂误差情况下的对准速度和精度。附图说明图1为本专利技术的基本流程框图；图2为杆臂加速度的频谱；图3为利用Matlab仿真得到的安装误差角估计误差曲线。具体实施方式下面结合附图对本专利技术进一步说明。为了验证本专利技术的有效性，利用Matlab对设计的基于容积卡尔曼滤波的舰船大方位失准角时的传递对准非线性模型进行仿真。舰船在海中航行时会受到风浪影响，产生三轴摇摆运动，其数学模型为：式中，ψ，θ，γ分别表示航向角、纵摇角和横摇角；ψm，θm，γm为摇摆角幅值；ωy，ωp，ωr为摇摆角频率；Ti＝2π/ωi,(i＝y,p,r)为摇摆周期；为初始姿态角；K为初始航向。仿真参数设置如下：摇摆角幅值：ψm＝5°，θm＝15°，γm＝10°；摇摆周期：Ty＝8s，Tp＝12s，Tr＝6s；初始姿态角：初始航向：本文档来自技高网...

【技术保护点】
一种基于容积卡尔曼滤波的舰船大方位失准角传递对准方法，其特征在于，包括以下步骤：步骤一：完成子惯导系统的启动、预热准备；步骤二：将子惯导加速度计的比力输出转换到导航坐标系，利用巴特沃斯数字低通滤波器对其进行滤波处理，以达到消除杆臂效应误差影响的目的；步骤三：主、子惯导系统分别进行惯导解算，主惯导的速度、姿态和角速度信息传输到子惯导的导航计算机；步骤四：在舰船存在大方位失准角的情况下，采用速度加姿态加角速度的匹配方式，认为主、子惯导载体坐标系不同而导航坐标系相同，选取主、子惯导系统之间的速度误差、姿态误差和角速度误差作为观测量，建立系统的状态方程和量测方程；步骤五：利用所建立的状态方程和量测方程，进行容积卡尔曼滤波解算，估计子惯导系统与主惯导系统间的安装误差角，完成传递对准。

【技术特征摘要】
1.一种基于容积卡尔曼滤波的舰船大方位失准角传递对准方法，其特征在于，包括以下步骤：步骤一：完成子惯导系统的启动、预热准备；步骤二：将子惯导加速度计的比力输出转换到导航坐标系，利用巴特沃斯数字低通滤波器对其进行滤波处理，以达到消除杆臂效应误差影响的目的；步骤三：主、子惯导系统分别进行惯导解算，主惯导的速度、姿态和角速度信息传输到子惯导的导航计算机；步骤四：在舰船存在大方位失准角的情况下，采用速度加姿态加角速度的匹配方式，认为主、子惯导载体坐标系不同而导航坐标系相同，选取主、子惯导系统之间的速度误差、姿态误差和角速度误差作为观测量，建立系统的状态方程和量测方程；步骤五：利用所建立的状态方程和量测方程，进行容积卡尔曼滤波解算，估计子惯导系统与主惯导系统间的安装误差角，完成传递对准。2.根据权利要求1所述的一种基于容积卡尔曼滤波的舰船大方位失准角传递对准方法，其特征在于，子惯导系统的振荡是以舒拉周期和地球自转周期为主的振荡，处在低频区，其频谱分布在f＝2×10-4Hz以下。根据杆臂效应加速度的频谱，可确定巴特沃斯低通滤波器的技术要求：通带截止频率fp＝0.01Hz，通带波纹αp＝2dB，阻带截止频率fs＝0.15Hz，阻带衰减αs＝40dB。首先通过下式确定滤波器的阶数N。式中，代入可得N＝1.80，取N＝2。3dB截止频率为：由巴特沃斯归一化低通滤波器参数表可得二阶低通滤波器的归一化原型系统函数：将Ga(p)去归一化，得到模拟低通滤波器的系统函数：采...

【专利技术属性】
技术研发人员：高伟，王凯，张亚，王岩岩，
申请(专利权)人：哈尔滨工业大学，
类型：发明
国别省市：黑龙江,23