一种水下清洗机器人与待清洗船的自适应贴合方法技术

本发明专利技术提供了一种水下清洗机器人与待清洗船的自适应贴合方法，包括：控制水下清洗机器人开启自适应控制模式，并根据自适应控制模式开启前的姿态数据控制水下清洗机器人的初始稳定姿态；实时获取水下清洗机器人的刷盘状态信息以及水下清洗机器人姿态数据；若刷盘为开启状态，则对水下清洗机器人姿态数据进行稳态滤波处理确定水下清洗机器人的稳态姿态数据，并根据稳态姿态数据实时调节水下清洗机器人的姿态，若刷盘为关闭状态，则获取刷盘关闭前水下清洗机器人姿态数据，根据刷盘关闭前水下清洗机器人姿态数据计算水下清洗机器人的刷盘面的贴合方向，根据水下清洗机器人的刷盘面的贴合方向控制水下清洗机器人沿贴合方向移动。移动。移动。

【技术实现步骤摘要】
一种水下清洗机器人与待清洗船的自适应贴合方法


[0001]本专利技术涉及水下机器人
，尤其涉及一种水下清洗机器人与待清洗船的自适应贴合方法。

技术介绍

[0002]船的稳定性和机动性是船只设计中的重大问题，既要足够稳定，又要机动灵活，还要航速快，船体形状需要根据这些方面做平衡设计，所以，在船体不同位置存在不同程度的弯曲。而水下清洗机器人在贴船清洗过程中，伴随船体不同位置的曲率的变化，水下清洗机器人的姿态要根据所处位置船体的实际曲率进行对应贴合。
[0003]目前，水下机器人的控制多是由水上远程控制。但在实际作业过程中，这种控制方式存在着很多未可预见的问题。以刷盘清洗机器人进行船体清洗为例，刷盘清洗机器人吸附行进时完全贴合船体，和船体曲率时刻保持一致，而船体不同位置的曲率是不一样的如果仅依据远程姿态控制指令来控制刷盘清洗机器人，则会出现刷盘清洗机器人实际与船体贴合的姿态与远程控制的姿态冲突，刷盘清洗机器人会向着远程控制的姿态进行调整，与吸附行进时状态相悖。
[0004]因此，如何设计一种水下清洗机器人与船体的自适应贴合方法，避免远程控制的姿态与清洗机器人实际与船体贴合的姿态冲突成为亟待解决的问题。

技术实现思路

