Processing math: 1%

基于L1自适应理论的AUV深度控制器设计

霍江航, 姜向远, 栾义忠, 马晓静

霍江航, 姜向远, 栾义忠, 等. 基于L1自适应理论的AUV深度控制器设计[J]. 中国舰船研究, 2021, 16(5): 150–157. DOI: 10.19693/j.issn.1673-3185.02114
引用本文: 霍江航, 姜向远, 栾义忠, 等. 基于L1自适应理论的AUV深度控制器设计[J]. 中国舰船研究, 2021, 16(5): 150–157. DOI: 10.19693/j.issn.1673-3185.02114
HUO J H, JIANG X Y, LUAN Y Z, et al. Design of AUV depth controller based on L1 adaptive theory[J]. Chinese Journal of Ship Research, 2021, 16(5): 150–157. DOI: 10.19693/j.issn.1673-3185.02114
Citation: HUO J H, JIANG X Y, LUAN Y Z, et al. Design of AUV depth controller based on L1 adaptive theory[J]. Chinese Journal of Ship Research, 2021, 16(5): 150–157. DOI: 10.19693/j.issn.1673-3185.02114
霍江航, 姜向远, 栾义忠, 等. 基于L1自适应理论的AUV深度控制器设计[J]. 中国舰船研究, 2021, 16(5): 150–157. CSTR: 32390.14.j.issn.1673-3185.02114
引用本文: 霍江航, 姜向远, 栾义忠, 等. 基于L1自适应理论的AUV深度控制器设计[J]. 中国舰船研究, 2021, 16(5): 150–157. CSTR: 32390.14.j.issn.1673-3185.02114
HUO J H, JIANG X Y, LUAN Y Z, et al. Design of AUV depth controller based on L1 adaptive theory[J]. Chinese Journal of Ship Research, 2021, 16(5): 150–157. CSTR: 32390.14.j.issn.1673-3185.02114
Citation: HUO J H, JIANG X Y, LUAN Y Z, et al. Design of AUV depth controller based on L1 adaptive theory[J]. Chinese Journal of Ship Research, 2021, 16(5): 150–157. CSTR: 32390.14.j.issn.1673-3185.02114

基于L1自适应理论的AUV深度控制器设计

基金项目: 国家自然科学基金委-英国皇家学会联合资助项目(61711530133);国家自然科学基金资助项目(61503413);中央高校基本科研业务费山东大学人才专项资助项目(2019GN052);山东大学青年创新群体专项资助项目(2020QNQT016)
详细信息
    作者简介:

    霍江航,男,1996年生,硕士生。研究方向:机器人控制算法。E-mail:l15638538993@163.com

    姜向远,男,1983年生,博士,副教授,硕士生导师。研究方向:寻源自适应控制,无人艇、水下潜航器、无人机及机械臂等智能系统的控制与优化。E-mail:JH1457244563@163.com

    栾义忠,男,1974年生,硕士,副研究员。研究方向:计算机控制及智能系统,检测与信息处理,智能制造,智慧系统等相关领域应用技术。E-mail:3742460@qq.com

    马晓静,女,1992年生,博士生。研究方向:海洋环境空基自动探测系统。E-mail:mx_jing@163.com

    通讯作者:

    姜向远

  • 中图分类号: U664.82

Design of AUV depth controller based on L1 adaptive theory

