排水管道清淤机器人控制系统技术方案

本实用新型专利技术公开了一种排水管道清淤机器人动力系统，该排水管道清淤机器人动力系统包括第一电机、第二电机、主控制器、第一无线收发模块、第一电机控制模块、第二无线收发模块、第二电机控制模块，第一无线收发模块和第二无线收发模块用于接收信号输送到主控制器，主控制器通过第一电机控制模块控制第一电机转动，主控制器通过第二电机控制模块控制第二电机转动。该动力系统通过无线通信控制电机工作，避免清淤机器人拖带通信线路，降低清淤机器人前进时的负重和阻力，且通过对两个电机单独控制，增强清淤机器人对管道内路况的适应能力，另外，通过对通信模块设置增益天线，使得该动力系统的有效通信距离较远，满足地下管道内的工作要求。

Control system of dredging robot for drainage pipeline

【技术实现步骤摘要】
排水管道清淤机器人控制系统
本技术涉及下水管道清淤设备
，具体涉及一种排水管道清淤机器人控制系统。
技术介绍
排水管道作为城市污水、雨水的排水途径，需要保证其能够通畅的排水，如果排水管道得不到定期定量的清淤作业，淤泥长时间累积会导致排水管道排水能力下降，在下雨天时，城市就很容易成为一个水城，并且下水道的污水会溢出到地表，严重影响城市的整体环境，影响居民生活。目前，我国大多城市排水管道的清淤工作还需依靠人工进入下水道作业，工作效率低下，并且在排水管道中工作不能保证工人的安全和健康。随着自动化技术的发展，采用清淤设备辅助进行清淤作业有着比较稳定的可靠性，清淤设备一方面降低了作业成本，提高作业效率，另一方面能够有效保证工人的健康和安全。清淤机器人是一种较为灵活的清淤设备，具有管道内淤泥累积情况探测、淤泥破碎作业等功能，如公开号为CN108517953A的中国专利文献记载了一种城市下水管道清淤机器人，该机器人通过履带在排水管道内行走，其设有由摄像头与探照灯组成的监控装置，以及碎泥叶轮与高压喷头，能够观测管道内环境，也能够对淤泥进行破碎，使淤泥可随水流走。但是该该专利文献记载的清淤机器人仅设有一台驱动电机，整个机器人的行走能力较弱。另外，现有清淤机器人一般均为牵引式，即机器人后方拖带有供电电线，这样可以保证供电充足且一旦机器人发生故障可通过电线将机器人拉出，保证机器人工作稳定性，但若机器人牵引线路重量较重则会导致机器人前进的阻力较大。
技术实现思路
本技术旨在提供一种排水管道清淤机器人控制系统，以解决现有技术中用于排水管道的清淤机器人前进动力不足、以及在地下行进不方便控制的技术问题。为解决上述技术问题，本技术采用以下技术方案：设计一种排水管道清淤机器人控制系统，包括第一电机、第二电机、主控制器、第一无线收发模块、第一电机控制模块、第二无线收发模块、第二电机控制模块，所述第一无线收发模块用于接收信号输送到所述主控制器，所述主控制器通过所述第一电机控制模块控制所述第一电机转动，所述第二无线收发模块用于接收信号输送到所述主控制器，所述主控制器通过所述第二电机控制模块控制所述第二电机转动。优选的，所述第一无线收发模块和第二无线收发模块均设有外接增益天线。优选的，所述主控制器与所述第一电机控制模块、第二电机控制模块之间通过光电隔离器对应连接。优选的，所述主控制器为AT89S52模块，所述第一无线收发模块和第二无线收发模块均为NRF24L01模块，所述第一电机控制模块和第二电机控制模块均为LMD18200模块。优选的，所述第一电机与所述清淤机器人的两个前轮驱动连接，所述第二电机与所述清淤机器人的两个后轮驱动连接。优选的，还包括24VDC-5VDC电源和5VDC-3.3VDC电源。优选的，所述第一电机与所述清淤机器人的两个前轮驱动连接，所述第二电机与所述清淤机器人的两个后轮驱动连接。优选的，还包括拖带在所述清淤机器人后方的电源线路或设置在所述清淤机器人上的电池。本技术的有益技术效果在于：1.本技术提供的排水管道清淤机器人控制系统通过无线通信控制电机工作，避免清淤机器人拖带通信线路，降低清淤机器人前进时的负重和阻力。2.通过对通信模块设置增益天线，使得该控制系统的有效通信距离较远，满足地下管道内的工作要求。3.通过对两个电机单独控制，两个电机既可以单独工作，也可以同时工作，增强清淤机器人对管道内路况的适应能力。附图说明图1为本技术排水管道清淤机器人控制系统实施例1的电路框图；图2为本技术排水管道清淤机器人控制系统实施例1的主控制器的外围电路图；图3为本技术排水管道清淤机器人控制系统实施例1的第一无线收发模块的外围电路图；图4为本技术排水管道清淤机器人控制系统实施例1的第二无线收发模块的外围电路图；图5为本技术排水管道清淤机器人控制系统实施例1的第一电机控制模块的外围电路图；图6为本技术排水管道清淤机器人控制系统实施例1的第二电机控制模块的外围电路图；图7为本技术排水管道清淤机器人控制系统实施例1的24VDC-5VDC电源电路原理图；图8为本技术排水管道清淤机器人控制系统实施例1的5VDC-3.3VDC电源电路原理图。图中，各标号示意为：第一电机11、第一无线收发模块111、第一电机控制模块112、第一增益天线113、第二电机12、第二无线收发模块121、第二电机控制模块122、第二增益天线123、主控制器13。具体实施方式下面结合附图和实施例来说明本技术的具体实施方式，但以下实施例只是用来详细说明本技术，并不以任何方式限制本技术的范围。实施例1：请一并参阅图1至图8。如图1所示，本技术实施例提供的排水管道清淤机器人控制系统包括第一电机11和第二电机12，该清淤机器人设有四个高花防陷轮胎，第一电机11通过差速器与清淤机器人的前面两个高花防陷轮胎连接，以便于清淤机器人转弯，第二电机12通过减速器与清淤机器人的后面两个高花防陷轮胎连接。该控制系统还设有用于控制第一电机11和第二电机12工作的控制系统，包括主控制器13、第一无线收发模块111、第一电机控制模块112、第二无线收发模块121、第二电机控制模块122，主控制器13为AT89S52单片机，第一无线收发模块111和第二无线收发模块121均为NRF24L01无线通信芯片，第一电机控制模块112和第二电机控制模块122均为LMD18200模块，第一无线收发模块111用于接收地面工作人员通过遥控器发送的信号，然后将该信号输送到主控制器13，主控制器13通过第一电机控制模块112控制第一电机11转动，第二无线收发模块121也用于接收地面工作人员通过遥控器发送的信号，该信号也输送到主控制器13，主控制器13再通过第二电机控制模块122控制第二电机12转动。由于第一电机11和第二电机12均设有单独的无线信号传送系统，因此可控制第一电机11和第二电机12单独工作或同时工作，当清淤机器人前进较为顺畅、没有发生打滑时，可仅启动第一电机11或第二电机12，当清淤机器人出现打滑现象时，可同时启动第一电机11和第二电机12。由于下水管道处于地下，环境较为复杂，不利于通信，因此对第一无线收发模块111外设有第一增益天线113，第二无线收发模块121外设有第二增益天线123，添加增益天线后，第一无线收发模块111和第二无线收发模块121的有效通信距离达200米，能够满足清淤机器人对通信距离的要求。具体的，如图2所示，主控制器13的XTAL2引脚接以有源晶振Y11为核心的时钟电路，RST引脚接以MAX809复位芯片为核心的复位电路。如图3所示，第一无线收发模块111的天线接口ANT1和ANT2连接有第一增益天线113电路，第一增益天线113包括用于收本文档来自技高网...

