0 引　言

AUV因其自主、智能的特性，在水下环境探测和资源勘探方面发挥了人工无法比拟的作用^[1]。AUV作业过程中，受到海浪和水流的干扰，所以在近海底自主观测、轨迹跟踪等要求精细控制的场景，必须考虑外界环境扰动对AUV稳定性的影响。AUV平台具有多变量、非线性、强耦合、外界干扰多和内部参数时变的特点，要想达到理想的控制效果，往往需要收敛速度快、抗干扰、鲁棒能力强的控制器，这些要求给控制系统的设计带来了很多困难。

基于对象信息的现代控制理论包含对模型不确定性的近似，这种近似性使得AUV控制系统性能有待提高。针对控制器本身存在不足及其对扰动抑制能力弱的问题，韩京清等^[3-5]提出了一种抗扰动控制方法，对控制模型信息依赖少，具有天然的解耦性和优秀的抗干扰能力，被广泛应用于机器人控制。针对非线性自抗扰控制参数比较多的问题，高志强^[6]提出了线性化版本，简化了工程实现和参数整定，更加便于工业推广。

目前针对线性自抗扰控制器的理论研究主要集中在其时域和频域特性的探索，以及与PID的关系的证明上，总结出了很多控制器调参的指导方法。其中，JIN等^[7]证明二阶线性ADRC可以等效于增加了前馈和二阶低通滤波器PID控制，并提出了按照等效PID参数对二阶线性ADRC调参的方法。崔文庆等^[8]说明在中低频段线性ADRC等效于PID控制器串联n阶超前环节。除了根据频域特性和类比PID的调参方法，还有很多自适应调参方法，如基于强化学习改进的自抗扰控制算法在无人船中的应用^[9-10]。以上理论分析说明ADRC实际上是改进版的PID，PID是ADRC的一种特殊情况。但是当输入阶跃信号的幅值改变较大时，得到的过渡过程不同，原有的扩张状态观测器对扰动的观测误差将增大，进而影响系统的稳定性，需要重新调节控制器参数，才能取得好的控制效果。

为此，本文提出一种基于RBF神经网络补偿的线性自抗扰控制方法：利用神经网络的自学习和自适应能力，将其用于扰动观测器的改进，实现在不同阶跃信号下对扰动的准确估计，以此改善ADRC的控制性能，简化控制器调参过程，提高控制器的鲁棒性。将改进后的控制器应用于AUV的航向角控制，通过仿真实验说明了方法的有效性，验证了所提方法对不同采样频率的鲁棒性。仿真结果表明，在低采样频率下改进后的控制方法有更好的控制效果，对实际工程具有参考意义。

1 AUV模型 1.1 坐标系、术语和符号定义

按照国际水池（ITTC）推荐的和造船与轮机工程学会（SNAME）术语公报的体系^[11]，采用2个右手坐标系表述AUV的运动学和动力学模型：一个是固定于地球上的定坐标系 $ E - \xi \eta \zeta $ ，原点取为水中任意一点；另一个是与AUV固联并随之运动的动坐标系 $ G - xyz $ ，原点取为AUV的浮心。AUV的位置和姿态分别用动系相对于定系的坐标（ $ {\xi _B} $ ， $ {\eta _B} $ ， $ {\zeta _B} $ ）和姿态角（横滚角 $ \varphi $ ，纵倾角 $ \theta $ ，航向角 $ \psi $ ）表示，而AUV运动的速度（u，v，w）、角速度（p，q，r）、所受力（X，Y，Z）和力矩（K，M，N）定义于动坐标系中，规定向量正方向沿对应坐标系正方向，所有旋转变量采用右手螺旋规则确定方向。坐标系和变量的定义如图1所示，各变量对应的符号列于表1。

1.2 AUV运动学模型

将AUV看做自由运动的刚体，根据刚体六自由度运动学方程，AUV位姿和运动速度之间的转换关系表达为：

$ \left[ \begin{gathered} {{{\dot {{P}}}}} \\ {{{\dot \varTheta }}} \\ \end{gathered} \right] = \left[ {\begin{array}{*{20}{c}} {{T}}&{{{{{{0}}}}_{3 \times 3}}} \\ {{{{0}}_{3 \times 3}}}&{{R}} \end{array}} \right]\left[ {\begin{array}{*{20}{c}} {{V}} \\ {{{{\varOmega}} }} \end{array}} \right]。$

(1)

式中： ${{{\boldsymbol{T}}}}$ 表示速度矢量从动系到定系的变换矩阵， ${{{\boldsymbol{R}}}}$ 代表角速度矢量从动系到定系的变换矩阵。

1.3 AUV动力学模型

将AUV看做刚体，参考刚体动力学公式推导AUV动力学模型。记 ${{v}} = {\left[ {{V}}\;\;{{\varOmega }} \right]^{\text{T}}}$ ，根据刚体六自由度动力学方程：

$ {{{{\boldsymbol{M}}}}_{RB}}{\boldsymbol{\dot v}} + {{{{\boldsymbol{C}}}}_{RB}}({{v}}){{v}} = {{\boldsymbol{\tau }}_{RB}} 。$

(2)

式中： ${{{{\boldsymbol{M}}}}_{RB}} \in {\Re ^{6 \times 6}}$ 为惯性矩阵； ${{{{\boldsymbol{C}}}}_{RB}} \in {\Re ^{6 \times 6}}$ 为科氏力和向心力矩阵； ${{\boldsymbol{\tau }}_{RB}} \in {\Re ^6}$ 为刚体受到的所有外力和外力矩。对于水下航行器应用环境，表达式^[12]为：

$ {{\boldsymbol{\tau }}_{RB}} = {\boldsymbol{\tau }} + {{\boldsymbol{\tau }}_{hyd}} + {{\boldsymbol{\tau }}_{hs}} + {{\boldsymbol{\tau }}_{dis}}。$

(3)

式中： ${{\boldsymbol{\tau }}_{hyd}} = - {{{{\boldsymbol{M}}}}_A}{{{\dot {\boldsymbol{v}}}}_r} - {{{{\boldsymbol{C}}}}_A}({{{{\boldsymbol{v}}}}_r}){{{{\boldsymbol{v}}}}_r} - {{{\boldsymbol{D}}}}({{{{\boldsymbol{v}}}}_r}){{{{\boldsymbol{v}}}}_r}$ 为水动力项， ${{\boldsymbol{\tau }}_{hs}} = - {{{\boldsymbol{g}}}}({{{\boldsymbol{\varTheta}} }}) - {{{{\boldsymbol{g}}}}_0}$ 为重力、浮力和载重产生的水静力项， $ {{\boldsymbol{\tau }}_{dis}} $ 表示来自水流、海浪等的环境干扰力、力矩， ${\boldsymbol{\tau }} = $ $ {\left[ {\begin{array}{*{20}{c}} {{X_\tau }}&{{Y_\tau }}&{{Z_\tau }}&{{K_\tau }}&{{M_\tau }}&{{N_\tau }} \end{array}} \right]^{\text{T}}} $ 为推进器和桨、舵的操纵力。本文实验使用的模型为REMUS 100 AUV，其操纵力来自尾推进器、垂直操纵舵和水平操纵舵。

1.4 AUV航向角控制模型

由式（2）和式（3）得到AUV状态变量的加速度表达式为：

$ {{\dot {\boldsymbol{v}}}} = {{{{\boldsymbol{M}}}}^{{\text{ - }}1}}{\boldsymbol{\tau }} - {{{{\boldsymbol{M}}}}^{{\text{ - }}1}}({{{\boldsymbol{C}}}}({{{\boldsymbol{v}}}}){{{\boldsymbol{v}}}} - {{D}}({{{\boldsymbol{v}}}}){{{\boldsymbol{v}}}} - {{{\boldsymbol{g}}}}({{{\boldsymbol{\varTheta}} }}) - {{{{\boldsymbol{g}}}}_0} + {{\boldsymbol{\tau }}_{{{{\boldsymbol{dis}}}}}}) 。$