知识共享许可协议
基于L1自适应理论的AUV深度控制器设计霍江航,采用知识共享署名4.0国际许可协议进行许可。
  • 摘要:
    目的 

    为抑制自主式水下航行器(autonomous underwater vehicle, AUV)运动过程中水动力参数变化和复杂外界环境干扰的影响,针对AUV深度控制通道设计一种自适应控制器。

    方法 

    首先建立AUV系统动力学模型,然后以REMUS AUV系统的纵向控制模型为被控对象设计L1自适应控制器,最后在考虑不同干扰条件下使用Matlab/Simulink对L1自适应控制器进行仿真试验,并与相同环境下PID控制器的效果进行对比。

    结果 

    在受到强外界干扰的条件下,对比PID控制器,L1自适应控制器的控制效果更稳定。且当AUV运动模型中水动力参数发生改变时,L1自适应控制器可以保持稳定。

    结论 

    仿真结果表明,基于L1自适应理论设计的控制器在拥有良好动态响应的同时能够保证抗干扰能力与鲁棒性。

    Abstract:
    Objectives 

    An adaptive controller is designed for the longitudinal control channel of autonomous underwater vehicles (AUV) in order to suppress the influence of hydrodynamic parameters and complex external environment disturbance during AUV motion.

    Methods 

    First, a dynamic model of the AUV system is established and the L1 adaptive controller is then designed on the basis of the longitudinal control model of the REMUS AUV system. Finally, Matlab/Simulink is used to simulate the L1 adaptive controller under different disturbance conditions, and the effects are compared with a PID controller in the same environment.

    Results 

    Under the condition of strong external interference, the control effects of the L1 adaptive controller are more stable than those of the PID controller. When the hydrodynamic parameters of the AUV motion model change, the L1 adaptive controller can still maintain stability.

    Conclusion 

    The simulation results show that the controller designed on the basis of L1 adaptive theory has good dynamic response and can guarantee anti-interference ability and robustness.

  • 自主式水下航行器(AUV)是一种自带动力源,能够在水下自主航行作业的无人潜航器。因其安全性高、可靠性强,且不受有线电缆的限制,目前已经广泛应用于海洋开发、海底检测等领域。在AUV各种应用场景中,例如,水下地形勘测或者海底铺设管道检查等,都需要稳定的深度控制,因此定深航行成为一种常用的航行状态。但AUV在水下作业中会因为移动速度或者水域环境差异的影响而使机体模型参数发生改变,这将导致运动模型产生不确定性,而且水下还存在复杂持续的外部环境干扰,这些问题一方面对AUV的定深稳定作业产生了不良影响,另一方面也对AUV深度控制器设计的抗干扰性和鲁棒性提出了更高的要求。

    为了保证AUV水下运动的稳定性和控制精度,多种控制算法被应用于AUV系统,例如传统PID控制方法及其改进算法[1-3]、神经网络法[4]、基于线性二次调节器(linear quadratic regulator, LQR)的控制方法[5]、滑模控制方法[6]、自适应控制方法[7]等。传统PID控制方法有着良好的鲁棒性和瞬态响应,但是对外界环境的干扰无法做出快速有力的应对。运用LQR的AUV控制方法虽然可以实现运动过程中能耗与响应效果的平衡,实现对AUV的最优化控制,但是需要对AUV模型进行精确建模,且当AUV模型参数发生改变时会使控制效果发生较大偏差。滑模控制具有优秀的鲁棒性可以抑制模型变化产生的偏差,但会在控制系统中产生抖动,因而常和其他控制方法结合应用来改善控制效果。

    自适应控制的强适应性可以对AUV水下运动中受到的不确定干扰做出有效应对,模型参考自适应控制(model reference adaptive control,MRAC)通过辨识系统中的未知参数,并根据辨识出的参数调整控制律来消除外界环境对被控对象的干扰,使得被控模型闭环系统的输出可以跟随理想参考模型的输出,提高了系统的抗干扰能力。但是传统的MRAC会在高自适应增益的情况下出现高频震荡控制信号,针对这个问题Cao等在2006年提出了L1自适应控制理论[8-9]。该控制方法是在MRAC基础上在反馈环中引入低通滤波器结构对高频信号进行过滤,使L1自适应控制器的输出能够保持在低频范围内,解决了控制器自适应速率与鲁棒性表现之间的耦合问题,使闭环系统能够在保证动态性能的同时具有良好的鲁棒性,提高了系统的渐进稳定性与可控精确度。基于输出反馈的L1自适应控制器通过分段常数自适应律与低通滤波控制信号,保证了系统输入/输出信号具有一致的性能边界,且可以通过减少积分步长使得闭环自适应系统与理想系统之间的误差足够小,系统地提高控制器性能。目前L1自适应控制理论应用在水下航行器上的研究尚处在起步阶段,Wu等[10]与Sarhadi等[11]均在REMUS AUV的俯仰通道上设计了基于状态反馈的L1自适应控制器并进行了仿真,证明了L1自适应控制器可应用于AUV纵向姿态控制,也验证了L1自适应控制器的抗干扰能力。Wu等[10]结合AUV执行器考虑了控制量的饱和问题,增加了补偿器,但未进行实验来验证控制器性能。Maalouf等[12-13]将L1自适应控制器与自适应非线性状态反馈控制器(adaptive nonlinear state feedback controller,ANSF)分别应用于遥控潜水器(AC-ROV)并进行了对比试验,结果表明,L1自适应控制器拥有更快的自适应速度。Maalouf等的控制器是在未考虑模型推进器的情况下设计的,且AC-ROV模型与REMUS AUV应用场景不同,模型差别较大,仅具有一定的参考价值。

    为提高AUV在水下作业中的抗干扰能力与鲁棒性,使AUV能够更稳定地定深航行,本文从REMUS AUV纵向控制模型出发,拟设计一种基于输出反馈的L1自适应控制器。首先,进行AUV的动力学建模,以及从六自由度非线性模型中提取出简化的纵向控制线性模型的条件与表达式。然后,介绍基于输出反馈的L1自适应控制器的结构与设计。在Matlab/Simulink平台上,将L1自适应控制器与PID控制器应用于REMUS AUV纵向控制模型,对不同情景条件下的仿真结果进行分析。最后,总结L1自适应控制器的动态响应效果,抗干扰性与鲁棒性表现,分析L1自适应控制器优于PID的原因以及未来可以尝试的一些改进方向。

    本文使用2个坐标系:惯性参考坐标系E-XYZ(固定)和载体坐标系O-xyz(运动)对AUV进行动力学建模,坐标系与AUV之间的关系如图1所示。图中:φθψ分别为AUV在惯性参考坐标系下与3个轴的夹角;lvwpqr分别为AUV在载体坐标系3个轴上的线速度与角速度;MKMMMNFxFyFz分别为AUV在载体坐标系3个轴方向上的力矩与力。

    图  1  AUV动力学模型与2个坐标系的关系图
    Figure  1.  Body-fixed frame and earth-fixed frame

    假设载体坐标系原点在AUV的浮心O,为让模型更具有一般性,AUV重心G不与载体坐标系原点重合,(xGyGzG)为AUV重心G的坐标,由动量定律和动量矩定律,可写出AUV六自由度动力学方程为:

    \left\{ \begin{aligned} & m[\dot l - vr + wq - {x_G}({q^2} + {r^2}) + {y_G}(pq - \dot r) + {{\textit{z}}_G}(pr + \dot q)] = {F_x} \\& m[\dot v - wp + lr - {y_G}({r^2} + {p^2}) + {{\textit{z}}_G}(qr - \dot p) + {x_G}(qp + \dot r)] = {F_y} \\& m[\dot w - lq + vp - {{\textit{z}}_G}({q^2} + {p^2}) + {x_G}(rp - \dot q) + {y_G}(rq + \dot p)] = {F_{\textit{z}}} \\& {I_x}\dot p + ({I_{\textit{z}}} - {I_y})qr + m[{y_G}(\dot w - lq + vp) - {{\textit{z}}_G}(\dot v - wp + lr)] = {{\boldsymbol{M}}_K} \\& {I_y}\dot q + ({I_x} - {I_{\textit{z}}})rp + m[{{\textit{z}}_G}(\dot l - vr + wq) - {x_G}(\dot w - lq + vp)] = {{\boldsymbol{M}}_M} \\& {I_{\textit{z}}}\dot r + ({I_y} - {I_x})pq + m[{x_G}(\dot v - wp + lr) - {y_G}(\dot l - vr + qw)] = {{\boldsymbol{M}}_N}\\ \end{aligned}\right. (1)

    式中:IxIyIz分别为AUV在载体坐标系3个轴上的转动惯量;m为AUV质量。

    假设AUV航速l恒定( \dot l=0),纵倾角\theta 控制在较小范围内,垂直方向上速度远小于其他方向的速度,式(1)可以在近似线性化后得到如下AUV纵向控制运动方程[14]

    \begin{split} & {I_y}\dot q = {M_{\dot q}}\dot q + {M_q}q + {M_\theta }\theta + {M_u}u \\& \dot {\textit{z}} = - l\cos \theta \\& \dot \theta = q \end{split} (2)

    式中: {M}_{\theta },\;{M}_{q},\;{M}_{\dot{q}},\;{M}_{u} 为水动力系数组合常量;u为控制量输入。

    由式(2)可知AUV纵向动力学方程状态空间表达形式为[14]

    \left[ {\begin{array}{*{20}{c}} {\dot q} \\ {\dot {\textit{z}}} \\ {\dot \theta } \end{array}} \right] = \left[ {\begin{array}{*{20}{c}} {\dfrac{{{M_q}}}{{{I_y} - {M_{\dot q}}}}}&0&{\dfrac{{{M_\theta }}}{{{I_y} - {M_{\dot q}}}}} \\ 0&0&{ - l} \\ 1&0&0 \end{array}} \right]\left[ {\begin{array}{*{20}{c}} q \\ {\textit{z}} \\ \theta \end{array}} \right] + \left[ {\begin{array}{*{20}{c}} {\dfrac{{{M_u}}}{{{I_y} - {M_{\dot q}}}}} \\ 0 \\ 0 \end{array}} \right]u (3)

    L1自适应控制器是在MRAC的体系结构基础上,在反馈环增设了一个低通滤波器来滤除高频控制信号,基于输出反馈的控制器中闭环自适应系统和参考系统之间的输出误差可以通过减小积分步长而变得任意小,实现对理想参考系统的渐进跟踪。故基于输出反馈的L1自适应控制器可以在参数不确定的情况下控制线性系统,同时保证低频的控制量[8-9, 15]

    本文设计的基于输出反馈的L1自适应控制器由理想参考模型、自适应律、控制律3个部分组成,自适应控制器的优点就是对被控系统动态变化过程中产生的不确定性与干扰表现出强适应性。根据前文建立的AUV模型可以表达为:

    y(s) = G(s)(u(s) + d(s)),{\kern 1pt} {\kern 1pt} {\kern 1pt} {\kern 1pt} y(0) = 0 (4)

    式中:u(s)为控制量输入u(t)的拉普拉斯变换;y(s)为系统输出y(t)的拉普拉斯变换;G(s)为AUV实际模型传递函数;d(s)为外界扰动d(t)=f (t, y(t))的拉普拉斯变换,其中f (.)为未知映射。为使时变外界干扰d(t)有界且为控制器设定稳定性条件,映射f (.)需要满足以下要求:存在常量Ld>0,使得在任意时刻t>0时对所有的y1y2满足以下关系式:

    \left| {f(t,{y_1}) - f(t,{y_2})} \right| \leqslant {L_d}\left| {{y_1} - {y_2}} \right| (5)

    L1自适应控制器结构如图2所示,其中r为输入信号;u为控制量;AmBmCmT为理想模型传递函数M(s)的状态空间方程的最小实现;\tilde y = \hat y - y,为理想输出与实际输出之间的误差值; \dot{ \hat {x}} 为理想参考模型状态; \hat {\boldsymbol{\sigma }}为自适应参数组成的向量,其维数与Bm相同; {\boldsymbol{\varPhi }}(T) {\boldsymbol{\mu }}(iT) 为组成自适应律的方程;C(s)为C(0)=1的低通滤波器;T为采样时间; i = 0,1,2,\cdots n i与采样时间T结合代表运行时间;I为单位矩阵。

    图  2  基于输出反馈的L1自适应控制器结构图
    Figure  2.  L1 adaptive output feedback control structure

    L1自适应控制器中的控制量u(t)的设计目标是:即使存在外界干扰与被控模型参数的不确定性,控制器依然能够使系统输出y(t)跟踪给定连续参考输入信号r(t)。这一目标可以通过设计理想的参考模型来实现,即

    y(s) \approx M(s)r(s) (6)

    式中:M(s)为极点实部均小于零的稳定传递函数;r(s)为输入信号r(t)的拉普拉斯变换;y(s)为系统输出y(t) 的拉普拉斯变换。为了实现设计目标,可将式(4)中的AUV模型改写为:

    y(s) = M(s)(u(s) + \sigma (s)) (7)
    \sigma (s) = \frac{{(G(s) - M(s))u(s) + G(s)d(s)}}{{M(s)}} (8)

    将式(7)写作状态空间方程形式为:

    \begin{split} & \dot {\boldsymbol{x}}(t) = {{\boldsymbol{A}}_{\boldsymbol{m}}}{\boldsymbol{x}}(t) + {{\boldsymbol{B}}_{\boldsymbol{m}}}(u(t) + \sigma (t)) \\& y(t) = {\boldsymbol{C}}_{\boldsymbol{m}}^{\text{T}}{\boldsymbol{x}}(t) \end{split} (9)

    理想的闭环系统设计目标是可以消除干扰对系统稳定性的影响,理想闭环系统可以写成如下形式:

    \hat y(s) = M(s)(\hat u(s) + \hat \sigma (s)) (10)
    \hat \sigma (s) = \frac{{((G(s) - M(s))\hat u(s) + G(s)\hat d(s))}}{{M(s)}} (11)

    为了消除理想闭环系统输出中包含干扰因素的项 \hat \sigma (s) 的影响,设计控制量\hat u(s)为:

    \hat u(s) = C(s)(r(s) - \hat \sigma (s)) (12)

    式中,当s \to 0时,联立式(12)与式(10)可以得到式(6)。

    根据式(10)和式(11)可以推导出:

    \hat y(s) = H(s)(C(s)r(s) + (1 - C(s))\hat d(s)) (13)
    H(s) = \frac{{G(s)M(s)}}{{(C(s)G(s) + (1 - C(s))M(s))}} (14)

    s \to 0时,根据式(13)和式(14)可以得到式(6),消除了干扰因素项 \hat d(s) 。为使上述理想模型系统稳定,需要设计C(s),M(s)使得H(s)稳定,且满足

    {\left\| {H(s)(1 - C(s))} \right\|_{{L_1}}}{L_d} < 1 (15)

    如此设计可以使被控系统的稳态与瞬态性能一致有界得到保证。

    设计理想参考模型状态空间表达形式为:

    \begin{split} & {\dot {\hat {\boldsymbol{x}}}}(t) = {{\boldsymbol{A}}_m}\hat {\boldsymbol{x}}(t) + {{\boldsymbol{B}}_m}u(t) + \hat {\boldsymbol{\sigma }}(t) \\& \hat y(t) = {\boldsymbol{C}}_m^{\text{T}}\hat {\boldsymbol{x}}(t) \end{split} (16)

    对式(16)进行拉普拉斯变换,可以得到

    \hat y(s) = M(s)u(s) + {\boldsymbol{C}}_{\boldsymbol{m}}^{\text{T}}{(s{\boldsymbol{I}} - {{\boldsymbol{A}}_{\boldsymbol{m}}})^{ - 1}}\hat \sigma (s) (17)

    自适应律设计的目的是在保证理想参考模型输出\hat y(t)跟随被控对象输出y(t)的条件下对控制变量进行修正。因为Am是理想模型传递函数M(s)的状态空间方程的最小实现,故Am的根均具有负实部,存在正定的对称矩阵P与正定矩阵Q满足李雅普诺夫方程式:

    {\boldsymbol{A}}_m^{\text{T}}{\boldsymbol{P}} + {\boldsymbol{P}}{{\boldsymbol{A}}_m} = - {\boldsymbol{Q}} (18)

    设计n \times n矩阵:

    {\boldsymbol{\varLambda }} = \left[ {\begin{array}{*{20}{c}} {{\boldsymbol{C}}_m^{\text{T}}} \\ {{\boldsymbol{D}}\sqrt {\boldsymbol{P}} } \end{array}} \right] \in {{\boldsymbol{R}}^{n \times n}} (19)

    式中,D(n - 1) \times n的矩阵,符合关系式

    {\boldsymbol{D}}{({\boldsymbol{C}}_{\boldsymbol{m}}^{\text{T}}{(\sqrt {\boldsymbol{P}} )^{ - 1}})^{\text{T}}} = 0 (20)

    自适应参数方程为:

    \begin{split} & \hat {\boldsymbol{\sigma }}(t) = \hat {\boldsymbol{\sigma }}(iT),t \in [iT,(i + 1)T) \\ & \hat {\boldsymbol{\sigma }}(iT) = - {{\boldsymbol{\varPhi }}^{ - 1}}(T){\boldsymbol{\mu }}(iT) \end{split} (21)
    {\boldsymbol{\varPhi }}(T) = \int_0^T {{e^{{\boldsymbol{\varLambda }}{{\boldsymbol{A}}_{\boldsymbol{m}}}{{\boldsymbol{\varLambda }}^{ - 1}}(T - \tau )}}{\boldsymbol{\varLambda }}d\tau } (22)
    {\boldsymbol{\mu }}(iT) = {e^{{\boldsymbol{\varLambda }}{{\boldsymbol{A}}_{\boldsymbol{m}}}{{\boldsymbol{\varLambda }}^{ - 1}}T}}{{\boldsymbol{l}}_{\boldsymbol{1}}}\tilde y(iT) (23)

    式中,l1为首项为1其余位均是0的向量。在处理器性能允许情况下积分步长越小,理想模型输出对实际模型输出的追踪效果越好,闭环系统和理想参考系统之间的差值可以达到任意小。控制器稳定性分析与式(9)和式(16)的匹配证明在文献[15]中有详细描述。

    控制律的设计是根据理想参考模型式(17)来决定的,为了实现当s \to 0时,参考模型输出可以跟随系统输入,控制量设计为

    u(s) = C(s)r(s) - \frac{{C(s)}}{{{\boldsymbol{C}}_m^{\text{T}}{{(s{\boldsymbol{I}} - {{\boldsymbol{A}}_m})}^{ - 1}}{{\boldsymbol{b}}_m}}}{\boldsymbol{C}}_m^{\text{T}}{(s{\boldsymbol{I}} - {{\boldsymbol{A}}_m})^{ - 1}}\hat {\boldsymbol{\sigma }}(s) (24)

    控制律的设计使控制量随自适应参数\sigma (t)的变化而不断调整,在保证实际被控模型输出y(t)保持与理想模型输出 \hat y(t) 相同的情况下还能够追随输入信号r(t),即实现式(6)。

    为验证L1自适应控制器良好的动态特性、抗干扰能力以及鲁棒性,使用Matlab R2019a/Simulink平台搭建传统PID控制器和L1自适应控制器,并分别应用于AUV,从动态特性与抗干扰效果2个方面进行对比分析,并改变AUV模型参数进行L1自适应控制器的鲁棒性分析。

    仿真使用REMUS AUV为被控对象,选取文献[14]中水动力系数搭建AUV模型,REMUS AUV具体模型参数见表1

    表  1  REMUS AUV的标称参数
    Table  1.  The nominal parameters values of the REMUS AUV
    参数数值
    Mθ/(kg·m2·s−2)−5.77
    Mq/(kg·m2·s−2)−6.87
    {M_{\dot q}}/({\rm{kg}}\cdot{\rm{m}}^2) −4.88
    Mu/(kg·m2·s−2)−34.65
    Iy/(kg·m2)3.45
    下载: 导出CSV 
    | 显示表格

    仿真实验中,T=0.000 1 s,总时间为50 s,航速3 kn,假设AUV初始纵倾角与初始纵倾角速度均为0。根据模型状态空间方程式(3),代入REMUS AUV标称参数,在AUV航行定速l=1.54 m/s条件下,可以得到AUV的纵向控制模型的状态空间方程:

    \dot {\boldsymbol{x}} = \left[ {\begin{array}{*{20}{c}} { - 0.82}&0&{ - 0.69} \\ 0&0&{ - 1.54} \\ 1&0&0 \end{array}} \right]{\boldsymbol{x}} + \left[ {\begin{array}{*{20}{c}} { - 4.16} \\ 0 \\ 0 \end{array}} \right]u (25)

    式中,{\boldsymbol{x}} = {[ q\;\;{\textit{z}}\;\;\theta ]^{\rm{T}}}。AUV深度通道的传递函数可以表示为

    G(s) = \frac{{6.406}}{{{s^3} + 0.82{s^2} + 0.69s}} (26)

    根据前文控制器设计要求,闭环系统中的C(s),M(s)的选择需要同时满足C(0)=1,H(s)稳定性和式(15),参考文献[16]中对L1自适应控制算法在导弹纵向控制中的参数调整过程,选择合适的极点得到:

    C(s) = \frac{{4{\kern 1pt} {\kern 1pt} 880}}{{{s^2} + 8.634s + 4{\kern 1pt} {\kern 1pt} 880}} (27)
    M(s) = \frac{{{s^2} + 36.55s + 776.3}}{{{s^3} + 3.236{s^2} + 4.966s + 2.879}} (28)

    传统PID控制器采用串级结构对AUV的深度变化进行控制,内环为对纵倾角 \theta 的PID控制器,外环为对惯性环节的P控制器。串级控制模型如图3所示,内环PID控制器参数经过试凑调整设定为(KP_in=20,KI_in =1,KD_in =4),外环P控制器参数设定为(KP_out =0.5)。

    图  3  深度通道串级PID控制结构
    Figure  3.  Depth-plane PID control system

    其中纵倾角 \theta 通道的传递函数根据式(25)可得:

    {G_1}(s) = \frac{{ - 4.16}}{{{s^2} + 0.82s + 0.69}} (29)

    惯性环节传递函数为:

    {G_2}(s) = \frac{{ - 1.54}}{s} (30)
    G(s) = {G_1}(s) \cdot {G_2}(s) (31)

    分别进行输入信号为阶跃信号、正弦信号情况下REMUS AUV应用L1自适应控制器与PID控制器的动态响应仿真实验并对比。AUV系统的深度z、纵倾角θ与纵倾角速度q在阶跃信号与正弦信号输入的动态响应仿真对比情况如图4~图6所示。无干扰情况下2种控制器的动态响应的性能指标对比如表2所示。假设存在外部干扰,根据海浪幅值响应公式[17],在低海况等级情况下,选取随机有义波高与仿真频段进行多谐波叠加来模拟随机海流对AUV产生的纵向扰动。扰动可表示为

    图  4  无干扰情况下AUV深度的动态响应
    Figure  4.  Dynamic response of AUV depth without disturbance
    图  5  无干扰情况下AUV纵倾角的动态响应
    Figure  5.  Dynamic response of AUV pitch without disturbance
    图  6  无干扰情况下AUV纵倾角速度的动态响应
    Figure  6.  Dynamic response of AUV pitch velocity without disturbance
    表  2  无干扰下AUV纵向姿态变化曲线的性能指标
    Table  2.  Performance indexes of the two controllers without disturbance
    输入类型响应指标PID控制器L1自适应控制器
    阶跃信号上升时间/s2.851.90
    调节时间/s4.873.76
    最大纵倾角/rad0.3860.416
    最大纵摇角速度/(rad·s−1)1.690.62
    正弦信号峰值偏差/m0.070.03
    峰值偏差百分比/%73
    最大纵摇角/rad0.1900.200
    最大纵摇角速度/(rad·s−1)0.1630.130
    下载: 导出CSV 
    | 显示表格
    \begin{split} d(t) = & 0.1\sin (t) + 0.15\sin ((1.5{/\text{π}} )t + 0.5) +\\& 0.2\sin ((2{/\text{π}} )t + 0.7) - 0.22 \end{split} (32)

    在仿真实验第10 s加入干扰,2种控制器的深度控制抗干扰仿真效果及抗干扰性能指标对比结果分别如图7表2所示。假设被控对象模型参数发生变化,进行L1自适应控制器在阶跃信号与正弦信号输入情况下的动态响应仿真实验,模型中水动力系数{M_{\dot q}}发生a倍变化时动态响应曲线变化情况如图8所示,模型中运动速度u发生变化时动态响应曲线变化情况如图9所示。

    图  7  外部环境干扰下AUV深度的动态响应
    Figure  7.  Dynamic response of AUV depth with disturbance
    图  8  AUV深度随模型参数{M_{\dot q}}的变化曲线
    Figure  8.  Dynamic response of AUV depth with different hydrodynamic force coefficient {M_{\dot q}}
    图  9  AUV深度随模型参数l的变化曲线
    Figure  9.  Dynamic response of AUV depth with different speed l

    综合分析以上仿真结果,可以得到以下结论:

    1) 根据图4~图6表2可以得知,L1自适应控制器的动态响应性能优于PID控制器,在阶跃信号输入情况下比PID控制器有着更低的超调量和更快的响应速度,在正弦波信号输入情况下比PID控制器的峰值偏差更小。这归因于控制器中理想参考模型的设计,通过实际输出与参考输出之间的误差来调整自适应参数进而修改控制量,使实际系统可以追随理想模型的输出,表现出良好的动态性能。图4~图6表2的结果说明了应用L1自适应控制器的AUV不仅具有实际可操控性,而且具有更高的控制精度。

    2) 根据图7表3可以得知,在引入随机海流干扰后,L1自适应控制器比PID控制器表现更稳定,可以精确追随输入信号。这归因于L1自适应控制器的设计前提中考虑了干扰,并通过设计控制律平衡了干扰的影响,使得整个系统即便存在外界干扰,其闭环系统依然等价于设计的理想参考模型。图7表3的结果证明了L1自适应控制器有着比PID控制器更强的抗干扰能力,可以在复杂外界干扰情况下保持良好的控制效果。

    表  3  外部干扰下AUV深度变化曲线的性能指标
    Table  3.  Performance indexes of the two controllers with disturbance
    输入类型响应指标PID控制器L1自适应控制器
    阶跃信号平均差值/m0.0080.000 5
    方差值/m20.012 70.000 16
    正弦信号最大峰值偏差/m0.1150.029
    最大峰值偏差百分比/%11.52.9
    下载: 导出CSV 
    | 显示表格

    3) 根据图8图9可以得知,当阶跃信号作为系统输入时,水动力系数 {M_{\dot q}} 的减小和速度l的增加对AUV深度通道动态响应没有产生明显影响;但当水动力系数 {M_{\dot q}} 增大到1.5倍或速度 l 减小至1 m/s时,AUV深度通道动态响应曲线开始出现波动。当正弦信号作为系统输入时,水动力系数 {M_{\dot q}} 与速度l的改变没有对AUV深度通道动态响应产生明显影响,AUV深度响应仿真曲线几乎重合。这归因于L1自适应控制器的设计将被控对象的参数变化视为干扰进行处理,因此可以获得良好的鲁棒性表现。图8图9的结果说明了L1自适应控制器在模型参数发生一定程度变化时可以保持AUV系统动态响应的稳定,但是在持续激励信号的作用下控制器的鲁棒性更好。

    综上所述,仿真结果证明了L1自适应控制器的设计使其拥有比PID控制器更好的动态响应与抗干扰能力,同时证明了L1自适应控制器在被控对象模型出现一定偏差时仍然可以保证控制的效果。

    本文针对AUV深度控制中面临的干扰大、参数不确定的问题,提出了一种基于L1自适应控制理论的控制器设计方案。仿真结果表明,无外部干扰的情况下,L1自适应控制器的动态响应更好。若存在持续外部环境干扰,L1自适应控制器比传统PID控制器拥有更强的抗干扰能力。当AUV模型参数发生一定程度变化时,L1自适应控制器可以保持动态响应的稳定,而且当输入信号是持续激励信号时系统的鲁棒性更强。基于输出反馈的L1自适应控制器将建模中的参数不准确与外界干扰统一归为扰动,在足够小的积分步长下,通过分段常数自适应律与低通滤波控制信号使实际闭环系统接近理想参考系统,使系统在具有良好动态响应的情况下具有比PID更好的抗干扰能力和优秀的鲁棒性。这种方法为复杂环境下AUV稳定作业的控制器设计提供了一种方案,不仅保证了系统在参数变化下的鲁棒性而且增强了系统的抗干扰能力。后续可以对该控制算法进行改进,优化算法在非持续激励信号输入下的动态响应表现,进一步改善AUV定深航行作业的鲁棒性效果。

  • 图  1   AUV动力学模型与2个坐标系的关系图

    Figure  1.   Body-fixed frame and earth-fixed frame

    图  2   基于输出反馈的L1自适应控制器结构图

    Figure  2.   L1 adaptive output feedback control structure

    图  3   深度通道串级PID控制结构

    Figure  3.   Depth-plane PID control system

    图  4   无干扰情况下AUV深度的动态响应

    Figure  4.   Dynamic response of AUV depth without disturbance

    图  5   无干扰情况下AUV纵倾角的动态响应

    Figure  5.   Dynamic response of AUV pitch without disturbance

    图  6   无干扰情况下AUV纵倾角速度的动态响应

    Figure  6.   Dynamic response of AUV pitch velocity without disturbance

    图  7   外部环境干扰下AUV深度的动态响应

    Figure  7.   Dynamic response of AUV depth with disturbance

    图  8   AUV深度随模型参数{M_{\dot q}}的变化曲线

    Figure  8.   Dynamic response of AUV depth with different hydrodynamic force coefficient {M_{\dot q}}

    图  9   AUV深度随模型参数l的变化曲线

    Figure  9.   Dynamic response of AUV depth with different speed l

    表  1   REMUS AUV的标称参数

    Table  1   The nominal parameters values of the REMUS AUV

    参数数值
    Mθ/(kg·m2·s−2)−5.77
    Mq/(kg·m2·s−2)−6.87
    {M_{\dot q}}/({\rm{kg}}\cdot{\rm{m}}^2) −4.88
    Mu/(kg·m2·s−2)−34.65
    Iy/(kg·m2)3.45
    下载: 导出CSV

    表  2   无干扰下AUV纵向姿态变化曲线的性能指标

    Table  2   Performance indexes of the two controllers without disturbance

    输入类型响应指标PID控制器L1自适应控制器
    阶跃信号上升时间/s2.851.90
    调节时间/s4.873.76
    最大纵倾角/rad0.3860.416
    最大纵摇角速度/(rad·s−1)1.690.62
    正弦信号峰值偏差/m0.070.03
    峰值偏差百分比/%73
    最大纵摇角/rad0.1900.200
    最大纵摇角速度/(rad·s−1)0.1630.130
    下载: 导出CSV

    表  3   外部干扰下AUV深度变化曲线的性能指标

    Table  3   Performance indexes of the two controllers with disturbance

    输入类型响应指标PID控制器L1自适应控制器
    阶跃信号平均差值/m0.0080.000 5
    方差值/m20.012 70.000 16
    正弦信号最大峰值偏差/m0.1150.029
    最大峰值偏差百分比/%11.52.9
    下载: 导出CSV
  • [1] 赵蕊, 许建, 王淼, 等. 基于遗传算法和分数阶技术的水下机器人航向控制[J]. 中国舰船研究, 2018, 13(6): 87–93.

    ZHAO R, XU J, WANG M, et al. Heading control of AUV based on GA and fractional order technology[J]. Chinese Journal of Ship Research, 2018, 13(6): 87–93 (in Chinese).

    [2] 陈路伟, 谢志强. 灰色PID控制在AUV横滚控制中应用研究[J]. 现代电子技术, 2015, 38(1): 100–102. doi: 10.3969/j.issn.1004-373X.2015.01.029

    CHEN L W, XIE Z Q. Application of gray PID control in autonomous underwater vehicle roll control[J]. Modern Electronics Technique, 2015, 38(1): 100–102 (in Chinese). doi: 10.3969/j.issn.1004-373X.2015.01.029

    [3] 吴小平, 冯正平, 朱继懋. 模糊PID策略在AUV控制中的应用[J]. 舰船科学技术, 2007, 29(1): 95–98.

    WU X P, FENG Z P, ZHU J M. Application on AUV control based on fuzzy PID strategy[J]. Ship Science and Technology, 2007, 29(1): 95–98 (in Chinese).

    [4] 周焕银, 刘开周, 封锡盛. 基于神经网络的自主水下机器人动态反馈控制[J]. 电机与控制学报, 2011, 15(7): 87–93. doi: 10.3969/j.issn.1007-449X.2011.07.016

    ZHOU H Y, LIU K Z, FENG X S. Dynamic feedback control based on ANN compensation controller for AUV motions[J]. Electric Machines and Control, 2011, 15(7): 87–93 (in Chinese). doi: 10.3969/j.issn.1007-449X.2011.07.016

    [5]

    WANG S K, JIN H Z, MENG L W, et al. Optimize motion energy of AUV based on LQR control strategy[C]//2016 35th Chinese Control Conference (CCC). Chengdu, China: IEEE, 2016.

    [6] 杨清, 宿浩, 唐功友, 等. 不确定AUV系统的鲁棒最优滑模控制[J]. 信息与控制, 2018, 47(2): 176–183.

    YANG Q, SU H, TANG G Y, et al. Robust optimal sliding MODE control for AUV system with uncertainties[J]. Information and Control, 2018, 47(2): 176–183 (in Chinese).

    [7] 张利军, 齐雪, 赵杰梅, 等. 垂直面欠驱动自治水下机器人定深问题的自适应输出反馈控制[J]. 控制理论与应用, 2012, 29(10): 1371–1376.

    ZHANG L J, QI X, ZHAO J M, et al. Depth-keeping control for autonomous underwater vehicle in vertical plane using adaptive output feedback controller[J]. Control Theory & Applications, 2012, 29(10): 1371–1376 (in Chinese).

    [8]

    CAO C Y, HOVAKIMYAN N. Design and analysis of a novel L1 adaptive controller, part I: control signal and asymptotic stability[C]//2006 American Control Conference. Minneapolis, MN, USA: IEEE, 2006.

    [9]

    CAO C Y, HOVAKIMYAN N. Design and analysis of a novel L1 adaptive controller, part II: guaranteed transient performance[C]//2006 American Control Conference. Minneapolis, MN, USA: IEEE, 2006.

    [10]

    WU N L, WU C, GE T, et al. Pitch channel control of a REMUS AUV with input saturation and coupling disturbances[J]. Applied Sciences, 2018, 8(2): 253. doi: 10.3390/app8020253

    [11]

    SARHADI P, NOEI A R, KHOSRAVI A. L1 adaptive pitch control of an autonomous underwater vehicle[J]. International Journal of Intelligent Unmanned Systems, 2014, 2(2): 107–120. doi: 10.1108/IJIUS-12-2013-0025

    [12]

    MAALOUF D, CHEMORI A, CREUZE V. Stability analysis of a new extended L1 controller with experimental validation on an underwater vehicle[C]//52nd IEEE Conference on Decision and Control. Florence, Italy: IEEE, 2013.

    [13]

    MAALOUF D, CHEMORI A, CREUZE V. L1 adaptive depth and pitch control of an underwater vehicle with real-time experiments[J]. Ocean Engineering, 2015, 98: 66–77. doi: 10.1016/j.oceaneng.2015.02.002

    [14]

    PRESTERO T J. Verification of a six-degree of freedom simulation model for the REMUS autonomous underwater vehicle[D]. Cambridge/Woods Hall: Massachusetts Institute of Technology/Woods Hole Oceanographic Institution, 2001.

    [15]

    CAO C Y, HOVAKIMYAN N. L1 adaptive output feedback controller for non strictly positive real reference systems with applications to aerospace examples[C]//AIAA Guidance, Navigation and Control Conference and Exhibit. Honolulu, Hawaii: AIAA, 2008.

    [16]

    WANG J, CAO C Y, HOVAKIMYAN N, et al. L1 adaptive controller for a missile longitudinal autopilot design[C]//AIAA Guidance, Navigation and Control Conference and Exhibit. Honolulu, Hawaii: AIAA, 2008.

    [17] 陆斌杰, 李文魁, 周岗, 等. 潜艇垂直面波浪力计算与运动仿真[J]. 火力与指挥控制, 2018, 43(11): 161–164, 170. doi: 10.3969/j.issn.1002-0640.2018.11.033

    LU B J, LI W K, ZHOU G, et al. Computation of motion and wave forces for a submarine in vertical plane[J]. Fire Control & Command Control, 2018, 43(11): 161–164, 170 (in Chinese). doi: 10.3969/j.issn.1002-0640.2018.11.033

  • 其他相关附件

图(9)  /  表(3)
计量
  • 文章访问数:  1186
  • HTML全文浏览量:  312
  • PDF下载量:  121
  • 被引次数: 0
出版历程
  • 收稿日期:  2020-09-15
  • 修回日期:  2020-11-30
  • 网络出版日期:  2021-05-25
  • 发布日期:  2021-09-22
  • 刊出日期:  2021-10-29

目录

/

返回文章
返回