一种基于镇定控制的欠驱动水面艇自动靠泊方法技术

本发明专利技术一种基于镇定控制的欠驱动水面艇自动靠泊方法，包括如下步骤：S1，构建水面艇三自由度运动数学模型；S2，将所建立的数学模型展开并进行微分同胚变换；S3，采用状态反馈线性化对数学模型进行反馈变换；S4，根据变换后的系统进行控制器的设计。本发明专利技术将欠驱动船舶的动态系统转换成一种拓展的链式结构，最终实现了欠驱动水面艇的全局渐进点镇定控制，从而实现其自动靠泊的功能；本发明专利技术能对欠驱动水面艇实现较为精确、稳定的控制，能够满足欠驱动水面艇控制系统的全局渐进稳定性，并使水面艇的位置、速度和艏向角等物理量指数收敛。

【技术实现步骤摘要】
一种基于镇定控制的欠驱动水面艇自动靠泊方法
本专利技术涉及一种欠驱动水面艇自动靠泊方法，具体涉及一种基于镇定控制的欠驱动水面艇自动靠泊方法，属于水面艇操纵

技术介绍
近年来，智能船舶作为控制领域的一个研究热点引起了学者的广泛关注，目前针对智能车辆的自动泊车技术已经取得较快的发展，而关于水面艇自动靠泊的研究相对较少。现今水面艇的离靠泊多由人工操控完成，依靠船员对水面艇位置、航向航速和航向角等信息做出判断，容易出现人为控制决策的失误或控制精度不足等问题，从而造成不必要的损失。因此，研究水面艇的自动靠泊方法具有十分重要的现实意义和实际价值。现阶段，用于海上航行的水面艇多为欠驱动水面艇，欠驱动水面艇是指控制系统的输入维数小于自由度数的水面艇，目前常见的水面艇主要采用螺旋桨和船舵作为控制装置。对于水平面的航向控制，此类型的水面艇是全驱动模型，而对于水平面内的位置和姿态控制则为欠驱动模型。由于这类水面艇在横向上没有推进装置，只能依靠纵向的推进器和船舵进行驱动，无法像全驱动水面艇能够实现可靠的侧移控制，具有较高的控制难度。目前关于欠驱动水面艇自动靠泊的研究较少，由于控制模型和控制任务的复杂性，实现稳定、可靠的自动靠泊是十分困难的。总之，自动靠泊领域的研究不仅对于非线性系统控制方法具有挑战性，也对于实际应用具有很高的价值。由于水面艇在海洋中的模型较为复杂，目前自动靠泊领域主要通过神经网络的方式建立水面艇运动的数学模型，然而该方法的可行性较低。一方面，在进行神经网络建模前需要大量的训练数据，高成本的海上实验难以满足其对于数据的需要；另一方面，对于已经建立的数学模型，神经网络方法并不具有解释其推理过程和推理依据的能力，这无论对于理论要求还是实际工程都是不可接受的。在船舶海洋实际工程中，欠驱动水面艇的自动靠泊问题可归结为镇定控制律的设计问题。在欠驱动水面艇的镇定控制中，需要使水面艇在水平面内到达并保持在预先设定的位置和艏向角上，因此在镇定过程中不仅要实现位置和艏向角的镇定，还要保证其他物理量例如横向速度、纵向速度以及艏向角速度的镇定。基于以上背景，本专利技术基于镇定控制理论提出一种可靠的自动靠泊方法。通过对现有方法的探索，并未发现类似专利。因此针对欠驱动水面艇，提出一种基于镇定控制的欠驱动水面艇自动靠泊方法是有一定前景的。
技术实现思路
本专利技术的目的是为了实现欠驱动水面艇的全局渐进点镇定控制，从而实现其自动靠泊的功能而提供了一种基于镇定控制的欠驱动水面艇自动靠泊方法。本专利技术的目的是这样实现的：一种基于镇定控制的欠驱动水面艇自动靠泊方法，包括如下步骤：S1，构建水面艇三自由度运动数学模型；S2，将所建立的数学模型展开并进行微分同胚变换；S3，采用状态反馈线性化对数学模型进行反馈变换；S4，根据变换后的系统进行控制器的设计本专利技术还包括这样一些结构特征：所述水面艇三自由度运动数学模型的展开式为：其中，m11、m22和m33为水面艇的附加质量系数；d11、d22和d33为水面艇的阻尼系数；u、v和r分别为水面艇的纵向速度、横向速度和转向角速度；τ1和τ3分别为水面艇的推进力矩和转向力矩；x、y和ψ为水面艇的纵向位置、横向位置和艏向角；所述微分同胚变换后的数学模型为：其中z＝[z1z2z3]T为微分同胚变换后的位置坐标；状态反馈线性化后的动态系统为：其中A＝m11/m22,B＝d22/m22，所设计的控制律为：与现有技术相比，本专利技术的有益效果是：本专利技术将欠驱动船舶的动态系统转换成一种拓展的链式结构，最终实现了欠驱动水面艇的全局渐进点镇定控制，从而实现其自动靠泊的功能；本专利技术能对欠驱动水面艇实现较为精确、稳定的控制，能够满足欠驱动水面艇控制系统的全局渐进稳定性，并使水面艇的位置、速度和艏向角等物理量指数收敛。附图说明图1是本专利技术中水面艇自动靠泊过程示意图；图2是本专利技术中微分同胚变换物理意义图；图3是本专利技术一实施例水面艇水平面内位置仿真效果图；图4是本专利技术一实施例水面艇艏向角仿真效果图；图5是本专利技术一实施例水面艇艏向角速度仿真效果图；图6是本专利技术一实施例水面艇的纵向速度和横向速度仿真效果图；图7是本专利技术一实施例船舶纵向推力仿真效果图；图8是本专利技术一实施例船舶转向力矩仿真效果图；图9是本专利技术一实施例船舶姿态和轨迹仿真效果图。具体实施方式下面举例对本专利技术做更详细的描述。一种针对欠驱动水面艇的自动靠泊方法。所述自动靠泊方法是一种针对欠驱动水面艇的基于时不变状态反馈的全局渐进点镇定控制策略，本专利技术的技术方案采取以下几个步骤：S1，建立水面艇的三自由度数学模型；S2，利用反步法将复杂的高阶系统拆解为多个简单的低阶子系统；S3，对控制系统进行状态反馈线性化；S4，进行控制器设计和稳定性分析；S5，将已知欠驱动水面艇的参数代入并进行MATLAB仿真。所述建立水面艇的三自由度数学模型是指忽略水面艇的横摇、纵摇和垂荡运动，仅限于横荡、纵荡和艏摇所建立的数学模型。所述高阶系统是指以高阶微分方程作为运动方程的三阶或三阶以上的控制系统，几乎所有控制系统都是高阶系统。所述低阶系统是指以低阶微分方程作为运动方程的一阶或二阶控制系统。所述对控制系统进行状态反馈线性化是指将复杂的非线性状态反馈通过状态变换的方式线性化。在描述船舶在海洋中的运动时，通常采用两种正交坐标系表示，一种是固定坐标系，另一种是随动坐标系。水面船舶在海洋中具有6个自由度的运动，运动形式较为复杂。对水面船舶采用如下假设条件：忽略水面船舶的纵摇、横摇以及垂荡运动。此时z＝0，ω＝0，φ＝0，p＝0，θ＝0，q＝0；假设船舶重心与随动坐标系原点重合且船体质量分布均匀；船舶关于纵垂面x-o-z和侧垂面y-o-z对称，此时转动惯量Ixy＝Iyz＝0。此时，欠驱动水面船舶的三自由度运动模型可以表示为如下形式：式中，η＝[xyψ]T,v＝[uvr]T,τ＝[τ10τ3]T，其中C13＝-m22v，C23＝m11u。[xyψ]T中物理量分别表示船舶的纵向位置、横向位置以及艏向角。[uvr]T中物理量分别表示船舶的纵向速度、横向速度以及艏向角速度。τ＝[τ10τ3]T代表控制系统的输入。M表示惯性参数矩阵。C(v)表示科里奥利和向心力矩阵。D(v)表示阻尼参数矩阵。将式(1)和式(2)的矩阵方程组展开，可得到如下以展开形式表示的欠驱动水面艇水平面运动方程：引入一种全局微分同胚变换：z＝JT(ψ)η(4)其中，z＝[z1z2z3]T，η＝[xyψ]T。经过微分同胚变换，将固定坐标系下欠驱动水面艇的位置坐标转换到随动坐标系下，本文档来自技高网...

