一种无人船虚拟目标跟踪控制系统技术方案

本发明专利技术公开了无人船虚拟目标跟踪控制系统及控制方法，其中系统包括，用于输出预置虚拟目标的位置p

【技术实现步骤摘要】
一种无人船虚拟目标跟踪控制系统
本专利技术涉及无人船控制
，尤其是一种无人船虚拟目标跟踪控制系统和控制方法。
技术介绍
当今时代，海洋资源越来越得到各国的重视。海洋机器人是人类认识海洋、开发海洋不可缺少的工具之一,亦是建设海洋强国、捍卫国家安全和实现可持续发展所必需的一种高技术手段。海洋机器人在机器人学领域属于服务机器人类，它包括智能水下机器人与智能水面机器人。无人船作为一种智能水面机器人因其具有小型化、轻量化、智能化等特点，是人们探索、开发和利用海洋的一种重要工具。无人船有很强的扩展功能，可搭载不同的仪器和作业工具去完成各种任务。在军用领域，无人船具备自主航行和超视距操作的功能，可携带多种传感器和武器系统，执行沿海智能化巡逻任务，是水面防卫、反恐、扫雷、搜救和救援的重要平台。在民用方面，无人船可应用于海洋环境监测、航道测量、水文调查、水面监视、污染源追踪等诸多领域。无人船目标跟踪的控制目标是使无人船对一个静止或移动目标点进行跟踪，这种控制方式在海上目标搜救，目标区域水文观测等场景中发挥重要作用。因此，设计一种无人船目标跟踪控制器是十分有必要的。在无人船目标跟踪控制方面，国内外学者已经取得了一些进展。现有方法包括采用滑模控制方法设计的领航-跟随编队控制器、基于多层前馈神经网络的自适应编队控制器、基于虚拟目标导引的自适应领航-跟随编队控制方法、神经网络领航-跟随编队控制器、基于神经网络观测器的饱和编队控制器等。从无人船目标跟踪来看，现有方法仍然存在以下不足：第一，现有无人船目标跟踪控制方法未考虑无人船暂态性能，在船路径跟踪控制中容易产生较大的超调和暂态振荡，导致跟踪路线不够光滑，增加了无人船运动中的风险，跟踪效果不好。第二，现有无人船目标跟踪控制系统结构较复杂，控制模块较多，产品设计和制造成本较高，不利于推广。现有控制方法制导律设计复杂，参数标定困难，鲁棒性能较差，适用面较窄，无法拓展到多无人船集群运动控制情形。
技术实现思路
本专利技术针对以上问题提出了一种无人船虚拟目标跟踪控制系统。本专利技术采用的技术手段如下：一种无人船虚拟目标跟踪控制系统，包括，参考点位置模块，用于输出预置的虚拟目标的位置pi*；参考点误差模块，用于获取预置的虚拟目标的位置pi*和无人船的实时位置pi以计算参考点误差pie；双偶极向量场模块，用于获取参考点误差pie和无人船的实时航向ψi以计算航向误差ψie；制导角速度模块，用于获取航向误差ψie以计算角速度制导信号ric并将所述角速度制导信号ric输入至受控无人船模块；以及，制导前向速度模块，用于获取参考点误差pie以计算前向速度制导信号并将所述前向速度制导信号输入至受控无人船模块。进一步地，所述计算航向误差ψie包括以下步骤：通过公式(1)计算二维双偶极向量场：其中，是由第i个虚拟点产生的向量场；pie∈R2为参考点误差，定义为κi∈R且κi≥2；且αi≠0；根据以上描述，二维双偶极向量场可通过公式(2)进行表示：通过公式(3)计算航向误差ψie：其中，ψi代表无人船在pi点的航向，代表向量场在(xi,yi)点的方向；此外，定义进一步地，通过公式(4)计算所述前向速度制导信号其中，为前向速度制导增益，为正数；为前向速度暂态调整参数，为正数用来避免暂态制导信号饱和。进一步地，通过公式(5)计算所述角速度制导信号其中，为角速度制导增益，为正数；为角速度暂态调整参数，为正数用来避免暂态制导信号饱和。一种无人船虚拟目标跟踪控制方法，包括以下步骤：获取预置的虚拟目标的位置pi*和无人船的实时位置pi计算参考点误差pie；获取无人船的实时航向ψi，并根据所述参考点误差pie和无人船的实时航向ψi计算航向误差ψie；根据所述航向误差ψie计算角速度制导信号ric，根据所述参考点误差pie计算前向速度制导信号并将所述角速度制导信号ric和前向速度制导信号输入至受控无人船模块以控制无人船航行。进一步地，所述计算航向误差ψie包括以下步骤：通过公式(1)计算二维双偶极向量场：其中，是由第i个虚拟点产生的向量场；pie∈R2为参考点误差，定义为κi∈R且κi≥2；且αi≠0；根据以上描述，二维双偶极向量场可通过公式(2)进行表示：通过公式(3)计算航向误差ψie：其中，ψi代表无人船在pi点的航向，代表向量场在(xi,yi)点的方向；此外，定义进一步地，通过公式(4)计算所述前向速度制导信号其中，为前向速度制导增益，为正数；为前向速度暂态调整参数，为正数用来避免暂态制导信号饱和。进一步地，通过公式(5)计算所述角速度制导信号其中，为角速度制导增益，为正数；为角速度暂态调整参数，为正数用来避免暂态制导信号饱和。与现有技术比较，本专利技术公开的无人船虚拟目标跟踪控制系统具有以下有益效果：第一，与现有的无人船目标跟踪制导系统相比，本专利技术考虑了无人船的暂态控制性能，使无人船能够沿着向量场场线移动，从而使得目标跟踪路线更加光滑，减小了无人船运动中的风险。第二，本专利技术采用的控制结构简单，控制模块较少，可以有效减少无人船的制造成本。与现有的无人船目标跟踪制导系统相比，本专利技术提出的目标跟踪制导系统，更方便拓展到多无人船编队控制、协同路径跟踪控制、包含控制等集群控制情形，更有利于解决多无人船多场景多任务协同控制问题，本系统具有更高的应用价值。附图说明图1是本专利技术公开的无人船虚拟目标跟踪控制系统结构图。图2是采用向量场方法的欠驱动无人船虚拟目标跟踪图。图3是采用向量场方法的欠驱动无人船虚拟目标跟踪误差图。图4是采用的虚拟目标跟踪向量场。图5是采用向量场方法的欠驱动无人船前向速度跟踪效果图。图6是采用向量场方法的欠驱动无人船角速度跟踪效果图。具体实施方式如图1所示为本专利技术公开的无人船虚拟目标跟踪控制系统，包括，参考点位置模块，用于输出预置的虚拟目标的位置pi*；参考点误差模块，用于获取预置的虚拟目标的位置pi*和无人船的实时位置pi以计算参考点误差pie；双偶极向量场模块，用于获取参考点误差pie和无人船的实时航向ψi以计算航向误差ψie；制导角速度模块，用于获取航向误差ψie以计算角速度制导信号ric并将所述角速度制导信号输入至受控无人船模块；以及，制导前向速度模块，用于获取参考点误差pie以计算前向速度制导信号并将所述前向速度制导信号输入至受控无人船模块。具体地，本专利技术公开的无人船虚拟目标跟踪控制系统，包括参考点位置模块、参考点误差模块、双偶极向量场模块、制导前向速度模块、制导角速度模块以及受控无人船；所述的参考点位置模块的输出端与参考点误差本文档来自技高网...

