CN114527744A - 基于天牛须搜索优化的无人帆船路径跟踪制导方法 - Google Patents
基于天牛须搜索优化的无人帆船路径跟踪制导方法 Download PDFInfo
- Publication number
- CN114527744A CN114527744A CN202210028022.3A CN202210028022A CN114527744A CN 114527744 A CN114527744 A CN 114527744A CN 202210028022 A CN202210028022 A CN 202210028022A CN 114527744 A CN114527744 A CN 114527744A
- Authority
- CN
- China
- Prior art keywords
- representing
- sailing
- cost function
- path tracking
- formula
- 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
- 238000000034 method Methods 0.000 title claims abstract description 46
- 241001481710 Cerambycidae Species 0.000 title claims abstract description 35
- 238000005457 optimization Methods 0.000 title claims abstract description 27
- 230000014509 gene expression Effects 0.000 claims abstract description 23
- 238000010845 search algorithm Methods 0.000 claims abstract description 9
- 230000008569 process Effects 0.000 claims abstract description 8
- 238000004364 calculation method Methods 0.000 claims description 17
- 230000004888 barrier function Effects 0.000 claims description 15
- 238000001514 detection method Methods 0.000 claims description 15
- 230000009467 reduction Effects 0.000 claims description 6
- 230000003068 static effect Effects 0.000 claims description 6
- 238000010276 construction Methods 0.000 claims description 3
- 238000011160 research Methods 0.000 claims description 3
- 238000012545 processing Methods 0.000 claims description 2
- 238000004422 calculation algorithm Methods 0.000 abstract description 15
- 238000010586 diagram Methods 0.000 description 8
- 241000244615 Ergates faber Species 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 229910052731 fluorine Inorganic materials 0.000 description 2
- 241000254173 Coleoptera Species 0.000 description 1
- YCKRFDGAMUMZLT-UHFFFAOYSA-N Fluorine atom Chemical compound [F] YCKRFDGAMUMZLT-UHFFFAOYSA-N 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 239000011248 coating agent Substances 0.000 description 1
- 238000000576 coating method Methods 0.000 description 1
- 238000010835 comparative analysis Methods 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 239000011737 fluorine Substances 0.000 description 1
- 125000001153 fluoro group Chemical group F* 0.000 description 1
- 230000019637 foraging behavior Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000002360 preparation method Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 230000000007 visual 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
技术领域
本申请涉及船舶控制工程与船舶自动化航行装备应用领域,具体地涉及一种基于天牛须搜索优化的无人帆船路径跟踪制导方法。
背景技术
天牛须搜索方法,是一种模仿甲虫觅食行为的优化算法。对于一个代价函数,在不等式约束下,找到一个状态使代价函数达到最小值。
对于路径跟踪任务,现有制导将常规动力船舶的LOS路径跟踪制导算法应用于无人帆船,并设置沿着参考路径的通道,限制无人帆船在执行特征操纵时产生的横向偏移,该算法的数学描述不直观且要求无人帆船的漂角(即船舶艏向与实际航向的夹角)为已知。由于船舶的纵荡、横荡速度通常难以准确测量,所以由速度正切关系描述的船舶漂角难以获取。
目前基于参数化LOS制导算法构造的无人帆船路径跟踪制导策略,采用符号函数描述无人帆船在进行特征操纵时的参考航向切换,并应用双降阶扩张状态观测器对漂角进行观测。该算法的数学描述直观,计算简捷,但无法处理无人帆船对曲线参考路径的跟踪任务。针对曲线路径跟踪任务,有基于Serret-Frenet坐标系的平行制导算法,但该算法仍然存在着计算复杂的弊端。
发明内容
为了克服现有技术的不足,本发明通过天牛须搜索方法与约束优化相结合,将制导问题转化为天牛须优化问题,对天牛须搜索算法进行改进来提高算法的性能,保证无人帆船实际航向角对参考航向角的收敛;本发明适用于无人驾驶帆船的路径跟踪与避碰混合制导,能够应对更复杂的海洋环境,可大幅提高无人帆船航行的安全性。
为实现上述目的,本发明所采用的解决方案为:
一种基于天牛须搜索优化的无人帆船路径跟踪制导方法,其具体步骤如下所示:
步骤1:采集帆船航行数据参数;
通过声呐、雷达和传感器采集帆船航行过程中的航行数据;
步骤2:构建无人帆船路径跟踪制导的代价函数;
经过对无人帆船路径跟踪制导的研究确定动静障碍物、速度和航程对帆船的航行状态产生影响;无人帆船路径跟踪制导的代价函数包括避碰代价函数、路径跟踪代价函数、速度损失代价函数和航程损失代价函数;
步骤21:构建避碰代价函数;
避碰代价函数的计算表达式如下式所示:
步骤22:构建路径跟踪代价函数;
路径跟踪代价函数需要分情况确定,当帆船位于参考路径右侧时,构造代价函数如下式所示:
式中:f2(ψd)表示路径跟踪代价函数;k2表示一个正的常数;ψpf表示路径跟踪的参考航向角;β表示帆船到参考路径的垂线距离与帆船和目标点间距离的夹角;g2表示横向误差影响函数;ye表示横向误差;
当帆船位于参考路径左侧时,构造代价函数如下式所示:
步骤23:构建速度损失代价函数;
为保证无人帆船前进速度的准确性,构造速度损失的代价函数如下式所示:
步骤24:构建航程损失代价函数;
如果当前计算的时间为t,上一时刻为t-1,则构造的航程损失代价函数为:
f4(ψd)=k4|ψd(t)-ψ(t-1)|
式中:k4为一个正的调优参数;f4(ψd)表示航程损失代价函数;ψd(t)表示时间t时刻的帆船航行时的参考航向角;ψ(t-1)表示时间t-1时刻的帆船航行时的航向角;
步骤25:构建无人帆船路径跟踪制导的代价函数;
获取步骤21、步骤22、步骤23和步骤24的结果,获得无人帆船路径跟踪制导的代价函数的具体形式由下式所示;
F(ψd)=f1(ψd)+f2(ψd)+f3(ψd)+f4(ψd)
式中:F(ψd)表示无人帆船路径跟踪制导的代价函数;
步骤3:求解无人帆船路径跟踪制导的代价函数;
获取步骤2得到的帆船路径跟踪制导的代价函数,通过改进的天牛须搜索算法实现优化,为提高天牛须搜索性能建立如下搜索状态的迭代表达式:
式中:xt+1表示t+1时刻搜索状态;xt表示t时刻搜索状态;δt表示搜索状态参数;sign表示符号函数;F(xl)表示左须对应的帆船路径跟踪制导的代价函数;F(xr)表示右须对应的帆船路径跟踪制导的代价函数;
通过上述迭代函数,使无人帆船路径跟踪制导的代价函数F(ψd)达到最小值,进而确定最优的参考航向角ψd,通过参考航向角控制帆船的航行姿态,实现帆船路径跟踪制导。
可优选的是,所述步骤1中的航行数据具体包括:参考航向角为ψd,帆船航向角为ψ,帆船速度方向与选定障碍物之间的夹角为ψ1,障碍物速度方向与帆船的夹角ψ2,帆船的速度为u1,障碍物速度为u2,帆船到参考路径的垂线距离与帆船和目标点间距离的夹角为β,障碍物的纵坐标y0,障碍物的横坐标x0,帆船与障碍物之间初始的距离d0。
可优选的是,所述步骤21中的避碰代价函数具体获得方法如下:
以无人帆船所在的平面位置为圆心,设置一个圆形的探测区域用以表示雷达和声纳的探测能力,而且只对探测区域内的障碍物进行处理;其中ψ1表示朝向选定障碍物(x0,y0)的夹角,具体表示为:
式中:ψ1表示帆船速度方向与选定障碍物的夹角;y0表示选定障碍物的纵坐标;y表示帆船纵坐标;x0表示选定障碍物的横坐标;x表示帆船横坐标;
帆船与障碍物之间的距离d通过下式确定:
式中:d表示随时间变化的帆船与障碍物之间的距离;d0表示帆船与障碍物之间初始的距离;a1表示会遇时间参数;a2表示会遇距离参数;TCPA表示最小会遇时间;
其中,会遇时间参数和会遇距离参数的计算表达式如下式所示:
式中:u1表示帆船速度;u2表示障碍物速度;ψ2表示障碍物速度方向与帆船的夹角;
进一步,确定最小会遇时间和最小会遇距离的计算表达式如下式所示:
式中:DCPA表示最小会遇距离;
检测区域内的所有障碍物均应通过以上两式进行评估,当TCPA≤0成立时,其对应障碍物首先被排除,仅针对TCPA>0成立时的障碍物进行考虑;
其中,随速度变化的危险度函数如下式所示:
可优选的是,所述步骤22中的路径跟踪代价函数具体获得过程如下所示:
前进方向目标点P的相对坐标为(xp,yp),则路径跟踪的参考航向角可以表示为:
式中:ψpf表示路径跟踪的参考航向角;yp表示目标点纵坐标;xp表示目标点横坐标;
当ψd在参考路径的垂线距离与帆船和目标点间距离的夹角β区域内时,实现路径跟踪,而如果位于180°-β的区域时,针对障碍物和帆船的不同位置,需要分情况考虑,构造不同的代价函数;
其中,横向误差影响函数如下式所示;
可优选的是,所述步骤3中的改进的天牛须搜索算法优化过程如下所示:
首先,分别确定当前时刻的左须位置和右须位置,其具体表达式如下所示:
其中,搜索状态参数的计算表达式如下式所示:
δt=c0dt;0<c0<1
式中:c0表示搜索状态参数缩减系数;
接着,搜索长度迭代计算表达式如下式所示:
dt+1=c1dt;0<c1<1
式中:dt+1表示t+1时刻的搜索长度;c1表示搜索长度缩减系数;
并且,当dt+1小于预先设定的一个搜索范围dmin时,搜索完成,输出;
x1=ψ(t-1)
式中:x1表示初始搜索状态;
使帆船路径跟踪制导的代价函数F(ψd)在t时刻达到最小值,输出对应的参考航向角ψd。
与现有技术相比,本发明的有益效果在于:
(1)本发明通过天牛须搜索方法与约束优化相结合,将制导问题转化为天牛须优化问题,对天牛须搜索算法进行改进来提高算法的性能,保证实际航向角对参考航向角的收敛,提出了一种完全表达式化描述且易于编程实现的无人帆船制导方法。
(2)本发明适用于无人驾驶帆船的路径跟踪与避碰混合制导,能够应对更复杂的海洋环境,大幅提高无人帆船航行的安全性。
附图说明
图1为本发明实施例的基于天牛须搜索优化的无人帆船路径跟踪制导方法的流程图;
图2是本发明实施例的无人帆船路径跟踪和避碰制导算法的原理说明图;
图3是本发明实施例的无人帆船速度极坐标图;
图4-图9分别是本发明实施例的基于天牛须搜索优化的无人帆船路径跟踪、避碰制导方法下的实船轨迹图;
图10是本发明实施例的制导方法的无人帆船速度变化曲线图。
具体实施方式
以下,参照附图对本发明的实施方式进行说明,如图1所示为基于天牛须搜索优化的无人帆船路径跟踪制导或者导航方法的流程图。
S1:采集帆船航行数据参数;
通过声呐、雷达、传感器等设备采集帆船航行过程中的航行数据;所述的航行数据具体包括:参考航向角为ψd,帆船航向角为ψ,帆船速度方向与选定障碍物之间的夹角为ψ1,障碍物速度方向与帆船的夹角ψ2,帆船的速度为u1,障碍物速度为u2,帆船到参考路径的垂线距离与帆船和目标点间距离的夹角为β,障碍物的纵坐标y0,障碍物的横坐标x0,帆船与障碍物之间初始的距离d0。如表1所示为无人帆船航行过程中的基本参数。
表1无人帆船的基本参数
S2:构建帆船路径跟踪制导的代价函数;
经过对无人帆船路径跟踪制导的研究确定动静障碍物、速度、航程等因素会对帆船的航行状态产生影响;因此,无人帆船路径跟踪制导的代价函数由避碰代价函数、路径跟踪代价函数、速度损失代价函数、航程损失代价函数共同组成。
S21:确定避碰代价函数;
在本发明中,发明人以无人帆船的平面位置为圆心,设置一个圆形的探测区域,表示雷达、声纳等设备的探测能力如图2所示描绘出了探测设备探测区域的示意图,只有探测区域内的障碍才会被处理。其中ψ1表示朝向选定障碍物(x0,y0)的夹角,具体表示为:
式中:ψ1表示帆船速度方向与选定障碍物的夹角;y0表示选定障碍物的纵坐标;y表示帆船纵坐标;x0表示选定障碍物的横坐标;x表示帆船横坐标;sign表示符号函数;
帆船与障碍物之间的距离d可通过下式确定:
式中:d表示随时间变化的帆船与障碍物之间的距离;d0表示帆船与障碍物之间初始的距离;a1表示会遇时间参数;a2表示会遇距离参数;TCPA表示最小会遇时间;
其中,会遇时间参数和会遇距离参数的计算表达式如下式所示:
式中:u1表示帆船速度;u2表示障碍物速度;ψ2表示障碍物速度方向与帆船的夹角;
进一步,确定最小会遇时间和最小会遇距离的计算表达式如下式所示:
式中:DCPA表示最小会遇距离;
检测区域内的所有障碍物均应通过以上两式进行评估,TCPA≤0的障碍物首先被排除,仅对TCPA>0的障碍物进行考虑。
避碰代价函数的计算表达式如下式所示:
其中,随速度变化的危险度函数如下式所示:
S22:确定路径跟踪代价函数;
路径跟踪作为无人帆船根本的导航任务,在本发明中采用LOS制导算法,其基本制导框架是以如图2所示的探测区域的示意图进行的。前进方向目标点P的相对坐标为(xp,yp),则路径跟踪的参考航向角可以表示为:
式中:ψpf表示路径跟踪的参考航向角;yp表示目标点纵坐标;xp表示目标点横坐标;
当ψd在参考路径的垂线距离与帆船和目标点间距离的夹角β区域内时,可以实现路径跟踪,而如果位于180°-β的区域时,不能很好的实现路径跟踪任务,因此针对障碍物和帆船的不同位置,需要分情况考虑,构造不同的代价函数;
当帆船位于参考路径右侧时,构造代价函数如下式所示:
式中:k2表示一个正的常数;β表示帆船到参考路径的垂线距离与帆船和目标点间距离的夹角;g2表示横向误差影响函数;ye表示横向误差;
当帆船位于参考路径左侧时,代价函数如下式所示:
其中,横向误差影响函数如下式所示;
S23:确定速度损失代价函数;
在稳定的风况中,帆船前进速度与α夹角之间的关系可以用速度极坐标图来描述,如图3所示为本发明实施例的无人帆船速度极坐标图;对于风帆船航行状况的不确定性,发明人还要考虑速度损失问题;为保证帆船前进速度的存在性,构造速度损失的代价函数如下式所示:
S24:确定航程损失代价函数;
帆船转角过大会造成速度损失以及控制效果下降,整个航行过程也有一定的损失。关于参考航向角的连续计算比较复杂,因此采用离散计算方法。当前计算的时间为t,上一时刻为t-1,构造的航程损失代价函数为:
f4(ψd)=k4|ψd(t)-ψ(t-1)|
式中:k4为一个正的调优参数。
S25:确定帆船路径跟踪制导的代价函数;
结合步骤S21、S22、S23和S24的计算结果确定帆船路径跟踪制导的代价函数如下所示;
F(ψd)=f1(ψd)+f2(ψd)+f3(ψd)+f4(ψd)
式中:ψd表示参考航向角;F(ψd)表示帆船路径跟踪制导的代价函数;f1(ψd)表示避碰代价函数;f2(ψd)表示路径跟踪代价函数;f3(ψd)表示速度损失代价函数;f4(ψd)表示航程损失代价函数;
S3:求解帆船路径跟踪制导的代价函数;
获取步骤S25得到的帆船路径跟踪制导的代价函数,通过改进的天牛须搜索算法,
可优选的是,所述步骤3中的改进的天牛须搜索算法具体优化过程如下所示:
将制导问题转化为天牛须优化问题,首先,分别定义当前时刻的左右须搜索状态,其具体表达式如下所示:
为提高天牛须搜索性能建立如下搜索状态的迭代表达式:
式中:xt+1表示t+1时刻搜索状态;δt表示搜索状态参数;F(xl)表示左须对应的帆船路径跟踪制导的代价函数;F(xr)表示右须对应的帆船路径跟踪制导的代价函数;
其中,搜索状态参数的计算表达式如下式所示:
δt=c0dt;0<c0<1
式中:c0表示搜索状态参数缩减系数;
进一步,搜索长度迭代计算表达式如下式所示:
dt+1=c1dt;0<c1<1
式中:dt+1表示t+1时刻的搜索长度;c1表示搜索长度缩减系数;
当dt+1小于预先设定的一个搜索范围dmin时,搜索完成,输出。
x1=ψ(t-1)
式中:x1表示初始搜索状态;
使帆船路径跟踪制导的代价函数F(ψd)在t时刻达到最小值,输出对应的参考航向角ψd;通过参考航向角控制帆船的航行姿态,达到帆船路径跟踪制导的目的。
如表2所示为本方法与基于视线制导的路径跟踪控制方法计算结果的对比,通过对比可以看出本方法在收敛时间、计算时间和迭代次数方面的优越性。
表2本方法与基于视线制导方法的对比分析
如图4-9所示为步骤S3对本发明制导算法进行MATLAB仿真测试的结果。分别为6个时间点下实船的轨迹图。其中,图4为帆船45s时的航行轨迹,在留有安全距离的同时,帆船成功的躲避了静态障碍物。图5为帆船60s时的航行轨迹,帆船成功躲避左侧来向障碍物。图6为帆船90s时的航行轨迹,帆船在完成躲避动态障碍物后成功收敛到参考路径。图7为帆船135s时的航行轨迹,由图可知,帆船成功躲避参考路径上的障碍物。图8为帆船170s时的航行轨迹,帆船完成障碍物的避碰任务,成功收敛到参考路径上。图9为帆船完成整个航线的轨迹图,由图可知,无人帆船成功的完成动、静障碍物的避碰任务,实现路径跟踪。其结果表明该制导和控制策略的有效性,保证了实船在避碰避障时有效的收敛到参考路径,帆船成功的绕过障碍物,避碰避障结束后很快回归到路径跟踪任务,证明了基于天牛须优化制导算法的有效性;图10描述了无人帆船的速度变化曲线。
综上,对本案例的结果进行分析证明了基于天牛须搜索优化的无人帆船路径跟踪制导方法具有很好的应用效果。
(1)本发明通过天牛须搜索方法与约束优化相结合,将无人帆船制导问题转化为天牛须优化问题,对天牛须搜索算法进行改进来提高算法的性能,保证实际航向角对参考航向角的收敛,提出了一种易于编程实现的无人帆船制导方法。
(2)本发明实施例中静态障碍物信息不需要提前获取,只需要对动态障碍物的速度进行初始值为零的赋值,通过实施例的进一步分析,表明本方法能够很大程度上减少计算量,提高算法的运算性能。
(3)本发明适用于无人驾驶帆船的路径跟踪与避碰混合制导,通过实施例的进一步分析,证明本方法能够应对更复杂的海洋环境,大幅提高无人帆船路径制导的准确性和航行的安全性。
以上所述的实施例仅是对本发明的优选实施方式进行描述,并非对本发明的范围进行限定,在不脱离本发明设计精神的前提下,本领域普通技术人员对本发明的技术方案做出的各种变形和改进,均应落入本发明权利要求书确定的保护范围内。
Claims (5)
1.一种基于天牛须搜索优化的无人帆船路径跟踪制导方法,其特征在于,其包括以下步骤:
步骤1:采集帆船航行数据参数;
通过声呐、雷达和传感器采集帆船航行过程中的航行数据;
步骤2:构建无人帆船路径跟踪制导的代价函数;
经过对无人帆船路径跟踪制导的研究确定动静障碍物、速度和航程对帆船的航行状态产生影响;无人帆船路径跟踪制导的代价函数包括避碰代价函数、路径跟踪代价函数、速度损失代价函数和航程损失代价函数;
步骤21:构建避碰代价函数;
避碰代价函数的计算表达式如下式所示:
步骤22:构建路径跟踪代价函数;
路径跟踪代价函数需要分情况确定,当帆船位于参考路径右侧时,构造代价函数如下式所示:
式中:f2(ψd)表示路径跟踪代价函数;k2表示一个正的常数;ψpf表示路径跟踪的参考航向角;β表示帆船到参考路径的垂线距离与帆船和目标点间距离的夹角;g2表示横向误差影响函数;ye表示横向误差;
当帆船位于参考路径左侧时,构造代价函数如下式所示:
步骤23:构建速度损失代价函数;
构造速度损失的代价函数如下式所示:
步骤24:构建航程损失代价函数;
如果当前计算的时间为t,上一时刻为t-1,则构造的航程损失代价函数为:
f4(ψd)=k4|ψd(t)-ψ(t-1)|
式中:k4为一个正的调优参数;f4(ψd)表示航程损失代价函数;ψd(t)表示时间t时刻的帆船航行时的参考航向角;ψ(t-1)表示时间t-1时刻的帆船航行时的航向角;
步骤25:构建无人帆船路径跟踪制导的代价函数;
获取步骤21、步骤22、步骤23和步骤24的结果,获得无人帆船路径跟踪制导的代价函数的具体形式由下式所示;
F(ψd)=f1(ψd)+f2(ψd)+f3(ψd)+f4(ψd)
式中:F(ψd)表示无人帆船路径跟踪制导的代价函数;
步骤3:求解无人帆船路径跟踪制导的代价函数;
获取步骤2得到的帆船路径跟踪制导的代价函数,通过改进的天牛须搜索算法实现优化,为提高天牛须搜索性能建立如下搜索状态的迭代表达式:
式中:xt+1表示t+1时刻搜索状态;xt表示t时刻搜索状态;δt表示搜索状态参数;sign表示符号函数;F(xl)表示左须对应的帆船路径跟踪制导的代价函数;F(xr)表示右须对应的帆船路径跟踪制导的代价函数;
通过上述迭代函数,使无人帆船路径跟踪制导的代价函数F(ψd)达到最小值,进而确定最优的参考航向角ψd,通过参考航向角控制帆船的航行姿态,实现帆船路径跟踪制导。
2.根据权利要求1所述的基于天牛须搜索优化的无人帆船路径跟踪制导方法,其特征在于,所述步骤1中的航行数据具体包括:参考航向角为ψd,帆船航向角为ψ,帆船速度方向与选定障碍物之间的夹角为ψ1,障碍物速度方向与帆船的夹角ψ2,帆船的速度为u1,障碍物速度为u2,帆船到参考路径的垂线距离与帆船和目标点间距离的夹角为β,障碍物的纵坐标y0,障碍物的横坐标x0,帆船与障碍物之间初始的距离d0。
3.根据权利要求1所述的基于天牛须搜索优化的无人帆船路径跟踪制导方法,其特征在于,所述步骤21中的避碰代价函数具体获得方法如下:
以无人帆船所在的平面位置为圆心,设置一个圆形的探测区域用以表示雷达和声纳的探测能力,而且只对探测区域内的障碍物进行处理;其中ψ1表示朝向选定障碍物(x0,y0)的夹角,具体表示为:
式中:ψ1表示帆船速度方向与选定障碍物的夹角;y0表示选定障碍物的纵坐标;y表示帆船纵坐标;x0表示选定障碍物的横坐标;x表示帆船横坐标;
帆船与障碍物之间的距离d通过下式确定:
式中:d表示随时间变化的帆船与障碍物之间的距离;d0表示帆船与障碍物之间初始的距离;a1表示会遇时间参数;a2表示会遇距离参数;TCPA表示最小会遇时间;
其中,会遇时间参数和会遇距离参数的计算表达式如下式所示:
式中:u1表示帆船速度;u2表示障碍物速度;ψ2表示障碍物速度方向与帆船的夹角;
进一步,确定最小会遇时间和最小会遇距离的计算表达式如下式所示:
式中:DCPA表示最小会遇距离;
检测区域内的所有障碍物均应通过以上两式进行评估,当TCPA≤0成立时,其对应障碍物首先被排除,仅针对TCPA>0成立时的障碍物进行考虑;
其中,随速度变化的危险度函数如下式所示:
5.根据权利要求1所述的基于天牛须搜索优化的无人帆船路径跟踪制导方法,其特征在于,所述步骤3中的改进的天牛须搜索算法优化过程如下所示:
首先,分别确定当前时刻的左须位置和右须位置,其具体表达式如下所示:
其中,搜索状态参数的计算表达式如下式所示:
δt=c0dt;0<c0<1
式中:c0表示搜索状态参数缩减系数;
接着,搜索长度迭代计算表达式如下式所示:
dt+1=c1dt;0<c1<1
式中:dt+1表示t+1时刻的搜索长度;c1表示搜索长度缩减系数;
并且,当dt+1小于预先设定的一个搜索范围dmin时,搜索完成,输出;
x1=ψ(t-1)
式中:x1表示初始搜索状态;
使帆船路径跟踪制导的代价函数F(ψd)在t时刻达到最小值,输出对应的参考航向角ψd。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210028022.3A CN114527744B (zh) | 2022-01-11 | 2022-01-11 | 基于天牛须搜索优化的无人帆船路径跟踪制导方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210028022.3A CN114527744B (zh) | 2022-01-11 | 2022-01-11 | 基于天牛须搜索优化的无人帆船路径跟踪制导方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114527744A true CN114527744A (zh) | 2022-05-24 |
CN114527744B CN114527744B (zh) | 2024-04-02 |
Family
ID=81620072
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210028022.3A Active CN114527744B (zh) | 2022-01-11 | 2022-01-11 | 基于天牛须搜索优化的无人帆船路径跟踪制导方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114527744B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116466334A (zh) * | 2023-06-19 | 2023-07-21 | 杭州聆巡科技有限公司 | 一种基于天牛须搜索算法的二维声呐阵列稀疏化方法 |
CN117308964A (zh) * | 2023-11-24 | 2023-12-29 | 陕西欧卡电子智能科技有限公司 | 智能游船的路径规划方法、装置、无人船及介质 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20170088123A (ko) * | 2016-01-22 | 2017-08-01 | 대우조선해양 주식회사 | 무인 선박의 항해 시스템 및 이를 이용한 항해 제어 방법 |
CN107168335A (zh) * | 2017-06-28 | 2017-09-15 | 大连海事大学 | 一种考虑混合多目标避障的水面无人艇路径跟踪制导方法 |
CN111290390A (zh) * | 2020-02-25 | 2020-06-16 | 智慧航海(青岛)科技有限公司 | 一种基于天牛须搜索的智能船舶路径规划方法 |
CA3067576A1 (en) * | 2019-01-14 | 2020-07-14 | Harbin Engineering University | Cooperative autonomous navigation systems and methods for multiple unmanned surface vehicles considering communication |
CN111562786A (zh) * | 2020-05-19 | 2020-08-21 | 智慧航海(青岛)科技有限公司 | 多级优化的无人船舶路径规划方法及装置 |
CN112327850A (zh) * | 2020-11-06 | 2021-02-05 | 大连海事大学 | 一种水面无人艇路径规划方法 |
CN112580261A (zh) * | 2020-12-23 | 2021-03-30 | 武汉理工大学 | 一种多船避碰决策方法及装置 |
-
2022
- 2022-01-11 CN CN202210028022.3A patent/CN114527744B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20170088123A (ko) * | 2016-01-22 | 2017-08-01 | 대우조선해양 주식회사 | 무인 선박의 항해 시스템 및 이를 이용한 항해 제어 방법 |
CN107168335A (zh) * | 2017-06-28 | 2017-09-15 | 大连海事大学 | 一种考虑混合多目标避障的水面无人艇路径跟踪制导方法 |
CA3067576A1 (en) * | 2019-01-14 | 2020-07-14 | Harbin Engineering University | Cooperative autonomous navigation systems and methods for multiple unmanned surface vehicles considering communication |
CN111290390A (zh) * | 2020-02-25 | 2020-06-16 | 智慧航海(青岛)科技有限公司 | 一种基于天牛须搜索的智能船舶路径规划方法 |
CN111562786A (zh) * | 2020-05-19 | 2020-08-21 | 智慧航海(青岛)科技有限公司 | 多级优化的无人船舶路径规划方法及装置 |
CN112327850A (zh) * | 2020-11-06 | 2021-02-05 | 大连海事大学 | 一种水面无人艇路径规划方法 |
CN112580261A (zh) * | 2020-12-23 | 2021-03-30 | 武汉理工大学 | 一种多船避碰决策方法及装置 |
Non-Patent Citations (2)
Title |
---|
方泗喃;高萍萍;肜郝捷;周心怡;鲁海燕: "基于改进天牛须搜索算法的路径规划方法", 信息技术与信息化, no. 011, 31 December 2021 (2021-12-31) * |
邓英杰;隋江华;张国庆;田佰军;: "基于DVS制导算法的欠驱动船舶路径跟踪指令滤波滑模控制", 大连海事大学学报, no. 02, 15 May 2017 (2017-05-15) * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116466334A (zh) * | 2023-06-19 | 2023-07-21 | 杭州聆巡科技有限公司 | 一种基于天牛须搜索算法的二维声呐阵列稀疏化方法 |
CN116466334B (zh) * | 2023-06-19 | 2023-09-05 | 杭州聆巡科技有限公司 | 一种基于天牛须搜索算法的二维声呐阵列稀疏化方法 |
CN117308964A (zh) * | 2023-11-24 | 2023-12-29 | 陕西欧卡电子智能科技有限公司 | 智能游船的路径规划方法、装置、无人船及介质 |
CN117308964B (zh) * | 2023-11-24 | 2024-02-13 | 陕西欧卡电子智能科技有限公司 | 智能游船的路径规划方法、装置、无人船及介质 |
Also Published As
Publication number | Publication date |
---|---|
CN114527744B (zh) | 2024-04-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106959698B (zh) | 一种路径跟踪避障制导方法 | |
CN109725650B (zh) | 一种密集障碍物环境下的auv避障方法 | |
CN109933067B (zh) | 一种基于遗传算法和粒子群算法的无人艇避碰方法 | |
CN109597417B (zh) | 一种基于避碰准则的多usv群体协同避碰规划方法 | |
CN114527744A (zh) | 基于天牛须搜索优化的无人帆船路径跟踪制导方法 | |
CN110083159B (zh) | 基于sbg和动态窗口约束的无人船自主动态避碰方法 | |
CN105955268A (zh) | 一种考虑局部避碰的uuv动目标滑模跟踪控制方法 | |
JPWO2016104030A6 (ja) | 移動体制御装置、移動体制御方法、および移動体制御プログラム | |
JPWO2016104030A1 (ja) | 移動体制御装置、移動体制御方法、および移動体制御プログラム | |
CN113759939B (zh) | 一种受限水域智能航行方法及装置 | |
KR102099699B1 (ko) | 무인수상선의 충돌 회피 장치 및 방법 | |
CN111123923B (zh) | 一种无人船舶局部路径动态优化方法 | |
JP2021181301A (ja) | 船舶の自動誘導方法、船舶の自動誘導プログラム、船舶の自動誘導システム、及び船舶 | |
CN113050684B (zh) | 一种面向突发威胁的无人机航迹规划算法 | |
CN114355899A (zh) | 一种基于动态导航船域与速度障碍的无人船避碰方法 | |
Song et al. | Method of emergency collision avoidance for unmanned surface vehicle (USV) based on motion ability database | |
CN113032896A (zh) | 一种基于船舶驾驶员偏好的避碰辅助决策方法 | |
CN109062198B (zh) | 一种船舶的航行控制方法、装置、设备及介质 | |
CN117369441A (zh) | 一种考虑船舶运动学和CORLEGs的自适应智能船舶路径规划方法 | |
Bakaric et al. | Improved basic planar algorithm of vehicle guidance through waypoints by the line of sight | |
CN116430856A (zh) | 一种基于变前视距离los算法的船舶航迹控制方法 | |
CN115755907A (zh) | 一种内河无人船自主避碰方法 | |
Yuan et al. | Model predictive control-based collision avoidance for autonomous surface vehicles in congested inland waters | |
CN115951581A (zh) | 一种基于改进empc的高速无人艇路径跟踪控制方法 | |
CN111984006B (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 |