一种水面/水下航行器与定位设备之间的航向角偏差估计方法
摘要:
本发明公开一种水面/水下航行器与定位设备间的航向角偏差估计方法,首先航行器在水面或水下进行定向直线航行,同时通过自身定位和定位设备定位,获得大地东北向坐标下航行器的离散定位点数据;然后采用数据拟合将航行器自身运动轨迹点和定位设备测试数据进行直线拟合,两条直线间的角度差即为航行器和定位设备的航向角偏差值;对同航向进行多次测试,并将多次数据求平均,即可获得该方向下的航向角偏差;然后控制航行器朝别的不同方向进行直线航行,重复上述步骤,获得其它方向下的航向角的偏差,若多个方向下的航向角偏差的相对误差小于5%,则再次求平均。该方法操作便捷,定位设备获取的定位数据更加精准,适用于各种不同的航行器航行环境。
0/0