CN113960994A - 一种多无人艇协同航行的s面自适应控制算法 - Google Patents
一种多无人艇协同航行的s面自适应控制算法 Download PDFInfo
- Publication number
- CN113960994A CN113960994A CN202010626245.0A CN202010626245A CN113960994A CN 113960994 A CN113960994 A CN 113960994A CN 202010626245 A CN202010626245 A CN 202010626245A CN 113960994 A CN113960994 A CN 113960994A
- Authority
- CN
- China
- Prior art keywords
- unmanned
- follower
- boat
- speed
- leader
- 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.)
- Granted
Links
- 230000003044 adaptive effect Effects 0.000 title claims abstract description 26
- 230000015572 biosynthetic process Effects 0.000 claims abstract description 68
- 238000000034 method Methods 0.000 claims abstract description 35
- 230000001360 synchronised effect Effects 0.000 claims abstract description 5
- 239000013256 coordination polymer Substances 0.000 claims description 10
- 238000004364 calculation method Methods 0.000 claims description 9
- 238000013459 approach Methods 0.000 claims description 7
- 238000005755 formation reaction Methods 0.000 description 58
- 230000006399 behavior Effects 0.000 description 9
- 230000008859 change Effects 0.000 description 5
- 238000005516 engineering process Methods 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 230000009471 action Effects 0.000 description 2
- 238000004891 communication Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000002195 synergetic effect Effects 0.000 description 1
Images
Classifications
-
- 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)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Description
技术领域
本发明涉及多无人艇协同控制技术领域,具体涉及一种多无人艇协同航行的S面自适应控制算法。
背景技术
无人艇单艇控制技术目前已相对成熟,但随着海洋开采力度的加大,所需执行的任务会越来越复杂。而单个无人艇能力有限,很多任务无法顺利完成,因此需要多艘无人艇协同执行同一个任务。比如,大面积海洋水文数据快速采集、舰队协同作战、自动牵引作业、多无人艇的海洋协作观测等作业,都需要运用到多无人艇的协同航行技术。多无人艇协同作业与单无人艇作业相比,具有以下几个优势:(1)对环境有更强的感知能力;(2)任务效率更高;(3)提高了自适应能力;(4)更强的任务执行力度。通过多无人艇的相互协调配合,不仅可完成更复杂的任务,还能产生1+1>2的协同效应。这些优点将促进多无人艇协同技术在大范围探测、监视等领域的广泛应用。
根据国内外的最新文献,可以把现有的多无人艇协同控制方法大致分为:基于行为的编队控制方法、基于领航跟随法编队控制方法和虚拟结构方法。
1)基于行为的编队控制方法
该方法是通过设计无人艇的局部控制规则和基本行为来控制多无人艇***整体行为完成编队的方法。在该方法中,给每个无人艇都分配基本的行为方式,使其可以保证独立的完成自身任务。一般来说,无人艇的基本行为分为目标驶向、编队保持、避障等行为。目标驶向是指按照期望路径驶向目的地;编队保持是指在行动过程中,编队队形可能被破坏,需要恢复到预定队形。由于多无人艇***中的每艘无人艇都自行控制自身行为,因此,该方法控制的多无人艇***的整体行为的局部控制不明显,不能明确定义群体行为,无法保证队形的稳定性。
2)基于领航跟随法的编队控制方法
该方法是通过指定一个无人艇为领航者,其他无人艇为跟随者。领航者只需要执行向目标驶向这个行为,跟随者则自行调整与领航者的距离与角度,以此来保证队伍的成型。根据主从式跟随策略,推导出非完整无人艇跟踪指定轨迹的控制率,并通过网络通信使跟随者无人艇保持协同队形。该方法可确保任何跟随者无人艇(相对于其领导者)的相对位置收敛到期望值。由于该方法整体优化问题不可控,无法保证达成全局最优解,只解决了领航者和跟随者间的局部最优解问题;而且该方法中并没有针对队形的反馈信息,多无人艇***无法判断队形是否还保持完整;且若领航者发生故障,整个***可能崩溃,在环境变化较大的情况下适应力不够强。
3)虚拟结构法
该方法是多无人艇间以保持某种刚性结构的方式,形成几何队形。通过编队形状来改变各自无人艇的方向以达到无人艇间相对位置不变的目的,然后整体形成虚拟结构朝目标点移动,从而保持编队状态。这种联合虚拟结构和路径跟踪的编队控制方法,其协同运动是通过调整每艘艇的航速实现的。由于刚性结构中无人艇有固定位置的相对约束,使整体缺乏机动性,不能用于需要队形变换的场合。目前,在二维无障碍区域中该方法比较适用。
上述几种多无人艇协同控制的方法不仅时效性差,通信数据量大,而且协同收敛速度较慢。由此可见,在多艇协同航行中,采用一种方便快捷、迅速有效的协同控制方法,对提高多艇协同位置的准确性和协同航行控制的效率具有十分重要的意义。
为此,本发明提供了一种多无人艇协同航行的S面自适应控制算法,以至少部分地解决相关技术中的问题。
发明内容
在发明内容部分中引入了一系列简化形式的概念,这将在具体实施方式部分中进一步详细说明。本发明的发明内容部分并不意味着要试图限定出所要求保护的技术方案的关键特征和必要技术特征,更不意味着试图确定所要求保护的技术方案的保护范围。
为了至少部分地解决上述问题,本发明提供了一种多无人艇协同航行的S面自适应控制算法,包括:
S1:采用领导者-跟随者的编队结构,建立多无人艇同步航行的协同队形的特征模型;
根据本发明的多无人艇协同航行的S面自适应控制算法,通过建立多无人艇同步航行的协同队形的特征模型,能够保证多无人艇编队***实现一致性;通过采用反三角函数的方法计算领导者无人艇的期望跟踪航向,可以使领导者无人艇快速靠近航线路径,提高航线路径的跟踪精度;通过协同计算跟随者无人艇的期望航速和期望航向,根据S面自适应控制算法,结合跟随者无人艇的期望航速和期望航向,控制跟随者无人艇的舵角和发动机转速,能够提高跟随者无人艇的跟踪精度,保持多无人艇的协同队形,最终提升对多无人艇协同航行控制的效率。
优选地,采用公式(1)表示所述特征模型,
其中,AB为所述航线路径,为所述航线路径AB的方向,为航迹偏差,即所述领导者无人艇的位置到所述航线路径AB的垂直距离,为所述领导者无人艇的位置P0到航点B的方向,Sign(DPC)取DPC的正负号,r为所述领导者无人艇的回转半径。
优选地,所述S3包括:
优选地,采用公式(9)计算所述跟随者无人艇的所述舵角Rdj,采用公式(10)计算所述跟随者无人艇的所述发动机的所述转速ERj,
附图说明
本发明的下列附图在此作为本发明的一部分用于理解本发明。附图中示出了本发明的实施方式及其描述,用来解释本发明的原理。
附图中:
图1为根据本发明的优选实施方式的多无人艇协同航行的S面自适应控制算法的流程示意图;
图2为根据本发明的优选实施方式的多无人艇协同航行的S面自适应控制算法的多无人艇协同航行的协同队形的特征模型的示意图;
图3为根据本发明的优选实施方式的多无人艇协同航行的S面自适应控制算法的领导者无人艇的航线路径跟踪控制的示意图;
图4为根据本发明的优选实施方式的多无人艇协同航行的S面自适应控制算法的跟随者无人艇的期望协同航速的协同算法的示意图;以及
图5为根据本发明的优选实施方式的多无人艇协同航行的S面自适应控制算法的计算跟随者无人艇的期望协同航向和期望协同航速的示意图。
具体实施方式
在下文的描述中,给出了大量具体的细节以便提供对本发明更为彻底的理解。然而,对于本领域技术人员来说显而易见的是,本发明实施方式可以无需一个或多个这些细节而得以实施。在其他的例子中,为了避免与本发明实施方式发生混淆,对于本领域公知的一些技术特征未进行描述。
为了彻底了解本发明的实施方式,将在下文提出详细的描述。显然,本发明实施方式的施行并不限定于本领域的技术人员所熟习的特殊细节。本发明的较佳实施方式详细描述如下,然而除了这些详细描述外,本发明还可以具有其他实施方式。
参考图1,本发明提供了一种多无人艇协同航行的S面自适应控制算法,在多人艇协同航行开始后,该方法主要包括以下步骤:
S1:采用领导者-跟随者的编队结构,建立多无人艇同步航行的协同队形的特征模型;
根据本发明的多无人艇协同航行的S面自适应控制算法,通过建立多无人艇同步航行的协同队形的特征模型,能够保证多无人艇编队***实现一致性;通过采用反三角函数的方法计算领导者无人艇的期望跟踪航向,可以使领导者无人艇快速靠近航线路径,提高航线路径的跟踪精度;通过领导者无人艇的期望跟踪航速和期望跟踪航向,以及跟随者无人艇需要跟踪的协同航点,协同计算跟随者无人艇的期望航速和期望航向,然后结合S面自适应控制算法,结合期望协同航速和期望协同航向,控制跟随者无人艇的舵角和发动机转速,能够提高跟随者无人艇的跟踪精度,保持多无人艇的协同队形,最终提升对多无人艇协同航行控制的效率。
在步骤S1中,多无人艇根据任务不同,采用领导者-跟随者的编队结构形成和保持的协同队形也不同。其协同队形的形成过程是通过提前设定一个协同队形目标,每个无人艇按照其协同队形分配的编队位置移动,各自独立地到达编队位置以便形成协同队形,并通过不断调整来保持协同队形。
参考图2,为了建立多无人艇空间同步模型,也就是建立多无人艇同步航行的协同队形的特征模型,在大地坐标系(ηοξ)的基础上,建立与领导者无人艇L一起运动的随船坐标系(xoy)。假设领导者无人艇L在大地坐标系下的坐标为跟随者无人艇Fj(第j个无人艇,j=1,2,3…n)在大地坐标系下的坐标为其中,和分别为领导者无人艇L和跟随者无人艇Fj在大地坐标系下的艏向角,通过几何方法来构造多无人艇的协同队形。领导者无人艇L在随船坐标系(xoy)的坐标原点,为了简单化定义无人艇的协同队形,这里利用Xj和Yj来确定多无人艇编队的协同队形,Xj和Yj分别表示各跟随者无人艇Fj与领导者无人艇L之间的水平距离和垂直距离。也就是说,各跟随者无人艇Fj相对于领导者无人艇L的位置将通过Xj和Yj这两个参数计算出。具体的协同队形的特征模型如公式(1)所示,
在多无人艇同步航行的协同队形的特征模型建立完成后,多无人艇即可按照特征模型表征的协同队形编队,然后沿给定的航线路径协同航行。
在步骤S2中,为了使得多无人艇航行收敛至给定航线路径,采用反三角函数的方法计算领导者无人艇的期望跟踪航向使领导者无人艇跟踪指定的航线路径。该方法简单实用,可以使领导者无人艇快速靠近航线路径,提高领导者无人艇对航线路径的跟踪精度。
其中,为航线路径AB的方向, 为航迹偏差,即领导者无人艇的位置到航线路径AB的垂直距离,为领导者无人艇的位置P0到航点B的方向,Sign(DPC)取DPC的正负号,r为领导者无人艇的回转半径,一般为领导者无人艇设计航速下舵角为35°时的回转半径。
在其他的一些实施方式中,多无人艇需要进行回转运动。为了提高在回转运动过程中多无人艇之间的协同度,保持多无人艇的协同队形以实现协同航行,在计算跟随者无人艇Fj的期望协同航速和期望协同航向时,需要考虑领导者无人艇回转角速度的影响,以提高回转运动过程中多无人艇对航线路径的跟踪精度。
具体地参考图5,假设领导者无人艇L在随船坐标系(xoy)的原点,领导者无人艇L在大地坐标系(ηοξ)下的期望跟踪航速为期望跟踪航向为回转角速度多无人艇编队做回转运动时,领导者无人艇L的瞬时回转半径为可以认为领导者无人艇L是绕着θ点做瞬时的圆周运动。通过领导者无人艇L与各跟随者无人艇Fj之间的相对位置,可计算出各跟随者无人艇Fj的期望协同航速和期望协同航向具体地采用公式(6)进行计算,
其中,rj采用公式(7)进行计算,
其中,Sign(w0)采用公式(8)进行计算,
为了实现更好的协同航行,可以根据S面自适应控制算法,结合期望协同航速和期望协同航向控制跟随者无人艇的舵角Rdj和发动机转速ERj,使跟随者无人艇保持协同队形。也就是说,结合S面函数、期望协同航速和期望协同航向建立跟随者无人艇的舵角Rdj与航向误差以及发动机转速ERj与航速误差之间的联系,通过直接控制跟随者无人艇的舵角和发动机转速来消除航向误差和航速误差,提升对多无人艇协同航行控制的效率。
跟随者无人艇Fj通过控制舵角Rdj来实现航向的控制,其舵角Rdj的控制规律采用公式(9)计算,
其中,为跟随者无人艇Fj的航向误差,为跟随者无人艇Fj的航向角速度,RdM为跟随者无人艇的最大舵角值;k1和k2是用来改变控制收敛的快慢或超调与否的控制参数,当航向误差收敛慢了,增加k1,减小k2;当航向控制超调了,减小k1,增加k2。
跟随者无人艇Fj通过控制发动机的转速ERj来实现航速的控制,其发动机的转速ERj的控制规律采用公式(10)计算,
其中,为所述跟随者无人艇Fj的航速误差,Vj为所述跟随者无人艇Fj的实际航速,为所述跟随者无人艇Fj的加速度,ERM为所述发动机的最大转速。同样地,k1和k2是用来改变控制收敛的快慢或超调与否的控制参数,当航速误差收敛慢了,增加k1,减小k2;当航速控制超调了,减小k1,增加k2。
除非另有定义,本文中所使用的技术和科学术语与本发明的技术领域的技术人员通常理解的含义相同。本文中使用的术语只是为了描述具体的实施目的,不是旨在限制本发明。本文中在一个实施方式中描述的特征可以单独地或与其它特征结合地应用于另一个实施方式,除非该特征在该另一个实施方式中不适用或是另有说明。
本发明已经通过上述实施方式进行了说明,但应当理解的是,上述实施方式只是用于举例和说明的目的,而非意在将本发明限制于所描述的实施方式范围内。本领域技术人员可以理解的是,根据本发明的教导还可以做出更多种的变型和修改,这些变型和修改均落在本发明所要求保护的范围以内。
Claims (6)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010626245.0A CN113960994B (zh) | 2020-07-01 | 2020-07-01 | 一种多无人艇协同航行的s面自适应控制算法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010626245.0A CN113960994B (zh) | 2020-07-01 | 2020-07-01 | 一种多无人艇协同航行的s面自适应控制算法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113960994A true CN113960994A (zh) | 2022-01-21 |
CN113960994B CN113960994B (zh) | 2024-03-26 |
Family
ID=79459282
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010626245.0A Active CN113960994B (zh) | 2020-07-01 | 2020-07-01 | 一种多无人艇协同航行的s面自适应控制算法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113960994B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114647250A (zh) * | 2022-03-21 | 2022-06-21 | 中国船舶科学研究中心 | 适用于水下无人航行器的双层集群控制方法 |
CN115686004A (zh) * | 2022-10-27 | 2023-02-03 | 南京长峰航天电子科技有限公司 | 一种基于无人船分散式编队控制的路径动态规划方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107168329A (zh) * | 2017-06-20 | 2017-09-15 | 南京长峰航天电子科技有限公司 | 基于跟随领航者法的航速航向协同控制编队航行控制方法 |
US20180074520A1 (en) * | 2016-09-13 | 2018-03-15 | Arrowonics Technologies Ltd. | Formation flight path coordination of unmanned aerial vehicles |
CN109375643A (zh) * | 2018-10-24 | 2019-02-22 | 中北大学 | 基于领航-跟随式三角形编队的多四旋翼对峙跟踪目标制导律 |
CN109799818A (zh) * | 2019-01-15 | 2019-05-24 | 大连海事大学 | 多参数化路径导引的无人船协同操纵控制器及其设计方法 |
WO2019203166A1 (ja) * | 2018-04-16 | 2019-10-24 | 日本電信電話株式会社 | 飛行制御装置、方法、及びプログラム |
CN110609556A (zh) * | 2019-10-09 | 2019-12-24 | 广东华中科技大学工业技术研究院 | 一种基于los导航法的多无人艇协同控制方法 |
CN110928278A (zh) * | 2018-08-31 | 2020-03-27 | 中国船舶重工集团公司第七一一研究所 | 一种用于无人艇的自主安全航行方法和无人艇 |
-
2020
- 2020-07-01 CN CN202010626245.0A patent/CN113960994B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20180074520A1 (en) * | 2016-09-13 | 2018-03-15 | Arrowonics Technologies Ltd. | Formation flight path coordination of unmanned aerial vehicles |
CN107168329A (zh) * | 2017-06-20 | 2017-09-15 | 南京长峰航天电子科技有限公司 | 基于跟随领航者法的航速航向协同控制编队航行控制方法 |
WO2019203166A1 (ja) * | 2018-04-16 | 2019-10-24 | 日本電信電話株式会社 | 飛行制御装置、方法、及びプログラム |
CN110928278A (zh) * | 2018-08-31 | 2020-03-27 | 中国船舶重工集团公司第七一一研究所 | 一种用于无人艇的自主安全航行方法和无人艇 |
CN109375643A (zh) * | 2018-10-24 | 2019-02-22 | 中北大学 | 基于领航-跟随式三角形编队的多四旋翼对峙跟踪目标制导律 |
CN109799818A (zh) * | 2019-01-15 | 2019-05-24 | 大连海事大学 | 多参数化路径导引的无人船协同操纵控制器及其设计方法 |
CN110609556A (zh) * | 2019-10-09 | 2019-12-24 | 广东华中科技大学工业技术研究院 | 一种基于los导航法的多无人艇协同控制方法 |
Non-Patent Citations (3)
Title |
---|
廖刚;徐海祥;余文?;李文娟;: "基于时空解耦的无人艇编队路径跟踪控制", 武汉理工大学学报(交通科学与工程版), no. 06 * |
董早鹏;万磊;宋利飞;茅云生;: "基于自适应专家S面算法的微小型USV控制***设计", 中国造船, no. 02 * |
赵宁宁;徐德民;严卫生;高剑;王金华;: "多自主水下航行器编队控制***设计", 火力与指挥控制, no. 01 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114647250A (zh) * | 2022-03-21 | 2022-06-21 | 中国船舶科学研究中心 | 适用于水下无人航行器的双层集群控制方法 |
CN115686004A (zh) * | 2022-10-27 | 2023-02-03 | 南京长峰航天电子科技有限公司 | 一种基于无人船分散式编队控制的路径动态规划方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113960994B (zh) | 2024-03-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110262492B (zh) | 一种无人艇的实时避碰和目标跟踪方法 | |
CN111487966B (zh) | 一种基于航路点的水面无人艇自适应路径跟踪控制方法 | |
CN113419428B (zh) | 基于3d映射制导的机/船协同路径跟踪控制器设计方法 | |
CN108445892A (zh) | 一种欠驱动无人船编队控制器结构及设计方法 | |
CN110609556A (zh) | 一种基于los导航法的多无人艇协同控制方法 | |
CN106094606A (zh) | 一种水面无人艇导航与控制遥操作平台 | |
CN112130566A (zh) | 一种基于模糊逻辑和滑模控制策略的无人艇、无人机混合编队控制方法及其控制*** | |
CN112558642B (zh) | 一种适用于异构多无人***的海空联合围捕方法 | |
CN111123903B (zh) | 一种基于圆形轨迹单元的无人艇避障方法 | |
CN113093804B (zh) | 基于反演滑模控制的无人艇编队控制方法和控制*** | |
Wiig et al. | A 3D reactive collision avoidance algorithm for nonholonomic vehicles | |
CN112327872B (zh) | 面向溢油围捕的双无人艇协同轨迹跟踪方法 | |
CN113960994B (zh) | 一种多无人艇协同航行的s面自适应控制算法 | |
CN115903800A (zh) | 一种基于领导者协同的多无人船编队的严格安全控制方法 | |
CN115202349A (zh) | 基于通信干扰的多移动机器人协同编队控制方法、装置、设备及存储介质 | |
Li et al. | Integrating dynamic event-triggered and sensor-tolerant control: Application to USV-UAVs cooperative formation system for maritime parallel search | |
CN113296505B (zh) | 一种基于速变los的无人船多模式路径跟踪控制方法 | |
CN111256694A (zh) | 一种确定水面无人艇路径的方法 | |
CN113359737A (zh) | 一种考虑队形伸缩的船舶编队自适应事件触发控制方法 | |
CN112180915A (zh) | 基于ros的双推力无人船运动控制***及控制方法 | |
Zheng et al. | Survey of approaches for improving the intelligence of marine surface vehicles | |
CN114035567B (zh) | 一种水面无人艇航控*** | |
Noshahri et al. | Towards automatic steering of underactuated ships | |
Savkin et al. | Decentralized formation flocking and stabilization for networks of unicycles | |
Zhang et al. | Formation control of autonomous surface vehicle and experimental validation |
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 | ||
CB02 | Change of applicant information |
Country or region after: China Address after: 201108 Shanghai city Minhang District Huaning Road No. 3111 Applicant after: The 711 Research Institute of China Shipbuilding Corp. Address before: 201108 Shanghai city Minhang District Huaning Road No. 3111 Applicant before: Shanghai Marine Diesel Engine Research Institute Country or region before: China |
|
CB02 | Change of applicant information | ||
GR01 | Patent grant | ||
GR01 | Patent grant |