【技术实现步骤摘要】
【技术保护点】
一种基于CKF的SINS/北斗/DVL组合对准方法,其特征在于,包括以下步骤:步骤1、对SINS/北斗/DVL组合导航系统进行预热,并采集各个传感器的量测信息;步骤2、根据SINS预热后采集的光纤陀螺仪和石英挠性加速度计输出的数据,初步确定此时的姿态信息,完成捷联惯导系统的粗对准;步骤3、建立SINS/北斗/DVL组合导航系统的非线性状态方程;步骤4、建立SINS/北斗/DVL组合导航系统的量测方程,利用将多传感器两侧信息拆分成单量测信息组的方法,即将量测方程分为两组:一组为SINS/北斗滤波器量测方程,以伪距和伪距率为观测量;另一组为SINS/DVL滤波器量测方程,以速度误差为观测量;步骤5、将融合中心的采样间隔设定为两组滤波器采样间隔的最高精度时间单位,即取能够被两组传感器采样间隔同时整除的最大数为融合中心的采样间隔;步骤6、根据融合中心的采样时刻,利用CKF对各传感器进行状态估计,并在融合中心对估计结果进行判断融合,从而完成SINS/北斗/DVL组合导航系统的初始对准。
【技术特征摘要】
【专利技术属性】
技术研发人员:高伟,张亚,孙骞,徐博,李倩,奔粤阳,周广涛,阮双双,史宏洋,鲍桂清,
申请(专利权)人:哈尔滨工程大学,
类型:发明
国别省市:
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。