三轴伺服移动平台控制系统的设计毕业论文设计

1、金 华 职 业 技 术 学 院j i n h u a p o l y t e c h n i c毕业教学环节成果 （2014届）题 目 三轴伺服移动平台 控制系统的设计 学 院 信息工程学院 专 业 电气自动化 班 级 自动化111 2014年5月30日金华职业技术学院毕业教学成果目 录摘要1英文摘要1引言21 三轴伺服移动平台控制系统简介32 控制系统结构及工作原理43 主要器件选型53.1 可编程控制器的选型53.2 触摸屏的选型54 i/o口分配表65 控制系统电路设计85.1 plc外围接线图85.2 伺服电机控制电路图95.3 横移电机控制电路图96传感器116.1 左右移动位置传感

2、器116.2上下移动位置传感器116.3 车位检查传感器117安装127.1控制系统接线图127.2 控制柜电气元件布局图12结论与谢辞13参考文献14附件115三轴伺服移动平台控制系统的设计信息工程学院电气自动化技术 摘要: 介绍了基于三菱q系列plc对三轴伺服移动平台的控制系统，选用了mcgs触摸屏实现人机交互 。文中给出了三轴伺服移动平台的基本架构。简单分析了伺服控制系统的控制系统结构及工作原理与一些传感器的使用。重点介绍了控制系统程序以及plc i/o口，还简单介绍了下移动平台控制系统的布局图与接线图。关键字 plc 人机界面 伺服控制design of control system

3、of three axis servo mobile platforminformation engineering college of electrical automation technology zhong zhang boabstract: introduced the q series based on mitsubishi plc control for lifting and transferring parking equipment, used mcgs touch screen realization of human-computer interaction. thi

4、s paper presents the basic structure of three axis servo mobile platform. a simple analysis of thesystemstructure and working principleof the servo control systemandsome sensors. focusing on the control systemprogram and the plci/o,also introduces thelayoutdiagram of the control systemundermobile pl

5、atformandwiring diagram.keyword: plc human-computer interface servo control引言现代工业对运动控制的要求越来越高，因而高精度电气系统和高性能自动控制系统应运而生。采用三菱电机有限公司推出的q系列高性能cpu、qd75m 定位模块以及 sscnet总线等集成三维伺服控制系统，将plc技术的优势和伺服控制诸多特性完美地结合于一体，以便使运动控制系统性能达到一个更好的水平。三维交流伺服这样一种扮演重要支柱技术角色的自动控制系统，在许多高科技领域得到了非常广泛的应用，如激光加工、机器人、数控机床等，因此该项目的研究有良好的应用价

6、值。三轴移动平台，有时候我们又称为三轴结构。它是进行目标自动跟踪和定位的关键设备。由于这种平台在运行中拥有着很高的灵活性和稳定性，因此在航天领域、军工领域、工业领域等方面一直有着很高程度的应用。所谓三轴，就是在三维立体空间的环境下，通过长、宽、高三个方面对物体进行控制和定位。把这种技术应用于控制平台的话，则可使受控设备更好的摆脱因设备本身所处的形态等因素对工作效果产生的影响。1基于 q系列 plc的三维伺服控制系统的构架1.1 三维伺服控制系统控制方案的选择该项目采用高性能 cpu + 伺服控制器 (定位模块 ) 进行运动控制。这种解决方案中，系统的控制性能不如选用专用运动型 cpu 的。专用

7、运动型 cpu可同时控制的轴数目多，控制性能优越，系统响应快，但系统一次成本较高，适用控制要求很高的场合。而采用高性能 cpu + 伺服控制器 (定位模块 )方案控制的轴的数目相对少，但性价比高，在目前属于主流的解决方案，也很适合我国的国情。1.2 基于 q系列 plc的三维伺服控制系统组成系统主要由电源模块、高性能cpu、i/o模块、定位模块、伺服放大器和三菱hc-kfs13低惯量交流伺服电机等组成。定位模块与 3个伺服放大器通过专用电缆sscnet网络通信，3台伺服电机分别安放于 x 轴、y轴和 z轴的平面上，能实现在三维空间的精确定位,可以完成多轴直线插补和圆弧插补等运算控制。该系统是按

8、工业级建立的，能针对具体的工艺设计完成对应的伺服控制，模拟实现如数控钻床、数控铣床、精密雕刻机、机械手控制等，系统还集成了mcgs人机界面对伺服系统的运行状况做实时监控。其整体系统结构如图 1所示。q64p电源模块。用于给主基板上安装的各个模块提供 5vdc电源，注意可以安装的电源模块型号依据基板而定；q02h高性能 cpu。支持三维伺服系统的控制与运算。该 cpu以中大规模系统为对象，在大幅提高cpu 模块处理性能和程序寄存器容量的同时，还提高了与网络模块、编程用外围设备之间数据通信的性能。支持本地 i/o最大可达 8 192点，程序容量最大有 28 k步。最快指令仅需 34 ns 。除了可

