CN109577397B - 具备自纠偏功能的履带底盘左右摆动绞吸式清淤机器人 - Google Patents

Abstract

本发明公开了一种具备自纠偏功能的履带底盘左右摆动绞吸式清淤机器人，能够实现水下无害化连续移动快速清淤。该清淤机器人采用履带底盘行进和左右摆动绞吸的方式进行淤泥的收集和泵送，能够实现水下无害化连续移动快速清淤；由于具备自纠偏单元，能够防止清淤机器人，使清淤机器人能够可靠的进行淤泥的清理和障碍的清除。该清淤机器人包括平台框架以及设置在所述平台框架上的履带底盘、左右摆动绞吸机构、清淤机构、泵送机构、自纠偏单元和控制单元；其中履带底盘为该清淤机器人的行走平台，左右摆动绞吸机构和清淤机构为清淤机器人的执行部分。

Description

具备自纠偏功能的履带底盘左右摆动绞吸式清淤机器人

技术领域

本发明涉及一种机器人，具体涉及一种清淤机器人。

背景技术

由于国内很多明渠的总干渠投入运行以来，沿线用水户依赖程度逐渐加深，供水保证率要求高，在今后的运行中，明渠的总干渠输水的希望值是不间断供水。然而，与其他明渠一样，这些明渠总干渠在其运行期间，不可避免在输水渠道及与之交叉的排洪建筑物内形成大量的淤积物，影响供水及危及总干渠安全。为保证不间断供水及总干渠安全，并减轻清淤过程中的二次污染，有必要研究一种水下清淤机器人

结合明渠总干渠运行要求及现场条件，水下清淤机器人应能适应渠道淤积和涵洞淤塞等不同环境，具备水下淤积物清理等功能，实现无害化连续可移动快速清淤。

发明内容

有鉴于此，本发明提供一种具备自纠偏功能的履带底盘左右摆动绞吸式清淤机器人，能够实现水下无害化连续移动快速清淤。

所述的具备自纠偏功能的履带底盘左右摆动绞吸式清淤机器人，包括：平台框架以及设置在所述平台框架上的履带底盘、左右摆动绞吸机构、清淤机构、泵送机构、自纠偏单元和控制单元；

所述履带底盘作为所述清淤机器人的行走机构，设置在所述平台框架底部；所述履带底盘在所述控制单元的控制下行走；

所述左右摆动绞吸机构设置在所述平台框架前端，包括：旋转底座、安装座、伸缩臂和绞吸头；所述旋转底座设置在所述平台框架上，用于在控制单元的控制下带动左右摆动绞吸机构在设定角度范围内左右摆动；所述安装座固定在旋转底座上，所述伸缩臂的一端与所述安装座铰接，另一端铰接绞吸头；所述绞吸头包括：罩体、螺旋绞吸头和马达B；所述罩体为底部开口，左右两边均设置有缺口的空心结构，所述螺旋绞吸头设置在所述罩体内部，所述螺旋绞吸头在所述马达B的驱动下绕竖直方向转动；所述马达B固定在所述罩体上，受控于所述控制单元；

所述泵送机构与设置在所述罩体顶部的吸泥砂管相连，所述泵送机构用于将所述绞吸头绞吸的淤泥泵送到地面；

所述清淤机构包括机械臂和收集筐，在所述左右摆动绞吸机构进行清淤前或清淤后，从所述安装座上拆除伸缩臂和绞吸头，在所述安装座上安装机械臂；所述收集筐设置在所述平台框架顶部；所述机械臂在所述控制单元的控制在设定位置完成拾取动作，并将拾取物放入所述收集筐内；

所述自纠偏单元包括：设置在所述平台框架同一侧面前后端的测高仪B和测高仪A；所述测高仪B和测高仪A实时测量其所在位置与对应侧河道墙面之间的距离，并发送给控制单元；当两个测高仪测量数据的差值超出所述控制单元内预设的差值范围时，所述控制单元通过控制履带底盘纠正所述清淤机器人的行进方向，直至两个测高仪测量数据的差值在预设的差值范围内。

进一步的：还包括防撞导向装置，所述防撞导向装置包括对称设置在所述平台框架左右两侧的防撞轮组，每侧的防撞轮组包括四个以上位于同一竖直面内的防撞轮，所述防撞轮的轴线沿竖直方向。