【技术保护点】
1.一种无人船虚拟目标跟踪控制系统，其特征在于：包括，/n参考点位置模块，用于输出预置的虚拟目标的位置p

【技术特征摘要】
1.一种无人船虚拟目标跟踪控制系统，其特征在于：包括，
参考点位置模块，用于输出预置的虚拟目标的位置pi*；
参考点误差模块，用于获取预置的虚拟目标的位置pi*和无人船的实时位置pi以计算参考点误差pie；
双偶极向量场模块，用于获取参考点误差pie和无人船的实时航向ψi以计算航向误差ψie；
制导角速度模块，用于获取航向误差ψie以计算角速度制导信号ric并将所述角速度制导信号ric输入至受控无人船模块；
以及，
制导前向速度模块，用于获取参考点误差pie以计算前向速度制导信号uic并将所述前向速度制导信号uic输入至受控无人船模块。


2.根据权利要求1所述的无人船虚拟目标跟踪控制系统，其特征在于：所述计算航向误差ψie包括以下步骤：
通过公式(1)计算二维双偶极向量场：



其中，是由第i个虚拟点产生的向量场；pie∈R2为参考点误差，定义为κi∈R且κi≥2；且αi≠0；
根据以上描述，二维双偶极向量场可通过公式(2)进行表示：



通过公式(3)计算航向误差ψie：



其中，ψi代表无人船在pi点的航向，代表向量场在(xi,yi)点的方向；此外，定义


3.根据权利要求2所述的无人船虚拟目标跟踪控制系统，其特征在于：通过公式(4)计算所述前向速度制导信号



其中，为前向速度制导增益，为正数；为前向速度暂态调整参数，为正数用来避免暂态制导信号饱和。


4.根据权利要求3所述的无人船虚拟目标跟踪控制系统，其特征在于：通过公式(5)计算所述角速度制导信号ric：



其中，为角速度制导增益，...

【专利技术属性】
技术研发人员：王丹，古楠，卢丽宇，王浩亮，刘陆，李铁山，彭周华，
申请(专利权)人：大连海事大学，
类型：发明
国别省市：辽宁;21