9、以使用梯形图、语句表、 st (结构化文本，类高级语言 )、 sfc、fb等 5种编程语言外, 还可支持多达 4个 cpu；qx40输入模块 ( i/o模块 )。运动系统的相关检测信号通过该模块送入 plc；qy10输出模块 ( i/o模块 )。运动系统的相关指令信号通过该模块发送给定位模块或伺服放大器；qd75p2定位模块。其内部集成有专用的控制芯片；用做运动控制所需数据的计算，再把处理的结果输入到伺服放大器；sscnet网络。定位模块与3个伺服放大器通过sscnet网络通信。sscnet也称为伺服系统现场总线网，是 plc控制系统中常用的 i/o l ink网，该总线可实现高速通信和简化系

10、统结构的目的。sscnet使多轴的同步、插补等高级定位功能得以可靠实现,在节省配线的同时，提高了整机的响应性，而且降低了因为配线错误而引起的故障概率；系统在连接上由一个主基板将电源模块、高性能cpu、 i/o模块和定位模块连接在一起。1.3 软件平台需要用到的相关编程平台有：gx-works2用于编写q系列cpu程序；gx-works2可以创建q系列、qna系列、a系列、fx系列的数据,实现了设置操作共用化。gx-works2可实现共用功能(工程、在线、诊断、工具、窗口、帮助 )、对各个对象进行编辑及设置的功能 (编辑、查找 /替换、转换、显示 )；同时也是伺服配置软件, 用于配置qd75p2

11、定位模块、mr-j2s10b伺服放大器的数据；嵌入式昆仑组态是专业的人机界面设计软件, 用于完成人机界面监控画面制作。2 三轴伺服移动平台控制系统结构简介及工作原理用三菱plc来控制定位模块，输入输出，再通过定位模块连接伺服放大器，控制伺服电机运行起来。在实际操作是通过人机界面，也就是触摸屏，通信连接三菱plc。为此，所有控制及监控都在触摸屏上进行操作，达到预期效果。x轴、y轴、z轴共三个轴，组装于底座两端的z轴运动系统，架设于所述底座中部的x轴运动系统，以及固定于轴运动系统上的y轴运动系统，其中，所述轴运动系统、轴运动系统以及轴运动系统分别包括伺服电机及滑动装置，该滑动装置包括导轨和滑块；所

12、述轴运动系统还包括一横梁，所述用于驱动该轴运动系统的伺服电机和所述导轨固定于该横梁上；所述y轴运动系统还包括一固定架，所述用于驱动该轴运动系统的伺服电机和所述导轨安装于所述固定架上。三轴运动平台不但可以提高系统运行平稳性和准确性，而且可以实现负载的高速、准确定位。3 主要器件选型3.1 可编程控制器的选型由于要进行精确定位，对控制性能要求较高，所以选择三菱q系列plc，它由电源模块、cpu模块、基板、i/o模块等组成。通过扩展基板与i/o模块可以增加i/o点数，通过扩展储存器卡可增加程序储存器容量，通过各种特殊功能模块可提高plc的性能，扩大plc的应用范围，非常便于使用。三菱q00ujcpu

13、-s8具有八个扩展模块128点i/o口，运算速度快，适合车库的需求。节省空间、节省配线， 安装q系列所需的空间只是原来ans系列的60% 安装灵活。q系列有5槽、8槽、12槽多种基板，可灵活配置，减少系统所用基板数。 cc-link， 它的指令丰富，可以用gx works2，也支持编程器编程，它的编程简单，适合大众人群。它与gx works2高速通信，提高了调试效率，通信接口有usb和rs232。usb接口使它可以和任意一台计算机连接，而rs232可以和触摸屏通信，可以通过触摸屏控制。本系统的x、y轴伺服定位控制系统启动、停止、双轴的手动jog正反转、接近开关以及z轴伺服控制系统的启动、停止、

14、手动正反转、接近开关、系统的回原点等信号；输出端连接的是三个放大器的得电、失电，xyz轴的近点dog信号，另外附带的插槽可以自行增减输入输出模块，三菱q00ujcpu-s8完全可以满足控制要求。3.2 触摸屏的选型mcgs(monitor and control generated system，通用监控系统)是北京昆仑通态自动化软件科技有限公司研发的一套用于快速构造和生成计算机监控系统的组态软件。它能够在基于microsoft的各种32位windows平台上运行，通过对现场数据的采集处理，以动画显示、报警处理、流程控制和报表输出等多种方式向用户提供解决实际工程问题的方案，在自动化领域有着广泛

15、的应用。mcgs主要特性和功能：(1)简单灵活的可视化操作界面；(2)实时性强、良好的并行处理性能；(3)丰富、生动的多媒体画面；(4)开放式结构，广泛的数据获取和强大的数据处理功能。mcgs系统由五大功能模块组成，主要的功能模块以构件的形式来构造，不同的构件有着不同的功能，且各自独立。三种基本类型的构件(设备构件、动画构件、策略构件)完成了mcgs系统三大部分(设备驱动、动画显示和流程控制)的所有工作。除此以外，mcgs还提供了一套开放的可扩充接口，用户可根据自己的需要用vb、vc等高级开发语言，编制特定的构件来扩充系统的功能。mcgs用数据库来管理数据存储，系统可靠性高。mcgs设立对象元

16、件库，组态工作简单方便，易于实现对工控系统的分布式控制和管理。触摸屏选用昆仑通态tpc7062ks型，它是以嵌入式低功耗cpu为核心（arm cpu，主频400mhz）的高性能嵌入式一体化触摸屏。该产品设计采用了7英寸高亮度tft液晶显示屏（分辨率800480），四线电阻式触摸屏（分辨率10241024）。灵敏度较高，而且具有防水防尘。它可通过rs232、rs485或usb与plc接口。它的色彩比较丰富，由65535色7寸屏幕显示，可以增强视觉效果。触摸屏有丰富资源库，在设计时可以在库里面选择适合元件。还具有特点：1实现了显示，运算，通讯全方位的高速化；2高亮度（400cd/ m2）显示，提供

17、免受外部光线干扰的完美图像 ；3 分辨率800480，65535色tft液晶显示 ；4显示尺寸：7英寸；5可视角度：左右70度，上下70/50度 。6 内置64mb标准内存。3.3伺服电机的选择如今市面上有很多种类的伺服电机，国内较常用的有日系的三菱、安川、松下、三洋、富士、日立等；美系的有danaher（原kollmogen）、baldor、parker、rockwell等；还有是台湾通用伺服：东元、台达；在大陆有和利时、埃斯顿等。在这里我们选择三菱公司的hf-kp053，电机自带的编码器反馈信号给驱动器， 驱动器根据反馈值与目标值进行比较，调整转子转动的角度。这款的伺服电机有如下特点： 体

18、积小，重量轻，大转矩输出； 低惯性，以适应速度指令或位置指令的快速变化； 良好的控制性能，以及发电制动功能； 宽广的调速范围，即要求伺服电机的转速能够随控制电压的改变能在宽广的范围内连续调节； 转矩脉动小。3.4伺服放大器的选择在伺服放大器的选择上主要考虑伺服电机的功率，在系统设备中，伺服电机的功率为50w，所以选择三菱公司的mr-j3-10a型的伺服放大器。此放大器的功率为100w，且设置方便，满足控制要求。用于驱动伺服电机，能和伺服电机的高分辨率编码器配合。4 控制系统电路设计4.1plc外围接线图如图4-1左边的plc输入信号，右边的是plc输出信号。图4-1 plc外围接线图4.2 控

19、制系统设计原理图plc通过读取触摸屏里个按钮的状态来执行相应的程序，qd75模块通过读取plc里正在执行的程序，把相应的参数存入qd75模块里，伺服放大器再通过读取qd75模块里的相关的参数来驱动各自对应的伺服电机运行。伺服电机也会把脉冲数反馈给伺服放大器，伺服放大器又会把收到的数据反馈给qd75模块,判断是否运行到位了，qd75模块也会把收到的数据反馈回plc里，plc也会把其收到的数据反馈回触摸屏。如图4-2所示:图4-2控制系统设计原理图4.3 控制系统接线图按照接线图如图4-3进行接线。用万用表检查接线情况，确保连接正确。图4-3 系统接线图5参数整定5.1定位模块参数设置编程时候用的

20、是gx works2软件自带定位参数整定功能（1）整定的x轴参数为下表5.1-1所示。（2）整定的y轴参数为下表5.1-2所示。5.2伺服系统内部参数设定伺服参数设置用的是gx works2软件自带定位参数整定功能，整定的伺服系统参数为下表5-2所示。6 人机界面设计在设计三轴伺服移动平台控制系统中，我们用触摸屏代替按钮或开关来操作，触摸屏控制器的主要作用是从触摸点检测装置上接收触摸信息，并将它转换成触点坐标，再送给cpu，它同时能接收cpu发来的命令并加以执行。在这个系统中，工作时的触摸屏界面包括主界面、操作界面以及手动界面。如下图所示图4-1为主界面、图4-2为操作界面、图4-3为手动界面

