基于视线导引法的AUV跟踪控制方法及装置

基本信息

申请号 CN202210078947.9 申请日 -
公开(公告)号 CN114115297A 公开(公告)日 2022-03-01
申请公布号 CN114115297A 申请公布日 2022-03-01
分类号 G05D1/02(2020.01)I 分类 控制;调节;
发明人 陈浩;吴雪玲;王加荣;周翠云;朱斯涵;吴祎婕 申请(专利权)人 成都航天通信设备有限责任公司
代理机构 成都九鼎天元知识产权代理有限公司 代理人 刘世权
地址 610052四川省成都市成华区东三环二段龙潭工业园航天路19号
法律状态 -

摘要

摘要 本发明公开了一种于视线导引法的AUV跟踪控制方法及装置,该方法包括建立原点为初始位置的第一直角坐标系以及原点为观测点的第二直角坐标系,通过间隔预设时间时目标AUV在第二直角坐标系的位置信息,确定目标AUV在第一直角坐标系下的艏向角,进而根据艏向角驱动目标AUV的航行,通过控制目标AUV航行的偏向角和在第二直角坐标系下的位置信息始终在预设条件内,进而控制目标AUV在误差范围内按预设预定航迹前行。本发明通过对AUV的实时位置进行准确的定位,同时改善视线导轨法在目标相隔较远时误差比较大的问题,通过动态改变控制AUV航向时间间隔提高了系统控制效率,也提高了AUV航行控制的精确度。