-
公开(公告)号:CN115855038A
公开(公告)日:2023-03-28
申请号:CN202211465410.4
申请日:2022-11-22
Applicant: 哈尔滨工程大学 , 哈尔滨哈船智聚创新科技发展有限公司
Abstract: 本发明公开一种短时高精度姿态保持方法,包括:获取陀螺仪输出和加速度计输出;基于加速度计输出和当地重力加速度,得到自身初始姿态信息;基于自身初始姿态信息和陀螺仪输出,得到航向角,作为航向输出;基于加速度计输出和当地重力加速度,得到俯仰角和横揺角,并进行低通滤波处理,将低通滤波处理后的俯仰角和横揺角作为水平姿态输出,实现姿态测量。本发明能够在不依赖任何外界信息的条件下快速完成初始姿态的确定,后续姿态测量也无需接受任何外界信息,抗干扰能力强。经过剧烈角运动后仍能实现高精度的姿态测量,提高姿态计算的精度,实现较低成本条件下的高精度姿态测量。
-
公开(公告)号:CN115855038B
公开(公告)日:2024-01-09
申请号:CN202211465410.4
申请日:2022-11-22
Applicant: 哈尔滨工程大学 , 哈尔滨哈船智聚创新科技发展有限公司
Abstract: 本发明公开一种短时高精度姿态保持方法,包括:获取陀螺仪输出和加速度计输出;基于加速度计输出和当地重力加速度,得到自身初始姿态信息;基于自身初始姿态信息和陀螺仪输出,得到航向角,作为航向输出;基于加速度计输出和当地重力加速度,得到俯仰角和横揺角,并进行低通滤波处理,将低通滤波处理后的俯仰角和横揺角作为水平姿态输出,实现姿态测量。本发明能够在不依赖任何外界信息的条件下快速完成初始姿态的确定,后续姿态测量也无需接受任何外界信息,抗干扰能力强。经过剧烈角运动后仍能实现高精度的姿态测量,提高姿态计算的精度,实现较低成本条件下的高精度姿态测量。(56)对比文件申强等《.多传感器信息融合导航技术》.北京理工大学出版社,2020,34-35.Bo Xu等.Error Modeling and SimulationAnalysis for the Vehicle Launching SystemErecting《.Advanced Materials Research》.2012,全文.高薪;卞鸿巍;傅中泽;张礼伟.捷联惯导晃动基座四元数估计对准算法.中国惯性技术学报.2014,(第06期),全文.孙立江;周召发;陈河;刘朋朋;郭琦.激光捷联惯导多矢量定姿法晃动基座粗对准.压电与声光.2016,(第02期),全文.
-
公开(公告)号:CN115752512A
公开(公告)日:2023-03-07
申请号:CN202211465275.3
申请日:2022-11-22
Applicant: 哈尔滨工程大学 , 哈尔滨哈船智聚创新科技发展有限公司
Abstract: 本申请公开了一种惯性基组合导航三轴不重合角标定方法及系统,其中方法包括以下步骤:构建超短基线系统的定位函数模型;基于所述定位函数模型,构建三轴不重合角姿态矩阵函数模型;基于所述超短基线系统定位模型和所述三轴不重合角姿态矩阵模型,构建BFGS标定算法目标函数模型;基于所述BFGS标定算法目标函数模型,对组合导航系统三轴不重合角进行标定。本申请的BFGS标定算法不需要对姿态矩阵进行近似,而是通过对代价函数应用BFGS算法求取最小值对应的三轴不重合角,此方法可以从误差角度提高标定的精度,特别是当安装偏差角较大时更加有效。
-
公开(公告)号:CN115855104A
公开(公告)日:2023-03-28
申请号:CN202211494167.9
申请日:2022-11-25
Applicant: 哈尔滨工程大学 , 哈尔滨哈船智聚创新科技发展有限公司
Abstract: 本申请公开了一种组合导航滤波结果最优在线评价方法,步骤包括:获取载体坐标系相对于地心惯性坐标系的状态数据;根据状态数据确立初始姿态四元数方程;对初始姿态四元数方程进行规范化处理,得到姿态更新方程;根据状态数据得到载体位置更新方程,基于载体位置更新方程和状态数据,得到载体速度更新方程;根据姿态更新方程和载体速度更新方程,得到姿态误差方程和速度与位置误差模型;根据姿态误差模型和速度与位置误差模型,对系统驱动白噪声进行等效离散化处理,得到离散卡尔曼滤波递推模型;基于离散卡尔曼滤波递推模型得到滤波结果,并对滤波结果进行归一化处理,结合加速遗传算法优化降维指标函数,最终得出最佳降维值。
-
公开(公告)号:CN115031727B
公开(公告)日:2023-06-20
申请号:CN202210344869.2
申请日:2022-03-31
Applicant: 哈尔滨工程大学
Abstract: 本发明提供一种基于状态变换的多普勒辅助捷联惯导系统初始对准方法,具体包括:步骤一:构建基于载体系速度误差的捷联惯导系统误差方程。步骤二:构建基于状态变换的多普勒测速仪辅助捷联惯性导航系统初始对准的卡尔曼滤波模型。步骤三:利用卡尔曼滤波器对SINS初始误差状态进行估计,完成对准任务。本发明是一种适用于初始大方位失准角条件下的SINS/DVL组合导航系统初始对准方法,具有较高的工程应用价值。本发明利用载体系速度误差模型,并构建了SINS和DVL安装偏差角模型,模型精度高,实验证明所提方法对准精度高。
-
公开(公告)号:CN115031724A
公开(公告)日:2022-09-09
申请号:CN202210279711.1
申请日:2022-03-21
Applicant: 哈尔滨工程大学
Abstract: 本发明公开了一种SINS/DVL紧组合系统DVL波束故障处理方法,步骤一、进行捷联惯性导航系统初始对准,然后将声学多普勒计程仪波束量测信息传送到捷联惯性导航系统;步骤二:构建捷联惯性导航系统状态参量X及状态方程;步骤三、选取捷联惯性导航系统量测量Z并构建量测方程,步骤四:利用基于新息的χ2检验方法对接收到的DVL波束量测信息进行故障检测,步骤五、根据不同波束故障情况,重构故障波束速度信息。本发明直接使用了DVL原始的波束量测信息,能够更加充分的获得可利用的有效信息,当部分波束量测出现故障时,本发明通过相应的波束信息故障处理方法使组合导航系统依旧维持较高的导航精度。
-
-
公开(公告)号:CN111158395B
公开(公告)日:2021-05-14
申请号:CN202010031399.5
申请日:2020-01-13
Applicant: 哈尔滨工程大学
IPC: G05D1/10
Abstract: 本发明提供一种基于鸽群优化的多无人机紧密编队控制方法,通过分析长机翼尖涡流对僚机影响建立紧密编队条件下气动耦合效应的数学模型,输入长机控制指令和改进人工势场法获得多无人机紧密编队的理想状态。利用改进鸽群优化算法估计可使下一时刻僚机状态量最接近理想状态下的僚机控制量,从而完成编队任务。本发明意义在于提供了一种在紧密编队条件下的多无人机编队控制方案,收敛速度快,稳态精度高,具有较高的工程应用价值。
-
公开(公告)号:CN109459040A
公开(公告)日:2019-03-12
申请号:CN201910033350.0
申请日:2019-01-14
Applicant: 哈尔滨工程大学
IPC: G01C21/20
Abstract: 本发明属于定位技术领域,具体涉及一种基于RBF神经网络辅助容积卡尔曼滤波的多AUV协同定位方法。本发明包括以下步骤:建立多AUV协同定位状态空间模型;创建一个RBF神经网络;在基准参考位置可用时,通过CKF进行多AUV协同定位估计;收集RBF神经网络的训练数据;对RBF神经网络进行训练;基准信号中断,停止训练RBF神经网络,继续进行CKF协同定位估计;估计CKF协同定位滤波误差;补偿滤波状态更新估计值。本发明在多AUV协同定位情况下,考虑跟随AUV航向漂移误差、洋流速度影响及与距离相关的水声噪声,具有更高的实用价值;利用RBF神经网络对CKF滤波估计值进行补偿,协同定位精度和稳定性显著提高;本发明算法易于实现。
-
公开(公告)号:CN115031725B
公开(公告)日:2024-10-15
申请号:CN202210280446.9
申请日:2022-03-21
Applicant: 哈尔滨工程大学
Abstract: 本发明公开了一种DVL多波束标定方法,包括:建立DVL波束量测结构模型,对模型进行四元数表示,选取状态量和量测信息,建立基于四元数表示的状态预测方程、量测预测方程和非线性量测方程的雅克比矩阵;使用EKF对四波束进行标定,将状态预测方程、量测预测方程和非线性量测方程的雅克比矩阵代入卡尔曼滤波器中得到安装偏差角四元数及结构角误差估计值;重置卡尔曼滤波器中状态量及状态先验协方差矩阵,状态量作为下一次滤波的状态初值,获得载体速度信息的迭代更新公式,重复迭代循环次数n,获得安装偏差角四元数及结构角误差估计值。本发明提高了标定精度,在迭代后具有更稳定的误差均值及标准差。
-
-
-
-
-
-
-
-
-