基于空间视线导引法的AUV三维航迹控制技术研究
2020-01-14郭亦平王益民林莉任元洲
声学与电子工程 2019年4期
关键词:设计
郭亦平 王益民 林莉 任元洲
(中船重工集团公司第七〇七研究所九江分部,九江市,333005)
水下自主无人航行器已广泛应用于海洋救助、打捞、海洋资源调查、石油开采等民用领域,并可承担扫雷、侦察、情报搜集及海洋探测等军事任务。作为AUV的核心技术之一,运动控制技术得到国内外学者和工程技术人员的广泛关注,并开展了大量的理论研究和工程实践工作。水下航迹跟踪控制是AUV的基本航行模式,主要应用于水下管网巡检、海洋资源调查等场合。高剑[1]基于级联系统理论研究了欠驱动自主无人潜航器的水平面直线航迹跟踪控制和三维直线航迹跟踪控制问题,证明了直线航迹跟踪的全局K指数稳定性。Morten Breivik、Fossen[2]基于视线导引法(Line-of-Sight,LOS)提出了三维路径跟随的制导律实现了三维航迹跟踪控制,Khac Duc Do和Jie Pan[3]利用反步自适应控制方法实现了欠驱动AUV的三维航迹跟踪控制。本文利用空间三维视线导引法,将AUV三维航迹跟踪控制转换为航向跟踪控制和纵倾角跟踪控制,实现了欠驱动AUV的三维航迹跟踪控制。
1 基于空间LOS的三维制导算法
图1所示为AUV的空间三维视线导引法示意图。图中,P为AUV的实际位置,表示期望直线航迹,由图1可知,三维直线航迹跟踪控制的目的为:

图1 AUV的3维直线航迹跟踪LOS
由图1可知,在包含期望航迹线的平面内对AUV实际航行位置进行投影,可消除横向航迹偏差,AUV的指令航向:

式中

为直线航迹线方位角。
按照空间LOS方法,为了消除航迹横向偏差,AUV需以航迹线上……
登录APP查看全文