(4)

其中， ${{{\boldsymbol{M}}}} = {{{{\boldsymbol{M}}}}_{{{{\boldsymbol{RB}}}}}} + {{{{\boldsymbol{M}}}}_{{{\boldsymbol{A}}}}}$ ， ${{{\boldsymbol{C}}}} = {{{{\boldsymbol{C}}}}_{{{{\boldsymbol{RB}}}}}} + {{{{\boldsymbol{C}}}}_{{{\boldsymbol{A}}}}}$ ，分别对应包含附加质量的矩阵。

实际控制器按照解耦后的模型来设计，所以可以对模型进行合理的简化。假设整个过程中推进器的转速保持不变，AUV处于巡航状态，当控制航向角时，只有垂直舵动作，水平舵微调用于保持纵倾角稳定。基于上述假设，得到航向角控制模型：

$ \begin{gathered} \ddot \psi = {m_{61}}({X_{prop}} + {X_r}) + {m_{62}}{Y_r} + {m_{64}}{K_{prop}} + {m_{66}}{N_r}+ \\ f(\psi ,\dot \psi ,{w_\psi },t) = b_0^\psi \delta _r^2 + b_1^\psi {\delta _r} + b_2^\psi + f(\psi ,\dot \psi ,{w_\psi },t) 。\end{gathered} $

(5)

其中： $ {m_{ij}} $ 为M矩阵的元素； $ {X_{prop}} $ ， $ {K_{prop}} $ ， $ {X_r} $ ， $ {Y_r} $ ， $ {N_r} $ 分别为尾推进器和垂直舵的操纵力，力矩； $ {w_\psi } $ 为外界环境的扰动； $ f(\psi ,\dot \psi ,{w_\psi },t) $ 为包含解耦项、水动力参数项等模型不确定部分的扰动，记 $ b_i^\psi $ ， $ i \in \left[ {0,2} \right] $ 分别为舵角不同阶次项的系数。

2 RBF神经网络改进的自抗扰控制器 2.1 自抗扰控制技术

ADRC将积分器串联型作为标准型，将总扰动扩张为系统的一个状态，并经观测器估计后补偿到控制输入中加以消除，达到简化控制系统、提高控制抗干扰性的目的。

ADRC由扩张状态观测器（Extended State Observer，ESO）、跟踪微分器（Tracking Differentiator，TD）和状态误差反馈控制律（State Error Feedback，SEF）组成，如图2所示。其中ESO用于估计系统的状态和总扰动，生成补偿量，TD用于配置过渡过程和获取微分信号，SEF用于生成控制信号。

设二阶对象：

$ \ddot y = f(y,\dot y,w,t) + {b_1}\delta 。$

(6)

式中： $ w $ 为外部扰动， $ f(y,\dot y,w,t) $ 为包含内扰和外扰的总扰动。取系统状态变量： $ {v_1} = y $ ， $ {v_2} = \dot y $ ，可将上式转化为状态方程：

