CN111830978A - 一种欠驱动无人艇避障路径规划及控制方法及系统 - Google Patents
一种欠驱动无人艇避障路径规划及控制方法及系统 Download PDFInfo
- Publication number
- CN111830978A CN111830978A CN202010647791.2A CN202010647791A CN111830978A CN 111830978 A CN111830978 A CN 111830978A CN 202010647791 A CN202010647791 A CN 202010647791A CN 111830978 A CN111830978 A CN 111830978A
- Authority
- CN
- China
- Prior art keywords
- under
- unmanned ship
- actuated unmanned
- potential field
- actuated
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 45
- 238000004458 analytical method Methods 0.000 claims abstract description 23
- 230000006870 function Effects 0.000 claims description 23
- 238000011156 evaluation Methods 0.000 claims description 16
- 238000013461 design Methods 0.000 claims description 13
- 238000004422 calculation algorithm Methods 0.000 claims description 11
- 238000004590 computer program Methods 0.000 claims description 5
- 238000001514 detection method Methods 0.000 claims description 5
- 238000012545 processing Methods 0.000 claims description 4
- 230000004888 barrier function Effects 0.000 claims description 2
- 238000004364 calculation method Methods 0.000 abstract description 3
- 238000010586 diagram Methods 0.000 description 6
- 230000008569 process Effects 0.000 description 6
- 238000011160 research Methods 0.000 description 4
- 230000010355 oscillation Effects 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 238000011217 control strategy Methods 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- 238000005260 corrosion Methods 0.000 description 1
- 230000007797 corrosion Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000009499 grossing Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 238000006467 substitution reaction Methods 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
技术领域
本发明涉及无人水下航行器技术领域,具体而言,尤其涉及一种欠驱动无人艇避障路径规划及控制方法及系统。
背景技术
欠驱动无人艇避障路径规划及控制系统分为避障与控制两个子策略。避障方面,欠驱动无人艇采用的是传统人工势场避障策略:将无人艇所在未知海域抽象成为一个受力场,将航行的目标点作为引力极形成引力势场,航行过程中遇到的海面障碍物作为斥力极并产生斥力势场,从而将所在海域人为的抽象成为由两者叠加构成的人工势场,无人艇在当前位置所受合力指导下对海域内的障碍物进行规避并驶向目标点。由于其原理简单、计算量小、实时性好等特点,人工势场法目前被广泛应用于欠驱动无人艇的路径规划和动态避障中。传统人工势场法存在目标不可达和局部最小值两个突出问题,导致无人艇无法完成避障要求抵达目标点,且传统人工势场法所规划出的避障艏向角存在的振荡频率高以及幅度大等问题,不符合工程实际要求,因此现有人工势场法已经无法满足对无人艇艏向角动态变化幅度小、路径平滑等的性能要求。控制方面,欠驱动无人艇所采用的传统鲁棒跟踪控制策略通过设计对无人艇前向与艏向上的控制律实现对无人艇的控制,设计简单、适用性好,但对未知海域内可能存在的风浪流等干扰未加补偿,影响控制精度。
为使欠驱动无人艇能够在复杂的未知海域内完成指定任务,航行过程中无人艇必须能够实时规划避障路径,并快速跟踪上该路径,从而及时避开海面障碍物,而且对障碍物及风浪流的干扰也需要具有较强的鲁棒性。因此,实时、有效的局部路径规划能力以及高精度的路径跟随能力是欠驱动无人艇实现安全平稳航行并完成规划任务的重要前提之一,故设计性能良好的局部路径规划系统以及路径跟踪系统成为欠驱动无人艇的一个核心研究问题。但是现有系统存在以下问题:
1.由于传统人工势场避障算法定义下的引力势场函数与斥力势场函数较简单,未考虑障碍物处于无人艇和目标点连线或目标点附近存在障碍物的情况,因此会存在局部极小值问题和目标不可达问题,导致无人艇无法躲避障碍物抵达目标点。一般采用设置虚拟引导点、随机搜索或沿墙走等方法解决局部极小值问题,采用引入了无人艇与目标点之间距离的斥力势场函数解决目标不可达问题,但对于复杂的多障碍物分布问题研究较少,而且未从根本上解决传统人工势场法的固有问题。
2.基于人工势场的避障算法普遍将引力与斥力构成的合力方向作为无人艇的艏向,当无人艇进入或驶离障碍物影响区域时,其合力方向会与上一时刻合力方向产生很大夹角,但由于受到回转性能影响,欠驱动无人艇的回转角速度受到很大约束,可能使得无人艇无法快速按规划出的避障路径航行,令其实际航迹与规划路径偏差较大,严重时可能造成碰撞事件发生。
3.人工势场法对于海流因素的考虑不足,忽略了无人艇所受到的外界风浪流干扰对避障精度的影响,使得算法在实际应用中存在很大局限性。现有的一些研究仅针对定常海流对势场函数加以调整,而将时变海流的影响通过势场方式加以考虑来调整避障路径十分困难。
发明内容
根据上述提出的技术问题,而提供一种欠驱动无人艇避障路径规划及控制方法及系统。本发明采用的技术手段如下:
一种欠驱动无人艇避障路径规划及控制方法,所述方法包括:
获取欠驱动无人艇当前位置以及欠驱动无人艇前方扇形区域内障碍物位置信息;
基于势场分析法,对所述获取的欠驱动无人艇当前位置以及欠驱动无人艇前方扇形区域内障碍物位置信息进行势场分析,选择其中具有最小合势场的估算点方向作为势场艏向角;
将所述势场艏向角与欠驱动无人艇当前艏向角之间的偏差角以及欠驱动无人艇当前位置引斥比作为两个输入量引入设计的模糊逻辑控制器中,得到欠驱动无人艇下一步运动的避障艏向角;
设计运动控制器,对所述欠驱动无人艇下一步运动的避障艏向角以及前行速度进行跟踪控制,实现所述欠驱动无人艇无碰撞的航行至目标点。
进一步地,所述获取欠驱动无人艇当前位置以及欠驱动无人艇前方扇形区域内障碍物位置信息,包括:
将TriTech微型机械扫描声呐朝着一定方向发射声波并接收由障碍物反射回来的声波;
按固定频率转动所述TriTech微型机械扫描声呐再次发射声波并接收由障碍物反射回来的声波;
获取欠驱动无人艇当前位置以及欠驱动无人艇前方扇形区域内障碍物位置信息。
进一步地,所述基于势场分析法,对所述获取的欠驱动无人艇当前位置以及欠驱动无人艇前方扇形区域内障碍物位置信息进行势场分析,选择其中具有最小合势场的估算点方向作为势场艏向角,包括:
假定在惯性坐标系下,欠驱动无人艇位于一海域的点P,坐标为X[x,y],当前艏向角为ψ,欠驱动无人艇航行目标为点G,坐标为Xg[xg,yg],该海域存在n个障碍物Aj(j=1,2,...,n),坐标为欠驱动无人艇前m个估算点Mi(i=1,2,...,m),坐标为
当任意一个估算点处于障碍物斥力影响范围ρ0内时,将所述势场分析法应用于人工势场避障算法的势场函数中,令估算点Mi处的引力势场函数为:障碍物Aj在估算点Mi处产生的斥力势场函数为则估算点Mi处的合势场函数为其中katt和krep分别为引力系数和斥力系数,表示估算点Mi与目标点G之间的欧氏距离,表示估算点Mi与障碍物Aj之间的欧氏距离;
计算出m个估算点Mi处的合势场函数值Ui后,将具有最小合势场值的估算点记为Mz,故确定点Mz的方位角ψz为势场艏向角,即ψt+1=ψz。
进一步地,所述将所述势场艏向角与欠驱动无人艇当前艏向角之间的偏差角以及欠驱动无人艇当前位置引斥比作为两个输入量引入设计的模糊逻辑控制器中,得到欠驱动无人艇下一步运动的避障艏向角,包括:
对输入、输出量的模糊集均采用均匀分布的三角形隶属度函数进行模糊化的处理;
将调整角θf与当前艏向角ψt的和作为欠驱动无人艇下一步运动的避障艏向角ψf,ψf=ψt+θf。
进一步地,所述的输入量和输出量之间的模糊规则采用if A and B then C 的形式构造。
进一步地,所述设计运动控制器,对所述欠驱动无人艇下一步运动的避障艏向角以及前行速度进行跟踪控制,实现所述欠驱动无人艇无碰撞的航行至目标点,包括:
设计有限时间扰动观测器,具体为:
其中,ξ=[ξu,0,ξr]T是虚拟控制输入,λi、L、q、p均为设计参数,λi>0(i=1,2),L=diag(Lu,0,Lr)且Lj>0(j=u,r),表示欠驱动无人艇速度矢量的观测值,表示外界扰动的观测值,且|x|表示x的绝对值,
基于所述设计的有限时间扰动观测器,设计鲁棒跟踪控制器,具体为:
其中,ku,kr>0为两个设计参数,和分别是经有限时间扰动观测器观测出的前向速度维度与艏向角速度维度上的外界未知干扰,ud、ψd分别是前向速度以及艏向角的期望值,rd为对艏向角速度的虚拟控制信号,其中kψ为一个设计参数,且kψ>0。
本发明还提供了一种欠驱动无人艇避障路径规划及控制系统,所述系统包括:
障碍物探测模块,用于获取欠驱动无人艇当前位置以及欠驱动无人艇前方扇形区域内障碍物位置信息;
势场分析模块,用于对所述获取的欠驱动无人艇当前位置以及欠驱动无人艇前方扇形区域内障碍物位置信息进行势场分析,选择其中具有最小合势场的估算点方向作为势场艏向角;
模糊控制模块,用于将所述势场艏向角与欠驱动无人艇当前艏向角之间的偏差角以及欠驱动无人艇当前位置引斥比作为两个输入量引入设计的模糊逻辑控制器中,得到欠驱动无人艇下一步运动的避障艏向角;
跟踪控制模块,用于对所述欠驱动无人艇下一步运动的避障艏向角以及前行速度进行跟踪控制,实现所述欠驱动无人艇无碰撞的航行至目标点。
本申请还提供了一种计算机可读存储介质,所述计算机可读存储介质中存储有包括计算机程序,其中,所述计算机程序运行时,执行上述欠驱动无人艇避障路径规划及控制方法。
较现有技术相比,本发明具有以下优点:
1、本发明使用TriTech微型机械扫描声呐作为障碍物探测设备,其测量精度较好、体积小、功耗低、耐腐能力强,能够适应无人船艇这个特殊工作环境,可以搭载于无人船艇上实现高精度的扫描探测工作,帮助无人船完成对周围障碍物的精准感知,为无人船艇动态避障提供了硬件设备支持。
2、本发明以人工势场法为基础进行欠驱动无人艇的避障路径规划,但避开了传统人工势场分析合势力的方法,而采用势场分析法对无人艇前扇形区域进行势场分析,使计算更简洁,能够高效解决传统人工势场法存在的目标不可达问题和局部极小值问题,且对复杂的U形障碍物群也能够精确躲避。
3、本发明采用模糊控制模块,将人工势场法计算过程中的数据进行二次加工,使目标航向角曲线大大平滑,且变化幅度也大大减小,更符合实际工程要求,且在面对复杂障碍物分布情况的海域时,避障成功率更高。
4、本发明考虑到未知海域内的风浪流扰动对无人艇避障的影响,设计了有限时间扰动观测器对未知扰动进行精确观测,同时设计了基于有限时间扰动观测器的鲁棒跟踪控制器,使无人艇对避障艏向角的跟踪控制精度大大提高,能够指导欠驱动无人艇在存在风浪流干扰且障碍物分布情况未知的海域内精准避障,实现由起始点至目标点的无碰撞自主航行。
基于上述理由本发明可在无人水下航行器等领域广泛推广。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图做以简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1为本发明方法流程图。
图2为本发明实施例提供的声呐扫描过程示意图。
图3为本发明实施例提供的m个估算点示意图。
图4为本发明实施例提供的基于扫描声呐的混合型模糊人工势场避障算法结构框图。
图5为本发明实施例提供的模糊控制规则。
图6为本发明实施例提供的基于有限时间扰动观测器的欠驱动无人艇运动控制器结构框图。
图7为本发明实施例提供的欠驱动无人艇避障路径规划及控制系统总体框图。
具体实施方式
需要说明的是,在不冲突的情况下,本发明中的实施例及实施例中的特征可以相互组合。下面将参考附图并结合实施例来详细说明本发明。
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。以下对至少一个示例性实施例的描述实际上仅仅是说明性的,决不作为对本发明及其应用或使用的任何限制。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
需要注意的是,这里所使用的术语仅是为了描述具体实施方式,而非意图限制根据本发明的示例性实施方式。如在这里所使用的,除非上下文另外明确指出,否则单数形式也意图包括复数形式,此外,还应当理解的是,当在本说明书中使用术语“包含”和/或“包括”时,其指明存在特征、步骤、操作、器件、组件和/或它们的组合。
若想令欠驱动无人艇按照所规划的避障路径运动,实现自主避障并最终抵达目标点,需要设计能够对避障艏向角进行精确跟踪的运动控制器。除此之外,海域内的风浪流等扰动也是影响避障效果的重要因素,但是从避障算法的角度对其进行补偿的难度较大,而在控制器中对扰动进行观测与补偿的研究已经相当成熟,因此所设计的控制器还需要能够对风浪流进行有效地补偿。本发明设计的欠驱动无人艇避障路径规划及控制方法是一种结合机械扫描声呐的基于改进型人工势场避障法。
如图1所示,本发明提供了一种欠驱动无人艇避障路径规划及控制方法,该方法包括如下步骤:
S1、获取欠驱动无人艇当前位置以及欠驱动无人艇前方扇形区域内障碍物位置信息;具体包括:
S11、将TriTech微型机械扫描声呐朝着一定方向发射声波并接收由障碍物反射回来的声波;
S12、按固定频率转动所述TriTech微型机械扫描声呐再次发射声波并接收由障碍物反射回来的声波;
S13、获取欠驱动无人艇当前位置以及欠驱动无人艇前方扇形区域内障碍物位置信息。
本发明中将声呐放置于无人艇船头,以无人艇运动方向为0°,使声呐以10°的间隔扫描发射11束声波,则扫描覆盖的角度范围近似是船前-50°到50°之间。该声呐扫描的距离范围为0.3m到75m,由于声呐的扫描速度极快,因此可以近似认为能够同时得到船前100°范围、0.3m至75m半径内各点的位置信息和势场情况。本发明选取半径3米处的11个点作为估算点。如图2所示,为声呐扫描过程示意图。
S2、基于势场分析法,对所述获取的欠驱动无人艇当前位置以及欠驱动无人艇前方扇形区域内障碍物位置信息进行势场分析,选择其中具有最小合势场的估算点方向作为势场艏向角;具体包括:
S21、假定在惯性坐标系下,欠驱动无人艇位于一海域的点P,坐标为 X[x,y],当前艏向角为ψ,欠驱动无人艇航行目标为点G,坐标为Xg[xg,yg],该海域存在n个障碍物Aj(j=1,2,...,n),坐标为欠驱动无人艇前m个估算点Mi(i=1,2,...,m),坐标为
S22、当任意一个估算点处于障碍物斥力影响范围ρ0内时,将所述势场分析法应用于人工势场避障算法的势场函数中,则各估算点的势场分析如图3 所示,令估算点Mi处的引力势场函数为:障碍物Aj在估算点Mi处产生的斥力势场函数为则估算点Mi处的合势场函数为其中katt和krep分别为引力系数和斥力系数,表示估算点Mi与目标点G之间的欧氏距离,表示估算点Mi与障碍物Aj之间的欧氏距离;
S23、计算出m个估算点Mi处的合势场函数值Ui后,将具有最小合势场值的估算点记为Mz,故确定点Mz的方位角ψz为势场艏向角,即ψt+1=ψz。
S3、为在保留人工势场算法结构简单、实时性强的优点的同时,减少所规划的避障路径期望艏向角振荡次数并降低其振幅,本发明在上述算法的基础上加入模糊控制器,其结构框图如图4所示。将所述势场艏向角与欠驱动无人艇当前艏向角之间的偏差角以及欠驱动无人艇当前位置引斥比作为两个输入量引入设计的模糊逻辑控制器中,得到欠驱动无人艇下一步运动的避障艏向角;具体包括:
S33、对输入、输出量的模糊集均采用均匀分布的三角形隶属度函数进行模糊化的处理;
S34、将调整角θf与当前艏向角ψt的和作为欠驱动无人艇下一步运动的避障艏向角ψf,ψf=ψt+θf。
经过模糊逻辑控制器处理得到的避障艏向角ψf能够更好的反映出障碍物信息及无人艇距目标点的距离,并且能够消除无障碍物区域内避障艏向角的振荡问题,达到平滑艏向角整体变化曲线以及避障路径的目的。
优选地,所述的输入量和输出量之间的模糊规则采用if A and B then C的形式构造。具体模糊规则如图5所示。
S4、设计运动控制器,其结构如图6所示,对所述欠驱动无人艇下一步运动的避障艏向角以及前行速度进行跟踪控制,实现所述欠驱动无人艇无碰撞的航行至目标点。具体包括:
S41、设计有限时间扰动观测器,具体为:
其中,ξ=[ξu,0,ξr]T是虚拟控制输入,λi、L、q、p均为设计参数,λi>0(i=1,2),L=diag(Lu,0,Lr)且Lj>0(j=u,r),表示欠驱动无人艇速度矢量的观测值,表示外界扰动的观测值,且|x|表示x的绝对值,
通过设计有限时间扰动观测器可以对未知海洋干扰τw进行精准观测,提高系统的控制精度和稳定性能,增强其抗干扰能力。
S42、基于所述设计的有限时间扰动观测器,设计鲁棒跟踪控制器,具体为:
其中,ku,kr>0为两个设计参数,和分别是经有限时间扰动观测器观测出的前向速度维度与艏向角速度维度上的外界未知干扰,ud、ψd分别是前向速度以及艏向角的期望值,rd为对艏向角速度的虚拟控制信号,其中kψ为一个设计参数,且kψ>0。
在一个实施例中,如图7所示,其示出了一种欠驱动无人艇避障路径规划及控制系统的结构框图,该系统包括:
障碍物探测模块,用于获取欠驱动无人艇当前位置以及欠驱动无人艇前方扇形区域内障碍物位置信息;
势场分析模块,用于对所述获取的欠驱动无人艇当前位置以及欠驱动无人艇前方扇形区域内障碍物位置信息进行势场分析,选择其中具有最小合势场的估算点方向作为势场艏向角;
模糊控制模块,用于将所述势场艏向角与欠驱动无人艇当前艏向角之间的偏差角以及欠驱动无人艇当前位置引斥比作为两个输入量引入设计的模糊逻辑控制器中,得到欠驱动无人艇下一步运动的避障艏向角;
跟踪控制模块,用于对所述欠驱动无人艇下一步运动的避障艏向角以及前行速度进行跟踪控制,实现所述欠驱动无人艇无碰撞的航行至目标点。
在获取欠驱动无人艇当前位置以及无人艇前方扇形区域内障碍物分布情况后,避障算法将基于上述信息规划出一个能够精确避障的期望艏向角,然后由控制策略对期望艏向角以及期望前向速度进行精准跟踪,使无人艇无碰撞的航行至某一位置,并在该位置的基础上再次规划、跟踪,直至无人艇躲避途中遇到的所有障碍物抵达目标点。
综上,本发明避免了传统人工势场法存在的目标不可达和局部极小值问题,除此之外,发明对复杂的U形障碍物群也具备优越的躲避能力,所规划出的避障艏向角以及实际航迹均具有平滑的特性,应用本发明的欠驱动无人艇能够在障碍物分布复杂且存在风浪流等外界干扰的未知海域中,高质高效的实现动态避障功能,完成起始点至目标点的无碰撞自主航行任务。
最后应说明的是:以上实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明实施例技术方案的范围。
Claims (8)
1.一种欠驱动无人艇避障路径规划及控制方法,其特征在于,所述方法包括:
获取欠驱动无人艇当前位置以及欠驱动无人艇前方扇形区域内障碍物位置信息;
基于势场分析法,对所述获取的欠驱动无人艇当前位置以及欠驱动无人艇前方扇形区域内障碍物位置信息进行势场分析,选择其中具有最小合势场的估算点方向作为势场艏向角;
将所述势场艏向角与欠驱动无人艇当前艏向角之间的偏差角以及欠驱动无人艇当前位置引斥比作为两个输入量引入设计的模糊逻辑控制器中,得到欠驱动无人艇下一步运动的避障艏向角;
设计运动控制器,对所述欠驱动无人艇下一步运动的避障艏向角以及前行速度进行跟踪控制,实现所述欠驱动无人艇无碰撞的航行至目标点。
2.根据权利要求1所述的欠驱动无人艇避障路径规划及控制方法,其特征在于,所述获取欠驱动无人艇当前位置以及欠驱动无人艇前方扇形区域内障碍物位置信息,包括:
将TriTech微型机械扫描声呐朝着一定方向发射声波并接收由障碍物反射回来的声波;
按固定频率转动所述TriTech微型机械扫描声呐再次发射声波并接收由障碍物反射回来的声波;
获取欠驱动无人艇当前位置以及欠驱动无人艇前方扇形区域内障碍物位置信息。
3.根据权利要求1所述的欠驱动无人艇避障路径规划及控制方法,其特征在于,所述基于势场分析法,对所述获取的欠驱动无人艇当前位置以及欠驱动无人艇前方扇形区域内障碍物位置信息进行势场分析,选择其中具有最小合势场的估算点方向作为势场艏向角,包括:
假定在惯性坐标系下,欠驱动无人艇位于一海域的点P,坐标为X[x,y],当前艏向角为ψ,欠驱动无人艇航行目标为点G,坐标为Xg[xg,yg],该海域存在n个障碍物Aj(j=1,2,...,n),坐标为欠驱动无人艇前m个估算点Mi(i=1,2,...,m),坐标为
当任意一个估算点处于障碍物斥力影响范围ρ0内时,将所述势场分析法应用于人工势场避障算法的势场函数中,令估算点Mi处的引力势场函数为:障碍物Aj在估算点Mi处产生的斥力势场函数为则估算点Mi处的合势场函数为其中katt和krep分别为引力系数和斥力系数,表示估算点Mi与目标点G之间的欧氏距离,表示估算点Mi与障碍物Aj之间的欧氏距离;
计算出m个估算点Mi处的合势场函数值Ui后,将具有最小合势场值的估算点记为Mz,故确定点Mz的方位角ψz为势场艏向角,即ψt+1=ψz。
4.根据权利要求1所述的欠驱动无人艇避障路径规划及控制方法,其特征在于,所述将所述势场艏向角与欠驱动无人艇当前艏向角之间的偏差角以及欠驱动无人艇当前位置引斥比作为两个输入量引入设计的模糊逻辑控制器中,得到欠驱动无人艇下一步运动的避障艏向角,包括:
对输入、输出量的模糊集均采用均匀分布的三角形隶属度函数进行模糊化的处理;
将调整角θf与当前艏向角ψt的和作为欠驱动无人艇下一步运动的避障艏向角ψf,ψf=ψt+θf。
5.根据权利要求4所述的欠驱动无人艇避障路径规划及控制方法,其特征在于,所述的输入量和输出量之间的模糊规则采用if A and B then C的形式构造。
6.根据权利要求1所述的欠驱动无人艇避障路径规划及控制方法,其特征在于,所述设计运动控制器,对所述欠驱动无人艇下一步运动的避障艏向角以及前行速度进行跟踪控制,实现所述欠驱动无人艇无碰撞的航行至目标点,包括:
设计有限时间扰动观测器,具体为:
其中,ξ=[ξu,0,ξr]T是虚拟控制输入,λi、L、q、p均为设计参数,λi>0(i=1,2),L=diag(Lu,0,Lr)且Lj>0(j=u,r),表示欠驱动无人艇速度矢量的观测值,表示外界扰动的观测值,且|x|表示x的绝对值,
基于所述设计的有限时间扰动观测器,设计鲁棒跟踪控制器,具体为:
7.一种欠驱动无人艇避障路径规划及控制系统,其特征在于,所述系统包括:
障碍物探测模块,用于获取欠驱动无人艇当前位置以及欠驱动无人艇前方扇形区域内障碍物位置信息;
势场分析模块,用于对所述获取的欠驱动无人艇当前位置以及欠驱动无人艇前方扇形区域内障碍物位置信息进行势场分析,选择其中具有最小合势场的估算点方向作为势场艏向角;
模糊控制模块,用于将所述势场艏向角与欠驱动无人艇当前艏向角之间的偏差角以及欠驱动无人艇当前位置引斥比作为两个输入量引入设计的模糊逻辑控制器中,得到欠驱动无人艇下一步运动的避障艏向角;
跟踪控制模块,用于对所述欠驱动无人艇下一步运动的避障艏向角以及前行速度进行跟踪控制,实现所述欠驱动无人艇无碰撞的航行至目标点。
8.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质中存储有包括计算机程序,其中,所述计算机程序运行时,执行所述权利要求1至6中任一项所述的方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010647791.2A CN111830978A (zh) | 2020-07-07 | 2020-07-07 | 一种欠驱动无人艇避障路径规划及控制方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010647791.2A CN111830978A (zh) | 2020-07-07 | 2020-07-07 | 一种欠驱动无人艇避障路径规划及控制方法及系统 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN111830978A true CN111830978A (zh) | 2020-10-27 |
Family
ID=72901166
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010647791.2A Pending CN111830978A (zh) | 2020-07-07 | 2020-07-07 | 一种欠驱动无人艇避障路径规划及控制方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111830978A (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112882479A (zh) * | 2021-01-28 | 2021-06-01 | 南通大学 | 一种基于内外角累积状态的路径规划方法 |
CN112947447A (zh) * | 2021-02-10 | 2021-06-11 | 大连理工大学 | 一种基于同步规划-控制策略的水面无人舰艇自主导航方法 |
CN114019984A (zh) * | 2021-12-13 | 2022-02-08 | 大连民族大学 | 一种无人艇及无人艇编队在线航迹规划方法及系统 |
CN115497238A (zh) * | 2022-06-20 | 2022-12-20 | 中国矿业大学 | 基于Wi-Fi探针的被动定位与疏散引导方法及系统 |
CN115494848A (zh) * | 2022-09-30 | 2022-12-20 | 大连海事大学 | 一种规避动静态障碍物的无人船路径跟踪视距制导方法及系统 |
CN116954212A (zh) * | 2023-04-25 | 2023-10-27 | 广东工业大学 | 面向复杂环境的改进D*Lite无人艇路径规划方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2012034119A2 (en) * | 2010-09-11 | 2012-03-15 | Wayne State University | Guidance and control system for under-actuated marine surface ships and other automomous platforms |
CN109358499A (zh) * | 2018-09-25 | 2019-02-19 | 大连海事大学 | 基于速度与航向双重制导的无人船精确路径跟踪控制方法 |
CN110032197A (zh) * | 2019-05-07 | 2019-07-19 | 大连海事大学 | 一种基于有限时间制导和控制的无人船路径跟踪控制方法 |
CN110471425A (zh) * | 2019-08-30 | 2019-11-19 | 大连海事大学 | 一种基于声呐的改进型模糊人工势场无人船避障方法 |
CN111045332A (zh) * | 2019-12-27 | 2020-04-21 | 哈尔滨工程大学 | 一种无人艇路径跟踪导引策略和扰动补偿方法 |
-
2020
- 2020-07-07 CN CN202010647791.2A patent/CN111830978A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2012034119A2 (en) * | 2010-09-11 | 2012-03-15 | Wayne State University | Guidance and control system for under-actuated marine surface ships and other automomous platforms |
CN109358499A (zh) * | 2018-09-25 | 2019-02-19 | 大连海事大学 | 基于速度与航向双重制导的无人船精确路径跟踪控制方法 |
CN110032197A (zh) * | 2019-05-07 | 2019-07-19 | 大连海事大学 | 一种基于有限时间制导和控制的无人船路径跟踪控制方法 |
CN110471425A (zh) * | 2019-08-30 | 2019-11-19 | 大连海事大学 | 一种基于声呐的改进型模糊人工势场无人船避障方法 |
CN111045332A (zh) * | 2019-12-27 | 2020-04-21 | 哈尔滨工程大学 | 一种无人艇路径跟踪导引策略和扰动补偿方法 |
Non-Patent Citations (1)
Title |
---|
杨盐生 等: "不确定系统的鲁棒控制及其应用", 31 October 2003, 大连海事大学出版社, pages: 165 - 168 * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112882479A (zh) * | 2021-01-28 | 2021-06-01 | 南通大学 | 一种基于内外角累积状态的路径规划方法 |
CN112947447A (zh) * | 2021-02-10 | 2021-06-11 | 大连理工大学 | 一种基于同步规划-控制策略的水面无人舰艇自主导航方法 |
CN112947447B (zh) * | 2021-02-10 | 2023-11-24 | 大连理工大学 | 一种基于同步规划-控制策略的水面无人舰艇自主导航方法 |
CN114019984A (zh) * | 2021-12-13 | 2022-02-08 | 大连民族大学 | 一种无人艇及无人艇编队在线航迹规划方法及系统 |
CN115497238A (zh) * | 2022-06-20 | 2022-12-20 | 中国矿业大学 | 基于Wi-Fi探针的被动定位与疏散引导方法及系统 |
CN115497238B (zh) * | 2022-06-20 | 2023-09-01 | 中国矿业大学 | 基于Wi-Fi探针的被动定位与疏散引导方法及系统 |
CN115494848A (zh) * | 2022-09-30 | 2022-12-20 | 大连海事大学 | 一种规避动静态障碍物的无人船路径跟踪视距制导方法及系统 |
CN115494848B (zh) * | 2022-09-30 | 2024-05-03 | 大连海事大学 | 一种规避动静态障碍物的无人船路径跟踪视距制导方法及系统 |
CN116954212A (zh) * | 2023-04-25 | 2023-10-27 | 广东工业大学 | 面向复杂环境的改进D*Lite无人艇路径规划方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111830978A (zh) | 一种欠驱动无人艇避障路径规划及控制方法及系统 | |
CN111399506B (zh) | 一种基于动力学约束的全局-局部混合无人船路径规划方法 | |
Ruiz et al. | Concurrent mapping and localization using sidescan sonar | |
Maki et al. | Navigation method for underwater vehicles based on mutual acoustical positioning with a single seafloor station | |
CN113759936B (zh) | 一种适用于动态目标跟踪的比例导引法与人工势场法相结合的路径规划方法 | |
CN113084817B (zh) | 扰流环境下水下机器人的物体搜索及抓取控制方法 | |
Teck et al. | Single beacon cooperative path planning using cross-entropy method | |
Xu et al. | A novel self-adapting filter based navigation algorithm for autonomous underwater vehicles | |
Zeng et al. | Exploiting ocean energy for improved AUV persistent presence: path planning based on spatiotemporal current forecasts | |
Li et al. | A research of multiple autonomous underwater vehicles cooperative target hunting based on formation control | |
Cai et al. | Long-range UWB positioning-based automatic docking trajectory design for unmanned surface vehicle | |
Feng et al. | Automatic tracking method for submarine cables and pipelines of AUV based on side scan sonar | |
CN114879660A (zh) | 一种基于目标驱动的机器人环境感知方法 | |
CN110471425B (zh) | 一种基于声呐的改进型模糊人工势场无人船避障方法 | |
Li et al. | Terrain correlation correction method for AUV seabed terrain mapping | |
Vvekanandan et al. | Autonomous underwater docking using flow state estimation and model predictive control | |
Sotnikova et al. | Algorithms for motion optimization on a given trajectory taking into account weather forecast and constraints | |
CN117369441A (zh) | 一种考虑船舶运动学和CORLEGs的自适应智能船舶路径规划方法 | |
CN115480580A (zh) | 一种基于nmpc的水下机器人路径跟踪与避障的控制方法 | |
CN112799414B (zh) | 一种auv松弛轨迹规划方法 | |
Praczyk | Correction of navigational information supplied to biomimetic autonomous underwater vehicle | |
Bykova et al. | Safe navigation algorithm for autonomous underwater vehicles | |
Cristi et al. | Motion estimation and modeling of the environment for underwater vehicles | |
Williams et al. | Field deployment of the simultaneous localisation and mapping algorithm | |
Saúde et al. | Single beacon acoustic navigation for an AUV in the presence of unknown ocean currents |
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 |