全驱动式自主水下航行器协同控制方法
Abstract:
本发明公开了一种全驱动式自主水下航行器(FAAUV)协同控制方法,包括以下步骤:首先建立FAAUV的二阶离散运动模型和动力学模型;其次由于每个水下机器人导航定位设备的定位误差不同,导致其拥有的航路信息具有不一致性;将航路信息视为虚拟领航者信息,其由一系列连续的航路点构成,提供一种将有限时间控制方法和一致性结合起来的有限时间一致性控制器,对FAAUV的速度和位置进行有限时间内的协同控制;每个水下机器人利用测速仪和陀螺仪测定自身的航速和运动姿态,并定时广播其自身的虚拟领航者信息和自身的速度信息。本发明计算出多个FAAUV的不同轴的驱动控制力,实现多个水下航行器在有限的时间内达到预定的编队形状。
Public/Granted literature
Patent Agency Ranking
0/0