一种水下机器人的自适应运动控制装置及其方法与流程

本发明属于水下机器人运动控制技术领域，涉及一种多执行机构水下机器人的自适应运动控制；具体涉及一种水下机器人自适应运动控制装置；还涉及一种水下机器人自适应运动控制方法。

背景技术：

海洋蕴含着丰富的资源，目前合理利用、开发海洋资源对于人类社会的可持续发展将起到巨大的作用。水下机器人能够广泛应用于海洋救助与打捞、海洋石油开采、水下工程施工、深海资源调查、军事和国防建设等诸多方面，是人类进行深海资源的研究与开发的强有力的工具。水下机器人常常工作于复杂的水下环境中，受到水流、电磁等外部干扰的影响，其运动控制已成为当前的技术难题和热点问题之一。此外，由于工作在水下环境中，该类机器人的推进器和控制舵也常常呈现非线性特性和耦合特征，可能会降低运动控制的控制精度，甚至会引起系统失稳。

针对水下机器人的运动控制，人们已经提出了很多种控制方法。传统的PID控制方法具有结构简单、易于工程实现的优点，但是PID方法的参数难以调整，而且难以在复杂多变的环境下获得良好的控制效果。近年来，现代控制理论也在水下机器人的运动控制中取得了广泛应用。但是基于反馈线性化的控制方法算法较为复杂，会加重计算机的计算负担，难以在线实现。鲁棒控制方法虽然能够解决模型不确定性系统的控制问题，在保证系统稳定的同时能将干扰对系统性能的影响抑制在一定的水平之下。但是鲁棒方法的控制增益是根据不确定性的范数上界设计的，过于保守而且不能随着干扰变化而变化。

技术实现要素：

本发明提供了一种水下机器人自适应运动控制装置，能够保证机器人在水下复杂环境中实现期望的轨迹和姿态跟踪，同时很好的处理执行机构中存在的死区等非线性特性。

本发明还提供了一种水下机器人自适应运动控制方法，基于自适应思想和反步控制策略，能够对多推进水下机器人执行机构死区非线性，水下环境干扰和未建模动态进行有效抑制。

本发明的技术方案是：一种水下机器人自适应运动控制装置，包括内环控制模块和外环控制模块，外环控制模块对期望信号进行跟踪，内环控制模块对外环控制模块的虚拟控制律进行跟踪；所述外环控制模块中加入干扰补偿项和输入不确定性补偿项，外环控制模块基于模糊逻辑模块的模糊逻辑的和动态信号生成模块的动态信号构建非线性自适应补偿模块；其中基于非线性自适应补偿模块构建执行机构非线性模块，基于执行机构非线性模块构建水下机器人动力学模型，基于水下机器人动力学模型构建水下机器人运动学模型。

更进一步的，本发明的特点还在于：

其中外环控制模型中水下环境干扰自适应补偿模块完成干扰补偿项，通过非线性反馈模块完成输入不确定性补偿项。

其中水下环境干扰自适应补偿模块、非线性反馈模块、动态信号生成模块和模糊逻辑模块共同构建控制分配模块，并且基于控制分配模块构建非线性自适应补偿模块。

本发明的另一技术方案是：一种水下机器人自适应运动控制方法，包括以下步骤：步骤1，构建水下机器人的运动学模型和动力学模型，并且构建水下机器人执行机构的非线性死区特性；步骤2，对未建模动态进行补偿，生成非线性动态补偿信号，其中未建模状态满足输入状态稳定性；步骤3，构建外环控制律和内环控制律，并且基于模糊逻辑构建外环虚拟控制律；步骤4，对水下机器人多执行机构的虚拟控制量进行控制分配。

更进一步的，本发明的特点还在于：

其中步骤1中还包括建立未建模状态下的动态方程。

其中步骤3还包括根据内环跟踪误差建立内环跟踪误差的动态方程。

其中步骤4还包括通过自适应补偿项克服由其自身带来的输入不确定性。

与现有技术相比，本发明的有益效果是：本发明从多执行机构水下机器人的运动学动力学角度出发，在存在未建模动态以及执行机构非线性的情形下，能够实现水下机器人的运动控制；控制器结构简单，不需要水动力的精确参数，能够减轻机器人的运算负荷；同时，该运动控制方法能够克服水下环境中存在各种干扰力和力矩，具备较强的鲁棒性和自适应性。通过该控制方法，能够辅助水下机器人完成海洋救助与打捞、海洋石油开采等诸多任务。

附图说明

图1为本发明控制装置的结构示意图；

图2为本发明控制方法执行机构死区非线性示意图。

图中：1为内环控制模块；2为外环控制模块；3为执行机构非线性模型；4为水下机器人动力学模型；5为水下机器人运动学模型；6为水下环境干扰自适应补偿模块；7为非线性反馈模块；8为动态信号生成模块；9为模糊逻辑模块；10为控制分配模块；11为非线性自适应补偿模块。

具体实施方式

下面结合附图和具体实施例对本发明的技术方案进一步说明。