进一步的：还包括视觉单元，所述视觉单元用于实时获取清淤机器人所在环境的图像，并通过光电复合电缆传输至地面的上位机；所述视觉单元包括：前置声纳、前置照明/摄像单元、后置前照明/摄像单元和后置后照明/摄像单元；其中所述前置声纳设置在平台框架前端中部，在所述平台框架上前端的左右两侧各设置一个镜头朝向前方的前置照明/摄像单元，在所述平台框架后端的中间位置分别设置镜头朝向前方的后置前照明/摄像单元和镜头朝向后方的后置后照明/摄像单元。

进一步的：还包括设置在所述平台框架前端中间位置安装测高仪C以及设置在所述平台框架上的姿态传感器；

当所述清淤机器人用在纵向截面为倒梯形的涵洞时，所述姿态传感器实时监测清淤机器人的姿态并发送给地面的上位机，依据所述姿态传感器所监测的姿态数据能够获知所述清淤机器人当前处于涵洞进口下斜坡段、平面段或涵洞出口上斜坡段；当所述清淤机器人处于平面段时，所述测高仪C实时测量所述清淤机器人所在位置到涵洞出口上斜坡的距离，并发送给上位机，所述上位机结合已知的涵洞的总长获得所述清淤机器人距离涵洞入口的距离。

进一步的：还包括救援单元，所述救援单元包括卷扬机，救援绳的一端缠绕在所述卷扬机上，另一端与清淤机器人相连；

当所述清淤机器人用在明渠时，所述卷扬机固定在岸边；

当所述清淤机器人用在涵洞时，所述卷扬机固定浮桥上，所述浮桥通过两套连接机构与挂放在垂直于涵洞洞口的墙面上的挂板相连；两套连接机构左右对称布置，每套连接机构包括长油缸、短油缸和链条，所述链条的一端与所述浮桥上对应的铰接支座铰接，另一端与所述挂板上对应的铰接支座铰接；所述长油缸的缸体端与浮桥上对应的铰接支座铰接，活塞杆端与挂板上对应的铰接支座铰接；所述卷扬机通过压板固定在所述浮桥上，所述短油缸的缸体端与压板上的铰接支座铰接，活塞杆端与挂板上对应的铰接支座铰接；在所述浮桥上相对洞口的一端设置有U形开口。

有益效果：

(1)该清淤机器人采用履带底盘行进和左右摆动绞吸的方式进行淤泥的收集和泵送，能够实现水下无害化连续移动快速清淤；由于具备自纠偏单元，能够防止清淤机器人，使清淤机器人能够可靠的进行淤泥的清理和障碍的清除。

(2)采用左右摆动绞吸机构进行淤泥的收集，效率高，扰动小，不造成二级污染。

(3)设置清淤机构，能够在吸淤泥前实现水下石块和树枝等较大杂物的拾取，使得吸淤效率更高。

(4)设置防撞导向装置不仅能够防止清淤机器人整车撞坏涵洞内的墙壁，还能够实现定轨道淤泥的清理和障碍的清除。

(5)由于清淤机器人的使用环境人通常无法进入，设置救援单元，从而提高该水下清淤机器人的安全性能。

(6)清淤机构中的机械臂能够与高压水枪或铲刮板等工具相配合，清除涵洞内壁四周出现的贝壳等附着生物。

附图说明

图1该清淤机器人的系统组成框图；

图2为该清淤机器人的整体结构示意图；

图3为该清淤机器人履带底盘的结构示意图；

图4为该清淤机器人左右摆动绞吸机构的结构示意图；

图5为带马达的绞吸头的结构示意图；

图6为设置清淤机构的清淤机器人的结构示意图；

图7为自纠偏单元的结构示意图；

图8为视觉单元的结构示意图；

图9为防撞导向装置的结构示意图；

图10为救援单元的侧视图；

图11为救援单元的俯视图。