[0005]为了克服现有技术存在的缺点与不足，本专利技术提供一种水下清洗机器人与待清洗船的自适应贴合方法，在水下清洗机器人贴船作业时，使水下清洗机器人与船体始终保持贴合，避免水下清洗机器人与船体脱离，影响船体清洗效果和效率。
[0006]本专利技术提供一种水下清洗机器人与待清洗船的自适应贴合方法，包括：
[0007]S1、控制水下清洗机器人开启自适应控制模式，并根据自适应控制模式开启前的姿态数据控制水下清洗机器人的初始稳定姿态；
[0008]S2、实时获取水下清洗机器人的刷盘状态信息以及水下清洗机器人姿态数据；
[0009]S3、若刷盘为开启状态，则对水下清洗机器人姿态数据进行稳态滤波处理确定水下清洗机器人的稳态姿态数据，并根据稳态姿态数据实时调节水下清洗机器人的姿态，若刷盘为关闭状态，则获取刷盘关闭前水下清洗机器人姿态数据，根据刷盘关闭前水下清洗机器人姿态数据计算水下清洗机器人的刷盘面的贴合方向，根据水下清洗机器人的刷盘面的贴合方向控制水下清洗机器人沿贴合方向移动，直至水下清洗机器人与待清洗船贴合。
[0010]进一步地，所述水下清洗机器人姿态数据包括水下清洗机器人的横滚角、俯仰角和偏航角。
[0011]进一步地，S3中所述稳态滤波处理包括均值滤波、中值滤波和卡尔曼滤波。
[0012]进一步地，S3中所述根据刷盘关闭前水下清洗机器人姿态数据计算水下清洗机器人的刷盘面的贴合方向，包括：
[0013]根据刷盘关闭前水下清洗机器人的横滚角、俯仰角和偏航角计算水下清洗机器人的刷盘面在站体坐标系下的法向量，其中，水下清洗机器人的刷盘面在站体坐标系下的法向量为机器人坐标系的Z轴在站体坐标系下的方向向量，计算公式如下：
[0014]x＝
‑
cos(yaw)sin(pitch)cos(roll)+sin(yaw)sin(roll)，
[0015]y＝
‑
sin(yaw)sin(pitch)cos(roll)
‑
cos(yaw)sin(roll)，
[0016]z＝cos(pitch)cos(roll)，
[0017]其中，roll为水下清洗机器人的横滚角，pitch为水下清洗机器人的俯仰角，yaw为水下清洗机器人的偏航角；
[0018]根据水下清洗机器人的刷盘面在站体坐标系下的法向量控制水下清洗机器人沿法向量方向移动。
[0019]与现有技术相比，采用上述技术方案后，本专利技术至少具有如下有益效果：
[0020]1、在水下清洗机器人的刷盘开启时，水下清洗机器人在刷盘的作用下吸附在船体上时，为了在水流与船体震动条件下，保证水下清洗机器人与船体贴合，需要不断更新水下清洗机器人姿态，受到采集的姿态数据起伏影响，频繁更新水下清洗机器人姿态会降低水下清洗机器人的运行效率，对采集到的水下清洗机器人的横滚角、俯仰角和航向角等姿态数据进行稳态滤波，实现姿态数据采集的相对稳定，降低姿态更新频率，保证水下清洗机器人姿态维持在相对稳定的状态，提高运行效率。
[0021]2、在水下清洗机器人的刷盘关闭时，刷盘吸力失效，为了在水流与船体震动条件下，避免水下清洗机器人与船体脱离，需要控制水下清洗机器人向船体方向移动，通过获取水下清洗机器人的横滚角、俯仰角和航向角等姿态数据计算水下清洗机器人的刷盘向船体的贴合方向，进而控制水下清洗机器人沿贴合方向移动，在刷盘吸力失效情况下，保证了水下清洗机器人与船体贴合。
附图说明
[0022]为了更清楚地说明本专利技术实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本专利技术的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动性的前提下，还可以根据这些附图获得其他的附图。
[0023]图1为本专利技术提供的一种水下清洗机器人与待清洗船的自适应贴合方法的流程图。
具体实施方式
[0024]下面将结合本专利技术实施例中的附图，对本专利技术实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本专利技术保护的范围。
[0025]如图1所示，本专利技术实施例提供了一种水下清洗机器人与待清洗船的自适应贴合方法，适用于带刷盘的水下清洗机器人，包括如下步骤：
[0026]S1、控制水下清洗机器人开启自适应控制模式，并根据自适应控制模式开启前的
姿态数据控制水下清洗机器人的初始稳定姿态；
[0027]在一种可能的实施方式中，所述水下清洗机器人姿态数据包括水下清洗机器人的横滚角、俯仰角和偏航角，这些姿态数据可通过搭载在水下清洗机器人上的测量设备进行测量，例如电子罗盘。
[0028]S2、实时获取水下清洗机器人的刷盘状态信息以及水下清洗机器人姿态数据；
[0029]水下清洗机器人达到稳态后，水下清洗机器人的刷盘可能开启或关闭，根据水下清洗机器人的刷盘所处的不同状态，自适应地控制水下清洗机器人的姿态，以使水下清洗机器人与船体贴合。
[0030]S3、若刷盘为开启状态，则对水下清洗机器人姿态数据进行稳态滤波处理确定水下清洗机器人的稳态姿态数据，并根据稳态姿态数据实时调节水下清洗机器人的姿态，若刷盘为关闭状态，则获取刷盘关闭前水下清洗机器人姿态数据，根据刷盘关闭前水下清洗机器人姿态数据计算水下清洗机器人的刷盘面的贴合方向，根据水下清洗机器人的刷盘面的贴合方向控制水下清洗机器人沿贴合方向移动，直至水下清洗机器人与待清洗船贴合。
[0031]在水下清洗机器人的刷盘开启时，由于水本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种水下清洗机器人与待清洗船的自适应贴合方法，其特征在于，包括：S1、控制水下清洗机器人开启自适应控制模式，并根据自适应控制模式开启前的姿态数据控制水下清洗机器人的初始稳定姿态；S2、实时获取水下清洗机器人的刷盘状态信息以及水下清洗机器人姿态数据；S3、若刷盘为开启状态，则对水下清洗机器人姿态数据进行稳态滤波处理确定水下清洗机器人的稳态姿态数据，并根据稳态姿态数据实时调节水下清洗机器人的姿态，若刷盘为关闭状态，则获取刷盘关闭前水下清洗机器人姿态数据，根据刷盘关闭前水下清洗机器人姿态数据计算水下清洗机器人的刷盘面的贴合方向，根据水下清洗机器人的刷盘面的贴合方向控制水下清洗机器人沿贴合方向移动，直至水下清洗机器人与待清洗船贴合。2.根据权利要求1所述的水下清洗机器人与待清洗船的自适应贴合方法，其特征在于，所述水下清洗机器人姿态数据包括水下清洗机器人的横滚角、俯仰角和偏航角。3.根据权利要求1所述的水下清洗机器人与待清洗船的自适应贴合方法，其特征在于，S3中所述稳态滤波处理包括均值滤波、中值滤波和卡尔曼滤波...

【专利技术属性】
技术研发人员：陈晓博，刘羽菁，车明，官涛，张河楠，
申请(专利权)人：飞马滨青岛智能科技有限公司，
类型：发明
国别省市：