• 专利标题: 自主水下航行器多普勒计程仪安装误差的校正方法
  • 专利标题(英): Correcting method of installation errors of doppler log of autonomous underwater vehicle (AUV)
  • 申请号: CN201310689696.9
    申请日: 2013-12-14
  • 公开(公告)号: CN103697910A
    公开(公告)日: 2014-04-02
  • 发明人: 李建龙孙晨徐文徐元欣
  • 申请人: 浙江大学
  • 申请人地址: 浙江省杭州市西湖区浙大路38号
  • 专利权人: 浙江大学
  • 当前专利权人: 浙江大学
  • 当前专利权人地址: 浙江省杭州市西湖区浙大路38号
  • 代理机构: 杭州求是专利事务所有限公司
  • 代理商 林松海
  • 主分类号: G01C25/00
  • IPC分类号: G01C25/00
自主水下航行器多普勒计程仪安装误差的校正方法
摘要:
本发明公开自主水下航行器多普勒计程仪安装误差的校正方法。1)数据采集:获取AUV在水面时的东北向位置信息、深度信息、速度信息、姿态信息;2)滤波估计:根据带误差校正的DVL航位推算模型,取AUV三维位置信息及DVL三维安装偏角为系统状态向量,DVL测得速度信息及姿态传感器测得姿态信息为系统输入向量,取AUV三维位置信息为测量向量,建立离散时间系统状态方程和测量方程;采用改进的平方根容积卡尔曼滤波进行滤波估计,得到DVL安装偏角的估计值;3)误差校正:根据安装偏角的估计值得到DVL安装误差校正矩阵。本发明操作简单,无需外部设备辅助,可有效估计出DVL的三维安装偏差角,从而消除DVL安装误差对AUV导航精度的影响,具有很强的实用价值。
0/0