1、EMD Trio运动控制器快速使用手册 北京意美德科技发展有限公司 TEL：010-65546546 65547005 65546752 Fax：010-65547015 Trio运动控制器快速使用手册 EMD Trio运动控制器快速使用手册 北京意美德科技发展有限公司 TEL：010-65546546 65547005 65546752 Fax：010-65547015 Trio多轴数字运动控制器快速使用手册 为了方便广大用户能够熟练的应用并掌握Trio多轴运动控制器，在这里我们主要介绍用户怎么样根据自己的设备进行开发编程和开发出自己专用的、特殊用途的设备。下面我们主要从以下几个方面加以说明
2、： 一、 Trio运动控制器的软件介绍和安装 Trio 运动控制器的软件可以使用于Trio的任何一款产品中，主要有以下几种使用软件。 1.Motion Prefect 2 (编辑.调试.修改参数操作界面) 2.CAD to Motion(CAD图形转化成运动程序软件) 3.CamGen (生成电子凸轮运动程序软件) 4.Mc simulator(仿真软件,基于Motion Preject) 5. Trio PC Motion(PCI208总线驱动程序和Active X) 6.Trio USB Driver(USB通讯驱动程序) 在Trio的每个操作软件下面都有一个这个软件的使用帮助软件，用户在
3、操作过程中可以随时查阅有关的说明。 （一）、 Motion Prefect 2 1、Motion Prefect 2软件的安装 在我们销售给您的控制器的包装里面，有一张我公司的所有资料光盘，里面是我公司所有资料的产品的介绍和其产品的运行软件。在安装时，在计算机的光驱上打开光盘，在光盘目录下，有一个专门的Trio运动控制器的文件夹，打开这个这个文件夹，在这个文件夹下面有驱动软件和使用手册两个自文件夹，打开驱动软件文件夹，在其中找到Install_MotionPerfect_2_2_2_2.exe的文件，双击该文件就可以进行安装了，其安装步骤与其他的安装程序软件一样，这里就不做详细的介绍了。 2、
4、 Motion Prefect 2软件的使用 Motion Preject这个软件可以对运动控制器控制的各个运动轴参数和控制的外部输入/输出信号进行修改、监视、调试，命令窗口、程序编辑窗口以及上载、下载项目或者程序，示波器功能，控制器或者控制卡的加密/解密等操作都可以在这个界面下运行。下图是一个Motion Preject 2在控制器与计算机连接的一个操作界面。其一般的操作如下： EMD Trio运动控制器快速使用手册 北京意美德科技发展有限公司 TEL：010-65546546 65547005 65546752 Fax：010-65547015 1） Trio运动控制器与计算机通讯的建立
5、在运行Motion Prefect 2的软件，第一次连接TRIO的产品时，TRIO默认的是采用的是RS232C和计算机进行通讯，其通讯的数据是：波特率为9600，通讯口为计算机的COM1，偶校验，7位数据位，2位停止位。如果，在计算机和TRIO控制器连接时，由于通讯的数据和方式有可能不一样，控制器和计算机是没有办法建立起来连接的，当我们运行Motion Prefect 2的软件时，在控制器与计算机的连接过程时，会显示“No controller found COM1”，(如下面的图形所示)意思就是在计算机的COM1口没有找到TRIO的控制器。这时，点击“Cancel”按钮，进入“Motion
6、Prefect 2”，我们就需要修改有关的通讯参数，点击在“Motion Prefect 2”菜单下面的“Options”中“Communications”，出现通讯参数的界面，根据其需要修改相应的通讯参数，如上页中的图形所示，选择采用Serial（串口）通讯，设定其通讯参数：通讯口、波特率、数据位、停止位、奇偶效验。 EMD Trio运动控制器快速使用手册 北京意美德科技发展有限公司 TEL：010-65546546 65547005 65546752 Fax：010-65547015 修改完毕以后，点击Motion Prefect 2的左上角的一个“connect”的图标进行连接，当找到和
7、计算机连接的TRIO产品以后，点击“OK”按钮就可以进入Motion Prefect 2界面。如下图所示： TRIO控制器还支持采用USB、Ethernet、PCI总线等通讯方式。另外，还有一个仿真软件。我们可以采用这个仿真软件在没有控制器时编写程序和检测、修改程序。 2） Terminal窗口 在Motion Prefect 2界面下，点击像计算机的显示器的一个EMD Trio运动控制器快速使用手册 北京意美德科技发展有限公司 TEL：010-65546546 65547005 65546752 Fax：010-65547015 图标，弹出一个对话框“select channel”，其中的“
8、0”为运动控制器在计算机上的Motion Prefect 2软件界面下的一个操作界面，可以在这个界面下输入运动命令直接修改、调用参数和查询参数的值和各轴的运动状态，也可以直接在“Terminal”窗口下面输入一个个运动命令直接控制电机的运动。“5、6、7”只是可以在编辑、调试程序时，可以作为一个监视窗口。我们点击“0”出现下面的窗口。其中的“”为命令提示符，只要输入一个命令回车以后，都会出现这个提示符。 3） 查看控制器 在Motion Prefect 2界面下，点击在菜单“controller”的下拉菜单下面的“controller configuration”，就会弹出一个控制器的描述窗口
9、（如下图所示），其中显示控制的轴的类型（Servo或者stepper）和所控制轴通道的个数，另外，还显示通讯口和有多少输入/输出点。 EMD Trio运动控制器快速使用手册 北京意美德科技发展有限公司 TEL：010-65546546 65547005 65546752 Fax：010-65547015 4） 查看并修改各轴参数 在Motion Prefect 2界面下，有各个功能的快捷图标，点击这个图标和点击菜单是一样。点击“Tools”菜单下的“Axis parameters”就会出现一个窗口，点击窗口下面的“Axes”按钮，选择弹出的子窗口，你购买的几个轴通道，你就可以选择几个轴。如下图
10、所示： 在这个窗口中，中间的灰白条部分是各轴的运动参数，是需要根据各轴的运动的动态性能直接在这个窗口调整各轴的参数，EMD Trio运动控制器快速使用手册 北京意美德科技发展有限公司 TEL：010-65546546 65547005 65546752 Fax：010-65547015 下面的参数是各轴在运动过程中的运动参数参数的时时显示。（这些参数的详细说明请查阅详细的说明书）在Trio控制器中，如果在这个参数表或者“Terminal”下输入的命令修改的参数，当控制器一断电以后，这些参数会全部恢复到出厂值。我们可以编辑一个程序把我们调试好的参数做到这个程序中，让这个程序在一上电就运行程序。具
11、体的做法见后面的说明。 5） 程序的编辑 在Motion Prefect 2界面下，点击“Program”菜单下的“New”下拉菜单，首先会出现一个对话框，然输入所要编辑的运动程序名字，输入一个程序名后回车或者是点击“OK”按钮，就弹出一个文本编辑，就可以在上面根据设备的需要编写运动、加工程序。这时这个程序就会在左边的一个白色的图形框内显示该程序名。其界面如下所示： 当程序编辑完以后，经过检查无误以后，如果已经把各轴的动态性能参数调试到最佳的效果了。这时，点击程序窗口上的绿色向右的箭头，程序开始编译，当编译发现程序在语法和命令有错误时，软件就会弹出一个窗口，显示程序中所产生错误的这一行命令的行
12、号错误。需要重新检查修改程序，一直到没有出现报警错误以后。程序才可以运行。 6） 示波器 在Motion Prefect 2界面下，有一个示波器的功能，可以通过这个示波器调试各轴的动态响应参数和监视各轴的运动状EMD Trio运动控制器快速使用手册 北京意美德科技发展有限公司 TEL：010-65546546 65547005 65546752 Fax：010-65547015 态。其图形如下所示： 7） 其他的功能显示、操作窗口 EMD Trio运动控制器快速使用手册 北京意美德科技发展有限公司 TEL：010-65546546 65547005 65546752 Fax：010-65547
13、015 8） 帮助文件 a、 Motion preject 2 Help 在上面的图形中，可以点击“Motion preject”的图标或者是点击菜单“Help”下的“Motion Prefect”子菜单，会弹出一个文件窗口，在这个窗口下面，有详细的介绍“Motion Prefect 2”软件中每一个部分的详细说明。如下图所示： EMD Trio运动控制器快速使用手册 北京意美德科技发展有限公司 TEL：010-65546546 65547005 65546752 Fax：010-65547015 b、 Trio Basic Help 当我们在编辑程序或者是调试控制时，如果对控制器的控制命令或
14、者参数的定义不了解，我们可以在上面的图形中，可以点击“Trio Basic Help”的图标或者是点击菜单“Help”下的“Trio Basic Language”子菜单，会弹出一个文件窗口，在这个窗口下面，有详细的Trio控制器的各种控制参数的详细说明。如下图所示： EMD Trio运动控制器快速使用手册 北京意美德科技发展有限公司 TEL：010-65546546 65547005 65546752 Fax：010-65547015 （二）、CAD To Motion 为了广大客户在二维的图形加工方面的编程方便，Trio控制器提供了在AutoCAD下或者是类似CAD的绘图文件格式*.dxf
15、根据所绘制的图形的轨迹直接转换成运动加工的运动程序文件*.bas。其操作界面如下图所示： 在运行这个程序时，只需要在“File”菜单下点击“import”或者“Append”下的“dxf”就可以导入在CAD软件下绘制的“*.dxf”的文件，控制器就直接生成了运动加工程序，其如下图形的右面所示： （三）、Cam Profile Generator 这个软件是TRIO专门针对于需要凸轮加工所开发的专用软件，这个软件中带有一般的电子凸轮的曲线或函数表达式，用户可以根据所需要加工的凸轮曲线或者函数表达 式，来直接生成所需要加工凸轮的TABLE表中凸轮曲线上分割成各点的值和凸轮加工的程序。也可以根据定义
16、的图形生成函数表达式 。 在做电子凸轮生成程序时，一定要注意选择的位置和速度的曲线，然后在选择所需要把这个曲线分成的多少份的点也就是TABLE 表中的起始点和终止点的值。其显示的界面如下所示： EMD Trio运动控制器快速使用手册 北京意美德科技发展有限公司 TEL：010-65546546 65547005 65546752 Fax：010-65547015 （四）、PC Motion 这个软件是TRIO专门针对于需要对设备的控制利用VB/VC/C+等高级语言进行二次开发所开发的Active X控件，利用这个控件可以在二次开发时直接和控制器或者控制卡进行通讯，进行运动控制的运算和运动程序的
17、编辑、图形的处理，通过软件和硬件的结合处理，完全可以根据自己的需求开发出一套属于自己的专用产品。下面是用VB进行二次开发程序中的一个页面和其程序代码。 另外，这个软件也带有PCI208运动控制卡的驱动程序，如果用户使用的是PCI208运动控制卡，在把控制卡插入计算机或者工控机的PCI总线时，最好是先安装这个软件到计算机的硬盘中。再插入计算机或者工控机中时，计算机或者工控机的操作系统会在硬件添加时能够自动搜索到PCI208的驱动程序。 EMD Trio运动控制器快速使用手册 北京意美德科技发展有限公司 TEL：010-65546546 65547005 65546752 Fax：010-6554
18、7015 其程序代码如下： （五）Trio USB Driver 这个软件主要是应用于Trio控制器在采用USB通讯方式和计 算机或者工控机通讯时，需要安装这个软件，操作系统才能在USB 口上找到与之连接的Trio控制器。其连接、通讯方法见前面的说 明。 EMD Trio运动控制器快速使用手册 北京意美德科技发展有限公司 TEL：010-65546546 65547005 65546752 Fax：010-65547015 二、 Trio运动控制器控制伺服电机的速度控制方式或者步进电机以及伺服电机的位置控制方式的接线说明（以MC206为例） 1、 采用Servo方式控制伺服电机的速度控制方式的
19、接线 1）、Trio控制器与Panasonic A4系列伺服电机驱动器的速度控制方式的接 2）Trio控制器与Yaswaka -系列伺服电机驱动器的速度控制方式的接线 直流24V开关电源+24V0V50外壳Axis 0：AIO 0VAIO 0CN X5：7COM+41 COM-29 SRV-ON14 SPR15 GND21 OA+22 OA-48 OB+49 OB-23 OZ+24 OZ-25 GND5GND7/Z6Z4/B3B2/A1AE2（WDOG）E1（WDOG）MINAS A4速度控制方式Trio控制器MC206（Servo）EMD Trio运动控制器快速使用手册 北京意美德科技发展有
20、限公司 TEL：010-65546546 65547005 65546752 Fax：010-65547015 3）Trio控制器与施耐德Lexium 05伺服电机驱动器的速度控制方式的接线 2、 采用Stepper方式（Step+Dir）控制伺服电机的位置控制方式直流24V开关电源+24V0V50外壳Axis 0：AIO 0VAIO 05GND7/Z6Z4/B3B2/A1AE2（WDOG）E1（WDOG）Trio控制器MC206（Servo）CN1：47 +24V40 /S-ON5 V-REF6SG33 PAO34 /PAO35 PBO36 /PBO19 PCO20 /PCO1SGYASKA
21、WASIGMA2速度控制方式直流24V开关电源+24V0V外壳AIO 0VAIO 05GND7/Z6Z4/B3B2/A1AE2（WDOG）E1（WDOG）Trio控制器MC206（Servo）CN1：41 0V35 ENABLE11 ANA1+12 ANA1-36 /HALTLexium 05速度控制方式1 ESIM-A6 /ESIM-A2 ESIM-B7 /ESIM-B3 ESIM-I8 /ESIM-I9 POS-0V43，37，38，29 24VAxis 0：CN5：5 SHLDEMD Trio运动控制器快速使用手册 北京意美德科技发展有限公司 TEL：010-65546546 65547
22、005 65546752 Fax：010-65547015 的接线 1） Trio控制器与Panasonic A4系列伺服电机驱动器的位置控制方式的接线 2） Trio控制器与Yaswaka -系列伺服电机驱动器的位置控 制方式的接线 直流24V开关电源+24V0V50外壳CN X5：Axis 0：注：松下A 4系列伺服驱动器的位置控制方式的脉冲输入既可以接入C N X 5插头（5 0针）的第3、4、5、6脚（集电极开路输Trio控制器MC206（Servo）7 COM+41 COM-29 SRV-ON44 PULSH145 PULSH246 SIGNH147 SIGNH225 GND5GND
23、4 Dir-3 Dir+2 Step-1 Step+E2（WDOG）E1（WDOG）MINAS A4位置控制方式直流24V开关电源+24V0V外壳Axis 0：CN1：外壳1SG12 /SIGN11 SIGN8 /PULSYASKAWASIGMA2位置控制方式40 /S-ON47 +24VTrio控制器MC206（Servo）E1（WDOG）E2（WDOG）1 STEP+2 STEP-3Dir+4Dir-5GND7 PULSEMD Trio运动控制器快速使用手册 北京意美德科技发展有限公司 TEL：010-65546546 65547005 65546752 Fax：010-65547015
24、3） Trio控制器与施耐德Lexium 05伺服电机驱动器的位置控制 方式的接线 4） Trio运动控制器采用Stepper方式（Step+Dir）控制步进电机 驱动器的接线图 直流24V开关电源+24V0VE2（WDOG）E1（WDOG）Trio控制器MC206（Servo）CN1：41 0V35 ENABLE36 /HALT43，37，38，29 24VLexium 05位置控制方式外壳5GND 9 POS-0V4/B3B2/A1AAxis 0：CN5：1 PULSE6 /PULSE2DIR7/DIR5 SHLDTrio控制器MC206（Servo）步进驱动器外壳Axis 0：外壳1 S
25、TEP+2 STEP-3Dir+4Dir-PULS/PULSSIGN/SIGNEMD Trio运动控制器快速使用手册 北京意美德科技发展有限公司 TEL：010-65546546 65547005 65546752 Fax：010-65547015 5） 输入/输出的接线 A、 输入点的接线 B、 输出点的接线 EMD Trio运动控制器快速使用手册 北京意美德科技发展有限公司 TEL：010-65546546 65547005 65546752 Fax：010-65547015 三、 Trio控制器控制伺服电机或者步进电机时的参数调整 Trio控制器的系统参数和各轴的运动控制参数在控制器断电
26、以后，全部又恢复到出厂值，为了保证在每次控制器通电的时候都去调试系所需要调试的系统参数和各轴的运动控制参数。调试完毕以后，我们都编辑一个程序，把这些需要调试的参数赋值到各个参数中，并且让控制器在一上电的情况下就加载这个程序。其具体的程序和操作见后面的程序编辑。 1、 参数调整 1）PID参数的调整 当采用Servo控制方式控制伺服电机时，Trio控制器发出16 bit的010V的模拟输出电压控制伺服电机定位、调速等控制，并采集伺服驱动器输出的伺服电机的编码器反馈形成一个闭环系统。所以我们在控制伺服电机的速度控制方式的时候需要调整P（比例增益）、I（积分增益）、D（微分增益），并且根据设备的负载
27、与机械设备的不同需要进行不同的调整。在我们第一次调试的时候我们一般给出经验值以供大家使用（见后面的初始化参数说明）。在设备加载的情况下，需要这三个参数搭配起来并且和伺服EMD Trio运动控制器快速使用手册 北京意美德科技发展有限公司 TEL：010-65546546 65547005 65546752 Fax：010-65547015 驱动器里面的PID增益参数结合起来调整。一般是先调整伺服驱动器的PID增益使电机达到一个好的效果以后，再调整控制器的参数。由于这个调整比较复杂，我们在这里不做详细的说明。如果需要咨询这方面的技术问题，请与我公司的技术部门联系。 2）移动当量的设定 当我们用Tr
28、io控制器与一个伺服驱动器连接以后，并且伺服电机连接到设备上了，我们为了编程方便，需要设定一个移动当量（UNITS）。所谓的移动当量就是一个设备中，假设是直线移动，我们需要滚珠丝杆移动1mm或者1cm所需要的脉冲数，如果是旋转负载，就是负载旋转1度或者1分、1秒所需要的脉冲数就是移动当量。这样我们在编程的时候就可以根据所设定的参数运动。例如：假设Trio控制器采用Servo方式控制一个伺服驱动器，伺服电机连接到一个丝杆螺距为5mm的滚珠丝杆上面驱动负载，由伺服驱动器输出到控制器的脉冲为2500P/R，其移动当量（UNITS=2500*4/5=2000） 在设定这个参数时，如果采用Stepper
29、方式控制伺服驱动器的位置控制方式或者控制步进电机时，如果我们需要输入10000 P（这个是根据伺服电机驱动器中的电子齿轮比或者步进电机驱动器的细分数和步距角结合一起计算）电机转一转，同样是上面的条件，其移动当量（UNITS=10000*16/5=32000） 当移动当量设定以后，编程所定义的位置、速度、加减速度均以这个移动当量为单位定义。 四、 程序的编辑和运行 1、 初始化参数的编辑和运行 1） 初始化参数的编辑 以下是Trio控制器控制电机的各轴的参数，假设控制器控制的Axis 0为Servo方式，Axis 1和Axis 2为Stepper方式，其程序名为：STARTUP Start St
30、andard Section 程序说明 Axis Parameters 程序说明 BASE(0) Axis 0 P_GAIN=1.5 P增益 I_GAIN=0.15 I增益 D_GAIN=0.5 D增益 OV_GAIN=0.0 速度环反馈增益 VFF_GAIN=0.0 速度前馈增益 UNITS=2000.0 移动当量 EMD Trio运动控制器快速使用手册 北京意美德科技发展有限公司 TEL：010-65546546 65547005 65546752 Fax：010-65547015 SPEED=1 速度(mm/s) ACCEL=10 加速度（mm/s2） DECEL=10 减速度（mm/s
31、2） CREEP=0.0100 寻找电机一转脉冲信号速度 JOGSPEED=0.0100 JOG速度 FE_LIMIT=0.2000 跟踪误差极限 DAC=0 模拟电压输出值 SERVO=1 伺服闭环 REP_DIST=500.0 控制器计数上限 FWD_IN=-1 正向硬件限位状态 REV_IN=-1 负向硬件限位状态 DATUM_IN=-1 回零减速开关状态 FHOLD_IN=-1 进给保持状态 FS_LIMIT=1999.9999 正向软件限位极限 RS_LIMIT=-2000.0 负向软件限位极限 BASE(1) Axis 1 P_GAIN=1.0 I_GAIN=0.0 D_GAIN=
32、0.0 OV_GAIN=0.0 VFF_GAIN=0.0 UNITS=32000.0 SPEED=0.1000 ACCEL=1.0 DECEL=1.0 CREEP=0.0100 JOGSPEED=0.0100 FE_LIMIT=0.2000 DAC=0 SERVO=1 REP_DIST=500.0 FWD_IN=-1 REV_IN=-1 DATUM_IN=-1 FHOLD_IN=-1 FS_LIMIT=1999.9999 EMD Trio运动控制器快速使用手册 北京意美德科技发展有限公司 TEL：010-65546546 65547005 65546752 Fax：010-65547015 R
33、S_LIMIT=-2000.0 BASE(2) P_GAIN=1.0 I_GAIN=0.0 D_GAIN=0.0 OV_GAIN=0.0 VFF_GAIN=0.0 UNITS=32000.0 SPEED=1 ACCEL=1.0 DECEL=1.0 CREEP=0.0100 JOGSPEED=0.0100 FE_LIMIT=0.2000 DAC=0 SERVO=1 REP_DIST=500.0 FWD_IN=-1 REV_IN=-1 DATUM_IN=-1 FHOLD_IN=-1 FS_LIMIT=1999.9999 RS_LIMIT=-2000.0 STOP Stop Standard Sec
34、tion 2)程序的运行 Trio 运动控制器可以多任务编程，所谓多任务就是将复杂的程序分成几个部分的任务来同时执行，每个部分的任务是独立的，这样就可以使设备的复杂运动过程控制变得简单明了。 控制器型号 最多可编辑任务 最优先级任务 MC202 3 3 MC206 7 7，6 MC216/MC224 14 14，13 EMD Trio运动控制器快速使用手册 北京意美德科技发展有限公司 TEL：010-65546546 65547005 65546752 Fax：010-65547015 Euro205/Euro205X 5 5，4 PCI208 7 7，6 所以我们在编辑完上述各轴的初始化程序
35、以后,我们可以让这个程序在控制器一上电的时候就执行这个初始化程序,其具体的操作方式是如下图所示: 在程序名上点击鼠标右键,点击弹出的下拉菜单的最后一项Run on startup,这时弹出如图所示的窗口,按下图进行操作就可以了. 3）回零方式 如果要使一个轴运动回零，首先，我们需要用一个输入信号来定义这个轴的回零减速开关，例如：DATUM_IN（0），这是定义采用输入点信号0作为当前轴的回零减速开关。当执行“DATUM（N）”时，控制器就控制伺服电机按定义的回零方式回零。N是表示回零的方式，其具体的含义见命令手册中的“DATUM”命令。 编程举例： BASE（0） 定义需要回零的轴为0轴 SP
36、EED=2 定义回零速度为2mm/s DATUM_IN=5 定义输入点5作为回零开关 CREEP=0.05 定义寻找电机一转脉冲信号的速度为0.05mm/s DATUM(5) 定义回零方式为电机往正向回零，找到回零减速开关以后，往负向按EMD Trio运动控制器快速使用手册 北京意美德科技发展有限公司 TEL：010-65546546 65547005 65546752 Fax：010-65547015 0.05mm/s的速度寻找电机一转脉冲信号，找到一转脉冲信号以后完成回零，并把当前的位置清为零点。 注意：Trio控制器的输入点在被定义作为回零减速开关、正负限位开关、进给保持开关以后，都需要
37、把开关接成常闭点信号（普通的输入信号接线为常开点）。 4)运动程序编程举例 1、 这是一个二轴运动写出“T”、“R”、“I”、“O”这四个英文字母，其运动路 径及坐标值如下：这几个字母是通过AUTOCAD绘图文件根据字体的顺序画一起的，在写出这几个字母以后，在保存的时候，选择保存为.dxf的文档，经过TRIO的CAD2MOTION的软件直接进行转化成TRIO的专用的运动命令.BAS的程序文件。在设计的过程中，我们用一个输出点来控制写字的笔或者是雕刻的刀，两个方向用伺服电机，电机根据轨迹运动，笔或者雕刻的刀不动。因为这个转化软件只能转化二维的图形文件，所以我们还要根据加工的路径需要增加笔或者是雕
38、刻的刀抬起与落下。下面就是加工的程序。 (60,30)(55,50)(35,20)(0,50)(0,0)301666 1061515程序如下： ，Output 15 输出点15控制笔的抬起/落下 REPEAT ，Plot TRIOstart WITH A T： 写TRIO中的“T” MOVEABS（0，50） 绝对移动到（0，50）点 WAIT IDLE 等待移动完成 OP（15，ON） 笔落下 MOVE（15，0） 第一个轴向左移动15 MOVE（0，-30） 第二个轴向下移动30 MOVE（0，30） 第二个轴向上移动30 MOVE（15，0） 第一个轴向左移动15 EMD Trio运动控
39、制器快速使用手册 北京意美德科技发展有限公司 TEL：010-65546546 65547005 65546752 Fax：010-65547015 WAIT IDLE 等待移动完成 OP（15，OFF） 笔抬起 ，Plot R： 写TRIO中的“R” MOVEABS（35，20） 绝对移动到（35，20）点 WAIT IDLE 等待移动完成 OP（15，ON） 笔落下 MOVE（0，30） 第二个轴向上移动30 MOVE（6，0） 第一个轴向左移动6 MOVECIRC（0，-16，0，-8，1） 顺时针画一个直径为16的半圆 MOVE（-6，0） 第一个轴向右移动6 WAIT IDLE 等待
40、移动完成 MOVE（6，0） 第一个轴向左移动6 MOVECIRC（8，-8，0，-8，1） 顺时针画一个直径为16的1/4的圆弧 MOVE（0，-6） 第二个轴向下移动6 WAIT IDLE 等待移动完成 OP（15，OFF） 笔抬起 ，Plot I： 写TRIO中的“I” MOVEABS（55，50） 绝对移动到（55，50） WAIT IDLE 等待移动完成 OP（15，ON） 笔落下 MOVE（0，-30） 第二个轴向下移动30 WAIT IDLE 等待移动完成 OP（15，OFF） 笔抬起 ，Plot O： 写TRIO中的“O” MOVEABS（60，30） 绝对移动到（60，30）
41、 WAIT IDLE 等待移动完成 OP（15，ON） 笔落下 MOVE（0，10） 第二个轴向上移动10 MOVECIRC（20，0，10，0，1） 顺时针画一个直径为20的半圆 MOVE（0，-10） 第二个轴向下移动10 MOVECIRC（-20，0，-10，0，1） 顺时针画一个直径为20的半圆 WAIT IDLE 等待移动完成 OP（15，OFF） 笔抬起 MOVEABS（0，0） 返回到起始点 2、抓取放置物品 这是一个长1.2m正方形的XY两维平台,在这个平台上放着6*6个装物品的盒子，一个真空吸附器类的机械装置从传送带上把一个规矩的物品抓起放入每一个空的盒子中。在这个设备中,X
42、和Y方向的两个伺服电机是由MC206控制移动到对应的位置。另外，用两个输出点控制吸附器类的机械装置的抬起/落下以及吸附器的抓取和放置。其结构如下： EMD Trio运动控制器快速使用手册 北京意美德科技发展有限公司 TEL：010-65546546 65547005 65546752 Fax：010-65547015 其放置的顺序如下图所示： 其抓取/放置的示意图如下所示： EMD Trio运动控制器快速使用手册 北京意美德科技发展有限公司 TEL：010-65546546 65547005 65546752 Fax：010-65547015 其工艺过程为: 在这个设备中,我们知道是一个长1.
43、2m正方形的设备，有6*6个盒子需要放置物品。所以，首先我们把吸附器机构移动抬起，吸附器打开，移动到所要抓取物品的绝对位置(pick_x,，pick_y)；吸附器机构落下，吸附器闭合抓取物品，吸附器机构抬起；然后移动X轴和Y轴到所需要放置物品的盒子的绝对位置；到位置以后，吸附器机构落下，吸附器放置物品。X轴和Y轴的移动距离应该是X_dis=总的X向行程/X向总的需要放置物品的个数+盒子的长度/2，Y_dis=总的Y向行程/Y向总的需要放置物品的个数+盒子的长度/2，根据这个数学计算以及工艺要求，我们编写这个程序如下： Constants: 程序标记,定义常量 Nozzle=8 定义输出点8控制
44、吸 附器机构的抬起和落下 Vacuum=9 定义输出点9控制吸附器 的抓取和放置 xdiv=6 定义每行有6个盒子 ydiv=6 定义每列有6个盒子 Start: 程序标记 Xscale=1200/xdiv 计算移动的距离 Xmid=xscale/2 Yscale=1200/ydiv Ymid=yscale/2 FOR X=0 TO xdiv-1 定义循环结构 FOR Y=0 TO ydiv-1 GOSUB Pick 跳转到Pick子程序 MOVEABS(X*Xscale)+Xmid , (Y*Yscale)+Ymid) 移动所需要放置物品的绝对位置 WAIT IDLE 等待移动到位置 GOS
45、UB Place 跳转到Place子程序 NEXT Y EMD Trio运动控制器快速使用手册 北京意美德科技发展有限公司 TEL：010-65546546 65547005 65546752 Fax：010-65547015 NEXT X GOTO Start 跳转到Start,循环 Pick: 子程序Pick MOVEABS(pick_x , pick_y) 移动到抓取物品的绝对位置 WAIT IDLE 等待移动到位置 OP(Nozzle,ON) 吸附器机构落下 OP(Vacuum,ON) 吸附器抓取 WA(500) 延时500ms OP(Nozzle,OFF) 吸附器机构抬起 WA(500)