21、。触摸屏操作步骤如下：（1）在系统调试之前先将触摸屏程序导入到触摸屏中，以实现控制系统的调节；进入主界面后，触摸界面任何一处进入操作界面；（2）进入操作页面后，点击外围启动按钮，给伺服放大器上电；按下手动界面按钮进入手动界面；（3）在手动控制界面中，分别按下x、y、z轴的上、下、左、右、前、后按钮，判断其运行是否有误，如无误的话，按下左箭头标志的按钮返回操作界面；（4）在操作界面里按原点回归按钮，等到回到原点，再按“画直线”或“画圆弧”或“画正方体”或“画圆柱体”或“画图”按扭进行相应动作；在开始界面中主要是写入一些相关的文字，说明一下系统的名称和制作人。 图4-1 主界面 在操作页面里，你按

22、下外围启动按钮后伺服放大器电源导通；接着再按下“画正方体”或“画圆柱体”按扭，就会打印出相应的物体；当按下停止按钮，所有的动作都会停下来；当你按一下再启动按钮，系统又会启动起来；你按一下回原点按钮，x、y、z轴都会回归到原点。在操作界面还有三个页面切换按扭，当按下“手动界面”、“监视页面”、 “主界面”按钮后，页面就会切换到相应的画面。 图4-2操作界面在监视页面里显示的是整个系统的当前所处的状态值，有x、y轴的位置显示和x、y轴的速度显示，还有就是x、y轴的速度波动显示。当按下“操作界面”、“主界面”按钮后，页面就会切换到相应的画面。 图4-3 监控页面 在手动页面中主要是系统的一些点动控制

23、信号的给定，当按一下“x轴向左”按钮，x轴就会实现点动的正转运行，按一下“x轴向右”按钮，x轴就会实行点动的反转运行，与此相似，当按一下y轴向前、向后和z轴上升、下降按钮后，都会实现相应的点动运行。在原料控制区里，按下进丝按钮，原料就会往喷嘴里装填，按下退丝按钮，原料就会退出喷嘴。当按下“操作界面”、“主界面”按钮后，页面就会切换到相应的画面。 图4-4 手动界面7系统流程图在系统搭建完成的前提下，按照定位参数的设置进行系统定位，包括位置控制、速度控制等控制；在原点回归方面，分为手动回原点，机械回原点，如近点dog运行、点动运行、自动控制状态下，启动、停止的信号的设定，启动后根据系统要求打印的

24、图形进行x、y、z轴的定位控制。在定位过程中如果发生错误动作系统会自动紧急停止，根据系统要求的功能编写程序，下图7-1为程序编写思路的流程图。8控制程序设计程序编写分为主程序块和子程序块，利用此种编程方法可使程序模块化，缩短运算周期、控制程序的流程等优点，主程序主要包括系统的公共部分，子程序主要包括原点回归子程序、手动调试子程序、轴速度和位置显示、画直线子程序、画圆弧子程序、画圆柱子程序、写字子程序，下面就系统的功能对以下程序进行大致说明。外围软件信号y10是放大器的电源，y20是x/y轴定位模块准备信号，y40是z轴定位模块的准备信号。系统急停信号和系统报警y24是x轴停止信号，y25是y轴

25、停止信号，y54是z轴停止信号。故障报警信号用于指示系统出错，自动停止系统的运行。再启动信号该信号用于急停后的再启动命令，可以恢复急停前的动作状态。轴故障复位当轴出现故障时，可以按下复位按钮对进行复位。这些只是程序其中的一部分，具体程序请至附件3中查阅。9 模拟调试模拟调试的步骤：(1)在断电情况下，用编程电缆（pc/ppi电缆）将计算机和plc主机相连；(2)接通计算机和plc的工作电源；(3)在计算机上运行gx work2软件，并进行正确的通信参数设置；(4)将伺服运动控制系统程序导入至plc中，并将相关的定位数据同时写入plc中；(5)建立计算机和plc主机的在线联系；(6)用户程序监视

26、运行。当plc主机上的工作方式开关在run位置时，执行gx work2主菜单中的plcrun命令，则plc在联机状态下运行，再打开调试菜单，选中程序状态，这时闭合触电和通电线圈内部颜色变蓝（呈阴影状态）。10联机调试在硬件线路接好并在断电条件下，按照电路图要求，将plc和外部设备通过航空插座相连，同时将plc和编程计算机相连，还有将触摸屏和编程计算机相连。将系统所有设备接通电源后，plc在计算机的监视下运行用户程序。观察系统运行动态是否设计要求相符合。(1）系统初始化操作，当执行打印前应先执行初始化操作，初始化操作包括x、y、z轴的原点归位、定位参数的整定和电气规格的检查。在向plc导入程序前首先是对系