[发明专利]一种管道清淤机器人装置及其控制方法

摘要

本发明公开了一种管道清淤机器人装置及其控制方法，包括底座、传动组件和清淤组件；所述清淤组件由挂座、机械臂和机械爪组成，挂座的空腔内安装有锂电池、驱动转换器、超声波测距仪、无线收发装置和电路板，电路板上焊接有电性元器件，各元件之间相互电路连接；所述传动组件由伺服电机、步进电机、伸缩杆和丝杆组成，伸缩杆穿过滑座，通过在底座内部安装的齿轮与步进电机传动连接，伸缩杆和丝杆连接的滑座的背面焊接有轴，并通过在轴上套接的齿轮与伺服电机传动连接。本发明通过简单的传动组件和清淤组件的设置，将其固定在底座上，占用空间小，手持操作，工作简单，整体装置集成度高，携带搬运方便，全自动化，节约大量的人力物力。

主权项

1.一种管道清淤机器人装置，其特征在于，包括底座(1)、传动组件(2)和清淤组件(3)；所述清淤组件(3)由挂座(31)、机械臂(32)和机械爪(33)组成；所述机械爪(33)传动连接机械臂(32)，机械臂(32)的另一端固定在挂座(31)上，挂座(31)的一侧安装有摄像头(34)；所述挂座(31)的空腔内安装有锂电池(311)、驱动转换器(312)、超声波测距仪(313)、无线收发装置(314)和电路板(315)；所述锂电池(311)分别与驱动转换器(312)、超声波测距仪(313)、无线收发装置(314)、电路板(315)电连接，并为其提供工作电源；所述电路板(315)上焊接有单片机(3151)、温度传感器(3152)、氧气浓度传感器(3153)、湿度传感器(3154)、光强传感器(3155)和位移传感器(3156)，各传感器之间分别通过电路与单片机(3151)连接；所述传动组件(2)由伺服电机(21)、步进电机(22)、伸缩杆(23)和丝杆(24)组成；所述丝杆(24)穿过挂座(31)，在丝杆(24)的一端部固定有前压板(25)，前压板(25)的顶部安装有LED照明灯(26)和限位传感器(27)，限位传感器(27)设置在LED照明灯(26)的两侧；所述丝杆(24)的另一端部固定连接伸缩杆(23)，伸缩杆(23)穿过滑座(28)，通过在底座(1)内部安装的齿轮与步进电机(22)传动连接；所述滑座(28)设置在底座(1)上，滑座(28)与底座(1)的接触面上焊接有滑块(281)；所述底座(1)上固定有纵向滑轨(11)，纵向滑轨(11)与滑座(28)背面的滑块(281)嵌合；所述滑座(28)的背面焊接有轴(282)，并通过在轴(282)上套接有齿轮与伺服电机(21)传动连接。