一种水下机器人传感器安装偏差估计方法

摘要

本发明公开了一种水下机器人传感器安装偏差估计方法，通过建立水面航行状态机器人航行位姿的因子图模型，基于卫星定位模块的真值反馈，利用非线性优化方法，实现水下机器人艏向测量的常值线性加性误差α和水下机器人前进速度、横移速度的非线性乘性误差cos(β)和sin(β)的估计，补偿航位推算模块与卫星定位模块间的位置偏差。实现传感器安装偏差的鲁棒估计，提高航位推算模块的计算精度，进而提高水下机器人的定位精度。减少机器人出水校准次数，提高作业效率，满足长时间水下航行的需求。