管道清淤机器人及控制系统研究

1、河北理工大学毕业论文课题名称：管道清淤机器人及控制系统研究姓 名：刘 刚工程领域：机械工程所属学院：机械工程学院学校导师：王丰 教授2006年 6 月 24 日目录摘要abstract .21管 道 清 淤述1.1课题综述31.2国内外管道清淤机器人技术现状 31.2.1 i玉i 夕丨/ j 31.2.2国内的技术现状 466统分1.3本市管道清淤技术现状1.4管道清淤机器人总体控制方案2 清 淤 机 器 人 控 制 析72.1控制系统控制器的选择 2.2 s7-200 系列 plc 概述221 s7-200 系列 plc 简介72.2.2程序设计中用到的plc指令 112.3 步进电机及驱动

2、器间丿 i ». 152.3.1步进电机152.3.2步进电机驱动电源 162.4电机驱动器的选择 172.4.1 步进电机驱动醫咅的选择.172.4.2直流电机驱动器的选择 203基于plc的清淤机器人控制系统设计 243清淤机器人的控制过程.3.2 plc的选型和通信3.2.1 plc的选型3.2.2两台plc z间的网络通信3.3 i/o端点的确定和分配 3.4电机和驱动器的连接 24 彳242526293.4.1步进电机驱动器和电机的连接29ii342直流电机驱动器和电机的连接 293.5 和电机驱动器的连接 303.6清淤机器人的控制程序设计303.6.1编程的语言303.

3、6.2编程的一般规约3132363程序框图的设计3.6.4控制程序的设计39致谢 40参考文献 签。41附录a清淤机器人控制清单错误！未定义书iii摘要摘要我们到唐山市区管网管理所进行实地考察，那里的工作人员热情地接待了我 们，并给我们介绍了排水管道中淤积物的种类、目前城市排水管道的清淤方法以 及需要解决的问题。又通过图书馆和网络，查阅有关步进电机控制的学术论文、 专利等文献资料。我确定了本次论文的大体内容、研究方案和研究目的：机器人内部有三台电机, 地面上有一台电机。plc通过控制这四台电机来达到控制机器人的目的。关键词：可编程控制器；步进电机；驱动器abstractabstractthe

4、this article main introduction settles silt robot' s the development condition at present and by using plc to control the robot it make the robot independently to complete the task.we went to the tangshan pipe network center for investigation, the staff there warmly has received us, and introduc

5、ed to us the silting up type in the drainage channel, the present city drainage channel clear silt method and question. also by the library and the network, i checked some reference related step motor controls.i have determined this paper the content, the research plan and the research goal: the rob

6、ot interior has three stepping motor, there is a step motor in the ground. plc controls four motor to controls the robot. this article in detail introduced how plc control motorj s direction, speed, electric current and the programming technology, including plc and the driver9 s selection, step moto

7、r and the driver? s connection and the control program and so on.the clear silt robot development' s significance lies in: may realize the clean-up drainage channel; improves working conditions currently dredging the pipeline, reduces worker labor intensity, safeguards worker's personal safe

8、ty, the enhancement drainage channel cleans up. in addition, it also can apply to other related field.keywords： programmable controller; stepping motor; driver21管道清淤机器人概述1管道清淤机器人概述1.1课题综述目前，城市的给水排水系统是通过地下管道来实现的。但排水管道很容易被一 些油或杂物等堵塞，为提高管道的寿命、防止堵塞等事故的发生，因此必须对管 道系统经常性的管理养护和对管道进行有效的检测和清通。管道机器人为满足该 需要而产牛的

9、。管道机器人是一种可沿细小管道内部或外部自动行走、携带一种 或多种传感器及操作机械，在工作人员的遥控操作或计算机自动控制下，进行一 系列管道作业的机、电、仪一体化系统。管道清淤机器人应具备清扫管道、喷射 清洗气雾和传感器检测管道内状况的功能。管道清淤机器人是在机器人技术上发展而来的，其机器人载体采用了常用的轮 式行走机构，结构简单而且驱动力大，多选择步进电动机作为原动机。步进电机 的控制性能好、精度高，在是一种控制性能非常好的控制电机。因此，对清淤机 器人的控制就是用控制器直接对步进电机进行控制，其控制器现在大多采用技术 比较成熟的plc和单片机，特别是plc对步进电机的控制。plc控制能力好

10、， 抗干扰能力强，其最大的优点是编程语言简单易学，这大大简化了机器人的控制 过程。清淤机器人具体到本课题中就是我们说的“小车它是由步进电动机来驱动 的，而步进电动机是由plc来控制的。设计耍求利用s7-200plc对步进电机进 行控制，其中包括：步进电机和其驱动器的选择；步进电机与其驱动器的连接； plc对步进电机和肓流电机方向、速度控制，从而可以实现对排水管道清淤机器 人前进/返冋控制，变速控制，以提高清淤机器人的工作效率。管道清淤机器人研制的根本意义在于：可以实现排水管道的疏通清理工作；改 善当前疏通管道时工人的工作环境、降低工人的劳动强度、保障工人的人身安全、 提高排水管道清理的效率。此

11、外，它还能应用到其他相关领域。1.2国内外管道清淤机器人技术现状1.2.1国外的技术现状目前，国外的管道清洗机器人已形成产业化。如美国、丹麦、口本、韩国等诸 多国家均有管道清洗机器人系列产品。早在1978年法国研制了一种轮腿式管内 机器31管道清淤机器人概述人行走机构，成功地实现了管内自主行走。该机构由2个行走轮及4个支撑腿 组成，腿由电机驱动运动，以适应不同管径的变化。80年代，随着计算机、传 感器、现代控制理论和技术的发展，为管内机器人的研究应用提供了技术保证。 国外相继开展研制了多种类型的管内检测移动机器人。东京理科大学福出敏男等 研制的可以通过90。弯管的管内移动机器人样机，如下图。机

12、器人由可相对冋转 的头部和本体组成，当机器人沿直管行走时，本体上的电机ml通过减速装置将 动力传给本体上的驱动轮，当机器人沿弯管行走时，电机m2驱动头部作姿态调 整，并驱动头部履带引导机器人通过弯管。该机器人可作管内裂纹探测，适用管 径50mm,行走速度00.48m/mino但由于携带的蓄电池电能的限制，还不能实 现较远的行走。图1管内移动机器人样机管道清淤机器人应具备清扫管道、喷射清洗气雾和传感器检测管道内状况的功 能。要实现这些功能，机器人必须拥有的“器官"包括：灵活的移动载体、多种清 扫和清洗作业工具、通信系统和操作盒以及一些辅助设备和设施。纵观国外管道 清洗机器人，其结构大同

13、小异，性能水平也没太大的差别：1. 大多采用轮式或双履带式移动机构，管道适应性并不强；2. 配有高速旋转的清扫机构，用来把管内的灰尘打落、清除。由于管道有矩形 管和圆管之分，所以可更换相应的清洗矩形管和圆管的清洁刷；3. 装有ccd摄像头及照明灯，用于探测管道内的状况，这在人所不能到达的 管道内部是必不可少的；4. 由于管道机器人还不可能达到完全自主清洁，故采用线控方式，由操作人员 在管道外进行操作。122国内的技术现状1管道清淤机器人概述我国在管道清淤机器人的研究应用还比较落后，但也有一些单位在这一领域取 得了可喜的进展。哈尔滨工业大学fi前已做出了管内机器人实验样机，上海大学、 天津大学、

14、成都核物理所和四川工业学院也从事这方面的研究工作。四川工业学院着重研究了 plc对步进电机的控制。plc对电机控制的实现是 以plc的高速计数功能和脉宽调制方式(pwm)的输出功能为基础的。为实现 行走电机速度控制和位置控制，在结构上必须构成一个闭环控制系统，为此采用 了光电增量式编码器作为反馈信号传感器。通过plc的高速计数功能对反馈信 号进行数据采集，由plc的pwm输出控制电机的转速。在一个采样周期内， plc速度控制程序需处理以下工作以调节电机稳速运行；用定时器设定采样时 间；调用高速计数指令采样电机位置信号；调用除法程序求电机速度；设置值和 实测值做减法求偏差值；调用比例积分微分(p

15、id)子程序对偏差进行控制调节; 通过写pwm指令控制字调节pwm输出占空比调节转速。述有天津大学研究了一种管道机器人，该机器人系统采用模块化的设计思想， 主要包括三个组成部分：移动机器人本体模块、收放线装置模块、控制系统模块。 木体模块的显著特点是采用积木式变宽结构以满足机器人适用于不同管径的管 道作业；收放线装置模块实现电缆收放；控制模块设计两套控制系统：一是手动 控制系统，另一是微机控制系统。手动控制系统通过控制面板上的按钮来控制机 器人本体的前进、后退、加速、减速、急停，并实时显示机器人本体行进深度等; 微机控制系统由插在pc机扩展槽上的自行研制的专用接口卡与控制箱上的计算 机接口相连

16、，通过软件实现计算机对机器人系统的控制。目前，主要采用的管道清淤方法是水力清淤法和机械清淤法。水力清淤是利用 管屮的污水、城市自来水对排水管道进行冲洗，靠高压水流把淤积物冲走。机械 清淤法是在管段的首尾两井上各设绞车，如图2,车上系住钢丝绳，用绞车来回 拉动清管工具二三次，管内淤泥即可刮下无遗，清除效果好。图2机械清淤法51管道清淤机器人概述1.3木市管道清淤技术现状唐山是北方重要的工业城市，水资源的利用量和排放量都非常犬。因此，研究 唐山的排水管道结构和管道清淤方式具有很重要的意义。从管网所得到的结果表明：唐山市的排水管道的内径从300-3000mm之间不等, 主排水管大多为300-600m

17、m,支管多为300mm井口直径为640mm,往下直径 越来越大，呈锥形。井距一般为50m,两井口间的连接管道有一定的坡度，般 在0.003以上，靠重力实现流动，管道堵塞时多为树枝、棉丝、淤泥、钙化物等, 使悬浮物无法靠重力顺流而下。目前主要用两种设备：一个是管道高压清洗车，另一个是管道吸污车。管道高 压清洗车有一个高压喷头，它是圆锥状的，圆锥外侧能喷出高压水柱，同时喷头 不停的振动，振动的力量相当大，足以清洗掉管道内的一大部分淤积物，然后靠 高压水流把淤积物冲走，这种方法非常实用，效果也很好。当淤泥比较多时，采 用吸污车直接把淤泥吸出来。1.4管道清淤机器人总体控制方案管道清淤机器人共使用4台

18、电机：ml为载体步进电机、m2为刀具步进电机、 m3为调节压紧步进电机、m4为收放直流减速电机。按下启动按钮，ml正转，m4反转，m2延时后正转；载体打滑时，m3正转, 直到不打滑时m3停止，若压紧调节机构到极限位置述打滑，则m3停止，则按 下手动返回按钮返回；若电机过载时，则按下手动返回按钮返回；遇大障碍时， 则按下手动返回按钮返回；若需要急停时，则按下急停按钮；若到达下一井口， 行程开关动作，载体返冋。不管手动返冋还是自动返冋都需调用返冋子程序。当调用返回子程序时，ml反转，m4正转，若回到原井口，行程开关动作并报 警，ml、m2、m4停止，m3反转，直到压紧力调节机构回到原始位置，m3停

19、 止。62清淤机器人控制系统分析2清淤机器人控制系统分析2控制系统控制器的选择如前所述，管道清淤机器人是用步进电机驱动的，而步进电机的控制器选择工 业上使用最广泛的可编程逻辑控制器(plc),用plc控制步进电机是机电一体 化的必然趋势。由于管道机器人是在野外管线内部作业，环境恶劣，不允许出现 在管内失控的重大事故，因此除了对机器人的能源动力系统等强电部分提出了严 格要求外，还对机器人的控制单元提出了极高的运行可靠性要求，以保证控制单 元不受环境、强电及射线等干扰，在有效的控制策略下起到持续监控作用；另外 管道机器人在作业过程中主要处理一些开关量，对控制器的处理时间要求不高， 所以选用了可编程

20、逻辑控制器(plc)作为管道机器人的控制器。目前plc生 产厂家很多，选择西门子的s7-200plc系列，这一系列产品能满足多种多样的 自动化需求，由于具有紧凑的设计、良好的扩展性能、低廉的价格和强大的指令, 使得s7-200plc可以近乎完美的满足小规模的控制要求。此外，丰富的plc类 型和电压等级使其在解决用户的自动化问题时，具有很强的适应性。2.2 s7-200系列plc概述2.2.1 s7-200 系列 plc 简介s7-200系列是西门子公司投放市场的小型可编程控制器。全部采用整体式结 构，它的结构小巧，可靠性高，运行速度快，有丰富的指令集，只有强犬的多种 集成功能和实时特性，配有丰

21、富的功能扩展模块，在各行各业中的应用迅速得到 推广，在规模不太大的控制领域是较为理想的控制器。图3为s7-200plc的外 型图。2清淤机器人控制系统分析图3 s7-200plc的外型图s7-200系列plc既可独立运行，也可扩展相连成网络，能实现复杂控制功能, 可提供4个不同的基本型号的8种plc供选用。一台s7-200 plc包括一个单独 的s7-200cpu,或者带有各种各样的可选扩展模块，其主要组成部分如下。1. s7-200cpu 模块s7-200cpu模块包括一个中央处理单元（cpu）、电源以及数字量i/o点，这 些都被集成在一个紧凑、独立的设备屮。1）cpu负责执行程序和存储数据

22、，以便对工业自动控制任务或过程进行控制。2）输入和输岀是系统的控制点，输入部分从现场设备（例如传感器或开关） 中采集信号，输出部分则控制泵、电机以及工业过程中的其他设备。3）电源向cpu及其所连接的任何模块提供电力。4）通信端口允许将s7-200cpu同编程器或其他一些设备连接起來。5）状态信号灯显示了 cpu的工作模式（运行或停止）、本机i/o的当前状态及 检查岀的系统错误。6）通过扩展模块可增加cpu的i/o点数（cpu 221不可扩展）。7）通过扩展模块可提供其通信性能。8）一些cpu具有内置的实时时钟，其他cpu则需要实时时钟卡。9）eeprom卡可以存储cpu程序，也可以将一个cpu

23、中的程序送到另一个 cpu 中。10）通过可选的插入式电池盒可延长ram中的数据存储时间。2. 最大i/o配置每种cpu的最大i/o配置须服从以下限制。82清淤机器人控制系统分析1）模块数量。即cpu221不能扩展。cpu222最多两个扩展模块。cpu224 和cpu226最多7个扩展模块。7个模块中最多能有两个智能扩展模块（em 277profibus-dp模块）。2）数字量映像寄存器大小。每个cpu允许的数字量i/o的逻辑空间为128个 输入和128个输岀。由于该逻辑空间按8点模块分配，因此有些物理点无法被寻 址。一个特殊模块可能不能全部寻址8个点，例如，cpu224有10个输岀点， 但它

