一种无人水面艇折线路径跟踪控制系统及方法技术方案

本发明专利技术公开了一种无人水面艇折线路径跟踪控制系统及方法，控制系统包括数据采集单元、数据处理单元、动力控制单元，所述数据采集单元获取无人水面艇的经纬度信息和艏向角并输出给数据处理单元；所述数据处理单元包括路径跟踪算法模块和运动控制算法模块，所述路径跟踪算法模块将计算出无人水面艇与预设路径之间的偏差，并将偏差输出给运动控制算法模块，所述运动控制算法模块根据无人水面艇与预设路径之间的偏差得出控制命令，并将控制命令传输给动力控制单元；所述动力控制单元控制无人艇的运动。本发明专利技术不但能实现欠驱动无人水面艇的直线路径跟踪，而且还能实现折线路径跟踪，使得无人水面艇更能满足航海实践中的路径跟踪要求。

【技术实现步骤摘要】
一种无人水面艇折线路径跟踪控制系统及方法
本专利技术属于智能无人艇
，涉及一种无人水面艇折线路径跟踪控制系统及方法。
技术介绍
无人水面艇是基于远程通信技术和自动控制技术实现的一种自动化无人操作船艇，它可以代替人类在复杂海洋环境中执行各种任务。无人水面艇具有机动性强、便于隐蔽、可搭载在其他舰艇上等优点，可以应用于搜索、救援、监视、侦察、探测、海洋测绘和地质取样等。路径跟踪是实现无人水面艇的自动化与智能化的关键技术之一，该问题的实现对无人水面艇技术的发展有着重要的意义。过去几年，无人水面艇的跟踪控制问题一直备受相关领域研究团体的广泛关注。如公开号为CN103760902A(公开日为2014年4月30日)的专利公开了一种基于模糊控制的无人水面艇直线路径跟踪方法，无人水面艇的起点不必在目标轨迹上，可任意初始航向角，能跟踪任意直线路径，并且避免了PID算法出现的大超调想象和大迂回现象，但是该专利提出的方法未考虑无人水面艇输入饱和的情况。Z.Zheng等(Z.ZhengandL.Sun,"Pathfollowingcontrolformarinesurfacevesselwithuncertaintiesandinputsaturation,"Neurocomputing)基于反步自适应径向基函数神经网络，提出了一中鲁棒自适应的无人水面艇路径跟踪控制方法，该方法未考虑对更加实用的不规则折线路径的跟踪。
技术实现思路
本专利技术所要解决的技术问题在于针对上述现有技术存在的不足提供一种不但能实现无人水面艇的直线路径跟踪，而且还能实现折线路径跟踪，使得无人水面艇更能满足航海实践中的路径跟踪要求的无人水面艇折线路径跟踪控制系统及方法。本专利技术所采用的技术方案为：一种无人水面艇折线路径跟踪控制系统，其特征在于：包括数据采集单元、数据处理单元、动力控制单元，所述数据采集单元包括GPS接收模块和地磁感应模块，所述GPS接收模块和地磁感应模块分别获取无人水面艇的经纬度信息和艏向角并输出给数据处理单元；所述数据处理单元包括路径跟踪算法模块和运动控制算法模块，所述路径跟踪算法模块将计算出无人水面艇与预设路径之间的偏差，并将偏差输出给运动控制算法模块，所述运动控制算法模块根据无人水面艇与预设路径之间的偏差得出控制命令，并将控制命令传输给动力控制单元；所述动力控制单元控制无人艇的运动。按上述技术方案，所述运动控制算法模块可以根据无人水面艇和预设路径之间的偏差，判断无人水面艇的运动状态调整方式，并得出控制命令输出给动力控制模块。按上述技术方案，所述路径跟踪算法模块包括直线路径跟踪算法和折线路径跟踪算法，所述直线路径跟踪策略以carrotchasing(基于虚拟目标的路径跟踪方法)直线路径跟踪算法为基础，在预设路径中加入动态变化的虚拟目标点，控制无人水面艇朝虚拟目标点靠近，并且在考虑输入饱和和时变干扰的前提下设计恰当的虚拟目标点的更新规则；所述折线路径跟踪算法在无人水面艇跟踪到一段直线路径尾端时，若虚拟目标点不在这段直线路径上，则无人水面艇开始跟踪下一段直线路径上。按上述技术方案，所述动力控制单元包括舵机控制模块、伺服舵机和喷水推进器，所述舵机控制模块接收数据处理单元输出的控制命令，产生电信号发送给伺服舵机和喷水推进器，所述伺服舵机受电信号激励转动，带动无人水面艇的喷水嘴摆动，进而使无人水面艇转向，所述喷水推进器受电信号激励快速运转，为无人水面艇提供动力。本专利技术还提供了一种无人水面艇折线路径跟踪控制方法，其特征在于：包括如下步骤：S1、采用数据采集单元获取无人水面艇的经纬度信息和艏向角信息，数据采集单元包括GPS接收模块和地磁感应模块；S2、采用路径跟踪算法模块计算出无人水面艇与预设路径之间的偏差；S3、运动控制算法模块根据无人水面艇与预设路径之间的偏差，判断无人水面艇的运动状态调整方式，并得出控制命令输出给动力控制模块；S4、动力控制模块控制无人水面艇的航向。按上述技术方案，所述路径跟踪算法模块包括直线路径跟踪算法和折线路径跟踪算法，所述直线路径跟踪策略以carrotchasing(基于虚拟目标的路径跟踪方法)直线路径跟踪算法为基础，在预设路径中加入动态变化的虚拟目标点，控制无人水面艇朝虚拟目标点靠近，虚拟目标点随无人水面艇的位置变化而不断地按照规则更新；所述折线路径跟踪算法在无人水面艇跟踪到一段直线路径尾端时，若虚拟目标点不在这段直线路径上，则无人水面艇开始跟踪下一段直线路径上。本专利技术所取得的有益效果为：本专利技术的有益效果是：1、本专利技术不但能实现欠驱动无人水面艇的直线路径跟踪，而且还能实现折线路径跟踪，使得无人水面艇更能满足航海实践中的路径跟踪要求；2、综合考虑无人水面艇的操纵性能与路径跟踪算法的特点，通过集成制导、航行与控制以实现欠驱动无人水面艇的路径跟踪问题；3、折线路径跟踪策略可以使无人水面艇在转向时提前打舵，避免了转向时出现的大迂回现象；4、本专利技术提供的方法考虑了输入饱和和时变干扰情况，提高了无人水面艇跟踪路径过程中的安全性和抗干扰性。附图说明图1为本专利技术的原理框图。图2为喷水推进器机械结构图。图3为无人水面艇三自由度模型图。图4为直线路径跟踪图。图5为折线路径跟踪策略图。图6为无人水面艇模型原理图。图7为仿真实验跟踪轨迹图。图8为仿真实验轨迹偏差图。具体实施方式下面结合附图对本专利技术作进一步说明。如图1所示，本实施例提供了一种无人水面艇折线路径跟踪控制系统，包括数据采集单元、数据处理单元、动力控制单元，所述数据采集单元包括GPS接收模块和地磁感应模块，所述GPS接收模块和地磁感应模块分别获取无人水面艇的经纬度信息和艏向角并输出给数据处理单元；所述数据处理单元包括路径跟踪算法模块和运动控制算法模块，所述路径跟踪算法模块将计算出无人水面艇与预设路径之间的偏差，并将偏差输出给运动控制算法模块，所述运动控制算法模块根据无人水面艇与预设路径之间的偏差得出控制命令，并将控制命令传输给动力控制单元；所述路径跟踪算法模块包括直线路径跟踪算法和折线路径跟踪算法，所述直线路径跟踪策略以carrotchasing直线路径跟踪算法为基础，在预设路径中加入动态变化的虚拟目标点，控制无人水面艇朝虚拟目标点靠近，并且在考虑输入饱和和时变干扰的前提下设计恰当的虚拟目标点的更新规则；所述折线路径跟踪算法在无人水面艇跟踪到一段直线路径尾端时，若虚拟目标点不在这段直线路径上，则无人水面艇开始跟踪下一段直线路径上。所述运动控制算法模块可以根据无人水面艇和预设路径之间的偏差，判断无人水面艇的运动状态调整方式，并得出控制命令输出给动力控制模块。所述动力控制单元包括舵机控制模块、伺服舵机和喷水推进器，所述舵机控制模块接收数据处理单元输出的控制命令，产生电信号发送给伺服舵机和喷水推进器，所述伺服舵机受电信号激励转动，带动无人水面艇的喷水嘴摆动，进而使无人水面艇转向，所述喷水推进器受电信号激励快速运转，为无人水面艇提供动力。本专利技术还提供了一种无人水面艇折线路径跟踪控制方法，其特征在于：包括如下步骤：S1、采用数据采集单元获取无人水面艇的经纬度信息和艏向角信息，数据采集单元包括GPS接收模块和地磁感应模块；S2、采用路径跟踪算法模块计算出无人水面艇与预设路径之间的偏差；S3本文档来自技高网...