本发明提供了一种水下机器人自适应运动控制装置，如图1所示，包括内环控制模块1和外环控制模块2；其中外环控制模块2通过动态信号生成模块8、模糊逻辑模块9、水下环境干扰自适应补偿模块6和非线性反馈模块7建立控制分配模块10；其中基于动态信号生成模块8生成的动态信号和模糊逻辑模块9的模糊逻辑设计模糊自适应补偿器，对水下机器人动态方程中未建模动态进行补偿；其中基于水下环境干扰自适应补偿模块6和非线性反馈模块7，加入干扰补偿项和输入不确定性补偿项对干扰和执行机构死区引起的输入不确定性进行处理。

其中基于控制分配模块10构建非线性自适应补偿模块11，基于非线性自适应补偿模块11构建执行机构非线性模块3，基于执行机构非线性模块3构建水下机器人动力学模型4，基于水下机器人动力学模型4构建水下机器人运动学模型5。

本发明还提供了一种水下机器人自适应运动控制方法，改方法基于自适应反步思想和非线性动态信号。其具体实施过程包括以下步骤：

步骤1，构建多执行机构水下机器人的运动学模型和动力学模型，并且构建水下机器人执行机构的非线性死区特性；其中多执行机构水下机器人的运动学动力学模型可以构建为：

其中M为惯性矩阵，C(v)为科氏力和向心力矩阵，D(v)为水动力矩阵，g(η)为恢复力和力矩向量，N为执行机构个数，τd为外部干扰力和力矩，J(η)为转换矩阵，η表示水下机器人的位置和姿态向量，表示水下机器人的速度向量。表示水下机器人的第j个执行机构的控制输出向量，Bj表示第j个执行机构的控制分布矩阵。τ＝[τ1^T,τ2^T,…,τN^T]^T。

为未建模的状态，代表由未建模动态引起的动态不确定性。未建模状态具有以下动态方程：

一般而言，存在未知光滑函数和满足：

考虑到水下执行机构工作时的复杂状况，将水下机器人执行机构的非线性死区特性构建如下：

其中mj,i,l(t)和mj,i,r(t)分别为第j个舵的第i个分量的死区特性的左右斜率；如图2所示，δj,i,l和δj,i,r分别为死区非线性的左右折点，τj,i,0(t)为该舵系统的输入，τj,i(t)为该舵系统的输出。定义：

则有：τj,i(t)＝hj,i(t)τj,i,0(t)+δj,i(t) (6)

定义τj,0＝[τj,1,0,τj,2,0,…,τj,n,0]^T，hj＝[hj,1,hj,2,…,hj,n]^T,δj＝[δj,1,δj,2,…,δj,n]^T，那么方程(1)可以写为：

步骤2，未建模动态进行补偿，生成非线性动态补偿信号；其中未建模状态满足输入状态稳定性，因此存在Vω(ω)满足：

α1(ω)≤Vω(ω)≤α2(ω)

为了对未建模动态进行补偿，引入如下动态信号：

其中，易知，该动态信号满足Vω(ω(t))≤r(t)+D(t),其中D(t)对于所有t≥T0满足D(t)＝0。

步骤3，构建外环控制律和内环控制律，并且基于模糊逻辑构建外环虚拟控制律。考虑到水下机器人运动学和动力学环节时间尺度的不同，将其动态方程分为内外两个环路。外环路实现对期望信号的跟踪，内环路实现对外环路虚拟控制律的跟踪。在外环实际控制律中，加入干扰补偿项和输入不确定性补偿项对外干扰和执行机构死区引起的输入不确定性进行处理，同时，基于模糊逻辑和前述动态信号，设计模糊自适应补偿器，对水下机器人动态方程的未建模动态进行补偿；其具体过程为：

假设期望信号为ηd，定义跟踪误差为eη＝η-ηd，那么跟踪误差的动态方程为：

设计外环虚拟控制律为：其中k1＞0为设计参数。进一步的，定义内环跟踪误差为ev＝v-vvirtual，那么该内环跟踪误差的动态方程可表示为：

定义外环控制律为选择对V0进行求导可得：

考虑

其中

其中ε1,ε2为正常数。因为光滑函数和未知，而且C(v)和水动力矩阵D(v)也假设为未知，本发明引入模糊逻辑对其进行逼近。理想状态为：

其中，为未知参数矩阵，Nl为模糊逻辑的个数，为模糊逼近函数，其分量可以表示为

l＝1,2,…,Nl。，为模糊近似误差，满足因此

其中

其中

于是得到

定义和δ的估计值为和设计外环虚拟控制律为：

其中k2＞0为设计参数，得到：

步骤4，对水下机器人多执行机构的虚拟控制量进行控制分配；令τj,virtual＝hjτj,0，针对该虚拟控制量进行控制分配。定义B＝[B1,B2,…,BN]。考虑如下最优控制分配问题：

可以直接得到解为：τvirtual＝B^T[BB^T]^-1uvirtual (27)

于是，将式(25)重写为：

因为hj是时变未知的，所以无法直接根据τvirtual求得τj,0，需要设计自适应补偿项克服其带来的输入不确定性。定义使得得到：

定义Hj＝1/inft≥0||hj||，设计实际控制律为：

于是：

进一步的：

得到：

选择最终Lyapunov函数为：

求导得到：

得到选择自适应律为：

从而使控制系统收敛，其中σδ,σH为正常数。