$ \left\{ {\begin{array}{*{20}{l}} {{{\dot v}_1} = {v_2}}，\\ {{{\dot v}_2} = f({v_1},{v_2},w,t) + {b_1}\delta }，\\ {y = {v_1}} 。\end{array}} \right. $

(7)

将航向角控制模型除控制量一阶项外的部分视为该通道的内部扰动，则式（5）变为：

$ \ddot \psi = b_1^\psi {\delta _r} + \hat f(\psi ,\dot \psi ,{\delta _r},{w_\psi },t)。$

(8)

对比式（6），可对航向角控制应用扩张状态观测器，估计总扰动并补偿到控制信号中。

2.1.1 跟踪微分器

TD的算法为：

$ \left\{ {\begin{array}{*{20}{l}} {{{\dot v}_1} = {v_2}} ，\\ {{{\dot v}_2} = fhan({v_1} - {v_0},{v_2},{r_0},{h_0})} 。\end{array}} \right. $

(9)

其中 $ fhan({x_1},{x_2},{r_0},{h_0}) $ 为最速综合函数，表达式为：

$ fhan = \left\{ \begin{array}{*{20}{l}} r{\rm{sign}}(a),&{\left| a \right| > d}，\\ r\frac{a}{d},&{\left| a \right| \leqslant d}。\end{array} \right. $

(10)

$ a = \left\{ {\begin{array}{*{20}{l}} {x_2} + \dfrac{{({a_0} + d)}}{2}{\rm{sign}}({x_3}),& {\left| {{x_3}} \right| > {d_0}} ，\\ {x_2} + \dfrac{{{x_3}}}{{{h_0}}},&{\left| {{x_3}} \right| \leqslant {d_0}}。\end{array}} \right. $

(11)

式中： $ {r_0} $ ， $ {h_0} $ 为函数控制参量， $ {r_0} $ 称为速度因子，根据过渡过程快慢的需要和系统的承受能力决定， $ {h_0} $ 称为滤波因子，常取系统采样步长的若干倍。 $ d = {r_0}h_0^2 $ ， $ {a_0} = {h_0}{x_2} $ ， $ {x_3} = {x_1} + {a_0} $ 。

TD的状态变量 $ {v_1} $ 能够跟踪输入信号 $ {v_0} $ ，配置过渡过程，生成快速、无超调的过渡信号，而 $ {v_2} $ 作为 $ {v_0} $ 的近似微分能够跟踪输入信号的微分。

2.1.2 扩张状态观测器

ESO是ADRC的核心，其以控制信号δ和输出信号y为输入量，输出对系统状态和总扰动的估计。

将总扰动扩张成新的状态变量：

$ v{}_3 = f(y,\dot y,w,t)。$

(12)

则可对系统式（7）建立线性扩张状态观测器：

$ \left\{ {\begin{array}{*{20}{l}} {\varepsilon = y - {z_1}}，\\ {{{\dot z}_1} = {z_2} + {l_1}\varepsilon }，\\ {{{\dot z}_2} = {z_3} + {l_2}\varepsilon + {b_1}\delta }，\\ {{{\dot z}_3} = {l_3}\varepsilon } 。\end{array}} \right. $

(13)

其中，观测器的状态向量 ${\boldsymbol{z}} = {\left[ {{z_1}}\;\;{{z_2}}\;\;{{z_3}} \right]^{\text{T}}}$ 是对系统状态向量 ${\boldsymbol{v}} = {\left[ {{v_1}}\;\;{{v_2}}\;\;{{v_3}} \right]^{\text{T}}}$ 的估计， ${\boldsymbol{L}} = {\left[ {{l_1}}\;\;{{l_2}}\;\;{{l_3}} \right]^{\text{T}}}$ 为观测器增益矩阵，可取 ${\boldsymbol{\hat L}} = {\left[ {3{w_0}}\;\;{3w_0^2}\;\;{w_0^3} \right]^{\text{T}}}$ ，称 $ {w_0} $ 为观测器带宽。

2.1.3 状态误差反馈控制器

将总干扰的观测值补偿到控制信号中：

$ \delta = \frac{{ - {z_3} + {\delta _0}}}{{{b_1}}}。$

(14)

忽略 $ {z_3} $ 的估计误差，系统式（6）中的控制对象简化为积分器串联系统。

$ \ddot y = (f - {z_3}) + {\delta _0} \approx {\delta _0} 。$

(15)

采用PD控制生成控制信号：

$ {\delta _0} = {k_p}({v_1} - {z_1}) - {k_d}({v_2} - {z_2})。$

(16)

其中， ${\boldsymbol{K}} = {[ {{k_d}}\;\;{{k_p}} ]^{\text{T}}}$ 为控制器增益矩阵，可取 ${\boldsymbol{\hat K}} = {[ {2{w_c}}\;\;{w_c^2} ]^{\text{T}}}$ ，称 $ {w_c} $ 为控制带宽。

2.2 自适应RBF神经网络改进的自抗扰控制器

根据扩张状态观测器的表达式（13），观测器带宽是固定不变的，只对一定频率范围内的干扰估计效果比较好，如果扰动的频率范围较宽，观测效果就会降低，需要重新调整观测器带宽。同时，由于AUV模型具有非线性、耦合、时变的特点，不同阶跃输入和采样频率也会引起内部扰动的变化，影响观测器的效率。针对这一问题，可以用RBF神经网络改进观测器，使之具有自适应特性。

RBF神经网络是20世纪80年代末提出的一种神经网络，能以任意精度逼近任意连续函数，具有学习速度快、避免陷入局部最小值的特点，采用RBF神经网络对系统式（7）中的总扰动进行自适应逼近。

RBFNN是一种3层的神经网络，结构如图3所示，包括输入层、隐层和输出层，输入层到隐层之间为非线性映射，激活函数采用径向基函数：

$ {\boldsymbol{h}}({\boldsymbol{x}},{\boldsymbol{c}}) = {\boldsymbol{h}}(\left\| {{\boldsymbol{x}} - {\boldsymbol{c}}} \right\|) 。$

(17)

径向基函数取值仅与距中心的距离有关，且两边对称。标准的径向基函数一般取欧式距离，最常用的是高斯核函数。隐层到输出层之间为线性映射，取径向基函数输出值的加权和，权值可以通过自适应律调整，称为自适应径向基函数神经网络。

取RBF神经网络的输入为TD设定值和ESO观测值的误差：

$ {e_1} = {v_1} - {z_1} ，$

(18)

$ {e_2} = {\dot v_1} - {\dot z_1} = {v_2} - {z_2}，$

(19)

$ {\boldsymbol{E}} = {\left[ {\begin{array}{*{20}{c}} {{e_1}}&{{e_2}} \end{array}} \right]^{\text{T}}}。$

(20)

采用高斯核RBF神经网络的算法为：

$ {\boldsymbol{h}}({\boldsymbol{E}}) = \exp ( - {{{{\left\| {{\boldsymbol{E}} - {{\boldsymbol{c}}_{ij}}} \right\|}^2}} /{2{\boldsymbol{b}}_j^2}})，$

(21)

$ f({\boldsymbol{E}}) = {{\boldsymbol{W}}^{\text{T}}}{\boldsymbol{h}}({\boldsymbol{E}}) + \sigma 。$

(22)

式中：i为输入层的节点数，j为隐含层的节点数， $ {{\boldsymbol{c}}_{ij}} $ 为高斯函数中心矢量， $ {{\boldsymbol{b}}_j} $ 为基宽向量，确定了径向基函数的作用范围，σ为对总扰动的逼近误差。

$ \sigma = \hat f({\boldsymbol{E}}|{\boldsymbol{W}}) - f({\boldsymbol{E}}) 。$

(23)

$ {\boldsymbol{W}} = {\left[ {{w_1},{w_2},...{\text{,}}{w_j}} \right]^{\text{T}}} $ 为神经网络的权值，存在最优参数：

$ {{\boldsymbol{W}}^{\boldsymbol{*}}} = \arg \mathop {\min }\limits_{{\boldsymbol{W}} \in {\boldsymbol{\varOmega }}} \left[ {\sup \left| {\hat f({\boldsymbol{E}}) - f({\boldsymbol{E}})} \right|} \right] 。$

(24)

式中， ${{{\boldsymbol{\varOmega}}}}$ 为 $ {\boldsymbol{W}} $ 的定义域。有很多权值调整的自适应率，常见的如参考误差滑模面的值或采用梯度下降法^[13-15]，本文取RBF神经网络权值的自适应律为：

${ \dot {\tilde {{W}}}} = - \alpha {{{E}}^{\text{T}}}{{Pbh}}({{E}}) 。$

(25)

此时可使神经网络的逼近误差 $ \sigma $ 最小，且控制系统稳定。其中， $ \alpha \geqslant 0 $ 为神经网络的学习率， ${\boldsymbol{b}} = {\left[ 0\;\;1 \right]^{\text{T}}}$ ，P为一个正定矩阵，满足李雅普诺夫方程：

$ {{\boldsymbol{\varLambda }}^{\text{T}}}{\boldsymbol{P}} + {\boldsymbol{P\varLambda }} = - {\boldsymbol{Q}}。$

(26)

其中，Q是任意的 $ 2 \times 2 $ 正定矩阵， ${\boldsymbol{\varLambda }}$ 定义为：

$ {\boldsymbol{\varLambda }} = \left[ {\begin{array}{*{20}{c}} 0&1 \\ { - {k_p}}&{ - {k_d}} \end{array}} \right]。$

(27)

式中， $ {k_p} $ 和 $ {k_d} $ 对应式（16）中取值。

神经网络的实际输出为：

$ \tilde f({\boldsymbol{E}}) = {{\boldsymbol{\tilde W}}^{\text{T}}}{\boldsymbol{h}}({\boldsymbol{E}})。$

(28)

可以用 $ \tilde f({\boldsymbol{E}}) $ 代替 $ {z_3} $ 补偿控制信号，使抗扰动有自适应、自学习的性能。RBF神经网络改进后的自抗扰控制器ADRC+RBFNN如图4所示。

3 仿真实验

为了验证本文提出方法的有效性，设计仿真实验。针对AUV姿态控制，分别建立PID、ADRC和ADRC+RBFNN控制器，进行姿态控制仿真。在不同时刻输入不同幅值的阶跃信号，对比控制器的动态响应性能；然后设计控制端扰动和反馈信号噪声，研究控制器对干扰的观测和补偿能力。最后，比较采样频率对改进前后控制器的影响，验证控制器的工程可实现性。

实验中的主要参数包括ADRC的速度因子 $ {r_0} $ ，最速综合函数步长 $ {h_0} $ ，观测器带宽 $ {w_0} $ ，控制器带宽 $ {w_c} $ ，补偿因子 $ {b_0} $ ，PID参数 $ {k_p} $ ， $ {T_i} $ ， $ {T_d} $ ，N，RBF神经网络中心矢量 $ {{\boldsymbol{c}}_{ij}} $ ，基宽向量 $ {{\boldsymbol{b}}_j} $ ，学习率 $ \alpha $ 。PID控制和ADRC控制仿真参数如表2所示。为了保证仿真结果的客观性，PID控制的参数按照文献[8]中提出的等效PID的参数整定，ADRC按照文献[16]中方法得到。

为了得到准确的结果，仿真中改进方法的参数 $ {r_0} $ 、 $ {h_0} $ 、 $ {w_0} $ 、 $ {w_c} $ 、 $ {b_0} $ 保持与ADRC控制器参数一致。为了简化调参过程，高斯函数中心矢量 $ {{\boldsymbol{c}}_{ij}} $ 取为零向量，基宽向量 $ {{\boldsymbol{b}}_j} $ 取为单位向量，学习率 $ \alpha = 1.0 $ 。RBFNN隐含层有5个节点，即采用2–5–1结构。

3.1 不同阶跃输入姿态控制仿真实验

为了比较不同阶跃输入下控制器的响应性能，设计了AUV航向角跟踪控制仿真实验。仿真时间总长150 s，分别于0 s、20 s、40 s、90 s时输入幅值为 $ 10^\circ $ 、 $ - 23.5^\circ $ 、 $ 30^\circ $ 、 $ - 40^\circ $ 的阶跃输入信号，输入幅值根据控制超调量10%得到，以便比较。

3.1.1 不含外部扰动时的仿真实验结果

仿真中采用的参数在阶跃输入为 $ 10^\circ $ 时整定，不含外部扰动时的航向角跟踪控制仿真实验的结果如图5所示。ADRC和ADRC+RBFNN控制方法对 $ {v_1} $ 和 $ {v_2} $ 的估计误差分别如图6和图7所示。

根据仿真结果可以发现，基于ADRC的方法可以取得与PID近似的效果，且在20 s之前对信号的观测误差比较小，说明控制器此时可以准确的观测模型不确定部分和各通道耦合部分。

阶跃输入幅值和过渡过程的不同会影响ADRC的控制效果，结果是当阶跃值增加到 $ 23.5^\circ $ 时，传统ADRC控制存在13.3%的超调量，而ADRC+RBFNN控制超调量很小，对 $ {v_1} $ 和 $ {v_2} $ 的观测误差较小。当阶跃值为 $ 30^\circ $ 时，改进后方法超调量为17.2%，观测误差不存在振荡，而且能够更快稳定。当阶跃值为 $ 40^\circ $ 时，改进后方法的控制效果也具有明显的优势。

仿真结果说明ADRC+RBFNN方法在不同阶跃信号输入时，对内部扰动和系统状态估计具有自适应能力，能够保证更大范围的稳定性，简化了控制器参数整定过程。

3.1.2 含外部扰动时的仿真实验结果

根据文献[17]，外部扰动 $ w $ 包括控制端扰动和反馈信号噪声2种。本次实验中控制端扰动是幅值为 $ 6^\circ $ ，周期为10 s的正弦信号，反馈噪声是均值为 $ 0.5^\circ $ 的高斯白噪声信号。含外部扰动时的航向角根踪控制仿真实验结果如图8所示，改进前后控制方法对 $ {v_1} $ 和 $ {v_2} $ 的估计误差分别如图9和图10所示，图11为两者对控制端扰动的估计误差对比。

由图8可知，ADRC控制相对PID具有更好的抗扰动效果，可以更快稳定，但是随着阶跃值的增加，原始ADRC控制发生一定程度的振荡。图9和图10说明此时ADRC对总扰动的估计出现较大误差，图11说明其对控制端扰动的估计出现较大的误差。反观ADRC+RBFNN方法，虽然也会受到阶跃变化的影响，但是总体超调量小于原始ADRC方法，且对扰动和状态量的估计误差能够迅速收敛。

仿真结果说明，相比ADRC控制，本文改进方法能够更好适应不同阶跃输入的变化，对总扰动的估计更加准确，提高了控制器的稳定性和抗干扰能力。

3.2 不同采样频率姿态控制仿真实验

由于采样频率会影响扩张状态观测器的效果，而AUV属于大惯性系统，实际平台中的采样频率比较低，有明显的离散特性。为了比较不同采样频率对改进前后控制方法的影响，设计仿真实验。选择采样频率分别为50 Hz、20 Hz、10 Hz，对比控制器的效果，仿真结果如图12所示。

仿真结果说明改进后的ADRC+RBFNN控制器在低采样频率下依然能够取得理想的控制效果，进而可以通过嵌入式系统硬件和工业软件组件的方式在实际AUV平台中实现，具有很大的工程应用潜力。

4 结　语

针对AUV作业过程中存在的环境干扰，为了提高在不同阶跃输入和采样频率下的扰动观测能力和抗干扰能力，本文提出一种基于RBF神经网络补偿的新型自抗扰控制方法。在线性ADRC控制的基础上，将自适应RBF神经网络应用于改进扩张状态观测器，提升了扰动估计的快速性、准确性。仿真实验证明，改进后的ADRC在不同阶跃输入下对扰动和系统状态的观测更加准确，控制器跟踪航向角能够更快达到稳定值，且适用于低采样频率。

后续工作将重点研究本文方法在AUV平台中的应用问题，通过水池和开放水域实验验证本文提出方法的有效性。