发明公开
- 专利标题: 一种基于机动约束和增量滤波的SINS自辅助导航方法
-
申请号: CN202210617248.7申请日: 2022-06-01
-
公开(公告)号: CN115060267A公开(公告)日: 2022-09-16
- 发明人: 吴小强 , 刘锡祥 , 王子璇 , 黄永江 , 罗浩 , 程相智
- 申请人: 东南大学
- 申请人地址: 江苏省南京市玄武区四牌楼2号
- 专利权人: 东南大学
- 当前专利权人: 东南大学
- 当前专利权人地址: 江苏省南京市玄武区四牌楼2号
- 代理机构: 南京众联专利代理有限公司
- 代理商 蒋昱
- 主分类号: G01C21/20
- IPC分类号: G01C21/20 ; G01C21/16
摘要:
一种基于机动约束和增量滤波的SINS自辅助导航方法,1驱动AUV做水平方向上的周期性稳态运动,在向指定方向机动的同时,为导航坐标系下的速度添加高频分量;2获取安装在水下AUV上的惯性传感器实时数据;3将步骤2中获得的导航坐标系下的水平速度输入至高通滤波器中,获得一组剔除了低频误差分量的导航坐标系下的水平速度量;4建立卡尔曼滤波器,将步骤3中获得的速度分量的增量作为卡尔曼滤波器的量测量输入至卡尔曼滤波器中,将获得的速度误差量进行补偿,获得自辅助补偿后的高精度定位值。本发明有效解决了SINS定位误差随时间发散的问题,与纯SINS解算的定位方案相比,可以将速度误差限制在一个很小的范围内,对定位精度有较大的提升。
IPC分类: