基于S7-200_SMAR...在线堵漏机器人控制系统设计_焦建俊.pdf

2023年8期设计创新科技创新与应用Technology Innovation and Application基于 S7-200 SMART 的热力管道在线堵漏机器人控制系统设计焦建俊1，李通1，武文斌1，刘晓貌1，李冰2（1.大唐保定供热有限责任公司，河北 保定 071000；2.华北电力大学 自动化系，河北 保定 071000）受国家环保、民生等宏观政策的影响，近年来集中供热行业快速发展，热力企业供热规模不断扩大，整体供热负荷持续增加，供热管网愈加复杂，大型供热管网或超大型供热管网正在日趋形成1。随着管网运行年限的增加，管网运行环境复杂多变，各种管网泄漏事故日益增多，如焊缝开裂、管道腐蚀泄漏及阀门破损等。在造成经济损失的同时，更是对民生供热稳定构成较大威胁，管网尤其是一次主管网的安全可靠成为不容忽视的问题2-4。在热力管道运维过程中，热力管道的泄漏点封堵是热力管道维护中非常关键的问题，目前全部采用人工加装密封夹具方式进行堵漏处理，工作环境恶劣，人身危害较大5。热力管道的人工堵漏作业方式如图 1 所示。为了提升抢险效率、减少现场泄漏造成的人身伤害，设计了专门用于夹具安装的在线堵漏机器人代替人工完成堵漏工作。通过利用可编程逻辑控制器（PLC）作为主控制器，以在线堵漏机器人控制过程为研究对象，设计了在线堵漏机器人的控制系统，作业技术人员通过遥控装置控制履带式底盘将机器人移动到待维修漏点附近，将夹具固定在机械臂末端，通过遥控装置将夹具安装在漏点管道上，抑制漏点高压高温热水喷射，后续人工进行紧固，实现对漏点的维修。图1热力管道的人工堵漏作业1在线堵漏机器人总体分析1.1在线堵漏机器人整体框架以在线堵漏机器人为研究对象，其整体结构如图2 所示。通过对一台小型挖掘机进行改造，设计了专门用于夹具夹紧的机械臂末端执行机构，实现对夹具的夹紧操作。在线堵漏检修机器人的底盘采用履带式结第一作者简介：焦建俊（1980-），男，工程师。研究方向为机械工程。摘要：针对热力管道泄漏人工堵漏作业存在的人身伤害等问题，对热力管道在线堵漏实际需求进行分析，提出一种基于 S7-200 SMART 控制器的在线堵漏机器人电气控制系统，并进行控制系统的软硬件设计。搭建实验平台对所设计系统进行现场实验，实验结果表明，在线堵漏机器人能够实现热力管道的远程遥控在线堵漏，具有较强的适用性。关键词：热力管道；在线堵漏；机器人；S7-200 SMART；控制系统设计中图分类号：TU985文献标志码：A文章编号：2095-2945（2023）08-0096-04Abstract:In view of the personal injury and other problems existing in the manual leaking stoppage operation of thermalpipeline leakage,the actual demand for online leaking stoppage of thermal pipeline is analyzed,and an electrical control system ofonline leaking stoppage robot based on S7-200 SMART controller is proposed,and the software and hardware are designed.Anexperimental platform is built to carry out field experiments on the designed system.The experimental results show that the onlineleaking stoppage robot can achieve remote online leaking stoppage of thermal pipelines,with strong applicability.Keywords:thermal pipeline;online leak plugging;robot;S7-200 SMART;control system designDOI：10.19981/j.CN23-1581/G3.2023.08.02296-设计创新科技创新与应用Technology Innovation and Application2023年8期构，将堵漏夹紧末端通过机械臂安装在底盘上。在线堵漏机器人控制主要包括行走控制、回转控制、机械臂操控、夹紧末端控制和电气控制系统等。其中机械臂控制主要包括大臂控制、小臂控制、末端垂直偏转控制、末端水平偏转控制及夹具夹紧控制，采用液压方式实现上述控制的动作6-7。大臂控制和小臂控制主要用于对夹紧末端位置进行粗调，末端垂直偏转与水平偏转用于对夹紧末端位置进行细调。夹紧装置一端夹具固定，另一端夹具采用液压推杆方式实现夹具在堵漏过程中的夹紧操作。图2在线堵漏机器人整体结构1.2在线堵漏机器人功能需求与指标在线堵漏机器人主要用于热力管道在发生泄漏时通过技术人员远程操控，实现带压堵漏，其主要功能需求为：能够适应现场恶劣环境；能够实现对管径 100400 mm 的管道进行堵漏；能够对管道压力为 10 MPa 时进行堵漏；末端可以在水平 180范围内回转，在垂直 180范围内转动；爬坡角度最大为 35。除以上功能需求外，在线堵漏机器人还具备液压系统监控、实时在线视频监控当前漏点状况等功能。1.3在线堵漏机器人控制系统整体方案在线堵漏机器人主要包括机械控制、液压控制和电气控制等系统组成，在堵漏过程中需要三部分协作完成。本文主要针对在线堵漏机器人的电气控制部分进行分析研究和设计，根据在线堵漏机器人的结构特性和作业要求，电气控制系统的结构如图 3 所示8。进行热力管道在线堵漏维修时，在线堵漏机器人进行作业的工作流程如下：1）首先将堵漏夹具安装在夹紧末端，并通过夹紧末端控制夹具，使其处于张开状态。2）作业人员通过底盘遥控装置控制履带式底盘将机器人移动到待维修漏点附近。3）通过机械臂遥控装置调整大臂、小臂、末端垂直及水平偏转位置，调整固定在机械臂夹紧末端的位姿。4）在夹紧装置位姿调整到位后，控制夹紧装置将夹具夹在管道漏点位置，抑制漏点高温高压热水的无序喷射。5）夹具在漏点位置夹紧后，由作业人员通过螺栓对夹具进行紧固并注入耐高温专用密封剂，实现对管道漏点的在线堵漏维修。图3在线堵漏机器人电气控制系统结构2在线堵漏机器人电气控制系统硬件设计在线堵漏机器人控制系统采用 PLC 作为核心控制部件，为了降低人员操作可能存在的人身伤害，采用遥控方式实现在线堵漏操作。技术人员通过远程遥控实现对在线堵漏机器人的控制操作，其控制主要包括大臂升降、小臂升降、末端垂直收放、末端水平摆偏和夹具夹紧松开控制等，控制信号通过遥控接收器接收遥控信号，实现对机器人堵漏时的实时控制。根据控制要求，PLC 控制系统需要 14 个输入点和 12 个输出点。本文采用西门子公司的 S7-200 SMART ST60 作为控制器，ST60 具有 36 个输入点和 24 个输出点8-9，能够满足系统控制需要，输入/输出点配置见表 1。数字量输入接口主要用于接收遥控器端发来的机械臂位姿调整及夹紧末端实现夹紧操作等开关控制信号的输入及液压系统过载保护输入；数字量输出用于实现机械臂各部件液压比例阀、换向阀控制信号的输出。遥控接收器安全保护PLC 控制器夹具夹紧马达末端水平回转马达末端垂直转动马达小臂液压马达大臂液压马达97-2023年8期设计创新科技创新与应用Technology Innovation and Application人工操作遥控端采用欧姆（重庆）电子技术有限公司TCS-32-L 型发射器，该遥控发射器采用双摇杆设计，使用寿命可达 100 万次；实时主动控制符合欧盟标准；高达 64 组数字 IO 输入及 10 组比例量输入；自动频率控制，开机时自动选择适当信道。接收器数字输出端与相应控制功能的 PLC 数字输入端连接，实现对在线堵漏时的实时控制操作。表1PLC控制模块输入输出配置表3在线堵漏机器人电气控制系统软件设计在线堵漏机器人在进行堵漏时位置调整、末端夹具姿态调整及夹具的夹紧等控制均由 PLC 控制程序实现，控制程序采用 IEC 1131-3 标准进行编制。3.1堵漏机器人控制流程设计由于热力管道大部分埋在地下，当热力管道出现泄漏时，在漏点附近开挖出作业面，漏点位置所处环境一般都比较复杂，且作业人员采用远程遥控方式对机器人进行操控。为了保证堵漏机器人在进行堵漏作业时的安全性，需要对堵漏机器人的动作流程进行限定。1）堵漏机器人履带底盘在移动过程中，机械臂不得进行动作操作，以免与周围围挡等发生碰撞（底盘操控与机械臂操控分别采用不同遥控器，此处由作业人员人工协调）。2）堵漏机器人底盘移动到位后，可以对机械臂操作，进行末端夹紧装置的位姿调整。3）在机械臂位姿调整时，大臂、小臂的动作可以同时进行，但此时夹紧末端垂直偏转、水平偏转动作不能进行。4）在大臂和小臂控制到位后，通过调整夹紧末端垂直偏转及水平偏转对夹具末端位姿进行精准调整，大臂、小臂控制不能有动作。5）夹具位姿调整到位后，控制夹紧装置将夹具夹在管道漏点处。夹具夹紧及松开操作时，大臂、小臂、垂直偏转、水平偏转均不能有动作。6）当出现过载时，所有动作立即停止，待过载问题排除后，方可继续进行操作。3.2控制系统程序设计根据堵漏机器人控制流程，采用梯形图方式对控制程序进行设计。部分控制功能梯形图如图 4 所示。图4堵漏机器人PLC梯形图程序4实验结果与分析为了验证在线堵漏机器人电气控制系统的可行性和适用性，系统设计完成后在河北联润在线工程技术有限公司搭建了实验平台，并进行了实际的堵漏作业操作。在线堵漏实验的过程及结果如图 5 所示。输入地址 功能 输出地址 功能 I0.0 紧急停止 I0.1 大臂升 Q0.0 大臂升 I0.2 大臂降 Q0.1 大臂降 I0.3 小臂升 Q0.2 小臂升 I0.4 小臂降 Q0.3 小臂降 I0.5 末端上偏 Q0.4 末端收 I0.6 末端下偏 Q0.5 末端放 I0.7 末端左偏 Q0.6 末端左偏 I1.0 末端右偏 Q0.7 末端右偏 I1.1 夹具夹紧 Q1.0 夹具夹紧 I1.2 夹具松开 Q1.1 夹具松开 I1.3 液压泵过载 Q1.2 紧急停止 I1.4 油泵过载 Q1.3 故障报警 I1.5 总机过载 过载保护，对应输入为常闭大臂升控制，紧急停止为常闭大臂降控制，紧急停止为常闭夹具末端水平左偏，紧急停止为常闭夹具末端水平右偏，紧急停止为常闭夹具末端夹紧夹具末端松开M10.0I1.2I0.0Q1.1M10.0Q1.0I1.1I0.0I0.2I0.4I1.2I0.1I0.3I1.1M10.0I1.0I0.0Q0.7I0.2I0.4I1.2I0.1I0.3I1.1M10.0I0.7I0.0Q0.6I0.6I1.0I1.2I0.5I0.7I1.1M10.0I0.2I0.0Q0.0I0.6I1.0I1.2I0.5I0.7I1.1M10.0I0.1I0.0Q0.0I1.3I1.4I1.5M10.098-设计创新科技创新与应用Technology Innovation and Application2023年8期（a）实验过程（b）实验结果图5在线堵漏实验首先将根据待堵漏管道粗细预先制作对应尺寸大小夹具，夹具分为上下两部分，分别安装在夹紧前端的上下固定位置，图 5 中机械臂前端弧形装置即为夹具。实验过程中，通过遥控器将夹具分开，分开距离大于待维修管道外径，以保证夹具能够在管道安装。现场工作人员通过遥控器将机器人履带底盘移动至合适位置，通过控制机械臂大臂、小臂将夹紧末端夹具调整到管道外围，并调整水平偏转及垂直偏转控制实现夹具位置细调，保证夹具与管道平行。操作夹具夹紧末端推动夹具闭合，将上下两部分夹具紧紧夹在管道外壁，由人工进行螺