液态环境下溶洞勘探机器人及其控制系统、控制方法

文档序号:1946748 发布日期:2021-12-10 浏览:20次 >En<

阅读说明:本技术 液态环境下溶洞勘探机器人及其控制系统、控制方法 (Karst cave exploration robot in liquid environment and control system and control method thereof ) 是由 高焕兵 鲁守银 王涛 隋首钢 高诺 于 2021-09-07 设计创作,主要内容包括:本发明液态环境下溶洞勘探机器人及其控制系统、控制方法,其中,一种液态环境下溶洞勘探机器人,包括安装支架,所述安装支架下部安装有声呐震源,底部设置有若干个与所述声呐震源连接的声呐传感器,所述声呐震源上方设置有密封电控仓,所述安装支架两侧设置有双向推进器组件,顶部设置有浮力块,所述浮力块、声呐传感器、双向螺旋推进器组件及声呐震源均与所述密封电控仓电连接并受其内的控制系统控制。其目的是为了提供一种省力省时、工作效率高且可在水下主动探测的液态环境下溶洞勘探机器人及其控制系统、控制方法。(The invention discloses a karst cave exploration robot under a liquid environment, a control system and a control method thereof, wherein the karst cave exploration robot under the liquid environment comprises a mounting support, a sonar seismic source is mounted at the lower part of the mounting support, a plurality of sonar sensors connected with the sonar seismic source are arranged at the bottom of the mounting support, a sealed electric control bin is arranged above the sonar seismic source, two-way propeller assemblies are arranged on two sides of the mounting support, a buoyancy block is arranged at the top of the mounting support, and the buoyancy block, the sonar sensors, the two-way spiral propeller assemblies and the sonar seismic source are all electrically connected with the sealed electric control bin and are controlled by the control system in the sealed electric control bin. The karst cave exploration robot is labor-saving, time-saving, high in working efficiency and capable of actively detecting underwater in a liquid environment, and the control system and the control method of the karst cave exploration robot are provided.)

液态环境下溶洞勘探机器人及其控制系统、控制方法

技术领域

本发明涉及水下作业设备技术领域,特别是涉及一种液态环境下溶洞勘探机器人及其控制系统、控制方法。

背景技术

我国岩溶发育区域广阔,尤以广西、云南、贵州、湖南等地较为突出,许多工程需要处理地下岩溶问题。在岩溶发育地区选择桩基础来处理工程问题时,由于钻孔灌注桩不受地层变化限制、不需要接桩和截桩、节省钢材、噪声小、适合大型工程、施工安全且不会产生由抽水引起地面沉降等优点,从而得到广泛的应用。但是在大量岩溶地区的应用实践中,特别在大直径工程桩中,一桩一孔施工勘察难以判断桩底是否存在溶洞、软弱夹层等不良地质体。通常除施工勘察外,还辅以物探手段来确认桩底是否存在不良地质体。

目前,常用的物探手段有地震法、高密度电法、探地雷达法等方法。由于桩孔底探测面小,很多物探方法不能在此环境中发挥出应有的效果。如高密度电法在狭小的桩孔底无法布置物探测线。在地震法中,探测时需要桩端裸露出鲜基的岩面并且还需要整平,桩孔内还有大量积水,因而在钻孔桩泥浆环境中难以实施。探地雷达法在探测时很难在桩底布设发射天线和接收天线,如果直接布设在地表则探测深度和精度均不够,难以满足工作需要。

有鉴于此,目前业内提出一种钻孔灌注桩桩底溶洞声呐探测方法,探索将声呐技术应用于桩底溶洞探测,利用桩孔中的泥浆作为声波传播和耦合的介质来探测桩底的溶洞发育情况。声呐探测是指利用水下声波判断物体的存在、位置及类型的方法和设备。在钻孔灌注桩桩底溶洞探测中,是利用在泥浆及水环境中激发的声呐应力波来探测桩底溶洞。声呐探测这种方法相对容易达到桩底3倍桩径且不小于5m深度范围的探测标准,目前市场上已经有此类产品出现,但在使用过程中存在如下不足之处:

1.声呐探测产品重量较重,施工人员需要花费较大力气将测量仪器送到桩底。

