CN110209181B - 一种基于测距仪的水下清洗机器人自主竖立着落船舷控制方法 - Google Patents
一种基于测距仪的水下清洗机器人自主竖立着落船舷控制方法 Download PDFInfo
- Publication number
- CN110209181B CN110209181B CN201910373255.5A CN201910373255A CN110209181B CN 110209181 B CN110209181 B CN 110209181B CN 201910373255 A CN201910373255 A CN 201910373255A CN 110209181 B CN110209181 B CN 110209181B
- Authority
- CN
- China
- Prior art keywords
- cleaning robot
- underwater cleaning
- distance
- ship board
- angle
- 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.)
- Active
Links
Images
Classifications
-
- 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
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0875—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted to water vehicles
Abstract
本发明提出了一种基于测距仪的水下清洗机器人自主竖立着落船舷控制方法。针对着落控制中参考量难以推导,以及船舷倾角信息无法先验获取的问题,本发明利用垂直安装于清洗机器人底面的测距仪实时测量机器人与船舷之间的距离,分别推导机器人相对船舷坐标系的俯仰角、横滚角,以及相对于船舷的距离。在着落过程中,为了解决当角度与距离同时控制时导致的机器人位置“漂移”问题,本发明提出了先“角度控制”后“角度和距离同时控制”的两阶段PID控制策略,使机器人相对船舷坐标系的俯仰角、横滚角先趋于零,再使距离之差趋于零,从而实现无“漂移”自主着落船舷的目标,并通过仿真验证了所提算法的有效性。
Description
技术领域
本发明涉及的是用于水下清洗机器人自主控制技术领域,具体为一种基于测距仪的水下清洗机器人自主竖立着落船舷的控制方法。
背景技术
随着远洋运输事业的飞速发展,船舶作为海上交通运输的主要工具发挥着日益重要的作用。船舶在航行过程中,海洋生物、贝类以及锈皮等会附着在船壁上,其会增 加船舶阻力,减小船舶航行速度,降低船舶使用寿命。因此,为了延长船舶使用寿命, 提高航行效率,保证航行安全,需要对船舶表面附着物进行定期清洗。
由于传统水下手工清洗方式存在效率低、安全性差和成本高等问题,因此,需要研究和寻求机器人和自动化技术在水下清洗作业中的应用。水下清洗机器人作为能提 高水下清洗作业自动化水平的有效工具之一,其能大大节省劳动力,提高清洗效率, 具有广阔的应用前景和发展空间。
水下清洗机器人的工作模式通常有三种组成,即巡游模式、着落船体模式、船体爬行模式,其中,着落船体模式包括着落船舷和着落船底两类,是介于机器人水下巡 游和船体爬行模式之间的过渡阶段。由于船舷倾角信息无法先验获取且不同船的船舷 倾角不同,因此,如何选取合适的传感器和控制策略实现自主稳定的着落是一项极具 挑战性的研究课题。另外,在实际着落过程中,当角度和距离同时控制时,水下清洗 机器人会产生“漂移”现象,如何设计合适控制方法抑制“漂移”也是着落船舷控制中的 一个重要研究方向。
综上所述,水下清洗机器人实现自主着落船舷存在三个难点问题:1、船舷倾角信息无法先验获取;2、如何选取恰当的传感器,并根据传感器量测值构造出合适的着落 控制参考量;3、着落过程中水下清洗机器人会产生“漂移”问题。
发明内容
为解决现有技术存在的问题,本发明提出一种基于测距仪的水下清洗机器人自主竖立着落船舷控制方法,其中针对着落控制中参考量难以获取以及船舷倾角信息无法 先验获取的问题,本发明利用多个垂直安装于清洗机器人底部的测距仪实时测量机器 人与船舷之间的距离,分别解算水下清洗机器人相对船舷坐标系的俯仰角、横滚角, 以及相对于船舷的距离;本发明的控制目标是使机器人与船舷之间的俯仰角、横滚角 和距离误差趋于零,从而实现着落贴合船舷的目标;另外,在着落过程中,为了解决 角度差与距离差同时控制时导致的水下清洗机器人位置“漂移”问题,本发明提出了先 “角度控制”后“角度和距离同时控制”的两阶段控制策略。
本发明的技术方案为:
所述一种基于测距仪的水下清洗机器人自主竖立着落船舷控制方法,其特征在于: 包括以下步骤:
步骤1:利用安装于水下清洗机器人底面的测距仪实时测量各个测距仪与船舷之间的距离,并根据测距仪的安装参数以及实时测量得到的各个测距仪与船舷之间的距 离,解算出水下清洗机器人底面相对船舷的俯仰角θ、横滚角φ和距离d;根据使机器 人自主着落至船舷的指令参数,得到待控制的水下清洗机器人底面相对船舷的俯仰角 差值Δθ=θ-θr、横滚角差值Δφ=φ-φr和距离差值Δd=d-dr;
步骤2:对于安装在水下清洗机器人底面的推进器,采用了先“角度控制”后“角度和距离同时控制”的两阶段PID控制策略进行控制:
当|Δθ|>β1或|Δφ|>β2时为第一阶段,其中β1和β2均为设定的大于零的阈值常数; 第一阶段的控制律为:
当|Δθ|≤β1且|Δφ|≤β2时为第二阶段,第二阶段的控制律为:
步骤3:根据测量的水下清洗机器人航向角ψ和航向角参考值ψd,对安装在水下 清洗机器人侧面的推进器进行控制,航向角控制律为:
其中为安装在水下清洗机器人侧面的推进器的推力向量,Nside为 安装在水下清洗机器人侧面的推进器数量,为分配矩阵C3的伪逆,分配矩阵C3由水 下清洗机器人侧面推进器的安装参数确定,Kp3,Ki3,Kd3为PID航向角控制中的待 调参数,Δψ=ψ-ψd。
进一步的优选方案,所述一种基于测距仪的水下清洗机器人自主竖立着落船舷控制方法,其特征在于:安装在水下清洗机器人底面的四个测距仪M1、M2、M3和M4, 测距方向垂直于水下清洗机器人底面,测量的与船舷之间的距离分别为d1、d2、d3和 d4;四个测距仪处于矩形的四角,其中测距仪M1与M4的连线垂直于水下清洗机器人 俯仰轴Zb;测距仪M1与M2的距离为l4,测距仪M1与M4的距离为l5;得到水下清洗机 器人底面相对船舷的俯仰角θ、横滚角φ和距离d为:
进一步的优选方案,所述一种基于测距仪的水下清洗机器人自主竖立着落船舷控制方法,其特征在于:θr=0,φr=0,dr为当水下清洗机器人处于贴合船舷状态时四 个测距仪中心点到船舷的距离。
进一步的优选方案,所述一种基于测距仪的水下清洗机器人自主竖立着落船舷控制方法,其特征在于:安装在水下清洗机器人底面有四个推进器T1、T2、T3、T4,四个 推进器分布在矩形四个角上,且推力方向垂直于水下清洗机器人底面,推进器T1和T4的 连线垂直于水下清洗机器人俯仰轴Zb;推进器T1和T2的距离为l1,推进器T1和T4的距离 为l2;
第一阶段的控制律为:
第二阶段的控制律为
进一步的优选方案,所述一种基于测距仪的水下清洗机器人自主竖立着落船舷控制方法,其特征在于:安装在水下清洗机器人侧面有两个推进器T5和T6;推进器T5和T6的推力方向平行于水下清洗机器人的横滚轴Xb,推进器T5和T6的距离为l3,航向角控 制律为
有益效果
本发明通过垂直安装于清洗机器人底部的测距仪对机器人与船舷之间的距离进行 测量,并在此基础上,解算出机器人与船舷之间的俯仰角、横滚角和距离差,从而解 决了自主着落控制中参考量难以获取以及船舷倾角信息无法先验获取的问题。
另外,本发明提出先“角度控制”后“角度和距离同时控制”的两阶段控制策略,可以解决在贴合过程中当角度差与距离差同时控制时导致的水下清洗机器人位置“漂移” 问题。
本发明的附加方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实践了解到。
附图说明
本发明的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得明显和容易理解,其中:
附图1为基于测距仪的水下清洗机器人自主着落控制原理框图。
附图2为四个测距仪均可探测到船舷的工作示意图。
附图3为水下清洗机器人六个推进器分布示意图。
附图4为先“角度控制”后“角度和距离同时控制”的两阶段控制策略下水下清洗机器人的X-Z与X-Y平面的轨迹图。
附图5为角度和距离同时控制策略下水下清洗机器人的X-Z与X-Y平面的轨迹 图。
附图6为水下清洗机器人X方向位置与三个相对地面坐标系的欧拉角变化曲线。
附图7为水下清洗机器人与船舷坐标系之间的距离和三个欧拉角跟踪误差曲线。
具体实施方式
下面详细描述本发明的实施例,所述实施例是示例性的,旨在用于解释本发明,而不能理解为对本发明的限制。
本实施例中水下清洗机器人的初始位置和欧拉角分别为:即X0=-1m,Y0=1m,Z0=-1m,初始速度和角速度均为零, dr=3,仿真步长Ts=0.1s,l1=0.574m,l2=0.454m,l3=0.454m,控制 参数为:Kp1=-0.18,Kp2=-1,Kp3=-1,Kp4=-1,Ki1=0,Ki2=0,Ki3=0,Ki4=0, Kd1=0,Kd2=0,Kd3=0,Kd4=0。
利用安装于水下清洗机器人底面的测距仪实时测量各个测距仪与船舷之间的距离,并根据测距仪的安装参数以及实时测量得到的各个测距仪与船舷之间的距离,解 算出水下清洗机器人底面相对船舷的俯仰角θ、横滚角φ和距离d。
图2给出了四个测距仪均可测距的工作示意图,其中,M1、M2、M3和M4分别 为布置在水下清洗机器人底部的1号、2号、3号和4号超声波测距仪器;这四个测距 仪在水下清洗机器人底部呈矩形分布,其中l4和l5分别为矩形的边长,具体地l4为M1与 M2(M3与M4)之间的距离,l5为M1与M4(M2与M3)之间的距离。d1、d2、d3和d4分别为1号、2号、3号和4号超声波测距仪器沿Yb方向到船舷的测量距离;N1、N2、 N3和N4分别为四个测距仪在沿Yb方向在船舷上的投影。
利用四个垂直安装于水下清洗机器人底面的测距仪实时测量机器人与船舷之间的 距离,分别解算出水下清洗机器人相对船舷坐标系的俯仰角、横滚角和距离,其表达 式为:
其中,d为水下清洗机器人的四个测距仪的中心点到船舷的距离;θ和φ分别为水下 清洗机器人相对船舷壁面的俯仰角和横滚角。此外,定义Δθ=θ-θr,Δφ=φ-φr, Δd=d-dr为待控制的角度和距离差;为使机器人自主着落至船舷,定义θr=0,φr=0, dr为当水下清洗机器人处于贴合船舷状态时四个测距仪中心点到船舷的距离。
根据图3所示的六个推进器分布示意图,可知在推进器推力T1、T2、T3、T4、T5和 T6作用下的水下清洗机器人受到的力Fy和力矩Mx、My、Mz分别为:
其中,T1、T2、T3、T4、T5和T6分别为1至6号推进器的推力值;Fy、Mx、My和 Mz分别为在六个推进器作用下的y方向推力,x方向力矩,y方向力矩,z方向力矩; l1、l2、l3如图3所示。
在推导出的距离测量值与俯仰、横滚角之差的对应关系的基础上,给出了跟踪误差的比例-微分-积分与Fy、Mx、My和Mz之间的关系如下所示:
对于安装在水下清洗机器人底面的推进器,采用了先“角度控制”后“角度和距离同 时控制”的两阶段PID控制策略进行控制:
第一阶段,当|Δθ|>β1或|Δφ|>β2时,β1和β2均为大于零的小常数,其控制律设计 为:
第二阶段,当|Δθ|≤β1且|Δφ|≤β2时,其控制律设计为:
水下清洗机器人在着落过程中会受洋流等外界力矩的干扰,会造成机器人航向角不稳定的问题;因此,在着落船舷过程中需要对航向角进行实时控制,以防止因航向 角不稳定对贴合效果造成的不利影响。水下清洗机器人的航向角控制律设计为:
其中,Kp3,Ki3,Kd3为待调的PID参数,Δψ=ψ-ψd,ψ和ψd分别为水下清洗 机器人的航向角和航向角参考值。
以上设计的自主着落控制方法可以使水下清洗机器人与船舷之间的俯仰角差、横滚角差和距离差趋于零,且能有效抑制贴合过程中的位置漂移。
图4给出了先“角度控制”后“角度和距离同时控制”的两阶段控制策略下机器人在X-Z与X-Y平面的轨迹图,通过对比图5中角度和距离同时控制算法下的平面轨迹图, 可知本发明所提的控制策略能较好地抑制着落过程中的位置漂移。由图6和7可知, 本节所提的控制律能使x→3,φ→0°,ψ→0°,θ→90°,即实现了以俯仰角90°方式 着落至船舷。上述仿真结果验证了本发明所提自主着落船舷的控制策略的有效性,实 现了以俯仰角90°的稳定贴合至船舷。
尽管上面已经示出和描述了本发明的实施例,可以理解的是,上述实施例是示例性的,不能理解为对本发明的限制,本领域的普通技术人员在不脱离本发明的原理和 宗旨的情况下在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。
Claims (5)
1.一种基于测距仪的水下清洗机器人自主竖立着落船舷控制方法,其特征在于:包括以下步骤:
步骤1:利用安装于水下清洗机器人底面的测距仪实时测量各个测距仪与船舷之间的距离,并根据测距仪的安装参数以及实时测量得到的各个测距仪与船舷之间的距离,解算出水下清洗机器人底面相对船舷的俯仰角θ、横滚角φ和距离d;根据使机器人自主着落至船舷的指令参数,得到待控制的水下清洗机器人底面相对船舷的俯仰角差值Δθ=θ-θr、横滚角差值Δφ=φ-φr和距离差值Δd=d-dr;
步骤2:对于安装在水下清洗机器人底面的推进器,采用了先“角度控制”后“角度和距离同时控制”的两阶段PID控制策略进行控制:
当|Δθ|>β1或|Δφ>β2时为第一阶段,其中β1和β2均为设定的大于零的阈值常数;第一阶段的控制律为:
当|Δθ|≤β1且|Δφ|≤β2时为第二阶段,第二阶段的控制律为:
步骤3:根据测量的水下清洗机器人航向角ψ和航向角参考值ψd,对安装在水下清洗机器人侧面的推进器进行控制,航向角控制律为:
3.根据权利要求2所述一种基于测距仪的水下清洗机器人自主竖立着落船舷控制方法,其特征在于:θr=0,φr=0,dr为当水下清洗机器人处于贴合船舷状态时四个测距仪中心点到船舷的距离。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910373255.5A CN110209181B (zh) | 2019-05-06 | 2019-05-06 | 一种基于测距仪的水下清洗机器人自主竖立着落船舷控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910373255.5A CN110209181B (zh) | 2019-05-06 | 2019-05-06 | 一种基于测距仪的水下清洗机器人自主竖立着落船舷控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110209181A CN110209181A (zh) | 2019-09-06 |
CN110209181B true CN110209181B (zh) | 2021-12-24 |
Family
ID=67786911
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910373255.5A Active CN110209181B (zh) | 2019-05-06 | 2019-05-06 | 一种基于测距仪的水下清洗机器人自主竖立着落船舷控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110209181B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113110531B (zh) * | 2021-04-19 | 2021-11-12 | 飞马滨(青岛)智能科技有限公司 | 一种水下机器人与待洗船只的自动贴壁方法 |
CN115503898A (zh) * | 2022-08-16 | 2022-12-23 | 飞马滨(青岛)智能科技有限公司 | 一种水下清洗机器人与待清洗船的自适应贴合方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102722177A (zh) * | 2012-06-27 | 2012-10-10 | 哈尔滨工程大学 | 具有pid反馈增益的自主水下航行器三维直线路径跟踪控制方法 |
CN103274016A (zh) * | 2013-04-16 | 2013-09-04 | 哈尔滨工程大学 | 一种高速水下自主航行器及其专用控制方法 |
CN104316932A (zh) * | 2014-11-05 | 2015-01-28 | 哈尔滨工程大学 | 一种uuv抵近海底作业的定高航行系统及航行方法 |
CN105676867A (zh) * | 2016-04-21 | 2016-06-15 | 南京工程学院 | 一种rov水下机器人悬浮姿态稳定控制方法 |
CN108628171A (zh) * | 2018-06-15 | 2018-10-09 | 哈尔滨工程大学 | 一种用于船舶动力定位系统的改进推力分配方法 |
CN108776428A (zh) * | 2018-06-10 | 2018-11-09 | 西北工业大学 | 一种自主水下航行器四通道耦合控制方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3346006B2 (ja) * | 1993-12-27 | 2002-11-18 | 石川島播磨重工業株式会社 | Rovの自動制御方法 |
JP2003011888A (ja) * | 2001-07-05 | 2003-01-15 | Mitsubishi Heavy Ind Ltd | 水中ロボット |
WO2006112416A1 (ja) * | 2005-04-15 | 2006-10-26 | Mitsui Engineering & Shipbuilding Co., Ltd. | 自動船位保持制御方法及び自動船位保持制御装置 |
-
2019
- 2019-05-06 CN CN201910373255.5A patent/CN110209181B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102722177A (zh) * | 2012-06-27 | 2012-10-10 | 哈尔滨工程大学 | 具有pid反馈增益的自主水下航行器三维直线路径跟踪控制方法 |
CN103274016A (zh) * | 2013-04-16 | 2013-09-04 | 哈尔滨工程大学 | 一种高速水下自主航行器及其专用控制方法 |
CN104316932A (zh) * | 2014-11-05 | 2015-01-28 | 哈尔滨工程大学 | 一种uuv抵近海底作业的定高航行系统及航行方法 |
CN105676867A (zh) * | 2016-04-21 | 2016-06-15 | 南京工程学院 | 一种rov水下机器人悬浮姿态稳定控制方法 |
CN108776428A (zh) * | 2018-06-10 | 2018-11-09 | 西北工业大学 | 一种自主水下航行器四通道耦合控制方法 |
CN108628171A (zh) * | 2018-06-15 | 2018-10-09 | 哈尔滨工程大学 | 一种用于船舶动力定位系统的改进推力分配方法 |
Non-Patent Citations (3)
Title |
---|
清洗机器人自主清洗方法研究;唐智国等;《计算机测量与控制》;20121231;第2270-2272,2280页 * |
船身自动清洁技术的研究与实现;张宝利等;《舰船科学技术》;20170430;第177-179页 * |
面向海底光学探测使命的自治水下机器人水平路径跟随控制;马艳彤等;《兵工学报》;20170630;第38卷(第6期);第1147-1153页 * |
Also Published As
Publication number | Publication date |
---|---|
CN110209181A (zh) | 2019-09-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110096063B (zh) | 一种基于测距仪的水下清洗机器人自主倒立着落船底控制方法 | |
Graver et al. | Underwater glider model parameter identification | |
Lindegaard et al. | Fuel-efficient rudder and propeller control allocation for marine craft: Experiments with a model ship | |
WO2017099219A1 (ja) | 水中航走体の経路設定方法、それを用いた水中航走体の最適制御方法及び水中航走体 | |
CN110209181B (zh) | 一种基于测距仪的水下清洗机器人自主竖立着落船舷控制方法 | |
WO2021230356A1 (ja) | 船舶の自動誘導方法、船舶の自動誘導プログラム、船舶の自動誘導システム、及び船舶 | |
CN106444822B (zh) | 一种基于空间矢量场制导的平流层飞艇路径跟踪控制方法 | |
CN107991872B (zh) | 欠驱动auv的虚拟锚泊水平面区域镇定控制方法及实现方法 | |
CN102323820A (zh) | 一种智能舵系统及其控制方法 | |
Rigatos | Sensor fusion-based dynamic positioning of ships using Extended Kalman and Particle Filtering | |
US11816994B1 (en) | Proximity sensing system and method for a marine vessel with automated proximity sensor location estimation | |
US11027804B2 (en) | Underwater sailing body and method of controlling posture of underwater sailing body | |
CN111679669A (zh) | 一种无人船自主精准停靠方法及系统 | |
CN102411657A (zh) | 自由航行状态下耙吸挖泥船动力定位的滤波器设计方法 | |
CN113778099A (zh) | 基于NDT算法和Hybrid A*算法的无人船路径规划方法 | |
CN109343555A (zh) | 基于仿鱼侧线的岸壁效应测量及船舶艏向补偿控制方法 | |
Wirtensohn et al. | Modelling and identification of a twin hull-based autonomous surface craft | |
JP5956233B2 (ja) | 航路保持制御装置及び船舶 | |
CN110456786B (zh) | 基于地形特征提取的uuv海底地形跟踪系统及跟踪方法 | |
CN113126633B (zh) | 一种轻型长航程auv的零攻角定深航行控制方法 | |
Moe et al. | Path following of underactuated marine underwater vehicles in the presence of unknown ocean currents | |
TWI745996B (zh) | 用於操作水運船舶的系統、裝置及方法 | |
Awale et al. | Fusion of navigation solutions from different navigation systems for an autonomous underwater vehicle | |
Mosleh et al. | An Alternative Method to Simulate Three-Dimensional Point Scan Sensors Aboard Moving Vehicle | |
LIU et al. | Design of variable stability ship control system for ship intelligent navigation test |
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 |