其中：1-履带底盘、4-收集筐、5-泵送机构、6-左右摆动绞吸机构、7-清淤机构、8-防撞导向装置、9-平台框架、10-视觉单元、11-履带轮毂、12-履带、13-马达A、14-减速机、16-支撑机构、17-旋转底座、18-安装座、19-支撑油缸、20-伸缩臂、21-绞吸头、22-罩体、23-螺旋绞吸头、24-吸泥砂管、25-马达B、26-滚轮、27-收集篓、33-防撞轮、35-姿态传感器、36-测高仪A、37-测高仪B、38-测高仪C、39-前置声纳、40-前置照明摄像单元、41-后置前照明/摄像单元、42-后置后照明/摄像单元、46-支撑架、47-防撞轮、48-旋转轴、50-清淤机器人、51-挂板、52-长油缸、53-短油缸、54-卷扬机、55-浮桥、56-链条。

具体实施方式

下面结合附图和实施例，对本发明作进一步的详细说明。

实施例1：

本实施例中提供一种具备自纠偏功能的履带底盘左右摆动绞吸式清淤机器人，能够实现水下无害化连续移动快速清淤。

如图1和图2所示，该清淤机器人包括：平台框架9、以及设置在平台框架9上的履带底盘1、左右摆动绞吸机构6、清淤机构7、泵送机构、自纠偏单元和控制单元。其中履带底盘1为该清淤机器人的行走平台，左右摆动绞吸机构6和清淤机构7为清淤机器人的执行部分。

如图3所示，该清淤机器人采用履带底盘1作为行走机构，履带底盘1包括：履带轮毂11、履带12、马达A13和减速机14；平台框架9为整个机器人的支撑结构，其顶部设置有收集筐4，底部两端各设置一个履带轮毂11，履带轮毂11上设置耐磨橡胶履带12，每个履带轮毂11对应一个马达A13作为动力单元，马达A13的动力通过减速机14传递至履带轮毂11，从而为清淤机器的行走提供动力。

该清淤机器人采用左右摆动绞吸机构6吸淤泥，如图4所示，左右摆动绞吸机构6设置在平台框架9前端中心位置，包括：旋转底座17、安装座18、支撑油缸19、伸缩臂20和带马达的绞吸头21。在台框架9前端中心位置设置有支座，旋转底座17安装在该支座上，旋转底座17用于带动左右摆动绞吸机构6在设定角度范围内转动，实现左右摆动；安装座18一端固定在旋转底座17上，另一端与伸缩臂20的一端通过销轴连接，伸缩臂20能够绕该销轴转动，实现上下摆动。伸缩臂20的另一端铰接绞吸头21。支撑油缸19的缸体端固定在安装座18上，活塞杆端与伸缩臂20相连，左右摆动绞吸机构正常工作时，支撑油缸19处于自由伸缩状态，通过支撑油缸19实现自由浮动，能够达到减振的效果；维修时，通过支撑油缸19将绞吸头21支起，便于维修更换绞吸头21。

带马达的绞吸头21的结构如图5所示，包括：罩体22、螺旋绞吸头23、吸泥砂管24、马达25和滚轮26。罩体22为底部开口，左右两边均设置有缺口的空心柱形结构，罩体22内部设置螺旋绞吸头23，螺旋绞吸头23由固定在罩体22顶部的马达25驱动绕竖直方向转动。罩体22底部沿圆周方向设置有四个滚轮26，使绞吸头21左右摆动绞吸淤泥时能够在地面滚动，减小摩擦阻力。

泵送机构主要由潜水电机和吸污泵组成，用于实现淤泥从水下到地面的泵送，设置在罩体22顶部的吸泥砂管24通过管路与泵送机构相连。

左右摆动绞吸机构的工作原理为：设置有罩体22的绞吸头21负责搅动和收集淤泥，罩体22顶部设置有抽吸淤泥的管道(即吸泥砂管24)，绞吸头21搅拌后的污泥通过吸泥砂管24进入设置在平台框架9上的泵送机构，通过泵送机构将淤泥泵送到地面。

由于涵洞中除淤泥外，还会存在石块和树枝，在该清淤机器人前端平台框架的左右两侧还设置有收集篓27，收集篓27前端开口，清淤机器人前行过程中，收集篓27如同撮箕一样收集石块和树枝；等涵洞的淤泥收集和泵送结束后，收集篓27前端开口上扬，避免石块和树枝滑出篓子，通过收集篓27将石块和树枝直接带回地面。