【技术保护点】
1.一种基于镇定控制的欠驱动水面艇自动靠泊方法，其特征是，包括如下步骤：/nS1，构建水面艇三自由度运动数学模型；/nS2，将所建立的数学模型展开并进行微分同胚变换；/nS3，采用状态反馈线性化对数学模型进行反馈变换；/nS4，根据变换后的系统进行控制器的设计。/n

【技术特征摘要】
1.一种基于镇定控制的欠驱动水面艇自动靠泊方法，其特征是，包括如下步骤：
S1，构建水面艇三自由度运动数学模型；
S2，将所建立的数学模型展开并进行微分同胚变换；
S3，采用状态反馈线性化对数学模型进行反馈变换；
S4，根据变换后的系统进行控制器的设计。


2.根据权利要求1所述的基于镇定控制的欠驱动水面艇自动靠泊方法，其特征是，所述水面艇三自由度运动数学模型的展开式为：



其中，m11、m22和m33为水面艇的附加质量系数；d11、d22和d33为水面艇的阻尼系数；u、v和r分别为水面艇的纵向速度、横向速度和转向角速度；τ1和τ3分别...

【专利技术属性】
技术研发人员：刘志林，苑守正，郑林熇，孙雨鑫，马英凯，朱齐丹，苏丽，
申请(专利权)人：哈尔滨工程大学，
类型：发明
国别省市：黑龙江;23