一种水下航行器的地形导航方法、装置、设备及存储介质

    公开(公告)号:CN118999549A

    公开(公告)日:2024-11-22

    申请号:CN202411487837.3

    申请日:2024-10-23

    Abstract: 本公开提供了一种水下航行器的地形导航方法、装置、设备及存储介质,包括:惯性导航系统基于姿态、速度信息和初始位置计算航行器的第一位置姿态数据;基于所述水深数据和姿态、速度信息计算下一时刻的第二位置姿态数据;基于第一位置姿态数据和第二位置姿态数据计算运动更新信息建立变尺度先验海底地形图;基于所述初始位置和预测的误差范围建立初始全对称多胞形,基于所述运动更新信息和所述变尺度先验海底地形图对所述初始全对称多胞形进行更新,得到量测更新全对称多胞形;基于所述量测更新全对称多胞形计算所述航行器的估计位置,基于所述估计位置对所述惯性导航系统的累计误差进行修正。

    一种水下航行器的地形导航方法、装置、设备及存储介质

    公开(公告)号:CN118999549B

    公开(公告)日:2024-12-31

    申请号:CN202411487837.3

    申请日:2024-10-23

    Abstract: 本公开提供了一种水下航行器的地形导航方法、装置、设备及存储介质,包括:惯性导航系统基于姿态、速度信息和初始位置计算航行器的第一位置姿态数据;基于所述水深数据和姿态、速度信息计算下一时刻的第二位置姿态数据;基于第一位置姿态数据和第二位置姿态数据计算运动更新信息建立变尺度先验海底地形图;基于所述初始位置和预测的误差范围建立初始全对称多胞形,基于所述运动更新信息和所述变尺度先验海底地形图对所述初始全对称多胞形进行更新,得到量测更新全对称多胞形;基于所述量测更新全对称多胞形计算所述航行器的估计位置,基于所述估计位置对所述惯性导航系统的累计误差进行修正。

Patent Agency Ranking