晃动基座行进间对准问题的QUEST算法

针对惯导系统晃动基座行进间初始对准问题,提出了一种基于重力矢量的QUEST(Quaternion Estimator)姿态最优估计算法。在传统基于重力矢量的初始对准方法基础上,将方向余弦矩阵的求解过程转换为Wahba问题,实现对重力矢量信息的充分利用,并通过QUEST算法实现了晃动基座下行进间粗对准的最优算法,改善了原有算法鲁棒性以及实时性等方面的问题。仿真和湖试实验验证表明,更改后的算法能够明显提高惯导系统在动基座下的姿态估计速度和精度,特别在周期性线振动环境下的对准精度能够提高一个数量级。多航次的湖试实验结果表明,改进后的算法能够有效提高航向对准精度,综合导航速度精度能够提高50%左右。     

DVL安装角估计方法在水下组合导航系统中的应用

对于INS/DVL组合导航系统,如何准确估计出DVL与载体之间的安装关系是影响组合导航系统精度的关键因素,针对该问题提出了一种在线迭代递推算法,应用卡尔曼滤波技术,对此安装关系进行估计。并对安装关系中的状态变量的可观性进行分析,给出了满足可观性所需的条件以及舰船运动方式。设计出了估计滤波器,并进行了实际船载实验。实验结果表明:在安装角误差小于10°的情况下,迭代计算两次后误差小于0.1°,估计精度满足要求,算法有效可行。该方法代替了人工光学标定方法,具有很好的工程应用价值。