CN110333723B - 一种基于双通信设备的无人艇协同编队方法 - Google Patents
一种基于双通信设备的无人艇协同编队方法 Download PDFInfo
- Publication number
- CN110333723B CN110333723B CN201910646220.4A CN201910646220A CN110333723B CN 110333723 B CN110333723 B CN 110333723B CN 201910646220 A CN201910646220 A CN 201910646220A CN 110333723 B CN110333723 B CN 110333723B
- Authority
- CN
- China
- Prior art keywords
- boat
- leader
- following
- coordinate system
- current
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000004891 communication Methods 0.000 title claims abstract description 49
- 230000009977 dual effect Effects 0.000 title claims abstract description 27
- 230000015572 biosynthetic process Effects 0.000 title claims abstract description 25
- 238000000034 method Methods 0.000 title claims abstract description 13
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims abstract description 5
- 238000005755 formation reaction Methods 0.000 description 17
- 238000005457 optimization Methods 0.000 description 4
- 238000013139 quantization Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000002730 additional effect Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000007849 functional defect Effects 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000010408 sweeping Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/0265—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric the criterion being a learning criterion
- G05B13/0275—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric the criterion being a learning criterion using fuzzy logic only
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/0206—Control of position or course in two dimensions specially adapted to water vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Artificial Intelligence (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Software Systems (AREA)
- General Physics & Mathematics (AREA)
- Fuzzy Systems (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Mathematical Physics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Health & Medical Sciences (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种基于双通信设备的无人艇协同编队方法,包括以下步骤:S1,将无人艇所在的水面区域当成二维平面,建立固定坐标系XOY和领导艇坐标系xoy;S2,设定跟随艇在领导艇坐标系下的目标位置和基于双通信设备计算跟随艇在领导艇坐标系下相对于领导艇的当前位置;S3,控制跟随艇的航行方向和航行速度;S4,判断跟随艇是否到达在领导艇坐标系下的目标位置以及领导艇是否停止运动,若否则继续执行步骤S2,若是则结束,完成无人艇协同编队。本发明跟随艇能够自主与领导艇形成设定的编队,可智能控制无人艇,具有安全、稳定、可靠的优点。
Description
技术领域
本发明属于无人艇控制技术领域,具体的说是一种基于双通信设备的领导艇-跟随艇形式下的协同编队方法。
背景技术
无人艇是一种具有自主规划、自主航行能力,并可自主完成环境感知、目标探测等任务的小型水面平台,可承担情报搜集、监视侦察、扫雷、反潜、精确打击、搜捕、水文地理勘察、反恐、中继通信等功能。无人艇根据使命的不同,可采用多种不同的模块,搭载不同的传感器或执行设备,执行任务也显示出多样性。
然而在未来战争中仅靠单艘无人艇自主作战难以适应复杂的战场环境,而具备有协同策略的无人艇集群编队能更好的完成任务。因为多艘无人艇构成的无人艇集群能够减小整体航行的阻力,使无人艇集群能够在执行复杂任务、多任务和复杂环境下具有相对大的活动范围,更大的任务完成概率,以及更高的保障性。多艘无人艇协同作业,不仅克服了单艘无人艇在功能上的缺陷,而且能产生1加1大于2的效果。很大程度上,提高了作业效率和作业范围。因此,多无人艇协同作业是必然的趋势,在军民应用领域都有很好的应用前景。但是无人艇集群执行各种不同的任务时,不同队形不仅会影响该任务的执行效果,而且会对任务链中的下一个任务产生额外的作用。特别是在同一区域执行不同的任务时,及时的队形变换可以使无人艇安全性提高,还能提升任务的执行效率。其次,对于一些突发的、额外的事件,队形变换有时是必须的、重要的。然而各任务的队形优化以及各任务优化与任务整体优化的关系,对队形控制存在着不可忽略的影响。因此各种不同的任务对无人艇集群队形的影响成为不可忽略的关键问题之一。
发明内容
为了解决上述的技术问题,本发明提供了一种基于双通信设备的无人艇协同编队方法。
为了解决上述技术问题,本发明采取以下技术方案:
一种基于双通信设备的无人艇协同编队方法,包括以下步骤:
S1,将无人艇所在的水面区域当成二维平面,建立固定坐标系XOY和领导艇坐标系xoy;
S2,设定跟随艇在领导艇坐标系下的目标位置和基于双通信设备计算跟随艇在领导艇坐标系下相对于领导艇的当前位置,领导艇上设有通信设备,跟随艇的头部和尾部各设一个通信设备形成双通信设备;
S3,控制跟随艇的航行方向和航行速度;
S4,判断跟随艇是否到达在领导艇坐标系下的目标位置以及领导艇是否停止运动,若否则继续执行步骤S2,若是则结束,完成无人艇协同编队。
所述领导艇坐标系的x轴平行于固定坐标系的X轴,领导艇坐标系的y轴平行于固定坐标系的Y轴,随领导艇坐标系的原点o为领导艇的中心。
所述步骤S2具体包括:
S201,将跟随艇在领导艇坐标系下的目标位置发送给相应的无人艇;
S202,基于双通信设备的协同定位计算跟随艇相对于领导艇的当前相对距离:
其中,L[i]为第i艘跟随艇相对于领导艇的当前相对距离,为领导艇上的通信设备到跟随艇i上的头部和尾部的通信设备的距离,c为双通信设备的传播速度,为跟随艇i上的头部和尾部的通信设备接收到领导艇的通信设备信号的时间,t0为领导艇的双通信设备发送信号的时间,d为无人艇的机身长度,c是指信号传播速度;
S203,基于双通信设备的协同定位计算跟随艇相对于领导艇的当前相对方位角:
其中,θ[i]为第i艘跟随艇相对于领导艇的当前相对方位角;
S204,获取跟随艇i的当前航向角,依据跟随艇相对于领导艇的当前相对距离、当前相对方位角和跟随艇的当前航向角计算跟随艇在领导艇坐标系下的当前位置坐标(x[i],y[i])。
所述步骤S3具体包括:
S301,计算当前时刻跟随艇i的当前位置到目标位置的距离以及期望航向:
S302,设计模糊控制器控制跟随艇的航行方向,该模糊控制器的输入为航向误差e和偏航率r,输出为实际航行方向;
本发明跟随艇能够自主与领导艇形成设定的编队,可智能控制无人艇,具有安全、稳定、可靠的优点。
附图说明
附图1为本发明流程示意图;
附图2为本发明实施例中基于双通信设备的协同定位图;
附图3为本发明所设计控制跟随艇航行方向的模糊控制器。
具体实施方式
为了便于本领域技术人员的理解,下面结合附图对本发明做进一步的描述。本发明提供的实施例,作为编队构建的参考性举例,仅用于更加详细地对本发明进行阐述,而不能解释为对本发明的限制,该具体示例紧紧作为一个普通示例,不能限制于该示例。本发明所公开的方法可提供许多不同的实施例,用来描述本发明中相应的结构、设置描述等,并且所对应的推广目的不在于限制本发明。此外,本发明中示例的数字或字母,仅为简化和表述清楚,可以引申为其余不同的示例中相对应的数字或者字母,不能以此为限制,其本身不代表所讨论实施例的本质或设置之间的关系。本发明所涉及示例中的各种工艺与材料为本领域普通技术人员常用的材料,采用的技术也是普通的技术手段。此外,本发明的描述中,除特别的注释,其术语均为广义理解。
如附图1-3所示,本发明揭示了一种基于双通信设备的无人艇协同编队方法,基于领导艇-跟随艇形式进行协同编队,具体包括以下步骤:
S1,将无人艇所在的水面区域当成二维平面,建立固定坐标系XOY和领导艇坐标系xoy;领导艇坐标系的x轴平行于固定坐标系的X轴,领导艇坐标系的y轴平行于固定坐标系的Y轴,随领导艇坐标系的原点o为领导艇的中心。
S2,设定跟随艇在领导艇坐标系下的目标位置和基于双通信设备计算跟随艇在领导艇坐标系下相对于领导艇的当前位置,领导艇上设有通信设备,跟随艇的头部和尾部各设一个通信设备形成双通信设备。
S3,控制跟随艇的航行方向和航行速度。
S4,判断跟随艇是否到达在领导艇坐标系下的目标位置以及领导艇是否停止运动,若否则继续执行步骤S2,若是则结束,完成无人艇协同编队。即当同时满足领导艇停止运动,及跟随艇已经到达在领导艇坐标系下的目标位置时,才视为完成协同编队。
所述步骤S2具体包括:
S201,将跟随艇在领导艇坐标系下的目标位置发送给相应的无人艇。
S202,基于双通信设备的协同定位计算跟随艇相对于领导艇的当前相对距离:
其中,L[i]为第i艘跟随艇相对于领导艇的当前相对距离,为领导艇上的通信设备到跟随艇i上的头部和尾部的通信设备的距离,c为双通信设备的传播速度,为跟随艇i上的头部和尾部的通信设备接收到领导艇的通信设备信号的时间,t0为领导艇的双通信设备发送信号的时间,d为无人艇的机身长度,c是指信号传播速度。
S203,基于双通信设备的协同定位计算跟随艇相对于领导艇的当前相对方位角:
其中,θ[i]为第i艘跟随艇相对于领导艇的当前相对方位角;
S204,获取跟随艇i的当前航向角,依据跟随艇相对于领导艇的当前相对距离、当前相对方位角和跟随艇的当前航向角计算跟随艇在领导艇坐标系下的当前位置坐标(x[i],y[i]),|x[i]|=L[i]cos(θ[i]-ψ[i]),|y[i]|=L[i]sin(θ[i]-ψ[i])。
根据跟随艇相对于领导艇的当前相对距离、当前相对方位角和当前航向角计算出跟随艇1、2在领导艇坐标系下的当前位置坐标分别为:(L[1]cos(θ[1]-ψ[1]),-L[i]sin(θ[1]-ψ[1]))、(L[2]cos(θ[2]-ψ[2]),-L[i]sin(θ[2]-ψ[2]))。
所述步骤S3具体包括:
S301,计算当前时刻跟随艇i的当前位置到目标位置的距离以及期望航向:
在利用上述公式计算期望航向时要注意跟随艇在领导艇坐标系下象限的判别,需要识别出在哪一个象限当中。
S302,设计模糊控制器控制跟随艇的航行方向,该模糊控制器的输入为航向误差e和偏航率r,输出为实际航行方向;
另外,如附图3所示,为模糊控制器,FG为模糊增益调节装置,FA为基本模糊控制器,Ke、Kr、Ky为基本模糊控制器的3个固定量化因子。模糊自校正控制器包括一个具有固定量化因子Ke、Kr、Ky的基本模糊控制器FA和三个模糊增益调节装置FG,三个模糊增益调节装置FG的输出也即比例因子ke、kr、ky用于乘在固定量化因子上,新获得的量化因子Keke、Krkr、Kyky是可调整的,量化因子值的优化与控制目标相匹配。
需要说明的是,以上仅为本发明的优选实施例而已,并不用于限制本发明,尽管参照实施例对本发明进行了详细的说明,对于本领域的技术人员来说,其依然可以对前述实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换,但是凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (3)
1.一种基于双通信设备的无人艇协同编队方法,包括以下步骤:
S1,将无人艇所在的水面区域当成二维平面,建立固定坐标系XOY和领导艇坐标系xoy;
S2,设定跟随艇在领导艇坐标系下的目标位置和基于双通信设备计算跟随艇在领导艇坐标系下相对于领导艇的当前位置,领导艇上设有通信设备,跟随艇的头部和尾部各设一个通信设备形成双通信设备;
S3,控制跟随艇的航行方向和航行速度;
S4,判断跟随艇是否到达在领导艇坐标系下的目标位置以及领导艇是否停止运动,若否则继续执行步骤S2,若是则结束,完成无人艇协同编队;
所述步骤S2具体包括:
S201,将跟随艇在领导艇坐标系下的目标位置发送给相应的无人艇;
S202,基于双通信设备的协同定位计算跟随艇相对于领导艇的当前相对距离:
其中,L[i]为第i艘跟随艇相对于领导艇的当前相对距离, 为领导艇上的通信设备到跟随艇i上的头部和尾部的通信设备的距离,c为双通信设备的传播速度,为跟随艇i上的头部和尾部的通信设备接收到领导艇的通信设备信号的时间,t0为领导艇的双通信设备发送信号的时间,d为无人艇的机身长度,c是指信号传播速度;
S203,基于双通信设备的协同定位计算跟随艇相对于领导艇的当前相对方位角:
其中,θ[i]为第i艘跟随艇相对于领导艇的当前相对方位角;
S204,获取跟随艇i的当前航向角,依据跟随艇相对于领导艇的当前相对距离、当前相对方位角和跟随艇的当前航向角计算跟随艇在领导艇坐标系下的当前位置坐标(x[i],y[i]),|x[i]|=L[i]cos(θ[i]-ψ[i]),|y[i|=L[i]sin(θ[i]-ψ[i]),其中ψ[i]为跟随艇i的当前航向角。
2.根据权利要求1所述的基于双通信设备的无人艇协同编队方法,其特征在于,所述领导艇坐标系的x轴平行于固定坐标系的X轴,领导艇坐标系的y轴平行于固定坐标系的Y轴,随领导艇坐标系的原点o为领导艇的中心。
3.根据权利要求2所述的基于双通信设备的无人艇协同编队方法,其特征在于,所述步骤S3具体包括:
S301,计算当前时刻跟随艇i的当前位置到目标位置的距离以及期望航向:
S302,设计模糊控制器控制跟随艇的航行方向,该模糊控制器的输入为航向误差e和偏航率r,输出为实际航行方向;
航向误差是期望航向和当前航向的差值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910646220.4A CN110333723B (zh) | 2019-07-17 | 2019-07-17 | 一种基于双通信设备的无人艇协同编队方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910646220.4A CN110333723B (zh) | 2019-07-17 | 2019-07-17 | 一种基于双通信设备的无人艇协同编队方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110333723A CN110333723A (zh) | 2019-10-15 |
CN110333723B true CN110333723B (zh) | 2022-03-22 |
Family
ID=68145759
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910646220.4A Active CN110333723B (zh) | 2019-07-17 | 2019-07-17 | 一种基于双通信设备的无人艇协同编队方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110333723B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108153311A (zh) * | 2017-12-22 | 2018-06-12 | 武汉理工大学 | 面向无人艇编队的智能控制***及控制方法 |
CN111506114B (zh) * | 2020-05-25 | 2021-05-04 | 北京理工大学 | 一种飞行器编队控制方法 |
CN111781934A (zh) * | 2020-07-29 | 2020-10-16 | 浙江树人学院(浙江树人大学) | 一种主从分布式协同装置及其控制方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010039843A (ja) * | 2008-08-06 | 2010-02-18 | Ricoh Co Ltd | 画像形成装置、画像形成システム、画像形成制御方法、画像形成制御プログラム及び記録媒体 |
CN104656663A (zh) * | 2015-02-15 | 2015-05-27 | 西北工业大学 | 一种基于视觉的无人机编队感知与规避方法 |
CN106355194A (zh) * | 2016-08-22 | 2017-01-25 | 广东华中科技大学工业技术研究院 | 一种基于激光成像雷达的无人艇水面目标处理方法 |
CN106843269A (zh) * | 2017-01-22 | 2017-06-13 | 北京航空航天大学 | 一种基于小型鸟类集群飞行机制的无人机编队方法 |
CN106950970A (zh) * | 2017-05-05 | 2017-07-14 | 东华大学 | 一种基于客户端‑服务器结构的多机器人协同编队方法 |
CN108073175A (zh) * | 2018-01-23 | 2018-05-25 | 上海交通大学 | 基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法 |
CN108170136A (zh) * | 2017-12-15 | 2018-06-15 | 武汉理工大学 | 基于无线传感网络的多无人艇编队控制***及方法 |
-
2019
- 2019-07-17 CN CN201910646220.4A patent/CN110333723B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010039843A (ja) * | 2008-08-06 | 2010-02-18 | Ricoh Co Ltd | 画像形成装置、画像形成システム、画像形成制御方法、画像形成制御プログラム及び記録媒体 |
CN104656663A (zh) * | 2015-02-15 | 2015-05-27 | 西北工业大学 | 一种基于视觉的无人机编队感知与规避方法 |
CN106355194A (zh) * | 2016-08-22 | 2017-01-25 | 广东华中科技大学工业技术研究院 | 一种基于激光成像雷达的无人艇水面目标处理方法 |
CN106843269A (zh) * | 2017-01-22 | 2017-06-13 | 北京航空航天大学 | 一种基于小型鸟类集群飞行机制的无人机编队方法 |
CN106950970A (zh) * | 2017-05-05 | 2017-07-14 | 东华大学 | 一种基于客户端‑服务器结构的多机器人协同编队方法 |
CN108170136A (zh) * | 2017-12-15 | 2018-06-15 | 武汉理工大学 | 基于无线传感网络的多无人艇编队控制***及方法 |
CN108073175A (zh) * | 2018-01-23 | 2018-05-25 | 上海交通大学 | 基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法 |
Non-Patent Citations (5)
Title |
---|
Algorith for Automatic Detection of Ship and Marine Mammals;Akiko Sakurada,等;《9th IFAC Conference on Control Applications in Marine Systems》;20131231;第352-355页 * |
Formation Control of Multiple Passive type Boats for Sea Surveillance;Halil Beglerovic,等;《Proceedings of the 2016 IEEE/SICE International Symposium on System Integration》;20161231;第869-874页 * |
双通信通道无人艇遥控***设计;祁亚辉,等;《工业控制计算机》;20190610;第32卷(第5期);第20-22页 * |
基于模糊推理的专家自整定PID控制器;耿涛,等;《华中科技大学学报(自然科学版)》;20100630;第38卷(第6期);第4-7页 * |
无人艇的目标跟踪策略研究;李刚,等;《设计与研究》;20181231;第97-99页 * |
Also Published As
Publication number | Publication date |
---|---|
CN110333723A (zh) | 2019-10-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108073175B (zh) | 基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法 | |
CN110333723B (zh) | 一种基于双通信设备的无人艇协同编队方法 | |
CN108549369B (zh) | 一种复杂海况下多无人艇协同编队的***及方法 | |
CN108445892B (zh) | 一种欠驱动无人船编队控制器结构及设计方法 | |
CN105511464B (zh) | 一种船舶自主航行控制***及控制方法 | |
CN107168309B (zh) | 一种基于行为的多水下机器人路径规划方法 | |
CN110609556A (zh) | 一种基于los导航法的多无人艇协同控制方法 | |
CN113433933A (zh) | 一种智能水面保洁无人船的自主巡航方法 | |
CN109857117B (zh) | 一种基于分布式模式匹配的无人艇集群编队方法 | |
CN111913481B (zh) | 一种可变领航员模式的多无人艇协同编队方法 | |
CN112558642A (zh) | 一种适用于异构多无人***的海空联合围捕方法 | |
CN110940985A (zh) | 一种多uuv跟踪围捕***及围捕方法 | |
CN113625544A (zh) | 一种波浪滑翔器的内外环pid路径跟踪控制方法 | |
CN109916400B (zh) | 一种基于梯度下降算法与vo法相结合的无人艇避障方法 | |
CN105758405A (zh) | 一种适用于高海况的uuv跟踪母船航迹规划方法 | |
CN115903800A (zh) | 一种基于领导者协同的多无人船编队的严格安全控制方法 | |
CN114610046A (zh) | 一种考虑动态水深的无人艇动态安全轨迹规划方法 | |
CN112925332B (zh) | 无人艇与水下无人潜器联合***的协同交会对接控制方法 | |
CN108287538A (zh) | 一种基于rtk技术无人驾驶船*** | |
CN116027796A (zh) | 一种多自治水下机器人编队控制***及方法 | |
CN115902868A (zh) | 一种基于约束粒子滤波的无人机高精度对峙目标跟踪方法及*** | |
CN115686008A (zh) | 基于指令滤波反步法的船舶动力定位辅助锚泊***设计 | |
CN115145312A (zh) | 仅方位角测量下基于双领导者模式的集群协同控制方法 | |
Chu et al. | Design of a dead reckoning based motion control system for small autonomous underwater vehicle | |
CN111207748B (zh) | 基于感知信息的水面/水下无人航行器目标环绕跟踪方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |