毕业设计(论文)-四自由度码垛机器人控制系统设计[管理资料].docx

学士学位士文ShandongUniversityBachelor'sThesis论文题目：W自由度码垛机器大控制系统设计姓名学号20061701027学院控制科学与工程学院专业自动化年级2006指!导教师2010年6月1日作为物流自动化领域的一门新兴技术，近年来，码垛技术获得了飞速的发展。码垛机器人以其高效、高精度、占地范围小等优势正在快速占领整个码垛行业。特别是西方发达国家几乎完全替代了人工码垛。从“七五”科技攻关开始，我国将工业机器人及应用工程作为研究开发重点之一，实现了中国机器人产业的“从无到有”。然而，从整体上说我国的机器人产业还很薄弱，机器人的研究依然任重而道远。本文就是立足于此，以具体工程实践为研究背景，进行四自由度码垛机器人控制系统的研究，以实现对码垛机器人的运动控制，满足生产实践需求。论文的主要内容如下：1、在绪论中简要介绍了本论文的研究背景及意义。2、通过分析机器人机械结构，获得机器人的几何模型，通过运动分析，得到运动变换关系式。3、根据码垛控制需求，选择位置伺服控制，并进行相关MATLAB仿真。4、以ACR90多轴运动控制器和MT6IOOiV人机界面为核心控制器件进行相关系统硬件线路设计，共分为以下几个部分：相关器件选型、电气线路连接、控制器与伺服信号线路连接、触摸屏与控制器线路连接5、以ACRVieW和EB8000为开发工具，分别对下位机程序和人机界面进行开发。其中下位机程序运用AcroBasic语言进行模块化编程以实现示教、回零、再现、手动运行、参数设置等功能。上位机通过将相关控件与相应地址相链接实现对下位机的控制。关键词：码垛机器人，控制系统，位置伺服控制，ACroBaSie语言，模块化编程AbstractAsanewtechnologyinlogisticsautomationarea,inrecentyears,stackingtechnologyhasexperiencedarapidgrowth.Withtheirhighperformance,highprecisionandsmallareaadvantages,stackingrobotsarequicklycapturingtheentirepalletizingindustry.Especiallyinthewesterndevelopedcountries,palletizingrobotsalmostcompletelyreplacedthemanualstack.Sincethetacklehard-nutproblemsinscienceandtechnologyduringChina,sSevenFiveyearPlanperiod,Ourcountryhasmadetorch-planprojectsandapplicationofindustrialrobotsasoneofthekeyresearchanddevelopmenthassuccessfullyrealizedrobotindustry"fromnonexistencetopassintoexistence"plan.However,onthewhole,ourcountry'srobotindustryisstillunderdevelopment,robots'researchisstillalongwaytogo.Thisarticletalksaboutthecontrolsystemofrobottorealizemotioncontroloftherobotbasedontheengineeringpracticewithspecificbackground.Ourpurposeistomeettheindustryrequirement.Specificcontentofthearticleareasfollows:1. Theintroductionofabriefbackgroundofthisthesisanditssignificance.2. Throughtheanalysisoftherobot'sphysicalconstruction,getasimplifiedgeometricmodel,andwithkinematicanalysis,gettransformationequationoftheendeffector.3. ChoosethewayofServo-positionControltomeettheneedofthestack.4. UseACR9000controllerandMT6IOOiVHMIasthecoreofcontroldevicetodesignthehardwaresystem.Thispartisdividedintothefollowingseveralparts:relatedcomponentsselection,electricalwiringconnections,theconnectionbetweencontrollerandservodriver,controllerandtheHMI5. UsingthedevelopmentsoftwareofACRViewandEB8000todesignthecontrolprogramandinterfaceoftheHMLThecontrolprogramisdesignedbyAcroBasiclanguage.Wecanusetheprogramtorealizethefunctionofteach,playback,backhome,manualoperation,parameterssettingsandsoon.Besides,HMIcontrolthecontrollerbytheconnectionofActiveXwithrelevantBITaddress.KEYWORDSstackingrobot,controlsystem,servo-positioncontrol,AcroBasiclanguage，modularprogram目录第一章绪论1国内外发展现状2论文研究意义和目的2本文主要研究内容3本章小结3第二章码垛机器人机械结构及其运动学分析4码垛机器人的机械结构4运动学分析5本章小结7第三章伺服控制方式选择及仿真8伺服驱动系统要求8AC伺服电机工作原理8伺服控制方式选择9位置伺服系统10*MATLAB4方11本章小结13第四章硬件控制系统设计14硬件系统控制结构14主要控制部件选型MiS彳G线路连16触摸屏与ACR9000的连接16ACR9000与伺服驱动器之间的连接17其它信号线路18电气线路连接18£二：1'名占'1第五章软件系统设计19下位机软件开发19ACRVieW开发环境介绍19系统参数配置流程19ACrOBaSiC语言及相关编程介绍33软件编写流程35典型程序介绍35运动监视、调试374242EB8000开发软件介绍名吉44第六章系统测试45结束语46致谢48参考文献49附录50附录L控制柜电气线路连接图50附录2.调试过程图片51附录3.成品实物图52附录4.下位机程序52第一章绪论研究背景所谓码垛就是按照集成单元化思想，将一件件物料按照一定的模式堆码成垛，以便使单元化的物垛实现存储、搬运、装卸运输等物流活动山。作为物流自动化领域的一门新兴技术，近年来，码垛技术获得了飞速的发展。一方面,随着企业集团化，生产能力规模化，对码垛能力的要求不断提高，传统的简单的码垛机和人工码垛己不能满足生产需要；另一方面，随着产品生产向着多品种少批量的方向发展，企业往往需要一线多产品的生产线，这就要求码垛机必须具备处理多种产品的能力。另外，随着大型物资批发配送中心的出现，需要为成千上万个用户按订单配送产品，这就要求码垛机具有混合码垛的能力，所有这些都为码垛机器人的发展提供了机会。作为工业机器人的典型的一种，继70年代末日本将其用于码垛行业以来，码垛机器人在工业应用，尤其是包装厂、领域和物流领域正发挥着越来越大的作用。将机器人Ij尸:与包装线相结合，既提高了生产线的工作效率，又增O蛾强了运行的可靠性，减少了人力资源的开支，更让当代企业迅速适应不断变化的市场要求，产生巨大的经7tz图1-1码垛过程示意图济效益。码垛机器人以其特有的优势迅速抢占了码垛市场。其优势主要表现在以下几个方面：码垛机器人不仅能承担高负重，而且速度和质量远远高于人工码垛。,工作范围大码垛机器人的占地面积小，操作范围大；每一台码垛机器人都有独立的控制系统，极大地保证了作业精度。可以根据需要抓取不同类别的产品，更能适应现代多元化的生产。机器人虽然前期投入较高，但是却能达到成本效用最大化，且各家机器人都在为客户的成本控制而在产品中不断加入新的科技成果。5.可以与其它检测设备和生产设备进行协调控制，构成现代化得自动生产线，大大提高企业自动化水平，提高了生产效率，增强企业竞争力国内外发展现状目前欧、美、日的码垛机器人在全球市场的占有率均超过了90%,在机器人国际市场中占领份额最大的是日本，其生产、使用及销售一直处于全球领先位置。目前日本已经有130余家专业的机器人生产制造商。据日本机器人联合会2007年8月公布的数据显示:2007年第二季度机器人销售金额为1460亿日元，其中出口金额竟达到978亿日元。虽然2008年的金融危机使机器人的生产厂商也受到牵连，机器人生产和销售都有所影响，但随着经济的复苏，机器人行业也出现回暖的形势。2009年全球机器人行业总销售量仍比2006年增长10%。从“七五”科技攻关开始，我国将工业机器人及应用工程作为研究开发重点之一，经过研制、生产、应用，实现了中国机器人产业的“从无到有”。“十五”期间是我国机器人产业发展的一个关键转折点。经过多年的研究开发，我国的机器人技术已经日趋成熟；市场需求在“十五”初期也有了一个“井喷式”的发展。此外我国也已经形成了以新松为代表的一些具有一定竞争力的机器人公司和产业化基地。但是，从整体上说我国的机器人产业还很薄弱，机器人的研究依然任重而道远。我国市场上机器人总共拥有量近万台，%,其中完全化国产机器人仅占30%,其余皆为从日本、美国、瑞典、德国、意大利等20多个国家引进。究其原因，很大程度在于自主品牌不够，发展壮大自主品牌及其自动化成套装备产业成为当务之急。论文研究意义和目的日本、美国等西方发达国家码垛机器人应用广泛，几乎遍布整个相关行业。而在中国，码垛机器人在食品、包装等行业才刚开始得到应用。码垛机器人未能在较大行业范围内使用，而且在使用的码垛机器人中，进口的占据大部分比例。从各方面显示，工业机器人正处在迅猛发展阶段，掌握机器人的控制系统设计刻不容缓。另外，国家对机器人行业发展日益重视。山东省近日出台指导意见,从政策与资金方面促进机器人产业创新发展,促进机器人产业尽快成长为战略新兴产业。为加大对机器人产业的资金投入力度,山东省将建立以政府投入为引导、企业投入为主体、金融投入为支撑的多元化投资体系。自2010年起，实施山东省机器人创新发展科技重大专项，重点支持面向山东省主导产业及领域的机器人关键共性技术研发及产业化项目的实施。省科技厅、发展改革委、经济和信息化委等部门的相关计划和专项资金安排向机器人的研究开发和示范应用推广倾斜。这对于机器人发展是一个重大机遇。因此抓住机遇，从事相关控制系统的研究，开发出高性能、低成本、具有自主知识产权的码垛机器人具有广阔的市场前景，同时可以进一步推进自主工业机器人的研发及推广使用，对于提高我国工业生产的现代化水平，都具有重大的经济价值和现实意义。本文主要研究内容本文依据山东省科学院自动化研究所机器人国家工程研究中心山东分中心所自主开发的一款四自由度混联码垛机器人为研究背景。主要研究码垛机器人的控制方案、控制算法，以及运用PARKERACR9000对伺服驱动器进行控制，运用威纶MT6IOOiv触摸屏进行上位机的开发。第1章主要对选题背景和研究内容及意义进行概述，介绍国内外码垛机器人的发展现状以及本文研究的目的和意义。第2章对码垛机器人进行机械结构及其运动学的相关分析。第3章对伺服电机控制特性进行分析设计，并运用MATLAB自带的SIMULlNK工具进行系统相关的仿真。第4章则重点介绍运动控制系统的硬件设计，包括对硬件控制器件的选型，线路连接等。第5章则进行相关软件的开发，包括运用ACroBaSiC语言对控制器进行编程，以及对触摸屏界面进行设计等。第6章则通过实际测试获得机器人的各项运动参数。最后一章是对本篇论文进行系统的总结。本章小结本章主要介绍了码垛机器人的相关发展背景，并对国内外的发展现状进行了描述。同时说明了课题的主要研究意义及研究内容。第二章码垛机器人机械结构及其运动学分析码垛机器人的机械结构图2-1码垛机器人机械结构图用于码垛的机器人只需要4个自由度即可满足实际需求。所设计的码垛机器人的具体机械结构如图2-1所示。该机器人为四自由度混联机器人。其中1底部基座，2内六角圆柱头螺钉3标准型弹簧垫圈4直线运动单元5外壳6连杆机构7内六角圆柱头螺钉8标准型弹簧垫圈9内六角圆柱头螺钉10标准型弹簧垫圈11内六角圆柱头螺钉12标准型弹簧垫圈。手臂固定在腰部，其中小臂通过前大臂、后大臂的运动实现搬运和码垛作业。该机器人包含4个关节，能够实现4种运动：手臂前后运动、上下运动、腰部旋转运动、手腕回转运动。在运动的极限位置都安装有限位开关。水平和垂直方向的运动是通过由前大臂、后大臂、大臂连杆、小臂四个构件组成的平行四边形实现的，而腕部是由小臂、辅助连杆、腕部、三角架构成的连杆机构在运动中保持水平的。运动学分析工业码垛机器人机构简图如图2-2所示，当F点固定，E点沿水平方向移动时，A点的水平移动速度为E点的人倍，如果E点作匀速运动，A点也将作匀速运动：当E点固定，F点沿垂直方向移动时，A点的垂直运动速度为F点的入-1倍，如果F点做匀速运动，A点也将作匀速运动。其中入=ACBC=CFDF.如图2-3所示，设置一个固定的坐标系XOY,其随基座一起旋转。当机器人本体处于虚线所示的位置时，平行四连杆机构的FO点为坐标系的原点，X轴与AoCO平行。图中，DF=140mm,CD=700mm,BC=140mm,AB=700mm,BE=700mm,DE=140mm。图2-3机械结构运动分析示意图下面分析当水平电机驱动模块正向移动X,垂直电机驱动模块正向移动y时，码垛机器人腕部的运动规律。因为DoF=DFy,DOE=DE+x,贝J(1)ZW)=鼠)EF=JOo尸+DqE2=y(DF-y)2+(DE+x)2在ADEF中，有2=NDEF叩cc。S(史坦3)2×DF×EF3=NFDE=arccos("fl)(4)2XDE×DF此时，C点坐标为Xe=CrXCOS(4+2)*yc=y+CF×sin(l+1)此时A点坐标为xa=xr+AC×cos(t-1-7)<(6)yA=yc-AC×sin(-1-y)将式(5)带入式(6)中，可得：xa=CT'xcos(6+%)+ACxcosg-G。2仇)(7)yA=>,+CF×sin(1+2)-AC×sin(,-1-2-3)将以、匕、03及全部已知变量带入式(7)中，利用几何知识解得(8)(9)xa=840+6xM=840-51则有r，xa=6xy,A=-y图2-4码垛示例图如图2-4所示，机器人码垛时，当码垛机器人搬运物品从生产线上的A(xo,y0,Z0)点到托盘上的B(xbybz1)点时=90°-arctan(-)(10)水平关节移动距离为1=(U12+W)-y0)z6(11)I2=(z1-z0)/(-5)(2)由以上分析可知，给定给定工作区间上初始位置和任意一点，即可计算出各关节应旋转的角度或位移。同理，已知各关节旋转的角度和位移，亦不难求出末端机械手的位姿。本章小结本章通过对码垛机器人的机械结构进行分析，获得简化几何模型。通过对模型的运动学分析和计算获得机器人的位姿变换关系式，为下一步实现对机器人的位置精确控制打下基础。第三章伺服控制方式选择及仿真伺服驱动系统要求机器人电动伺服驱动系统是利用各种电动机产生的力矩和力，直接或间接地驱动机器人本体以获得机器人的各种运动的执行机构。对工业机器人关节驱动的电动机，要求有最大功率质量比和扭矩惯量比、高起动转矩、低惯量和较宽广且平滑的调速范围。特别是像机器人末端执行器（手爪）应采用体积、质量尽可能小的电动机，尤其是要求快速响应时，伺服电动机必须具有较高的可靠性和稳定性，并且具有较大的短时过载能力。这是伺服电动机在工业机器人中应用的先决条件。机器人对关节驱动电机的主要要求归纳如下：1）快速性。电动机从获得指令信号到完成指令所要求的工作状态的时间应短。响应指令信号的时间愈短，电伺服系统的灵敏性愈高，快速响应性能愈好，一般是以伺服电动机的机电时间常数的大小来说明伺服电动机快速响应的性能。2）起动转矩惯量比大。在驱动负载的情况下，要求机器人的伺服电动机的起动转矩大，转动惯量小。3）控制特性的连续性和直线性，随着控制信号的变化，电动机的转速能连续变化，有时还需转速与控制信号成正比或近似成正比。4）调速范围宽。能使用于较大的调速范围。5）体积小、质量小、轴向尺寸短。6）能经受得起苛刻的运行条件目前，由于高起动转矩、大转矩、低惯量的交、直流伺服电动机在工业机器人中得到广泛应用，一般负载I（X）ON（相当IOOkgf）以下的工业机器人大多采用电伺服驱动系统。所采用的关节驱动电动机主要是AC伺服电动机，步进电动机和DC伺服电动机。AC伺服电机工作原理目前国际上的工业机器人90%以上均采用AC伺服电机作为执行机构。永磁交流伺服电动机同直流伺服电动机比较，主要优点有:无电刷和换向器，因此工作可靠，对维护和保养要求低。定子绕组散热比较方便。惯量小，易于提高系统的快速性。适应于高速大力矩工作状态。同功率下有较小的体积和重量。机器人所采用的AC伺服电机也常常被称作是DC无刷伺服电机。伺服电机内部的转子是永磁铁，驱动器控制的U/V/W三相电形成电磁场，转子在此磁场的作用下转动，同时电机自带的编码器反馈信号给驱动器，驱动器根据反馈值与目标值进行比较，调整转子转动的角度。伺服电机的精度决定于编码器的精度（线数）。AB"C 二Ae伺服电机mm驱动电路位置传感器输入指令控制电路图3-1AC伺服电机工作电路基本组成图3-1给出了AC伺服电机工作电路的基本组成。交流电源通过整流滤波后再经过PWM逆变器输出交流信号，形成旋转的磁场，从而使电机运动。通过控制驱动电路的脉冲信号通断来实现对电机运动的控制.伺服控制方式选择一般伺服包含三种控制方式：速度控制方式，转矩控制方式，位置控制方式。（1）速度控制方式：通过模拟量的输入或脉冲的频率进行转动速度的控制，速度控制模式主要用于对速度要求比较高的场合。（2）转矩控制方式：转矩控制方式是通过外部模拟量的输入或直接的地址的赋值来设定电机轴对外的输出转矩的大小，可以通过即时的改变模拟量的设定来改变设定的力矩大小，也可通过通讯方式改变对应的地址的数值来实现。主要应用于对速度和位置要求不太严格，对材质的受力有严格要求的缠绕和放卷的装置中。（3）位置控制方式：位置控制模式一般是通过外部输入的脉冲的频率来确定转动速度的大小，通过脉冲的个数来确定转动的角度，也有些伺服可以通过通讯方式直接对速度和位移进行赋值。由于位置模式可以对速度和位置都有很严格的控制，所以一般应用于定位装置。码垛机器人运动轨迹属于PTP型，在运动过程中末端执行器以最快的速度从一点准确定位到另一点。机器人的控制对末端执行器的位置精度要求较高，而对末端执行器的速度控制和力矩控制没有特殊要求，所以确定码垛机器人关节点选择位置伺服控制方式以保证末端定位精度。位置伺服系统图3-2位置伺服控制方式原理图关节单元位置伺服控制系统工作原理如图3-2位置给定信号与位置反馈信号之差值通过调节器进行动态校正，然后送至速率调节器、电流调节器，即经过外环、中环、内环三个闭环调节器的校正再由模拟功率接口驱动伺服电动机，实现位置伺服控制。在这个系统中，位置调节器的作用是使位置给定与的偏差向最小变化。速度反馈调节器的主要作用是阻尼位置调节过程的超调。电流调节器的作用是减小力矩波动，改善动态响应的快速性，并对最大电流进行限定等。滤波电路的作用是滤除位置或速率传感器输出信号中的谐波信号。以上各环节的参数的设计和整定应根据具体的负载的性质（力矩和惯量的大小），以便满足位置伺服精度的要求。位置环处理时采用积分PID算法。通过调节比例、积分、微分的参数，可以使伺服电机获得较好的动态性能，使实际位置与期望位置偏差较小，从而使系统保持较高的运动精度。离散化PID控制算式为：U(k)=Kpe(k)+Ki(z)+Kde(k)-e(k-l)其中，k为采样序列号，k=0,1,2.；Kp.Ki、Kd分别表示比例、微分、积分系数。根据递推原理得到其增量式PlD算法为：(7(k)=KPAe(A)+Kje(k)+KdAe(A)-e(-1)通过调整Kp.Ki、Kd的值，配合较高的机械精度，可以使伺服系统的动作灵敏，响应加快，使位置控制在一定的偏差范围内。机器人MATLAB仿真系统仿真采用MATLAB中Simulink自带的机器人系统实例。具体仿真模型如图3-3所示。图33机器人系统MATLAB仿真原理图该仿真系统中采用两路伺服电机，模拟平面内的运动。可以实现两轴的协调控制仿真过程模拟机器人从点-30,-45到点30,45的运动状态，其中参数设置为两路电机系统位置环PlD参数均为P=32000,D=400,速度环PID参数设置为P=,1=10,加速度及减速度均设为500OrPmZS,减速比设置为130。仿真结果如图3-4,其中第一幅仿真图读取的参数为机器人运动参数。从上到下读取参数依次为转矩、加速度、运动速度、位置。第二幅和第三幅读取的分别是两路伺服电机的相关参数，从上到下依次为电压、电流、转矩、回转速度。从图中可知，该系统多电机同步效果较好，反应灵敏，位移较为精确，可以很好的满足码垛的需求。图34MATLAB仿真结果本章小结通过对伺服驱动系统的要求及AC伺服电机工作原理的分析，选择合适的伺服控制方式，即位置控制方式。并通过对反馈环的分析，获得所要调节的控制参数。最后通过MATLAB仿真，进行控制方式验证和参数调整。第四章硬件控制系统设计硬件系统控制结构整个控制系统基本硬件平台如图47所示图4-1控制系统硬件结构图主要控制部件选型1.运动控制器运动控制器选用美国Parker公司生产的独立式系统级别的多轴控制器ACR9000o和传统的板卡级运动控制卡相比，ACR9000可脱离工控机工作，稳定性好；封闭式结构，抗干扰强；屏蔽电缆连接，屏蔽性好，通讯距离长；体积小巧。ACR-9000的特点主要包括以下几个方面（1）稳定，可靠的硬件结构（2）直观、友善的调试开发界面（ACR-VIEW）（3）灵活、简便的编程功能（4）强大、开放的PlD算法（5）强劲、多样的运动及插补功能（6）针对不通应用领域提供的特殊功能（7）强大的通讯能力，便捷地HMl开发方式控制器具体规格参数说明如表1所示表1ACR9000规格参数说明硬件控制轴数2,4,6or8轴（选用的为6轴）处理器32位浮点DSP150MFLOPS/75MHZ轨迹运算64-bit精确度用户存储区IMB内存，用于保存用户的程序和设置的参数固件闪存外形尺寸“WX“HX”D(2-4axes),“wX,H×”D(6-8axes)操作系统多任务实时操作系统电池可选备份电池使用户程序和参数不易丢失性能多任务8个坐标系/16个正本程序/8个梯形图程序轨迹更新每100-500s伺服更新25Us/axis梯形图逻辑PLC100-500s扫描时间插补直线、圆弧、正弦曲线、螺旋线、椭圆、样条、三维弧形伺服环PID,速度前馈，加速度前馈，Notch和低通滤波位置修正硬件VIUSCC通讯串行接口1个串行端口(RS232and/orRS422)Ethernet10100Base-TUSBCANopenDS401协议，用于1/0扩展。（可选项）控制信号模拟输出可输出到8路，16位模拟量步进输出可输出到8路，最高频率输入输出编码器输入可输入到10路正交编码器信号，20MHz。可通过软件设置同步串行接口（SSI）,正交接口，步进和方向，CW/CCW模式模拟输入8路单端（4路双端），12位（可选项）内置数字I/O2到4轴控制内置20点24VDC光隔离输入，4点24VDC光隔离输出；4到8轴控制器内置40点，24VDC光隔离输入，8点24VDC光隔离输出软件提供开发软件ACR-View软件开发包语言支持动态链接库支持C+,VB6,C#,2.触摸屏触摸屏选用威纶MT6100iV0威纶系列触摸屏是目前市场上使用较为广泛的一类触摸屏。所选内含32位RISC（精简指令集）微处理器，高效快速，功能强大、使用方便、可靠性高、寿命长、性价比高。触控反应灵敏，具有高可靠性。能够支持市场上大多数的PLc特别是兼容对ACR9000控制器的开发，这是其它触摸屏所不具有的。3.伺服驱动器及伺服电机选用安川系列产品。驱动器型号为SGDM-10ADA,输入电压为200-230V,最大输入电流为7A。输出0-230V,输出功率为230W伺服电机根据关节位置的不同，工作性能要求也不相同。这里不再详细说明。通信线路连接触摸屏与ACR9000的连接触摸屏与ACR9000控制器之间通过RS232进行串口通讯团，具体通信线路连接如图4-2所示：ACR9000RS232 COM1weinviewMT8000系列触摸屏C0M12RX3TX5GND图4-2ACR9000与触摸屏连接示意图3TX2RX5GND其中通讯参数设置为COMl(9600,N,8,1),不需要进行站号设置。ACR9000与伺服驱动器之间的连接24V开关电源33PAO 34PA0 35PB0 36PB0 19PC0 20PC07PULS 8/PULS 11SIGN 12/SIGN32ALM-31ALM+47 24V+ 40/S-ON 42P-OT 43T-OT44ALM-ResetA+3A-4B+5B-6Z+7Z-8；Step+10jStep-11>Dir+12)Dir-13Drivefault+16Drivefault-17Enable-20Enable+21DriveReset-22DriveReset+23图4-3ACR9000与安川伺服驱动器连接电路图该连接信号线路较多，连接起来比较复杂。具体线路连接图如图4-3所示。控制器和伺服驱动器具体引脚功能说明见表2表2ACR9000与安川伺服驱动器引脚说明ACR90安川引脚号说明引脚号说明3编码器输入A+33PAO4编码器输入A-34/PAO5编码器输入B+35PBO6编码器输入B-36/PBO7编码器输入C÷19PCO8编码器输入C-20/PCO10脉冲+（驱动器位置控制方式）7PULS11脉冲（驱动器位置控制方式）8/PULS12方向+（驱动器位置控制方式）11SIGN13方向-（驱动器位置控制方式）12/SIGN16读驱动器报警输入+（外接+24V）32ALM-（警报输出负）17读驱动器报警输入-31ALM+（警报输出正）20对驱动器使能输出4724V+21对驱动器使能输出+40/S-ON（伺服使能端）22对驱动器复位输出42P-OT（禁止正转驱动）43T-OT（禁止反转驱动）23对驱动器复位输出十44ALM-Reset其它信号线路在调试过程中，上位机是通过USB下载线与触摸屏进行通讯的。上位机与ACR9000的通讯是通过Ethernet实现的。电气线路连接主要是主电路控制柜配线。需要配合使用继电器器，开关，急停按钮等。电源采用220V交流电源。通过控制器输出伺服驱动器控制信号，以实现伺服电机电机的同步运行。具体电气线路图请参见附件1。本章小结本章主要对控制系统硬件系统进行搭建和连接。选择合适的控制器件，进行信号线路和电气线路的连接。从而实现由人机界面控制控制器，实现对伺服驱动器的控制，从而控制机器人按要求运行。第五章软件系统设计下位机软件开发ACRVieW开发环境介绍ACRVieW为Parker控制器自带的开发工具，可以支持EthemeLUSB,CANopen和串口连接等多种通讯方式。含有配置向导使项目的建立更为简易，可以将系统参数设置好以备控制器随时进行对运动和代码的开发。通过配置向导可以对机械参数、PID参数、伺服增益、正/反向运动进行调整。设置导向中有一个易于使用的试运行装置，用来快速验证每一个轴的关键运动状况和硬件设置;程序编辑模块同时支持AcroBasic语言和PLC语言编程。另外为了调试运行方便，ACRVieW还提供了很多状态监视窗口，包括参数监视面板、BIT位监视面板、伺服环监视面板、通用状态面板以及图形监视功能，极大的方便了用户。系统参数配置流程ACR-View软件安装好之后，我们可以通过下面的方法来打开。逐步单击“开始”菜单“所有程序”"ParkerAutomation""ACR-View”uACR-ViewProgram”，弹出“New/0PenProject,对话框，如图5-1所示，该对话框用于新建或者打开现有的工程。Mew0penProject(×IOK ICancelIDernoll(CreateNewProjectCOpenExistingProject图5-1新建窗口下面我们新建一个工程：选中“CreateNewProject”单选框，并在后面输入工程的名字,我们这里输入工程名为“Demol”，点击“0K”按钮继续，弹出新的对话框，在这里需要选择控制器类型，我们这里选择“ACR9000”，如图5-2所示：图5-2选择控制器类型单击“下一步”按钮，在新弹出的对话框中选择所购买的ACR控制器型号，我们手头的产品是9000P1U6B0,因此选择这个型号，如图5-3示：图5-3选择控制器型号单击“下一步”按钮，在新弹出的对话框中保持默认设置，再单击“下一步”至此，工程配置操作完成，弹出ACR-VieW主界面，如图5-4示：图5-4ACRVieW主界面我们可以看到，该对话框主要分成四个区域：1 .最上面是菜单栏2 .菜单栏下面是工具栏（分上下两层，上层是通用工具栏，下层是梯形图编程工具栏）3 .工具栏下面左侧是树形向导，也是我们经常要打交道的地方4 .树形向导右侧是主操作界面区域，其显示内容会根据在树形向导中所选择内容的不同而变化，我们大部分操作都要在这个地方进行。当新建一个工程后，在主界面中首先会显示“通讯”对话框，如图5-5所示图5-5通讯设置窗口在这个对话框中，我们要选择用到的通讯方式，主要有下面4种：Bus：总线通讯，只用于ACRI505,ACR8020板卡式运动控制器Serial：串口，在后面指定与运动控制器连接的PC机的串口号，及通讯速率Ethernet：以太网，在后面输入ACR9000的IP地址，USB：电脑通过USB与ACR9000通讯。我们选择以太网，点击Connect使电脑与ACR9000连接。下面我们需要对ACR9000的各个电机轴进行配置。我们单击左侧“树形向导”中的ConfigurationWizard（配置向导）”，如图5-6中蓝色区域位置：BDemOlB , ACR9000ConfigurationWiZardProgramEditorSFPLCEditor心TerffiinalEmulatorjTools田恒StatusPanels国SSScopes图5-6点击配置向导点击后，会在主界面区域中弹出图5-7所示对话框：图5-7配置向导说明该对话框是对aConfigurationWizard（配置向导）”简单说明，点击“Find”按钮（图5-7中黑框处）可以查看当前控制器中的固件版本号，单击“Next”按钮继续，弹出图5-8所示对话框，该对话框说明了配置需要有哪些步骤，单击“Next”按钮继续到下一步。单击“Back”按钮可返回上一步。TheConfigurationWiNardwillnowleadyouthroughthe1. CommandOutput2. Drive/Motor3. Fdbck4. Scaling5. Fault6. DedicatedI/OClickOntheNextpushbuttonbelowto图5-8配置步骤说明单击“Next”后，弹出图5-9所示对话框，从这里要开始对第一个电机轴进行配置图5-9轴设置开始该对话框指定轴的名字，及控制器对驱动器输出的信号类型。AxisName:指定轴的名字，一般保持默认。CommandOutput：选择控制器输出给驱动器的信号类型，“DAC”代表输出+/-1OV模