基于高强度弹簧压壁装置的螺旋轮式驱动管道机器人系统的制作方法
【专利说明】
(一)技术领域:
[0001]本发明属于管道检测机器人技术领域，特别是一种基于高强度弹簧压壁装置的螺旋轮式驱动管道机器人系统。
(二)【背景技术】:
[0002]管道运输与铁路运输、公路运输、水路运输和航空运输并称为当今世界五大运输方式。凭借安全、经济、快捷、量大等传输特点，管道输送已广泛应用于石油化工、食品加工、城市供排水、生活资源供给、核工业等领域，在国民经济发展中占有极为重要的地位，是衡量一个国家工业发展水平的主要标志之一。随着国家经济建设的稳步推进，管道工业也迎来了快速发展期。在“十一五”期间，我国管道新增数量将接近34000公里.随着油气管道长时运行，由管道自身缺陷和后期运行期间发生的腐蚀穿孔、人为损坏和自然地质灾害等因素造成的管道泄漏、爆炸等事故将会增多，严重威胁着周边居民人身财产安全和自然环境，影响着国家正常的经济建设。传统管道检测都是由相关人员实施，有全面挖掘发和随机抽样法，工作量大，效率低下。而且有些管道位置人员无法安全到达实施监测，比如输送有毒化学品或内部结构复杂狭小的管道。此外特殊的管道环境也给管道检测带来了很大的困难。由此，管道检测机器人应运而生。管道机器人是一种可沿细小管道内部或外部自动行走、携带一种或多种传感器及操作机械，在工作人员的遥控操作或计算机自动控制下，进行一系列管道作业的机、电、仪一体化系统。具有快速运动、灵活操纵、准确判断和低成本等优点。
[0003]目前，管道机器人多以普通结构的轮式或是履带式为主，可以在水平或是倾斜度不大的管道内运行，但在倾斜度较大甚至垂直的管道内很难稳定运行;驱动电机控制多以传统PID算法为主，但面对结构复杂、环境多变的管道，控制效果不佳。
(三)
【发明内容】
:
[0004]本发明的目的在于提供一种基于高强度弹簧压壁装置的螺旋轮式驱动管道机器人系统，它可以克服现有技术的不足，是一种结构简单，操作方便的机器人系统，它结合了压壁结构和螺旋驱动结构的机械本体设计，使机器人可以在具有倾斜、垂直、微小变径等特征的小型管道内稳定灵活地移动;底层单片机和上位PC机的联合控制方式，可以实现对管道机器人的远程遥控和在线数据采集。
[0005]本发明的技术方案:一种基于高强度弹簧压壁装置的螺旋轮式驱动管道机器人系统，其特征在于它包括本体机械结构和控制系统；其中，所述本体机械结构由螺旋头、机身和保持架构成;所述机身是机器人的主体，所述螺旋头和保持架均安装在机身上;所述螺旋头在圆周方向上分布安装有驱动轮;所述保持架在圆周方向上分布安装有导向轮;所述驱动轮和导向轮均通过连接杆连接到螺旋头和保持架上。
[0006]所述螺旋头在圆周方向上均匀分布着三组驱动轮，每两组驱动轮之间的间隔为120。。
[0007]所述三组驱动轮的每组都由单个车轮构成，而且每个车轮的轴线与管道的中心线成一个夹角α，当车轮沿着管道内壁移动一圈时，管道机器人移动的直线距离为L = 3iDtana，其中D为管道内径。
[0008]所述保持架在圆周方向上均匀分布着三组导向轮，每两组导向轮之间的间隔为120。。
[0009]所述三组导向轮的每组都由单个车轮构成，而且每个车轮的轴线与管道的中心线平行，对机器人起支撑、导向作用。
[0010]所述连接杆的径向装有高强度弹簧，使行走机构即驱动轮和导向轮对管壁始终保持一定的压力和摩擦力。
[0011 ]所述控制系统，包括上位PC机、路由器、Wifi连接器，其特征在于它是由单片机、电源模块、电机驱动模块、直流驱动电机、检测模块和通讯模块构成;其中所述电源模块为单片机和检测模块提供5V直流电，为通讯模块提供3.3V直流电，为电机驱动模块提供12V直流电；所述单片机与通讯模块和检测模块分别呈双向连接，且所述单片机的输入端分别与电源模块和检测模块的输出端连接;所述单片机的输出端连接电机驱动模块的输入端;所述电机驱动模块的输出端输出驱动信号驱动直流驱动电机，最终驱动管道机器人本体运动。
[0012]所述单片机是美国微芯公司生产的PIC(Peripheral Interface Controller)系列单片机芯片。
[0013]所述通讯模块是Wifi通讯传输芯片，可以通过路由器和Wifi连接器与手机、摄像头、上位PC机连接。
[0014]所述电源模块是3节3.7V的可充电式锂电池，作为系统的主电源，系统峰值电压可达12.6V，电容量为2600mAh，可以对其它功能模块和执行元件实现无拖缆式直流供电。
[0015]所述电源模块经稳压元件可输出的电压为5V、3.3V。
[0016]所述电机驱动模块是美国国家半导体公司的LMD18200直流电机驱动芯片。
[0017]所述检测模块是由超声波测距单元、霍尔测速单元、倾角检测单元、温湿度检测单元、定位检测单元和视频检测单元构成;所述超声波测距单元采用超声波传感器;所述霍尔测速单元采用的是霍尔测速元件;所述霍尔测速单元的输入端采集管道机器人本体上导向轮的车轮信息，其输出端连接PIC单片机的输入端;所述倾角检测单元采用倾角传感器;所述温湿度检测单元采用温湿度传感器;所述定位检测单元是非接触式读卡器;所述视频检测单元是Wifi摄像头。
[0018]所述单片机、直流驱动电机、电源模块、电机驱动模块、检测模块和通讯模块均安装在机身内部。
[0019]—种基于高强度弹簧压壁装置的螺旋轮式驱动管道机器人系统的工作方法，其特征在于它是以车轮直线速度为反馈量的全闭环伺服控制系统，采用模糊自适应PID控制算法，具体包括以下步骤:
[0020]①由上位PC机设定管道机器人车轮直线移动速度，作为设定值，通过通讯模块输送给单片机。
[0021]②单片机把速度设定值处理转化成PWM信号，输送给电机驱动模块。再由电机驱动模块驱动直流驱动电机旋转。
[0022]③用霍尔测速元件检测管道机器人直线移动速度脉冲，反馈给单片机；
[0023]④单片机把采集到的霍尔测速元件信号进行计算处理，得到管道机器人实际直线移动速度，通过通讯模块，输送回上位PC机。
[0024]⑤在上位PC机中，实际直线移动速度与设定值作比较，得出的偏差量和偏差率，作为模糊自适应PID控制器的输入量。而输出量则是经模糊自适应PID算法调节后的新的速度设定值，重复①-④的步骤，直至速度偏差为零，系统稳定下来。
[0025]本发明的工作原理:当驱动电机得电旋转时，通过联轴器带动螺旋头旋转，由于驱动轮的轴线与管道的轴线有夹角，则驱动轮会沿管壁做螺旋运动。随着驱动电机轴旋转方向不同，螺旋运动的方向也不同。同时保持架的导向轮轴线与管道的轴线无夹角，受周向摩擦力的作用不会旋转，只会沿着管道轴向运动。这样在驱动电机的带动下，管道机器人本体可以沿着管道轴向运动，而且运动方向与驱动电机旋转方向相对应。由于驱动电机选用的是有刷直流电机，电机转速与电枢电压的大小成正比，改变电枢电压即可控制电机转速。本发明采用数字式PWM控制方式，通过PIC单片机发出可调节脉宽宽度(占空比)的PWM信号，经高速光电耦合器(起避免信号干扰的作用)输送给电机驱动模块，再由电机驱动模块进行信号放大，放大后的信号即可直接驱动电机运转，控制电机的转速和方向。当电机停转后，受高强度压壁弹簧的作用，管道机器人的车轮与管壁间存有较大的摩擦力，可使管道机器人静止在倾斜管道内，不会产生下溜、打滑现象。PIC单片机模块通过PWM接口为电机驱动模块输出PWM控制信号，通过串行接口与通讯模块、读卡器相连接收发送数据，通过A/D转换接口接收倾角传感器采集的数据，通过普通I/O接口接收测