Invention Grant
- Patent Title: 一种DVL辅助SINS鲁棒行进间初始对准方法
-
Application No.: CN201811075323.1Application Date: 2018-09-14
-
Publication No.: CN109141475BPublication Date: 2020-06-05
- Inventor: 徐祥 , 徐大诚
- Applicant: 苏州大学
- Applicant Address: 江苏省苏州市相城区济学路8号
- Assignee: 苏州大学
- Current Assignee: 北京唯实深蓝科技有限公司
- Current Assignee Address: 江苏省苏州市相城区济学路8号
- Agency: 苏州市中南伟业知识产权代理事务所
- Agent 冯瑞; 杨慧林
- Main IPC: G01C25/00
- IPC: G01C25/00
Abstract:
本发明公开了一种DVL辅助SINS鲁棒行进间初始对准方法,包括以下步骤,步骤(1):获取传感器实时数据;步骤(2):建立矢量视运动参数方程;步骤(3):在建立参数方程的基础上,利用自适应鲁棒卡尔曼滤波估计参数矩阵;步骤(4):建立基于估计参数的重构矢量;步骤(5):利用最优基四元数姿态确定方法,并计算确定姿态与真实姿态之间的误差角;步骤(6):初始对准过程运行时间为M,获取实时数据的时刻为k,若k=M,则输出初始对准结果,完成初始对准过程,若k
Public/Granted literature
- CN109141475A 一种DVL辅助SINS鲁棒行进间初始对准方法 Public/Granted day:2019-01-04
Information query