CN114564029A - 基于直接参数化法的全驱动船舶轨迹跟踪控制方法和装置 - Google Patents
基于直接参数化法的全驱动船舶轨迹跟踪控制方法和装置 Download PDFInfo
- Publication number
- CN114564029A CN114564029A CN202210279235.3A CN202210279235A CN114564029A CN 114564029 A CN114564029 A CN 114564029A CN 202210279235 A CN202210279235 A CN 202210279235A CN 114564029 A CN114564029 A CN 114564029A
- Authority
- CN
- China
- Prior art keywords
- ship
- matrix
- full
- model
- error
- 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 64
- 239000002131 composite material Substances 0.000 claims abstract description 43
- 238000013178 mathematical model Methods 0.000 claims abstract description 31
- 101150080778 INPP5D gene Proteins 0.000 claims description 163
- 239000011159 matrix material Substances 0.000 claims description 146
- 238000013016 damping Methods 0.000 claims description 29
- 238000006243 chemical reaction Methods 0.000 claims description 15
- 239000000126 substance Substances 0.000 claims description 12
- 238000013461 design Methods 0.000 claims description 10
- 230000009471 action Effects 0.000 claims description 6
- 230000008569 process Effects 0.000 claims description 6
- 150000001875 compounds Chemical class 0.000 claims description 5
- 238000006073 displacement reaction Methods 0.000 description 9
- 230000001133 acceleration Effects 0.000 description 8
- 238000010586 diagram Methods 0.000 description 8
- 230000008859 change Effects 0.000 description 6
- 238000005457 optimization Methods 0.000 description 6
- 238000013528 artificial neural network Methods 0.000 description 4
- 230000007613 environmental effect Effects 0.000 description 4
- 230000006641 stabilisation Effects 0.000 description 3
- 238000011105 stabilization Methods 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 239000001257 hydrogen Substances 0.000 description 2
- 230000010355 oscillation Effects 0.000 description 2
- 238000006467 substitution reaction Methods 0.000 description 2
- 230000001052 transient effect Effects 0.000 description 2
- 238000004804 winding Methods 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000013329 compounding Methods 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000012938 design process Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000009916 joint effect Effects 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000002441 reversible effect Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 230000009466 transformation 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
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
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)
- Feedback Control In General (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开一种基于直接参数化法的全驱动船舶轨迹跟踪控制方法和装置,包括:根据船舶的运动学模型和动力学模型,得到全驱动船舶的二阶数学模型;根据全驱动船舶的非线性误差模型,得到动态增益观测器对复合扰动进行估计;根据全驱动船舶的二阶数学模型和动态增益观测器估计复合扰动设计轨迹跟踪控制器,所述控制器由基于动态增益观测器的补偿控制器和误差反馈控制器两部分构成,其中,误差反馈控制器是由直接参数化方法所设计。采用本发明的技术方案,解决了全驱动船舶在轨迹跟踪中所遇到的外部未知扰动和系统性能问题。
Description
技术领域
本发明属于全驱动船舶的控制技术领域,具体涉及一种基于直接参数化法的全驱动船舶轨迹跟踪控制方法和装置。
背景技术
近年来,船舶的轨迹跟踪控制是自动控制领域中涌现的一个热门课题,最早研究的船舶主要是欠驱动船舶,仅涉及到纵向推力和艏摇船舵。随着船舶技术的不断发展,在前者的基础上,已出现拥有横向推力的全驱动船舶。
目前,以全驱动船舶为代表的全驱系统正在快速发展,大量的全驱系统被研制出来并投入实际使用,但是全驱动船舶的轨迹跟踪控制研究尚不成熟。
船舶在实际运动中有如下问题:
(1)外部未知扰动问题,船舶在复杂的海面航行时,风浪流等不确定因素致使船舶难以按照期望轨迹运动。
(2)轨迹跟踪系统的性能问题,船舶在实际航行过程中,由于系统本身的结构和参数,使其很难达到预期的性能指标。
综上所述,如何解决全驱动船舶的轨迹跟踪问题成为急需解决的难点。
发明内容
本发明的目的是提出一种基于直接参数化法的全驱动船舶轨迹跟踪控制方法和装置,解决了全驱动船舶在轨迹跟踪中所遇到的外部未知扰动和系统性能问题。
本发明为了解决上述问题采用以下技术方案:
一种基于直接参数化法的全驱动船舶轨迹跟踪控制方法,设计基于动态增益观测器的补偿控制器对扰动进行补偿,解决外部未知扰动问题;设计误差反馈控制器对系统的性能进行优化,解决轨迹跟踪系统的性能问题。具体包括以下步骤:
一种基于直接参数化法的全驱动船舶轨迹跟踪控制方法,包括以下步骤:
步骤S1、根据北东坐标系和船体固定坐标系建立船舶的运动学模型和动力学模型,根据所述船舶的运动学模型和动力学模型得到全驱动船舶的二阶数学模型;其中,北东坐标系用于描述全驱动船舶的位置和姿态角,船体固定坐标系用于描述全驱动船舶运动时的线速度和角速度;
步骤S2、根据全驱动船舶的非线性误差模型,得到动态增益观测器对复合扰动进行估计;
步骤S3、根据全驱动船舶的二阶数学模型和动态增益观测器估计复合扰动设计轨迹跟踪控制器,所述控制器由基于动态增益观测器的补偿控制器和误差反馈控制器两部分构成,其中,误差反馈控制器是由直接参数化方法所设计。
作为优选,步骤S1中,对全驱动船舶进行建模,得到运动学模型和动力学模型为:
其中,η=[x,y,ψ]为全驱动船舶在北东参考坐标系下的实际位置误差(x,y) 和艏摇角误差ψ组成的向量;R(ψ)表示从船体固定坐标系到北东坐标系的转换矩阵,并且满足RT(ψ)=R-1(ψ);α=[u,v,r]为全驱动船舶在船体坐标系下纵荡速度误差u、横荡速度误差v和艏摇角速度误差r组成的向量;M=M1+M2是由由刚体惯性矩阵M1和水动力附加质量矩阵M2所组成的惯性矩阵;C(α)为科里奥利向心力矩阵;D(α)=D0(α)+ΔD(α)由线性水动力系数矩阵D0(α)和非线性水动力系数矩阵ΔD(α)所组成的水动力系数矩阵;τ=[τu,τv,τr]为控制输入纵向推力τu、横向推力τv和艏摇力矩τr组成的向量;τw=[τwu,τwv,τwr]为船体固定坐标系下外界环境因素产生的干扰;
转换矩阵R(ψ)、刚体惯性矩阵M1、水动力附加质量矩阵M2分别表示为:
其中,m表示船舶的质量;Iz表示船舶绕Zb轴转动的转动惯量;表示纵荡加速度产生的纵荡附加质量系数;表示横荡加速度产生的横荡附加质量系数;表示艏摇角加速度产生的横荡附加质量系数;的表示艏摇角加速度产生的艏摇附加转动惯量系数;
科里奥利向心力矩阵C(α)、线性水动力系数矩阵D0(α)和非线性水动力系数矩阵ΔD(α)分别表示为:
其中,Xu表示纵荡速度产生的纵荡线性阻尼系数;Yv表示横荡速度产生的横荡线性阻尼系数;Nr表示艏摇角速度产生的艏摇线性阻尼系数;X|u|u表示纵荡速度产生的高阶纵荡非线性阻尼系数;Y|v|v表示横荡速度产生的高阶横荡非线性阻尼系数;Y|r|r表示艏摇角速度产生的高阶横荡非线性阻尼系数;Y|r|v表示横荡速度和艏摇角速度产生的高阶横荡非线性阻尼系数;Y|v|r表示艏摇角速度和横荡速度产生的高阶横荡非线性阻尼系数;N|r|r表示艏摇角速度产生的高阶艏摇非线性阻尼系数;N|v|r表示横荡速度和艏摇角速度产生的高阶艏摇非线性阻尼系数; N|r|v表示艏摇角速度和横荡速度产生的高阶艏摇非线性阻尼系数;
将运动学模型和动力学模型转化成全驱动船舶的二阶数学模型,具体表达式如下:
其中,m11、m22和m33分别表示为:
全驱动船舶的二阶数学模型转化成二阶系统形式,具体表达式如下:
作为优选,步骤S2中,针对系统内部不确定性和外部风浪流扰动对控制精度产生的影响,建立非线性误差模型,设计动态增益观测器对复合扰动进行估计;
建立全驱动船舶的非线性误差模型,使得误差模型收敛至平衡点,即
W1(t)=W2(t)=0;
首先,定义中间变量c如下:
建立关于W2(t)的动态方程如下:
作为优选,步骤S3中,
全驱动船舶的轨迹跟踪控制器u表达式如下:
u=uc+uf (9)
其中,uc是补偿控制器,uf是误差反馈控制器;
设计基于动态增益观测器的补偿控制器,用来抵消船舶所遭受的复合扰动;外部环境扰动τw由一阶马尔可夫随机过程给出,具体表达式如下:
其中,b∈R3为北东坐标系下船舶遭受的外部环境扰动,Tc为时间常数对角阵, n∈R3为零均值高斯白噪声向量,ρ为n的幅值矩阵;
复合扰动ξ与外部环境扰动τw关系式由公式(4)给出;
通过动态增益观测器估计复合扰动,即非线性项ξ,补偿控制器uc具体表达式如下:
利用直接参数化方法设计误差反馈控制器,提升系统的性能指标;
为了使补偿后的系统镇定,将求解误差反馈控制器问题转化为求解塞尔维斯特方程问题;通过选取矩阵F,F∈R2n×2n是自由的待定参数,提升系统的稳态性能,即将稳态误差控制在合理的范围之内;在此基础上优化矩阵Z,Z∈Rn×2n是自由参数,达到系统预期的暂态性能,即将上升时间、调节时间和超调量约束在合理的范围之内,再利用已优化好的参数去求解塞尔维斯特方程,进而得到误差反馈控制器的增益;
加入误差反馈控制器可将原系统变为一个闭环系统,由于系数矩阵相似于自由参数矩阵F,为了直接得出系统的特征根,将矩阵F令其为一个对角矩阵,且自由参数矩阵F和Z有很大的自由度,选取的优化指标H具体表达式如下:
在优化过程中使用二范数计算优化指标H;
设计误差反馈控制器uf,具体表达式如下:
本发明还提供一种基于直接参数化法的全驱动船舶轨迹跟踪控制装置,其特征在于,包括以下步骤:
建模模块,用于船舶的运动学模型和动力学模型,得到全驱动船舶的二阶数学模型;
估计模块,用于根据全驱动船舶的非线性误差模型,得到动态增益观测器对复合扰动进行估计;
跟踪控制模块,用于根据全驱动船舶的二阶数学模型和动态增益观测器估计复合扰动设计轨迹跟踪控制器,其中,所述控制器由基于动态增益观测器的补偿控制器和误差反馈控制器两部分构成,其中,误差反馈控制器是由直接参数化方法所设计。
作为优选,建模模块根据北东坐标系和船体固定坐标系建立船舶的运动学模型和动力学模型,其中,北东坐标系用于描述全驱动船舶的位置和姿态角,船体固定坐标系用于描述全驱动船舶运动时的线速度和角速度。
作为优选,船舶的运动学模型和动力学模型为:
其中,η=[x,y,ψ]为全驱动船舶在北东参考坐标系下的实际位置误差(x,y) 和艏摇角误差ψ组成的向量;R(ψ)表示从船体固定坐标系到北东坐标系的转换矩阵,并且满足RT(ψ)=R-1(ψ);α=[u,v,r]为全驱动船舶在船体坐标系下纵荡速度误差u、横荡速度误差v和艏摇角速度误差r组成的向量;M=M1+M2是由由刚体惯性矩阵M1和水动力附加质量矩阵M2所组成的惯性矩阵;C(α)为科里奥利向心力矩阵;D(α)=D0(α)+ΔD(α)由线性水动力系数矩阵D0(α)和非线性水动力系数矩阵ΔD(α)所组成的水动力系数矩阵;τ=[τu,τv,τr]为控制输入纵向推力τu、横向推力τv和艏摇力矩τr组成的向量;τw=[τwu,τwv,τwr]为船体固定坐标系下外界环境因素产生的干扰。
作为优选,将运动学模型和动力学模型转化成全驱动船舶的二阶数学模型,具体表达式如下:
将全驱动船舶的二阶数学模型转化成二阶系统形式,具体表达式如下:
本发明具有如下有益效果:
针对全驱动船舶的轨迹跟踪问题,常用的控制方法有反步控制方法、基于神经网络的智能控制方法等,本发明是基于直接参数化方法的全驱动船舶轨迹跟踪控制方法;以上方法均可解决全驱动船舶轨迹跟踪问题,但后者相较于前者在设计过程中有明显的优势。
1.反步控制方法在解决轨迹跟踪问题上,需要对船舶模型的所有参数精确已知,对于精确获取模型中矩阵的可变系数几乎是不现实的,而且此方法只能克服较小的常值扰动,一旦对系统的扰动过大,则使得船舶无法跟踪期望轨迹。
相较于反步控制方法,本发明设计的轨迹跟踪控制器不仅对船舶模型中的未知参数要求不高,而且能克服较大的时变扰动,并可令复杂的非线性全驱动船舶系统转化成一个可以任意配置特征结构的线性定常系统。
2.基于神经网络的智能控制方法在解决轨迹跟踪问题上,针对实际应用中难以确定神经网络的最优结构参数,并且较多的隐含层节点数还会增加控制系统的计算负担,一旦超出其系统的计算范围,则使得船舶无法跟踪期望轨迹。
相较于基于神经网络的智能控制方法,本发明设计的轨迹跟踪控制器可根据实际需求对自由参数进行优化,得到最优的参数;系统参数具有很大的自由度,大幅度地减小了计算量,而且灵活的将轨迹跟踪问题转化为控制器镇定问题。
附图说明
图1为基于直接参数化法的全驱动船舶轨迹跟踪控制系统整体结构图;
图2为建立全驱动船舶数学模型所需要的参考坐标系,即北东坐标系;
图3为建立全驱动船舶数学模型所需要的惯性坐标系,即船体坐标系;
图4为全驱动船舶轨迹跟踪变化图;
图5为全驱动船舶位移轨迹跟踪控制器变化图;
图6为全驱动船舶艏轨迹迹跟踪控制器变化图;
图7为全驱动船舶纵荡、横荡位移误差变化图;
图8为全驱动船舶艏向角误差变化图;
图9为全驱动船舶纵荡位移跟踪观测变化图;
图10为全驱动船舶横荡位移跟踪观测变化图;
图11为全驱动船舶艏摇角跟踪观测变化图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。通常在此处附图中描述和示出的本发明实施例的组件可以以各种不同的配置来布置和设计。
实施例1:
如图1所示,本发明提供一种基于直接参数化法的全驱动船舶轨迹跟踪控制方法,包括如下步骤:
步骤S1、步骤S1、根据北东坐标系和船体固定坐标系建立船舶的运动学模型和动力学模型,根据所述船舶的运动学模型和动力学模型得到全驱动船舶的二阶数学模型;其中,北东坐标系用于描述全驱动船舶的位置和姿态角,船体固定坐标系用于描述全驱动船舶运动时的线速度和角速度;
步骤S2、针对系统内部不确定性和外部风浪流扰动对控制精度产生的影响,根据全驱动船舶的非线性误差模型,得到动态增益观测器对复合扰动进行估计;
步骤S3、根据全驱动船舶的二阶数学模型和动态增益观测器估计复合扰动设计轨迹跟踪控制器,所述控制器由基于动态增益观测器的补偿控制器和误差反馈控制器两部分构成,其中,误差反馈控制器是由直接参数化方法所设计。
进一步地,步骤S1中,所述的北东坐标系、船体固定坐标系和全驱动船舶的运动学模型和动力学模型表示如下:
为了描述全驱动船舶的位置和姿态角,在北东坐标系中,如图2所示,N轴指向地球正北,E轴指向地球正东,D轴垂直于NE平面,坐标原点位于船舶质心;并给出北东坐标系和地心坐标系之间的关系,Xe轴位于赤道面并指向经线方向,Ze轴与地球旋转轴重合,Ye轴与Xe轴,Ze轴满足右手关系,坐标原点Oe位于地球质心。
一般情况下,针对全驱动船舶的运动可看成是在地球表面一个刚体的质点在做局部区域性运动,可认为其位置的经纬度是保持不变的。因此在北东坐标系中牛顿定律仍然适用,并将北东坐标系看作为惯性坐标系。
为了描述全驱动船舶的线速度和角速度,在船体固定坐标系中,如图3所示, Xb轴指向船艏方向,Yb轴指向船舶右舷方且垂直于Xb轴,Zb轴指向船底,并且垂直于船舶的水平面。
为了更好的描述全驱动船舶的三自由度复合运动,如图3所示,给出了直线运动和旋转运动;包括沿Xb轴方向上做直线运动,即纵荡;沿Yb轴方向上做直线运动,即横荡;绕Zb轴做旋转运动,即艏摇。
对全驱动船舶进行建模,得到运动学模型和动力学模型的形式如下:
其中,η=[x,y,ψ]为全驱动船舶在北东参考坐标系下的实际位置误差(x,y) 和艏摇角误差ψ组成的向量;R(ψ)表示从船体固定坐标系到北东坐标系的转换矩阵,并且满足RT(ψ)=R-1(ψ);α=[u,v,r]为全驱动船舶在船体坐标系下纵荡速度误差u、横荡速度误差v和艏摇角速度误差r组成的向量;M=M1+M2是由由刚体惯性矩阵M1和水动力附加质量矩阵M2所组成的惯性矩阵;C(α)为科里奥利向心力矩阵;D(α)=D0(α)+ΔD(α)由线性水动力系数矩阵D0(α)和非线性水动力系数矩阵ΔD(α)所组成的水动力系数矩阵;τ=[τu,τv,τr]为控制输入纵向推力τu、横向推力τv和艏摇力矩τr组成的向量;τw=[τwu,τwv,τwr]为船体固定坐标系下外界环境因素产生的干扰;
转换矩阵R(ψ)、刚体惯性矩阵M1、水动力附加质量矩阵M2分别表示为:
其中,m表示船舶的质量;Iz表示船舶绕Zb轴转动的转动惯量;表示纵荡加速度产生的纵荡附加质量系数;表示横荡加速度产生的横荡附加质量系数;表示艏摇角加速度产生的横荡附加质量系数;的表示艏摇角加速度产生的艏摇附加转动惯量系数;
科里奥利向心力矩阵C(α)、线性水动力系数矩阵D0(α)和非线性水动力系数矩阵ΔD(α)分别表示为:
其中,Xu表示纵荡速度产生的纵荡线性阻尼系数;Yv表示横荡速度产生的横荡线性阻尼系数;Nr表示艏摇角速度产生的艏摇线性阻尼系数;X|u|u表示纵荡速度产生的高阶纵荡非线性阻尼系数;Y|v|v表示横荡速度产生的高阶横荡非线性阻尼系数;Y|r|r表示艏摇角速度产生的高阶横荡非线性阻尼系数;Y|r|v表示横荡速度和艏摇角速度产生的高阶横荡非线性阻尼系数;Y|v|r表示艏摇角速度和横荡速度产生的高阶横荡非线性阻尼系数;N|r|r表示艏摇角速度产生的高阶艏摇非线性阻尼系数;N|v|r表示横荡速度和艏摇角速度产生的高阶艏摇非线性阻尼系数; N|r|v表示艏摇角速度和横荡速度产生的高阶艏摇非线性阻尼系数;
对全驱动船舶的动力学模型做出如下三个假设:
假设一:船体质量均匀分布,且船体左右对称。
假设二:只考虑纵荡、横荡位移和艏摇姿态。
假设三:船舶所受到的外部环境扰动未知且有界。
根据公式(1)中全驱动船舶的动力学模型可得如下形式:
对公式(1)中全驱动船舶的运动学模型两边同时对时间进行求导可得如下形式:
将公式(18)和公式(19)合并可得公式(2)形式如下:
其中,m11、m22和m33分别表示为:
将公式(2)中的全驱动船舶的二阶数学模型转化成二阶系统形式,具体表达式如下:
对于公式(2)满足如下三个约束条件:
根据公式(1)可知系统惯性矩阵和转换矩阵是可逆的,则有:
至此,一种基于直接参数化法的全驱动船舶二阶数学模型的一般形式已经表示完毕,二阶数学模型的一般形式在实际应用中被广泛使用,由于大多数实际系统中都可用二阶系统来表示,因此在许多情况中,实际系统的二阶模型要比实际系统的一阶模型表达更为清晰,以便控制。
进一步地,步骤S2中,所述的复合扰动对控制精度产生的影响,建立非线性误差模型,设计动态增益观测器对复合扰动进行估计;
建立全驱动船舶的非线性误差模型,使得误差模型收敛至平衡点,即
W1(t)=W2(t)=0;
首先,定义中间变量c如下:
建立关于W2(t)的动态方程如下:
式(10)和(11)即为设计的动态增益观测器;
进一步地,步骤S3中,在此基础上设计轨迹跟踪控制器,该控制器由基于动态增益观测器的补偿控制器和误差反馈控制器两部分构成,其中误差反馈控制器是由直接参数化方法所设计;
全驱动船舶的轨迹跟踪控制器u表达式如下:
u=uc+uf (9)
其中,uc是补偿控制器,uf是误差反馈控制器;
外部环境扰动τw由一阶马尔可夫随机过程给出,具体表达式如下:
其中,b∈R3为北东坐标系下船舶遭受的外部环境扰动,Tc为时间常数对角阵, n∈R3为零均值高斯白噪声向量,ρ为n的幅值矩阵;
复合扰动ξ与外部环境扰动τw关系式由公式(4)给出;
通过动态增益观测器估计复合扰动,即非线性项ξ,补偿控制器uc具体表达式如下:
二阶全驱系统在加入补偿控制器uc的具体表达式形式如下:
所述的利用直接参数化方法对全驱动船舶设计轨迹跟踪控制器形式如下:
针对全驱动船舶的数学模型设计由补偿控制器和误差反馈控制器两部分构成的轨迹跟踪控制器,其中误差反馈控制器是由直接参数化方法所设计。
利用直接参数化方法设计误差反馈控制器,提升系统的性能指标;
为了使补偿后的系统镇定,将求解误差反馈控制器问题转化为求解塞尔维斯特方程问题;通过选取矩阵F,F∈R2n×2n是自由的待定参数,提升系统的稳态性能,即将稳态误差控制在合理的范围之内;在此基础上优化矩阵Z,Z∈Rn×2n是自由参数,达到系统预期的暂态性能,即将上升时间、调节时间和超调量约束在合理的范围之内,再利用已优化好的参数去求解塞尔维斯特方程,进而得到误差反馈控制器的增益;
加入误差反馈控制器可将原系统变为一个闭环系统,由于系数矩阵相似于自由参数矩阵F,为了直接得出系统的特征根,将矩阵F令其为一个对角矩阵,且自由参数矩阵F和Z有很大的自由度,选取的优化指标H具体表达式如下:
在优化过程中使用二范数计算优化指标H;
设计误差反馈控制器uf,具体表达式如下:
将公式(12)代入到公式(25)中,则系统可表示成如下形式:
其中有,
假设公式(4)中二阶全驱系统能控,误差反馈控制器uf使系统镇定为闭环系统,若存在如下形式:
令P=[P0,P1]T=[P0,P0F]T,然后将Ac代入到公式(23)中得到如下形式:
将公式(30)化简得到如下形式:
A2P0F2+A1P0F+A0P0=BK0P0+BK1P1=BQ (31)
则上述的误差反馈控制器uf要使得系统镇定,可转化为求解塞尔维斯特方程的问题形式如下:
将公式(31)中的塞尔维斯特方程关于P和Q的所有解都可被参数化形式如下:
其中矩阵Z∈Rn×2n是自由参数,矩阵F∈R2n×2n是自由的待定参数,且满足 det(P)≠0。
结合上述说明和公式(12),则可以得到:
全驱动船舶是一个二阶的全驱系统,采用直接参数化法设计误差反馈控制器,通过选取待定的自由参数矩阵F和优化自由参数矩阵Z可得到理想的控制器增益,最后将轨迹跟踪问题转化为控制器镇定问题,使得跟踪系统变的十分地简洁清晰。
进一步地,步骤五中,通过Matlab对轨迹跟踪控制器作用下的全驱动船舶轨迹跟踪控制系统进行仿真,得到图4,图5,图6,图7,图8所示的结果:
图4为全驱动船舶跟踪变化图,设置地图长度为700m,宽度为700m,全驱动船舶的出发点坐标为(-120,80),目标点的坐标为(640,640),被跟踪轨迹曲线为一条倾斜45°的直线,且朝着正北正东方向倾斜,当全驱动船舶运动到坐标点(280,280)左右时轨迹已完全跟踪上,跟踪精度精确到厘米级单位,全驱动船舶跟踪的轨迹合理且光滑,并由局部放大图所表示。
图5和图6为全驱动船舶轨迹跟踪控制器力与力矩变化图,从图中可知轨迹跟踪控制器对系统分别施加纵荡力、横荡力和艏摇力矩,并在18s左右的时间趋于稳定,当时间接近75s时控制器达到千分之一的精确程度,且控制器的精度随着时间的延长而提高,并由局部放大图所表示。
图7和图8为全驱动船舶纵荡、横荡位移误差和艏摇角的误差变化图,纵荡位移初始误差为80m,横荡位移初始误差为-120m,艏摇角初始误差为-55°,全驱动船舶轨迹跟踪系统的误差随着控制器的影响而逐渐衰减,在18s左右的时间趋于稳定,当时间接近40s时误差达到千分之一的精确程度,且误差的精度随着时间的延长而提高,最终恒定于零值,并由局部放大图所表示。
图9、图10和图11为全驱动船舶的动态增益观测器分别在纵荡、横荡位移和艏摇角的观测复合扰动变化图,由仿真图可知,文中所设计的动态增益观测器可准确估计真实的复合扰动。
实施例2:
本发明还提供一种基于直接参数化法的全驱动船舶轨迹跟踪控制装置,其特征在于,包括以下步骤:
建模模块,用于船舶的运动学模型和动力学模型,得到全驱动船舶的二阶数学模型;
估计模块,用于根据全驱动船舶的非线性误差模型,得到动态增益观测器对复合扰动进行估计;
跟踪控制模块,用于根据全驱动船舶的二阶数学模型和动态增益观测器估计复合扰动设计轨迹跟踪控制器,其中,所述控制器由基于动态增益观测器的补偿控制器和误差反馈控制器两部分构成,其中,误差反馈控制器是由直接参数化方法所设计。
作为本实施例的一种实施方式,建模模块根据北东坐标系和船体固定坐标系建立船舶的运动学模型和动力学模型,其中,北东坐标系用于描述全驱动船舶的位置和姿态角,船体固定坐标系用于描述全驱动船舶运动时的线速度和角速度。
作为本实施例的一种实施方式,船舶的运动学模型和动力学模型为:
其中,η=[x,y,ψ]为全驱动船舶在北东参考坐标系下的实际位置误差(x,y) 和艏摇角误差ψ组成的向量;R(ψ)表示从船体固定坐标系到北东坐标系的转换矩阵,并且满足RT(ψ)=R-1(ψ);α=[u,v,r]为全驱动船舶在船体坐标系下纵荡速度误差u、横荡速度误差v和艏摇角速度误差r组成的向量;M=M1+M2是由由刚体惯性矩阵M1和水动力附加质量矩阵M2所组成的惯性矩阵;C(α)为科里奥利向心力矩阵;D(α)=D0(α)+ΔD(α)由线性水动力系数矩阵D0(α)和非线性水动力系数矩阵ΔD(α)所组成的水动力系数矩阵;τ=[τu,τv,τr]为控制输入纵向推力τu、横向推力τv和艏摇力矩τr组成的向量;τw=[τwu,τwv,τwr]为船体固定坐标系下外界环境因素产生的干扰。
作为本实施例的一种实施方式,将运动学模型和动力学模型转化成全驱动船舶的二阶数学模型,具体表达式如下:
将全驱动船舶的二阶数学模型转化成二阶系统形式,具体表达式如下:
最后应说明的是:以上各实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述各实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。
Claims (9)
1.一种基于直接参数化法的全驱动船舶轨迹跟踪控制方法,其特征在于,包括以下步骤:
步骤S1、根据北东坐标系和船体固定坐标系建立船舶的运动学模型和动力学模型,根据所述船舶的运动学模型和动力学模型得到全驱动船舶的二阶数学模型;其中,北东坐标系用于描述全驱动船舶的位置和姿态角,船体固定坐标系用于描述全驱动船舶运动时的线速度和角速度;
步骤S2、根据所述全驱动船舶的非线性误差模型,得到动态增益观测器对复合扰动进行估计;
步骤S3、根据所述全驱动船舶的二阶数学模型和动态增益观测器估计复合扰动设计轨迹跟踪控制器,所述控制器由基于动态增益观测器的补偿控制器和误差反馈控制器两部分构成,其中,误差反馈控制器是由直接参数化方法所设计。
2.如权利要求1所述的基于直接参数化法的全驱动船舶轨迹跟踪控制方法,其特征在于,步骤S1中,对全驱动船舶进行建模,得到运动学模型和动力学模型的形式如下:
其中,η=[x,y,ψ]为全驱动船舶在北东参考坐标系下的实际位置误差(x,y)和艏摇角误差ψ组成的向量;R(ψ)表示从船体固定坐标系到北东坐标系的转换矩阵,并且满足RT(ψ)=R-1(ψ);α=[u,v,r]为全驱动船舶在船体坐标系下纵荡速度误差u、横荡速度误差v和艏摇角速度误差r组成的向量;M=M1+M2是由由刚体惯性矩阵M1和水动力附加质量矩阵M2所组成的惯性矩阵;C(α)为科里奥利向心力矩阵;D(α)=D0(α)+ΔD(α)由线性水动力系数矩阵D0(α)和非线性水动力系数矩阵ΔD(α)所组成的水动力系数矩阵;τ=[τu,τv,τr]为控制输入纵向推力τu、横向推力τv和艏摇力矩τr组成的向量;τw=[τwu,τwv,τwr]为船体固定坐标系下外界环境因素产生的干扰。
5.如权利要求4所述的基于直接参数化法的全驱动船舶轨迹跟踪控制方法,其特征在于,步骤S3中,全驱动船舶的轨迹跟踪控制器u表达式如下:
u=uc+uf (9)
其中,uc是补偿控制器,uf是误差反馈控制器;
设计基于动态增益观测器的补偿控制器,用来抵消船舶所遭受的复合扰动;
外部环境扰动τw由一阶马尔可夫随机过程得到,即:
其中,b∈R3为北东坐标系下船舶遭受的外部环境扰动,Tc为时间常数对角阵,n∈R3为零均值高斯白噪声向量,ρ为n的幅值矩阵;
通过动态增益观测器估计复合扰动,即非线性项ξ,补偿控制器uc具体表达式如下:
设计误差反馈控制器uf,即:
6.一种基于直接参数化法的全驱动船舶轨迹跟踪控制装置,其特征在于,包括以下步骤:
建模模块,用于船舶的运动学模型和动力学模型,得到全驱动船舶的二阶数学模型;
估计模块,用于根据全驱动船舶的非线性误差模型,得到动态增益观测器对复合扰动进行估计;
跟踪控制模块,用于根据全驱动船舶的二阶数学模型和动态增益观测器估计复合扰动设计轨迹跟踪控制器,其中,所述控制器由基于动态增益观测器的补偿控制器和误差反馈控制器两部分构成,其中,误差反馈控制器是由直接参数化方法所设计。
7.如权利要求6所述的基于直接参数化法的全驱动船舶轨迹跟踪控制装置,其特征在于,建模模块根据北东坐标系和船体固定坐标系建立船舶的运动学模型和动力学模型,其中,北东坐标系用于描述全驱动船舶的位置和姿态角,船体固定坐标系用于描述全驱动船舶运动时的线速度和角速度。
8.如权利要求7所述的基于直接参数化法的全驱动船舶轨迹跟踪控制装置,其特征在于,船舶的运动学模型和动力学模型为:
其中,η=[x,y,ψ]为全驱动船舶在北东参考坐标系下的实际位置误差(x,y)和艏摇角误差ψ组成的向量;R(ψ)表示从船体固定坐标系到北东坐标系的转换矩阵,并且满足RT(ψ)=R-1(ψ);α=[u,v,r]为全驱动船舶在船体坐标系下纵荡速度误差u、横荡速度误差v和艏摇角速度误差r组成的向量;M=M1+M2是由由刚体惯性矩阵M1和水动力附加质量矩阵M2所组成的惯性矩阵;C(α)为科里奥利向心力矩阵;D(α)=D0(α)+ΔD(α)由线性水动力系数矩阵D0(α)和非线性水动力系数矩阵ΔD(α)所组成的水动力系数矩阵;τ=[τu,τv,τr]为控制输入纵向推力τu、横向推力τv和艏摇力矩τr组成的向量;τw=[τwu,τwv,τwr]为船体固定坐标系下外界环境因素产生的干扰。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210279235.3A CN114564029B (zh) | 2022-03-21 | 2022-03-21 | 基于直接参数化法的全驱动船舶轨迹跟踪控制方法和装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210279235.3A CN114564029B (zh) | 2022-03-21 | 2022-03-21 | 基于直接参数化法的全驱动船舶轨迹跟踪控制方法和装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114564029A true CN114564029A (zh) | 2022-05-31 |
CN114564029B CN114564029B (zh) | 2022-10-11 |
Family
ID=81720415
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210279235.3A Active CN114564029B (zh) | 2022-03-21 | 2022-03-21 | 基于直接参数化法的全驱动船舶轨迹跟踪控制方法和装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114564029B (zh) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20130173096A1 (en) * | 2010-09-11 | 2013-07-04 | Wayne State University | Guidance and control system for under-actuated marine surface ships and other autonomous platforms |
CN107015562A (zh) * | 2017-04-26 | 2017-08-04 | 华南理工大学 | 一种满足预设跟踪性能的欠驱动水面船舶控制方法 |
CN109116856A (zh) * | 2018-09-28 | 2019-01-01 | 上海海事大学 | 一种基于扰动观测器的欠驱动船舶路径跟踪控制方法 |
CN109839934A (zh) * | 2019-02-26 | 2019-06-04 | 华南理工大学 | 基于rise技术的无人水面艇预设性能跟踪控制方法 |
CN110134012A (zh) * | 2019-04-30 | 2019-08-16 | 上海海事大学 | 一种用于不确定系统的船舶路径跟踪控制方法 |
CN111045432A (zh) * | 2019-12-31 | 2020-04-21 | 哈尔滨工程大学 | 一种欠驱动水面船非线性路径跟踪控制系统及方法 |
CN111650837A (zh) * | 2020-06-19 | 2020-09-11 | 哈尔滨理工大学 | 一种推进器故障时水面船轨迹跟踪的二阶预设性能容错控制方法 |
-
2022
- 2022-03-21 CN CN202210279235.3A patent/CN114564029B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20130173096A1 (en) * | 2010-09-11 | 2013-07-04 | Wayne State University | Guidance and control system for under-actuated marine surface ships and other autonomous platforms |
CN107015562A (zh) * | 2017-04-26 | 2017-08-04 | 华南理工大学 | 一种满足预设跟踪性能的欠驱动水面船舶控制方法 |
CN109116856A (zh) * | 2018-09-28 | 2019-01-01 | 上海海事大学 | 一种基于扰动观测器的欠驱动船舶路径跟踪控制方法 |
CN109839934A (zh) * | 2019-02-26 | 2019-06-04 | 华南理工大学 | 基于rise技术的无人水面艇预设性能跟踪控制方法 |
CN110134012A (zh) * | 2019-04-30 | 2019-08-16 | 上海海事大学 | 一种用于不确定系统的船舶路径跟踪控制方法 |
CN111045432A (zh) * | 2019-12-31 | 2020-04-21 | 哈尔滨工程大学 | 一种欠驱动水面船非线性路径跟踪控制系统及方法 |
CN111650837A (zh) * | 2020-06-19 | 2020-09-11 | 哈尔滨理工大学 | 一种推进器故障时水面船轨迹跟踪的二阶预设性能容错控制方法 |
Non-Patent Citations (1)
Title |
---|
裴志远等: "无人船运动控制方法综述", 《海洋科学》 * |
Also Published As
Publication number | Publication date |
---|---|
CN114564029B (zh) | 2022-10-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109283941B (zh) | 基于扰动观测器的预设性能海底飞行节点轨迹跟踪控制方法 | |
CN111580523B (zh) | 一种基于侧滑角补偿的无人艇路径跟踪自抗扰控制方法 | |
CN107168312B (zh) | 一种补偿uuv运动学和动力学干扰的空间轨迹跟踪控制方法 | |
CN108319140B (zh) | 一种重定义输出式无模型自适应航向控制方法及系统 | |
Zhang et al. | NNFFC-adaptive output feedback trajectory tracking control for a surface ship at high speed | |
CN110687799B (zh) | 一种智能船舶自动舵系统的模糊自适应输出反馈控制方法及系统 | |
CN109407671B (zh) | 一种欠驱动无人船目标包围控制器结构及设计方法 | |
Fortuna et al. | A roll stabilization system for a monohull ship: modeling, identification, and adaptive control | |
CN111308890B (zh) | 一种带有指定性能的无人船数据驱动强化学习控制方法 | |
CN109739248B (zh) | 基于adrc的船载三自由度并联稳定平台稳定控制方法 | |
CN111948937B (zh) | 多智能体系统的多梯度递归强化学习模糊控制方法及系统 | |
CN113341953B (zh) | 一种吊舱式无人艇航向控制方法 | |
CN111857165B (zh) | 一种水下航行器的轨迹跟踪控制方法 | |
CN113110511B (zh) | 一种基于广义模糊双曲模型的智能船舶航向控制方法 | |
Leifeng et al. | Adaptive heading control of unmanned wave glider with heading information fusion | |
CN113848887A (zh) | 一种基于mlp方法的欠驱动无人艇轨迹跟踪控制方法 | |
CN114442640A (zh) | 一种水面无人艇轨迹跟踪控制方法 | |
CN114397821A (zh) | 一种基于预设性能的多水面船分布式编队的鲁棒控制方法 | |
CN115390564A (zh) | 用于欠驱动水面无人船舶的编队控制方法、介质及设备 | |
Ansari et al. | Generalized dynamic inversion based attitude control of autonomous underwater vehicles | |
CN114967714A (zh) | 一种自主式水下机器人抗扰运动控制方法及系统 | |
CN113467231A (zh) | 基于侧滑补偿ilos制导律的无人艇路径跟踪方法 | |
CN116088309B (zh) | 一种基于故障辨识的水面船复合学习容错控制方法 | |
CN114564029B (zh) | 基于直接参数化法的全驱动船舶轨迹跟踪控制方法和装置 | |
CN113485390B (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 |