2.目前的测量方法,是将测量仪水平放置到桩底,采集一组数据;然后施工人员使用绞盘等设备拉起测量仪,换一个桩底位置,再次测量;如此重复若干次。同样因为重量较大,这个操作过程费力费时,工作效率极低。

发明内容

本发明要解决的技术问题是提供一种省力省时、工作效率高且可在水下主动探测的液态环境下溶洞勘探机器人及其控制系统、控制方法。

为了解决上述技术问题,本申请提供了如下技术方案:

第一方面,本发明提供了一种液态环境下溶洞勘探机器人,包括安装支架,所述安装支架下部安装有声呐震源,底部设置有若干个与所述声呐震源连接的声呐传感器,所述声呐震源上方设置有密封电控仓,所述安装支架两侧设置有双向推进器组件,顶部设置有浮力块,所述浮力块、声呐传感器、双向螺旋推进器组件及声呐震源均与所述密封电控仓电连接并受其内的控制系统控制。

本发明液态环境下溶洞勘探机器人,所述浮力块内设置有环形翼,所述环形翼在所述控制系统的控制下伸出或缩回浮力块内。

本发明液态环境下溶洞勘探机器人,所述环形翼包括半环形的主翼以及活动连接在其两端且在所述控制系统的控制下伸出或缩回主翼内的两个副翼。

本发明液态环境下溶洞勘探机器人,所述双向螺旋推进器组件包括设置于安装支架前后两侧的用于沿水平方向推进的水平螺旋推进器一、水平螺旋推进器二、水平螺旋推进器一和水平螺旋推进器一,以及,设置于所述安装支架中部的用于沿垂直方向推进的垂直螺旋推进器一、垂直螺旋推进器二。

本发明液态环境下溶洞勘探机器人,所述声呐传感器通过水密接插件与密封电控仓连接。

第二方面,本发明还提供了一种应用于上述任一液态环境下溶洞勘探机器人的控制系统,包括:

主处理器,用于处理传感器数据,并通过电机驱动模块驱动电机运动;

IMU传感器,用于检测所述机器人的姿态和速度以获知其是否处于水平状态;

FLASH芯片,用于存储声呐传感器采集的声呐数据;

USB/WiFi双接口,用于将数据导出到计算机中;

RS-485通信模块,用于机器人与地面终端之间的通信;

水下接近开关,用于探测机器人是否碰壁。

其中,所述地面终端包括显示屏、按键,所述按键用于下发开始/停止工作命令,所述显示屏用于实时显示声呐数据、机器人姿态以及是否碰壁的信息。

第三方面,本发明还提供了一种基于上述控制系统的控制方法,包括如下步骤:

S1、施工人员将机器人放置到桩底,通过地面终端的按键控制机器人开始工作;

S2、机器人进入自主采集数据阶段,将机器人初始的放置位置定义为采集点A,在采集点A上,通过IMU传感器检测所述机器人是否处于水平状态,即声呐传感器是否垂直于桩底,如果不水平,调整机器人姿态,直至水平;

S3、声呐震源发射声呐信号,声呐传感器采集返回数据,并通过RS-485通信模块将数据传递到地面终端,显示屏实时显示数据,同时,采集到的数据存储到FLASH芯片中,采集点A的数据采集完毕;

S4、主处理器通过电机驱动模块驱动电机运动,进而通过垂直螺旋推进器一、垂直螺旋推进器二推动机器人上升,升至高度I,定义一个固定的水平运动方向A,沿该方向A运动80cm后停下,定义此位置为采集点B,参照步骤S2、S3重复进行一次数据采集,采集点B的数据采集完毕;

S5、主处理器再次通过垂直螺旋推进器一、垂直螺旋推进器二推动机器人上升,升至高度II,定义一个固定的水平运动方向B,沿该方向B运动80cm后停下,定义此位置为采集点C,参照步骤S2、S3重复进行一次数据采集,采集点C的数据采集完毕;

S6、主处理器又通过垂直螺旋推进器一、垂直螺旋推进器二推动机器人上升,升至高度III,定义一个固定的水平运动方向C,沿该方向C运动80cm后停下,定义此位置为采集点D,参照步骤S2、S3重复进行一次数据采集,采集点D的数据采集完毕;

