CN115421483A - 一种无人船操纵运动预报方法 - Google Patents
一种无人船操纵运动预报方法 Download PDFInfo
- Publication number
- CN115421483A CN115421483A CN202211004479.7A CN202211004479A CN115421483A CN 115421483 A CN115421483 A CN 115421483A CN 202211004479 A CN202211004479 A CN 202211004479A CN 115421483 A CN115421483 A CN 115421483A
- Authority
- CN
- China
- Prior art keywords
- unmanned ship
- kernel function
- motion
- usv
- propeller
- 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
- 238000013277 forecasting method Methods 0.000 title claims description 14
- 238000000034 method Methods 0.000 claims abstract description 33
- 238000012360 testing method Methods 0.000 claims description 36
- 238000012549 training Methods 0.000 claims description 32
- 238000004422 calculation algorithm Methods 0.000 claims description 17
- 239000013598 vector Substances 0.000 claims description 17
- 238000012795 verification Methods 0.000 claims description 16
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 14
- 238000005259 measurement Methods 0.000 claims description 9
- 238000005457 optimization Methods 0.000 claims description 9
- 238000012545 processing Methods 0.000 claims description 9
- 238000010606 normalization Methods 0.000 claims description 7
- 230000010355 oscillation Effects 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 claims description 5
- 230000005484 gravity Effects 0.000 claims description 3
- 230000008569 process Effects 0.000 abstract description 10
- 230000000694 effects Effects 0.000 abstract description 5
- 230000006870 function Effects 0.000 description 74
- 238000001914 filtration Methods 0.000 description 10
- 230000009471 action Effects 0.000 description 5
- 230000008859 change Effects 0.000 description 5
- 230000009977 dual effect Effects 0.000 description 5
- 238000007781 pre-processing Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 238000011160 research Methods 0.000 description 3
- 230000007547 defect Effects 0.000 description 2
- 230000007613 environmental effect Effects 0.000 description 2
- 238000011156 evaluation Methods 0.000 description 2
- 238000012706 support-vector machine Methods 0.000 description 2
- 230000009466 transformation Effects 0.000 description 2
- 238000007476 Maximum Likelihood Methods 0.000 description 1
- 230000004075 alteration Effects 0.000 description 1
- 238000013473 artificial intelligence Methods 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000002790 cross-validation Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000002349 favourable effect Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000010998 test method 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
本发明涉及无人艇技术领域，公开了一种无人船操纵运动预报方法，无人船USV的试验测量数据作为系统输入输出的变化数据序列，通过基于混合核函数的支持向量回归MK‑SVR方法进行辨识，建立无人船USV操纵运动模型，实现操纵运动预报，并对预报效果进行评估。本发明的有益效果为兼具学习能力强与泛化性能优的双重优势，对实际航行过程的USV操纵运动预报具有良好的效果。
Description
技术领域
本发明涉及无人艇技术领域，涉及一种无人船操纵运动预报方法，具体涉及一种基于MK-SVR模型的无人船操纵运动预报方法。
背景技术
水面无人船(unmanned surface vehicle，USV)是一种新型的水上智能工作平台，在如自主巡逻、水文勘测等军事、民用领域都发挥着巨大作用，但强非线性的船舶运动特征、随机的环境干扰等因素均对USV智能化水平提出很高要求。无人船自主导航和自动避碰是实现其智能化应用的重要支撑，这两项技术的基础都是建立精准的操纵运动模型对船舶操纵运动进行预报。因此，对于高度智能化的水面无人船，操纵运动预报就显得尤为重要，操纵运动试验加系统辨识是目前成本较低且有效可靠的预报方法之一。
早期，学者通过经典的系统辨识算法，如最小二乘法、卡尔曼滤波、极大似然法等进行参数辨识建立船舶操纵运动模型，但这些算法对变量初值和参数估计初值存在较大依赖性。为了改善经典算法本身的技术缺陷，人工智能算法在船舶操纵运动辨识建模中得到广泛应用，其中，支持向量回归(SVR)作为支持向量机(SVM)回归形式的应用，克服了神经网络算法维度受限、易陷入局部极值等缺点，但回归精度不高。在此基础上，学者们对算法进行了深入研究，通过对算法结构和超参数的优化进行了改进。
现有研究大多关注在系统辨识算法的精度方面，且研究样本数据是来自仿真试验，难以反映随机环境因素干扰下的船舶实际航行过程的运动参数变化，对SVR算法学习精度和泛化性能的验证尚不充分。另一方面，基于小型无人船的约束试验耗费成本较大，通过快速性试验对其操纵性进行评估和有效预报具有重要意义。
目前，常用方法包括采用多项式核函数支持向量回归(PK-SVR)和径向基核函数支持向量回归(RBF-SVR)建立USV操纵运动预报模型；PK-SVR所建立的操纵运动预报模型泛化性能整体上优于RBF-SVR，而在学习精度上则低于后者。
发明内容
针对现有技术中存在的问题，为了得到兼并学习能力强和泛化性能优的操纵运动预报模型，本发明提供了一种联合多项式核函数(PK)和径向基核函数(RBF)的混合核函数支持向量回归(MK-SVR)的无人船操纵运动辨识建模方法，对实际航行过程的USV操纵运动预报具有良好的效果。
为实现上述目的，本发明提供如下技术方案：
一种无人船操纵运动预报方法，包括以下步骤：
步骤1：开展无人船USV操纵运动试验；
步骤2：对所述步骤1中无人船USV操纵运动试验的试验数据进行预处理；所述试验数据包括运动参数u、v、r和控制输入转速ns、np；其中，u、v、r分别表示无人船在随体坐标系o-xyz中x轴、y轴方向的速度和绕z轴的转艏角速度，即u表示纵向速度、v表示横向速度、r表示转向角速度；ns、np为控制输入转速，即分别表示左、右螺旋桨转速；
步骤3：将所述步骤2中预处理后的试验数据分为训练数据集与验证数据集；
步骤4：将所述训练数据集中的运动参数u、v、r和控制输入转速ns、np的时间序列进行数据归一化处理，得到归一化处理后的训练数据集；
步骤5：对无人船USV进行运动学数学建模，表示出无人船在随体坐标系和惯性坐标系中各运动量的关系；所述各运动量包括无人船的纵向速度、横向速度、转向角速度以及艏向角；
步骤6：根据所述步骤5中各运动量的关系对无人船USV进行动力学建模；
步骤7：基于所述步骤6中对无人船USV进行的动力学建模，联合多项式核函数PK和径向基核函数RBF构建混合核函数支持向量回归MK-SVR的无人船操纵运动辨识建模算法，开始辨识建模；
步骤8：将所述步骤4中得到的归一化处理后的训练数据集中的运动参数带入所述步骤7中构建的混合核函数支持向量回归MK-SVR，对混合核函数权重系数进行参数寻优，得到寻优后的混合核函数权重系数；
步骤9：基于确定了权重系数的混合核函数支持向量回归MK-SVR，辨识得到SVR模型，进行SVR模型训练，将其训练结果与联合多项式核函数PK、径向基核函数RBF的预测结果进行对比，得到最优SVR模型；
步骤10：由于辨识得到的SVR模型，包含了无人船的动力学参数，后续，只需要根据螺旋桨指令等动力信息，就可以进行运动预报，得到运动参数的预测值，根据所述步骤9中得到的最优SVR模型得到无人船运动参数u、v、r的预测值，从而进行运动预报。
进一步地，所述步骤5中无人船USV在随体坐标系和惯性坐标系中各运动量的关系为：
其中，在惯性坐标系o0-x0y0z0中通过无人船重心位置(x0G,y0G)和艏向角ψ表示运动过程的位置和姿态，
表示在惯性坐标系中无人船的纵向速度、
表示在惯性坐标系中无人船的横向速度、
表示惯性坐标系中无人船的艏向角角速度。
进一步地，所述步骤6中对无人船USV进行动力学建模的步骤为：
步骤6-1：根据牛顿第二定律，建立无人船USV三自由度操纵运动方程；
步骤6-2：对所述步骤6-1中得到的无人船USV三自由度操纵运动方程进行简化，得到无人船USV粘性水动力模型。
进一步地，所述步骤6-1中无人船USV三自由度操纵运动方程为：
其中，XH、YH、NH分别为无人船所受粘性水动力的纵向分力、横向分力和转艏力矩；XP、YP、NP分别为螺旋桨作用于船舶的纵荡力、横荡力和艏摇力矩；m为无人船质量；mx和my分别为无人船在x轴和y轴上的附加质量；Iz和Jz分别为绕z轴的转动惯量和附加转动惯量。
进一步地，所述步骤6-2中无人船USV粘性水动力模型如下：
其中，Xuu、Xrr、Yv、Yr、Yrr、Nv、Nr、Nrr皆为水动力系数；XH、YH、NH分别为无人船所受粘性水动力的纵向分力、横向分力和转艏力矩；
两螺旋桨对称安装，螺旋桨轴系与随体坐标系中x轴同向，螺旋桨作用力及力矩计算模型如下：
其中，XP、YP、NP分别为螺旋桨作用于船舶的纵荡力、横荡力和艏摇力矩；T(s)、T(p)分别为左右螺旋桨的有效推力；tP(s)、tP(p)分别为左右螺旋桨的推力减额系数；KT(s)、KT(p)分别为左右螺旋桨的推力系数；ρ为水的密度；ns为左螺旋桨转速，np为右螺旋桨转速；D为螺旋桨直径；l为螺旋桨距离船中纵轴线的距离。
进一步地，所述步骤7中，多项式核函数PK为：KPK(u,v)＝(gamma*uTv+coef0)degree；径向基核函数RBF为：KRBF(u,v)＝exp(-γ||u-v||2)；其中，γ表示带宽。
进一步地，所述步骤7中，联合多项式核函数PK和径向基核函数RBF根据Mercer定理构造的混合核函数MK为：
其中，
分别为多项式核函数PK与径向基核函数RBF的权值，σ表示决定两个权值的系数。
进一步地，所述步骤7中还包括将所述步骤3和步骤4中的数据带入多项式核函数PK与径向基核函数RBF中，得到基于多项式核函数PK的预测值与训练集中的实测数据的均方误差、基于径向基核函数RBF的预测值与训练集中的实测数据的均方误差、基于多项式核函数PK的预测值与验证数据集中的实测数据的均方误差、基于径向基核函数RBF的预测值与验证数据集中的实测数据的均方误差。
进一步地，本发明的预报方法还包括以下步骤：
步骤11：基于所述步骤9中辨识得到的最优SVR模型对训练数据集内的运动参数进行预测，将预测值与训练集中的实测数据对比，计算两者的均方误差，通过对比多项式核函数PK、径向基核函数RBF以及混合核函数MK这3种不同核函数的SVR的预报结果(u、v、r)的均方误差，均方误差越小，则学习能力越强。
进一步地，本发明的预报方法还包括以下步骤：
步骤12：基于所述步骤9中辨识得到的最优SVR模型对验证数据集内的运动参数进行预测，将预测值与验证数据集中的实测数据对比，计算两者的均方误差，通过对比多项式核函数PK、径向基核函数RBF以及混合核函数MK这3种不同核函数的SVR的预报结果(u、v、r)的均方误差，均方误差越小，则泛化性能越强。
进一步地，通过开展无人船USV的Z型操纵运动试验获得后续辨识建模所需样本数据。
进一步地，采用高斯滤波对无人船USV操纵运动试验的试验数据进行预处理。
与现有技术相比，本发明提供了一种无人船操纵运动预报方法，具备以下有益效果：
(1)本发明的操纵运动预报方法，针对USV操纵运动预报对模型学习能力和泛化性能的双重要求，提出了一种混合核函数支持向量回归(MK-SVR)的无人船操纵运动辨识建模方法，构造混合核函数(MK)构建MK-SVR模型进行USV操纵运动预报，其核函数构造结合了多项式核函数(PK)和径向基核函数(RBF)，对比RBF-SVR模型的学习精度有所提高，模型泛化性也优于PK-SVR模型，兼具学习能力强与泛化性能优的双重优势，对实际航行过程的USV操纵运动预报具有良好的效果。
(2)本发明的辨识建模基于实船试验实测数据，在进行辨识建模前对数据进行预处理；采用用高斯滤波进行去噪处理，并除去水流速度的影响，预处理后的的试验数据较为稳定，有利于建立精确有效的预报模型。
(3)本发明的辨识建模基于实船参数，预报方法中的判断条件所需的计算以及物理量的测量均较为简易，利用简单的程序语句和传感器均可实现。
附图说明
图1为本发明基于MK-SVR辨识建模流程图；
图2为惯性坐标系和随体坐标系；
图3为实船试验航向角变化图；
图4为无人船部分轨迹图；
图5为相对大地和相对水流的纵向速度、横向速度变化图；
图6为高斯滤波前后的无人船Z型试验数据。
具体实施方式
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
本发明的整个系统由无人艇以及所搭载的设备构成，具体需搭载的设备如下：
除了保证无人艇正常航行的设备外，本发明要求无人艇搭载有：GPS定位系统，无线通讯天线、惯性导航、摄像头、探测仪模块等；通过惯性导航系统和GPS来获取定位信息，通过探测仪获取流速信息；此外，本发明的运动预报方法针对所有双桨推进的船舶都适用，并不局限于表1中各项参数的无人船。
表1无人船各项参数
如图1所示，本发明的无人船操纵运动预报方法基于MK-SVR模型，包括以下步骤：
步骤1：开展无人船USV操纵运动试验；
步骤2：对所述步骤1中无人船USV操纵运动试验的试验数据进行预处理；所述试验数据包括运动参数u、v、r和控制输入转速ns、np；其中，u、v、r分别表示无人船在随体坐标系o-xyz中x轴、y轴方向的速度和绕z轴的转艏角速度，即u表示纵向速度、v表示横向速度、r表示转向角速度；ns、np为控制输入转速，即分别表示左、右螺旋桨转速；
步骤3：将所述步骤2中预处理后的试验数据分为训练数据集与验证数据集；
步骤4：将所述训练数据集中的运动参数u、v、r和控制输入转速n(s)、n(p)的时间序列进行数据归一化处理；
步骤5：对无人船USV进行运动学数学建模，表示出无人船在随体坐标系和惯性坐标系中各运动量的关系；所述各运动量包括无人船的纵向速度、横向速度、转向角速度以及艏向角；
步骤6：根据所述步骤5中各运动量的关系对无人船USV进行动力学建模；
步骤7：基于所述步骤6中对无人船USV进行的动力学建模，联合多项式核函数PK和径向基核函数RBF得到混合核函数支持向量回归MK-SVR的无人船操纵运动辨识建模算法，开始辨识建模；
步骤8：对混合核函数权重系数进行参数寻优，得到寻优后的混合核函数权重系数；
步骤9：将所述步骤8中得到的寻优后的混合核函数权重系数带入所述步骤3中得到的混合核函数中进行SVR模型训练；
步骤10：根据所述步骤9中得到的混合核函数中的SVR模型得到无人船运动参数u、v、r的预测值，从而进行运动预报。
在本实施例的一种具体实施方式中，步骤5中无人船USV在随体坐标系和惯性坐标系中各运动量的关系为：
其中，船舶在水平面内的运动通常采用如图2所示的惯性坐标系和随体坐标系进行描述，两坐标系均遵循右手螺旋定律。
其中，在惯性坐标系o0-x0y0z0中通过无人船重心位置(x0G,y0G)和艏向角
表示运动过程的位置和姿态，
表示在惯性坐标系中无人船的纵向速度、
表示在惯性坐标系中无人船的横向速度、
表示惯性坐标系中无人船的艏向角角速度。
在本实施例的一种具体实施方式中，步骤6中对无人船USV进行动力学建模的步骤为：
步骤6-1：根据牛顿第二定律，建立无人船USV三自由度操纵运动方程；
无人船USV三自由度操纵运动方程为：
其中，XH、YH、NH分别为无人船所受粘性水动力的纵向分力、横向分力和转艏力矩；XP、YP、NP分别为螺旋桨作用于船舶的纵荡力、横荡力和艏摇力矩；m为无人船质量；mx和my分别为无人船在x轴和y轴上的附加质量；Iz和Jz分别为绕z轴的转动惯量和附加转动惯量。
步骤6-2：由于USV双螺旋桨轴系角度固定，自身无横向主动力，横向速度v的产生来源于坐标变换产生的科里奥利力，所以v、r水动力导数存在耦合；另外，v数值较小，高阶耦合项所起作用可以忽略不计，因此，对上述操纵运动方程进行简化，得到无人船USV粘性水动力模型。
无人船USV粘性水动力模型如下：
其中，Xuu、Xrr、Yv、Yr、Yrr、Nv、Nr、Nrr皆为水动力系数；XH、YH、NH分别为无人船所受粘性水动力的纵向分力、横向分力和转艏力矩；
两螺旋桨对称安装，螺旋桨轴系与随体坐标系中x轴同向，螺旋桨作用力及力矩计算模型如下：
其中，XP、YP、NP分别为螺旋桨作用于船舶的纵荡力、横荡力和艏摇力矩；T(s)、T(p)分别为左右螺旋桨的有效推力；tP(s)、tP(p)分别为左右螺旋桨的推力减额系数；KT(s)、KT(p)分别为左右螺旋桨的推力系数；ρ为水的密度；ns为左螺旋桨转速，np为右螺旋桨转速；D为螺旋桨直径；l为螺旋桨距离船中纵轴线的距离。
在本实施例的一种具体实施方式中，在步骤7中的具体辨识建模算法如下：
SVR算法原理：
假设给定一个特征空间上的训练数据集：Ds＝{(x1,y1),(x2,y2),...,(xN,yN)}，其中，xi∈Rn，yi∈{+1,-1}，i＝1,2,...N，xi为第i个特征向量，SVR算法是为了寻找回归模型f(x)＝ωTx+b，使得f(x)与y尽可能接近，其中，ω、b是训练得到的模型的法向量和位移，可以根据训练数据集求得，ω的求解如式(9)中第一个式子；b的求解如式(12)。
相较于传统回归模型基于f(x)与y之间的差异来计算损失，当且仅当f(x)与y完全等同时，损失才为零。SVR假设容许误差为ε，当f(x)与y之间的差的绝对值大于ε时计算损失。于是求解回归模型的最优化问题写成：
其中，C为正则化常数，lε为损失函数
N为训练数据集的数据个数。
为使最优化问题确定有解，引入松弛变量ξi和
优化问题转化为下式问题：
通过求解上述问题的对偶形式可以得到最优解。引入Lagrangian乘子μi≥0,
α≥0,
得到Lagrangian函数：
分别求偏导得到：
将上面的式子代入Lagrangian函数得到对偶问题：
其满足KKT条件：
求解对偶问题得到：
其中，S为支持向量集合，|S|为集合中支持向量的个数。
SVR核函数：
对于输入空间中的非线性问题，需要通过非线性变换转化为某个维特征空间中的线性问题进行处理。由于线性支持向量回归学习的对偶问题，目标函数和分类决策函数都只涉及实例和实例之间的内积，所以通过核函数替换当中的内积便可得到解决非线性问题的SVR。
若核函数为：K(x,xi)＝φ(x)Tφ(xi)，则SVR的解为：
由于核函数的形式很多，不同的形式具备的特点各有不同，相应的由它们所构建的SVR也会有不同的特性；且，目前核函数可以划分为两类：全局核函数和局部核函数；又由于全局核函数的代表有多项式核函数(PK)，它能获取与待测点相距较远的全局信息，有较好的推广泛化能力，而局部核函数的代表有径向基核函数(RFB)，其值只受相距很近数据点的影响，表现为学习能力较强；故，本发明为兼并学习能力强和泛化性能优的操纵运动预报模型提出种联合多项式核函数(PK)和径向基核函数(RBF)的混合核函数支持向量回归(MK-SVR)的无人船操纵运动辨识建模方法，对实际航行过程的USV操纵运动预报具有良好的效果。
多项式核函数(PK)为：
KPK(u,v)＝(gamma*uTv+coef0)degree (15)
径向基核函数(RBF)：
KRBF(u,v)＝exp(-γ||u-v||2) (16)
其中，γ表示带宽，用于控制径向作用范围。
联合多项式核函数PK和径向基核函数RBF根据Mercer定理构造的混合核函数(MK)为：
其中，
分别为多项式核函数(PK)与径向基核函数(RBF)的权值；σ表示决定两个权值的系数，当σ确定，两个的权值便可以确定，可以直接根据认为经验确定或通过优化算法确定，比如K折交叉验证优化算法确定σ。由于
避免了其中一种核函数完全不起作用而导致精度过低或泛化性能太差的问题。
根据辨识得到的SVR模型对训练数据集内的运动参数进行预测，将预测值与训练集中的实测数据对比，计算两者的均方误差；均方误差越小，则学习能力越强。经过学习能力评估，本发明(MK-SVR)的运动预报对比RBF-SVR模型，RBF-SVR预报结果的均方误差基本可以控制在0.001m/s以内，MK-SVR预报结果的均方误差基本可以控制在0.0004m/s以内，改进后的方法预报效果明显更贴近试验值，学习能力也更好。
根据辨识得到的SVR模型对验证数据集内的运动参数进行预测，将预测值与验证数据集中的实测数据对比，计算两者的均方误差；均方误差越小，则泛化性能越强。经过学习能力评估，本发明(MK-SVR)的运动预报对比PK-SVR模型，PK-SVR预报结果的均方误差基本可以控制在0.0012m/s以内，MK-SVR预报结果的均方误差基本可以控制在0.0004m/s以内，表明混合核函数有对泛化性能提高的有效性。
在本实施例的一种具体实施方式中，所述均方误差计算公式如下：
其中，
为根据辨识建模对训练数据集(或验证数据集)内的运动参数进行预测得到的预测值，即模型预测值，θ为预处理后的对应训练数据集(或验证数据集)中的运动参数，即数据集中的实测值，E(*)为期望函数。
在本实施例的一种具体实施方式中，在步骤1中，通过开展无人船USV的Z型操纵运动试验获得后续辨识建模所需样本数据。试验过程通过上位机远程操控，试验数据通过无人船USV搭载传感器实时监测，监测量包括无人船惯性坐标(x,y)、航向角ψ、纵向速度u、横向速度v、转向角速度r以及左右螺旋桨转速ns和npnr，采样间隔为0.25秒，图3是实船试验过程的航向角变化，其中ψ_hope为期望航向角，ψ_real为实际航向角，图4是无人船部分轨迹图。
在本实施例的一种具体实施方式中，步骤2中，采用高斯滤波对无人船USV操纵运动的试验数据进行预处理，滤波前后的数据如图6，其中图6中(a)图表示高斯滤波前后无人船Z型试验纵向速度变化值，图6中(b)图表示高斯滤波前后无人船Z型试验横向速度变化值，由2图对比可知由于外部干扰因素的随机性，即便进行了去噪处理之后，运动参数的时序曲线也并非稳定，仍存在上下小幅度波动，且在控制航向角突变的时刻，运动参数均存在瞬时的大幅度波动，是在瞬时操纵改变运动状态时无人船的惯性超调现象；图中u_test表示高斯滤波前Z型试验纵向速度变化值，u_filtered表示高斯滤波后Z型试验纵向速度变化值。
除随机噪声之外，试验过程的主要干扰还有河段水流的影响。图5中(a)图和(b)图中uc、vc分别是无人船相对大地的纵向速度和横向速度变化，故需要去除定常水流的横向速度和纵向速度。
在本实施例的一种具体实施方式中，在步骤3中，基于步骤6中建立的模型以及步骤7中的试验数据进行无人船操纵运动辨识建模及预报，辨识建模的输入为经预处理的纵向速度u、横向速度v和转向角速度r，取其中800秒内的样本为训练数据集，取另外1200秒内的样本为验证数据集。
需要说明的是，在本文中，诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来，而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且，术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含，从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素，而且还包括没有明确列出的其他要素，或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下，由语句“包括一个……”限定的要素，并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
尽管已经示出和描述了本发明的实施例，对于本领域的普通技术人员而言，可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换和变型，本发明的范围由所附权利要求及其等同物限定。
Claims (10)
1.一种无人船操纵运动预报方法，其特征在于，包括以下步骤：
步骤1：开展无人船USV操纵运动试验；
步骤2：对所述步骤1中无人船USV操纵运动试验的试验数据进行预处理；所述试验数据包括运动参数u、v、r和控制输入转速ns、np；其中，u、v、r分别表示无人船在随体坐标系o-xyz中x轴、y轴方向的速度和绕z轴的转艏角速度，即u表示纵向速度、v表示横向速度、r表示转向角速度；ns、np为控制输入转速，即分别表示左、右螺旋桨转速；
步骤3：将所述步骤2中预处理后的试验数据分为训练数据集与验证数据集；
步骤4：将所述训练数据集中的运动参数u、v、r和控制输入转速ns、np的时间序列进行数据归一化处理，得到归一化处理后的训练数据集；
步骤5：对无人船USV进行运动学数学建模，表示出无人船在随体坐标系和惯性坐标系中各运动量的关系；
步骤6：根据所述步骤5中各运动量的关系对无人船USV进行动力学建模；
步骤7：基于所述步骤6中对无人船USV进行的动力学建模，联合多项式核函数PK和径向基核函数RBF构建混合核函数支持向量回归MK-SVR的无人船操纵运动辨识建模算法，开始辨识建模；
步骤8：将所述步骤4中得到的归一化处理后的训练数据集中的运动参数带入所述步骤7中构建的混合核函数支持向量回归MK-SVR，对混合核函数权重系数进行参数寻优，得到寻优后的混合核函数权重系数；
步骤9：基于确定了权重系数的混合核函数支持向量回归MK-SVR，辨识得到SVR模型，进行SVR模型训练，将其训练结果与联合多项式核函数PK、径向基核函数RBF的预测结果进行对比，得到最优SVR模型；
步骤10：根据所述步骤9中得到的最优SVR模型得到无人船运动参数u、v、r的预测值，从而进行运动预报。
2.根据权利要求1所述的一种无人船操纵运动预报方法，其特征在于：所述步骤5中无人船USV在随体坐标系和惯性坐标系中各运动量的关系为：
其中，在惯性坐标系o0-x0y0z0中通过无人船重心位置(x0G,y0G)和艏向角ψ表示运动过程的位置和姿态，
表示在惯性坐标系中无人船的纵向速度、
表示在惯性坐标系中无人船的横向速度、
表示惯性坐标系中无人船的艏向角角速度。
3.根据权利要求1所述的一种无人船操纵运动预报方法，其特征在于：所述步骤6中对无人船USV进行动力学建模的步骤为：
步骤6-1：根据牛顿第二定律，建立无人船USV三自由度操纵运动方程；
步骤6-2：对所述步骤6-1中得到的无人船USV三自由度操纵运动方程进行简化，得到无人船USV粘性水动力模型。
4.根据权利要求3所述的一种无人船操纵运动预报方法，其特征在于：所述步骤6-1中无人船USV三自由度操纵运动方程为：
其中，XH、YH、NH分别为无人船所受粘性水动力的纵向分力、横向分力和转艏力矩；XP、YP、NP分别为螺旋桨作用于船舶的纵荡力、横荡力和艏摇力矩；m为无人船质量；mx和my分别为无人船在x轴和y轴上的附加质量；Iz和Jz分别为绕z轴的转动惯量和附加转动惯量。
5.根据权利要求3所述的一种无人船操纵运动预报方法，其特征在于：所述步骤6-2中无人船USV粘性水动力模型如下：
其中，Xuu、Xrr、Yv、Yr、Yrr、Nv、Nr、Nrr皆为水动力系数；XH、YH、NH分别为无人船所受粘性水动力的纵向分力、横向分力和转艏力矩；
两螺旋桨对称安装，螺旋桨轴系与随体坐标系中x轴同向，螺旋桨作用力及力矩计算模型如下：
其中，XP、YP、NP分别为螺旋桨作用于船舶的纵荡力、横荡力和艏摇力矩；T(s)、T(p)分别为左右螺旋桨的有效推力；tP(s)、tP(p)分别为左右螺旋桨的推力减额系数；KT(s)、KT(p)分别为左右螺旋桨的推力系数；ρ为水的密度；ns为左螺旋桨转速，np为右螺旋桨转速；D为螺旋桨直径；l为螺旋桨距离船中纵轴线的距离。
6.根据权利要求1所述的一种无人船操纵运动预报方法，其特征在于：所述步骤7中，多项式核函数PK为：KPK(u,v)＝(gamma*uTv+coef0)degree；径向基核函数RBF为：KRBF(u,v)＝exp(-γ||u-v||2)；其中，γ表示带宽。
7.根据权利要求6所述的一种无人船操纵运动预报方法，其特征在于：所述步骤7中，联合多项式核函数PK和径向基核函数RBF根据Mercer定理构造的混合核函数MK为：
其中，
分别为多项式核函数PK与径向基核函数RBF的权值，σ表示决定两个权值的系数。
8.根据权利要求1所述的一种无人船操纵运动预报方法，其特征在于：所述步骤7中还包括将所述步骤3和步骤4中的数据带入多项式核函数PK与径向基核函数RBF中，得到基于多项式核函数PK的预测值与训练集中的实测数据的均方误差、基于径向基核函数RBF的预测值与训练集中的实测数据的均方误差、基于多项式核函数PK的预测值与验证数据集中的实测数据的均方误差、基于径向基核函数RBF的预测值与验证数据集中的实测数据的均方误差。
9.根据权利要求8所述的一种无人船操纵运动预报方法，其特征在于：还包括以下步骤：
步骤11：基于所述步骤9中辨识得到的最优SVR模型对训练数据集内的运动参数进行预测，将预测值与训练集中的实测数据对比，计算两者的均方误差。
10.根据权利要求8所述的一种无人船操纵运动预报方法，其特征在于，还包括以下步骤：
步骤12：基于所述步骤9中辨识得到的最优SVR模型对验证数据集内的运动参数进行预测，将预测值与验证数据集中的实测数据对比，计算两者的均方误差。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202211004479.7A CN115421483B (zh) | 2022-08-22 | 2022-08-22 | 一种无人船操纵运动预报方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202211004479.7A CN115421483B (zh) | 2022-08-22 | 2022-08-22 | 一种无人船操纵运动预报方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN115421483A true CN115421483A (zh) | 2022-12-02 |
| CN115421483B CN115421483B (zh) | 2024-06-14 |
Family
ID=84197520
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202211004479.7A Active CN115421483B (zh) | 2022-08-22 | 2022-08-22 | 一种无人船操纵运动预报方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN115421483B (zh) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN117556172A (zh) * | 2024-01-11 | 2024-02-13 | 青岛哈尔滨工程大学创新发展中心 | 船舶操纵运动预报模型构建方法及船舶操纵运动预报方法 |
| CN117610293A (zh) * | 2023-11-29 | 2024-02-27 | 华中科技大学 | 一种基于时变参数建模的无人艇操纵运动预测方法及系统 |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20210117796A1 (en) * | 2020-12-01 | 2021-04-22 | Harbin Engineering University | Ship Motion Prediction Method Based on Long Short-Term Memory Network and Gaussian Process Regression |
| CN114859910A (zh) * | 2022-04-28 | 2022-08-05 | 武汉理工大学 | 基于深度强化学习的无人船路径跟随系统及方法 |
-
2022
- 2022-08-22 CN CN202211004479.7A patent/CN115421483B/zh active Active
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20210117796A1 (en) * | 2020-12-01 | 2021-04-22 | Harbin Engineering University | Ship Motion Prediction Method Based on Long Short-Term Memory Network and Gaussian Process Regression |
| CN114859910A (zh) * | 2022-04-28 | 2022-08-05 | 武汉理工大学 | 基于深度强化学习的无人船路径跟随系统及方法 |
Non-Patent Citations (1)
| Title |
|---|
| 徐锋;邹早建;徐小卡;尹建川;: "基于支持向量机的船舶操纵运动黑箱建模", 北京航空航天大学学报, no. 11, 29 October 2013 (2013-10-29) * |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN117610293A (zh) * | 2023-11-29 | 2024-02-27 | 华中科技大学 | 一种基于时变参数建模的无人艇操纵运动预测方法及系统 |
| CN117556172A (zh) * | 2024-01-11 | 2024-02-13 | 青岛哈尔滨工程大学创新发展中心 | 船舶操纵运动预报模型构建方法及船舶操纵运动预报方法 |
| CN117556172B (zh) * | 2024-01-11 | 2024-04-19 | 青岛哈尔滨工程大学创新发展中心 | 船舶操纵运动预报模型构建方法及船舶操纵运动预报方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN115421483B (zh) | 2024-06-14 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN107168312B (zh) | 一种补偿uuv运动学和动力学干扰的空间轨迹跟踪控制方法 | |
| Kraus | Wave glider dynamic modeling, parameter identification and simulation | |
| CN101833338B (zh) | 无人潜航器垂直面欠驱动运动控制方法 | |
| Zhang et al. | NNFFC-adaptive output feedback trajectory tracking control for a surface ship at high speed | |
| CN115421483A (zh) | 一种无人船操纵运动预报方法 | |
| CN110658814B (zh) | 一种应用于船舶运动控制的自适应船舶运动建模方法 | |
| CN105005679B (zh) | 一种基于粒子滤波的船舶参数辨识方法 | |
| CN111562742B (zh) | 一种欠驱动船舶的在线建模与自适应控制方法 | |
| CN106054607A (zh) | 水下检测与作业机器人动力定位方法 | |
| Qu et al. | Wind feed-forward control of a USV | |
| CN113467231A (zh) | 基于侧滑补偿ilos制导律的无人艇路径跟踪方法 | |
| CN104316025A (zh) | 一种基于船体姿态信息估计海浪浪高的系统 | |
| Qu et al. | Nonlinear station keeping control for underactuated unmanned surface vehicles to resist environmental disturbances | |
| Kinjo et al. | Trajectory tracking of a fully-actuated surface vessel using nonlinear model predictive control | |
| Baier et al. | Hybrid physics and deep learning model for interpretable vehicle state prediction | |
| Guo et al. | Sins/gnss-integrated navigation of surface vessels based on various nonlinear kalman filters and large ship dynamics | |
| Zhang et al. | Research on the maneuverability and path following control of the wave glider with a propeller-rudder system | |
| Liu et al. | Improved path following for autonomous marine vehicles with low-cost heading/course sensors: Comparative experiments | |
| Lin et al. | The depth-keeping performance of autonomous underwater vehicle advancing in waves integrating the diving control system with the adaptive fuzzy controller | |
| LIU et al. | Design of variable stability ship control system for ship intelligent navigation test | |
| CN116540717A (zh) | 一种基于改进dwa的auv局部路径规划方法 | |
| Jaroś et al. | Data fusion of GPS sensors using particle Kalman filter for ship dynamic positioning system | |
| CN115480580A (zh) | 一种基于nmpc的水下机器人路径跟踪与避障的控制方法 | |
| Rodiana et al. | Software and hardware in the loop simulation of navigation system design based on state observer using Kalman filter for autonomous underwater glider | |
| CN112904719A (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 |