CN109814392B - 一种欠驱动水下机器人执行器故障鲁棒容错控制方法 - Google Patents
一种欠驱动水下机器人执行器故障鲁棒容错控制方法 Download PDFInfo
- Publication number
- CN109814392B CN109814392B CN201910129709.4A CN201910129709A CN109814392B CN 109814392 B CN109814392 B CN 109814392B CN 201910129709 A CN201910129709 A CN 201910129709A CN 109814392 B CN109814392 B CN 109814392B
- Authority
- CN
- China
- Prior art keywords
- auv
- fault
- actuator
- vector
- formula
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Images
Landscapes
- Feedback Control In General (AREA)
Abstract
本发明公开了一种欠驱动AUV执行器故障鲁棒容错控制方法,包括以下步骤:定义AUV运动的位置误差向量;定义新的误差向量;利用神经网络方法逼近复合不确定项;设计辅助动态系统;设计欠驱动AUV执行器故障鲁棒容错控制律。本发明由于应用神经网络来逼近AUV的动态不确定和扰动不确定,不需要AUV的运动数学模型动态参数及海流扰动的先验知识,具有良好的自适应能力和鲁棒性。本发明通过设计辅助动态系统来处理执行器故障对AUV控制系统造成的影响,提高了AUV运动控制系统的可靠性。本发明引入坐标变换来定义AUV的输出向量,解决了AUV的欠驱动问题,且实现欠驱动AUV三维运动控制,更加符合实际。
Description
技术领域
本发明涉及海洋工程装备领域,特别是一种欠驱动水下机器人执行器故障鲁棒容错控制方法。
背景技术
自主水下机器人(AUV)作为人类探索和开发海洋的工具,在海洋作业中发挥着重要的作用。AUV系统本身具有欠驱动、动态不确定等特性,且在航行时会遭受海流的干扰;另一方面,AUV在作业时其执行器一直暴露在海水中,会由于海水侵蚀等原因而老化损坏,从而发生故障。执行器一旦发生故障,AUV不仅无法继续完成任务,而且无法回收,损失巨大。因此,研究欠驱动AUV的执行器故障鲁棒容错控制,对提高AUV的鲁棒性以及容错能力尤为重要,能够为AUV进行相关海洋作业的安全可靠提供保障。
中国专利CN108196445A公开了一种基于双闭环自抗扰的水下机器人姿态与位置控制方法,设计水下机器人的速度环扩张状态观测器,提供水下机器人未建模动态和外部扰动构成的总扰动的估计值,并用于总扰动的实时补偿,实现水下机器人三维运动控制。中国专利CN107861382A公开了一种水下机器人运动鲁棒自适应控制方法,应用滑模控制方法设计水下机器人运动控制律,并结合自适应方法对控制增益进行在线调节,实现水下机器人的三维运动控制。中国专利CN108170151A公开了一种水下机器人运动模糊自适应控制方法,应用模糊算法逼近水下机器人的动态不确定,应用自适应技术估计外部扰动的上界,结合逆推方法设计水下机器人运动控制律,实现水下机器人的三维运动控制。然而,上述专利均未考虑水下机器人的欠驱动特性以及执行器可能出现故障的情况。
中国专利CN107463097A公开了一种水下机器人的自适应量化容错控制方法,该方法在CN108170151A基础上考虑执行器出现部分失效故障情况,应用自适应技术估计描述故障情况的执行器效率因子的上界,设计水下机器人容错控制器;然而,此专利也未考虑水下机器人欠驱动特性。中国专利CN105785974A公开了一种欠驱动自主水下航行器的航向容错控制系统,建立故障诊断模块实时判断垂直舵是否正常工作,一旦垂直舵出现问题,切换成不依赖垂直舵的控制模式,实现欠驱动自主水下航行器的自主行驶。然而,此专利仅仅处理了垂直舵出现故障情况,且所设计的控制系统无法实现水下机器人的三维运动。
发明内容
为解决现有技术存在的上述问题,本发明要提出一种欠驱动AUV执行器故障鲁棒容错控制方法,在AUV动态不确定和遭受扰动不确定以及执行器出现故障情况下,实现欠驱动AUV的三维运动控制。
为实现上述目的,本发明的技术方案如下:一种欠驱动AUV执行器故障鲁棒容错控制方法,所述的欠驱动AUV的运动数学模型包括运动学模型和带有执行器故障的动力学模型,分别如式(1)和式(2)所示:
式中,x、y和z分别表示在大地坐标系下AUV的横荡、纵荡和升沉位置,θ和ψ分别表示在大地坐标系下AUV的纵倾角和艏摇角,记η=[x,y,z,θ,ψ]T为AUV的位姿向量;u、v和w分别表示在附体坐标系下AUV的前进、横漂和垂荡的速度,q和r分别表示在附体坐标系下AUV的纵倾角速度和艏摇角速度,记υ=[u,v,w,q,r]T为AUV的速度向量,附体坐标系的原点选为AUV的重心;mii和dii分别表示带有附加质量的惯性参数和水动力参数,ii=11、22、33、44、55;表示AUV的纵稳心高度,g表示重力加速度,ρ表示AUV所处海洋环境的密度,▽表示AUV的排水体积;τu、τq和τr分别表示AUV推进系统产生的横荡方向合力及纵倾和艏摇合力矩,τdu、τdv、τdw、τdq和τdr分别表示AUV遭受的由时常变化且不可预测的海流引起的横荡、纵荡、升沉方向的扰动力及纵倾和艏摇方向的扰动力矩,这些扰动是不确定的;σu、σq和σr是执行器的效率因子,若σu、σq和σr为0,表示执行器完全失效,若为1,表示执行器未发生故障,本发明考虑效率因子σu∈(0,1)、σq∈(0,1)和σr∈(0,1)的情况,即执行器发生部分失效故障的情况。
由于AUV在纵荡和升沉方向没有控制输入,AUV的纵荡和升沉位置无法直接被控制,属于欠驱动;AUV的运动数学模型参数会发生变化且不容易精确测量,造成AUV的动态不确定。
式中,l表示AUV附体坐标系坐标原点到AUV最前端的距离,AUV附体坐标系坐标原点取AUV的重心。
根据式(1)-(3),AUV运动的向量-矩阵形式数学模型表示如下:
式中:
τ=[τu,τq,τr]T
τd=[τdu,τdq,τdr]T
所述的执行器故障鲁棒容错控制方法,包括以下步骤:
式中,K1是3×3的正定设计矩阵。
令α通过下面的一阶滤波器,以获得镇定函数的滤波信号和滤波信号的微分项:
式中,Xd为一阶滤波器的三维状态向量,Td为正的设计常数。
式中,I是3×3的单位矩阵。
假设未知时变扰动τd是有界的,存在未知常数向量Δ=[Δ1,Δ2,Δ3]T使得|τdu|≤Δ1、|τdq|≤Δ2和|τdr|≤Δ3,根据式(9)有:
式中,为AUV的动态不确定和扰动不确定引起的复合不确定项,Sgn(S2)=diag(sgn(S2,1),sgn(S2,2),sgn(S2,3)),diag(·)表示对角矩阵,sgn(·)表示符号函数。
C、利用神经网络方法逼近复合不确定项f(η,υ):
f(η,υ)=WTΦ(X)+E(X) (12)
式中,X是神经网络的输入向量,W是理想常值权矩阵,具体如下式:
X=[ηT,υT]T
Wi=[Wi,1,Wi,2,···,Wi,n]T
Φi(X)=[Φi,1(X),···,Φi,j(X),···,Φi,n(X)]T
i=1、2、3
j=1、2、…、n
D、为了处理执行器故障问题,设计如下辅助动态系统:
式中,ξ为辅助动态系统(14)的三维状态向量,Kξ是3×3的正定设计矩阵,γ1和γ2为正的设计常数,且γ1<γ2。
E、设计欠驱动AUV执行器故障鲁棒容错控制律如下:
式中,K2和KS是3×3的正定设计矩阵。
与现有技术相比,本发明具有以下有益效果:
1、本发明由于应用神经网络来逼近AUV的动态不确定和扰动不确定,不需要AUV的运动数学模型动态参数及海流扰动的先验知识,具有良好的自适应能力和鲁棒性。
2、本发明通过设计辅助动态系统来处理执行器故障对AUV控制系统造成的影响,提高了AUV运动控制系统的可靠性。
3、本发明引入坐标变换来定义AUV的输出向量,解决了AUV的欠驱动问题,且实现欠驱动AUV三维运动控制,更加符合实际。
4、本发明采用滤波信号的微分项代替镇定函数的微分,避免了传统逆推方法中对镇定函数的求导运算,从而简化了控制律。
附图说明
图1为AUV的大地坐标系和附体坐标系框架图。
图2为欠驱动AUV执行器故障鲁棒容错控制方法原理图。
具体实施方式
下面结合附图对本发明进行进一步地描述。
如图1-2所示,欠驱动AUV执行器故障鲁棒容错控制方法原理为:欠驱动AUV为被控制对象,会受海流扰动的影响;AUV的输出信号为大地坐标系下的位姿向量η,经过坐标变换,转换为AUV大地坐标系下前端实际位置AUV前端实际位置反馈到AUV的参考输入端,并与AUV的期望位置比较,形成偏差信号S1;辅助动态系统根据AUV的控制输入τ、位姿向量η和速度向量υ,产生状态向量ξ;神经网络根据位姿向量η和速度向量υ来逼近由动态不确定和扰动不确定引起的复合不确定项f(η,υ);AUV执行器故障鲁棒容错控制律依据偏差信号S1、辅助动态系统的状态向量ξ、来自神经网络对不确定项f(η,υ)的估计值,产生AUV的控制输入τ,驱动AUV达到期望的位置。
本发明不局限于本实施例,任何在本发明披露的技术范围内的等同构思或者改变,均列为本发明的保护范围。
Claims (1)
1.一种欠驱动AUV执行器故障鲁棒容错控制方法,其特征在于:所述的欠驱动AUV的运动数学模型包括运动学模型和带有执行器故障的动力学模型,分别如式(1)和式(2)所示:
式中,x、y和z分别表示在大地坐标系下AUV的横荡、纵荡和升沉位置,θ和ψ分别表示在大地坐标系下AUV的纵倾角和艏摇角,记η=[x,y,z,θ,ψ]T为AUV的位姿向量;u、v和w分别表示在附体坐标系下AUV的前进、横漂和垂荡的速度,q和r分别表示在附体坐标系下AUV的纵倾角速度和艏摇角速度,记υ=[u,v,w,q,r]T为AUV的速度向量,附体坐标系的原点选为AUV的重心;mii和dii分别表示带有附加质量的惯性参数和水动力参数,ii=11、22、33、44、55;表示AUV的纵稳心高度,g表示重力加速度,ρ表示AUV所处海洋环境的密度,▽表示AUV的排水体积;τu、τq和τr分别表示AUV推进系统产生的横荡方向合力及纵倾和艏摇合力矩,τdu、τdv、τdw、τdq和τdr分别表示AUV遭受的由时常变化且不可预测的海流引起的横荡、纵荡、升沉方向的扰动力及纵倾和艏摇方向的扰动力矩,这些扰动是不确定的;σu、σq和σr是执行器的效率因子,若σu、σq和σr为0,表示执行器完全失效,若为1,表示执行器未发生故障,本申请考虑效率因子σu∈(0,1)、σq∈(0,1)和σr∈(0,1)的情况,即执行器发生部分失效故障的情况;
式中,l表示AUV附体坐标系坐标原点到AUV最前端的距离,AUV附体坐标系坐标原点取AUV的重心;
根据式(1)-(3),AUV运动的向量-矩阵形式数学模型表示如下:
式中:
τ=[τu,τq,τr]T
τd=[τdu,τdq,τdr]T
所述的执行器故障鲁棒容错控制方法,包括以下步骤:
式中,K1是3×3的正定设计矩阵;
令α通过下面的一阶滤波器,以获得镇定函数的滤波信号和滤波信号的微分项:
式中,Xd为一阶滤波器的三维状态向量,Td为正的设计常数;
式中,I是3×3的单位矩阵;
假设未知时变扰动τd是有界的,存在未知常数向量Δ=[Δ1,Δ2,Δ3]T使得|τdu|≤Δ1、|τdq|≤Δ2和|τdr|≤Δ3,根据式(9)有:
式中,为AUV的动态不确定和扰动不确定引起的复合不确定项,Sgn(S2)=diag(sgn(S2,1),sgn(S2,2),sgn(S2,3)),diag(·)表示对角矩阵,sgn(·)表示符号函数;
C、利用神经网络方法逼近复合不确定项f(η,υ):
f(η,υ)=WTΦ(X)+E(X) (12)
式中,X是神经网络的输入向量,W是理想常值权矩阵,具体如下式:
X=[ηT,υT]T
Wi=[Wi,1,Wi,2,···,Wi,n]T
Φi(X)=[Φi,1(X),···,Φi,j(X),···,Φi,n(X)]T
i=1、2、3
j=1、2、…、n
D、为了处理执行器故障问题,设计如下辅助动态系统:
式中,ξ为辅助动态系统(14)的三维状态向量,Kξ是3×3的正定设计矩阵,γ1和γ2为正的设计常数,且γ1<γ2;
E、设计欠驱动AUV执行器故障鲁棒容错控制律如下:
式中,K2和KS是3×3的正定设计矩阵。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910129709.4A CN109814392B (zh) | 2019-02-21 | 2019-02-21 | 一种欠驱动水下机器人执行器故障鲁棒容错控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910129709.4A CN109814392B (zh) | 2019-02-21 | 2019-02-21 | 一种欠驱动水下机器人执行器故障鲁棒容错控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109814392A CN109814392A (zh) | 2019-05-28 |
CN109814392B true CN109814392B (zh) | 2021-10-26 |
Family
ID=66607108
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910129709.4A Expired - Fee Related CN109814392B (zh) | 2019-02-21 | 2019-02-21 | 一种欠驱动水下机器人执行器故障鲁棒容错控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109814392B (zh) |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110209056A (zh) * | 2019-06-25 | 2019-09-06 | 西北工业大学 | 一种自主水下航行器舵面故障诊断方法 |
CN110209197B (zh) * | 2019-06-25 | 2022-03-25 | 湖北航天技术研究院总体设计所 | 一种飞行器控制系统设计方法 |
CN110147120B (zh) * | 2019-06-25 | 2021-07-06 | 西北工业大学 | 一种自主水下航行器舵面主动容错控制方法 |
CN110568757B (zh) * | 2019-09-04 | 2020-06-26 | 北京航空航天大学 | 一种电推力器的自适应容错控制方法 |
CN110579965B (zh) * | 2019-09-23 | 2022-09-13 | 哈尔滨工业大学 | 基于事件驱动的水面无人艇网络攻击下的容错控制方法 |
CN111273549B (zh) * | 2020-02-21 | 2023-01-13 | 大连海事大学 | 一种智能船舶自动舵系统的模糊自适应输出反馈容错控制方法及系统 |
CN111736612A (zh) * | 2020-07-14 | 2020-10-02 | 大连海事大学 | 一种基于多项式模糊模型的usv航迹跟踪控制方法 |
CN113093734B (zh) * | 2021-03-17 | 2023-11-03 | 大连海事大学 | 一种输入受限的无人船航向共融控制方法、系统及装置 |
CN113238567B (zh) * | 2021-04-30 | 2021-12-10 | 哈尔滨工程大学 | 一种基于扩展状态观测器的底栖式auv弱抖振积分滑模点镇定控制方法 |
CN113835434B (zh) * | 2021-09-29 | 2024-01-30 | 大连海事大学 | 一种分布式多无人船舶自适应神经网络编队控制方法 |
CN114035550B (zh) * | 2021-11-15 | 2023-11-21 | 江苏科技大学 | 一种基于eso的自主式水下机器人执行机构故障诊断方法 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102298326B (zh) * | 2011-06-30 | 2013-05-08 | 哈尔滨工程大学 | 欠驱动auv自适应轨迹跟踪控制装置及控制方法 |
CN102385316B (zh) * | 2011-09-16 | 2013-03-20 | 哈尔滨工程大学 | 一种基于神经网络反步法的欠驱动自主水下航行器变深控制方法 |
CN102541062B (zh) * | 2012-02-24 | 2014-01-15 | 天津大学 | 一种水下自主式航行器的局部路径规划方法 |
CN104898688B (zh) * | 2015-03-27 | 2018-05-18 | 哈尔滨工程大学 | Uuv四自由度动力定位自适应抗扰滑模控制系统及控制方法 |
CN106950974B (zh) * | 2017-04-19 | 2020-07-28 | 哈尔滨工程大学 | 欠驱动自主水下航行器的对三维路径进行理解及跟踪控制方法 |
CN109032136B (zh) * | 2018-07-23 | 2020-09-08 | 西北工业大学 | 基于主从分布式模型预测控制的欠驱动多无人船编队跟踪方法 |
CN108983612A (zh) * | 2018-08-08 | 2018-12-11 | 华南理工大学 | 一种具有预设性能和连接保持的水下机器人编队控制方法 |
-
2019
- 2019-02-21 CN CN201910129709.4A patent/CN109814392B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN109814392A (zh) | 2019-05-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109814392B (zh) | 一种欠驱动水下机器人执行器故障鲁棒容错控制方法 | |
CN108803632B (zh) | 基于饱和补偿技术的水面无人艇全状态约束轨迹跟踪控制方法 | |
CN107168312B (zh) | 一种补偿uuv运动学和动力学干扰的空间轨迹跟踪控制方法 | |
Moreira et al. | Path following control system for a tanker ship model | |
CN111580523B (zh) | 一种基于侧滑角补偿的无人艇路径跟踪自抗扰控制方法 | |
CN111736600B (zh) | 一种时滞非对称时变全状态约束下的水面无人艇轨迹跟踪控制方法 | |
CN109583144B (zh) | 一种无人海洋航行器的动力学优化控制器结构及设计方法 | |
CN112527018B (zh) | 一种欠驱动自主水下航行器的三维镇定控制方法 | |
Fan et al. | Course keeping control based on integrated nonlinear feedback for a USV with pod-like propulsion | |
CN112965371B (zh) | 基于固定时间观测器的水面无人艇轨迹快速跟踪控制方法 | |
CN110007606A (zh) | 一种考虑输入饱和的水面无人艇误差约束控制方法 | |
CN111857165B (zh) | 一种水下航行器的轨迹跟踪控制方法 | |
CN114442640B (zh) | 一种水面无人艇轨迹跟踪控制方法 | |
CN112558477B (zh) | 一种基于加速度信息的无人船状态和扰动观测器 | |
Saoud et al. | Modeling and control design of a robotic sailboat | |
Yuan et al. | An efficient control allocation algorithm for over-actuated AUVs trajectory tracking with fault-tolerant control | |
CN112591060B (zh) | 一种水下自主航行器x型舵控制方法 | |
CN115686034A (zh) | 考虑速度传感器失效的无人潜航器轨迹跟踪控制方法 | |
Liu et al. | Synchronisation control for ships in underway replenishment based on dynamic surface control | |
CN114527772A (zh) | 一种auv轨迹跟踪控制器设计方法与系统 | |
CN114564015A (zh) | 一种拒止环境下的欠驱动无人艇分布式编队控制方法 | |
Bo-Wen et al. | Global asymptotic stabilization of an underactuated surface vessel | |
CN113093739A (zh) | 一种多无人艇编队避碰的优化控制器及其结构、设计方法 | |
Li et al. | Pitch reduction system design and control for an underwater vehicle | |
Wan et al. | Modeling and motion control strategy for AUV |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20211026 |
|
CF01 | Termination of patent right due to non-payment of annual fee |