当左右摆动绞吸机构6完成渠道的清淤后，可以将左右摆动绞吸机构6拆除，在安装座18上安装清淤机构7，再到渠道进行大石块的拾取。如图6所示，清淤机构7为五轴机械臂，五轴机械臂的一端与安装座18相连，通过旋转底座17带动机械臂绕竖直方向转动，实现机械臂在周向不同位置操作。机械臂在控制单元的控制下实现水下石块和树枝的拾取，旋转底座17负责整个机械臂的旋转，从而拾取前方的石块和树枝后，向后旋转到设置在平台框架9上的收集筐4里面，最后由清淤机器人带回到地面。

控制单元为设置在平台框架上的下位机，下位机与地面上的上位机配合，实现对清淤机器人的控制，控制单元包括液压控制单元和电控单元，液压控制单元用于控制该清淤机器人上的液压部分，本方案中，履带底盘1中的马达A13、绞吸头21中的马达B25均为液压马达，五轴机械臂也采用液压动力源，由此，履带底盘1、绞吸头21、五轴机械臂、支撑油缸19以及泵吸机构均受控于液压控制单元；清淤机器人上的电子元器件均受控于电控单元。下位机能够接收上位机的指令，对清淤机器人进行控制。

该清淤机器人有两种应用环境，具体如下：

第一种：人工河道是明渠，笔直的，水流顺流而下，水流截面为倒梯形，水质较清澈；个别时候也要经过横在河道的桥梁或者暗洞。要求水下设备不可将河道两边的岸堤或桥墩碰坏，更不能将涵洞的四面墙壁碰坏，需要水下设备实现河道淤泥的清理和障碍(石头或树枝，编织物)的清除。

第二种：人工河道本身是横穿明渠下方，且在明渠之下的倒梯形涵洞，且是满水状态下，水流截面是正方形，通常称为穿渠涵洞，河水浑浊。穿渠涵洞自身内部所有尺寸(如洞长，倒梯形坡度，坡度俯视长度，纵坡面样貌和所有相关尺寸)预知。要求水下设备不可将倒梯形涵洞四面墙壁碰坏，需要水下设备实现涵洞淤泥的清理和障碍(石头或树枝，编织物)的清除。

为保证清淤机器人能够可靠的进行淤泥的清理和障碍的清除，防止其跑偏，在该清淤机器人上设置自纠偏单元，如图7所示，自纠偏单元包括：姿态传感器35和两个测高仪，在平台框架15同一侧面的前后端各安装一个测高仪，本实施例中平台框架15的右侧面的前后端各安装一个测高仪，分别为位于右前端的测高仪B37和位于右后端的测高仪A36；姿态传感器35位于平台框架15正中位。

当水下清淤机器人用在明渠时：明渠河道笔直，水流截面为倒梯。由于在平台框架9同一侧面的前后端各安装有一个测高仪，当清淤机器人笔直行走不跑偏的情况时，其平台框架9侧面到水流截面为倒梯形的河道墙面的距离为固定值，即平台框架9同一侧面的两个测高仪(测高仪B37和测高仪A36)测得平台框架9侧面到河道墙面的距离理论上应该是相等的，测高仪B37和测高仪A36将测量数据实时发送给位于地面上的上位机，当两个测高仪的测量数据相同或差值在设定范围内时，表明清淤机器人没有跑偏，反之，当上位机显示两个测高仪(测高仪B37和测高仪A36)测量的数据差值在不断增大，表明清淤机器人跑偏；此时通过上位机通过控制履带底盘(即控制履带底盘的马达)实现对清淤机器人的纠偏，直至测高仪B37和测高仪A36的测量数据相同或差值在设定范围内，由此可以有效避免水下机器人撞到岸边或者桥墩，很好实现水下自身定位，使清淤机器人一直笔直的前行。同时平台框架9正中的姿态传感器35实时监测清淤机器人的姿态，当水下清淤泥机器人某一边履带底盘遇到大的石头造成车身倾斜时，姿态传感器的X轴，Y轴(令姿态传感器的Y轴方向与清淤机器人的行进方向一致、X轴与清淤机器人的横向一致)会产生联合倾角反馈给上位机，当水下清淤机器人越过石块后，姿态传感器的X轴，Y轴产生联合倾角均会反馈为零，这些数据的及时反馈，对地面操控人员具有很好的指导意义。

