-
公开(公告)号:CN115855104A
公开(公告)日:2023-03-28
申请号:CN202211494167.9
申请日:2022-11-25
Applicant: 哈尔滨工程大学 , 哈尔滨哈船智聚创新科技发展有限公司
Abstract: 本申请公开了一种组合导航滤波结果最优在线评价方法,步骤包括:获取载体坐标系相对于地心惯性坐标系的状态数据;根据状态数据确立初始姿态四元数方程;对初始姿态四元数方程进行规范化处理,得到姿态更新方程;根据状态数据得到载体位置更新方程,基于载体位置更新方程和状态数据,得到载体速度更新方程;根据姿态更新方程和载体速度更新方程,得到姿态误差方程和速度与位置误差模型;根据姿态误差模型和速度与位置误差模型,对系统驱动白噪声进行等效离散化处理,得到离散卡尔曼滤波递推模型;基于离散卡尔曼滤波递推模型得到滤波结果,并对滤波结果进行归一化处理,结合加速遗传算法优化降维指标函数,最终得出最佳降维值。
-
公开(公告)号:CN102221366B
公开(公告)日:2013-07-03
申请号:CN201110058569.X
申请日:2011-03-11
Applicant: 哈尔滨工程大学
IPC: G01C21/18
Abstract: 本发明的目的在于提供一种基于模糊变地球自转角速度的快速精对准方法,包括以下步骤:确定载体的初始位置参数,采集加速度计和陀螺仪输出,确定粗略的初始姿态矩阵,根据计算地球自转角速度进行卡尔曼滤波一步迭代计算,确定精对准时间,判断是否精对准是否结束,若结束则采用卡尔曼滤波技术估计出的失准角,并用失准角来修正系统的捷联姿态矩阵,完成精确初始对准,若未结束则返回进行修正直至精对准结束,之后同样采用卡尔曼滤波技术估计出的失准角,并用失准角来修正系统的捷联姿态矩阵,完成精确初始对准。本发明不需要增加任何外观测设备,无需提供辅助位置转台,工程实现容易,有效提高了捷联惯性导航系统的精对准的快速性。
-
公开(公告)号:CN115371705B
公开(公告)日:2025-05-09
申请号:CN202211056699.4
申请日:2022-08-31
Applicant: 哈尔滨工程大学
Abstract: 本发明属于非理想条件下的导航器件标定技术领域,具体涉及一种基于特殊正交群和鲁棒不变扩展卡尔曼滤波的DVL标定方法。本发明通过李群空间到李代数空间的指数映射,得到了线性的误差方程,可以更准确的刻画误差传播规律,避免非线性条件下不准确的雅各比矩阵对滤波估计的影响。本发明通过引入统计相似度量李群,设计鲁棒滤波器,抑制了测量离群点对标定精度的影响,可以更准确的输出SINS和DVL间的安装偏差角及DVL的刻度系数误差。
-
公开(公告)号:CN115307631A
公开(公告)日:2022-11-08
申请号:CN202211060602.7
申请日:2022-08-31
Applicant: 哈尔滨工程大学
Abstract: 本发明属于组合导航技术领域,具体涉及一种基于地球坐标系和右群状态误差定义的SINS/USBL组合导航方法。本发明利用地球坐标系下的机械编排,使得导航系统具备无切换全球导航能力;利用李群理论定义新的误差并推导相应的误差模型,使得在较大的初始失准角的情况下,采用线性模型和线性滤波器就可以对大初始导航误差进行准确估计,并且在任意载体机动条件下都可以保证姿态误差、速度误差和位置误差的可观测性。本发明通过建立虚拟观测方程来解决在大初始失准角条件下,由于USBL的数据更新频率低而导致的严重降低收敛速度及估计精度的问题。
-
公开(公告)号:CN102221366A
公开(公告)日:2011-10-19
申请号:CN201110058569.X
申请日:2011-03-11
Applicant: 哈尔滨工程大学
IPC: G01C21/18
Abstract: 本发明的目的在于提供一种基于模糊变地球自转角速度的快速精对准方法,包括以下步骤:确定载体的初始位置参数,采集加速度计和陀螺仪输出,确定粗略的初始姿态矩阵,根据计算地球自转角速度进行卡尔曼滤波一步迭代计算,确定精对准时间,判断是否精对准是否结束,若结束则采用卡尔曼滤波技术估计出的失准角,并用失准角来修正系统的捷联姿态矩阵,完成精确初始对准,若未结束则返回进行修正直至精对准结束,之后同样采用卡尔曼滤波技术估计出的失准角,并用失准角来修正系统的捷联姿态矩阵,完成精确初始对准。本发明不需要增加任何外观测设备,无需提供辅助位置转台,工程实现容易,有效提高了捷联惯性导航系统的精对准的快速性。
-
公开(公告)号:CN115371705A
公开(公告)日:2022-11-22
申请号:CN202211056699.4
申请日:2022-08-31
Applicant: 哈尔滨工程大学
Abstract: 本发明属于非理想条件下的导航器件标定技术领域,具体涉及一种基于特殊正交群和鲁棒不变扩展卡尔曼滤波的DVL标定方法。本发明通过李群空间到李代数空间的指数映射,得到了线性的误差方程,可以更准确的刻画误差传播规律,避免非线性条件下不准确的雅各比矩阵对滤波估计的影响。本发明通过引入统计相似度量李群,设计鲁棒滤波器,抑制了测量离群点对标定精度的影响,可以更准确的输出SINS和DVL间的安装偏差角及DVL的刻度系数误差。
-
-
-
-
-