S7、机器人上报采集完成,工作结束。

上述步骤S4、S5、S6中,如果在运动80cm的过程中机器人到达桩壁,则停止运动,将相应停止点作为采集点B、采集点C、采集点D,下沉采集。其中,所述水平运动方向B为水平运动方向A转动90°后的方向,所述水平运动方向C为水平运动方向B转动90°后的方向。

本发明液态环境下溶洞勘探机器人及其控制系统、控制方法至少具有以下有益效果:

本发明液态环境下溶洞勘探机器人在控制系统的控制下能够在液体环境下运动,机器人配备声呐探测部件,在水下通过电机与推进器配合实现自主运动,不需人工作业即可完成整个桩底的数据采集。搭载声呐传感器的机器人采用轻量化设计,本体重量轻,减轻了推进器电机的负荷。同时,因为是在液态环境运行,故配置浮力块,通过水的浮力克服机器人本体的重力,使用较小的推动力即可实现机器人的运动,省时省力,机器人自主升降完成勘探,工作效率显著提高。另外,本申请的机器人还能够通过推进器产生冲刷水流,冲刷泥沙,

总之,本申请的机器人结构简单、自重轻,控制系统架构简单,控制方法简单、效率高,同时实现了观测及冲刷浅层泥沙两种功能,实用性大大增强。

下面结合附图对本发明液态环境下溶洞勘探机器人及其控制系统、控制方法作进一步说明。

附图说明

图1为本发明液态环境下溶洞勘探机器人的立体结构示意图;

图2为本发明液态环境下溶洞勘探机器人的主视图;

图3为本发明液态环境下溶洞勘探机器人的后视图;

图4为本发明液态环境下溶洞勘探机器人的俯视图;

图5为本发明液态环境下溶洞勘探机器人的仰视图;

图6为本发明液态环境下溶洞勘探机器人的左视图;

图7为本发明液态环境下溶洞勘探机器人中的环形翼收起状态结构示意图;

图8为本发明液态环境下溶洞勘探机器人中的环形翼展开状态结构示意图;

图9为本发明液态环境下溶洞勘探机器人的控制系统框图;

图10为本发明液态环境下溶洞勘探机器人的控制方法流程图。

具体实施方式

如图1至图6所示,本发明液态环境下溶洞勘探机器人包括作为安装基础的安装支架6,安装支架6呈U字形上开口结构,所述安装支架6下部安装有声呐震源5,底板下表面设置有若干个声呐传感器3,这些声呐传感器3与所述声呐震源5适配并连接。所述声呐震源5上方设置有密封电控仓2,密封电控仓2内布设有控制系统。所述安装支架6的左右两侧设置有6个推进器组成的双向推进器组件4。安装支架6顶部设置有4个结构相同的浮力块1,浮力块1采用玻璃微珠制成,主要是为机器人提供正浮力。所述浮力块1、声呐传感器3、双向螺旋推进器组件4及声呐震源5均与所述密封电控仓2电连接并受其内的控制系统控制,双向螺旋推进器组件4及密封电控仓2是整个推进和控制核心。所述声呐传感器3通过水密接插件与密封电控仓2连接。在进行具体探测作业时,声呐传感器3可以成套更换,极大地提高了实用性。

水下作业的机器人要求实现水下空间多自由度运动,即三种平移运动(推进、升沉、横移)和三种回转运动(转舷、纵倾、横倾)。本申请的机器人的运动是靠电机螺旋桨推进器来实现的。具体的,本实施例中,所述双向螺旋推进器组件4包括6个推进器,具体的,安装支架6前方左右两侧分别设置用于沿水平方向推进的水平螺旋推进器一41、水平螺旋推进器二42,后方左右两侧也分别设置用于沿水平方向推进的水平螺旋推进器一43、水平螺旋推进器一44,这4个推进器在控制系统的控制下负责机器人水平方向运动。安装支架6中部左右两侧设置有用于沿垂直方向推进的垂直螺旋推进器一45、垂直螺旋推进器二46,这2个推进器负责机器人上下方向运动。

本申请的机器人安装六个推进器,根据水底淤泥状况进行相应处理:

⑴少量淤泥:针对只有少量淤泥的情况,在机器人下潜到水底前就可以利用推进器的推进水流将淤泥清洗完成;

⑵淤泥量较多,但在可清洗范围内:在此情况下,机器人配备常用的照明设备与水下摄像机,下潜过程中加速,在接触水底前将四个水平推进器关闭,完全通过两个垂直推进器产生向下冲刷的水流,将淤泥冲散,同时淤泥随着冲刷水流转移至别处;

⑶淤泥较厚,无法通过冲刷完成:在此情况下,机器人在接触水底前保持一定运动速度,利用惯性及垂直推进器推力,使声呐传感器3尽可能的接触硬底,完成探测任务。

本实施例的机器人以配备6个推进器为例进行说明,实际使用时,可以根据勘探工况需要基于本申请的发明构思灵活增减推进器的个数并适应性调整安装位置,此处不一一列举。

结合图7、图8所示,为了调整浮力块1在液体环境中的浮力大小,每个浮力块1内均滑动嵌设有环形翼11,环形翼11通过传动机构连接驱动电机,驱动电机可以为四个分别装设在四个浮力块1内的单独单机,也可以为配设在四个浮力块1之间的一个总电机,在所述控制系统的控制下,该驱动电机驱动所述环形翼11整体伸出或缩回浮力块1内。所述环形翼11包括半环形的主翼111以及活动连接在其两端的两个副翼112。两个副翼112在上述驱动电机的驱动下伸出或缩回主翼111内。主翼111径向向内插入浮力块1中,两副翼112安装在主翼111中,通过调整环形翼11的展开面积调整机器人所受浮力的大小。具体的,两副翼112在上述驱动电机的驱动下完成展开和收起动作,展开动作:电机正传时,主翼111从浮力块1中伸出,浮力增加,电机继续正传,两副翼112从主翼111中伸出展开,浮力进一步增加;收起动作:电机反转时,两副翼112缩回主翼111中,浮力减小,电机继续反转,主翼111缩回到浮力块1中,浮力进一步减小。

结合图9所示,应用于上述液态环境下溶洞勘探机器人的控制系统,包括:

主处理器,选用STM32F407高性能ARM处理器,处理声呐传感器3、IMU(惯性导航单元)传感器、水下接近开关、水深传感器(压力型)等的数据,并通过电机驱动模块驱动上述环形翼11的驱动电机以及六个推进器的电机运动;

IMU(惯性导航单元)传感器,检测所述机器人的姿态(欧拉角)和速度以获知其是否处于水平状态;

大容量的FLASH芯片,用于存储声呐传感器3采集的声呐数据;

USB/WiFi双接口,用于将采集到的上述声呐数据导出到计算机中;

RS-485通信模块,用于机器人与地面终端之间的通信;所述地面终端包括显示屏、按键,所述按键用于下发开始/停止工作命令,所述显示屏用于实时显示声呐数据、机器人姿态以及是否碰壁的信息。

水下接近开关,用于探测机器人是否碰壁,具体的,通过机器人运动速度作为综合判断条件,在非主动停止的情况下,如果通过测量速度检测到机器人水平方向静止,则机器人可能碰到桩壁被阻挡,需要结合接近开关检查的障碍距离共同判断是否碰壁。

结合图10所示,基于上述控制系统的液态环境下溶洞勘探机器人的控制方法,包括如下步骤:

S1、施工人员将机器人放置到桩底,通过地面终端的按键控制机器人开始工作;

S2、机器人进入自主采集数据阶段,将机器人初始的放置位置定义为采集点A,在采集点A上,通过IMU传感器检测所述机器人是否处于水平状态,即声呐传感器3是否垂直于桩底,如果不水平,调整机器人姿态,直至水平;

S3、声呐震源5发射声呐信号,声呐传感器3采集返回数据,并通过RS-485通信模块将数据传递到地面终端,地面终端的显示屏实时显示数据,同时,采集到的数据存储到FLASH芯片中;此步骤中,需判断采集点A的数据是否采集完毕,是,进入下一步骤;否,重复本步骤直至采集点A的数据采集完毕;

