CN105843233A - 一种基于非线性观测器的自主水下航行器运动控制方法 - Google Patents

Abstract

一种基于非线性观测器的自主水下航行器运动控制方法，涉及自主水下航行器(AUV)运动控制技术领域。本发明是为了增强自主水下航行器对环境扰动的鲁棒性，提供控制系统的动态性能指标。包括以下步骤：步骤1、建立自主水下航行器的六自由度数学模型；步骤2、设计跟踪微分器获取期望位置信息的跟踪信息以及微分信息；步骤3、设计非线性观测器利用传感器测量得到的位置信息观测出自主水下航行器的速度、干扰状态信息；步骤4、设计控制器利用跟踪微分器以及非线性观测器获得的信息得到执行机构所需控制量；步骤5、执行机构作用于受控对象自主水下航行器，使自主水下航行器运动到设定的期望位置。本发明适用于自主水下航行器运动控制。

Description

一种基于非线性观测器的自主水下航行器运动控制方法

技术领域

本发明涉及自主水下航行器(AUV)运动控制技术领域。

背景技术

自主水下航行器可以在水下承担情报收集、侦察、反潜、水下武器对抗、应急救生与打捞、危险条件下作业等多种任务，被广泛应用于军事、海洋环境勘测、海底资源开发等领域。自主水下航行器在水下自治工作，具有水下活动范围大、机动性好、安全、结构简单等优点，成为当前世界各国海洋开发、国防工业部门、和海洋装备的最重要研究方向之一。

自主水下航行器要实现在水下自治式工作，其最主要的设计部分为控制系统的设计，高性能高精度的运动控制是提升自主水下航行器行为能力的重要指标之一。随着对自主水下航行器控制系统性能指标的要求越来越高，自主水下航行器已经从单纯的反馈控制发展为非线性、鲁棒、智能控制等先进控制方法的阶段。自主水下航行器是一个强耦合、存在模型参数摄动、易受外界环境干扰力影响的强非线性系统，需要采用高效的控制策略方能满足其对高精度控制性能指标的需求。非线性观测器是提高耦合、扰动系统鲁棒性的有效手段，已被广泛应用于船舶动力定位系统、磁悬浮列车悬浮系统、机器人关节伺服控制系统等，以实现高速、高精度的跟踪控制、定位控制等目标。非线性观测器利用有效的测量状态，实现状态反馈控制中所需的不可测状态的观测，估计环境干扰力并对环境干扰力进行补偿，以提升系统的控制性能。同时，非线性观测器对由测量元件引入的测量噪声还具有较好的滤波效果。

因此，设计一种基于非线性观测器的自主水下航行器运动控制方法具有重要的作用价值。

发明内容

本发明是为了增强自主水下航行器对环境扰动的鲁棒性，提供控制系统的动态性能指标，从而提供一种基于非线性观测器的自主水下航行器运动控制方法。

一种基于非线性观测器的自主水下航行器运动控制方法，它包括以下步骤：

步骤一、建立自主水下航行器的六自由度数学模型；

自主水下航行器的数学模型建立在北东坐标系和运动坐标系下，在北东坐标系下定义其位置矢量，运动坐标系下定义其广义速度矢量；建立在两坐标系下的运动学和动力学数学模型为：