当水下清淤机器人用在穿过明渠的涵洞里时：由于穿渠涵洞自身是倒梯形，从涵洞进口向下到倒梯形底边有一个斜坡(为涵洞进口下斜坡段)，走过倒梯形水平底边(为平面段)后又有一个向上的斜坡(为涵洞出口上斜坡段)到涵洞另一端的出口。由此，如果既要保证清淤机器人在穿渠涵洞正常行进，又不碰到涵洞内的墙壁，同时，还要实现淤泥的清理和障碍的清除，就需要清淤机器人能够实现浑水状态下的自纠偏。此时，自纠偏单元的功能实现过程与在明渠里使用时相同。

实施例2：

在上述实施例1的基础上，为了能够实现清淤机器人在涵洞里的定位，在平台框架9前端中间位置安装测高仪C38，测高仪C38为长量程测高仪，自定位过程为：姿态传感器35实时监测清淤机器人在X轴、Y轴、Z轴(Z轴与竖直方向一致)的倾斜角度并反馈到地面的上位机，测高仪C38实时将测量数据反馈到地面的上位机；依据所述姿态传感器35所监测的姿态数据能够获知清淤机器人当前处于涵洞进口下斜坡段、平面段或涵洞出口上斜坡段，如当清淤机器人从涵洞进口往下走斜坡时，姿态传感器35向上位机提供一个机身向下倾斜的数据，表明此时清淤机器人位于涵洞进口的下斜坡上；当向下的斜坡走完，姿态传感器向下倾斜的数据可能接近为零，相当于开始走倒梯形底边，因为进口斜坡的俯视距离比较短，也是事先已知，唯一不能确认的是清淤机器人距离涵洞入口的距离，此时平台框架前端的长量程测高仪C38能够测量出自身到涵洞出口斜坡的距离，并发送给上位机，上位机依据已知的涵洞的总长能够反算清淤机器人距离涵洞入口的距离，由此能够实现清淤机器人的自身定位，从而开展涵洞的清理淤泥和障碍工作。

实施例3：

在上述实施例1或实施例2的基础上，在平台框架9上设置用于监测清淤机器人所在环境的视觉单元，如图8所示，视觉单元包括：安装在平台框架9上的前置声纳39、前置照明摄像单元40、后置前照明/摄像单元41和后置后照明/摄像单元42。其中前置声纳39设置在平台框架9前端中部，在平台框架9上收集筐4前端的左右两侧各设置一个镜头朝向前方的前置照明摄像单元40，平台框架9上收集筐4后端的中间位置分别设置后置前照明/摄像单元41和后置后照明/摄像单元42，其中后置前照明/摄像单元41的镜头朝向前方，后置后照明/摄像单元42的镜头朝向后方。视觉单元中的用于将通过照明/摄像单元采集水下的图像以及通过声纳探测得到的图像轮廓，通过水下清淤机器人尾端的光电复合电缆传输到地面的上位机，通过上位机的多屏幕显示器显示在屏幕上，便于地面人员根据图像操控上位机的操纵杆和数据处理系统联合向下位机(即清淤机器人的控制单元)发出指令，指导清淤机器人水下执行机构(左右摆动绞吸机构和清淤机构)工作。

实施例4：

在上述实施例1-3的基础上，为防止水下清淤机器人整车撞坏涵洞内的墙壁，在平台框9上设置有防撞导向装置，如图9所示，防撞导向装置：包括对称设置在平台框架9左右两侧的胶轮组，每侧的胶轮组包括四个在竖直面内呈矩形分布的橡胶轮作为防撞轮47，防撞轮47的轴线沿竖直方向，具体安装方式为：支撑架46的一端与平台框架9相连，另一端通过轴承与旋转轴48相连，防撞轮47通过轴承套装在与旋转轴48外部。

防撞导向装置的主要作用是当履带底盘1跑偏时，可以防止水下清淤机器人整车撞坏涵洞内的墙壁；同时清淤机器人在行进时可以一侧或两紧贴涵洞墙面顺着墙边行驶，实现定轨道淤泥的清理和障碍的清除。如针对3米的涵洞，假设设计车身1.5米宽，可以直接将防撞导向装置两边各设计为0.7米宽，由此，水下清淤机器人可以直接依靠两边的各四个胶轮顺着涵洞前行，实现定轨道淤泥的清理和障碍的清除。对于大于3米小于等于6米的涵洞，可以让一边的四个胶轮贴墙，顺着墙边行驶，完成定距离的清淤后，再让另外一边的四个胶轮也贴墙顺着墙边行驶，完成另外一半的定距离的清淤。由此通过两次的进出涵洞，就可以完成涵洞的定距离清淤工作。