S4、主处理器通过电机驱动模块驱动垂直螺旋推进器一45、垂直螺旋推进器二46推动机器人上升,升至高度I,例如,上升30cm,使机器人有一定的垂直行程,依靠重力将声呐传感器3插入桩底泥土中即可,在该高度定义一个固定的水平运动方向A,沿该方向A运动80cm后停下,定义此位置为采集点B,如果在运动80cm的过程中机器人到达桩壁,则停止运动,将相应停止点作为采集点B,此时再次通过垂直螺旋推进器一45、垂直螺旋推进器二46将机器人从采集点B下沉至桩底,并将声呐传感器3插入桩底泥土中,参照步骤S2、S3进行数据采集,直至采集点B的数据采集完毕;

S5、主处理器再次通过垂直螺旋推进器一45、垂直螺旋推进器二46推动机器人上升,升至高度II,定义一个固定的水平运动方向B,该方向B为水平运动方向A顺时针(或逆时针)转动90°之后的方向,沿该方向B运动80cm后停下,定义此位置为采集点C,如果在运动80cm的过程中机器人到达桩壁,则停止运动,将相应停止点作为采集点C,此时再次通过垂直螺旋推进器一45、垂直螺旋推进器二46将机器人从采集点C下沉至桩底,并将声呐传感器3插入桩底泥土中,参照步骤S2、S3进行数据采集,直至采集点C的数据采集完毕;

S6、主处理器又通过垂直螺旋推进器一45、垂直螺旋推进器二46推动机器人上升,升至高度III,定义一个固定的水平运动方向C,该方向C为水平运动方向B转动90°(与步骤S5中的转动方向相同)之后的方向,沿该方向C运动80cm后停下,定义此位置为采集点D,如果在运动80cm的过程中机器人到达桩壁,则停止运动,将相应停止点作为采集点D,此时再次通过垂直螺旋推进器一45、垂直螺旋推进器二46将机器人从采集点D下沉至桩底,并将声呐传感器3插入桩底泥土中,参照步骤S2、S3进行数据采集,直至采集点D的数据采集完毕;

S7、机器人通过RS-485通信模块向控制台上报采集完成,施工人员收回机器人结束工作。

如果施工人员认为数据采集不够,可以通过按键启动新一轮数据采集,具体步骤参见上述步骤S1-S6,此处不复述。

上述步骤中,上升高度I、II、III使机器人有一定的垂直行程即可,以便依靠重力将声呐传感器3插入桩底泥土中即可,例如,上升30cm。

上述步骤中,方向A、B的转动角度均为90°,采集点A、B、C、D在桩底均匀分布而非疏密相间,机器人不会较快碰壁,有利于保证测量结果的精确性。

桩底溶洞声呐探测法是在桩底泥浆中利用声呐探测设备发射声呐弹性波,当声呐遇到桩基底部一定范围内的溶洞、溶蚀裂隙、软弱夹层等不良地质体时,会产生声呐回波,接收回波并根据回波特性可以分析桩底的不良地质体的情况,是一种探测不良地质体的水中物探方法,可用于岩溶、软弱夹层、裂隙带的探测,评价嵌岩桩桩基持力层完整性可靠,是解决建筑物桩基围岩岩溶探测难、探测成本高两大难题的有效途径。根据《岩土工程勘察规范》,当在施工勘察阶段采用大直径嵌岩桩时,应对桩位进行专门的桩基勘察,勘察点应逐桩布置,勘探的深度应不小于桩底以下桩径的3倍并不小于5米。本申请采用桩底溶洞声呐探测方法对液态环境下的溶洞进行勘探,易解释、精度高、异常明显、分辨能力强、工期短、仪器设备投资少、探测费用低,极大地满足了液态环境下的溶洞勘探需求。

以上所述的实施例仅仅是对本发明的优选实施方式进行描述,并非对本发明的范围进行限定,在不脱离本发明设计精神的前提下,本领域普通技术人员对本发明的技术方案作出的各种变形和改进,均应落入本发明权利要求书确定的保护范围内。

17页详细技术资料下载
上一篇:一种医用注射器针头装配设备
下一篇:一种用于潜水器机械手的切割装置

网友询问留言

已有0条留言

还没有人留言评论。精彩留言会获得点赞!

精彩留言,会给你点赞!