$\{\begin{array}{c}\stackrel{\·}{\mathrm{\η}}=J\left(\mathrm{\Θ}\right)V\\ M\stackrel{\·}{V}=-C_{RB}\left(V\right)V-C_A\left(V\right)V-D\left(V\right)V-g\left(\mathrm{\Θ}\right)+b+\mathrm{\τ}\end{array}---\left(1\right)$

其中，η为定义在固定坐标系下自主水下航行器的位置矢量矩阵，V为定义在运动坐标系下自主水下航行器的广义速度矢量矩阵，J(Θ)为自主水下航行器在北东坐标系下的速度与运动坐标系下的广义速度之间的转换矩阵，M为惯性矩阵，C_RB(V)为刚体科里奥利向心力矩阵，C_A(V)为流体产生的科里奥利向心力矩阵，D(V)为阻尼力矩阵，g(Θ)为重力和浮力产生的阿基米德回复力和力矩矩阵，b为环境干扰力矩阵，τ为控制输入；

步骤二、利用跟踪微分器获取期望位置信息的跟踪信息以及微分信息；

步骤三、利用非线性Luenberger观测器利用传感器测量得到的位置信息观测出自主水下航行器的速度和干扰状态信息；

步骤四、控制器利用跟踪微分器以及非线性Luenberger观测器获得的信息得到执行机构所需控制量；

步骤五、执行机构作用于受控对象自主水下航行器，使自主水下航行器运动到设定的期望位置，完成一次自主水下航行器运动控制。

步骤二至四为基于非线性Luenberger观测器的自主水下航行器定深控制步骤，具体为：

步骤A、跟踪微分器对期望深度指令进行微分，得到期望指令的跟踪信息x和微分信息v；

步骤B、非线性Luenberger观测器利用传感器测量得到的位置信息η观测出航行器在运动坐标系下的广义速度V；

步骤C、三阶非线性扩张状态观测器利用非线性Luenberger观测器观测到的深度信息观测出航行器的深度z₁以及定义在北东坐标系下的下潜速度

步骤D、将跟踪微分器获得的期望深度跟踪信息x和微分信息v分别与三阶非线性扩张状态观测器观测到的深度信息z₁以及定义在北东坐标系下的下潜速度的差值作为控制器的比例和微分输入，经非线性PD控制率获得输出控制信号u₀；把非线性Luenberger观测器观测到的下潜速度信息作为二阶非线性扩张状态观测器的输入，观测出航行器在下潜方向的总扰动；

步骤E、将控制信号u₀与总扰动的差值作为最后升降舵的控制输入u。

步骤B中所述的非线性Luenberger观测器为：

$\left\{\begin{array}{c}\stackrel{\·}{\widehat{\mathrm{\η}}}=J\left(\mathrm{\θ}\right)\hat{V}+L\widetilde{\mathrm{\η}}\\ M\stackrel{\·}{\hat{V}}=-C_{RB}\left(\hat{V}\right)\hat{V}-C_A\left(\hat{V}\right)\hat{V}-D\left(\hat{V}\right)\hat{V}-g\left(\mathrm{\θ}\right)+\hat{b}+\mathrm{\τ}+{\mathrm{MJ}}^T\left(\mathrm{\θ}\right)K\widetilde{\mathrm{\η}}\\ \stackrel{\·}{\hat{b}}=\mathrm{\β}fal(\widetilde{\mathrm{\η}},\mathrm{\α},\mathrm{\δ})\end{array}\right.---\left(2\right)$

其中，β为非线性扩张观测器的可调参数；g(θ)为重力加速度分量；为对η的观测值，为对V的观测值，为对环境干扰b的观测值，为位置观测误差；

为饱和函数，其具体形式如下：

$fal(\widetilde{\mathrm{\η}},\mathrm{\α},\mathrm{\δ})=\left\{\begin{array}{c}\frac{\widetilde{\mathrm{\η}}}{{\mathrm{\δ}}^{\mathrm{\α}-1}},\left|\widetilde{\mathrm{\η}}\right|\≤\mathrm{\δ}\\ {\left|\widetilde{\mathrm{\η}}\right|}^{\mathrm{\α}}sign\left(\widetilde{\mathrm{\η}}\right),\left|\widetilde{\mathrm{\η}}\right|>\mathrm{\δ}\end{array}\right.---\left(3\right)$

α和δ为饱和函数的待设计参数。

步骤C中，三阶非线性扩张状态观测器为：

$\left\{\begin{array}{c}e=z_1-\hat{z}\\ {\stackrel{\·}{z}}_1=z_2-{\mathrm{\β}}_{1}e\\ {\stackrel{\·}{z}}_2=z_3-{\mathrm{\β}}_{2}fal(e,{\mathrm{\α}}_1,\mathrm{\δ})+bu\\ {\stackrel{\·}{z}}_3=-{\mathrm{\β}}_{3}fal(e,{\mathrm{\α}}_2,\mathrm{\δ})\end{array}\right.---\left(4\right)$

其中，e为下潜深度观测误差；；为非线性Luenberger观测器观测出的下潜位移状态，z₁为对的观测值，z₂为对的观测值；z₃为对下潜方向所受总和干扰的估计值；β₁、β₂、β₃为非线性扩张观测器的可调参数。

步骤D中，二阶非线性扩张状态观测器为：

$\left\{\begin{array}{c}{e}_v=z_{11}-\hat{w}\\ {\stackrel{\·}{z}}_{11}=z_{22}-{\mathrm{\β}}_{11}{e}_v+bu\\ {\stackrel{\·}{z}}_{22}=-{\mathrm{\β}}_{22}fal(e_v,{\mathrm{\α}}_2,\mathrm{\δ})\end{array}\right.---\left(5\right)$

其中，e_v为下潜速度观测误差；为非线性Luenberger观测器观测出的下潜速度状态，z₁₁为对的观测值，z₂₂为对下潜方向总干扰的观测值；β₁₁、β₁₂为非线性扩张观测器的可调参数。

步骤四中所述的控制器为非线性PD控制器：

u₀＝k_pfal(e₁,α_p,δ_k)+k_dfal(e₂,α_d,δ_k) (6)

其中，α_p、α_d、δ_k为饱和函数的待设计参数，e₁＝x-z₁，e₂＝v-z₂，k_p、k_d为控制器的比例和微分设计参数。

步骤E中最后升降舵的控制输入u为：

u＝u₀-z₂₂/b (7)

其中，u₀为纵向速度控制常量；z₂₂为非线性Luenberger观测器对自主水下航行器定深控制方向总扰动的观测值，b为环境干扰力矩阵。

本发明通过非线性Luenberger观测器实现对自主水下航行器速度、总扰动的准确观测，通过控制率对总扰动的实时补偿，使受控对象成为积分串联型系统，不仅提高了控制系统的动态性能指标，而且增强了系统对环境扰动、模型参数摄动的鲁棒性。

附图说明

图1是基于非线性Luenberger观测器系统的自主水下航行器垂直面控制系统结构示意图；

图2是控制系统的控制流程示意图；

图3是非线性Luenberger观测器对自主水下航行器下潜位移、纵倾角实际值与观测值曲线仿真示意图；

图4是非线性Luenberger观测器对自主水下航行器下潜速度、纵倾角速度实际值与观测值曲线仿真示意图；

图5是非线性Luenberger观测器对两坐标系下自主水下航行器下潜速度观测值曲线仿真示意图；

图6是非线性Luenberger观测器对自主水下航行器垂荡方向总和干扰观测值曲线仿真示意图；

图7是PID和基于非线性Luenberger观测器的自抗扰控制下自主水下航行器升降舵舵角曲线仿真示意图；

图8是PID和基于非线性Luenberger观测器的自抗扰控制下自主水下航行器下潜位移响应曲线仿真示意图；

图9是非线性Luenberger观测器对含测量噪声影响的测量值滤波效果曲线仿真示意图；

具体实施方式

具体实施方式一、一种基于非线性观测器的自主水下航行器运动控制方法，本发明以自主水下航行器定深控制为研究对象，提出了一种基于非线性观测器的自主水下航行器运动控制方法。该控制系统中非线性Luenberger观测器不仅可以对系统的全维状态进行观测，而且可以估计出系统的总和扰动，同时对由测量元件引入的测量噪声有着较好的滤波效果。

下面结合附图对本发明作进一步详细说明。

(1)、考虑实际受控对象的特点，建立自主水下航行器的数学模型；

自主水下航行器是一个空间的六自由度运动载体，为方便描述其运动，其数学模型通常建立在北东坐标系和运动坐标系下。在北东坐标系下定义其位置矢量，运动坐标系下定义其广义速度矢量。建立在两坐标系下的运动学和动力学数学模型为：

$\{\begin{array}{c}\stackrel{\·}{\mathrm{\η}}=J\left(\mathrm{\Θ}\right)V\\ M\stackrel{\·}{V}=-C_{RB}\left(V\right)V-C_A\left(V\right)V-D\left(V\right)V-g\left(\mathrm{\Θ}\right)+b+\mathrm{\τ}\end{array}---\left(1\right)$

其中，η为定义在固定坐标系下自主水下航行器的位置矢量矩阵，V为定义在运动坐标系下自主水下航行器的广义速度矢量矩阵，J(Θ)为自主水下航行器在北东坐标系下的速度与运动坐标系下的广义速度之间的转换矩阵，M为惯性矩阵，C_RB(V)为刚体科里奥利向心力矩阵，C_A(V)为流体产生的科里奥利向心力矩阵，D(V)为阻尼力矩阵，g(Θ)为重力和浮力产生的阿基米德回复力和力矩矩阵，b为环境干扰力矩阵，τ为控制输入。

(2)、建立基于非线性Luenberger观测器的自主水下航行器定深控制系统设计方案；

本发明中，自主水下航行器的位置矢量由传感器测量得到。控制系统的基本控制结构及控制系统工作流程图如图1和2所示：跟踪微分器对期望深度指令进行微分，得到期望指令的跟踪信息x和微分信息v；非线性Luenberger观测器利用传感器测量得到的位置信息η观测出航行器在运动坐标系下的广义速度V；三阶非线性扩张状态观测器利用非线性Luenberger观测器观测到的深度信息观测出航行器的深度z₁以及定义在北东坐标系下的下潜速度将跟踪微分器获得的期望深度跟踪信息x和微分信息v分别与三阶非线性扩张状态观测器观测到的深度信息z₁以及定义在北东坐标系下的下潜速度的差值作为控制器的比例和微分输入，经非线性PD控制率获得输出控制信号u₀；把非线性Luenberger观测器观测到的下潜速度信息作为二阶非线性扩张状态观测器的输入，观测出航行器在下潜方向的总扰动；将控制信号u₀与总扰动的差值作为最后升降舵的控制输入u。

(3)、非线性Luenberger观测器的设计：

设计非线性Luenberger观测器的目的是为了观测出航行器在北东坐标系下的下潜速度信息以及深度控制方向的总扰动。要想观测出航行器在深度控制方向的总扰动，首先要获得航行器在运动坐标系下的广义下潜速度信息。

a、为获得航行器在运动坐标系下的广义下潜速度信息，对自主水下航行器的运动数学模型(1)设计如下形式的非线性Luenberger观测器：

$\left\{\begin{array}{c}\stackrel{\·}{\widehat{\mathrm{\η}}}=J\left(\mathrm{\θ}\right)\hat{V}+L\widetilde{\mathrm{\η}}\\ M\stackrel{\·}{\hat{V}}=-C_{RB}\left(\hat{V}\right)\hat{V}-C_A\left(\hat{V}\right)\hat{V}-D\left(\hat{V}\right)\hat{V}-g\left(\mathrm{\θ}\right)+\hat{b}+\mathrm{\τ}+{\mathrm{MJ}}^T\left(\mathrm{\θ}\right)K\widetilde{\mathrm{\η}}\\ \stackrel{\·}{\hat{b}}=\mathrm{\β}fal(\widetilde{\mathrm{\η}},\mathrm{\α},\mathrm{\δ})\end{array}\right.---\left(2\right)$

其中，为对η的观测值，为对V的观测值，为对环境干扰b的观测值，为位置观测误差。为饱和函数，其具体形式如下：

$fal(\widetilde{\mathrm{\η}},\mathrm{\α},\mathrm{\δ})=\left\{\begin{array}{c}\frac{\widetilde{\mathrm{\η}}}{{\mathrm{\δ}}^{\mathrm{\α}-1}},\left|\widetilde{\mathrm{\η}}\right|\≤\mathrm{\δ}\\ {\left|\widetilde{\mathrm{\η}}\right|}^{\mathrm{\α}}sign\left(\widetilde{\mathrm{\η}}\right),\left|\widetilde{\mathrm{\η}}\right|>\mathrm{\δ}\end{array}\right.---\left(3\right)$

α和δ为饱和函数的待设计参数。

非线性Luenberger观测器(2)利用系统的标称模型信息重构了原系统，当趋于零时，即可实现对原系统位置、广义速度以及环境干扰的观测。

附图3和4给出了非线性Luenberger观测器对自主水下航行器下潜位移、纵倾角、下潜速度以及纵倾角速度的实际值与观测值曲线，附图9为含测量噪声影响的位置测量值及其经非线性Luenberger观测器滤波后的观测值曲线。可见，非线性Luenberger观测器不仅可以较准确的实现对自主水下航行器位置、广义速度状态的实时观测，还具有较好的滤波效果。

b、为获得控制器所需自主水下航行器在北东坐标系下的实际下潜速度，设计三阶非线性扩张状态观测器：

$\left\{\begin{array}{c}e=z_1-\hat{z}\\ {\stackrel{\·}{z}}_1=z_2-{\mathrm{\β}}_{1}e\\ {\stackrel{\·}{z}}_2=z_3-{\mathrm{\β}}_{2}fal(e,{\mathrm{\α}}_1,\mathrm{\δ})+bu\\ {\stackrel{\·}{z}}_3=-{\mathrm{\β}}_{3}fal(e,{\mathrm{\α}}_2,\mathrm{\δ})\end{array}\right.---\left(4\right)$

其中，为非线性Luenberger观测器观测出的下潜位移状态，z₁为对的观测值，z₂为对的观测值。可见，三阶非线性扩张状态观测器观测出的速度状态与位置状态是定义在北东坐标系下的。

附图5给出了三阶非线性扩张状态观测器和非线性Luenberger观测器对固定坐标系中下潜速度和运动坐标系中下潜速度的观测值，可见，两者是完全不同的，三阶非线性扩张状态观测器的观测值可以作为设计控制器所需的速度反馈状态。

c、未知扰动是影响被控对象控制系统性能的一个重要因素，如能对系统的扰动进行观测并进行实时补偿，将会大大提高系统的控制性能。非线性扩张状态观测器可以将作用于系统的外界干扰、未建模扰动以及系统的已建模确知部分归结为系统的总扰动进行观测，将观测到的总扰动进行实时补偿，便可以将复杂被控系统转变为简单的积分串联型系统。为获得航行器在定深控制方向的总扰动，设计如下形式的二阶非线性扩张状态观测器：

$\left\{\begin{array}{c}{e}_v=z_{11}-\hat{w}\\ {\stackrel{\·}{z}}_{11}=z_{22}-{\mathrm{\β}}_{11}{e}_v+bu\\ {\stackrel{\·}{z}}_{22}=-{\mathrm{\β}}_{22}fal(e_v,{\mathrm{\α}}_2,\mathrm{\δ})\end{array}\right.---\left(5\right)$

其中，为非线性Luenberger观测器观测出的下潜速度(运动坐标系)状态，z₁₁为对的观测值，z₂₂为对下潜方向总干扰的观测值。由二阶非线性扩张状态观测器(5)可得：只要观测误差e_v趋于零，z₁₁便趋向于z₂₂趋向于下潜方向的总扰动。

附图6为三阶非线性扩张状态观测器和二阶非线性扩张状态观测器对自主水下航行器下潜方向总扰动的观测曲线，在150-200秒加入幅值为250N的白噪声信号来模拟外界环境干扰对自主水下航行器的影响，可见，两观测器对总扰动的观测值有着很大的差别，二阶非线性扩张状态观测器对垂荡方向总扰动的观测比较精确。

(4)控制器的设计：

设计非线性PD控制器：

u₀＝k_pfal(e₁,α_p,δ_k)+k_dfal(e₂,α_d,δ_k) (6)

其中，α_p、α_d、δ_k为饱和函数的待设计参数，e₁＝x-z₁，e₂＝v-z₂，k_p、k_d为控制器的比例和微分设计参数。为实现系统对非线性Luenberger观测器观测总扰动的补偿，最终升降舵所获得的控制输入为：

u＝u₀-z₂₂/b (7)

其中，z₂₂为非线性Luenberger观测器对自主水下航行器定深控制方向总扰动的观测值，b为环境干扰力参数。

附图7和8分别给出了传统PID控制和基于非线性Luenberger观测器的非线性PD控制下自主水下航行器的升降舵舵角和下潜深度响应曲线。

由附图7可见，基于非线性Luenberger观测器的控制方法相对于传统PID控制，自主水下航行器升降舵舵角的幅度明显减小，有利于减小执行机构的磨损。

由附图8可见，对自主水下航行器垂直面的运动控制，基于非线性Luenberger观测器的控制方法相对于传统PID控制，系统超调明显减小，对外界环境扰动能够做出较快的相应。控制系统中通过加入非线性Luenberger观测器，有利于改善控制系统的动态性能指标，增强了系统对外界环境扰动的鲁棒性。

Claims (7)

1.一种基于非线性观测器的自主水下航行器运动控制方法，其特征是：它包括以下步骤：

步骤一、建立自主水下航行器的六自由度数学模型；

自主水下航行器的数学模型建立在北东坐标系和运动坐标系下，在北东坐标系下定义其位置矢量，运动坐标系下定义其广义速度矢量；建立在两坐标系下的运动学和动力学数学模型为：

$\left\{\begin{array}{c}\stackrel{\·}{\mathrm{\η}}=J\left(\mathrm{\Θ}\right)V\\ M\stackrel{\·}{V}=-C_{RB}\left(V\right)V-C_A\left(V\right)V-D\left(V\right)V-g\left(\mathrm{\Θ}\right)+b+\mathrm{\τ}\end{array}\right.---\left(1\right)$

其中，η为定义在固定坐标系下自主水下航行器的位置矢量矩阵，V为定义在运动坐标系下自主水下航行器的广义速度矢量矩阵，J(Θ)为自主水下航行器在北东坐标系下的速度与运动坐标系下的广义速度之间的转换矩阵，M为惯性矩阵，C_RB(V)为刚体科里奥利向心力矩阵，C_A(V)为流体产生的科里奥利向心力矩阵，D(V)为阻尼力矩阵，g(Θ)为重力和浮力产生的阿基米德回复力和力矩矩阵，b为环境干扰力矩阵，τ为控制输入；

步骤二、利用跟踪微分器获取期望位置信息的跟踪信息以及微分信息；

步骤三、利用非线性Luenberger观测器利用传感器测量得到的位置信息观测出自主水下航行器的速度和干扰状态信息；

步骤四、控制器利用跟踪微分器以及非线性Luenberger观测器获得的信息得到执行机构所需控制量；

步骤五、执行机构作用于受控对象自主水下航行器，使自主水下航行器运动到设定的期望位置，完成一次自主水下航行器运动控制。

2.根据权利要求1所述的一种基于非线性观测器的自主水下航行器运动控制方法，其特征在于步骤二至四为基于非线性观测器的自主水下航行器定深控制步骤，具体为：

步骤A、跟踪微分器对期望深度指令进行微分，得到期望指令的跟踪信息x和微分信息v；

步骤B、非线性Luenberger观测器利用传感器测量得到的位置信息η观测出航行器在运动坐标系下的广义速度V；

步骤C、三阶非线性扩张状态观测器利用非线性Luenberger观测器观测到的深度信息观测出航行器的深度z₁以及定义在北东坐标系下的下潜速度

步骤D、将跟踪微分器获得的期望深度跟踪信息x和微分信息v分别与三阶非线性扩张状态观测器观测到的深度信息z₁以及定义在北东坐标系下的下潜速度的差值作为控制器的比例和微分输入，经非线性PD控制率获得输出控制信号u₀；把非线性Luenberger观测器观测到的下潜速度信息作为二阶非线性扩张状态观测器的输入，观测出航行器在下潜方向的总扰动；

步骤E、将控制信号u₀与总扰动的差值作为最后升降舵的控制输入u。

3.根据权利要求2所述的一种基于非线性Luenberger观测器的自主水下航行器运动控制方法，其特征在于步骤B中所述的非线性Luenberger观测器为：

$\left\{\begin{array}{c}\stackrel{\·}{\widehat{\mathrm{\η}}}=J\left(\mathrm{\θ}\right)\hat{V}+L\widetilde{\mathrm{\η}}\\ M\stackrel{\·}{\hat{V}}=-C_{RB}\left(\hat{V}\right)\hat{V}-C_A\left(\hat{V}\right)\hat{V}-D\left(\hat{V}\right)\hat{V}-g\left(\mathrm{\θ}\right)+\hat{b}+\mathrm{\τ}+{\mathrm{MJ}}^T\left(\mathrm{\θ}\right)K\widetilde{\mathrm{\η}}\\ \stackrel{\·}{\hat{b}}=\mathrm{\β}fal(\widetilde{\mathrm{\η}},\mathrm{\α},\mathrm{\β})\end{array}\right.---\left(2\right)$

其中，β为非线性扩张观测器的可调参数；g(θ)为重力加速度分量；为对η的观测值，为对V的观测值，为对环境干扰b的观测值，为位置观测误差；

为饱和函数，其具体形式如下：

$fal(\widetilde{\mathrm{\η}},\mathrm{\α},\mathrm{\δ})=\left\{\begin{array}{c}\frac{\widetilde{\mathrm{\η}}}{{\mathrm{\δ}}^{\mathrm{\α}-1}},\left|\widetilde{\mathrm{\η}}\right|\≤\mathrm{\δ}\\ {\left|\widetilde{\mathrm{\η}}\right|}^{\mathrm{\α}}sign\left(\widetilde{\mathrm{\η}}\right),\left|\widetilde{\mathrm{\η}}\right|>\mathrm{\δ}\end{array}\right.---\left(3\right)$

α和δ为饱和函数的待设计参数。

4.根据权利要求3所述的一种基于非线性观测器的自主水下航行器运动控制方法，其特征在于步骤C中，三阶非线性扩张状态观测器为：

$\left\{\begin{array}{c}e=z_1-\hat{z}\\ {\stackrel{\·}{z}}_1=z_2-{\mathrm{\β}}_{1}e\\ {\stackrel{\·}{z}}_2=z_3-{\mathrm{\β}}_{2}fal(e,{\mathrm{\α}}_1,\mathrm{\δ})+bu\\ {\stackrel{\·}{z}}_3=-{\mathrm{\β}}_{3}fal(e,{\mathrm{\α}}_2,\mathrm{\δ})\end{array}\right.---\left(4\right)$

其中，e为下潜深度观测误差；为非线性Luenberger观测器观测出的下潜位移状态，z₁为对的观测值，z₂为对的观测值，z₃为对下潜方向所受总和干扰的估计值；β₁、β₂、β₃为非线性扩张观测器的可调参数。

5.根据权利要求4所述的一种基于非线性观测器的自主水下航行器运动控制方法，其特征在于步骤D中，二阶非线性扩张状态观测器为：

$\left\{\begin{array}{c}{e}_v=z_{11}-\hat{w}\\ {\stackrel{\·}{z}}_{11}=z_{22}-{\mathrm{\β}}_{11}{e}_v+bu\\ {\stackrel{\·}{z}}_{22}=-{\mathrm{\β}}_{22}fal(e_v,{\mathrm{\α}}_2,\mathrm{\δ})\end{array}\right.---\left(5\right)$

其中，e_v为下潜速度观测误差；为非线性Luenberger观测器观测出的下潜速度状态，z₁₁为对的观测值，z₂₂为对下潜方向总干扰的观测值；β₁₁、β₁₂为非线性扩张观测器的可调参数。

6.根据权利要求5所述的一种基于非线性观测器的自主水下航行器运动控制方法，其特征在于步骤四中所述的控制器为非线性PD控制器：

u₀＝k_pfal(e₁,α_p,δ_k)+k_dfal(e₂,α_d,δ_k) (6)

其中，α_p、α_d、δ_k为饱和函数的待设计参数，e₁＝x-z₁，e₂＝v-z₂，k_p、k_d为控制器的比例和微分设计参数。

7.根据权利要求6所述的一种基于非线性观测器的自主水下航行器运动控制方法，其特征在于步骤E中最后升降舵的控制输入u为：

u＝u₀-z₂₂/b (7)

其中，u₀为纵向速度控制常量；z₂₂为非线性观测器对自主水下航行器定深控制方向总扰动的观测值，b为环境干扰力矩阵。