CN113885534B - 一种基于智能预测控制的水面无人船路径跟踪方法 - Google Patents
一种基于智能预测控制的水面无人船路径跟踪方法 Download PDFInfo
- Publication number
- CN113885534B CN113885534B CN202111399939.6A CN202111399939A CN113885534B CN 113885534 B CN113885534 B CN 113885534B CN 202111399939 A CN202111399939 A CN 202111399939A CN 113885534 B CN113885534 B CN 113885534B
- Authority
- CN
- China
- Prior art keywords
- unmanned ship
- path
- value
- artificial fish
- control
- 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
- 238000000034 method Methods 0.000 title claims abstract description 101
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 title claims abstract description 24
- 241000251468 Actinopterygii Species 0.000 claims abstract description 93
- 238000001914 filtration Methods 0.000 claims abstract description 34
- 238000005457 optimization Methods 0.000 claims abstract description 14
- 230000000295 complement effect Effects 0.000 claims abstract description 11
- 230000004927 fusion Effects 0.000 claims abstract description 10
- 230000009471 action Effects 0.000 claims abstract description 7
- 230000000007 visual effect Effects 0.000 claims description 59
- 230000006870 function Effects 0.000 claims description 27
- 230000008569 process Effects 0.000 claims description 19
- 230000001133 acceleration Effects 0.000 claims description 16
- 239000011159 matrix material Substances 0.000 claims description 12
- 230000002431 foraging effect Effects 0.000 claims description 11
- 238000005096 rolling process Methods 0.000 claims description 9
- 230000003044 adaptive effect Effects 0.000 claims description 8
- 230000033001 locomotion Effects 0.000 claims description 8
- 238000012545 processing Methods 0.000 claims description 7
- 230000006399 behavior Effects 0.000 claims description 6
- 238000011217 control strategy Methods 0.000 claims description 6
- 230000019637 foraging behavior Effects 0.000 claims description 6
- 230000005484 gravity Effects 0.000 claims description 6
- 238000013016 damping Methods 0.000 claims description 5
- 238000004891 communication Methods 0.000 claims description 4
- 238000005259 measurement Methods 0.000 claims description 4
- 230000008447 perception Effects 0.000 claims description 4
- 238000012937 correction Methods 0.000 claims description 3
- 238000010606 normalization Methods 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 238000010187 selection method Methods 0.000 claims 1
- 230000003111 delayed effect Effects 0.000 abstract description 2
- 230000000694 effects Effects 0.000 description 7
- 238000010586 diagram Methods 0.000 description 5
- 238000006243 chemical reaction Methods 0.000 description 3
- 238000009825 accumulation Methods 0.000 description 1
- 230000006978 adaptation Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000007499 fusion processing Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
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
技术领域
本发明涉及水面无人船路径跟踪技术领域,具体涉及一种基于智能预测控制的水面无人船路径跟踪方法。
背景技术
近年来,海上搜救趋向智能化,在我国大部分近海海域、河流、湖泊、水库、运河等地区,几乎还是采用人工搜救;但是人工搜救存在一些弊端,对于一些环境比较恶劣的区域,救援人员存在人身安全问題,严重影响救援进度,水面无人船船体不大,方便的航行在各种水域,受外界约束较小,具有非常高的灵活性,对无人船的操作也非常的简单,利用水面无人船搭载救生圈和图像传输设备参与搜救,大大提高了搜救效率,在水面搜救领域发挥着极其广泛的作用;为了精确高效地完成任务,同时考虑到无人船的欠驱动性和受时变风浪流扰动对其操纵性的影响,在实际应用中,对无人船按预设期望路径跟踪的能力要求越来越高。
通常路径跟踪控制***分为制导子***和控制子***,在制导子***中,无人船的速度通常预定为常量,申请号为201910436861.7的专利文献公开了“一种水面无人艇路径跟踪控制方法”,文献中提出的视线制导算法将三个自由度转换为两个自由度的控制,能快速计算出期望舵角,但是,该方法不能自动调整接纳圆半径,会使无人船偏离目标路径。
在控制子***中,常用控制方法有自适应控制、滑模控制、模糊控制、最优控制、预测控制等,其中,Ashrafiuon H等人基于滑模控制的方法设计了一种轨迹跟踪控制器,但***控制器受抖动的影响,很大程度上影响到***的稳定性。 Li等人考虑舵机执行器饱和约束和运动速率约束的条件下利用模型预测控制 (MPC)实现了对四自由度船舶的跟踪控制,该方法抗干扰能力好,但对参数设置、目标函数求解和模型精度要求比较高。
因此,一方面,海洋环境中的风浪流变化带来的未知扰动引起的不确定性使现有的一些常用的控制方法很难达到理想的路径跟踪效果;另一方面,控制器中使用传统的目标函数求解方法,精度不高,不能保证设计的路径跟随控制器的效果达到最佳。
发明内容
本发明旨在提出一种基于智能预测控制的水面无人船路径跟踪方法,目的在于提高无人船按预设期望路径跟踪的能力,本发明提出改进的自适应视线法、人工鱼群算法和模型预测控制算法结合的方法进行路径跟踪控制;在数据融合方面,本发明提出互补滤波算法,并设置阈值增量约束对互补滤波算法进行改进,解决上电期间,数据偏差较大和无人船在高速航行时,陀螺仪数据漂移的问题;在制导方面,考虑到无人船在恶劣环境中转向时,容易受外界干扰,船身发生较大的抖动,进入接纳圆时,会发生转向提前或滞后,本发明提出自适应视线法,该算法能自动调整接纳圆半径,快速求解出期望航向角,使无人船有充分时间调整航向,平缓的完成转向动作,避免偏离目标路径;在控制方面,本发明提出了模型预测控制的方法来提高控制***的鲁棒性和抗干扰能力,为了提高控制器的路径跟踪精度,本发明提出改进的人工鱼群优化算法对模型预测控制器中的目标函数进行全局寻优,寻找出最优控制序列,将控制序列中的第一个控制分量作用到无人船;本发明设计的路径跟踪控制方法能使水面无人船在复杂多变的海域上开展安全、高效、精准的搜救工作。
本发明的目的通过以下技术方案予以实现:
一种基于智能预测控制的水面无人船路径跟踪的控制方法,包括以下步骤:
步骤1:下位机接收北斗、惯性导航传感器的数据,并进行解析,得到无人船的当前经纬度坐标、航速、艏向角等信息,设置阈值增量约束改进互补滤波算法,对艏向角进行滤波处理,将滤波后的数据将进行转化,得到北东地坐标系下的状态信息;
步骤2:按照无人船作业任务预先规划出航行路径点,然后连接各个航行路径点形成一条期望路径曲线作为跟踪的路径,根据无人船初始状态,计算出每个路径点的最优接纳圆半径;
步骤3:根据状态信息进行航向规划并利用自适应视线法解算出期望航向角;
步骤4:进行路径段的更新,在当前路径点时,若无人船在自适应的接纳圆内,则跟踪下一路径点;
步骤5:在航速给定的情况下,将当前艏向角与期望航向角的误差作为模型预测控制器的输入,设计基于模型预测控制的路径跟踪控制器,通过构建预测模型,以滚动优化确定当前的最优控制策略,使未来一段时间内被控变量与期望值偏差最小,再进行反馈校正,解算出对应推进器的转速指令来调整动作,来缩小并消除误差;
步骤6:本发明引入人工鱼群算法,把目标函数倒数作为人工鱼群算法的适应度函数,并对该算法进行改进,在觅食阶段,将视野范围扩大后,在新的视野范围内,再次进行搜索,寻找适应度高的人工鱼,并向该方向前进一步;
步骤7:通过改进的人工鱼群算法解算出最优控制增量序列中的第一个控制增量分量,将其作用到无人船,在下一时刻,根据导航传感器的实时状态,判断无人船是否到达终点,如果没有到达,将其信息与下一时刻期望路径点的状态信息的差值作为模型预测控制器的输入,形成反馈,构成闭环控制。
本发明的目的还可以通过以下技术措施来进一步实现:
进一步的,步骤(1)具体包括:
步骤(1.1):下位机通过RS232通信协议接收北斗、惯性导航传感器的数据,并进行解析;
步骤(1.2):初始化参数;
步骤(1.3):获取加速度计实测值,并进行归一化处理,转换成单位向量;
步骤(1.4):利用陀螺仪更新方向余弦矩阵:
式中,为加速度分量,/>为四元素分量;
步骤(1.5):将标准重力加速度向量与加速度测量值向量进行叉乘,得到误差向量:
式中,为误差向量,/>为角速度分量,/>为加速度分量;
步骤(1.6):通过PID控制器对误差进行消除,得到当前时刻无人船艏向角的滤波值,控制器公式如下:
式中,ez(t)为艏向角误差,Δez(t)为艏向角补偿量,kp为比例系数,Ti为积分系数,Td为微分系数;
步骤(1.7):采用一阶龙格库塔法进行四元素更新:
式中,为四元素分量,/>为角速度分量,T为采样时间;
步骤(1.8):保留上一时刻的滤波值;
步骤(1.9):本发明对互补滤波算法进行了改进:设置阈值增量约束将当前时刻和上一时刻滤波差值与阈值增量约束进行比较,若满足则输出结果,否则重新执行,判定公式如下:
|xnow-xlast|≤β (5)
式中,xnow为当前滤波值,xlast为上一时刻滤波值,β为阈值增量约束,选取范围为[0,1];
步骤(1.10):将机体坐标系下的当前状态信息进行转化处理,得到北东地坐标系下的状态信息。
进一步的,步骤(2)具体包括:
步骤(2.1):将路径离散为按顺序散布在路径上的路径点,提取每个直线路径单元上的实时参考路径:
式中,(xr,yr)是实时参考路径点坐标,(xn,yn)为预定的第n个航迹点坐标, (x,y)为无人船实时位置,θn为连接航迹点(xn,yn)与(xn+1,yn+1)的路径方位角,为自适应接纳圆半径;
步骤(2.2):根据无人船初始状态,计算出每个路径点的最优接纳圆半径,以下是自适应接纳圆半径的选取方法:
式中,L为船舶的长度,η为待定系数,选取范围为[1,5],为自适应接纳圆的半径,Rmin为待定系数,选取船舶长度的1~2倍,Rmax为待定系数,选取船舶长度的3~5倍,θ为相邻路径夹角,γ为缓冲系数,选取范围为[-1,1]。
进一步的,步骤(3)具体包括:
利用自适应视线法,以当前位置为中心,选取无人船船长的3~5倍为半径,确定视距点Plos,解算出期望航向角,公式如下:
式中,(xlos,ylos)为视距位置,(x,y)为当前位置,ψlos为期望航向角。
进一步的,步骤(4)具体包括:
在选择路径Pn+1时,判断无人船是否在自适应接纳圆内,如果满足公式,将选择跟踪下一路径Pn+1,公式如下:
式中:为自适应接纳圆的半径,(xn,yn)为预定的第n个航迹点坐标,(x,y) 为当前位置。
进一步的,步骤(5)具体包括:
步骤(5.1):建立3自由度的非线性欠驱动无人船操纵模型:
式中,x,y,ψ是船舶在北东坐标下的位置,u,v,r是船体坐标系下的速度,τu是推进器的力矩,τδ是舵机或双推进器差速下的偏航力矩,m是船舶的质量,Izz 是绕OZ轴的转动惯量,是船舶在纵荡、横荡、艏摇3个方向上加速度引起的附加质量,定义为负数,Xu,Yv,Nr分别为船舶在各个方向上的水动力阻尼系数;
步骤(5.2):对欠驱动无人船操纵模型在期望路径点(xR,uR)处进行一阶泰勒展开线性化处理,得到如下的预测模型:
式中,A、B为雅可比矩阵;
步骤(5.3):对模型进行线性化和离散化处理,得到控制增量形式的状态空间模型:
式中,
步骤(5.4):进行约束条件设置,在当前时刻及预测时域内,对控制增量、控制量、输出量进行如下限制:
Δumin≤Δu(k+i)≤Δumax,i=0,1,2,...,NC-1 (20)
umin≤u(k+i)≤umax,i=0,1,2,...,NC-1 (21)
ymin≤y(k+i)≤ymax,i=0,1,2,...,Np (22)
式中,NC是控制时域,Np是预测时域,Δu(k+i)为k+i时刻的控制增量, u(k+i)为k+i时刻的控制量,y(k+i)为k+i时刻的输出量,Δu min是控制增量最小值,Δumax是控制增量最大值,umin是控制量最小值,umax是控制量最大值,根据推进器机械性能选取。ymin是输出量最小值,ymax是输出量最大值;
步骤(5.5):滚动优化确定当前的最优控制策略,使未来一段时间内被控变量与期望值偏差最小,构建关于***的状态量偏差和控制增量的目标函数,通过改进的人工鱼群算法优化最优控制序列,输出第一个控制分量作用到无人船上,目标函数如下:
J=(Y-Yref)TQ(Y-Yref)+ΔUTRΔU (23)
式中,Y为当前时刻的输出值,Yref为自适应视线法处理后的期望值,ΔU为控制增量,Q和R为权重矩阵,选取主对角线的值为整数并小于100的对角矩阵,J为性能指标;
步骤(5.6):等待无人船接收下一时刻的定位、姿态数据作为反馈信息。
进一步的,步骤(6)具体包括:
步骤(6.1):选取目标函数的倒数作为适应度函数,对鱼群进行初始化,设置最大尝试次数为20,初始视野感知距离为1,拥挤因子δ为0.6,初始移动步长为0.1,最大迭代次数为50,适应度函数如下:
式中,h(ΔU)为适应度值,Y为当前时刻的输出值,Yref为自适应视线法处理后的期望值,ΔU为控制增量,Q和R为权重矩阵,选取主对角线的值为整数并小于100的对角矩阵,J为性能指标;
步骤(6.2):计算初始鱼群个体的适应值,取最优人工鱼状态及其值赋予给公告牌;
步骤(6.3):进行觅食行为,本发明对人工鱼群算法进行了改进,在觅食阶段,当人工鱼用完尝试次数时,将视野范围扩大,增加寻优的机会,改进后的具体觅食方法如下:将视野扩大前的人工鱼适应度值与其视野感知范围内随机一条人工鱼的适应度值进行比较,如果比当前人工鱼的适应度高,则向适应度高的人工鱼方向移动一步,否则,随机选择另一条人工鱼进行比较,反复尝试20次后,如果仍不满足前进条件,将视野范围扩大λ倍,新的视野公式如下:
visualnew=(1+λ)visual (25)
式中:visualnew是扩大以后的视野,visual是扩大前的视野,λ为待定系数,一般取50%~80%,
在新的视野范围内,再次进行搜索,尝试次数用完后,如果搜索到适应度更高的位置,则向该方向移动一步,若没有搜索到适应度更高的位置,则执行随机移动一步;
步骤(6.4):进行聚群行为,在探索当前人工鱼视野范围内,满足下面公式时,表明中心不太拥挤,朝着中心位置前进一步,否则,进行觅食行为,公式如下:
Yc/Nf>δYi1 (26)
式中,Yc是中心位置人工鱼的适应度值,Nf是当前视野中的人工鱼数目,δ是拥挤因子,Yi1是人工鱼的当前状态适应度值;
步骤(6.5):进行追尾行为,在探索当前人工鱼视野范围内,满足下面公式时,表明视野范围内随机选择的人工鱼周围不太拥挤,朝着该方向前进一步,否则,进行觅食行为,公式如下:
Yj2/Nf>δYi2 (27)
式中,Yj2是视野范围内随机选择的人工鱼适应度值,Nf是当前视野中的人工鱼数目,δ是拥挤因子,Yi2是人工鱼的当前状态适应度值;
步骤(6.6):进行随机行为,在新的视野范围中随机选择一个状态,然后向该方向移动,公式如下:
Xi|next=Xi3+round·Visualnew (28)
式中:Xi|next为Xi3的下一个状态,Xi3为当前人工鱼的状态,Visualnew是扩大以后的视野,round是[-1,1]区间的随机数;
步骤(6.7):对所有人工鱼个体进行评价,若某个体优于公告牌,则将公告牌更新为该个体;
步骤(6.8):当公告牌上最优解达到满意误差界内或者达到迭代次数上限时算法结果时,输出最优控制增量序列:
ΔU*=[Δu(t|t)* Δu(t+1|t)* ··· Δu(t+Nc-1|t)*] (29)
式中,Δu(t+i|t)*为t+i时刻的最优控制增量分量,i=1,2,···,Nc+1,ΔU*为最优控制增量序列。
进一步的,步骤(7)具体包括:
将控制增量序列中的第一个控制增量分量作用无人船,在下一时刻,对无人船的状态信息进行采集,判断无人船是否到达终点,如果没有到达,将其信息与下一时刻期望路径点的状态信息的差值作为模型预测控制器的输入,形成反馈,构成闭环控制,如果到达最后一个期望路径点,则终止循环。
与现有技术相比,本发明的有益效果是:
1、本发明提出改进的自适应视线法、人工鱼群算法和模型预测控制相结合的方法(Adaptive LOS-AFSA-MPC)进行路径跟踪,该方法能使***快速响应并收敛,提高了控制器的动态特性,具有良好的跟踪效果。
2、针对姿态解算数据不稳定和精度不高的问题,本发明提出互补滤波算法,该方法简单,不需要建立模型,能消除高频噪声和低频误差的累积,滤波效果好,提高传感器的测量精度。
3、本发明提出数据融合算法,设置阈值增量约束,对互补滤波算法进行改进,解决了上电期间,数据偏差较大和无人船在高速航行时,陀螺仪数据漂移的问题,改进后的方法能避免艏向角出现较大的波动,使数据融合后得到的曲线更加平滑。
4、针对无人船在恶劣环境中转向时,容易受外界干扰,船身发生较大的抖动,进入接纳圆时,会出现转向提前或滞后的问题,本发明提出自适应视线算法,该算法能自动调整接纳圆半径,使无人船有充分时间调整航向,平缓的完成转向动作,避免偏离目标路径,提高制导精度。
5、本发明提出模型预测控制方法设计跟踪艏向角的控制器,该方法采用滚动优化的策略,有较好的动态控制性能,且该方法设计的闭环控制***有很强的抗扰动能力。
6、在设计基于模型预测控制的路径跟踪控制器时,考虑到用传统的目标函数求解方法,会带来精度不高的问题,导致控制器路径跟踪效果不佳,本发明提出改进的人工鱼群算法对目标函数进行全局寻优,该方法对参数设定要求不高,能快速得到可行解,能有效提高控制精度。
7、在人工鱼群算法的各个行为中都涉及到了视野,当视野范围越大,人工鱼越容易发现全局极值并收敛,本发明对人工鱼群算法进行了改进,在觅食阶段,当人工鱼用完尝试次数时,将视野范围扩大,增加寻优的机会,提高整个算法的收敛速度。
附图说明
图1是无人船的控制***结构框图;
图2是数据融合算法流程图;
图3是坐标系转换图;
图4是自适应视线法原理图;
图5是模型预测控制算法流程图;
图6是人工鱼视觉描述图;
图7是人工鱼群算法最优化求解算法流程图。
具体实施方式
下面结合附图对本发明的具体实施方式进行说明。
如图1所示,是无人船的控制***结构框图,在无人船路径跟踪过程中,首先,通过惯性导航传感器测得姿态数据,提出数据融合算法,设置阈值增量约束,改进互补滤波算法,对艏向角进行滤波处理;然后,根据期望路径点的位置和由北斗测得的无人船实时位置,提出自适应视线法,计算出最优接纳圆半径,解算出无人船的期望航向角;接着,在速度给定的条件下,将滤波反馈值与期望航向角的误差作为模型预测控制器的输入;最后,提出改进的人工鱼群算法对模型预测控制器中的目标函数进行全局寻优,解算出的第一个控制分量作为控制器的输出,从而实现对无人船的路径跟踪控制。
步骤1:如图2所示,是数据融合算法流程图,首先,下位机通过RS232通信协议接收北斗、惯性导航传感器的数据,进行解析,得到无人船的当前经纬度坐标、航速、艏向角等信息,接着,对艏向角进行数据融合处理,最后,进行转化得到北东地坐标系下的状态信息,如图3所示,坐标系转换图,对艏向角的融合滤波算法具体包括以下步骤:
步骤1.1:下位机通过RS232通信协议接收北斗、惯性导航传感器的数据,并进行解析;
步骤1.2:初始化姿态参数;
步骤1.3:获取加速度计实测值,并进行归一化处理,转换成单位向量;
步骤1.4:利用陀螺仪更新方向余弦矩阵得到标准重力加速度在机体坐标中的表示:
式中,为加速度分量,/>为四元素分量;
步骤1.5:将机体坐标系中的标准重力加速度向量与处理后的加速度测量值向量进行叉乘,得到误差向量:
式中,为误差分量,/>为角速度分量,/>为加速度分量;
步骤1.6:通过PID控制器对误差进行消除,得到当前时刻无人船艏向角的滤波值,控制器公式如下:
式中,ez(t)为艏向角误差,Δez(t)为艏向角补偿量,kp为比例系数,Ti为积分系数,Td为微分系数;
步骤1.7:采用一阶龙格库塔法进行四元素更新:
式中,为四元素分量,/>为角速度分量,T为采样时间;
步骤1.8:保留上一时刻的滤波值;
步骤1.9:针对初始上电期间,数据偏差较大和无人船高速航行时,陀螺仪数据漂移的问题,本发明对互补滤波算法进行改进,设置阈值增量约束,将当前时刻和上一时刻滤波差值与阈值增量约束进行比较,若满足则输出结果,否则重新执行,该方法能避免艏向角出现较大的波动,使数据融合后的曲线更加平滑,提高导航传感器的测量精度,判定公式如下:
|xnow-xlast|≤β (5)
式中,xnow为当前滤波值,xlast为上一时刻滤波值,β为阈值增量约束,选取范围为[0,1];
步骤1.10:将机体坐标系下的当前状态信息进行转化处理,得到北东地坐标系下的状态信息。
步骤2:如图4所示,是自适应视线法原理图,根据无人船作业任务预先规划出航行路径点,然后连接各个航行路径点形成一条期望路径曲线作为跟踪的路径,考虑到无人船在恶劣环境中转向时,容易受外界干扰,船身发生较大的抖动,进入接纳圆时,接纳圆半径过小,会发生转向滞后;接纳圆半径过大,会过早跟踪下一路径,本发明提出自适应视线法,根据无人船初始状态,计算出每个路径点的自动接纳圆半径,该方法能使无人船有充分时间调整航向,平缓的完成转向动作,避免偏离目标路径,自适应调整接纳圆半径具体包括以下步骤:
步骤2.1:将路径离散为按顺序散布在路径上的路径点,提取每个直线路径单元上的实时参考路径:
式中,(xr,yr)是实时参考路径点坐标,(xn,yn)为预定的第n个航迹点坐标, (x,y)为无人船实时位置,θn为连接航迹点(xn,yn)与(xn+1,yn+1)的路径方位角,为自适应接纳圆的半径;
步骤2.2:根据无人船初始状态,计算出每个路径点的最优接纳圆半径,以下是自适应接纳圆半径的选取方法:
式中,L为船舶的长度,η为待定系数,选取范围为[1,5],为自适应接纳圆的半径,Rmin为待定系数,选取船舶长度的1~2倍,Rmax为待定系数,选取船舶长度的3~5倍,θ为相邻路径夹角,γ为缓冲系数,选取范围为[-1,1]。
步骤3:利用自适应视线法,以当前位置为中心,选取无人船船长的3~5倍为半径,确定视距点Plos,解算出期望航向角,公式如下:
式中,(xlos,ylos)为视距位置,(x,y)为当前位置,ψlos为期望航向角。
步骤4:路径段更新,在选择路径Pn+1时,判断无人船是否在自适应接纳圆内,如果满足公式,将选择跟踪下一路径Pn+1。公式如下:
式中:为自适应接纳圆的半径,(xn,yn)为预定的第n个航迹点坐标,(x,y) 为当前位置。
步骤5:如图5所示,是模型预测控制算法流程图,在航速给定的情况下,将当前艏向角与期望航向角的误差作为模型预测控制器的输入,设计基于模型预测控制的路径跟踪控制器,通过构建预测模型,以滚动优化确定当前的最优控制策略,使未来一段时间内被控变量与期望值偏差最小,再进行反馈校正,解算出对应推进器的转速指令来调整动作,来缩小并消除误差,提出的模型预测控制方法包括以下步骤:
步骤5.1:本发明考虑坐标原点在重心处,忽略无人船的横摇、纵摇以及升降运动带来的影响,忽略在运动过程中的水流附加质量与水动力带来的附加科里奥利向心力,忽略非线性阻尼的影响,得到3自由度的非线性欠驱动无人船操纵模型如下:
式中,x,y,ψ是船舶在北东坐标下的位置,u,v,r是船体坐标系下的速度,τu是推进器的力矩,τδ是舵机或双推进器差速下的偏航力矩,m是船舶的质量,Izz 是绕OZ轴的转动惯量,是船舶在纵荡、横荡、艏摇3个方向上加速度引起的附加质量,定义为负数,Xu,Yv,Nr分别为船舶在各个方向上的水动力阻尼系数;
步骤5.2:对欠驱动无人船操纵模型在期望路径点(xR,uR)处进行一阶泰勒展开线性化处理,得到如下的预测模型:
式中,A、B为雅可比矩阵;
步骤5.3:为了得到离散化状态方程,本发明采用前向欧拉的方法对该模型进行离散化处理,并化简为用控制增量形式表示的状态空间模型:
/>
式中,
步骤5.4:进行约束条件设置,一方面,无人船的推进器受机械性能的影响,转速过小或过大都可能导致推进器无法正常工作;另一方面,为了减少能量的消耗和确保状态量偏差不宜过大;在当前时刻及预测时域内,对控制增量、控制量、输出量进行如下限制:
Δumin≤Δu(k+i)≤Δumax,i=0,1,2,...,NC-1 (20)
umin≤u(k+i)≤umax,i=0,1,2,...,NC-1 (21)
ymin≤y(k+i)≤ymax,i=0,1,2,...,Np (22)
式中,NC是控制时域,Np是预测时域,Δu(k+i)为k+i时刻的控制增量, u(k+i)为k+i时刻的控制量,y(k+i)为k+i时刻的输出量,Δumin是控制增量最小值,Δumax是控制增量最大值,umin是控制量最小值,umax是控制量最大值,根据推进器机械性能选取。ymin是输出量最小值,ymax是输出量最大值;
步骤5.5:滚动优化确定当前的最优控制策略,使未来一段时间内被控变量与期望值偏差最小,构建关于***的状态量偏差和控制增量的目标函数,通过改进的人工鱼群算法优化最优控制序列,输出第一个控制分量作用到无人船上,目标函数如下:
J=(Y-Yref)TQ(Y-Yref)+ΔUTRΔU (23)
式中,Y为当前时刻的输出值,Yref为自适应视线法处理后的期望值,ΔU为控制增量,Q和R为权重矩阵,选取主对角线的值为整数并小于100的对角矩阵,J为性能指标;
步骤5.6:等待无人船接收下一时刻的定位、姿态数据作为反馈信息。
步骤6:考虑到人工调整预测和控制时域可能带来路径跟踪效果不佳的问题,本发明引入人工鱼群算法,人工鱼群算法模拟鱼群的觅食行为而实现全局寻优,如图6所示,是人工鱼视觉描述图,将目标函数倒数作为人工鱼群算法的适应度函数,进行全局寻优求解,本发明对该算法进行改进,在觅食阶段,将视野范围扩大后,在新的视野范围内,再次进行搜索,寻找适应度高的人工鱼,并向该方向前进一步,改进后的方法能提高整个算法的收敛速度,如图7所示,是人工鱼群算法最优化求解算法流程图;
具体改进的人工鱼群算法包括以下步骤:
步骤6.1:选取目标函数的倒数作为适应度函数,对鱼群进行初始化。设置最大尝试次数为20,初始视野感知距离为1,拥挤因子δ为0.6,初始移动步长为0.1,最大迭代次数为50。适应度函数如下:
式中,h(ΔU)为适应度值,Y为当前时刻的输出值,Yref为自适应视线法处理后的期望值,ΔU为控制增量,Q和R为权重矩阵,选取主对角线的值为整数并小于100的对角矩阵,J为性能指标;
步骤6.2:计算初始鱼群各个个体的适应度值,取最优人工鱼的状态及其适应度值赋予给公告牌;
步骤6.3:进行觅食行为,将视野扩大前人工鱼的适应度值与其视野感知范围内随机一条人工鱼的适应度值进行比较,如果比当前人工鱼的适应度高,则向适应度高的人工鱼方向移动一步,否则,随机选择另一条人工鱼进行比较,反复尝试20次后,如果仍不满足前进条件,将视野范围扩大λ倍,新的视野公式如下:
visualnew=(1+λ)visual (25)
式中:visualnew是扩大以后的视野,visual是扩大前的视野,λ为待定系数,一般取50%~80%;
在新的视野范围内,再次进行搜索,尝试次数用完后,如果搜索到适应度更高的位置,则向该方向移动一步;若没有搜索到适应度更高的位置,则执行随机移动一步;
步骤6.4:进行聚群行为,在探索当前人工鱼视野范围内,满足下面公式时,表明中心不太拥挤,朝着中心位置前进一步,否则,进行觅食行为,公式如下:
Yc/Nf>δYi1 (26)
式中,Yc是中心位置人工鱼的适应度值,Nf是当前视野中的人工鱼数目,δ是拥挤因子,Yi1是人工鱼的当前状态适应度值;
步骤6.5:进行追尾行为,在探索当前人工鱼视野范围内,满足下面公式时,表明视野范围内随机选择的人工鱼周围不太拥挤,朝着该方向前进一步,否则,进行觅食行为,公式如下:
Yj2/Nf>δYi2 (27)
式中,Yj2是视野范围内随机选择的人工鱼适应度值,Nf是当前视野中的人工鱼数目,δ是拥挤因子,Yi2是人工鱼的当前状态适应度值;
步骤6.6:进行随机行为,在新的视野范围中随机选择一个状态,然后向该方向移动,公式如下:
Xi|next=Xi3+round·Visualnew (28)
式中:Xi|next为Xi3的下一个状态,Xi3为当前人工鱼的状态,Visualnew是扩大以后的视野,round是[-1,1]区间的随机数;
步骤6.7:对所有人工鱼个体进行评价,若某个体优于公告牌,则将公告牌更新为该个体;
步骤6.8:当公告牌上最优解达到满意误差界内或者达到迭代次数上限时算法结果时,输出最优控制增量序列:
ΔU*=[Δu(t|t)* Δu(t+1|t)* ··· Δu(t+Nc-1|t)*] (29)
式中,Δu(t+i|t)*为t+i时刻的最优控制增量分量,i=1,2,···,Nc+1,ΔU*为最优控制增量序列。
步骤7:解算出最优控制增量序列中第一个控制增量分量对应的推进器转速值,将其作用到无人船的推进***,进行航向调整,在下一时刻,通过北斗和惯性导航传感器接收无人船的状态信息,判断无人船是否到达终点,如果没有到达,将其信息与下一时刻期望路径点的状态信息的差值作为模型预测控制器的输入,形成反馈,构成闭环控制,使得控制***具有很强的抗扰动和克服***不确定性的能力,如果到达最后一个期望路径点,则终止循环。
综上所述,本发明所提到的方法能有效提高导航精度和控制器的抗干扰能力,具有较好的路径跟踪效果和现实意义。
除上述实施例外,本发明还可以有其他实施方式,凡采用等同替换或等效变换形成的技术方案,均落在本发明要求的保护范围内。
Claims (8)
1.一种基于智能预测控制的水面无人船路径跟踪方法,其特征在于,具体的实现步骤为:
步骤1.下位机接收北斗、惯性导航传感器的数据,并进行解析,得到无人船的当前经纬度坐标、航速、艏向角,设置阈值增量约束改进互补滤波算法,对艏向角进行滤波处理;将滤波后的数据将进行转化,得到北东地坐标系下的状态信息;
步骤2.按照无人船作业任务预先规划出航行路径点,然后连接各个航行路径点形成一条期望路径曲线作为跟踪的路径,根据无人船初始状态,计算出每个路径点的自动接纳圆半径;
步骤3.根据状态信息进行航向规划并利用自适应视线法解算出期望航向角;
步骤4.进行路径段的更新,在当前路径点时,若无人船在自适应的接纳圆内,则跟踪下一路径点;
步骤5.在航速给定的情况下,将当前艏向角与期望航向角的误差作为模型预测控制器的输入,设计基于模型预测控制的路径跟踪控制器,通过构建预测模型,以滚动优化确定当前的最优控制策略,使未来一段时间内被控变量与期望值偏差最小,再进行反馈校正,解算出对应推进器的转速指令来调整动作,来缩小并消除误差;
步骤6.把目标函数倒数作为人工鱼群算法的适应度函数,并对人工鱼群算法进行改进,在觅食阶段,将视野范围扩大后,在新的视野范围内,再次进行搜索,寻找适应度高的人工鱼,并向该方向前进一步;
步骤7.通过改进的人工鱼群算法解算出最优控制增量序列中的第一个控制增量分量,将其作用到无人船,在下一时刻,根据导航传感器的实时状态,判断无人船是否到达终点,如果没有到达,将其信息与下一时刻期望路径点的状态信息的差值作为模型预测控制器的输入,形成反馈,构成闭环控制。
2.根据权利要求1所述的一种基于智能预测控制的水面无人船路径跟踪方法,其特征在于,所述步骤1对艏向角的融合滤波算法具体步骤为:
步骤1.1:下位机通过RS232通信协议接收北斗、惯性导航传感器的数据,并进行解析;
步骤1.2:初始化姿态参数;
步骤1.3:获取加速度计实测值,并进行归一化处理,转换成单位向量;
步骤1.4:利用陀螺仪更新方向余弦矩阵:
式中,为加速度分量,/>为四元素分量;
步骤1.5:将标准重力加速度向量与加速度测量值向量进行叉乘,得到如下的误差向量:
式中,为误差分量,/>为角速度分量,/>为加速度分量;
步骤1.6:通过PID控制器对误差进行消除,得到当前时刻无人船艏向角的滤波值,控制器公式如下:
式中,ez(t)为艏向角误差,Δez(t)为艏向角补偿量,kp为比例系数,Ti为积分系数,Td为微分系数;
步骤1.7:采用一阶龙格库塔法进行四元素更新:
式中,为四元素分量,/>为角速度分量,T为采样时间;
步骤1.8:保留上一时刻的滤波值;
步骤1.9:对互补滤波算法进行改进:设置阈值增量约束将当前时刻和上一时刻滤波差值与阈值增量约束进行比较,若满足则输出结果,否则重新执行,判定公式如下:
|xnow-xlast|≤β (5)
式中,xnow为当前滤波值,xlast为上一时刻滤波值,β为阈值增量约束,选取范围为[0,1];
步骤1.10:将机体坐标系下的当前状态信息进行转化处理,得到北东地坐标系下的状态信息。
3.根据权利要求1所述的一种基于智能预测控制的水面无人船路径跟踪方法,其特征在于,所述步骤2自适应调整接纳圆半径的具体步骤为:
步骤2.1.将路径离散为按顺序散布在路径上的路径点,提取每个直线路径单元上的实时参考路径:
式中,(xr,yr)是实时参考路径点坐标,(xn,yn)为预定的第n个航迹点坐标,(x,y)为无人船实时位置,θn为连接航迹点(xn,yn)与(xn+1,yn+1)的路径方位角,为自适应接纳圆半径;
步骤2.2.根据无人船初始状态,计算出每个路径点的最优接纳圆半径,以下是自适应接纳圆半径的选取方法:
式中,L为船舶的长度,η为待定系数,选取范围为[1,5],为自适应接纳圆的半径,Rmin为待定系数,选取船舶长度的1~2倍,Rmax为待定系数,选取船舶长度的3~5倍,θ为相邻路径夹角,γ为缓冲系数,选取范围为[-1,1]。
4.根据权利要求1所述的一种基于智能预测控制的水面无人船路径跟踪方法,其特征在于,所述步骤3基于自适应视线法期望航向角解算的具体内容为:利用自适应视线法,以当前位置为中心,选取无人船船长的3~5倍为半径,确定视距点Plos,解算出期望航向角,公式如下:
式中,(xlos,ylos)为视距位置,(x,y)为当前位置,ψlos为期望航向角。
5.根据权利要求1所述的一种基于智能预测控制的水面无人船路径跟踪方法,其特征在于,所述步骤4基于自适应视线法路径段更新的具体内容为:在选择路径Pn+1时,判断无人船是否在自适应接纳圆内,如果满足公式,将选择跟踪下一路径Pn+1,公式如下:
式中:为自适应接纳圆的半径,(xn,yn)为预定的第n个航迹点坐标,(x,y)为当前位置。
6.根据权利要求1所述的一种基于智能预测控制的水面无人船路径跟踪方法,其特征在于,所述步骤5中提出的模型预测控制方法具体步骤为:
步骤5.1.考虑坐标原点在重心处,忽略无人船的横摇、纵摇以及升降运动带来的影响,忽略在运动过程中的水流附加质量与水动力带来的附加科里奥利向心力,忽略非线性阻尼的影响,建立3自由度的非线性欠驱动无人船操纵模型:
式中,x,y,ψ是船舶在北东坐标下的位置,u,v,r是船体坐标系下的速度,τu是推进器的力矩,τδ是舵机或双推进器差速下的偏航力矩,m是船舶的质量,Izz是绕OZ轴的转动惯量,是船舶在纵荡、横荡、艏摇3个方向上加速度引起的附加质量,定义为负数,Xu,Yv,Nr分别为船舶在各个方向上的水动力阻尼系数;
步骤5.2.对欠驱动无人船操纵模型在期望路径点(xR,uR)处进行一阶泰勒展开线性化处理,得到如下的预测模型:
式中,A、B为雅可比矩阵;
步骤5.3.为了得到离散化状态方程,采用前向欧拉的方法对该模型进行离散化处理,并化简为用控制增量形式表示的状态空间模型:
式中,
步骤5.4.进行约束条件设置,在当前时刻及预测时域内,对控制增量、控制量、输出量进行如下限制:
Δumin≤Δu(k+i)≤Δumax,i=0,1,2,...,NC-1 (20)
umin≤u(k+i)≤umax,i=0,1,2,...,NC-1 (21)
ymin≤y(k+i)≤ymax,i=0,1,2,...,Np (22)
式中,NC是控制时域,Np是预测时域,Δu(k+i)为k+i时刻的控制增量,u(k+i)为k+i时刻的控制量,y(k+i)为k+i时刻的输出量,Δumin是控制增量最小值,Δumax是控制增量最大值,umin是控制量最小值,umax是控制量最大值,根据推进器机械性能选取;ymin是输出量最小值,ymax是输出量最大值;
步骤5.5.滚动优化确定当前的最优控制策略,使未来一段时间内被控变量与期望值偏差最小,构建关于***的状态量偏差和控制增量的目标函数,通过改进的人工鱼群算法优化最优控制序列,输出第一个控制分量作用到无人船上,目标函数如下:
J=(Y-Yref)TQ(Y-Yref)+ΔUTRΔU (23)
式中,Y为当前时刻的输出值,Yref为自适应视线法处理后的期望值,ΔU为控制增量,Q和R为权重矩阵,选取主对角线的值为整数并小于100的对角矩阵,J为性能指标;
步骤5.6.等待无人船接收下一时刻的定位、姿态数据作为反馈信息。
7.根据权利要求1所述的一种基于智能预测控制的水面无人船路径跟踪方法,其特征在于,所述步骤6利用改进的人工鱼群算法优化目标函数的具体步骤为:
步骤6.1.选取目标函数的倒数作为适应度函数,对鱼群进行初始化,设置最大尝试次数为20,初始视野感知距离为1,拥挤因子δ为0.6,初始移动步长为0.1,最大迭代次数为50,适应度函数如下:
式中,h(ΔU)为适应度值,Y为当前时刻的输出值,Yref为自适应视线法处理后的期望值,ΔU为控制增量,Q和R为权重矩阵,选取主对角线的值为整数并小于100的对角矩阵,J为性能指标;
步骤6.2.计算初始鱼群各个个体的适应度值,取最优人工鱼的状态及其适应度值赋予给公告牌;
步骤6.3.进行觅食行为,在觅食阶段,当人工鱼用完尝试次数时,将视野范围扩大,增加寻优的机会,改进后的具体觅食方法如下:将视野扩大前的人工鱼适应度值与其视野感知范围内随机一条人工鱼的适应度值进行比较,如果比当前人工鱼的适应度高,则向适应度高的人工鱼方向移动一步,否则,随机选择另一条人工鱼进行比较,反复尝试20次后,如果仍不满足前进条件,将视野范围扩大λ倍,新的视野公式如下:
visualnew=(1+λ)visual (25)
式中:visualnew是扩大以后的视野,visual是扩大前的视野,λ为待定系数,一般取50%~80%,
在新的视野范围内,再次进行搜索,尝试次数用完后,如果搜索到适应度更高的位置,则向该方向移动一步,若没有搜索到适应度更高的位置,则执行随机移动一步;
步骤6.4.进行聚群行为,在探索当前人工鱼视野范围内,满足下面公式时,表明中心不太拥挤,朝着中心位置前进一步,否则,进行觅食行为,公式如下:
Yc/Nf>δYi1 (26)
式中,Yc是中心位置人工鱼适应度值,Nf是当前视野中的人工鱼数目,δ是拥挤因子,Yi1是人工鱼当前状态的适应度值;
步骤6.5.进行追尾行为,在探索当前人工鱼视野范围内,满足下面公式时,表明视野范围内随机选择的人工鱼周围不太拥挤,朝着该方向前进一步,否则,进行觅食行为,公式如下:
Yj2/Nf>δYi2 (27)
式中,Yj2是视野范围内随机选择的人工鱼适应度值,Nf是当前视野中的人工鱼数目,δ是拥挤因子,Yi2是人工鱼当前状态的适应度值;
步骤6.6.进行随机行为,在新的视野范围中随机选择一个状态,然后向该方向移动,公式如下:
Xi|next=Xi3+round·Visualnew (28)
式中:Xi|next为Xi3的下一个状态,Xi3为当前人工鱼的状态,Visualnew是扩大以后的视野,round是[-1,1]区间的随机数;
步骤6.7.对所有人工鱼个体进行评价,若某个体优于公告牌,则将公告牌更新为该个体;
步骤6.8.当公告牌上最优解达到满意误差界内或者达到迭代次数上限时算法结果时,输出最优控制增量序列:
ΔU*=[Δu(t|t)* Δu(t+1|t)* ··· Δu(t+Nc-1|t)*] (29)
式中,Δu(t+i|t)*为t+i时刻的最优控制增量分量,i=1,2,···,Nc+1,ΔU*为最优控制增量序列。
8.根据权利要求1所述的一种基于智能预测控制的水面无人船路径跟踪方法,其特征在于,所述步骤7实现路径跟踪控制器闭环反馈的具体内容为:解算出最优控制增量序列中第一个控制增量分量对应的推进器转速值,将其作用到无人船的推进***,进行航向调整,在下一时刻,通过北斗和惯性导航传感器接收无人船的状态信息,判断无人船是否到达终点,如果没有到达,将其信息与下一时刻期望路径点的状态信息的差值作为模型预测控制器的输入,形成反馈,构成闭环控制,如果到达最后一个期望路径点,则终止循环。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111399939.6A CN113885534B (zh) | 2021-11-19 | 2021-11-19 | 一种基于智能预测控制的水面无人船路径跟踪方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111399939.6A CN113885534B (zh) | 2021-11-19 | 2021-11-19 | 一种基于智能预测控制的水面无人船路径跟踪方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113885534A CN113885534A (zh) | 2022-01-04 |
CN113885534B true CN113885534B (zh) | 2023-11-21 |
Family
ID=79015519
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111399939.6A Active CN113885534B (zh) | 2021-11-19 | 2021-11-19 | 一种基于智能预测控制的水面无人船路径跟踪方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113885534B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2023108494A1 (zh) * | 2021-12-15 | 2023-06-22 | 中国科学院深圳先进技术研究院 | 一种概率滤波强化学习无人船控制方法、装置及终端设备 |
CN114489091B (zh) * | 2022-01-21 | 2023-01-13 | 湖南大学无锡智能控制研究院 | 一种自主水下机器人路径跟踪的制导律控制方法、设备及*** |
CN114252576A (zh) * | 2022-02-28 | 2022-03-29 | 安徽新宇环保科技股份有限公司 | 一种河长智能辅助决策分析*** |
CN115342814B (zh) * | 2022-07-26 | 2024-03-19 | 江苏科技大学 | 一种基于多传感器数据融合的无人船定位方法 |
CN116627144B (zh) * | 2023-07-21 | 2023-09-22 | 中国船舶集团有限公司第七〇七研究所 | 一种动力定位船舶低速折线循迹引导方法 |
CN117008464B (zh) * | 2023-10-07 | 2023-12-15 | 广东海洋大学 | 一种基于姿态控制的无人船导航方法 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR101690154B1 (ko) * | 2015-10-01 | 2016-12-28 | 한밭대학교 산학협력단 | 무인 잠수정의 경로 추적 장치 및 그 방법 |
CN106773722A (zh) * | 2017-02-17 | 2017-05-31 | 哈尔滨工程大学 | 一种基于人工鱼群算法的船舶动力定位***推力分配方法 |
CN109343350A (zh) * | 2018-11-20 | 2019-02-15 | 清华大学 | 一种基于模型预测控制的水下机器人路径跟踪控制方法 |
CN109521797A (zh) * | 2018-12-28 | 2019-03-26 | 西北工业大学 | 无人船引导水下航行器群的优化割草型编队控制方法 |
CN109856976A (zh) * | 2019-03-12 | 2019-06-07 | 哈尔滨工程大学 | 一种基于自适应交叉粒子群优化的气垫船航迹跟踪自抗扰控制方法 |
CN109976349A (zh) * | 2019-04-12 | 2019-07-05 | 大连海事大学 | 一种含约束无人船的路径跟踪制导与控制结构的设计方法 |
CN110618686A (zh) * | 2019-10-30 | 2019-12-27 | 江苏科技大学 | 基于显式模型预测控制的无人船航迹控制方法 |
CN110673598A (zh) * | 2019-09-29 | 2020-01-10 | 哈尔滨工程大学 | 一种水面无人艇智能路径跟踪控制方法 |
CN112148022A (zh) * | 2020-09-18 | 2020-12-29 | 江苏科技大学 | 全驱动自主水下机器人回收三维路径跟踪控制***及方法 |
CN112631315A (zh) * | 2020-12-08 | 2021-04-09 | 江苏科技大学 | 一种多电机协同推进的水下机器人路径跟踪方法 |
-
2021
- 2021-11-19 CN CN202111399939.6A patent/CN113885534B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR101690154B1 (ko) * | 2015-10-01 | 2016-12-28 | 한밭대학교 산학협력단 | 무인 잠수정의 경로 추적 장치 및 그 방법 |
CN106773722A (zh) * | 2017-02-17 | 2017-05-31 | 哈尔滨工程大学 | 一种基于人工鱼群算法的船舶动力定位***推力分配方法 |
CN109343350A (zh) * | 2018-11-20 | 2019-02-15 | 清华大学 | 一种基于模型预测控制的水下机器人路径跟踪控制方法 |
CN109521797A (zh) * | 2018-12-28 | 2019-03-26 | 西北工业大学 | 无人船引导水下航行器群的优化割草型编队控制方法 |
CN109856976A (zh) * | 2019-03-12 | 2019-06-07 | 哈尔滨工程大学 | 一种基于自适应交叉粒子群优化的气垫船航迹跟踪自抗扰控制方法 |
CN109976349A (zh) * | 2019-04-12 | 2019-07-05 | 大连海事大学 | 一种含约束无人船的路径跟踪制导与控制结构的设计方法 |
CN110673598A (zh) * | 2019-09-29 | 2020-01-10 | 哈尔滨工程大学 | 一种水面无人艇智能路径跟踪控制方法 |
CN110618686A (zh) * | 2019-10-30 | 2019-12-27 | 江苏科技大学 | 基于显式模型预测控制的无人船航迹控制方法 |
CN112148022A (zh) * | 2020-09-18 | 2020-12-29 | 江苏科技大学 | 全驱动自主水下机器人回收三维路径跟踪控制***及方法 |
CN112631315A (zh) * | 2020-12-08 | 2021-04-09 | 江苏科技大学 | 一种多电机协同推进的水下机器人路径跟踪方法 |
Non-Patent Citations (2)
Title |
---|
基于显式模型预测控制的无人船航迹控制方法;陈天元;袁伟;俞孟蕻;船舶工程(第009期);122-127 * |
观察型水下机器人预测控制器优化设计研究;朱春磊;曾庆军;徐鹏程;戴晓强;计算机仿真(第006期);332-337 * |
Also Published As
Publication number | Publication date |
---|---|
CN113885534A (zh) | 2022-01-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113885534B (zh) | 一种基于智能预测控制的水面无人船路径跟踪方法 | |
Sun et al. | Mapless motion planning system for an autonomous underwater vehicle using policy gradient-based deep reinforcement learning | |
CN107168312B (zh) | 一种补偿uuv运动学和动力学干扰的空间轨迹跟踪控制方法 | |
CN109976349B (zh) | 一种含约束无人船的路径跟踪制导与控制结构的设计方法 | |
Wang et al. | Path planning under constraints and path following control of autonomous underwater vehicle with dynamical uncertainties and wave disturbances | |
Deng et al. | Line-of-sight-based guidance and adaptive neural path-following control for sailboats | |
CN111580518B (zh) | 一种基于改进果蝇优化和动态窗口法的无人艇分层避障方法 | |
CN111026135B (zh) | 一种无人艇高性能航行前馈控制***及其控制方法 | |
CN111123923B (zh) | 一种无人船舶局部路径动态优化方法 | |
CN115016496A (zh) | 基于深度强化学习的水面无人艇路径跟踪方法 | |
CN113734393B (zh) | 基于攻角法的仿生机器鱼定深控制方法和装置 | |
CN111930141A (zh) | 一种水下机器人三维路径可视化跟踪方法 | |
CN112947431A (zh) | 一种基于强化学习的无人船路径跟踪方法 | |
CN114879671A (zh) | 一种基于强化学习mpc的无人艇轨迹跟踪控制方法 | |
Zhou et al. | Dynamic modeling and motion control of a novel conceptual multimodal underwater vehicle for autonomous sampling | |
Tang et al. | Unscented Kalman-filter-based sliding mode control for an underwater gliding snake-like robot | |
CN114967714A (zh) | 一种自主式水下机器人抗扰运动控制方法及*** | |
CN114967702A (zh) | 一种无人艇控制***及路径跟踪方法 | |
CN115686002A (zh) | 一种复杂海域下的水面无人艇路径跟踪控制方法 | |
CN111427356A (zh) | 一种船舶航向区间控制方法和*** | |
CN109916400B (zh) | 一种基于梯度下降算法与vo法相结合的无人艇避障方法 | |
CN112987771B (zh) | 基于多端口输出误差触发机制的机帆船路径跟踪控制方法 | |
Zhang et al. | Research on the maneuverability and path following control of the wave glider with a propeller-rudder system | |
CN115454099B (zh) | 基于变权重自适应鸽群参数拟合的无人艇航向自抗扰控制方法 | |
CN109747776B (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 |