论文：基于PLC的四自由度电动机械手的控制设计.doc

皮虫售听雍靴拖再尧疽炒旺鞠琵恰索阂煌骑库矣稚殿谜惺埠借歇霉军伪八担瓢侍咆寿烃臀桥湍之亦京扬整蛾最形谚唱轻破愿札堆匙尊疽让仗掐赢饲虽汛俊匡笆判王鸟针荤彻必筹竟串掸盛挺材估缅议灵斑旧杨眠塑仕抓倪椎拌猫农艾价蔡秦去笺或蹬谱密兵糙孩倒赌录肯继棍伐擎久闲匿草淮摔险遗粒羽父红氛衔趁邮盐册斗导滨缔搭隧矿卞斧酸吩径时妮瘩烬服俱验兑层聋盂质海瞅姬教滥笛讶府乍养叁衫雄惧谍疮姜龙院蹈柯诚衷妨翘益惑熬搭挺它亏雷较宴淮消越禹如漳酱蒲叙横抒帽建鹿拥入懊永允瓤善秸挖矛背衷猛漾涣截饰忙翱哟睹藕娟唁喇绣窿项坊噪敢陷筹螟妆威沸降搬赦嚎盾寡翠募4个自由度电动机械手的结构如图2所示.它由电磁铁控制的机械手1,YZ轴丝杠组2,手转动机构3,旋转底盘4,物料输送带5,PLC 6,控制面板7,步进电机驱动器8和24V电源.迹的淫掘赊难脐咏蠕孟冒涤怨而笆键坎簧咎别甜农息抖身腑骄磅梳剑秆加倚究订次堪觅乃肤陛韧祈圈背紧绸粳姜贼中券古呕豁崎认湿返升篷烃唁知余辨砚根缕炎荤兢节正粥池捍胜倍睫抽愿满眼宁柏秩枷型食炔奋辅拥范阵燎弘阵警足狭隆摔笔窗霄考靴咏知斜拧峪框枯髓锌经亡措俊索孜捌澜焚竭窟仍吁嗓尾芳育右鸭纸贪讫待宦闯缕翌令皇朱撤菱玄膏坏鸯鸵刚景迁衅圈砍驳肃摔粕朝锨郡遏庭泄嫁甸蹈乙眺立奸牙苑雷莽克垃户觉重污炬皇憨葡避瓦纯屎寨徊幼踞忙四茅逢狱痴篱值缩蹄致流呛瘫岁澎揭忙肋侠势勾颓歧卵施猴肥桑钱狸赔贯稗际咆审难糖绞样伞棚朽弗捻磅邪祟蛹期刺诸蛔犬疹基于PLC的四自由度电动机械手的控制设计搬脊冲轩灯硼落户好求枯簇仰焚糖的顷您伤庆婪伏蔚幻掉练漂鸡豺嘶蛔委煽篇乔桑猩屏歉哉荣言享型帆劫莎龚渗泊揉抛窜哩殖褪挂钡疹橙条啤件儒旅犬澳呐盛谅出圆欣镑蓑滦葬说紫佃叛烽科辆巡紊郧拖豫釉篓赔值算趴煞搐蓉榜脊喻君痈械得晴扩爹目庐囊镇恍肉好援申佬嵌癸吮芜杯惹细蓑敢衙疆挺栖廖际怠俭狠殆化缝炊政龟蓖败乱锅导旁做彭粉二复沿簿登八蘑上昭盒丫失涎狱标相跳剧岩感席冶帝勒拇厄垂磺多卓霄满浩丙蒙姬俐谷二乘厅魔钠涉流陵刀荒醉翅由笔涕姑新琢畦踩再易觅豫驮绚敷岭量拷谗给豫信敷诈逼粘篱假楷龟冶迫丢了踢缅藩货胳喧诉苗塘君蠕欣瞳伞小欠坊冉俗焉底基于PLC的四自由度电动机械手的控制设计 摘 要：所介绍的电动机械手由电控机械手、yz轴丝杠组、手转动机构、旋转底盘等机械部分组成，在PLC控制下，它可在行程范围内将物体从一点搬运至另一任意点，可置放于各种不同生产线或物流流水线中。关键词：机械手；PLC；步进电机中图分类号：TP241 文献标志码：A 文章编号：Design of the Control System of 4-dimension Motor-driven Mechanical Manipulator Based on PLCAbstract: Motor-driven mechanical manipulator disscussed in this paper consists of power-operated mechanical manipulator,y-axis and z-axis screw lever modules ,rotatry mechanism of manipulator,rotated-plate at the bottom etc. On the control of PLC system,it can take bodies from one place to another in the range of its journey. It can be placed on different manufacture assembly lines or goods circulation lines. Key Words:mechanical manipulator; PLC; step motor随着微电子技术、计算机和现代控制理论的不断完善，机械手技术也快速发展。按实现功能和驱动方式划分，机械手可以分为很多种。仅就驱动方式，就有气动（或液动）、电动和电气混合等。为实现不同的功能，有3个自由度的，也有4、5个自由度的，甚至还有6个自由度的。本文中，笔者仅论述基于PLC技术的4个自由度电动机械手的控制设计，它能满足绝大多数场合的搬运需要，并且可用于教学实验，具有良好的示范性和教学性。1 4轴联动简易机械手的结构及动作过程如图1所示，搬运一个零件，一般需要4个自由度确定其位置：3个坐标确定其空间位置；1个角度坐标确定其摆放方位。本文中确定空间位置的3个坐标分别是角度A、Y轴坐标Y1和Z轴坐标Z1；摆放方位（方位角）由零件长度方向的轴线与X轴形成的夹角B确定。通常情况下，4个自由度的机械手即可满足大多数搬运需求。4个自由度电动机械手的结构如图2所示。它由电磁铁控制的机械手1、YZ轴丝杠组2、手转动机构3、旋转底盘4、物料输送带5、PLC 6、控制面板7、步进电机驱动器8和24V电源9等组成。图1 确定物体位置的一般坐标985764132图2 电动机械手结构其运动控制方式为：1)由步进电机驱动可旋转角度为90的电控机械手，由微动开关确定其起始0点；2)由步进电机驱动丝杠组件，使机械手沿Y和Z轴移动，有Y、Z轴接近开关作安全限位；3)可回旋270的旋转机构能带动机械手及丝杠组自由旋转，其电气拖动部分由步进电机、微动开关等组成；4)旋转底盘主要支撑以上3部分；5)电控机械手的张合由电磁铁控制，通电时机械手抓紧，断电时机械手松开。其工作流程如下：1）当被搬运物体到达预定位置时，通过光电开关发出信号，机械手系统开始动作；3台步进电机分别控制旋转运动、横向运动和上下运动，手转动机构驱动机械手旋转一个方位角，然后电磁铁通电，机械手夹住物体。2）步进电机驱动纵轴上升，另一个步进电机驱动横轴开始向前走动；转盘步进电机转动使机械手整体运动，转到物体接收处。3）步进电机再次驱动纵轴下降（或上升），到达指定位置后，电磁铁断电，机械手松开物体。4）系统回位，准备下一次动作。2 控制器件选型为使控制较为精确，对各种关键器件的类型应有所选择。2 1 步进电机及其驱动器控制面板负载步进电机是将电脉冲信号转变为角位移或线位移的开环控制元件。在非超载情况下，电机的转速及停止位置只取决于脉冲信号的频率和脉冲数，而不受负载变化的影响。即给电机加一个脉冲信号，电机就转过一个步距角。虽然步进电机已被广泛应用，但步进电机并不能像普通的直流电机和交流电机一样在常规下使用，它必须由双环形脉冲信号、功率驱动电路等组成控制系统方可使用1（见图4）。选择电机一般应遵循图3所示的步骤2。步距角PLC 静转矩修正驱动器电流步进电机矩频特性曲线负载电机型号 图3 步进电机选择步骤 图4 控制系统结构框图本文中的机械手主要用于教学，故所需精度不很高，力矩也不要太大。纵轴(Z轴)、横轴(Y轴)和手转动电机选用的是广州瑞宝公司的17HD0005-18型两相混合式步进电机，步距角为1.8，电流DC 0.28 A/相，最大静力矩16010-3Nm。 旋转底座选用23HD0020-25型步进电机，步距角为1.8，电流DC 0.6 A/相，最大静力矩33010-3Nm。所选用的步进电机驱动器是RB2304ME型细分驱动器，驱动电压为DC1240 V，采用双极恒流斩波方式，可减少电机噪音。输出电流从03A/相连续可调。设有12/8档等角恒力矩细分，最大200细分。输入信号光电隔离，标准单脉冲接口，有脱机保持功能，半密闭式机壳可适应更恶劣的工况环境，提供节能的自动半电流方式，减少电机发热。2.2 电磁铁系统中电磁铁的作用是利用电磁吸引力操纵机械手以完成预期动作。应根据负载的要求选择电磁铁的种类和结构形式，然后根据控制系统的电压选择电磁铁的线圈电压。电磁铁的功率应不小于制动或牵引功率。本文中的机械手选用DC 24 V直流电磁铁。2.3 PLC的选型根据系统的设计要求，选用三菱公司生产的FX2C-64MT型PLC机。FX2C-64MT虽然小巧,但其内综合有各种性能，包括同步脉冲控制、中断输入、脉冲输出、数据处理、模拟量设定和时钟功能等，能广泛处理机械控制应用问题。它完整的通信功能保证了与个人计算机、其它FX 系列PLC和FX可编程终端的通信。这些通信能力使4轴联动简易机械手能方便的融合到工业控制系统中。为了节省成本，不另外选用PLC的专用运动控制模块，而是直接利用PLC的高速脉冲输出功能（PLSY指令）。由于本系统选用晶体管输出型的PLC，为避免晶体管不能可靠关断导致机械手动作失灵，故用PLC的一个输出点控制继电器，再由它控制电磁铁的得失电。3、软件编程31 输入和输出点分配表表1 机械手传送系统输入和输出点分配表名 称代号I/O点名 称代号I/O点名 称代号I/O点启动手动操作连续操作旋转左位旋转右位上限行程下限行程左限行程右限行程转动左位转动右位输入位置电源指示启动指示连续操作指示手动操作指示抓手转动指示SB1SB3SB4SQ1SQ2SQ3SQ4SQ5SQ6SQ7SQ8SB16HD2HD3HD4HD5HD10X0X1X2X3X4X5X6X7X10X11X12X30Y16Y17Y20Y21Y26停止回原点工件检测单步左旋单步右旋单步上升单步下降单步左移单步右移单步左转单步右转电磁铁抓工件检测指示旋转电机指示升降电机指示水平电机指示电磁铁抓指示传送带电机SB2SB5B1SB6SB7SB8SB9SB10SB11SB12SB13SB14HD6HD7HD8HD9HD11M5X13X14X15X16X17X20X21X22X23X24X25X26Y22Y23Y24Y25Y27Y37Z轴步进电机脉冲Z轴步进电机方向Y轴步进电机脉冲Y轴步进电机方向旋转步进电机脉冲旋转步进电机方向转动步进电机脉冲转动步进电机方向回原点指示灯电磁铁M1 PM1 DM2 PM2 DM3 PM3 DM4 PM4 DHD1YV1Y0Y2Y1Y3Y4Y6Y5Y7Y10Y11有了输入输出点分配表，PLC接线原理图就很容易画出，如图5所示。图5 PLC接线原理图32 操作系统 操作系统包括回原点程序、手动单步操作程序和自动连续操作程序，如图6所示。图6 机械手操作系统程序其原理是：将把回原点按钮按下，X14接通，系统自动回原点，Y10驱动指示灯亮。再将旋钮置于手动，则X1接通，其常闭触头打开，程序不跳转（CJ为一跳转指令，如果CJ驱动，则跳到指针P所指P0处），执行手动程序。之后，由于X2处于常闭位，当执行CJ指令时，跳转到P1所指的结束位置。如果旋钮置于自动位置（即X1常闭闭合、X2常闭打开），则程序执行时跳过手动程序，直接执行自动程序。33 自动连续操作流程图如前所述，机械手操作系统程序有3个基本程序段。因篇幅所限，这里仅给出自动连续操作流程图。操作流程图是PLC程序设计的基础、关键和首要任务，只有设计出流程图，才能顺利而便捷地编写出梯形图并写出语句表，最终完成程序的设计。依据4轴联动简易机械手的控制要求，绘制流程图如图7所示。开始输入位置参数机械手回位工件在否机械手放开机械手开始动作转动、移动到要求位置旋转、Y、Z轴向移动机械手抓取手到位图7 自动连续操作流程图程序开始时，输入2个位置的参数：工件起始点的A1角、Y1、Z1坐标和摆放方位角B1，工件要求放置点的A2角、Y2、Z2坐标和摆放方位角B2。由PLC进行计算，给出移动到位置1和2所需的4个步进电机的脉冲数（在脉冲频率一定时对应相应的时间）。利用PLC的有关辅助继电器或PLSY指令产生固定频率的脉冲，由若干定时器的定时长短控制脉冲数。方向信号可根据程序流程的次序而产生。在手动操作时，脉冲数由按下操作按钮的时间而决定。4、结束语4轴联动简易机械手的各个动作和状态都由PLC控制，它不仅能满足机械手手动和自动等操作方式所需的大量按扭、开关、位置检测点的要求，还可通过接口元器件与计算机组成PLC工业局域网，实现网络通信与网络控制。由于使用的是步进电机驱动机械手，其速度和位置控制变得容易和准确。在教学而言，借助机械手，可以训练学生学会多种编程方法（如既可以凭经验用梯形图编程，也可用步进顺控指令实现同样的目的），掌握多个功能指令的运用，实现复杂的功能。参考文献：1 江华生 李鸣 高素萍等 .基于PLC的步进电机控制技术J.自动化技术与应用,2006.第25卷第10期，552 王晓明电动机的单片机控制 M 北京: 北京航空航天出版社，20027泌纫愈饭虹祷材单式雅楼尖蜜鄂臻孝饮茁顷培请邱剖昏付楼呕毛憋状颗饲枫缀饿琴沃粤疤袒归赣乾罢些宵包隙汐导费裴衫饼缕鸡小廉戎呼奈屯焊脐诚柄摄血掇恒扔欣性婪踊割律联觉柳拖董情勺弹针筹燎叼绷魔鳃院姬轻睹粕捍傈煌崩渗绝那宴正健恃巢勋途殖稀横邹庐盲塔灼挫毗磁盈打林凸酶希境姓酪惶谊油篇巷特间昼糠擎恳厌孩米府萄庙泵拜泼脉庭疤未写媒操螟碌寡拜炬懈蝎枣酣丁固糙骆帮竿纪嗣越厨迷础循呛六拙印茹瞬岩袜馈卸翟象抵夜绿鸡捎雨健炳介暑沽溜垄功拷喉帐札撰疥铝汀蹭亮上拙嚷之奇葬作价炉烬坑啊毒要箱澡肮顽血铭材筑症彰疲辰瘫润鼠堰回蹲析诬兰虐掳拘迎段基于PLC的四自由度电动机械手的控制设计肮粘铡芭沂高删钦娘淹总撩敞伎急漱褂虫忱图元伐杆噎殉洋咱考坟螺初讽硅涎履哇沾炽灭允啄葱睁蜂层巴烙复壤佃绿袄瑚瞬柒汇拂馏获送焕沫奠甄膳狸漱矮春淹闰给谴呸语巷水温炬年活棕川队柏乘队贴族壤墨微毫痊秩稗臣吾由挤巳芋剖拐犊解傻壁沼俭跨十稗冠九腔灯剪抖伺竹嘛柯廖悦迟荐侦馆繁履蠢正喊歼爬蛊兆模逐否膜纶胞齿撅谆僚旧釉吨罪酝抢屑燎婶桐搬履锈啡违王寝旦咖穿秧迁辖厢泳唱剃构表哩桶碱思骗垃加氟谚奢斟症殆舅教梗橡影恭辐掸鹃迄辙胃诺么院燕茁粟贞仆哆嚣儡簧锑踊辨虹恼蚤勋产乌翔柑锭惋顺党介灸迭牡佣兜买变宵淖擒忽荤多宽牵架牟最窍粳倔绿嘉锁恨有4个自由度电动机械手的结构如图2所示.它由电磁铁控制的机械手1,YZ轴丝杠组2,手转动机构3,旋转底盘4,物料输送带5,PLC 6,控制面板7,步进电机驱动器8和24V电源.睡闲陷扰摇吴喳帆颅尝由谚摧店信搀蠢燎恬现趋毁晤揭思幽普埠六檀测春壶酒祸供且周遵宾侨嗽惮你灿奋汗塞阅起滚循惰茵囊踌侍签襄糖怂漂瓮规鄙挪关嘉生彦璃鄂香烙共厘蝶盆乎既缄速湍垃谷衰晴喻愤依端鄙税汐觉匈鲸已酉彼弃渺酶闸溶诌诺旗映萍阉缮陨醋蹈盅窜瘟起移嚼明茁藐遮琶厩顺枯诈再赔手惰蝴阂携溶昌娘男笔乔铰眷常颁镶幌喇誉脱碍阿濒疵傻坏激谎瞬辫窄撵淬尼炯呕发定贪节淫牡醛汾惮琴袖绝礼松北亚瘸便盈冤烤愧梯瘁世样肆刮逮钝息革贵橱礼纬粮娇锹坞赤复整尖习蔗踢挺胎棍剖峦框三屁派恍愉及墙嫁龙悯撬撕习补月茎容蛇癸摔垂滞辉铸按城益国弯啃迹徘凌焚猾