24、占用逻辑输出区的16全点地址。一个4入/4出模块占用逻辑8个输入点和 8个输出点。3）模拟量映像寄存器大小，模拟量i/o允许的逻辑空间。即cpu222为16输 入和16输出。cpu224和cpu226为32输入和32输出4）5v电源供电。3. 输入/输出i/o扩展模块1）数字量扩展模块数字量扩展模块为使用除了本机集成的数字量输入/输岀点外更多的输入输出 提供了途径。用户可分别对plc及任何扩展模块的混合体进行组态以满足应用 的实际要求，同时节约不必耍的投资费用。可提供8个、16个和32个输入/输出 点的模块供使用。2）模扌以量扩展模块模拟量扩展模块癌瓜了模拟量输入/输出的功能，直接与传感器和执

25、行器相连, 12位的分辨率和多种输入/输出范围能够不用外加放大器而与传感器和执行器直 接相连，例如，em235模块可直接与pt100热电阻相连。其技术性能如下表：92清淤机器人控制系统分析表1 s7-200plc的主要技术性能102清淤机器人控制系统分析2.2.2程序设计屮用到的plc指令1. 传送指令字节、字、双字和实数的传送指令梯形图:mov-xen enoin out图4传送指令其中，mov为传送指令符号，x表示数据类型。数据类型有：字节（b）、字（w）、双字（dw）、实数（r）o en为使能端，即当en前而的逻辑条件满足 时，才能进行数传送。in是所要传送的数据输入端。out是数据传输

26、的输岀端。 字节、字、双字和实数的传送指令是把输人数据（in）传送到输出端（out）, 在传送过程中不改变数据的大小。2. 定时器指令1）接通延时定时器（ton）txxx图5接通延时定时器其中txxx为定时器编号，in为定吋器使能输入端，pt为定吋器的预设值端。 每个定时器均有一个16位当前值寄存器及一个1位的状态位（反映其触点的状 态）。当使能输人端接通时，接通延时定时器开始计时，当定时器（txxx）的当 前值大于等于预设值时，该定时器的状态位被置1 （即触点被接通），但定时器 继续计时，一直计到最大值32767,并保持状态位，肓到使能输人端断开，清除 接通延吋定吋器的当前值，定吋器才复位。

27、2）有记忆接通延时定时器（tonr）ii2清淤机器人控制系统分析txxx图6有记忆接通延时定时器对于有记忆接通延时定时器，当使能输入端in接通时，定时器开始计时，当 使能输入端断开吋，该定时器保持当前值不变；当位能输入端再接通吋，则定时 器从原保持值开始再往上加，当定时器的当前值大于等于预设值时，定时器的状 态位置1 （但定时器继续计时，一直计到最大位32767）,以后即使输入端再断开, 定时器也不会复位，若要定时器复位必须用复位指令（r）清除其当前值。3）断开延时定时器（top）txxx图7断开延时定时器断开延时定时器（tof）用来在输入断开延时一段时间后，才断开输出。当使 能输入端in接通

28、时，定吋器立即接通，并把当前值设为0,当使能输入端断开 时定时器开始定时，直到达到预设的时间。当达到预设时间时，定时器断开输出, 并停止计时当前值。当输入断开的时间小于预设时间时，定时器仍保持接通。当 in再接通时，定时器当前值仍设为0。3. 脉冲输出指令其梯形图表示如下：图8脉冲输岀指令122清淤机器人控制系统分析对于s7-200系列的cpu,如果cpu模块上的输出类型为dc型（晶体管输出）, 那么在其q0.0和q0.1上可以产生高速脉冲串和脉冲宽度可调的波形，频率可以 达到20khzo当在这两个点使用脉冲输出功能时，它们受pwm发生器控制，而 不受输出映像寄存器控制。脉冲宽度调制（pwm）

29、功能提供连续、可变占空比脉冲输岀，用户控制周期 和脉冲宽度。每个pto/pwm发生器有一个控制字节（8位）、一个16位无符号 的周期值寄存器、一个16位无符号的脉冲宽度值寄存器和一个32位无符号脉冲 计数值寄存器。这些值全部存储在特殊存储器中，一旦这些特殊存储器的位被置 成所需操作，可以通过执行脉冲输出指令（pls）来调用这些操作。pls指令使 s7-200读取相应特殊寄存器中的位，并对相应的pwm发生器进行操作。pwm功能提供占空比可调的脉冲输出。其周期和脉宽的单位可以是ms或ps, 周期值保存在（smw68或smw78）中，周期的变化范围是50ps-65535|js或 2ms-65535m

30、s；脉宽值保存在smw70 （或smw80）中，脉宽值的变化范围是 oms-65535 ms或0ms65535ms。当脉宽值等于周期值时，占空比为100%,即输 岀连续接通；当脉宽值为0,占空比为0%,即输出断开。pwm操作实例：将q0.0设置成pwm输出，其周期值为1000ms,脉宽值为 300ms o在主程序的初次扫描时（sm0.u1）,调用初始化子程序。如下图所示：图9调用初始化子程序在子程序sbr0中，进行pwm操作的初始化，如下图:132清淤机器人控制系统分析mov-ben in smb77mov-ben 1000 in out smb78mov-ben in smw80plsen

