超小型水下机器人智能定位系统

提出一种新的超小型水下机器人智能定位系统.融合短基线定位声纳、电子罗盘、X=Y倾角传感器和深度传感器组成超小型水下机器人定位的硬件系统,使用基于构件的方法开发了针对超小型水下机器人定位系统的水上控制计算机三维虚拟显示软件.使用马尔可夫自定位算法在实测定位声纳信号的间隙推算水下机器人的位置,提高定位速度,使其与姿态传感器同步.设计了定位算法有效性的测试实验,结果证明算法有效.