-
公开(公告)号:CN114199248A
公开(公告)日:2022-03-18
申请号:CN202111444203.6
申请日:2021-11-30
Applicant: 哈尔滨工程大学
Abstract: 本发明属于水下多航行器协同导航技术领域,具体涉及一种基于混合元启发算法优化ANFIS的AUV协同定位方法。本发明基于AQPSO‑GA方法训练的ANFIS‑AQPSO‑GA模型具有更好拟合输入输出数据的能力。训练好的ANFIS‑AQPSO‑GA模型能在实时工作环境中,对丢失量测信息进行补偿,对异常量测信息进行修正,大大降低协同导航整体估计误差,提升长航时缺少基准位置条件下的定位精度。本发明采用ANFIS‑AQPSO‑GA结构设计的预测结构对协同定位方法本身计算复杂度无明显影响,能满足实时动态条件下的计算需求,且有效提升了协同定位算法的鲁棒性和定位精度。
-
公开(公告)号:CN118443010A
公开(公告)日:2024-08-06
申请号:CN202410535383.6
申请日:2024-04-29
Applicant: 哈尔滨工程大学 , 北京格联科技有限公司
Abstract: 本发明公开一种惯性基组合导航方法、产品、介质、设备及水下自主潜航器,涉及导航领域。本发明在惯性基组合导航系统启动的初始阶段,SINS利用USBL辅助初始对准,获得初始姿态信息;在进入正式导航工作状态时,SINS基于初始姿态信息进行纯惯性导航解算,得到含有误差的导航参数计算值,包括姿态、速度和位置;根据含有误差的导航参数计算值构建基于李群的导航状态误差模型,进而建立组合导航鲁棒卡尔曼滤波算法;基于Huber函数构建广义最大似然估计模型,并结合组合导航鲁棒卡尔曼滤波算法对惯性基组合导航系统进行滤波估计,得到状态估计值;根据状态估计值对导航参数进行反馈更新,基于更新后的导航参数进行导航,能够提高组合滤波精度以及定位定向精度。
-
公开(公告)号:CN115855104A
公开(公告)日:2023-03-28
申请号:CN202211494167.9
申请日:2022-11-25
Applicant: 哈尔滨工程大学 , 哈尔滨哈船智聚创新科技发展有限公司
Abstract: 本申请公开了一种组合导航滤波结果最优在线评价方法,步骤包括:获取载体坐标系相对于地心惯性坐标系的状态数据;根据状态数据确立初始姿态四元数方程;对初始姿态四元数方程进行规范化处理,得到姿态更新方程;根据状态数据得到载体位置更新方程,基于载体位置更新方程和状态数据,得到载体速度更新方程;根据姿态更新方程和载体速度更新方程,得到姿态误差方程和速度与位置误差模型;根据姿态误差模型和速度与位置误差模型,对系统驱动白噪声进行等效离散化处理,得到离散卡尔曼滤波递推模型;基于离散卡尔曼滤波递推模型得到滤波结果,并对滤波结果进行归一化处理,结合加速遗传算法优化降维指标函数,最终得出最佳降维值。
-
公开(公告)号:CN115046554A
公开(公告)日:2022-09-13
申请号:CN202210293267.9
申请日:2022-03-23
Applicant: 哈尔滨工程大学
Abstract: 本发明提供一种基于马氏距离与神经网络辅助的AUV协同定位方法,本发明利用自适应容积卡尔曼滤波处理野值的同时,使用双阈值马氏距离来检测声学量测是否发生异常以及发生何种异常,如果量测正常更新则允许卡尔曼滤波结果对状态进行更新,如果量测发生异常则根据异常类型,使用不同的算法辅助滤波更新,以达到提高协同定位精度的目的。
-
公开(公告)号:CN115031725A
公开(公告)日:2022-09-09
申请号:CN202210280446.9
申请日:2022-03-21
Applicant: 哈尔滨工程大学
Abstract: 本发明公开了一种DVL多波束标定方法,包括:建立DVL波束量测结构模型,对模型进行四元数表示,选取状态量和量测信息,建立基于四元数表示的状态预测方程、量测预测方程和非线性量测方程的雅克比矩阵;使用EKF对四波束进行标定,将状态预测方程、量测预测方程和非线性量测方程的雅克比矩阵代入卡尔曼滤波器中得到安装偏差角四元数及结构角误差估计值;重置卡尔曼滤波器中状态量及状态先验协方差矩阵,状态量作为下一次滤波的状态初值,获得载体速度信息的迭代更新公式,重复迭代循环次数n,获得安装偏差角四元数及结构角误差估计值。本发明提高了标定精度,在迭代后具有更稳定的误差均值及标准差。
-
-
-
-