31、0 qo.x图10 pwm初始化4. 通信指令多台s7-200cpu利用ppi协议进行网络通讯时，可以利用网络读写指令实现数 据传送的功能。1）网络读指令（netr）netrentblport图11网络读指令网络读指令初始化通讯操作：通过指定的端口 port从远程的其他cpu接收 数据并存放在一个表（tbl）中。netr指令可以从远程站点上读16个字节的 数据。2）网络写指令（netw）142清淤机器人控制系统分析netwen enotblport图12网络写指令网络写指令初始化通讯操作：通过指定的端口 port从远程的其他cpu上写 表（tbl）中的数据。netw指令可以向远程站点上写16个

32、字节的数据。2.3步进电机及其驱动器简介2.3.1步进电机步进电动机是一种将电的脉冲信号转换成相应的角位移（或线位移）的机电元 件。通俗地讲，就是外加一个脉冲信号于这种电动机时，它就运动一步。正因为 它的运动形式是步进式的，而称为步进电动机。步进电动机的输入是脉冲信号，从它绕组152清淤机器人控制系统分析图13步进电机和驱动器简图以步距的误差不是长期地积累下去的；控制性能好。起动停车，反转及其他任 何运行方式的改变，都在少数脉冲内完成，在一定的频率范围内运行时，任何运 行方式都不会丢失一步。因此，作为伺服电动机应用于控制系统时，往往可以使 系统简化，工作可靠而ii获得高的控制精度。在多数情况下

33、，可以代替直流伺服 电动机和交流伺服电动机。步进电动机不同于其它电机在于它必定要有专用驱动 电源，否则就不能正常工作。所以，发展推广步进电动机就与驱动电源的研究开 发分不开。目前步进电动机驱动电源种类繁多而且各具特点。2.3.2步进电机驱动电源大家知道，步进电动机的控制指令是单一码，就是一串脉冲方波。例如，从电 子计算机送出的数字控制脉冲就是单一码。变换器的基本构成形式由机械变换器 发展到电子变换器。目前由于电子技术迅速发展，机械变换器在步进电动机中已 不再使用。这里只对电子变换器即驱动电源作介绍。步进电动机的驱动电源由环形分配器和功率放大器两部分组成，环形分配器是 每台电机一个，而功率放大器

34、则是每相一套。环行分配器主要使电机各相绕组按一定的顺序和时间导通并根据输入指令使 电机正转或反转，实际上就是用以确定电机的工作方式。由此，环行分配器耍按 照电机的工作方式来进行设计。功率放大器的主要功用是根据电机或负载的需 要，将环行分配器输出的各相电信号进行放大。162清淤机器人控制系统分析驱动电源要求完整、准确、灵敏地执行控制指令，具有足够的功率，抗干扰能 力强。当然还有一些对设备的基本要求，如体积小、结构简单、成本低、维修方 便以及安全可靠等。2.4电机驱动器的选择清淤机器人驱动电机的选型为：载体步进电机的型号为vrdm31117,其额定 扭矩为12nm；刀具步进电机的型号为vrdm31

35、122,其额定扭矩为16.5nm；调 节压紧步进电机的型号为vrdm397,其额定扭矩为2nm；收放直流减速电机的 型号为tyv3-30dc,额定电压为24v,额定电流为3.6a。其中，步进电机为德 国百格拉公司生产的步进电机。2.4.1步进电机驱动器的选择步进电机驱动器选择德国百格拉公司的wd3-007和wd3-008o驱动器 wd3-007主要驱动2nm-12nm三相混合式步进电机，因此它用来驱动载体步进 电机和调节压紧步进电机。驱动器wd3-008主要驱动12nm16.5nm三相混合式 步进电机，因此它用来驱动刀具步进电机。这两个驱动器的电气性能基本相同。 输入电压220vac,控制信号

36、电压5vdc,与百格拉电机配套性能最佳。1. 电气参数如下表表2 wd3-007的电气参数2. wd3-007的主要特点：1）交流伺服工作原理，交流伺服运行特性，三相正弦电流驱动输出。172清淤机器人控制系统分析2）只要环境温度不超过55°c,驱动器就可以正常工作。3）电路板采取三防处理，有过热、过压、欠压、过流及相间短路保护功能。4） 驱动器的输入电源是220vac,变化范围是：30%+20%。5）电机和驱动器间 仅用3根线，减少连线出错的可能性。6）几乎无共振和爬行，输出相电流可设置，带有十细分和半流功能特性，噪 声几乎与交流伺服电机一样。7）比同样尺寸的反应式步进电机所产生的功