【技术保护点】
1.一种排水管道清淤机器人控制系统，其特征在于，包括第一电机、第二电机、主控制器、第一无线收发模块、第一电机控制模块、第二无线收发模块、第二电机控制模块，所述第一无线收发模块用于接收信号输送到所述主控制器，所述主控制器通过所述第一电机控制模块控制所述第一电机转动，所述第二无线收发模块用于接收信号输送到所述主控制器，所述主控制器通过所述第二电机控制模块控制所述第二电机转动；所述第一无线收发模块和第二无线收发模块均设有外接增益天线。/n

【技术特征摘要】
1.一种排水管道清淤机器人控制系统，其特征在于，包括第一电机、第二电机、主控制器、第一无线收发模块、第一电机控制模块、第二无线收发模块、第二电机控制模块，所述第一无线收发模块用于接收信号输送到所述主控制器，所述主控制器通过所述第一电机控制模块控制所述第一电机转动，所述第二无线收发模块用于接收信号输送到所述主控制器，所述主控制器通过所述第二电机控制模块控制所述第二电机转动；所述第一无线收发模块和第二无线收发模块均设有外接增益天线。


2.根据权利要求1所述的排水管道清淤机器人控制系统，其特征在于，所述主控制器与所述第一电机控制模块、第二电机控制模块之间通过光电隔离器对应连接。


3.根据权利要求1所述的排水管道清淤机器人控制...

【专利技术属性】
技术研发人员：邵峰，
申请(专利权)人：郑州科技学院，
类型：新型
国别省市：河南;41