一种基于机动约束和增量滤波的SINS自辅助导航方法
摘要:
一种基于机动约束和增量滤波的SINS自辅助导航方法,1驱动AUV做水平方向上的周期性稳态运动,在向指定方向机动的同时,为导航坐标系下的速度添加高频分量;2获取安装在水下AUV上的惯性传感器实时数据;3将步骤2中获得的导航坐标系下的水平速度输入至高通滤波器中,获得一组剔除了低频误差分量的导航坐标系下的水平速度量;4建立卡尔曼滤波器,将步骤3中获得的速度分量的增量作为卡尔曼滤波器的量测量输入至卡尔曼滤波器中,将获得的速度误差量进行补偿,获得自辅助补偿后的高精度定位值。本发明有效解决了SINS定位误差随时间发散的问题,与纯SINS解算的定位方案相比,可以将速度误差限制在一个很小的范围内,对定位精度有较大的提升。
0/0