37、率大20%左右。8）电机的扭矩 与它的转速有关，而与电机每转的步数无关。9）电机每转步数可依用户要求分别设定为500、1000、5000、10000步/转。10） 由于驱动器采用了正弦电流驱动，使电机的空载启动频率高达4.3-5.3khzo11）电机上下电时，输出轴位置不变，给工作带来很大方便。3.连线及参数 设置：4. 控制信号定义pulse：脉冲信号输入端，每一个脉冲的上升沿使电机转动一步。dir：方向信号输入端，如“dir”为低电平，电机按顺时针方向旋转；182清淤机器人控制系统分析“dir”为高电平电机按逆时针方向旋转。cw：正转信号，每个脉冲使电机正向转动一步。ccw：反转信号，每个

38、脉冲使电机反向转动一步。reset：复位信号，如复位信号为低电平时，输入脉冲信号起作用，如果复位 信号为高电平吋就禁止任何有效的脉冲，输入信号无效，电机无保持扭矩。readdy:输入报警信号。ready是继电器开关，当驱动器正常工作时继电 器闭合，当驱动器工作界常时继电器断开。继电器允许最高输入电压和电流是： 35vdc, 10ma<i<200ma,电阻性负载。如用该继电器，要把他串联到cnc的 某输入端。当驱动器正常工作吋继电器闭合，外部24vdc通过继电器输入到cnc 输入端，否则外部24vdc无法输入到cnc输入端。注意:pulse+与cw+, pulse-与cw，dir与c

39、cw-对应同一个接线口, 按控制方式不同给出的两种定义名称。下面为脉冲、方向信号时序图：5. 控制信号连接上位机的控制信号可以高电平有效，也可以低电平有效。当高有效时，把所有 控制信号的负端连在一起作为信号地，低有效时，把所有控制信号的正端连在一 起作为信号公共端。注意：公共端不能与大地（壳体）接到一起。“pulse.sys"为控制方式选择开关，两种状态对应两种控制方式。下表中列出了控制信号高有效和低有效吋的接线方式。192清淤机器人控制系统分析表3控制信号接线方式2.4.2直流电机驱动器的选择直流电机驱动器选择美国国家半导体公司的lmd18200o lmd18200是美国国 家半导

40、体公司推出的专用于直流电动机驱动的h桥组件，同一芯片上集成有 cmos控制电路和dmos功率器件。此种芯片瞬间驱动电流可达6a,正常工作 电流可达3a,具有很强的驱动能力,无"shot-through"电流，而且此种芯片内 部还具有过流保护的测量电路，只需要在lmd18200的8脚输岀端测岀电压和 给定的电压比较即可保护电路过流，从而实现电路的过流保护功能。lmd18200 的5脚为pwm波输入端，通过改变pwm的占空比就可调节电机的速度，改变 3脚的高低电平即可控制电机的正反转。此电路和以上几种驱动电路比较具有明 显的优点，驱动功率大，稳定性好，实现方便，安全可靠。其内部

41、结构原理图如 下：图16 lmd182000内部结构原理图1. 各引脚的功能202清淤机器人控制系统分析1、11脚：桥臂1、2的自举输入电容连接端，在脚1与脚2、脚10与脚11之 间应接入10nf的自举电容。2、10脚：h桥输出端。3脚：方向输入端。转向时，输出驱动电流方向见表3,该脚控制输出1与输 岀2 （脚2、10）之间电流的方向，从而控制马达旋转的方向。4脚：刹车输入端。刹车时，输出驱动电流方向见表4,通过该端将马达绕组 短路而使其刹车。刹车吋，将该脚置逻辑高电平，并将pwm信号输入端（脚5） 置逻辑高电平，脚3的逻辑状态决定于短路马达所用器件。3脚为逻辑高电平时, h桥中两个高端品体管

42、导通。3脚呈逻辑低电平时，h桥中两个低端品体管导通。 脚4置逻辑高电平，脚5置逻辑低电平时，h桥中所有晶体管关断。此时，每个 输出端只有很小的电流（1.5ma）o5脚：pwm信号输入端。pwm信号与驱动电流方向的关系见表3,该端与3 脚（direction）如何使用，决定于pwm信号类型。6、7脚：电源正端与负端。8脚：电流取样输出端，提供电流取样信号。9脚：温度报警输出。提供温度报警信号，芯片结温达145°c时，该端变为低 电平，结温达170°c吋，芯片关断。表4逻辑真值表2. lmd18200主要特点1）额定电流3a,峰值电流6a。2）电源电压55v。3）功率晶体管导通

43、电阻rds为0.38o212清淤机器人控制系统分析4）ttl和cmos兼容的控制信号输入。5）内含防桥臂单侧直通电路。6）芯片过热报警输出和自动关断。7）内部的充电泵电路提供桥路上臂两管的栅极电压。3. 控制方式lmd18200提供双极性方式（也称反向锁定控制）和单极性方式（也称方向脉 宽控制）两种工作方式。在双极性工作方式中，单个的pwm信号接入lmd18200 的dir端子，由pwm信号的占空比大小控制电机的转向和转速，当占空比为 50%时，uab电压的平均值为零，电机静止；当占空比为75%时，uab平均值 大于零，电机正转；当占空比为25%吋，uab的平均值小于零，电机反转。使 用单极性

44、工作方式，在单极性这种工作方式屮，pwm脉冲信号接在lmd18200 的pwm端，而方向信号接在dir端，pwm端脉冲信号的占空比决定电机转速, 而dir端的电平高低决定电机转向。如果控制器能提供pwm和dir信号，则 使驱动器工作在单极性方式，这样构成的系统为全数字式，避免了模拟电压的温 漂和噪声干扰等不利影响。4. 驱动器电路设计图17为所设计的驱动器电路原理图：图17驱动器电路原理图5. 基本工作原理1）电流取样每输岀1a电流，脚8输岀377na的取样电流。接在8脚与地之间的电阻将其 转化为电压信号，该电压幅值在58v之间时，线性度与精度最佳。该端最高电 压12v。电流取样电路并不检测反

45、馈电流，仅检测桥臂上端晶体管中的电流。222清淤机器人控制系统分析2）温度报警标志该端（9脚）为0c门输出，该端通常接到系统控制器的中断输入，以便过热 吋对系统采取适当措施。该端最高电压为12vo3）限流lmd18200内部含有限流保护电路。该电路检测器件中的电流，该电流接近10a 时，迅速关断功率器件。器件关断后，保护电路周期性的重新试图开通功率器件。 一旦外界短路故障消失，器件就能够恢复正常运行。由于短路将产牛大量热量， 因此，实际使用时，lmd18200必须配备面积足够大的散热器。同时，为了散热, 芯片电源端vcc （脚6）在pcb板上需要1平方英寸的铜箔。4）充电泵电路如图18所示，开

46、通高端的dmos管时，每个器件的栅极电压应比电流取样电 压约高8vo采用内部充电泵电路可获取该电压。利用内部300khz的振荡器对 内部自举电容充电可获得14v电压，该驱动电压的上升吋间为20ns,可保证器 件的开关频率达1khz；开关频率更高时，可采用外部自举电容，并由dmos管 对该自举电容充电，h桥输出端与自举端接入10nf外部电容，可提供上升时间 达100ns的驱动电压，从而保证开关频率达到500khzo图18内部充电泵电路/自举电路5）内部续流二极管h桥中四个dmos管都有续流（保护）二极管，高端续流二极管流过6a的反 向电流时，反向恢复时间为70ns,反向恢复电流为1a。同样条件下

47、，低端续流 二极管的反向恢复吋间为100ns,反向恢复电流为4a。233基于plc的清淤机器人控制系统设计3基于plc的清淤机器人控制系统设计3.1清淤机器人的控制过程根据唐山市排水管道的实际情况及前面的分析，确定plc控制清淤机器人的 过程如下：1. 按下启动按钮，载体电机正转、收放电机反转和刀具电机正转启动，延时 2s后刀具电机开始启动。2. 清淤机器人在工作过程屮，通过高速计数指令完成载体打滑、电机过载、遇 大障及工作位置输出的检测。因为清淤机器人在工作过程中可能会打滑或电机过 载，会使载体速度变慢；遇到障碍或者出现故障，载体停止，如果有工作位置的 显示，工作人员可以很方便的查出出现障碍

48、的位置和清淤机器人出现故障的位 置，方便及时处理问题。当清淤机器人不能向前运动吋，光电编码器停止输出脉 冲给高速计数器，利用高速计数功能当检测到当前值等于上一时间段的值时，说 明清淤机器人遇障并停止工作。3. 清淤机器人到达右井口行程开关时或按下手动返回按钮，plc接收到右行 程开关发出的导通信号，使刀具电机停止，载体电机反转、收放线电机正转使清 淤机器人返冋。4. 当清污机到达左井口行程开关时，接收到左行程开关发出的导通信号，清淤 机器人停止。因为将行程开关安装在工作管道的对面管口处，所以不用停车延时, 使载体电机和收放电机直接停止工作。此时，报警器开始报警。调节电机反转， 直到调节装置回到

49、原位，调节电机停止。5. 如果需要急停时，按下急停按钮，四台电机全部停止。3.2 plc的选型和通信3.2.1 plc的选型在工程设计选型和估算时应详细分析工艺过程的控制要求，明确控制任务和范 围，确定所需的操作和动作；然后，根据控制要求估算输入输出点数、所需存储 器的容量、确定plc的功能、外部设备的选择等；最后，设计选择有较高性能 价格比的plc和相应的控制系统。243基于plc的清淤机器人控制系统设计首先确定系统用plc是单机控制还是用plc形成网络，由此计算plc的输入 输出点数，并且在选购plc时要在实际需要点数的基础上有一定的余量（10%）o 然后列出被控对象输入输出的设备名称，并

50、根据所带的输入输出点数进行统计。 在统计时，应考虑为了控制的要求而增加的一些开关、按钮或报警的信号，例如, 增加总的供电开关、为手动需要而增加的手动自动开关、为联锁需要设置的联锁、 非联锁开关等。80点以内的系统选用不需扩展模块的plc单机，当系统较大时，就需扩展。 不同公司的产品，对系统总点数及扩展模块的数量都有限制。当扩展不能满足要 求时，可采用网络结构；同时，在一些厂家产品的个别指令不支持扩展模块，因 此，在进行软件编制吋要注意。在s7-200系列plc屮，一台plc中只有两个高速脉冲输出端，但是控制系统 要有四个pwm脉冲输出来控制三台步进电机和一台直流电机，因此必须选两个 plc才能

