[发明专利]一种用于水下桩基巡检的蛇形机器人及控制方法

说明书

本发明涉及机器人控制领域，尤其涉及一种用于水下桩基巡检的蛇形机器人及控制方法，本发明通过控制蛇形机器人对水下桩基进行巡检，巡检时，控制蛇形机器人的姿态由直线状转变为弧形状，使蛇形机器人保持弧形状姿态调整与桩基的距离，环抱桩基后调整推进器的推进方向，使得蛇形机器人围绕桩基螺旋上升，采集完整的桩基表面数据完成对桩基的巡检，同时，在巡检过程中，遇到障碍时执行避障动作，改变蛇形机器人的姿态以及推进器的推进方向，使得蛇形机器人跨越障碍，并且，通过控制推进器的推进方向，实时控制蛇形机器人与桩基的最近距离，避免机器人发生碰撞，通过本发明的方法具备广泛的应用前景，能够对处于各类复杂环境状况的桩基完成巡检。

技术领域

本发明涉及机器人控制领域，尤其涉及一种用于水下桩基巡检的蛇形机器人及控制方法。

背景技术

桩基作为桥梁、海上风电系统、钻井平台的重要结构组成部分，长期服役于水下，由于常受到水流冲刷以及船舶撞击，桩基表面容易产生裂缝和变形；此外，桩基因在水下时间过长其表面还容易有生物附着，为了延长桩基的寿命，确保其安全性和稳定性，需要定期对水下桩基表面进行巡检，现阶段通常利用相关检测装置执行巡检动作。

中国专利公开号：CN113681575A，公开了一种面向水下桩基础的有缆检修机器人，包括环抱装置、执行机构和水下平台，通过环抱装置实现对桩基的夹持，通过水下平台实现机器人运动位姿的改变，通过执行机构实现检修作业；

可见，现有技术中还存在以下问题

1、现有技术中，未考虑巡检过程中遇到洋流冲击对巡检造成的影响，无法对应调整巡检装置与桩基表面的距离；

2、现有技术中，未考虑对表面存在凸起或障碍的桩基进行巡检时进行自适应的避障动作；

3、现有技术中，巡检装置笨重，不具备在狭小空间内对桩基进行巡检的应用前景。

发明内容

为解决上述问题，本发明提供一种用于水下桩基巡检的蛇形机器人控制方法，其包括：

步骤S1，控制蛇形机器人各关节上的舵机，以使蛇形机器人各关节以预设角度转向，使蛇形机器人姿态由直线状改变为弧形状；

步骤S2，控制所述蛇形机器人上设置的推进器转变推进方向，以控制所述蛇形机器人以弧形状姿态靠近或远离桩基，直至所述蛇形机器人各连杆与所述桩基的最小距离处于安全距离区间；

步骤S3，控制所述蛇形机器人上设置的推进器转变推进方向以使所述蛇形机器人以弧形状姿态围绕所述桩基螺旋上升完成巡检动作，且，实时获取所述蛇形机器人头部连杆上设置的图像采集单元所传输的图像，以获取所述桩基的完整表面图像；

步骤S4，在所述蛇形机器人进行所述巡检动作时，实时获取所述蛇形机器人的头部连杆设置的测距单元所检测的数据，以判定前方是否存在障碍，并在存在障碍时控制所述蛇形机器人的舵机改变所述蛇形机器人的姿态，并控制所述蛇形机器人的推进器转变推进方向改变所述蛇形机器人的前进方向，以使所述蛇形机器人完成避障动作；

步骤S5，在所述蛇形机器人进行所述巡检动作时，实时获取测距单元所检测的数据，并基于所述蛇形机器人与所述桩基的最近距离，控制所述蛇形机器人的推进器转变推进方向，以使得所述蛇形机器人与所述桩基的最近距离保持在安全距离区间。

进一步地，所述步骤S1中，将蛇形机器人的姿态由直线状改变为弧形状的过程包括，控制所述蛇形机器人保持直线状姿态并与桩基横截面平齐，并通过控制舵机控制所述蛇形机器人各连杆间的关节，使蛇形机器人的各关节向相同方向旋转预设角度。

进一步地，所述步骤S1中，还包括通过所述图像采集单元获取桩基图像并判定桩基横截面最大半径Rm，以将所述最大半径Rm与预设的第一半径对比参量R1以及第二半径对比参量R2进行对比，并根据对比结果确定所述蛇形机器人各关节向相同方向旋转的角度，其中，R2＞R1，