CN111798701B - 无人艇路径跟踪控制方法、***、存储介质及终端 - Google Patents
无人艇路径跟踪控制方法、***、存储介质及终端 Download PDFInfo
- Publication number
- CN111798701B CN111798701B CN202010644736.8A CN202010644736A CN111798701B CN 111798701 B CN111798701 B CN 111798701B CN 202010644736 A CN202010644736 A CN 202010644736A CN 111798701 B CN111798701 B CN 111798701B
- Authority
- CN
- China
- Prior art keywords
- heading angle
- unmanned ship
- heading
- path tracking
- unmanned
- 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 59
- 230000007704 transition Effects 0.000 claims abstract description 43
- 230000033001 locomotion Effects 0.000 claims abstract description 40
- 230000006870 function Effects 0.000 claims description 40
- 238000004364 calculation method Methods 0.000 claims description 10
- 238000004590 computer program Methods 0.000 claims description 10
- 238000012937 correction Methods 0.000 claims description 9
- 230000007613 environmental effect Effects 0.000 claims description 8
- 230000009471 action Effects 0.000 claims description 5
- 238000004422 calculation algorithm Methods 0.000 claims description 5
- 230000008859 change Effects 0.000 description 8
- 238000010586 diagram Methods 0.000 description 8
- 238000012545 processing Methods 0.000 description 7
- 230000000694 effects Effects 0.000 description 5
- 230000008569 process Effects 0.000 description 5
- 230000009286 beneficial effect Effects 0.000 description 3
- 238000013461 design Methods 0.000 description 3
- 230000003287 optical effect Effects 0.000 description 2
- 230000009467 reduction Effects 0.000 description 2
- 230000003044 adaptive effect Effects 0.000 description 1
- 230000004075 alteration Effects 0.000 description 1
- 230000033228 biological regulation Effects 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 230000014509 gene expression Effects 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 238000011835 investigation Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000005055 memory storage Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G3/00—Traffic control systems for marine craft
-
- 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)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Ocean & Marine Engineering (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种无人艇路径跟踪控制方法、***、存储介质及终端,其中,无人艇路径跟踪控制方法包括步骤:采集无人艇的第一位置信息和速度信息;根据第一位置信息和艏向控制器调整无人艇的转艏运动;根据速度信息和速度控制器调整无人艇的纵向运动;根据第一位置信息和艏向控制器调整无人艇的转艏运动包括以下步骤:根据第一位置信息和基于视线法原理创建的制导律生成无人艇在路径跟踪状态下的期望艏向角;基于过渡目标值函数和期望艏向角创建艏向控制器;将第一位置信息、期望艏向角输入艏向控制器生成控制力矩;根据控制力矩调整无人艇的转艏运动。本发明提供的无人艇路径跟踪控制方法、***、存储介质及终端提高了跟踪精度、扩大了应用范围。
Description
技术领域
本发明涉及无人艇航行控制技术领域,尤其涉及一种无人艇路径跟踪控制方法、***、存储介质及终端。
背景技术
无人艇(unmanned surface vessel,简称USV)被广泛地应用于海洋生产活动中,尤其是在海洋资源调查、水质监测与采样、环卫等方面具有突出的优势。无人艇在执行以上任务时往往需要进行路径跟踪控制。在路径跟踪控制的过程中,控制***在折线路径单元转折处会出现目标艏向角发生“骤变”的情形,但是无人艇本身具有较大惯性,执行机构存在长时滞的特性,导致其艏向在实际控制中很容易发生超调现象,从而影响路径跟踪控制的精度;此外现有路径跟踪控制方法对无人艇的数学模型依赖性强、动力控制器的设计形式复杂,难以扩大其应用范围。
发明内容
本发明的目的在于提供一种无人艇路径跟踪控制方法、***、存储介质及终端,用以降低现有无人艇路径跟踪控制方法中期望艏向角骤变时对精度的影响。
本发明的上述目的可采用下列技术方案来实现:
本发明提供一种无人艇路径跟踪控制方法,包括步骤:采集无人艇的第一位置信息和速度信息;根据所述第一位置信息和艏向控制器调整所述无人艇的转艏运动;根据所述速度信息和速度控制器调整所述无人艇的纵向运动;其中,所述根据所述第一位置信息和艏向控制器调整所述无人艇的转艏运动包括以下步骤:根据所述第一位置信息和基于视线法原理创建的制导律生成所述无人艇在路径跟踪状态下的期望艏向角;基于过渡目标值函数和所述期望艏向角创建艏向控制器;将所述第一位置信息、所述期望艏向角输入所述艏向控制器生成控制力矩;根据所述控制力矩调整所述无人艇的转艏运动;其中,所述过渡目标值函数为期望艏向角骤增过渡函数和期望艏向角骤减过渡函数,且期望艏向角骤减过渡函数采用下面公式表述:
其中,ψd为期望艏向角,κ为调整因子,其取值范围为0<κ<1。
本发明的目的还可以采用以下的技术措施来进一步实现。
优选的,其中,所述根据所述第一位置信息和基于视线法原理创建的制导律生成所述无人艇在路径跟踪状态下的期望艏向角的步骤包括以下步骤:在期望路径上创建多个航路点;在相邻两个所述航路点之间创建参考点;获取所述参考点前后各一个相邻所述航路点的第二位置信息;根据所述第一位置信息和两个所述第二位置信息利用视线法原理和几何法求轨迹方程生成所述参考点的第三位置信息;基于所述第一位置信息和所述第三位置信息利用投影算法生成所述期望艏向角。
优选的,其中,所述基于过渡目标值函数和所述期望艏向角创建艏向控制器的步骤包括以下步骤:将所述期望艏向角输入所述过渡目标值函数生成目标艏向角;获取所述无人艇的艏向角信息;根据所述艏向角信息和所述目标艏向角生成参数修正信息;基于S面控制原理和所述参数修正信息创建所述艏向控制器。
优选的,其中,所述期望艏向角骤增过渡函数采用下面公式表述:
其中,t′为过渡时间,t0为过渡函数的作用时间,t为无人艇实时运动的时间;
其中,ψd为期望艏向角,κ为调整因子,其取值范围为0<κ<1。
优选的,其中,所述艏向控制器中还包括环境干扰补偿函数。
优选的,其中,所述根据所述速度信息和速度控制器调整所述无人艇的纵向运动的步骤包括以下步骤:基于积分S面方法创建所述速度控制器;根据所述速度信息和所述速度控制器生成纵向控制力;根据所述纵向控制力调整所述无人艇的纵向运动。
优选的,其中,所述根据所述控制力矩调整所述无人艇的转艏运动的步骤通过调整舵机的舵角进行;和/或所述根据所述纵向控制力调整所述无人艇的纵向运动的步骤通过调整推进器的转速进行。
本发明的目的还采用以下的技术方案来实现。依据本发明提出的一种***,其中,包括:执行任一项前述的无人艇路径跟踪控制方法的步骤的模块。
本发明的目的还采用以下的技术方案来实现。依据本发明提出的一种存储介质,其上存储有计算机程序,其中,所述存储介质是计算机可读存储介质,且所述程序被执行时实现任一项前述的无人艇路径跟踪控制方法。
本发明的目的还采用以下的技术方案来实现。依据本发明提出的一种终端,其中,包括存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,其中,所述处理器执行所述计算机程序时实现任一项前述的无人艇路径跟踪控制方法。
本发明与现有技术相比具有明显的优点和有益效果。借由上述技术方案,本发明提出的无人艇路径跟踪控制方法、***、存储介质及终端至少具有下列优点及有益效果:
1、采用过渡目标值函数对骤变的期望艏向角进行过渡处理,缓解了艏向误差的骤变对路径跟踪控制精度的影响;
2、采用积分S面控制原理创建速度控制器,能够消除速度跟踪时产生的稳态误差;
3、对艏向控制器和速度控制器进行解耦设计,从而降低其对无人艇的模型依赖性,且艏向控制器和速度控制器的结构形式简单、易实现。
上述说明仅是本发明技术方案的概述,为了能更清楚了解本发明的技术手段,而可依照说明书的内容予以实施,并且为让本发明的上述和其他目的、特征和优点能够更明显易懂,以下特举较佳实施例,并配合附图,详细说明如下。
附图说明
为了更清楚地说明本发明实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1是本发明一个实施例的无人艇路径跟踪控制方法的流程框图;
图2是本发明一个实施例的无人艇路径跟踪控制方法的流程框图;
图3是本发明一个实施例的无人艇路径跟踪控制方法的流程框图;
图4是本发明一个实施例的无人艇路径跟踪控制方法的流程框图;
图5是本发明一个实施例的无人艇路径跟踪控制方法的流程框图;
图6是本发明一个实施例的终端的结构框图;
图7是本发明一个实施例的期望艏向角的计算原理示意图;
图8是本发明一个实施例的期望艏向角和目标艏向角的对比示意图;
图9是本发明一个实施例的路径跟踪控制示意图。
附图标记与说明:
10000、终端; 11000、存储器;
11100、计算机程序; 12000、处理器;
ψlos、期望艏向角; ψd、期望艏向角;
Pk-1(xk-1,yk-1)、位置坐标; Pk(xk,yk)、位置坐标;
Pk+1(xk+1,yk+1)、位置坐标; Plos(xlos,ylos)、位置坐标;
R、半径; αk-1、方位角;
ye、偏航距离; Δ、前视距离;
Rk、半径。
具体实施方式
为更进一步阐述本发明为达成预定发明目的所采取的技术手段及功效,以下结合附图及较佳实施例,对依据本发明提出的无人艇路径跟踪控制方法、***、存储介质及终端的具体实施方式、结构、特征及其功效,详细说明如后。
虽然每个实施例代表了申请步骤的单一组合,但是本发明不同实施例的步骤可以替换,或者合并组合,因此本发明也可认为包含记载的相同和/或不同实施例中步骤的所有可能组合。因而,如果一个实施例包含步骤A、B、C,另一个实施例包含步骤B和D的组合,那么本发明也视为包括含有A、B、C、D的一个或多个步骤的所有其他可能的组合的实施例,尽管该实施例可能并未在以下内容中有明确的文字记载。
实施方式一
下面将结合附图,对本发明实施例提供的一种无人艇路径跟踪控制方法进行详细介绍。
图1至图5是本发明的无人艇路径跟踪控制方法的流程框图。具体的,请参阅图 1,本发明示例的无人艇路径跟踪控制方法主要包括步骤:
S1:采集无人艇的第一位置信息和速度信息
其中,第一位置信息是指无人艇的位置坐标。
其中,速度信息信息是指无人艇的速度信息,具体的,该速度信息包括无人艇的纵向速度信息与期望速度信息。
在一些实施例中,无人艇的位置坐标和速度信息均采用相对坐标系的方式进行表示,在一些实施例中,无人艇的位置坐标和速度信息均采用绝对坐标系的方式进行表示,在另一些实施例中,无人艇的位置坐标和速度信息采用不同的坐标系的方式进行表示,本领域的技术人员可以根据实际计算模型进行选择。
S2:根据第一位置信息和艏向控制器调整无人艇的转艏运动
S3:根据速度信息和速度控制器调整无人艇的纵向运动
本领域的技术人员应当明白,步骤S2和步骤S3可以同时并行直接对无人艇的运动状态进行调整,也可以有采用串行的方式先后分别调整无人艇的转艏运动或纵向运动。
进一步的,请参见图2,S2:根据第一位置信息和艏向控制器调整无人艇的转艏运动的步骤包括以下步骤:
S21:根据第一位置信息和基于视线法原理创建的制导律生成无人艇在路径跟踪状态下的期望艏向角
其中,视线法原理即Line-of-Sight,简称LOS。其具体含义为:视线法通过不断引导船舶时刻瞄准下一目标点运动,以实现点到点的引导运动,从而完成两点之间的路径跟踪控制。
在一些实施例中,请参见图3,S21:根据第一位置信息和基于视线法原理创建的制导律生成无人艇在路径跟踪状态下的期望艏向角包括以下步骤:
S211:在期望路径上创建多个航路点;
S212:在相邻两个航路点之间创建参考点;
S213:获取参考点前后各一个相邻航路点的第二位置信息;
S214:根据第一位置信息和两个第二位置信息利用视线法原理和几何法求轨迹方程生成参考点的第三位置信息;
S215:基于第一位置信息和第三位置信息利用投影算法生成期望艏向角。
其中,该期望艏向角是指无人艇转向参考点所需要转动的角度。
下面通过具体实施例对上述步骤进行详细介绍,具体请参考图7:
S211:在期望路径上创建多个航路点,即创建航路点P1、航路点P2…航路点Pk-1、航路点Pk、航路点Pk+1…航路点Pn;
本领域的技术人员应当明白,航路点的数量可以根据期望路径的长度、折点等参数确定,其可以根据期望路径的形式预设完成,也可以按照实际需求进行实时创建,只要在期望路径上创建了多个航路点就应该在本发明的保护范围内。
S212:然后在相邻两个该航路点Pk-1与Pk之间创建参考点Plos;
S213:获取参考点前后各一个相邻航路点的第二位置信息(即其位置坐标);
在一些实施例中,只获取与参考点Plos前后各一个相邻的两个航路点Pk-1的位置坐标Pk-1(xk-1,yk-1)与Pk的位置坐标Pk(xk,yk),因此其无需占用过多的存储空间;在另一些实施例中,期望路径上所有的航路点的位置坐标已经存储在***中,在需要获取时直接从***中读取即可,因此其获取速度更加及时。
S214:根据第一位置信息(即无人艇的位置坐标)和两个第二位置信息利用视线法原理和几何法求轨迹方程生成参考点的第三位置信息(即参考点的位置坐标);
具体的,无人艇P的位置坐标为P(x,y)、相邻两个该航路点的位置坐标分别为 Pk-1(xk-1,yk-1)和Pk(xk,yk),该参考点Plos的位置坐标Plos(xlos,ylos)通过通过以下公式计算得到:
其中,半径R为以无人艇为圆心所做的LOS圆的半径,方位角αk-1为该路径单元的方位角。
本领域的技术人员应当明白,该半径R的大小选取与无人艇的船长、回转半径等尺寸参数相关,在一些优选实施例中该半径R的大小等于两倍的船长。
S215:基于第一位置信息(即无人艇的位置坐标)和第三位置信息(即参考点的位置坐标)利用投影算法生成期望艏向角,也即基于无人艇P的位置坐标P(x,y)和参考点Plos的位置坐标Plos(xlos,ylos)生成期望艏向角ψlos:
具体的,期望艏向角ψlos根据投影算法通过下面公式计算得到:
其中,ye为偏航距离,Δ为前视距离,其取值范围为Δ>0。
在一些实施例中期望路径为直线形式,在另一些实施例中期望路径为折线形式,在期望路径为折线形式的状态下,航路点与折线的转折点相重合,因此相邻两个该航路点Pk-1与Pk之间形成的路径单元为直线路径单元。
S22:基于过渡目标值函数和期望艏向角创建艏向控制器
其中,过渡目标值函数为期望艏向角骤变过渡函数。在一些实施例中,该过渡目标值函数包括期望艏向角骤增过渡函数和期望艏向角骤减过渡函数。
进一步的,期望艏向角骤增过渡函数采用下面公式表述:
期望艏向角骤减过渡函数采用下面公式表述:
其中,t′为过渡时间,t0为过渡函数的作用时间,t为无人艇实时运动的时间。
更进一步的,请参见图4,S22:基于过渡目标值函数和期望艏向角创建艏向控制器包括以下步骤:
S221:将期望艏向角输入过渡目标值函数生成目标艏向角;
其中,κ为调整因子,其取值范围为0<κ<1。
在一些实施例中,期望艏向角ψlos和上述公式中的期望艏向角ψd相等,在另一些实施例中,上述公式中的期望艏向角ψd由期望艏向角ψlos经过修正过程后生成,优选的该修正过程按照无人艇在航行时遇到的风浪流条件进行。
为了能够直观的显示期望艏向角ψd和目标艏向角的变化,现以阶跃形式的输入信号为例,绘制形成期望艏向角ψd和目标艏向角的对比示意图,具体请参见图 8。从中可以看到,在过渡时间内目标艏向角小于期望艏向角ψd,在过渡时间外目标艏向角等于期望艏向角ψd。
S222:获取无人艇的艏向角信息
在一些实施例中,获取直接通过采集模块进行,在另一些实施例中,获取通过直接或间接的读取采集模块中的相关信息进行。
S223:根据艏向角信息和目标艏向角生成参数修正信息
S224:基于S面控制原理和参数修正信息创建艏向控制器
进一步的,该艏向控制器中还包括环境干扰补偿函数,本领域的技术人员应当明白该环境干扰补偿函数可以根据具体的环境干扰选择不同的函数表达,在此不对其进行限制,只要在艏向控制器中加入了环境干扰补偿函数就应当在本发明的保护范围内。
在一些实施例中,具体的,S面控制原理创建的艏向控制器的基本结构形式为:
S23:将第一位置信息、期望艏向角输入艏向控制器生成控制力矩
在一些实施例中,具体的,无人艇的控制力矩τr采用如下的公式计算得到:
本领域的技术人员应当明白,该第一位置信息、该期望艏向角和该艏向偏差的表示形式或计算方式已经在前述步骤中说明,在此不进行赘述,其可以直接在该步骤的公式中进行带入计算。
S24:根据控制力矩调整无人艇的转艏运动
在一些实施例中,根据控制力矩调整无人艇的转艏运动的步骤通过调整舵机的舵角进行。本领域的技术人员应当明白,在不采用舵机进行转艏运动控制的状态下,还可以通过控制力矩调整无人艇的其他结构来控制其转艏运动,只要能调整无人艇的转艏运动就应当在本发明的保护范围之内。
在一些实施例中,无人艇持续向参考点附近运动,当其渐近收敛到期望路径之上,在即将到达航路点Pk之时,通过判断无人艇的位置是否进入可接受圆半径Rk之内来判断是否跟踪下一条路径单元。其中,可接受圆半径Rk可以根据实际情况进行预设,在一些优选实施例中,其范围为2米至5米。
请参见图5,S3:根据速度信息和速度控制器调整无人艇的纵向运动包括以下步骤:
S31:基于积分S面方法创建速度控制器
本发明采用对基本S面的输出进行积分得到的积分S面速度控制器具有全局调节能力,且能显著消除稳态误差。
具体的,该速度控制器的结构形式如下:
其中,该公式中出现的变量与前述S面原理中的变量具有相同的物理含义,在此不对其进行赘述。
S32:根据速度信息和速度控制器生成纵向控制力
在一些具体实施例中,纵向控制力τu采用以下的公式计算得到:
其中,ku1和ku2均为控制参数,其取值范围分别为ku1>0,ku2>0,ue、分别为速度偏差和速度偏差变化率。本领域的技术人员应当明白,速度偏差ue可以根据无人艇的速度信息(即包括无人艇的纵向速度信息与期望纵向速度信息)选取不同的公式进行计算得到,在此不对其选用的具体公式进行限制。
S33:根据纵向控制力调整无人艇的纵向运动
进一步的,根据控制力调整无人艇的纵向运动的步骤通过调整推进器的转速进行。本领域的技术人员应当明白,调整推进器的转速是为了调整无人艇的纵向运动,从而控制无人艇的航行速度,进而控制其路径跟踪精度。
本发明提出的无人艇路径跟踪控制方法至少具有下列优点及有益效果:
1、采用过渡目标值函数对骤变的期望艏向角进行过渡处理,缓解了艏向误差的骤变对路径跟踪控制精度的影响;
2、采用积分S面控制原理创建速度控制器,能够消除速度跟踪时产生的稳态误差;
3、对艏向控制器和速度控制器进行解耦设计,从而降低其对无人艇的模型依赖性,且艏向控制器和速度控制器的结构形式简单、易实现。
本发明还通过一个实例对本发明提供的无人艇路径跟踪控制方法的优点及效果进行了论证,具体请参见图9,其中控制场景为无人艇跟踪一条折线路径,该折线路径由航路点1、航路点2和航路点3组成,从图9中可以直接毫无疑义的得出以下结论:在初始阶段,偏航距离的变化具有指数收敛特性;在无人艇运动至航路点2的折点处时,由于追踪的期望路径单元(即期望路径中航路点2和航路点3形成的路径单元)发生了变化,无人艇出现了小幅的超调现象,约为5m;而在其余阶段路径跟踪误差均稳定在1m以内,综合考虑,路径跟踪误差满足预设条件,控制效果提到明显提升。
实施方式二
本发明实施例还提供了一种***,该***包括执行实施方式一中任意一个实施例中无人艇路径跟踪控制方法的步骤的模块。本领域的技术人员应当了解,本发明提供的***具有和实施方式一中实施例一样的有益效果,在这里就不再进行赘述。
实施方式三
本发明实施例还提供了一种存储介质,其上存储有计算机程序11100,存储介质是计算机可读存储介质,且该程序被处理器12000执行时实现实施方式一中任一实施例方法的步骤。其中,计算机可读存储介质可以包括但不限于任何类型的盘,包括软盘、光盘、DVD、CD-ROM、微型驱动器以及磁光盘、ROM、RAM、EPROM、EEPROM、 DRAM、VRAM、闪速存储器设备、磁卡或光卡、纳米***(包括分子存储器IC),或适合于存储指令和/或数据的任何类型的媒介或设备。具体执行过程可以参见实施方式一中的方法实施例的具体说明,在此不进行赘述。
本领域的技术人员应当了解,本发明提供的存储介质具有和实施方式一中实施例一样的有益效果,在这里就不再进行赘述。
实施方式四
请参见图6,本发明实施例还提供了一种终端10000,包括存储器11000、处理器12000及存储在存储器11000上并可在处理器12000上运行的计算机程序11100。其中该处理器12000执行该计算机程序11100时实现实施方式一中任一实施例的方法。具体执行过程可以参见上述方法实施例的具体说明,在此不进行赘述。
本发明实施例中,处理器12000为计算机***的控制中心,可以是实体机的处理器12000,也可以是虚拟机的处理器12000。本发明实施例中,存储器11000中存储有至少一条指令,该指令由处理器12000加载并执行以实现上述各个实施例中的方法。
本发明实施例中的终端可以包括但不限于智能手机、平板电脑、掌上电脑、个人数字助理(Personal Digital Assistant,PAD)、交互智能平板、移动电脑等设备。
本发明另一个实施例中,处理器12000可以包括一个或多个处理核心,比如4 核心处理器、8核心处理器等。处理器12000可以采用DSP(Digital Signal Processing,数字信号处理)、FPGA(Field-Programmable Gate Array,现场可编程门阵列)、PLA(Programmable Logic Array,可编程逻辑阵列)中的至少一种硬件形式来实现。处理器12000也可以包括主处理器和协处理器,主处理器是用于对在唤醒状态下的数据进行处理的处理器,也称CPU(Central Processing Unit,中央处理器);协处理器是用于对在待机状态下的数据进行处理的低功耗处理器。
存储器11000可以包括一个或多个计算机可读存储介质,该计算机可读存储介质可以是非暂态的。存储器11000还可包括高速随机存取存储器,以及非易失性存储器,比如一个或多个磁盘存储设备、闪存存储设备。在本发明的一些实施例中,存储器 11000中的非暂态的计算机可读存储介质用于存储至少一个指令,该至少一个指令用于被处理器12000所执行以实现本发明实施例中的方法。
本领域的技术人员应当了解,本发明提供的终端10000具有和实施方式一中实施例一样的有益效果,在这里就不再进行赘述。
以上所述,仅是本发明的较佳实施例而已,并非对本发明做任何形式上的限制,虽然本发明已以较佳实施例揭露如上,然而并非用以限定本发明,任何熟悉本专业的技术人员,在不脱离本发明技术方案范围内,当可利用上述揭示的技术内容做出些许更动或修饰为等同变化的等效实施例,但凡是未脱离本发明技术方案的内容,依据本发明的技术实质对以上实施例所做的任何简单修改、等同变化与修饰,均仍属于本发明技术方案的范围内。
Claims (10)
1.一种无人艇路径跟踪控制方法,其特征在于,包括步骤:
采集无人艇的第一位置信息和速度信息;
根据所述第一位置信息和艏向控制器调整所述无人艇的转艏运动;
根据所述速度信息和速度控制器调整所述无人艇的纵向运动;
其中,所述根据所述第一位置信息和艏向控制器调整所述无人艇的转艏运动的步骤包括以下步骤:
根据所述第一位置信息和基于视线法原理创建的制导律生成所述无人艇在路径跟踪状态下的期望艏向角;
基于过渡目标值函数和所述期望艏向角创建艏向控制器;
将所述第一位置信息、所述期望艏向角输入所述艏向控制器生成控制力矩;
根据所述控制力矩调整所述无人艇的转艏运动;
其中,所述过渡目标值函数为期望艏向角骤增过渡函数和期望艏向角骤减过渡函数,且期望艏向角骤减过渡函数采用下面公式表述:
其中,t′为过渡时间,t0为过渡函数的作用时间,t为无人艇实时运动的时间;
其中,ψd为期望艏向角,κ为调整因子,其取值范围为0<κ<1。
2.根据权利要求1所述的无人艇路径跟踪控制方法,其特征在于,所述根据所述第一位置信息和基于视线法原理创建的制导律生成所述无人艇在路径跟踪状态下的期望艏向角的步骤包括以下步骤:
在期望路径上创建多个航路点;
在相邻两个所述航路点之间创建参考点;
获取所述参考点前后各一个相邻所述航路点的第二位置信息;
根据所述第一位置信息和两个所述第二位置信息利用视线法原理和几何法求轨迹方程生成所述参考点的第三位置信息;
基于所述第一位置信息和所述第三位置信息利用投影算法生成所述期望艏向角。
3.根据权利要求2所述的无人艇路径跟踪控制方法,其特征在于,所述基于过渡目标值函数和所述期望艏向角创建艏向控制器的步骤包括以下步骤:
将所述期望艏向角输入所述过渡目标值函数生成目标艏向角;
获取所述无人艇的艏向角信息;
根据所述艏向角信息和所述目标艏向角生成参数修正信息;
基于S面控制原理和所述参数修正信息创建所述艏向控制器。
5.根据权利要求3所述的无人艇路径跟踪控制方法,其特征在于,所述艏向控制器中还包括环境干扰补偿函数。
6.根据权利要求1所述的无人艇路径跟踪控制方法,其特征在于,所述根据所述速度信息和速度控制器调整所述无人艇的纵向运动的步骤包括以下步骤:
基于积分S面方法创建所述速度控制器;
根据所述速度信息和所述速度控制器生成纵向控制力;
根据所述纵向控制力调整所述无人艇的纵向运动。
7.根据权利要求6所述的无人艇路径跟踪控制方法,其特征在于,
所述根据所述控制力矩调整所述无人艇的转艏运动的步骤通过调整舵机的舵角进行;和/或
所述根据所述纵向控制力调整所述无人艇的纵向运动的步骤通过调整推进器的转速进行。
8.一种无人艇路径跟踪***,其特征在于,包括:
执行权利要求1到7中任一项权利要求所述的无人艇路径跟踪控制方法的步骤的模块。
9.一种存储介质,其上存储有计算机程序,其特征在于,
所述存储介质是计算机可读存储介质,且所述程序被执行时实现如权利要求1到7中任一项权利要求所述的无人艇路径跟踪控制方法。
10.一种终端,包括存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,其特征在于,
所述处理器执行所述计算机程序时实现如权利要求1到7中任一项权利要求所述的无人艇路径跟踪控制方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010644736.8A CN111798701B (zh) | 2020-07-07 | 2020-07-07 | 无人艇路径跟踪控制方法、***、存储介质及终端 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010644736.8A CN111798701B (zh) | 2020-07-07 | 2020-07-07 | 无人艇路径跟踪控制方法、***、存储介质及终端 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111798701A CN111798701A (zh) | 2020-10-20 |
CN111798701B true CN111798701B (zh) | 2022-07-26 |
Family
ID=72810163
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010644736.8A Active CN111798701B (zh) | 2020-07-07 | 2020-07-07 | 无人艇路径跟踪控制方法、***、存储介质及终端 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111798701B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111240192B (zh) * | 2018-11-28 | 2022-02-01 | 中国科学院沈阳自动化研究所 | 一种基于平滑切换函数的过渡过程目标值控制方法 |
CN114489091B (zh) * | 2022-01-21 | 2023-01-13 | 湖南大学无锡智能控制研究院 | 一种自主水下机器人路径跟踪的制导律控制方法、设备及*** |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103808323A (zh) * | 2012-11-07 | 2014-05-21 | 上海航天控制工程研究所 | 一种卫星姿态跟踪机动的余弦过渡加速度路径方法 |
CN104932517A (zh) * | 2015-05-15 | 2015-09-23 | 哈尔滨工业大学 | 环境干扰下的水下无人航行器航迹跟踪动态面控制优化方法 |
CN105500354A (zh) * | 2016-02-02 | 2016-04-20 | 南京埃斯顿机器人工程有限公司 | 一种工业机器人应用的过渡轨迹规划方法 |
CN105710881A (zh) * | 2016-03-16 | 2016-06-29 | 杭州娃哈哈精密机械有限公司 | 一种机器人末端连续轨迹规划过渡方法 |
CN107168335A (zh) * | 2017-06-28 | 2017-09-15 | 大连海事大学 | 一种考虑混合多目标避障的水面无人艇路径跟踪制导方法 |
CN107966152A (zh) * | 2017-11-22 | 2018-04-27 | 大连海事大学 | 一种具有碰撞风险预测机制的避碰及路径跟踪制导方法 |
CN110515392A (zh) * | 2019-08-26 | 2019-11-29 | 哈尔滨工业大学 | 一种面向性能恢复的高超声速飞行器轨迹跟踪控制方法 |
CN110647161A (zh) * | 2019-10-15 | 2020-01-03 | 哈尔滨工程大学 | 基于状态预测补偿的欠驱动uuv水平面轨迹跟踪控制方法 |
Family Cites Families (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105929842B (zh) * | 2016-04-20 | 2019-01-11 | 哈尔滨工程大学 | 一种基于动态速度调节的欠驱动uuv平面轨迹跟踪控制方法 |
CN107239075A (zh) * | 2017-04-19 | 2017-10-10 | 哈尔滨工程大学 | 自主水下航行器平面直线航线跟踪的智能s面制导控制方法 |
CN107544500B (zh) * | 2017-09-18 | 2020-12-29 | 哈尔滨工程大学 | 一种考虑约束的无人艇靠泊行为轨迹规划方法 |
CN107765701A (zh) * | 2017-11-15 | 2018-03-06 | 哈尔滨工程大学 | 一种适用于回转体平台的艏向控制方法 |
CN108415423B (zh) * | 2018-02-02 | 2020-12-04 | 哈尔滨工程大学 | 一种高抗扰自适应路径跟随方法及*** |
CN108594807B (zh) * | 2018-03-30 | 2019-05-24 | 武汉理工大学 | 一种无人水面艇折线路径跟踪控制***及方法 |
CN109283842B (zh) * | 2018-08-02 | 2022-01-07 | 哈尔滨工程大学 | 一种无人艇航迹跟踪智能学习控制方法 |
CN109240288B (zh) * | 2018-08-31 | 2021-08-10 | 武汉理工大学 | 一种基于轨迹单元的障碍物情况下无人艇避碰路径规划方法 |
CN109808853A (zh) * | 2019-03-05 | 2019-05-28 | 上海大学 | 一种无人艇艏向航速分级控制***及其控制方法 |
CN109901402B (zh) * | 2019-04-08 | 2021-10-29 | 哈尔滨工程大学 | 一种基于航向平滑技术的自主水下机器人路径跟踪方法 |
CN110377036B (zh) * | 2019-07-09 | 2022-04-05 | 哈尔滨工程大学 | 一种基于指令约束的无人水面艇航迹跟踪固定时间控制方法 |
CN110308719B (zh) * | 2019-07-11 | 2022-02-22 | 哈尔滨工程大学 | 一种水面无人艇路径跟踪控制方法 |
CN110673598B (zh) * | 2019-09-29 | 2022-10-25 | 哈尔滨工程大学 | 一种水面无人艇智能路径跟踪控制方法 |
CN110609556A (zh) * | 2019-10-09 | 2019-12-24 | 广东华中科技大学工业技术研究院 | 一种基于los导航法的多无人艇协同控制方法 |
CN110618611A (zh) * | 2019-10-23 | 2019-12-27 | 哈尔滨工程大学 | 一种基于回转率约束的无人艇轨迹跟踪安全控制方法 |
CN111208824B (zh) * | 2020-02-17 | 2021-03-23 | 上海大学 | 一种无人艇航行串级控制***及其控制方法 |
-
2020
- 2020-07-07 CN CN202010644736.8A patent/CN111798701B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103808323A (zh) * | 2012-11-07 | 2014-05-21 | 上海航天控制工程研究所 | 一种卫星姿态跟踪机动的余弦过渡加速度路径方法 |
CN104932517A (zh) * | 2015-05-15 | 2015-09-23 | 哈尔滨工业大学 | 环境干扰下的水下无人航行器航迹跟踪动态面控制优化方法 |
CN105500354A (zh) * | 2016-02-02 | 2016-04-20 | 南京埃斯顿机器人工程有限公司 | 一种工业机器人应用的过渡轨迹规划方法 |
CN105710881A (zh) * | 2016-03-16 | 2016-06-29 | 杭州娃哈哈精密机械有限公司 | 一种机器人末端连续轨迹规划过渡方法 |
CN107168335A (zh) * | 2017-06-28 | 2017-09-15 | 大连海事大学 | 一种考虑混合多目标避障的水面无人艇路径跟踪制导方法 |
CN107966152A (zh) * | 2017-11-22 | 2018-04-27 | 大连海事大学 | 一种具有碰撞风险预测机制的避碰及路径跟踪制导方法 |
CN110515392A (zh) * | 2019-08-26 | 2019-11-29 | 哈尔滨工业大学 | 一种面向性能恢复的高超声速飞行器轨迹跟踪控制方法 |
CN110647161A (zh) * | 2019-10-15 | 2020-01-03 | 哈尔滨工程大学 | 基于状态预测补偿的欠驱动uuv水平面轨迹跟踪控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111798701A (zh) | 2020-10-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109116856B (zh) | 一种基于扰动观测器的欠驱动船舶路径跟踪控制方法 | |
CN107024863B (zh) | 一种避免微分***的uuv轨迹跟踪控制方法 | |
CN108073175B (zh) | 基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法 | |
CN111487966B (zh) | 一种基于航路点的水面无人艇自适应路径跟踪控制方法 | |
CN111798701B (zh) | 无人艇路径跟踪控制方法、***、存储介质及终端 | |
CN111798702B (zh) | 无人艇路径跟踪控制方法、***、存储介质及终端 | |
CN111930123B (zh) | 多目标综合优化决策方法、装置及电子设备 | |
Deraj et al. | Deep reinforcement learning based controller for ship navigation | |
CN104950882A (zh) | 全局一致渐进路径跟踪引导控制方法 | |
Yang et al. | An improved stanley guidance law for large curvature path following of unmanned surface vehicle | |
CN116360260B (zh) | 基于触发制导和自更新阈值的asv预设性能控制方法 | |
CN115113524B (zh) | 一种基于干预lvs制导的asv多端口事件触发路径跟踪控制方法 | |
CN117826824B (zh) | 船舶自适应自主航行决策方法、装置及电子设备 | |
Wang et al. | Vector field-based integral LOS path following and target tracking for underactuated unmanned surface vehicle | |
CN111752278B (zh) | 航行设备的定点控制方法、装置及电子设备 | |
Yılmaz et al. | Parallel docking problem for unmanned surface vehicles | |
Yuan et al. | EMPMR berthing scheme: A novel event-triggered motion planning and motion replanning scheme for unmanned surface vessels | |
CN111651943B (zh) | 一种船舶运动控制方法、终端设备及存储介质 | |
Wu et al. | Deep reinforcement learning with intrinsic curiosity module based trajectory tracking control for USV | |
CN114740859A (zh) | 一种船只自动悬停方法及*** | |
Li et al. | [Retracted] A Systematic Pipelaying Control Method Based on the Sliding Matrix for Dynamically Positioned Surface Vessels | |
CN117234217B (zh) | 基于三维时空域的水面无人艇轨迹跟踪制导方法及*** | |
CN112068550A (zh) | 一种船舶航向跟踪控制的方法 | |
Salarieh et al. | Trajectory optimization for a high speed planing boat based on Gauss pseudospectral method | |
CN115268459B (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 |