【技术保护点】
1.一种无人水面艇折线路径跟踪控制系统，其特征在于：包括数据采集单元、数据处理单元、动力控制单元，所述数据采集单元包括GPS接收模块和地磁感应模块，所述GPS接收模块和地磁感应模块分别获取无人水面艇的经纬度信息和艏向角并输出给数据处理单元；所述数据处理单元包括路径跟踪算法模块和运动控制算法模块，所述路径跟踪算法模块将计算出无人水面艇与预设路径之间的偏差，并将偏差输出给运动控制算法模块，所述运动控制算法模块根据无人水面艇与预设路径之间的偏差得出控制命令，并将控制命令传输给动力控制单元；所述动力控制单元控制无人艇的运动。

【技术特征摘要】
1.一种无人水面艇折线路径跟踪控制系统，其特征在于：包括数据采集单元、数据处理单元、动力控制单元，所述数据采集单元包括GPS接收模块和地磁感应模块，所述GPS接收模块和地磁感应模块分别获取无人水面艇的经纬度信息和艏向角并输出给数据处理单元；所述数据处理单元包括路径跟踪算法模块和运动控制算法模块，所述路径跟踪算法模块将计算出无人水面艇与预设路径之间的偏差，并将偏差输出给运动控制算法模块，所述运动控制算法模块根据无人水面艇与预设路径之间的偏差得出控制命令，并将控制命令传输给动力控制单元；所述动力控制单元控制无人艇的运动。2.根据权利要求1所述的无人水面艇折线路径跟踪控制系统，其特征在于：所述运动控制算法模块可以根据无人水面艇和预设路径之间的偏差，判断无人水面艇的运动状态调整方式，并得出控制命令输出给动力控制模块。3.根据权利要求1或2所述的无人水面艇折线路径跟踪控制系统，其特征在于：所述路径跟踪算法模块包括直线路径跟踪算法和折线路径跟踪算法，所述直线路径跟踪算法是在预设路径中加入动态变化的虚拟目标点，控制无人水面艇朝虚拟目标点靠近，虚拟目标点随无人水面艇的位置变化而不断地按照规则更新；所述折线路径跟踪算法在无人水面艇跟踪到一段直线路径尾端时，若虚拟目标点不在这段直线路径上，则无人水面艇开始跟踪下一段直线路径上。4.根据权利要求...

【专利技术属性】
技术研发人员：马勇，赵玉蛟，
申请(专利权)人：武汉理工大学，
类型：发明
国别省市：湖北,42