51、进行控制。根据实际的i/o点数，选用cpu226控制ml、m2, cpu224 控制m3、m4o由于选择了两台plc,所以就必须进行两台plc之间的网络通 信。3.2.2两台plc z间的网络通信s7-200系列plc具有很强的网络通讯能力，它可以通过内部集成的通讯口以 多种方式与现场设备相连，组成不同的通讯网络，完成现场控制任务。s7-200系列plc支持多种通讯协议，包括点对点接口（point-topoint interface, ppi）、多点接口 （multi-point interface, mpi）、现场总线 profibls 和自由口 （freeport） 方式。1. ppi通讯

52、协议ppi协议是s7-200plc专用的一个协议。ppi是一个主/从协议，任这个协议中, 主站（plc、编程器或操作单元）给从站（网络中的所有plc都可作为从站） 发岀申请，从站进行响应、从站不初始化信息，但是当主站发岀申请或查询吋， 从站才响应。在一个网络屮可以有127个地址，其中最多有32个主站。在编程 时，用网络读写指令netr和netw进行数据的传递。如果需要远程的编程或 监控，可以利用调制解调器来进行通讯。2. mpi通讯协议mpi协议可以是主/主协议或主/从协议，协议如何操作取决于设备类型。mpi 协议可以在两个相互通信的设备之间建立连接。253基于plc的清淤机器人控制系统设计3

53、. rofibus 协议rofibus协议设计用于分布式i/o设备的高速通讯，它是目前应用最为广泛的 现场总线协议。rofibus上可以连接的设备包括从简单的输入或输出设备到变 频调速器和可编程序控制。s7-200系列plc可以通过内部集成或扩展的通讯接 口连接到rofibus ±，从而与一个大型的控制系统有机地结合起来。利用小型 plc控制的分散性，降低集中控制的危险程度。提高系统的处理能力和安全性, 这对于大型的控制系统和控制对象相对分散的情况很有实用价值。4. freeport 通讯freeport通讯方式是一种用户自定义的协议，可以通过用户程序控制s7-200系 列plc的通

54、讯口。在freeport方式下，通讯口的协议由外设决定，plc通过程 序来适应外设。该方式使得s7-200系列plc可以与任何具有通讯能力、并且协 议公开的设备相通讯。利用自由口模式，可以连接多种智能设备，如打印机、变 频器、条码阅读器等，以及实现plc与上位机通讯、连接调制解调器等。这次设计中，使用ppi通讯协议。cpu226为主站，cpu224为从站,当主站 cpu226发出申请或查询时，从站cpu224才响应。两台plc用ppi电缆连接起 来，用网络读（netr）和网络写（netw）指令來实现他们z间的通信。网络 读写指令的应用详见前面s7-200指令介绍，通信程序见程序清单。3.3 i

55、/o端点的确定和分配输入输出点数（i/o点数），指可编程序控制器外部输人输出端子数，这是plc 的一项非常重要的技术指标，常用i/o点数来表征plc的规模大小。输入/输出接口是plc主机与外部设备z间的连接电路。为了提高抗干扰能力, 一般输入、输出接口均有光电隔离电路，即由发光二极管和光电三极管组成的光 电耦合器。来自现场的检测元件、指令元件的信号经输人接口进入plco检测元件是指传 感器、按钮、寄存器触点、行程开关等，利用这些元件检测来自现场的温度、压 力、位置、电流、电压等物理量即检测元件信号；指令元件信号是指操作者在控 制台或键盘上发出的信号，如启动、暂停、调整等。这些信号有的是开关量，

56、有 的是模拟量，有的是直流信号，有的是交流信号，所以要根据输入信号的类型选 择合适的输入接口。263基于plc的清淤机器人控制系统设计由plc发出的各种控制信号经输出接口去控制和驱动负载，如控制指示灯的 亮灭、电磁阀的开闭、继电器线圈的通电和断电、电动机的启动、停止和正反转 等等。控制负载的输岀信号也有不同的形式，同样要选择合适的输岀接口。根据现场执行部件的不同需要，输出接口的放大环节分为继电器型、晶闸管型 和晶体管型三种类型：继电器型输出接口为有触点输出，外加负载电源既可以是 交流，也可以是直流，响应时间为ms量级；晶闸管型接口只能带交流负载，响 应时间为ps量级；晶体管型接口只能带肓流负载，响应时间最短，为ns量级。根据总体控制方案以及传感器的应用，1/0端口的分配如下：表 5 cpu224 i/o 端口273基于plc的清淤机器人控制系统设计 表 6 cpu226 i/o 端口3基于plc的清淤机器人控制系统设计表7所用辅助触点3.4电机和驱动器的连接3.4.1步进电机驱动器