实施例5：

在上述实施例1-实施例4的基础上，由于清淤机器人的使用环境人通常无法进入，为提高该水下清淤机器人的安全性能，增加救援单元。

当清淤机器人用在明渠时：救援单元仅包括卷扬机54，直接将卷扬机54固定在岸边，能够承载10吨的尼龙绳的一端缠绕在卷扬机54上，另一端与清淤机器人50相连。正常情况下，尼龙绳飘在水面上，不受载荷的；当发生突发情况如明渠内水流超过1m/s，影响清淤机器人50工作或清淤机器人50故障时，通过卷扬机54回收尼龙绳，从而拖曳清淤机器人50，特别是清淤机器人50从笔直河道退回岸边时，有了卷扬机54的拖曳，可以防止清淤机器人50倒退时打滑，更加快速和便捷自己爬行上岸。

当清淤机器人用在穿过明渠的涵洞里时：增加如图10和图11所示的救援单元，此时救援单元包括：挂板51、两个长油缸52、两个短油缸53、卷扬机54、浮桥55和两个链条56。救援单元通过浮桥55安装在，具体为：首先将涵洞洞口的满水抽到半水状态，放下浮桥55，由于不能够破坏洞口墙面，在垂直于洞口的墙面上安放挂板51，通过挂板51固定浮桥55。挂板51上焊接用于连接油缸和铰接链条56的铰接支座(共六个)，同时在浮桥55上安装有四个铰接支座，分别用于连接两个长油缸52和两个链条56。一个长油缸52、一个短油缸53和一个链条56位一套连接机构，其中两套连接机构左右对称布置，以保证浮桥表面水平；且浮桥55上链条56的连接位离涵洞洞口最近，长油缸52的连接位离涵洞洞口最远；挂板51上链条56的连接位位于最下方，长油缸52的连接位位于最上方。救援单元的安装过程为：首先，用两个链条56链接挂板51和浮桥55；然后，用两只长油缸52连接挂板51和浮桥55，并用插销固定(长油缸52的缸体端与浮桥55上的铰接支座铰接，活塞杆端与挂板51上的铰接支座铰接)。然后在浮桥55上安放卷扬机54，能够承载10吨的尼龙绳的一端缠绕在卷扬机54上，另一端下清淤机器人50相连。卷扬机54通过压板固定在浮桥55上，压板上安装两个铰接支座，用两只短油缸53连接挂板51和压板，并用插销固定(短油缸53的缸体端与压板上的铰接支座铰接，活塞杆端与挂板51上的铰接支座铰接)。由此在涵洞洞口设置了一个固定的浮动桥面，而且该浮桥55在相对洞口的一端设置有U形开口，便于清淤机器人50倒退回洞口时，方便起吊。

实施例6：

在上述实施例1-实施例5的基础上，增加清洗系统，所述清洗系统包括机械臂、绑缚在机械臂上的高压水枪以及设置在地面与高压水枪通过水管相连的高压清洗泵。

清洗系统的功能如下：

(1)由于现有涵洞均具有内倒角，清淤机器人很难用清淤机构将其完全清干净，当在完成涵洞主要清淤工作后，在五轴机械臂上绑缚高压水枪，实现对涵洞左右两边内倒角处淤泥的冲洗清理，将其冲洗到涵洞的中央，然后再通过清淤机器人的左右摆动绞吸机构进行收集，通过泵送机构进行泵送，将涵洞内残留的淤泥泵送到地面的泥水分离设备中。

(2)当涵洞内壁附着有贝壳类的生物时，由于附着力不强，涵洞两侧面和顶部可以通过高压水枪冲洗的方式将贝壳类的附着物直接冲洗清理后，再由清淤机器人的左右摆动绞吸机构进行收集，通过泵送机构进行泵送，完成涵洞内的清淤工作。

