[发明专利]基于自主水下机器人航向运动的动态状态反馈控制方法

权利要求书

1.一种基于自主水下机器人航向运动的动态状态反馈控制方法，其特征在于：动态调整状态反馈控制参数，消弱自主水下机器人纵向速度对其航向运动的耦合影响，提高自主水下机器人系统抗干扰能力与自适应于被控对象能力，控制方法通用性强，且只有两控制参数k_r k_ψ，该方法包含以下步骤：

(1)构建自主水下机器人系统航向运动模型，根据自主水下机器人系统航向运动控制特点，构建航向运动状态方程

(2)根据能控性判据知系统完全能控，可实现极点的任意配置，预设期望极点为λ_r、λ_ψ，从而得到加入状态反馈后，系统期望特征方程为E(λ)＝λ²-(λ_r+λ_ψ)λ+λ_rλ_ψ；

(3)设置待求控制参数k_r k_ψ构建状态反馈控制律δ_r(t)＝k_re_r+k_ψe_ψ，将控制律代入条件(1)中航向运动状态方程，得到加入控制律后的特征方程为E(λ)＝λ²-(a+bk_r)λ-bk_ψ；

(4)对比条件(2)的期望特征方程与条件(3)的加入状态反馈控制律的特征方程，可得控制参数k_r k_ψ为

(5)确定状态反馈控制律

ψ——为自主水下机器人航向角，单位度；

r——为航向角速度，单位弧度/秒；

e_ψ——为自主水下机器人航向角误差即实际航向角与期望航向角的差，单位度；

e_r——为自主水下机器人航向角速度误差即实际航向角速度与期望航向角速度的差，单位度；

N_r——系统非线性水动力系数，无单位；

N_δ——系统非线性水动力系数，无单位；

——加速度水动力参数，无单位；

I_zz——转动惯量，无单位；

a——无单位；

b——无单位；

u——为纵向速度，单位米/秒；

λ——为特征方程算子，无单位；

λ_r——为特征方程一期望极点，具有负实部，无单位；

λ_ψ——为特征方程一期望极点，具有负实部，无单位；

k_r——为状态反馈控制律一控制参数，随着纵向速度与模型参数变化，无单位；

k_ψ——为状态反馈控制律一控制参数，随着纵向速度与模型参数变化，无单位；

δ_r——为状态反馈控制律，物理表述为自主水下机器人系统垂直舵输出角度，随着纵向速度与模型参数变化而变化，单位度。

2.根据权利要求1所述的基于自主水下机器人航向运动的动态状态反馈控制方法，其特征在于：所述的两控制参数k_r k_ψ实现纵向速度动态调整，通过以下方法得到：

权利要求1条件(2)的期望特征方程与权利要求1条件(3)的特征方程联立E(λ)＝λ²-(λ_r+λ_ψ)λ+λ_rλ_ψ＝λ²-(a+bk_r)λ-bk_ψ根据方程两边对应系数相等，推出

3.根据权利要求1所述的基于自主水下机器人航向运动的动态状态反馈控制方法，其特征在于：控制参数所含动态量的约束条件；所述的两系数a，b描述知控制参数k_r k_ψ随着纵向速度变化而变化，其主要表现为控制参数所含两系数与均包含纵向速度；控制参数分母b含有纵向速度，为了避免由于纵向速度过低导致控制参数过大，造成系统控制执行机构垂直舵长时间处于满舵状态，本发明对两控制参数所含纵向速度进行约束，约束条件为适用于动态反馈控制律δ_r(t)。