CN112141303A - 水下机器人攀爬模态下的防滑调头控制方法及水下机器人 - Google Patents

水下机器人攀爬模态下的防滑调头控制方法及水下机器人 Download PDF

Info

Publication number
CN112141303A
CN112141303A CN202011074964.2A CN202011074964A CN112141303A CN 112141303 A CN112141303 A CN 112141303A CN 202011074964 A CN202011074964 A CN 202011074964A CN 112141303 A CN112141303 A CN 112141303A
Authority
CN
China
Prior art keywords
underwater robot
skid
control method
zero
robot
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.)
Granted
Application number
CN202011074964.2A
Other languages
English (en)
Other versions
CN112141303B (zh
Inventor
严卫生
崔荣鑫
陈乐鹏
许晖
王崇武
李宏
邢瑶
蒋绍博
张守旭
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Northwestern Polytechnical University
Shenzhen Institute of Northwestern Polytechnical University
Original Assignee
Northwestern Polytechnical University
Shenzhen Institute of Northwestern Polytechnical University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Northwestern Polytechnical University, Shenzhen Institute of Northwestern Polytechnical University filed Critical Northwestern Polytechnical University
Priority to CN202011074964.2A priority Critical patent/CN112141303B/zh
Publication of CN112141303A publication Critical patent/CN112141303A/zh
Application granted granted Critical
Publication of CN112141303B publication Critical patent/CN112141303B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
    • B63C—LAUNCHING, HAULING-OUT, OR DRY-DOCKING OF VESSELS; LIFE-SAVING IN WATER; EQUIPMENT FOR DWELLING OR WORKING UNDER WATER; MEANS FOR SALVAGING OR SEARCHING FOR UNDERWATER OBJECTS
    • B63C11/00—Equipment for dwelling or working underwater; Means for searching for underwater objects
    • B63C11/52—Tools specially adapted for working underwater, not otherwise provided for
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
    • B63B—SHIPS OR OTHER WATERBORNE VESSELS; EQUIPMENT FOR SHIPPING 
    • B63B59/00—Hull protection specially adapted for vessels; Cleaning devices specially adapted for vessels
    • B63B59/06—Cleaning devices for hulls
    • B63B59/10—Cleaning devices for hulls using trolleys or the like driven along the surface

Abstract

本发明涉及水下机器人控制技术领域，提供了一种水下机器人攀爬模态下的防滑调头控制方法及相应的防滑掉头控制装置和水下机器人。防滑调头控制方法，包括以下步骤：步骤1：根据期望调头时间T、机器人的初始航向角ψ0和自适应变量β构造出期望航向角ψd(t)；步骤2：根据期望航向角ψd(t)以及预设的调头侧移量yd，构建滑模面s1、s2；步骤3：基于水下机器人左、右履带不打滑的控制需求，根据水下机器人左、右履带所能提供的最大牵引力F1m和F2m，设计防滑调头控制律F1、F2以及防滑调头自适应律
Figure DDA0002716412150000011
Figure DDA0002716412150000012
步骤4：基于防滑调头控制律F1、F2，为水下机器人左、右履带分别提供牵引力u1和u2。根据本发明的水下机器人攀爬模态下的防滑调头控制方法可实现在工作壁面无滑动地按期望侧移量调头。

Description

水下机器人攀爬模态下的防滑调头控制方法及水下机器人
技术领域
本发明涉及水下机器人控制技术领域，具体为一种水下机器人攀爬模态下的防滑调头控制方法及相应的防滑掉头控制装置和水下机器人。
背景技术
水下机器人是海洋资源开发，海洋监测以及海洋生态保护的重要装备之一。通过搭载不同类型的传感器和执行器，水下机器人能够有效地实现对海洋探索、开发、监测以及侦查等多项任务。
对于复杂海洋环境下的探索开发，尤其是当需要在船侧、大坝、桥墩等复杂工作面进行降落、攀爬或行走等作业任务时，就需要深入地研究开发同时具有大范围游动能力以及局部行走和攀爬能力的水下机器人，其可广泛应用于海洋资源开发和利用、海洋牧场建设、水下文化遗产保护、搜集和打捞、水库大坝的安全检查、船舶清洗和日常保养、水下安全等领域，可促进我国海洋经济的快速发展，维护社会稳定和国家安全，具有重要的经济和社会效益。
水下机器人通常受限于传感器探测范围或者作业工具作业范围的制约，当水下机器人着陆并贴合到工作面后，就需要合理设计水下机器人的覆盖控制算法，以实现对工作壁面的高效率的检测或作业。沿着预定规划路径循环式覆盖方法作为一种简单实用的覆盖控制算法广泛应用于实际工程中，其核心在于机器人调头侧移量的精确控制。基于此，面向左右履带和推进器混合驱动的水下机器人的调头侧移量控制是一个很有理论和实际意义的研究问题。
水下机器人依靠推进器的螺旋桨产生垂直于工作面的推力使机器人稳定的依附于工作壁面。但是，由于水下机器人攀爬的工作壁面(船侧、大坝、桥墩等)大多覆盖着一层柔软的附着物，如苔藓等水生植物，其将导致工作壁面攀爬的摩擦系数小的问题。然而水下机器人垂推的推力之和通常是有限的，当水下机器人在光滑壁面快速调头运动或控制律设计不合理时，左右履带期望的驱动力极易大于在垂推作用下履带所能产生的最大牵引力。这将使水下机器人左右履带在工作壁面打滑，进而导致调头侧移量难以精准控制的问题。
此外，不同于一些平衡点为零且跟踪的期望状态为常值的机器人控制系统，例如水下机器人定深、定向等控制系统。当控制输入受限时，这些系统可以通过设计合适的抗饱和补偿器，即在满足系统稳定性前提下，通过合理减缓期望值跟踪速度来削弱控制输入，以实现输入受限下的定深、定向等控制目标。但是，混合驱动水下机器人的调头动力学模型不同于其它一些平衡点为零且跟踪的期望状态为常值的动力学模型，这将导致不能按传统抗饱和补偿器来设计防滑控制律，应当考虑通过减小调头运动速度以实现按期望下移量无滑动调头。因此，在水下机器人垂推大小给定的前提下，如何根据工作壁面的摩擦系数，合理地协调控制履带的驱动力和调头时间，以保证水下机器人在柔软且光滑的工作壁面上无滑动地按期望下移量调头，是另一个值得深入研究的问题。
综上所述，水下机器人在攀爬模态下的防滑调头侧移量控制存在以下两个问题：1、如何利用已有的传感器间接获取水下机器人的调头侧移量，以克服无传感器直接测量获取的问题；2、如何协调控制履带的驱动力和调头时间，使水下机器人自主适应垂推推力大小和攀爬工作壁面的摩擦系数，以实现在工作壁面无滑动地按期望侧移量调头。
发明内容
(1)技术问题
本发明面向高精度的调头侧移量控制需求，针对混合驱动水下机器人调头侧移动力学模型的特殊性、侧移量无法通过传感器直接测量获取以及履带式水下机器人在工作壁面易打滑的问题，提出了一种混合驱动水下机器人攀爬模态下的防滑调头控制方法及相应的防滑掉头控制装置和水下机器人，其能自主适应垂推推力大小和攀爬工作壁面的摩擦系数，以实现在工作壁面无滑动地按期望侧移量调头。
(2)技术方案
根据本发明的一方面，提供了一种水下机器人攀爬模态下的防滑调头控制方法，包括以下步骤：
步骤1：根据期望调头时间T、机器人的初始航向角ψ0和自适应变量β构造出期望航向角ψd(t)；
步骤2：根据期望航向角ψd(t)以及预设的调头侧移量yd，构建滑模面s1、s2；
步骤3：基于水下机器人左、右履带不打滑的控制需求，根据水下机器人左、右履带所能提供的最大牵引力F1m和F2m，设计防滑调头控制律F1、F2以及防滑调头自适应律
Figure BDA0002716412130000021
Figure BDA0002716412130000022
步骤4：基于防滑调头控制律F1、F2，为水下机器人左、右履带分别提供牵引力u1和u2。
根据本发明的示例性实施例，步骤1中
Figure BDA0002716412130000031
根据本发明的示例性实施例，步骤2中
Figure BDA0002716412130000032
其中，
Figure BDA0002716412130000033
为水下机器人t时刻期望的侧移量，其由航向角ψ、预设的调头侧移量yd和累积侧移量
Figure BDA0002716412130000034
共同决定；λ1为大于零的常数；
其中，
Figure BDA0002716412130000035
L为左右履带间距，V1和V2分别为左右履带的行走速度，
Figure BDA0002716412130000036
根据本发明的示例性实施例，步骤3中
Figure BDA0002716412130000037
其中，m＝m0+mλ为水下机器人质量m0和附加质量mλ之和；J＝J0+Jλ为水下机器人绕攀爬壁面的转动惯量J0和附加转动惯量Jλ之和；
Figure BDA0002716412130000038
其中，τ1和τ2为大于零的常数，k1和k2为大于零的常数，w1、w2、
Figure BDA0002716412130000039
和
Figure BDA00027164121300000310
为所设计的自适应状态量，c0、c2和c3为模型的流体动力参数，且c0、c2和c3均为大于零的常数；Mr为转向时水下机器人侧向摩擦力所产生的阻尼力矩，其力矩方向与航向角速度方向相反，可表示为
Figure BDA0002716412130000041
其中，FN为水下机器人垂推推力之和，其为大于零的恒定值；d为混合驱动水下机器人的长度；μ为左右履带相对工作壁面的摩擦系数；
Figure BDA0002716412130000042
Figure BDA0002716412130000043
其中，
Figure BDA0002716412130000044
为模型不确定和未知干扰之和的上界估计值；ε1、ε2、kρ1、kρ1均为大于零的常数；
Figure BDA0002716412130000045
Δu1＝F1-u1，Δu2＝F2-u2；
Figure BDA0002716412130000046
Figure BDA0002716412130000047
为大于零的常数；κ1和κ2为均为大于零的常量，且κ1≤0.01，κ2≤0.01；ku1和ku2均为大于零的常数。
根据本发明的示例性实施例，步骤4中，
Figure BDA0002716412130000048
其中，壁面所能提供最大牵引力为
Figure BDA0002716412130000049
根据本发明的另一方面，提供了一种水下机器人攀爬模态下的防滑调头控制装置，包括处理器和存储器，所述存储器中存储有执行上述防滑调头控制方法的计算机程序。
根据本发明的又一方面，提供了一种水下机器人，包括处理器和存储器，所述存储器中存储有执行上述的防滑调头控制方法的计算机程序。
(3)有益效果
根据本发明的混合驱动水下机器人攀爬模态下的防滑调头控制方法及相应的防滑掉头控制装置和水下机器人，其能协调控制履带的驱动力和调头时间，使水下机器人自主适应垂推推力大小和攀爬工作壁面的摩擦系数，以实现在工作壁面无滑动地按期望侧移量调头。在该方法中，基于滑模控制设计了自适应律，其能实时估计出模型不确定和外界未知扰动力的上界，进而抵抗模型不确定和外界扰动力对控制精度造成的不利影响。
附图说明
附图1为攀爬模态下混合驱动水下机器人防滑调头控制系统的结构框图；
附图2为混合驱动水下机器人在工作壁面行进的路线图；
附图3为混合驱动水下机器人旋转原点生成机制示意图；
附图4为混合驱动水下机器人t时刻期望的侧移量yr的生成机制示意图；
附图5为采用本发明实施例控制方法下的混合驱动水下机器人调头运动轨迹图；
附图6为采用本发明实施例控制方法下的混合驱动水下机器人调头侧移量变化曲线图；
附图7为采用本发明实施例控制方法下的混合驱动水下机器人航向角变化曲线图；
附图8为采用对比控制方法下的混合驱动水下机器人航向角变化曲线图；
附图9A、9B为分别采用本发明实施例控制方法、对比控制方法下的混合驱动水下机器人左右履带驱动力变化曲线图；
附图10A、10B为分别采用本发明实施例控制方法、对比控制方法下的混合驱动水下机器人左右履带速度变化曲线图；
附图11A、11B为采用本发明实施例控制方法下自适应变量w1和w2变化曲线图；
附图12A、12B为采用本发明实施例控制方法下滑模量s1和s2的变化曲线图。
具体实施方式
下面结合具体实施来描述本发明：
本发明的一实施例中，以某型由多推进器混合驱动贴壁以及双履带行走的水下机器人为研究对象。混合驱动水下机器人的长度和左右履带间距分别为d＝1m和L＝0.9m，质量为m＝160kg,绕垂直壁面方向的转动惯量J＝4kg·m2，传动机构的摩擦阻力和压实阻力系数c0＝600Ns/m,前向水阻力系数c2＝313Ns/m,壁面旋转水阻力系数c3＝830Ns/m。
混合驱动水下机器人初始位姿为x(0)＝0m，y(0)＝0m，ψ(0)＝10°，左右履带初始速度为V1(0)＝V2(0)＝0m/s；期望调头侧移量设置为yd＝-0.4m；混合驱动水下机器人的垂推之和设置为500N；左右履带与工作壁面间的动摩擦系数设置为μ＝0.4；混合驱动水下机器人的航向角由10°变为-180°所需要的时间，即调头时间设置为T＝30s。
本发明实施例中的控制参数选取如下：λ1＝3，τ1＝6，τ2＝14，k1＝0.1，k2＝0.02，
Figure BDA0002716412130000061
κ1＝0.01，κ2＝0.01，ε1＝0.4，ε2＝0.2，kρ1＝0.01，kρ2＝0.01，ku1＝0.1，ku2＝0.1。同时，为了验证本发明所提的防滑控制方法的有效性，在6s～9s时段内增加一个较大的恒值扰动力矩ΔM＝8Nm。
步骤1：利用多推进器混合驱动以实现贴壁，建立履带式水下机器人的运动学方程：
Figure BDA0002716412130000062
其中，(x,y)和ψ分别为水下机器人在壁面坐标系内的位置和航向角，L为左右履带间距；V1和V2分别为左右履带的行走速度。
步骤2：混合驱动水下机器人动力学方程：
Figure BDA0002716412130000063
其中，m＝m0+mλ为水下机器人质量m0和附加质量mλ之和，机器人前向运动速度
Figure BDA0002716412130000064
J＝J0+Jλ分别为水下机器人绕垂直壁面方向的转动惯量J0和附加转动惯量Jλ之和；u1和u2分别为左右履带作用于壁面所产生的驱动力；R0为水下机器人本体攀爬时受到的阻力，其包括水下机器人内部齿轮等传动机构的摩擦阻力和水下机器人碾压壁面的压实阻力，且其与水下机器人攀爬速度V成正比，即R0＝c0V，c0为大于零的常数；Rw为水下机器人的运动阻力，其可表示为Rw＝c1ρSV|V|＝c2V|V|，其中ρ为海水密度，S为水下机器人纵向特征面积，c0、c1和c2均为大于零的常数。
MF＝-L(u1-u2)为左右履带提供的驱动力矩；M0＝c0L(V1-V2)为转向时水下机器人内部损耗造成的阻尼力矩和地面作用于水下机器人的阻尼力矩，其具体包括水下机器人内部齿轮等传动机构的摩擦阻力和水下机器人碾压壁面的压实阻力所产生的阻尼力矩；
Figure BDA0002716412130000071
为海水作用于水下机器人的转向阻尼力矩，c3为大于零的常数。ΔF为外界不确定干扰力和未建模之和，ΔM为外界不确定干扰力矩和未建模之和。
Mr为转向时水下机器人侧向摩擦力所产生的阻尼力矩，其力矩方向与航向角速度方向相反，其可表示为
Figure BDA0002716412130000072
其中，d为混合驱动水下机器人的长度；FN为水下机器人垂推之和，其为大于零的恒定值；μ为水下机器人与壁面之间的摩擦系数。
综上所述，混合驱动水下机器人在攀爬模态下的动力学方程可写为
Figure BDA0002716412130000073
左右履带作用于壁面的驱动力u1和u2取决于驱动电机产生的力以及壁面所能提供的最大牵引力：
Figure BDA0002716412130000074
其中，壁面所能提供最大牵引力为
Figure BDA0002716412130000075
μ为履带与壁面之间的摩擦系数。
步骤3：混合驱动水下机器人调头侧移量可表示为
Figure BDA0002716412130000076
其中，yw＝2yL＞0表明水下机器人朝左侧履带方向侧移，yw＝2yL＜0表明水下机器人朝右侧履带方向侧移。为了保证水下机器人按期望的侧移量调头，则需要使yw-yd趋于零，其中，yd为预设的调头侧移量。
针对调头侧移任务需求，需设计合理的控制器使机器人的航向角从初始航向角ψ0稳定收敛至-180°，同时需保证机器人的调头侧移量稳定收敛为yd。
因此，构建如下两个滑模面：
Figure BDA0002716412130000081
其中，
Figure BDA0002716412130000082
为水下机器人t时刻期望的侧移量，其由航向角ψ、预设的调头侧移量yd和累积侧移量
Figure BDA0002716412130000083
共同决定；λ1为大于零的常数；
Figure BDA0002716412130000084
为期望的航向角，T为水下机器人调头预设时间，β为自适应变量。
为了满足水下机器人左、右履带不打滑的控制需求，自适应变量β可采用如下设计：
对期望的航向角求一阶和二阶导数，可得
Figure BDA0002716412130000085
且需满足
Figure BDA0002716412130000086
其中，τ1为常数，w1为待设计的自适应变量。
步骤4：针对步骤1和2设计得到的水下机器人的数学模型,以及步骤3的侧移量控制目标，采用以下控制律和自适应律进行控制，所述控制律为
Figure BDA0002716412130000087
其中，
Figure BDA0002716412130000091
其中，k1和k2为大于零的常数，w1、w2、
Figure BDA0002716412130000092
和
Figure BDA0002716412130000093
为所设计的自适应状态量，
Figure BDA0002716412130000094
所述的自适应律为：
Figure BDA0002716412130000095
其中，
Figure BDA0002716412130000096
为模型不确定和未知干扰之和的上界估计值；ε1、ε2、kρ1、kρ1均为大于零的常数；
Figure BDA0002716412130000097
Δu1＝F1-u1，Δu2＝F2-u2；
Figure BDA0002716412130000098
Figure BDA0002716412130000099
为大于零的常数；κ1和κ2为均为大于零的常量，且κ1≤0.01，κ2≤0.01；ku1和ku2均为大于零的常数。
结合图1，为了实现在工作壁面无滑动地按期望侧移量调头，基于防滑调头控制律F1、F2，为水下机器人左、右履带分别提供牵引力u1和u2。
关于控制律的稳定性，可采用李雅普诺夫稳定性原理证明。选取李雅普诺夫候选函数：
Figure BDA0002716412130000101
其中，w＝[w1，w2]T，
Figure BDA0002716412130000102
和
Figure BDA0002716412130000103
为模型不确定和未知干扰之和的上界估计误差，ρ1、ρ2为模型不确定和未知干扰之和的上界。
对候选函数求导，可得
Figure BDA0002716412130000104
进一步得到
Figure BDA0002716412130000105
由于
Figure BDA0002716412130000106
上式可进一步写为
Figure BDA0002716412130000107
Figure BDA0002716412130000108
基于如下放缩事实：
Figure BDA0002716412130000111
Figure BDA0002716412130000112
上式可进一步写为
Figure BDA0002716412130000113
其中，
Figure BDA0002716412130000114
设计参数时需满足：
Figure BDA0002716412130000115
由此可以证明该闭环控制系统是稳定的。
图1示出了攀爬模态下混合驱动水下机器人防滑调头控制系统结构框图。
首先，根据期望调头时间T、机器人的初始航向角ψ0和自适应变量β构造出期望航向角ψd(t)；
其次，根据期望航向角ψd(t)以及预设的调头侧移量yd，构建滑模面s1、s2；
再次，基于水下机器人左、右履带不打滑的控制需求，根据水下机器人左、右履带所能提供的最大牵引力F1m和F2m，设计防滑调头控制律F1、F2以及防滑调头自适应律
Figure BDA0002716412130000116
最后，基于防滑调头控制律F1、F2，为水下机器人左、右履带分别提供牵引力u1和u2。
图3为混合驱动水下机器人旋转原点生成机制示意图。由图3可知，混合驱动水下机器人的当前旋转原点由左右履带速度V1和V2共同决定，期望旋转原点由期望侧移量决定.本发明的控制目的是在履带不打滑前提条件下，使混合型水下机器人的当前旋转原点稳定收敛值期望旋转原点，即实现以期望侧移量调头的任务。
附图4为混合驱动水下机器人t时刻期望的侧移量yr的生成机制示意图。由图4可知，混合驱动水下机器人在任意t时刻的期望侧移量yr由航向角ψ、预设的调头侧移量yd和累积侧移量
Figure BDA0002716412130000121
共同决定；具体可表述为
Figure BDA0002716412130000122
由图5和图6可以看出，本发明所提的控制方法能较好地使水下机器人的调头侧移量稳定收敛至期望调头下移量，其侧移量控制误差大约为0.005m，满足实际运用时的精度需求。
特别地，从图7中航向角变化曲线可知，本发明所提的控制方法能自主调节调头角速度的参考值以减小履带所需的牵引力，进而间接避免履带打滑问题。
为了验证所提方法的优越性，本发明设计了一组对比控制方法；该对比方法与所提方法中的前半部分的滑模控制方法一致，不同之处在于对比方法无自适应抵抗左右履带滑动的控制策略，即
Figure BDA0002716412130000123
ku1＝0，ku2＝0且混合驱动水下机器人的垂推之和不限大小。
图8给出了采用对比控制方法下的混合驱动水下机器人航向角变化曲线；由图8可知，传统控制方法中航向角速度的参考值保持不变，即不具备自主调节调头角速度的参考值以减小履带所需牵引力的能力。
图9A、9B为分别采用本发明实施例控制方法、对比控制方法下的混合驱动水下机器人左、右履带驱动力变化曲线。由图9A、9B可知，相对于上述对比方法，本发明所提的控制方法通过利用自适应策略，能自主减小水下机器人的调头角速度，进而减小履带所需的牵引力，最后确保履带驱动力始终小于履带所能提供的驱动力，即能有效解决水下机器人打滑问题，保证了调头下移量控制精度。
图10A、10B为分别采用本发明实施例控制方法和上述对比控制方法下的混合驱动水下机器人左右履带速度变化曲线。从图10A、10B中可以看出，当水下机器人受到外界较大的干扰时，本发明所提控制方法中的履带速度不会出现较大的突变，能较平稳地抵抗外界不确定性干扰，具有较好的鲁棒性。图11A、11B和图12A、12B分别为本发明所提控制方法中的自适应变量和滑模面的变化曲线图。图11A、11B可以看出，当左右履带所需的驱动力大于履带所能提供的最大牵引力时，本发明的控制方法能通过自主调节自适应变量w1和w2的大小，自适应减小所需的驱动力，进而实现无滑动运动的目标。从图12A、12B可以看出，本发明的控制方法能使滑模面在稳定地收敛为零。
以上所述，仅是本发明的较佳实施例而已，并非对本发明作任何形式上的限制，虽然本发明已以较佳实施例揭露如上，然而并非用以限定本发明，任何熟悉本专业的技术人员，在不脱离本发明技术方案范围内，当可利用上述揭示的技术内容作出些许更动或修饰为等同变化的等效实施例，但凡是未脱离本发明技术方案的内容，依据本发明的技术实质对以上实施例所作任何的简单修改、等同变化与修饰，均仍属于本发明技术方案的范围内。

Claims (7)

1.一种水下机器人攀爬模态下的防滑调头控制方法，其特征在于：所述防滑调头控制方法包括以下步骤：
步骤1：根据期望调头时间T、机器人的初始航向角ψ0和自适应变量β构造出期望航向角ψd(t)；
步骤2：根据期望航向角ψd(t)以及预设的调头侧移量yd，构建滑模面s1、s2；
步骤3：基于水下机器人左、右履带不打滑的控制需求，根据水下机器人左、右履带所能提供的最大牵引力F1m和F2m，设计防滑调头控制律F1、F2以及防滑调头自适应律
Figure FDA0002716412120000011
Figure FDA0002716412120000012
步骤4：基于防滑调头控制律F1、F2，为水下机器人左、右履带分别提供牵引力u1和u2。
2.根据权利要求1所述的防滑调头控制方法，其特征在于：步骤1中
Figure FDA0002716412120000013
3.根据权利要求2所述的防滑调头控制方法，其特征在于：步骤2中
Figure FDA0002716412120000014
其中，
Figure FDA0002716412120000015
为水下机器人t时刻期望的侧移量，其由航向角ψ、预设的调头侧移量yd和累积侧移量
Figure FDA0002716412120000016
共同决定；λ1为大于零的常数；
其中，
Figure FDA0002716412120000017
L为左右履带间距，V1和V2分别为左右履带的行走速度，
Figure FDA0002716412120000018
4.根据权利要求3所述的防滑调头控制方法，其特征在于：步骤3中
Figure FDA0002716412120000019
其中，m＝m0+mλ为水下机器人质量m0和附加质量mλ之和；J＝J0+Jλ为水下机器人绕攀爬壁面的转动惯量J0和附加转动惯量Jλ之和；
Figure FDA0002716412120000021
其中，τ1和τ2为大于零的常数，k1和k2为大于零的常数，w1、w2、
Figure FDA0002716412120000022
和
Figure FDA0002716412120000023
为所设计的自适应状态量，c0、c2和c3为模型的流体动力参数，且c0、c2和c3均为大于零的常数；Mr为转向时水下机器人侧向摩擦力所产生的阻尼力矩，其力矩方向与航向角速度方向相反，可表示为
Figure FDA0002716412120000027
其中，FN为水下机器人垂推推力之和，其为大于零的恒定值；d为混合驱动水下机器人的长度；μ为左右履带相对工作壁面的摩擦系数；
Figure FDA0002716412120000024
Figure FDA0002716412120000025
其中，
Figure FDA0002716412120000026
为模型不确定和未知干扰之和的上界估计值；ε1、ε2、kρ1、kρ1均为大于零的常数；
Figure FDA0002716412120000031
Δu1＝F1-u1，Δu2＝F2-u2；
Figure FDA0002716412120000032
Figure FDA0002716412120000033
为大于零的常数；κ1和κ2为均为大于零的常量，且κ1≤0.01，κ2≤0.01；ku1和ku2均为大于零的常数。
5.根据权利要求4所述的防滑调头控制方法，其特征在于：步骤4中，
Figure FDA0002716412120000034
其中，壁面所能提供最大牵引力为
Figure FDA0002716412120000035
6.一种水下机器人攀爬模态下的防滑调头控制装置，其特征在于：所述防滑调头控制装置包括处理器和存储器，所述存储器中存储有执行如权利要求1-5任一所述的防滑调头控制方法的计算机程序。
7.一种水下机器人，其特征在于：所述水下机器人包括处理器和存储器，所述存储器中存储有执行如权利要求1-5任一所述的防滑调头控制方法的计算机程序。
CN202011074964.2A 2020-10-09 2020-10-09 水下机器人攀爬模态下的防滑调头控制方法及水下机器人 Active CN112141303B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011074964.2A CN112141303B (zh) 2020-10-09 2020-10-09 水下机器人攀爬模态下的防滑调头控制方法及水下机器人

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011074964.2A CN112141303B (zh) 2020-10-09 2020-10-09 水下机器人攀爬模态下的防滑调头控制方法及水下机器人

Publications (2)

Publication Number Publication Date
CN112141303A true CN112141303A (zh) 2020-12-29
CN112141303B CN112141303B (zh) 2021-11-02

Family

ID=73952744

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011074964.2A Active CN112141303B (zh) 2020-10-09 2020-10-09 水下机器人攀爬模态下的防滑调头控制方法及水下机器人

Country Status (1)

Country Link
CN (1) CN112141303B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113419545A (zh) * 2021-07-23 2021-09-21 西北工业大学 一种具有滑移管制的水下机器人优化控制方法

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103389087A (zh) * 2013-08-07 2013-11-13 上海海事大学 一种轮式机器人位姿解算方法
CN107499476A (zh) * 2017-08-21 2017-12-22 江苏科技大学 水下机器人控制系统及运动控制方法
CN109466724A (zh) * 2019-01-03 2019-03-15 中国石油大学(华东) 一种用于船舶附着物清除的水下爬壁机器人
CN110096063A (zh) * 2019-05-06 2019-08-06 西北工业大学深圳研究院 一种基于测距仪的水下清洗机器人自主倒立着落船底控制方法
KR102120078B1 (ko) * 2019-05-09 2020-06-08 (주)에스엘엠 선체 외면의 수중생물 청소/사멸 장치 및 이를 포함하는 선체 외면 청소 로봇
CN111572663A (zh) * 2020-05-05 2020-08-25 嘉兴勤慎智能技术有限公司 一种具有自适应能力的爬壁机器人
CN111731449A (zh) * 2020-06-14 2020-10-02 西北工业大学 一种基于一致性算法的水下清洗机器人调头侧移量控制方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103389087A (zh) * 2013-08-07 2013-11-13 上海海事大学 一种轮式机器人位姿解算方法
CN107499476A (zh) * 2017-08-21 2017-12-22 江苏科技大学 水下机器人控制系统及运动控制方法
CN109466724A (zh) * 2019-01-03 2019-03-15 中国石油大学(华东) 一种用于船舶附着物清除的水下爬壁机器人
CN110096063A (zh) * 2019-05-06 2019-08-06 西北工业大学深圳研究院 一种基于测距仪的水下清洗机器人自主倒立着落船底控制方法
KR102120078B1 (ko) * 2019-05-09 2020-06-08 (주)에스엘엠 선체 외면의 수중생물 청소/사멸 장치 및 이를 포함하는 선체 외면 청소 로봇
CN111572663A (zh) * 2020-05-05 2020-08-25 嘉兴勤慎智能技术有限公司 一种具有自适应能力的爬壁机器人
CN111731449A (zh) * 2020-06-14 2020-10-02 西北工业大学 一种基于一致性算法的水下清洗机器人调头侧移量控制方法

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113419545A (zh) * 2021-07-23 2021-09-21 西北工业大学 一种具有滑移管制的水下机器人优化控制方法
CN113419545B (zh) * 2021-07-23 2022-09-27 西北工业大学 一种具有滑移管制的水下机器人优化控制方法

Also Published As

Publication number Publication date
CN112141303B (zh) 2021-11-02

Similar Documents

Publication Publication Date Title
CN110333739B (zh) 一种基于强化学习的auv行为规划及动作控制方法
Bibuli et al. Path‐following algorithms and experiments for an unmanned surface vehicle
Im et al. Artificial neural network controller for automatic ship berthing using head-up coordinate system
CN109799814B (zh) 基于运动学模型的履带无人车辆轨迹跟踪控制器设计方法
CN108427414B (zh) 一种自主水下航行器水平面自适应轨迹跟踪控制方法
CN109508022B (zh) 基于分层制导与拖曳力补偿的双无人艇协同溢油围捕方法
Dai et al. Trajectory tracking control for seafloor tracked vehicle by adaptive neural-fuzzy inference system algorithm
CN106990787A (zh) 一种上下体艏向信息融合的波浪滑翔器航点跟踪方法
CN104635773B (zh) 一种基于改进强跟踪滤波状态观测器的船舶动力定位方法
CN107239075A (zh) 自主水下航行器平面直线航线跟踪的智能s面制导控制方法
CN107991872B (zh) 欠驱动auv的虚拟锚泊水平面区域镇定控制方法及实现方法
CN105807789A (zh) 基于t-s模糊观测器补偿的uuv控制方法
CN112141303B (zh) 水下机器人攀爬模态下的防滑调头控制方法及水下机器人
CN109933074B (zh) 一种有领导者的多无人船群集运动控制器结构的设计方法
CN107247413A (zh) 一种基于模糊控制法的高速三体船减纵摇控制方法
CN115826606B (zh) 一种自升式船舶平台的动力定位控制方法
CN112306076A (zh) 一种混合驱动水下机器人动力学模型建立方法
Dukan et al. Sea floor geometry approximation and altitude control of ROVs
CN108664039A (zh) 基于梯度估计的自主式水下机器人场源搜索方法及系统
Dai et al. Nonlinear multi-body dynamic modeling and coordinated motion control simulation of deep-sea mining system
CN112147899A (zh) 一种基于模糊滑模算法的水下机器人自主避障控制方法
CN113093804B (zh) 基于反演滑模控制的无人艇编队控制方法和控制系统
CN108572654A (zh) 基于q学习的欠驱动auv虚拟锚泊三维镇定控制及实现方法
CN113419545B (zh) 一种具有滑移管制的水下机器人优化控制方法
CN115480580A (zh) 一种基于nmpc的水下机器人路径跟踪与避障的控制方法

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