(3)由于清淤机器人是一机两用，即在渠道里使用，又要在涵洞里使用，因此，当清淤机器人从涵洞里使用完毕后，通过高压水枪对清淤机器人进行冲水清洗后，再到明渠里进行淤泥的收集和泵送。

实施例7：

在上述实施例1-实施例5的基础上，由于目前部分地区的涵洞内壁四周出现附着的贝壳生物，附着力不强，直径在10-60毫米之间。针对这种特殊淤积物，水下清淤机器人衍生出铲刮系统，具体为，在清淤机器人的五轴机械臂的末端安装铲刮板，通过五轴机械臂在旋转底座17的带动下旋转，使得五轴机械臂垂直涵洞的侧壁，通过安装在其前端的铲刮板，再通过五轴机械臂的前伸实现对涵洞两侧内壁的贝壳等附着物的铲刮，最后通过清淤机器人的左右摆动绞吸机构进行淤泥和贝壳收集，通过泵送机构进行泵送，完成涵洞内的清淤工作。涵洞顶端的贝壳生物还是需要依靠上述实施例3中高压水枪的冲洗，将贝壳附着生物冲洗下来，再通过清淤机器人清理。

虽然，上文中已经用一般性说明及具体实施例对本发明作了详尽的描述，但在本发明基础上，可以对之作一些修改或改进，这对本领域技术人员而言是显而易见的。因此，在不偏离本发明精神的基础上所做的这些修改或改进，均属于本发明要求保护的范围。

Claims (9)

1.具备自纠偏功能的履带底盘左右摆动绞吸式清淤机器人，其特征在于：包括：平台框架(9)以及设置在所述平台框架(9)上的履带底盘(1)、左右摆动绞吸机构(6)、清淤机构(7)、泵送机构(5)、自纠偏单元和控制单元；

所述履带底盘(1)作为所述清淤机器人的行走机构，设置在所述平台框架(9)底部；所述履带底盘(1)在所述控制单元的控制下行走；

所述左右摆动绞吸机构(6)设置在所述平台框架(9)前端，包括：旋转底座(17)、安装座(18)、伸缩臂(20)和绞吸头(21)；所述旋转底座(17)设置在所述平台框架(9)上，用于在控制单元的控制下带动左右摆动绞吸机构在设定角度范围内左右摆动；所述安装座(18)固定在旋转底座(17)上，所述伸缩臂(20)的一端与所述安装座(18)销接，另一端连接绞吸头(21)；所述绞吸头(21)包括：罩体(22)、螺旋绞吸头(23)和马达B(25)；所述罩体(22)为底部开口，左右两边均设置有缺口的空心结构，所述螺旋绞吸头(23)设置在所述罩体(22)内部，所述螺旋绞吸头(23)在所述马达B(25)的驱动下绕竖直方向转动；所述马达B(25)固定在所述罩体(22)上，受控于所述控制单元；

所述泵送机构(5)与设置在所述罩体(22)顶部的吸泥砂管(24)相连，所述泵送机构(5)用于将所述绞吸头(21)绞吸的淤泥泵送到地面；

所述清淤机构(7)包括机械臂和收集筐(4)，在所述左右摆动绞吸机构(6)进行清淤前或清淤后，从所述安装座(18)上拆除伸缩臂(20)和绞吸头(21)，在所述安装座(18)上安装机械臂；所述收集筐(4)设置在所述平台框架(9)顶部；所述机械臂在所述控制单元的控制下在设定位置完成拾取动作，并将拾取物放入所述收集筐(4)内；

所述自纠偏单元包括：设置在所述平台框架(9)同一侧面前后端的测高仪B(37)和测高仪A(36)；所述测高仪B(37)和测高仪A(36)实时测量其所在位置与对应侧河道墙面之间的距离，并发送给控制单元；当两个测高仪测量数据的差值超出所述控制单元内预设的差值范围时，所述控制单元通过控制履带底盘(1)纠正所述清淤机器人的行进方向，直至两个测高仪测量数据的差值在预设的差值范围内。

2.如权利要求1所述的具备自纠偏功能的履带底盘左右摆动绞吸式清淤机器人，其特征在于：还包括防撞导向装置，所述防撞导向装置包括对称设置在所述平台框架(9)左右两侧的防撞轮组，每侧的防撞轮组包括四个以上位于同一竖直面内的防撞轮(47)，所述防撞轮(47)的轴线沿竖直方向。

