CN115616907A - 一种无人艇航向智能规划方法及控制器 - Google Patents
一种无人艇航向智能规划方法及控制器 Download PDFInfo
- Publication number
- CN115616907A CN115616907A CN202211158293.7A CN202211158293A CN115616907A CN 115616907 A CN115616907 A CN 115616907A CN 202211158293 A CN202211158293 A CN 202211158293A CN 115616907 A CN115616907 A CN 115616907A
- Authority
- CN
- China
- Prior art keywords
- unmanned ship
- course
- planning
- ship course
- intelligent planning
- 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 43
- 239000011159 matrix material Substances 0.000 claims abstract description 36
- 238000013528 artificial neural network Methods 0.000 claims abstract description 18
- 238000005457 optimization Methods 0.000 claims abstract description 16
- 230000006870 function Effects 0.000 claims description 43
- 238000003062 neural network model Methods 0.000 claims description 22
- 238000005070 sampling Methods 0.000 claims description 19
- 230000009466 transformation Effects 0.000 claims description 14
- 238000012887 quadratic function Methods 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims description 3
- 238000004590 computer program Methods 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 2
- 238000013461 design Methods 0.000 abstract description 4
- 238000005265 energy consumption Methods 0.000 abstract description 3
- 230000000694 effects Effects 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 4
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 4
- 238000010586 diagram Methods 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012797 qualification Methods 0.000 description 1
- 238000011160 research 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/0088—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots characterized by the autonomous decision making process, e.g. artificial intelligence, predefined behaviours
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/0265—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric the criterion being a learning criterion
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/3446—Details of route searching algorithms, e.g. Dijkstra, A*, arc-flags, using precalculated routes
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/34—Route searching; Route guidance
- G01C21/3453—Special cost functions, i.e. other than distance or default speed limit of road segments
-
- 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
-
- 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/20—Control system inputs
- G05D1/22—Command input arrangements
- G05D1/221—Remote-control arrangements
- G05D1/227—Handing over between remote control and on-board control; Handing over between remote control arrangements
-
- 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/60—Intended control result
- G05D1/69—Coordinated control of the position or course of two or more vehicles
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06N—COMPUTING ARRANGEMENTS BASED ON SPECIFIC COMPUTATIONAL MODELS
- G06N3/00—Computing arrangements based on biological models
- G06N3/02—Neural networks
- G06N3/04—Architecture, e.g. interconnection topology
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G3/00—Traffic control systems for marine craft
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Artificial Intelligence (AREA)
- Aviation & Aerospace Engineering (AREA)
- Health & Medical Sciences (AREA)
- Evolutionary Computation (AREA)
- Software Systems (AREA)
- Medical Informatics (AREA)
- Theoretical Computer Science (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Business, Economics & Management (AREA)
- General Health & Medical Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Biomedical Technology (AREA)
- Biophysics (AREA)
- Computational Linguistics (AREA)
- Data Mining & Analysis (AREA)
- Game Theory and Decision Science (AREA)
- Molecular Biology (AREA)
- Computing Systems (AREA)
- General Engineering & Computer Science (AREA)
- Mathematical Physics (AREA)
- Ocean & Marine Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
本发明涉及一种无人艇航向智能规划方法及控制器,所述方法基于近似动态规划的最优化原理,实现无人艇航向偏角从起点到终点的整体最优化规划;通过二次型代价函数及其性能指标,以及虚拟RBF神经网络和最小二乘法的设计,实现航向偏角和控制信号均最小化的优化目标,最终求出无人艇航向智能规划的最优化航向表达式,并通过无人艇性能指标黑森矩阵的正定约束来保证其稳定性和收敛程度。与现有技术相比,本发明减少了偏航和控制信号超调,实现航程和操舵能耗的最优化;并实现了完全由数据驱动的无人艇航向智能规划和高精度的反馈调节。
Description
技术领域
本发明涉及智能控制和船舶与海洋工程技术领域,尤其是涉及一种无人艇航向智能规划方法及控制器。
背景技术
近年来,随着无人驾驶技术的快速发展,水面无人艇受到越来越多的关注。相较于无人机和无人车,无人艇的研究还处于探索阶段。无人艇作为一种具有自主规划、自主航向能力等作业任务的小型水面平台,在复杂多变的水域环境中,其运动是非线性的,所受干扰具有不确定性。由此,无人艇的航向规划与控制技术显得尤为重要。
比如中国申请专利CN202110533417.4公开了一种吊舱式无人艇航向控制方法,可减少时延问题,满足内河无人艇对航向偏差控制的要求;中国申请专利CN202111549519.1公开了一种无人艇航向控制方法、控制器、自动舵以及无人艇,实现了一种基于模糊自适应PD控制的无人艇航向控制方法;中国申请专利CN202110306691.8公开了一种无人艇航向自抗扰控制系统及控制方法,实现了基于模糊神经网络的无人艇航向自抗扰控制系统及方法;中国申请专利CN202210591518.1公开了一种无人艇导航方法,解决了无人艇航向角漂移的导航困难问题等。
然而,上述方法大多还属于传统控制方法,用于解决无人艇航向控制有关的单一问题;还不具备无人艇航向智能规划的能力,更没有全局优化的智能规划效果。
因此,在无人艇航向规划与控制方面,单一技术难以适用于复杂水域环境和全局规划要求;将多种智能控制技术和智能算法融合设计的无人艇航向控制器,才能保证在不同场景下都发挥优越的规划与控制效果。
发明内容
本发明的目的就是为了克服上述现有技术存在的缺陷而提供一种无人艇航向智能规划方法及控制器。
本发明的目的可以通过以下技术方案来实现:
一种无人艇航向智能规划方法,包括以下步骤:
构建无人艇航向智能规划的动态系统;
对所述无人艇航向智能规划的动态系统进行形式变换;
基于形式变换后的无人艇航向智能规划的动态系统,设计无人艇航向智能规划的代价函数;
基于所述代价函数,设计无人艇航向智能规划的性能指标及其连续逼近差;
基于所述性能指标及其连续逼近差,设计神经网络模型;
基于所述神经网络模型,等效求出无人艇航向智能规划的性能指标中的函数;
基于所述性能指标中的函数,求出无人艇航向智能规划的最优化航向表达式;
基于所述最优化航向表达式及所述性能指标,构建黑森矩阵,并判断该黑森矩阵的正定性;
若所述黑森矩阵的正定性满足预设的要求,则输出所述最优化航向表达式,并将所述最优化航向表达式输入预设的反馈网络。
优选地,基于以下方程,构建所述无人艇航向智能规划的动态系统:
其中,θ(t),分别表示无人艇的航向偏角、其对时间的一阶偏导数和二阶偏导数;M表示无人艇的有效载荷质量;g表示重力加速度;L表示无人艇的长度;J表示无人艇的惯性矩;D表示无人艇的粘滞摩擦阻力;v(t)表示实际海况的扰动信号;u(t)表示最优化航向。
在此形式下,无人艇航向智能规划动态系统的状态变量为x(t)=[x1(t),x2(t)]T。
进一步地,基于形式变换后的无人艇航向智能规划的动态系统,设计无人艇航向智能规划的代价函数为:
γ(t)=γ[x(t),u(t),t]=a1Δx1 2(t)+a2Δx2 2(t)+a3u2(t)
其中,γ(t)、γ[x(t),u(t),t]均表示t时刻无人艇航向智能规划的代价函数;Δx1(t)表示t时刻的航向偏角与其规划航线上的航向偏角之差;Δx2(t)表示t时刻的航向偏角对时间t的偏导数;a1,a2和a3分别表示Δx1(t)、Δx2(t)及u(t)的优化权重系数。
进一步地,基于线性二次型函数,设计无人艇航向智能规划的性能指标Q(t)为:
Q(t)=[Δx1(t),Δx2(t),u(t)]P(t)[Δx1(t),Δx2(t),u(t)]T
其中,P(t)是二次型性能指标的上三角权矩阵,其中元素均为时间t的变量;
基于所述代价函数,无人艇航向智能规划的性能指标Q(t)的连续逼近差记为γ(t+1),表示相邻采样时间t+1和t下的性能指标Q(t)与Q(t+1)之差,其表达式为:
Q(t)-αQ(t+1)=Q(x(t),u(t))-αQ(x(t+1),u(t+1))
=γ[x(t+1),u(t+1),t+1]=γ(t+1)
其中,α代表折扣因子,α>0。
进一步地,基于所述性能指标及其连续逼近差,设计神经网络模型,所述神经网络模型为RBF神经网络模型;
设计RBF神经网络的基函数为矩阵φ(x(t),u(t)):
φ(x(t),u(t))=[x1 2(t),2x1(t)x2(t),2x1(t)u(t),x2 2(t),2x2(t)u(t),u2(t)]T
设计RBF神经网络的连接权值参数为矩阵w(t):
w(t)=[p11(t),p12(t),p13(t),p22(t),p23(t),p33(t)]T
其中,矩阵w(t)中的各个变量与无人艇航向智能规划的性能指标中矩阵P(t)中的变量一致。
进一步地,所述RBF神经网络模型收集在相邻采样时间下Φ(t)和Γ(t)的N个采样数据对,其中,Φ(t)与所述RBF神经网络模型的基函数有关,Γ(t)与无人艇航向智能规划性能指标的连续逼近差有关,将所述N个采样数据对对齐排列,得到Φ(t)和Γ(t):
Φ(t)=[φ1(x(t),u(t))-φ1(x(t+1),u(t+1)),φ2(x(t+1),u(t+1))-φ2(x(t+2),u(t+2)),…,φN(x(t+N-1),u(t+N-1))-φ6(x(t+N),u(t+N))]
其中,所述采样数据对的个数N大于或等于所述RBF神经网络网络的基函数个数;Φ(t)和Γ(t)的N个采样数据对的运算关系为:
ΦT(t)w(t)=Γ(t)
采用最小二乘法求出w(t),即:
w(t)=(Φ(t)ΦT(t))-1Φ(t)ΓT(t)
等效求出无人艇航向智能规划的性能指标中的函数P(t)。
进一步地,基于所述性能指标中的函数P(t),求出无人艇航向智能规划的最优化航向表达式,包括以下步骤:
基于二次型形式的近似动态规划最优化目标式:
通过求解无人艇航向智能规划性能指标Q(t)对最优化航向输入信号u(t)的偏导数,得到无人艇航向智能规划的最优化航向表达式为:
进一步地,基于所述最优化航向表达式及所述性能指标,计算无人艇航向智能规划的性能指标Q(t)对每一个状态变量x(t)和最优化航向u(t)的二阶偏导数,构建以下黑森矩阵:
一种无人艇航向智能规划控制器,包括存储器和处理器,所述存储器存储有计算机程序,所述处理器调用所述程序指令能够执行如上所述的无人艇航向智能规划方法。
与现有技术相比,本发明具有以下有益效果:
本发明基于近似动态规划的最优化原理,实现无人艇航向智能规划的控制目标,即在一定的无人艇有效载荷质量和海况扰动下,航向偏角能实现从起点到终点的整体最优,则步步最优,即能在无人艇航行全过程上实现高精度的航向规划。
通过二次型代价函数及其性能指标,以及虚拟RBF神经网络和最小二乘法的特别设计,能实现航向偏角和控制信号均最小化,从而减少了偏航和控制信号超调,实现航程和操舵能耗的最优化,降低了无人艇航行功耗;并实现了完全由数据驱动的无人艇航向智能规划和高精度的反馈调节。
附图说明
图1为本发明的实施流程图;
图2为本发明的结构和原理示意图。
具体实施方式
下面结合附图和具体实施例对本发明进行详细说明。本实施例以本发明技术方案为前提进行实施,给出了详细的实施方式和具体的操作过程,但本发明的保护范围不限于下述的实施例。
本发明提出了一种无人艇航向智能规划方法,基于近似动态规划的最优化原理,实现航向偏角能从起点到终点的整体最优,则步步最优。通过二次型代价函数及其性能指标,以及虚拟RBF神经网络和最小二乘法的特别设计,能实现航向偏角和控制信号均最小化的优化目标。
如图1所示,一种无人艇航向智能规划方法,包括以下步骤:
1、构建无人艇航向智能规划的动态系统;
2、对无人艇航向智能规划的动态系统进行形式变换;
3、基于形式变换后的无人艇航向智能规划的动态系统,设计无人艇航向智能规划的特定代价函数;
4、基于代价函数,设计无人艇航向智能规划的性能指标及其连续逼近差;
5、基于性能指标及其连续逼近差,设计神经网络模型,该神经网络模型为虚拟RBF神经网络模型;
6、基于虚拟RBF神经网络模型,等效求出无人艇航向智能规划的性能指标中的P(t)函数;
7、基于性能指标中的P(t)函数,求出无人艇航向智能规划的最优化航向表达式;
8、基于最优化航向表达式及性能指标,构建黑森矩阵,并判断该黑森矩阵的正定性;
9、若黑森矩阵的正定性满足预设的要求,即能够达到智能规划效果,则输出最优化航向表达式,并将最优化航向表达式输入预设的反馈网络;若黑森矩阵的正定性不满足预设的要求,则返回步骤1,并依次重新执行各个步骤。
本发明还提供了一种无人艇航向智能规划控制器,包括存储器和处理器,存储器存储有计算机程序,处理器调用程序指令能够执行如上无人艇航向智能规划方法。
对于步骤1,构建实际海况下无人艇航向智能规划的动态系统,在本实施例中,其动态过程可基于以下二阶动态方程设计:
其中,θ(t),分别表示无人艇的航向偏角、其对时间的一阶偏导数和二阶偏导数,单位分别是度、度/秒、度/秒2;M表示无人艇的有效载荷质量,单位是千克;g表示重力加速度,单位是米/秒2;L表示无人艇的长度,单位是米;J表示无人艇的惯性矩,单位是千克·米2;D表示无人艇的粘滞摩擦阻力,单位是牛顿/(米/秒);v(t)表示实际海况的扰动信号;u(t)表示最优化航向。
在此形式下,无人艇航向智能规划动态系统的状态变量为x(t)=[x1(t),x2(t)]T。
本实施例中,无人艇航向智能规划动态系统的参数设置为:M=1,g=9.8,L=0.5,J=1,D=2,所添加实际海况2的扰动信号为v(t)=x2(t)sin(x1(t)),无人艇的初始状态设置为x(0)=[1,-0.5]T,初始的最优化航向10设置为u(0)=-0.36。
对于步骤3,基于形式变换后的无人艇航向智能规划的动态系统,设计无人艇航向智能规划的代价函数,为实现航向偏角和控制信号均最小化的优化目标,从而减少偏航和控制信号超调,实现航程和操舵能耗的最优化,本实施例中,代价函数可特别设计为:
γ(t)=γ[x(t),u(t),t]=a1Δx1 2(t)+a2Δx2 2(t)+a3u2(t)
其中,γ(t)、γ[x(t),u(t),t]均表示t时刻无人艇航向智能规划的代价函数;Δx1(t)表示t时刻的航向偏角与其规划航线上的航向偏角之差;Δx2(t)表示t时刻的航向偏角对时间t的偏导数;a1,a2和a3分别表示Δx1(t)、Δx2(t)及u(t)的优化权重系数,本实施例中a1,a2和a3均可以取为1,在其他的实施方式中可根据具体需求更改其取值。
对于步骤4,为实现数据驱动和直接反馈形式的无人艇1航向智能规划,基于线性二次型函数,设计无人艇航向智能规划的性能指标Q(t)为:
Q(t)=[Δx1(t),Δx2(t),u(t)]P(t)[Δx1(t),Δx2(t),u(t)]T
其中,P(t)是二次型性能指标的上三角权矩阵,其中元素p11(t),p12(t),p13(t),p22(t),p23(t),p33(t)均为时间t的变量;
基于线性二次型函数及代价函数,无人艇航向智能规划的性能指标Q(t)的连续逼近差记为γ(t+1),表示相邻采样时间t+1和t下的性能指标Q(t)与Q(t+1)之差,其表达式为:
Q(t)-αQ(t+1)=Q(x(t),u(t))-αQ(x(t+1),u(t+1))
=γ[x(t+1),u(t+1),t+1]=γ(t+1)
其中,α代表折扣因子,0<α<1,本实施例中取α=0.95,在其他的实施方式中可根据具体需求更改其取值。
对于步骤5,基于性能指标及其连续逼近差,设计神经网络模型,本实施例中,该神经网络模型为虚拟RBF神经网络模型;“RBF神经网络”表示径向基神经网络。本实施例中,性能指标Q(t)的最优化值,应当与基于一个虚拟的RBF神经网络所逼近的最优化结果保持一致。
可设计该虚拟RBF神经网络的基函数为如下6×1矩阵φ(x(t),u(t)):
φ(x(t),u(t))=[x1 2(t),2x1(t)x2(t),2x1(t)u(t),x2 2(t),2x2(t)u(t),u2(t)]T
本实施例中,6是该虚拟RBF神经网络的基函数个数。
设计RBF神经网络的连接权值参数为如下6×1矩阵w(t):
w(t)=[p11(t),p12(t),p13(t),p22(t),p23(t),p33(t)]T
其中,矩阵w(t)中的各个变量与无人艇航向智能规划的性能指标中矩阵P(t)中的变量一致,即连接权值参数w(t)里的pij(t),正好是无人艇航向智能规划性能指标P(t)矩阵中第i行第j列的变量;同时,上式的设计还考虑到了需符合其后续矩阵计算的形式。
对于步骤6,本实施例对该虚拟RBF神经网络配置了评价模块,负责收集在相邻采样时间下Φ(t)和Γ(t)的N个采样数据对,其中,Φ(t)与RBF神经网络模型的基函数有关,Γ(t)与无人艇航向智能规划性能指标的连续逼近差有关,将N个采样数据对对齐排列,得到Φ(t)和Γ(t):
Φ(t)=[φ1(x(t),u(t))-φ1(x(t+1),u(t+1)),φ2(x(t+1),u(t+1))-φ2(x(t+2),u(t+2)),…,φN(x(t+N-1),u(t+N-1))-φ6(x(t+N),u(t+N))]
ΦT(t)w(t)=Γ(t)
采用最小二乘法求出w(t),即:
w(t)=(Φ(t)ΦT(t))-1Φ(t)ΓT(t)
由于w(t)的元素与P(t)中的元素一致,因此可以等效求出无人艇航向智能规划的性能指标中的函数P(t)。
对于步骤7,基于性能指标中的函数P(t),求出无人艇航向智能规划的最优化航向表达式,包括以下步骤:
基于二次型形式的近似动态规划最优化目标式:
通过求解无人艇航向智能规划性能指标Q(t)对最优化航向输入信号u(t)的偏导数,得到直接反馈形式的无人艇航向智能规划的最优化航向u(t)的表达式为:
对于步骤8,基于最优化航向表达式及性能指标,计算无人艇航向智能规划的性能指标Q(t)对每一个状态变量x(t)和最优化航向u(t)的二阶偏导数,构建以下黑森矩阵:
对于步骤9,黑森矩阵正定性的预设要求由所述领域专业技术人员制定,本实施例中,黑森矩阵是正定矩阵,在该正定约束下,该无人艇的航向智能规划在每一个时间步长,都是全局最优的,也是收敛的,即能够达到智能规划效果。最后则输出最优化航向表达式,并将最优化航向表达式输入反馈网络。
如图2所示,为本发明的结构和原理示意图,构成一个反馈网络。在一种具体的实施方式中,无人艇1航向智能规划控制器9,规划出整体最优则步步最优的最优化航向10:u(t),控制无人艇1,在实际海况2下,获得t时刻的航向偏角3,与规划航线上的航向偏角4,经求差函数5,求出t时刻的航向偏角与其规划航向上的航向偏角之差7:Δx1(t);t时刻的航向偏角3,经求导函数6,求出t时刻的航向偏角对时间t的偏导数8:Δx2(t);最后,Δx1(t)、Δx2(t)和u(t),输入给无人艇1航向智能规划控制器9,经上述具体实施方式的步骤1-8,计算出新的最优化航向10:u(t),并将该新的最优化航向10再次输入反馈网络,不断优化无人艇航向的规划精度。
以上详细描述了本发明的较佳具体实施例。应当理解,本领域的普通技术人员无需创造性劳动就可以根据本发明的构思作出诸多修改和变化。因此,凡本技术领域中技术人员依本发明的构思在现有技术的基础上通过逻辑分析、推理或者有限的实验可以得到的技术方案,皆应在由权利要求书所确定的保护范围内。
Claims (10)
1.一种无人艇航向智能规划方法,其特征在于,包括以下步骤:
构建无人艇航向智能规划的动态系统;
对所述无人艇航向智能规划的动态系统进行形式变换;
基于形式变换后的无人艇航向智能规划的动态系统,设计无人艇航向智能规划的代价函数;
基于所述代价函数,设计无人艇航向智能规划的性能指标及其连续逼近差;
基于所述性能指标及其连续逼近差,设计神经网络模型;
基于所述神经网络模型,等效求出无人艇航向智能规划的性能指标中的函数;
基于所述性能指标中的函数,求出无人艇航向智能规划的最优化航向表达式;
基于所述最优化航向表达式及所述性能指标,构建黑森矩阵,并判断该黑森矩阵的正定性;
若所述黑森矩阵的正定性满足预设的要求,则输出所述最优化航向表达式,并将所述最优化航向表达式输入预设的反馈网络。
4.根据权利要求3所述的一种无人艇航向智能规划方法,其特征在于,基于形式变换后的无人艇航向智能规划的动态系统,设计无人艇航向智能规划的代价函数为:
γ(t)=γ[x(t),u(t),t]=a1Δx1 2(t)+a2Δx2 2(t)+a3u2(t)
其中,γ(t)、γ[x(t),u(t),t]均表示t时刻无人艇航向智能规划的代价函数;Δx1(t)表示t时刻的航向偏角与其规划航线上的航向偏角之差;Δx2(t)表示t时刻的航向偏角对时间t的偏导数;a1,a2和a3分别表示Δx1(t)、Δx2(t)及u(t)的优化权重系数。
5.根据权利要求4所述的一种无人艇航向智能规划方法,其特征在于,基于线性二次型函数,设计无人艇航向智能规划的性能指标Q(t)为:
Q(t)=[Δx1(t),Δx2(t),u(t)]P(t)[Δx1(t),Δx2(t),u(t)]T
其中,P(t)是二次型性能指标的上三角权矩阵,其中元素均为时间t的变量;
基于所述代价函数,无人艇航向智能规划的性能指标Q(t)的连续逼近差记为γ(t+1),表示相邻采样时间t+1和t下的性能指标Q(t)与Q(t+1)之差,其表达式为:
Q(t)-αQ(t+1)=Q(x(t),u(t))-αQ(x(t+1),u(t+1))
=γ[x(t+1),u(t+1),t+1]=γ(t+1)
其中,α代表折扣因子,α>0。
6.根据权利要求5所述的一种无人艇航向智能规划方法,其特征在于,基于所述性能指标及其连续逼近差,设计神经网络模型,所述神经网络模型为RBF神经网络模型;
设计RBF神经网络的基函数为矩阵φ(x(t),u(t)):
φ(x(t),u(t))=[x1 2(t),2x1(t)x2(t),2x1(t)u(t),x2 2(t),2x2(t)u(t),u2(t)]T
设计RBF神经网络的连接权值参数为矩阵w(t):
w(t)=[p11(t),p12(t),p13(t),p22(t),p23(t),p33(t)]T
其中,矩阵w(t)中的各个变量与无人艇航向智能规划的性能指标中矩阵P(t)中的变量一致。
7.根据权利要求6所述的一种无人艇航向智能规划方法,其特征在于,所述RBF神经网络模型收集在相邻采样时间下Φ(t)和Γ(t)的N个采样数据对,其中,Φ(t)与所述RBF神经网络模型的基函数有关,Γ(t)与无人艇航向智能规划性能指标的连续逼近差有关,将所述N个采样数据对对齐排列,得到Φ(t)和Γ(t):
Φ(t)=[φ1(x(t),u(t))-φ1(x(t+1),u(t+1)),φ2(x(t+1),u(t+1))-φ2(x(t+2),u(t+2)),…,φN(x(t+N-1),u(t+N-1))-φ6(x(t+N),u(t+N))]
其中,所述采样数据对的个数N大于或等于所述RBF神经网络网络的基函数个数;Φ(t)和Γ(t)的N个采样数据对的运算关系为:
ΦT(t)w(t)=Γ(t)
采用最小二乘法求出w(t),即:
w(t)=(Φ(t)ΦT(t))-1Φ(t)ΓT(t)
等效求出无人艇航向智能规划的性能指标中的函数P(t)。
10.一种无人艇航向智能规划控制器,其特征在于,包括存储器和处理器,所述存储器存储有计算机程序,所述处理器调用所述程序指令能够执行如权利要求1至9任一所述的无人艇航向智能规划方法。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211158293.7A CN115616907B (zh) | 2022-09-22 | 2022-09-22 | 一种无人艇航向智能规划方法及控制器 |
LU503035A LU503035B1 (en) | 2022-09-22 | 2022-11-10 | Method and controller for intelligently planning course of unmanned surface vehicle |
US18/366,669 US11977383B2 (en) | 2022-09-22 | 2023-08-07 | Intelligent course planning method and controller for unmanned surface vehicle |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211158293.7A CN115616907B (zh) | 2022-09-22 | 2022-09-22 | 一种无人艇航向智能规划方法及控制器 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115616907A true CN115616907A (zh) | 2023-01-17 |
CN115616907B CN115616907B (zh) | 2023-08-04 |
Family
ID=84858478
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211158293.7A Active CN115616907B (zh) | 2022-09-22 | 2022-09-22 | 一种无人艇航向智能规划方法及控制器 |
Country Status (3)
Country | Link |
---|---|
US (1) | US11977383B2 (zh) |
CN (1) | CN115616907B (zh) |
LU (1) | LU503035B1 (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN118011820A (zh) * | 2024-02-06 | 2024-05-10 | 大连海事大学 | 考虑输入死区的无人船自适应动态规划航向跟踪控制方法 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004118658A (ja) * | 2002-09-27 | 2004-04-15 | Advanced Telecommunication Research Institute International | 物理系の制御方法および装置ならびに物理系の制御のためのコンピュータプログラム |
US20170312614A1 (en) * | 2016-05-02 | 2017-11-02 | Bao Tran | Smart device |
CN108073175A (zh) * | 2018-01-23 | 2018-05-25 | 上海交通大学 | 基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法 |
CN110018687A (zh) * | 2019-04-09 | 2019-07-16 | 大连海事大学 | 基于强化学习方法的无人水面船最优轨迹跟踪控制方法 |
US20200064444A1 (en) * | 2015-07-17 | 2020-02-27 | Origin Wireless, Inc. | Method, apparatus, and system for human identification based on human radio biometric information |
CN112947477A (zh) * | 2021-03-23 | 2021-06-11 | 哈尔滨工程大学 | 一种无人艇航向自抗扰控制系统及控制方法 |
CN113671964A (zh) * | 2021-08-24 | 2021-11-19 | 上海大学 | 一种无人艇高性能轨迹跟踪控制系统和方法 |
CN113900372A (zh) * | 2021-09-03 | 2022-01-07 | 广东工业大学 | 一种基于神经网络自抗扰控制的无人艇航向保持方法 |
WO2022047709A1 (zh) * | 2020-09-03 | 2022-03-10 | 深圳市大疆创新科技有限公司 | 更新限制区域数据的方法、装置、可移动平台和计算机存储介质 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB8808475D0 (en) * | 1988-04-11 | 1988-05-11 | Erba Carlo Spa | Process for preparing 4-demethoxydauno-mycinone |
US11274929B1 (en) * | 2017-10-17 | 2022-03-15 | AI Incorporated | Method for constructing a map while performing work |
US11263549B2 (en) * | 2018-03-22 | 2022-03-01 | Here Global B.V. | Method, apparatus, and system for in-vehicle data selection for feature detection model creation and maintenance |
US11340082B2 (en) * | 2019-07-02 | 2022-05-24 | Nvidia Corporation | Determining localization confidence of vehicles based on convergence ranges |
US20220307849A1 (en) * | 2021-07-30 | 2022-09-29 | Intel Corporation | Path planning system and method with intelligent sampling and two-way search (its) |
-
2022
- 2022-09-22 CN CN202211158293.7A patent/CN115616907B/zh active Active
- 2022-11-10 LU LU503035A patent/LU503035B1/en active
-
2023
- 2023-08-07 US US18/366,669 patent/US11977383B2/en active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004118658A (ja) * | 2002-09-27 | 2004-04-15 | Advanced Telecommunication Research Institute International | 物理系の制御方法および装置ならびに物理系の制御のためのコンピュータプログラム |
US20200064444A1 (en) * | 2015-07-17 | 2020-02-27 | Origin Wireless, Inc. | Method, apparatus, and system for human identification based on human radio biometric information |
US20170312614A1 (en) * | 2016-05-02 | 2017-11-02 | Bao Tran | Smart device |
CN108073175A (zh) * | 2018-01-23 | 2018-05-25 | 上海交通大学 | 基于虚拟艇自适应规划的欠驱动无人艇编队智能控制方法 |
CN110018687A (zh) * | 2019-04-09 | 2019-07-16 | 大连海事大学 | 基于强化学习方法的无人水面船最优轨迹跟踪控制方法 |
WO2022047709A1 (zh) * | 2020-09-03 | 2022-03-10 | 深圳市大疆创新科技有限公司 | 更新限制区域数据的方法、装置、可移动平台和计算机存储介质 |
CN112947477A (zh) * | 2021-03-23 | 2021-06-11 | 哈尔滨工程大学 | 一种无人艇航向自抗扰控制系统及控制方法 |
CN113671964A (zh) * | 2021-08-24 | 2021-11-19 | 上海大学 | 一种无人艇高性能轨迹跟踪控制系统和方法 |
CN113900372A (zh) * | 2021-09-03 | 2022-01-07 | 广东工业大学 | 一种基于神经网络自抗扰控制的无人艇航向保持方法 |
Non-Patent Citations (5)
Title |
---|
JIAN-CHUAN YIN 等: "《On-line predictionofshiprollmotionduringmaneuveringusingsequential learning RBFneuralnetworks》", 《OCEAN ENGINEERING》 * |
ZIHAN LIU 等: "《Research on Shipyard Integrated Navigation Algorithm based on Radial basis function neural network》", 《2021 4TH INTERNATIONAL SYMPOSIUM ON TRAFFIC TRANSPORTATION AND CIVIL ARCHITECTURE》 * |
唐冲 等: "《改进型LM-RBF 神经网络在自抗扰控制器上的应用》", 《兵工自动化》, pages 11 - 13 * |
文元桥 等: "《无人艇自适应路径跟踪控制器的设计与验证》", 《哈尔滨工程大学学报》, vol. 40, no. 3, pages 482 - 488 * |
随博文 等: "《基于深度Q 网络的水面无人艇路径规划算法》", 《上海海事大学学报》, vol. 41, no. 3, pages 1 - 5 * |
Also Published As
Publication number | Publication date |
---|---|
US20240118694A1 (en) | 2024-04-11 |
US11977383B2 (en) | 2024-05-07 |
CN115616907B (zh) | 2023-08-04 |
LU503035B1 (en) | 2023-05-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Xiang et al. | Robust fuzzy 3D path following for autonomous underwater vehicle subject to uncertainties | |
Zhang et al. | Novel DVS guidance and path-following control for underactuated ships in presence of multiple static and moving obstacles | |
CN115016496A (zh) | 基于深度强化学习的水面无人艇路径跟踪方法 | |
Mu et al. | Fuzzy‐based optimal adaptive line‐of‐sight path following for underactuated unmanned surface vehicle with uncertainties and time‐varying disturbances | |
Zhang et al. | Disturbance observer-based composite neural learning path following control of underactuated ships subject to input saturation | |
Londhe et al. | Robust proportional derivative (PD)-like fuzzy control designs for diving and steering planes control of an autonomous underwater vehicle | |
CN110361975A (zh) | 一种基于滑模技术的umv状态时滞系统的自适应容错控制方法 | |
Mu et al. | Path following for podded propulsion unmanned surface vehicle: Theory, simulation and experiment | |
CN115616907A (zh) | 一种无人艇航向智能规划方法及控制器 | |
CN113848887A (zh) | 一种基于mlp方法的欠驱动无人艇轨迹跟踪控制方法 | |
Gao et al. | Command filtered path tracking control of saturated ASVs based on time‐varying disturbance observer | |
Kinjo et al. | Trajectory tracking of a fully-actuated surface vessel using nonlinear model predictive control | |
Li et al. | Event-triggered robust adaptive control for path following of the URS in presence of the marine practice | |
Gao et al. | Tracking control for a quadrotor via dynamic surface control and adaptive dynamic programming | |
Wang et al. | Design and implementation of a testing platform for ship control: A case study on the optimal switching controller for ship motion | |
CN109375642B (zh) | 一种无人机节能控制方法 | |
CN115248553A (zh) | 欠驱动船舶的事件触发自适应pid航迹跟踪容错控制方法 | |
CN114217603A (zh) | 一种多无人船编队安全优化控制系统 | |
Zhang et al. | Hybrid threshold event-triggered control for sail-assisted USV via the nonlinear modified LVS guidance | |
da Silva et al. | Project and control allocation of a 3 DoF autonomous surface vessel with aerial azimuth propulsion system | |
CN113156825A (zh) | 一种自适应反步滑模控制的舰载光电跟踪系统设计方法 | |
CN114943168B (zh) | 一种水上浮桥组合方法及系统 | |
CN114715331B (zh) | 一种浮式海洋平台动力定位控制方法及系统 | |
Zhang et al. | Composite neural learning event-triggered control for dynamic positioning vehicles with the fault compensation mechanism | |
Xu et al. | Robust adaptive path following control of autonomous underwater vehicle with uncertainties and communication bandwidth limitation |
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 |