一种引入径向速度的SINS/USBL松组合导航定位方法

摘要

一种引入径向速度的SINS/USBL松组合导航定位方法，它属于组合导航及水声定位技术领域。本发明解决了传统SINS/USBL松组合方法忽略基元与信标之间径向速度的测量导致SINS速度误差的估计精度受限，以及在USBL定位无效时，依靠SINS单独完成导航任务带来的导航误差累积的问题。本发明将USBL的径向速度测量信息引入SINS/USBL松组合中，能够在USBL定位无效时，使SINS保持组合工作方式，减小SINS的误差积累；通过将径向速度作为滤波观测量，能够提高SINS/USBL松组合滤波系统对SINS速度误差的估计精度，从而改善整体导航性能。本发明可以应用于组合导航及水声定位领域。