3.如权利要求1所述的具备自纠偏功能的履带底盘左右摆动绞吸式清淤机器人，其特征在于：还包括视觉单元，所述视觉单元用于实时获取清淤机器人所在环境的图像，并通过光电复合电缆传输至地面的上位机；所述视觉单元包括：前置声纳(39)、前置照明/摄像单元(40)、后置前照明/摄像单元(41)和后置后照明/摄像单元(42)；其中所述前置声纳(39)设置在平台框架(9)前端中部，在所述平台框架(9)上前端的左右两侧各设置一个镜头朝向前方的前置照明/摄像单元(40)，在所述平台框架(9)后端的中间位置分别设置镜头朝向前方的后置前照明/摄像单元(41)和镜头朝向后方的后置后照明/摄像单元(42)。

4.如权利要求1所述的具备自纠偏功能的履带底盘左右摆动绞吸式清淤机器人，其特征在于：还包括设置在所述平台框架(9)前端中间位置安装测高仪C(38)以及设置在所述平台框架(9)上的姿态传感器(35)；

当所述清淤机器人用在纵向截面为倒梯形的涵洞时，所述姿态传感器(35)实时监测清淤机器人的姿态并发送给地面的上位机，依据所述姿态传感器(35)所监测的姿态数据能够获知所述清淤机器人当前处于涵洞进口下斜坡段、平面段或涵洞出口上斜坡段；当所述清淤机器人处于平面段时，所述测高仪C(38)实时测量所述清淤机器人所在位置到涵洞出口上斜坡的距离，并发送给上位机，所述上位机结合已知的涵洞的总长获得所述清淤机器人距离涵洞入口的距离。

5.如权利要求1所述的具备自纠偏功能的履带底盘左右摆动绞吸式清淤机器人，其特征在于：还包括救援单元，所述救援单元包括卷扬机(54)，救援绳的一端缠绕在所述卷扬机(54)上，另一端与清淤机器人(50)相连；

当所述清淤机器人(50)用在明渠时，所述卷扬机(54)固定在岸边；

当所述清淤机器人(50)用在涵洞时，所述卷扬机(54)固定浮桥(55)上，所述浮桥(55)通过两套连接机构与挂放在垂直于涵洞洞口的墙面上的挂板(51)相连；两套连接机构左右对称布置，每套连接机构包括长油缸(52)、短油缸(53)和链条(56)，所述链条(56)的一端与所述浮桥(55)上对应的铰接支座铰接，另一端与所述挂板(51)上对应的铰接支座铰接；所述长油缸(52)的缸体端与浮桥(55)上对应的铰接支座铰接，活塞杆端与挂板(51)上对应的铰接支座铰接；所述卷扬机(54)通过压板固定在所述浮桥(55)上，所述短油缸(53)的缸体端与压板上的铰接支座铰接，活塞杆端与挂板(51)上对应的铰接支座铰接；在所述浮桥(55)上相对洞口的一端设置有U形开口。

6.如权利要求1、2、3、4或5所述的具备自纠偏功能的履带底盘左右摆动绞吸式清淤机器人，其特征在于：在所述平台框架(9)的左右两侧均设置有收集篓(27)。

7.如权利要求1、2、3、4或5所述的具备自纠偏功能的履带底盘左右摆动绞吸式清淤机器人，其特征在于：所述左右摆动绞吸机构(6)还包括支撑油缸(19)，所述支撑油缸(19)的缸体端固定在所述安装座(18)上，活塞杆端与所述伸缩臂(20)相连，所述左右摆动绞吸机构工作时，所述支撑油缸(19)处于自由伸缩状态。

8.如权利要求1、2、3、4或5所述的具备自纠偏功能的履带底盘左右摆动绞吸式清淤机器人，其特征在于：在所述机械臂上连接高压水枪，所述高压水枪通过水管与地面的高压清洗泵相连，形成清洗系统，用于对淤泥以及墙面附着物进行冲洗清理。

9.如权利要求1、2、3、4或5所述的具备自纠偏功能的履带底盘左右摆动绞吸式清淤机器人，其特征在于：在所述机械臂的末端安装铲刮板，形成铲刮系统，用于铲刮侧壁附着物。

Images