-
公开(公告)号:CN113324546A
公开(公告)日:2021-08-31
申请号:CN202110563429.1
申请日:2021-05-24
Applicant: 哈尔滨工程大学
Abstract: 本发明提供一种罗经失效下的多潜航器协同定位自适应调节鲁棒滤波方法,包括以下步骤:步骤一:建立航向角未知的多潜航器协同定位模型;步骤二:计算航向角输入未知的待校正状态估计值;步骤三:通过自适应更新量测噪声方差矩阵削弱野值噪声对状态估计的影响;步骤四:构建核带宽度自适应调节因子;步骤五:计算航向估计值与校正后的位置向量估计值。本发明在保证不扩展状态维数的基础上,实现航向角未知伴随非高斯噪声条件下的准确定位。本发明可用于非理想条件下的多潜航器协同定位领域。
-
公开(公告)号:CN111323050B
公开(公告)日:2021-06-18
申请号:CN202010196612.8
申请日:2020-03-19
Applicant: 哈尔滨工程大学
Abstract: 本发明公开了一种捷联惯导和多普勒组合系统标定方法,包括:步骤一:构建捷联惯导/GPS组合系统,并计算组合导航系统在载体系下速度,同步获取多普勒输出的多普勒坐标系下速度。步骤二:构建捷联惯导/多普勒大安装偏差角及刻度系数误差的模型。步骤三:构建捷联惯导/多普勒安装偏差角及刻度系数误差的相关系统方程及量测方程。步骤四:利用卡尔曼滤波对安装偏差状态量及刻度系数误差进行估计,完成标定任务。本发明适用于SINS/DVL组合导航系统任意未知安装偏差角条件下的标定方法,具有较高的工程应用价值,利用SINS/GPS组合导航的速度作为参考速度,同时利用卡尔曼滤波技术进行状态估计,标定结果精度高。
-
公开(公告)号:CN111323049B
公开(公告)日:2021-04-20
申请号:CN202010196578.4
申请日:2020-03-19
Applicant: 哈尔滨工程大学
IPC: G01C25/00
Abstract: 本发明公开了一种粒子群算法的粗对准方法,包括:步骤一:建立多矢量定姿模型,求解水平姿态;步骤二:建立粒子群算法模型;步骤三:构建粒子群适应度函数;步骤四:粒子早熟收敛问题的解决;步骤五:进行载体坐标系对导航坐标系姿态矩阵的更新;本发明充分利用惯性系对准算法水平姿态收敛较快的特点,极大降低了构造粒子群算法适应度函数的难度。本发明利用粒子群算法的快速估计能力,将粒子群算法应用到惯性系的粗对准之中,极大缩短了摇摆基座的对准时间。
-
公开(公告)号:CN111323050A
公开(公告)日:2020-06-23
申请号:CN202010196612.8
申请日:2020-03-19
Applicant: 哈尔滨工程大学
Abstract: 本发明公开了一种捷联惯导和多普勒组合系统标定方法,包括:步骤一:构建捷联惯导/GPS组合系统,并计算组合导航系统在载体系下速度,同步获取多普勒输出的多普勒坐标系下速度。步骤二:构建捷联惯导/多普勒大安装偏差角及刻度系数误差的模型。步骤三:构建捷联惯导/多普勒安装偏差角及刻度系数误差的相关系统方程及量测方程。步骤四:利用卡尔曼滤波对安装偏差状态量及刻度系数误差进行估计,完成标定任务。本发明适用于SINS/DVL组合导航系统任意未知安装偏差角条件下的标定方法,具有较高的工程应用价值,利用SINS/GPS组合导航的速度作为参考速度,同时利用卡尔曼滤波技术进行状态估计,标定结果精度高。
-
公开(公告)号:CN116680500B
公开(公告)日:2024-03-22
申请号:CN202310690292.5
申请日:2023-06-12
Applicant: 哈尔滨工程大学
Abstract: 本发明公开了水下航行器在非高斯噪声干扰下的位置估计方法及系统,所述方法包括以下步骤:根据获取的水下航行器的位置数据、速度数据与航向数据,构建协同定位系统状态空间模型;在得到基于线性化误差补偿的优化量测方程的基础上,构建增广状态模型;利用增广状态模型,基于student'st核函数和最小误差熵准则,构建代价函数;基于代价函数,求得后验状态估计的加权最小二乘表达形式;基于后验状态估计的加权最小二乘表达形式,使用矩阵求逆引理得到后验状态估计及相应的估计误差协方差矩阵的最终表达形式,完成水下航行器的位置估计。本发明能够有效削弱非高斯噪声对位置估计的影响,提高水下航行器在非理想作业环境中的定位精度。
-
公开(公告)号:CN116858286A
公开(公告)日:2023-10-10
申请号:CN202310821020.4
申请日:2023-07-06
Applicant: 哈尔滨工程大学
Abstract: 本发明公开了一种基于特殊欧式群和地球坐标系的线性传递对准方法,包括:将主惯性导航系统的导航信息传递给子惯性导航系统作为初始导航信息,其中所述初始导航信息包括初始姿态、初始速度和初始位置;子惯性导航系统通过初始导航信息进行导航解算,并引入李群理论,构建误差向量,获取传递对准误差和传递对准误差状态模型;基于主惯性导航系统的导航信息构建误差观测模型,采用卡尔曼滤波器对所述传递对准误差进行误差估计,并根据误差定义对所述子惯性导航系统进行反馈校正,获得所述子惯性导航系统准确的姿态和速度,完成传递对准。本发明具有计算量小、无数学奇异点、具备全球导航能力等优点。
-
公开(公告)号:CN115031727B
公开(公告)日:2023-06-20
申请号:CN202210344869.2
申请日:2022-03-31
Applicant: 哈尔滨工程大学
Abstract: 本发明提供一种基于状态变换的多普勒辅助捷联惯导系统初始对准方法,具体包括:步骤一:构建基于载体系速度误差的捷联惯导系统误差方程。步骤二:构建基于状态变换的多普勒测速仪辅助捷联惯性导航系统初始对准的卡尔曼滤波模型。步骤三:利用卡尔曼滤波器对SINS初始误差状态进行估计,完成对准任务。本发明是一种适用于初始大方位失准角条件下的SINS/DVL组合导航系统初始对准方法,具有较高的工程应用价值。本发明利用载体系速度误差模型,并构建了SINS和DVL安装偏差角模型,模型精度高,实验证明所提方法对准精度高。
-
公开(公告)号:CN115307631A
公开(公告)日:2022-11-08
申请号:CN202211060602.7
申请日:2022-08-31
Applicant: 哈尔滨工程大学
Abstract: 本发明属于组合导航技术领域,具体涉及一种基于地球坐标系和右群状态误差定义的SINS/USBL组合导航方法。本发明利用地球坐标系下的机械编排,使得导航系统具备无切换全球导航能力;利用李群理论定义新的误差并推导相应的误差模型,使得在较大的初始失准角的情况下,采用线性模型和线性滤波器就可以对大初始导航误差进行准确估计,并且在任意载体机动条件下都可以保证姿态误差、速度误差和位置误差的可观测性。本发明通过建立虚拟观测方程来解决在大初始失准角条件下,由于USBL的数据更新频率低而导致的严重降低收敛速度及估计精度的问题。
-
-
公开(公告)号:CN109974706A
公开(公告)日:2019-07-05
申请号:CN201910177062.2
申请日:2019-03-08
Applicant: 哈尔滨工程大学
IPC: G01C21/20
Abstract: 本发明属于水下航行器导航研究领域,具体涉及一种基于双运动模型的主从式多AUV协同导航方法,包括以下步骤:领航AUV与跟随AUV进行水声测距,同时领航AUV将自身位置和速度信息广播发送给跟随AUV;建立跟随AUV与领航AUV间的相对运动状态空间模型;通过CKF估计跟随AUV与领航AUV的速度分量差值;建立双领航模式的多AUV协同导航状态空间模型;本发明提出将AUV相对运动状态空间模型与双领航模式的多AUV协同导航状态空间模型相结合,保障了多AUV协同导航系统的协同定位性能;本发明跟随AUV不需装备惯性导航设备和DVL,从而降低AUV系统配置的复杂性且节约了跟随AUV的内部空间、减轻重量。
-
-
-
-
-
-
-
-
-