机器人技术实验指导书.doc

机器人技术基础实验指导书机电一体化实验室2009年6月学生实验规则1、实验前，学生要认真阅读实验指导书中内容，以求对实验目的、内容、方法和步骤有初步的了解。2、遵守实验室的各项规章制度，听从教师的指导，实验时必须严肃、认真、细致。3、要求在教师指导下，独立按时完成规定的实验内容。4、实验过程中，学生不得无故迟到、早退、旷课、有事须请假批准。5、遵守操作规则，注意安全。6、爱护实验中用到的相关设备与工具，丢失损失东西，及时报告，照价赔偿。7、实验结束，应将设备、仪器、工具清理干净，搞好当天卫生。第一章HNC-IR型教学机器人简介HNC-IR型教学机器人的总体结构为立式关节形式，具有五个自由度，各关节均采用步进电机经谐波减速器和绳轮驱动，绳轮轮系具有消除间隙机构，因此定位精度较高。 机器人的各关节结构实现了部件化，便于更换不同形式的驱动电机，根据教学、科研和工业的需要可以在各关节的驱动轴上安装力或位置检测元件，更换不同手爪非常简便。1.1 HNC-IR教学机器人基本配置 HNC-IR教学机器人由控制单元、示教操作盒、控制电柜和机器人主体等部分组成，通过连接电缆连成一体，如图1.1所示。1.1.1 控制单元 HNC-IR教学机器人的控制单元实际上就是一台工控PC机或商用PC机。它包括主机、彩色CRT显示器、标准键盘等几部分，通过打印机接口(并行接口)由打印电缆与控制电柜侧面的“计算机接口”插座相连。 PC机键盘和CRT是人机交互的主要设备，负责编程及系统管理操作。1.1.2 示教操作盒 HNC-IR教学机器人的示教操作盒如图1.2所示，通过连接电缆直接连于控制电柜后面的“示教盒互连”插头上。示教操作盒用于直接控制机器人的动作及获取示教编程位姿。示教操作盒的使用介绍1.4节。1.1.3 控制电柜 控制电柜通过“220V电源”插头由连接电缆连到交流220V电源上，为机器人的控制提供强电，它把控制单元和示教操作盒送来的命令和操作转换为控制机器人动作的信号，送到固定在机器人主体上的步进电机，经谐波减速器和绳轮驱动带动机器人关节转动。 控制电柜通过“机器人互联”插头由连接电缆连到机器人尾部的插头上。1.2 机械部分1.2.1主要技术参数自由度（轴）数5机械结构形式立式关节形作业半径650mm负荷能力2kg重复定位精度0.5mm驱动电机步进电机总重量（约）40kg运动范围轴A（立柱）120+125轴B（大臂）12+108轴C（小臂）10430轴D（手腕）105+44轴E170+149连杆长或高连杆1360mm连杆2280mm连杆3220mm连杆4150mm1.2.2 机械传动与结构 HNC_IR型教学机器人是立式关节形，具有五个自由度。该机器人的机械结构是由立柱、大臂、小臂、手腕和手爪等五个部分组成，如图13所示。 立柱的底部可以固定在桌面上，也可以平放在任意台面上，立柱底部安装尺寸图如图1.4所示。立柱顶部装有支承臂，它可以绕立柱轴心旋转135，称为A轴。 在支承臂上固定着驱动大臂转动的电机B和驱动手腕摆动的电机D。大臂在支承臂上可以绕水平轴转动150，称为B轴。 在大臂上固定着驱支小臂摆动的电机C，经过谐波减速器和绳轮传动，可使小臂绕大臂端部的轴心向下转动135，称为C轴。 小臂的端部装有手腕部件，手腕摆动是由固定在支承臂上的电机D经谐波减速器和绳轮轮系实现的，手腕在小臂的端部绕水平轴线可以摆动90，称为D轴。当大臂或小臂转动时，该绳轮轮系可使手腕相对基础坐标系实现平动。 手腕自身装有一个电机E和减速传动系统，可以带动手爪转动180，称为E轴。 手爪固定在手腕的端部，用电磁力实现手爪的夹紧动作，手爪张开是靠弹簧完成的。根据作业要求可以更换手指或手爪部件。 注意：该机器人所有关节的转动都不能超过极限位置，否则会将传动的钢丝绳或导线拉断。1.2.3 机器人的作业空间 机器人的作业空间图如图1.6所示。图1.6机器人作业空间图1.3 机器人操作的一般步骤1.3.1 系统上电 连上220V总电源后，合上控制电柜侧面的强电开关(向上搬)，向右旋控制电柜侧面的钥匙，接通示教操作盒电源及HC5902接口板电源；打开PC机及CRT电源开关。1.3.2 运行系统程序 在HNC-IR教学机器人控制单元(PC机)的安装子目录下，运行N.bat批处理文件。此时，屏幕显示系统的主操作界面，如图1.7所示。说明： (1)运行方式：显示系统目前的运行方式，如自动、单段、手动、 回零、急停等 (2)运行程序：显示一行正在运行的程序 (3)正文(图形)显示窗口：根据您的需要，可以按不同的视角显示当前运行程序的三维或二维运行轨迹；可以以大字符方式显示机器人当前的坐标；可以显示正在编辑或运行的程序。您可以选择F9“显示方式”子菜单来控制显示方式(详见第 六章)。(4)命令行说明当前画面所处的位置 命令行主画面 自动运行自动运行的设置，程序调入等 编辑程序编辑、删除、拷贝、改名等 参数系统参数的显示，修改等 MDIMDI画面 示教示教编程的编辑、删除、存储等 PLCPLC画面 诊断系统故障诊断及报警处理(5) 菜单命令条：它提示您在当前情况下，命令行下方的FIF10 这lO个按钮键的功能。按这10个键则进入相应的界面，如在图1.7所示界面下按F10，进入扩展功能，如图1.8所示(在其它界面中按F10为返回上一界面)；在图1.8所示界面下按 F10，则又回到如图1.7所示的界面。菜单按钮键F9在任何画面中有效，用于设置显示的方式、参数等。(6)运行程序索引：显示自动运行中的代码和N代码(7)直角指令坐标：在机器人坐标系下显示迪卡尔空间指令位置实际位置(8)关节指令坐标：在机器人坐标系下显示关节空间指令位置实际位置(9)运行速度：显示自动运行时各关节的合成速度1.3.3 复位系统 从图1.7可知，刚进入主操作界面时，系统的运行方式为急停，为控制机器人运行，需按下并拔起示教操作盒侧面的“急停”按钮以复位系统，使系统进入其它运行方式(由示教操作盒上的波段开关选择)，如图1.9所示。1.3.4 机器人回参考点 HNC-IR教学机器人的控制可在关节空间或迪卡尔空间下进行，因此需要建立相应的坐标系。 建立关节空间坐标系的关键在于确定各关节轴的零点。为此，定义A轴零点为行程挡钉与轴心的连线上，A轴的正向由右手定则确定，即当四指指向A轴的正向时，大拇指指向正上方；定义B轴零点为水平面，B轴正向为水平面上方；定义C轴零点为B轴(大臂)的延长线，C轴正向为B轴的延长线的上侧；定义D轴零点为A轴的轴线，D轴正向使手爪远离机器人侧；定义E轴零点为，两手爪的连线垂直A轴行程挡钉与轴心的连线，E轴正向由右手定则确定，即当四指指向E轴的正向时，大拇指指向正下方。 为建立关节空间坐标系，机器人在复位系统后，首先应进行回参考点的操作，以确定机器人各关节参考点在关节空间的位置。机器人参考点可以与机器人零点重合，也可以不重合，通过机器人参数指定参考点到零点的距离。 回参考点的操作方法如下：旋转示教操作盒上面的波段开关，置于“回零”方式；旋转示教操作盒下面的波段开关，选择轴A；按示教操作盒上的“循环启动”按钮；轴A回参考点后停止。用同样的方法使轴B、轴C、轴D、轴E回参考点。所有轴回参考点后，即建立了关节空间坐标系。建立关节空间坐标系的同时， 也就建立了迪卡尔空间坐标系：定义迪卡尔空间坐标系原点为立柱和大臂的交点；X轴正向为A轴行程挡钉与轴心的连线方向；z轴正向指向正上方；Y轴正向由右手定则确定，即当四指由X轴正向指向Y轴正向时，大拇指指向z轴正向；P为手爪绕Y轴转动的角度，R为手爪绕Z轴转动的角度，P、R的正向由右手定则确定。 需要注意的是，由于各关节轴的运动范围小于一个圆周，在回参考点前，应保证关节当前位置在参考点的回参考点方向相反侧，如A轴的回参考点方向为负(-)，则回参考点前，应保证A关节当前位置在参考点的正向(+)侧。 在回参考点过程中，若出现“超程”，需按下示教操作盒上的“超程解除”按钮，向相反方向手动移动该关节轴使其退出“超程”状态。1.3.5 机器人运行、编程 机器人在回参考点建立坐标系后，就可以进行其它操作了。如手动移动一个关节坐标轴(用示教操作盒操作)；运行一个已编好存放在系统内部的程序(主操作界面下按F1)；MI)I运行一段手工现场输入的程序(主操作界面下按F4)；输入编辑(主操作界面下按F2)一个程序或用示教编程(主操作界面下按FS)的方法生成一个程序；显示、修改系统参数(主操作界面下按F3)等。1.3.6 退出机器人系统 按下示教操作盒上的“急停”按钮，在系统主操作界面下按“ALT+X”键。1.4 示教操作盒的使用介绍1.4.1紧急停止与复位 机器人运行过程中，当出现紧急情况时，按下“急停”按钮，伺服运行立即停止工作，系统即进入急停状态；松开急停按钮，系统进入复位状态。1.4.2超程解除 当某轴出现超程，要退出超程状态时，必须松开急停按钮，一直按着“超程解除”按钮，然后在手动方式下，使该轴向相反方向退出超程状态。1.4.3方式选择 通过两个波段开关，选择机器人的工作方式，有如下几种方式可供选择。(1) 自动：波段开关(下)置于“自动”，波段开关(上)置于“自动点动修调”档。机器人控制由RC自动完成。(2) 单段：波段开关(下)置于“单段”，波段开关(上)置于“自动点动修调”档。 机器人控制由RC单程序段执行。(3) 点动：波段开关(上)置于“自动点动修调”档，波段开关(下)选择点动坐标轴(A、B、C、D、E)。 点动移动坐标轴方式。 (4)步进：波段开关(上)置于“增量倍率”档，波段开关(下)选择步进坐标轴(A、B、C、D、E)。 步进移动坐标轴方式。 (5)回零：波段开关(上)置于“回零档，波段开关(下)选择回零坐标轴(A、B、c、D、E)。 返回机器人参考点方式。1.4.4 返回参考点 手动回参考点。当工作方式为回参考点方式时，按压“循环启动”按钮，执行返回参考点操作，直到被选择坐标轴到达参考点的位置(当减速限位开关被接通，再关断后，下一个标记脉冲被看作是参考点)，该轴参考点返回结束，参考点返回指示灯亮。 在电源接通后，必须用这种方法完成返回参考点操作以建立坐标系。1.4.5手动运行 手动运行包括：点动运行、步进运行、手爪松紧等。(1) 坐标轴选择在手动运行方式下，首先要选择手动运行轴(A、B、C、D、E)，每次只能手动走一个坐标轴。(2) 点动运行及运行速度选择 在点动运行方式下，按压“+JOG或“-JOG”，由坐标轴选择开关选择的轴将向正向或负向产生连续移动，松开“+JOG”或“-JOG”，即减速停止。点动运行的速率为最大运行速率的1/3乘以“自动点动修调”开关选择的倍率。若同时按下“+JOG” 或“-JOG”和“快进”键，则产生所选坐标轴的正向或负向快速运动。此时JOG速率为最大运行速率乘以点动倍率。(3) 增量(步进)运行及增量倍率 在步进(增量)运行方式下，按一下“+JOG”或“-JOG”，由坐标轴选择开关所选择的轴将向正向或负向移动一个增量值。 增量值的大小由“增量倍率”开关选择。增量倍率开关上的增量值单位为度。(4)手爪松紧 按一下“手爪松紧”开关，手爪由松变紧或由紧变松。1.4.6自动运行(1) 自动运行与单段自动运行启动-循环启动 当机器人工作于自动方式时，机器人控制由CNC自动完成，在RC主操作界面下按F1键进入自动加工子菜单，按FI(程序选择)选择要运行的程序，按下“循环起动”按钮，自动加工开始。自动加工期间，按钮内指示灯亮。 当机器人工作于单段方式时时，程序控制将逐段执行，即运行一段后机器人停止，再按一下“循环起动”按钮，即执行下一程序段，执行完了后又再次停止。(2) 自动运行暂停一进给保持 自动运行暂停。在自动运行过程中，按下“进给保持”键，暂停执行程序，机器人运动轴减速停止，暂停期间，按钮内指示灯亮。(3)进给保持后的再启动 在自动运行暂停状态下，按下“循环起动”键系统将重新启动，从暂停前的状态继续运行。 (4) 运行速度修调 在自动方式下，当运行速度偏高或偏低时，可用“自动点动修调”开关修调程序中编制的运行速度，此开关可提供5150的修调范围。 注意：在点动方式，此开关修调点动速率。1.4.7 机器人锁定 禁止机器人各关节动作。在自动运行开始前，将“机器人锁定”键按下，再按“循环启动”，坐标位置信息变化，但不允许机器人运动，这个功能用于校验程序。 注：在自动运行过程中，按“机器人锁定”键，机器人锁定无效；在自动运行过程中，只有在运行结束时，方可解除机器人锁定。第二章HNC-IR型教学机器人编程指令说明2.1 机器人编程概述2.1.1 定义一个机器人程序 机器人程序是由机器人控制系统专用编程语言书写的一系列指令组成的，到目前为止国际标准化组织尚未规定通用代码。 机器人控制系统将机器人程序转化为对机器人的控制动作。2.1.2 准备一个机器人程序一般来说，准备一个机器人程序可以有三种方法：示教编程、编辑编程以及离线编程,HNC-IR教学机器人可用前两种方法创建(编制)一个机器人程序，编程操作方法将在以下一下说明。2.2 程序的结构 一个机器人程序是一组被传送到控制系统中去的指令和数据。 HNC-1R教学机器人程序是由遵循一定结构、句法和格式规则的若干个程序段组成的，而每个程序段是由一个程序段号、一个指令字和若个指令参数组成的。如图2.1所示。图2.1 程序的结构2.2.1 程序段的格式 一个程序段定义一个将由机器人控制系统执行的指令行。 程序段是程序段号、指令字和指令参数组成的。 指令参数可以是纯数字，也可以是字符加数字。 程序段中不同的指令字及其后续指令参数确定了每个指令字的含义。2.2.2程序的一般结构HNC一1R教学机器人程序包括起始符和结束符：程序起始符为，后跟程序号；程序结束符为end。 机器人程序是按程序段的输入顺序执行的，而不是按程序段号的顺序执行的，然而我们建议书写程序时，按升序书写程序段号。在同一个程序中，程序段号不能重复。2.3HNC-IR教学机器人的编程指令体系HNC-IR教学机器人的编程指令如表2.1所示：表2.1 编程指令一览表 指令字 功能 指令参数MOVE_LINE_ARC via_ to_CIRCLE via_ und_APPRO_ over_APPROS_ over_DEPART_DAPARTS_关节移动命令空间直线移动命令空间圆弧运动命令空间整圆运动命令关节空间接近命令空间直线接近命令关节空间离开命令空间直线离开命令目标点坐标：地址符+数字目标点坐标：地址符+数字中间点及目标点坐标：地址符+数字第一及第二中间点坐标：地址符+数字目标点坐标及z向距离：地址符+数字目标点坐标及Z向距离：地址符+数字z向距离：数字z向距离：数字SPEED_运行速度数字DELAY_延时等待时间(ms)：数字HOME via_自动返回参考点中间点坐标：地址符+数字OPENCLOSE打开机械手关闭机械手无无WAITNWAIT精确停止校验连续方式校验无无GOSUBRET调用子程序从子程序返回子程序号：0-9999无END程序结束无2.3.1 坐标表示形式 前面已经说过，HNC-IR教学机器人的控制可在关节空间或迪卡尔空间下进行，相应地空间任一点的坐标值有两种表示形式：关节坐标和迪卡尔空间坐标。 当用关节坐标表示空间一点时，又可任意选用如下两种表示方法之一(两种方法完全等价，用户可根据喜好选用)： A_B_C_D_E_， 其中A、B、C、D、E为关节坐标轴名，其后的数字表示相应的关节坐标值； J(_，_，_，_，_)，其中J表示关节(Joint)坐标，大括号内以逗号隔开的是关节坐标轴A、B、C、D、E的坐标值。 当用迪卡尔空间坐标表示空间一点时，类似地，也可用如下两种表示方法： X_Y_Z_P_R_， 其中X、Y、Z后的数字表示空间点的位置，P、R后的数字表示空间点的姿态 P(_，_，_，_，_)， 其中P表示迪卡尔空间坐标(Position)，大括号内以逗号隔开的是迪卡尔空间坐标轴 X、Y、Z、P、R的坐标值。2.3.2 编程指令详解1、关节移动指令MOVE 格式：MOVEA_B_C_D_E_X_Y_Z_P_R_J_,_,_,_,_P_,_,_,_,_其中，MOVE后的指令参数为目标点(定位终点)在机器人坐标系中的坐标。MOVE指令控制机器人终端执行器(手爪)从当前位置以联动的方式，按SPEED指令设定的运行速度，转动转角变化最大的关节轴，到达程序段所指令的目标值，其余各关节轴同步到达程序段所指令的目标点。MOVE指令的联动关节轴合成轨迹一般不是直线。MOVE指令只要其目标点在运动范围内，就可可保证中间点不超出工作空间。2、空间直线移动命令LINE 格式：LINEA_B_C_D_E_X_Y_Z_P_R_J_,_,_,_,_P_,_,_,_,_其中，LINE后的指令参数为目标点(直线终点)在机器人坐标系中的坐标。 LINE指令控制机器人终端执行器(T-爪)从当前位置以联动的方式，按SPEED指令设定的合成运行速度(mmmin)，沿直线(联动关节轴的合成轨迹是直线)移动到程序段所指令的终点。LINE指令的目标点虽在运动范围内，但并不能保证直线上所有中间点不超出工作空间。3、空间圆弧运动命令ARC Via_ to_ 格式： 格式：ARC viaA_B_C_D_E_toA_B_C_D_E_X_Y_Z_P_R_X_Y_Z_P_R_J_,_,_,_,_J_,_,_,_,_P_,_,_,_,_P_,_,_,_,_其中，via 后的指令参数为圆弧中间点在机器人坐标系中的坐标，to 后的指令参数为目标点(圆弧终点)在机器人坐标系中的坐标。ARC via_ to_指令控制机器人终端执行器(手爪)从当前位置以联动的方式，按SPEED指令设定的合成运行速度(mmmin)，沿圆弧(联动关节轴的合成轨迹是空间三点决定的一段圆弧)经过中间点移动到程序段所指令的圆弧终点。Arc指令的中间点和目标点虽在运动范围内，但并不能保证圆弧上所有中间点不超出工作空间。例.从当前点以关节移动方式移到A点，然后从A点以圆弧方式经由B点移到C点，再从C点以直线移动方式移到D点的程序如下：n15 move x-176.24 y305.248 z-200.52 当前点A点(关节)n20 arc via p352.48,0,-100.52,0,8.835 to P176.24,-305.248,0.052,0,8 A点B点C点(圆弧)n30 line x176.24 y-305.248 z-200.52 C点D点(直线)4、空间整圆运动命令CIRCLE via_ und_ 格式：CIRCLE viaA_B_C_D_E_undA_B_C_D_E_X_Y_Z_P_R_X_Y_Z_P_R_J_,_,_,_,_J_,_,_,_,_P_,_,_,_,_P_,_,_,_,_ 其中，via后的指令参数为空间整圆经过的第一中间点在机器人坐标系中的坐标，und后的指令参数为空间整圆经过的第二个中间点在机器人坐标系中的坐标。CIRCLE via_und_指令控制机器人终端执行器（手爪）从当前位置以联动的方式，按SPEED指令设定的合成运行速度（mm/min），沿圆弧（联动关节轴的合成轨迹是空间三点决定的一个整圆）经过第一中间点和第二中间点移动到当前位置（圆的终点）。CIRCLE指令的第一中间点和第二中间点虽在运动范围内，但并不能保证整圆上所有中间点不超出工作空间。例.从前点以关节移动方式移到A点，然后从A点以圆弧方式经由B点和以C点移到A点，再从A点以直线移动方式到D点的程序如下：n18speed 2000n15 move a0 b60 c-60 当前点A点(关节)n20 circle via J45，30，-60，0，0und a0 b0 c-45 d0 e0A点B点C点A点(整圆)n30 line x176.24 y-305.248 z-200.52 A点D点(直线)5、关节空间接近命令 APPRO_ over_ 格式：APPROA_B_C_D_E_Over_X_Y_Z_P_R_J_,_,_,_,_P_,_,_,_,_ 其中，APPRO后的指令参数为目标点在机器人坐标系中的坐标，over后的指令参数为Z向距离(mm)，可正可负。 APPRO over_指令控制机器人终端执行器(手爪)从当前位置以关节移动的方式，移到与目标点在Z向上相隔一定距离处。APPRO指令的目标点虽在运动范围内，但并不能保证其Z向上相隔一定距离处不超出工作空间。6、空间直线接近命令APPROS_ over_ 格式：APPROSA_B_C_D_E_Over_X_Y_Z_P_R_J_,_,_,_,_P_,_,_,_,_ 其中，APPROS后的指令参数为目标点在机器人坐标系中的坐标，over后的指令参数为Z向距离(mm)，可正可负。 APPROS over_指令控制机器人终端执行器(手爪)从当前位置以直线移动的方式，移到与目标点在Z向上相隔一定距离处。APPROS指令的目标点虽在运动范围内，但并不能保证其Z向上相隔一定距离处以及整个直线不超出工作空间。7、关节空间离开命令DEPART_ 格式：DEPART_ 其中，DEPART后的指令参数为Z向距离(mm)，可正可负。 DEPART_指令控制机器人终端执行器(手爪)从当前位置以关节移动的方式，在Z向上移动一段距离。8、空间直线离开命令DEPARTS_ 格式：DEPARTS一 其中，DEPARTS后的指令参数为Z向距离(mm)，可正可负。 DEPARTS_指令控制机器人终端执行器(手爪)从当前位置以直线移动的方式，在Z向上移动一段距离。 例.从当前点以关节移动方式移到A点，然后从A点以直线方式接近B点正上方(z向200mm处)，再从B点正上方(z向200mm处)以直线方式移到B点的程序如下：n30 move x35248 yO z-200.52 当前点A点(关节)n35 appros x305 y176 over 200 (Z向200mm处)n40 departs 200 B点正上方(Z向200mm处)B点9、运行速度SPEED_格式：SPEED_其中，SPEED后的指令参数为运行速度，为正数。当为关节移动方式时，SPEED指令设定的运行速度，为转角变化最大的关节轴转动速度(1000*min)，其余各关节轴的转速与它成比例以同步到达程序段所指令的目标点；当为直线或圆弧移动方式时，为各关节的合成运行线速度(mmmin)。SPEED一旦编程则一直有效，直到被新的SPEED值所取代。 借助示教操作盒上的自动倍率开关，SPEED可在一定范围内进行倍率修调。10、延时等待DELAY_ 格式：DELAY_ 其中，DELAY后的指令参数为延时等待时间(ms)，为正数。 DELAY指令控制机器人在前一程序段的运行速度降到零之后，再延时等待一段时间，然后接着执行下一程序段。11、自动返回参考点HOME Via_ 格式：HOME viaA_B_C_D_E_X_Y_Z_P_R_J_,_,_,_,_P_,_,_,_,_ 其中，via后的指令参数为中间点在机器人坐标系中的坐标。HOME via指令控制机器人的受控轴从当前位置以关节移动的方式，快速定位到中间点(非参考点)，然后再从中间点自动返回到机器人的参考点。对于在HOME Via_程序段中没有指令的轴，则不返回参点。只要中间点在运动范围内，就能保证整个运行过程不超出工作空间。12、打开机械手OPEN 格式：OPEN OPEN指令无参数，它控制机器人打开手爪。13、关闭机械手CLOSE 格式：CLOSE CLOSE指令无参数，它控制机器人关闭手爪。14、精确停止校验WAIT 格式：WAIT WAIT指令无参数，在WAIT后的各程序段的移动指令都要准确停止在本程序段的终点，然后再继续执行下个程序段。此时，编程轨迹与买际轨迹相符。15、连续方式校验NWAIT 格式：NWAIT NWAIT指令无参数，在NWAIT后的各程序段所编程的轴的运动刚开始减速时就开始执行下一程序段，直到遇到WAIT为止。换言之，机器人在上一程序段到达所编程的终点之前，就开始执行下一程序段。 G64方式的编程轮廓与实际轮廓不同。其不同程度取决于SPEED值的大小及两路径间的夹角，SPEED越大，其区别越大。16、调用子程序GOSUB_ 格式：GOSUB_ 其中，GOSUB后的指令参数为被调用子程序的程序号。 GOSUB指令控制机器人程序执行被调用的子程序，直到遇到RET从子程序返回，接着GOSUB指令行的后一程序段继续执行。17、从子程序返回RET 格式：RET RET指令无参数，它控制机器人程序从子程序返回主程序，接着GOSUB指令行的后一程序段继续执行。18、程序结束END 格式：END END指令无参数，它是机器人程序的结束标志。 每个机器人程序都必须以开始，以END结束。2.4 装入运行程序、校验与运行用文本编辑方法或示教编程方法编制好机器人程序后，就可以装入程序，进行校验和运行了。在主操作界面(图2.1)下按F1“自动加工”进入程序自动运行功能，如图2.2。2.4.1装入运行程序 (i)选择运行程序的路径：在图2.2自动加工子菜单下，按F1“程序选择”，系统将弹出如图2.3所示菜单。用户用、键移动亮条选择程序路径，用回车键确认，其中当前编辑程序是指当前正在编辑的程序，内部程序是指硬盘或电子盘中的程序；磁盘程序是指“软盘中的程序；网络程序是指通过网络调入的程序。() 选择运行程序：选择内部程序，磁盘程序，网络程序后，系统自动将所有程序目录都以菜单的形式列出，如图3.3所示。用户、键选择，按回车键确认，即可将程序调入运行区。此时屏幕布上将显示要运行的程序。如果选择当前编辑程序，则将当前正在编辑的程序调入运行区。2.4.2 程序仿真校验程序仿真校验可对调入运行区的程序进行校验，并提示可能的错误。以前从来没有运行的新程序在调入后最好先仿真校验，无误后再启动自动运行。校验过程中，机器人不动作。() 按3.1节方法，调入运行程序(要校验的程序)；() 在图3.1自动加工子菜单下，按F3，此时主画面中的运行方式显示改为“校验”；() 启动程序校验，旋转示教操作盒上的波段开关，让波段开关(下)置于“自动”档，让波段开关(上)置于“自动点动修调”档；按下示教操作盒上的 “循环启动”按扭，程序校验开始。 如果选择正文显示方式(可用F9选择其它显示方式)，此时会有一黄色亮条跟踪被校验的程序段，亮条将不断下移以指示校验过程。若程序正确，程序显示又回到头，且主画面中 的运行方式显示改回为“自动”；若程序错误，亮条停在错误行，且主画面中有“出错闪动。此时可进入到故障显示功能中查看出错信息。2.4.3 自动运行 程序调入运行区并校验无误后，可启动运行程序控制机器人动作。 旋转示教操作盒上的波段开关，让波段开关(下)置于“自动”档，让波段开关(上)置于“自动点动修调”档；按下示教操作盒上的“循环启动”按扭，程序自动运行开始。 如果选择正文显示方式(可用F9选择其它显示方式)，此时会有一黄色亮条跟踪运行程序段，亮条将不断下移以指示运行过程。2.4.4 自动运行停止 自动运行停止有以下几种情况： 1程序结束(END) END是运行程序的结束标志，当系统执行该程序段时，自动运行停止。 2进给保持 在自动运行过程中，按下示教操作盒上的“进给保持”键，指示灯亮，机器人减速停止，如再按教操作盒上的“循环启动”键，机器人继续运行。 3急停 机器人运行过程中，当出现紧急情况时，按下示教操作盒上的“急停，按钮，运行立即停止工作，系统即进入急停状态；松开急停按钮，系统复位。 4停止运行 在自动运行过程中， 想人为的退出自动运行或屏幕上有报警信息时，可强行停止自动运行。在图31下，按F7“停止运行”，命令行提示确认信息(如图34所示)自动运行：是否退出自动运行YN? 按“Y”键表明停止运行， 其它任意键不停止运行。2.4.5 重新运行在停止加工程序后，希望重新开始运行时，只需要在图3.1下，按F4键，如图3.5所示。这时，命令行会提示确认信息自动运行：是否重新开始执行YN? 按“Y”键表明重新开始运行，光标将返回段首，从第0行开始重新执行调入运行区的程序；按其它任意键取消重新开始运行。2.4.6 查看运行状态在图3.1下，按F2，将显示目前正在运行程序的状态，包括用户宏程序等，并可进行用户宏变量设置： (i)在图31下，按F2，系统弹出变量类型选择菜单，如图3.6所示，用、移动亮条选择。按ESC退出。(ii)按回车键确认，正文窗口将显示相应类型变量值，如图3.7所示。(iii)此时若想修改变量值，可用f、移动光标选择要修改的变量，按回车键，在命令行输入要修改的值后再按回车键。修改后的值将显示在正文窗121的相应位置。2.4.7 运行断点保存在自动运行过程中，按下示教操作盒上的进给保持，在图3.1下，按F5(保存断点)，系统会提示断点保存文件，一般为OXXXXBP.00X，若不想改变，可直接按回车确认，如果文件已存在系统会提示您是否覆盖该文件，如果有坐标轴未回零，系统会提示保存断点失败，断点位置不存在。2.4.8 恢复断点运行按F1(自动运行)按F6(恢复断点)，系统提示您选择断点保存文件用、键选择所需文件后，回车确认。如果有坐标轴未回零，或文件指向的运行程序已改变，则提示断点恢复失败，否则系统提示用MDI方式返回断点一按F10(返回)一按F4(MDI)一按F4(返回断点)一按循环启动，机器人返回断点一按F10(返回)，然后就可以按循环启动从断点处接着上次运行了。第三章 实验项目机器人技术基础实验以HNC-IR型教学机器人为基本实验设备，通过实验，使学生认识和了解工业机器人的基本结构和组成，结合理论学习，了解该机器人的控制原理和特点，能对该机器人进行简单的静力及动力学分析，初步掌握对机械手的编程和控制方法。本课程共有三个实验，均为综合性实验，其中实验一、实验二为必做内容，实验三根据情况选做，也可以做为综合设计类开放性实验向全校学生开放。实验一工业机器人的基本结构与工作原理一、实验目的1、了解HNC-IR型教学机器人的机械结构。2、认识机器人的运动特点和控制原理。3、掌握DH坐标系的建立方法。二、实验设备HNCIR型教学机器人（二台）。设备主要参数自由度（轴）数5机械结构形式立式关节形作业半径650mm负荷能力2kg重复定位精度0.5mm驱动电机步进电机总重量（约）40kg运动范围轴A（立柱）120+125轴B（大臂）12+108轴C（小臂）10430轴D（手腕）105+44轴E170+149连杆长或高连杆1360mm连杆2280mm连杆3220mm连杆4150mm三、实验内容：1、观察机器人机械结构，电气线路硬件情况。2、手动运行，观察关节动作，手部位资。四、实验报告要求1、叙述该机器人机械结构特点。2、画出该机器人的传动系统图。3、建立DH坐标系，写出杆件的参数表。五、实验步骤1、打开控制电柜，观察电气线路硬件情况，2、打开机器人大臂和小臂的外壳，观察机器人的传动。3、连上220V总电源后，合上控制电柜侧面的强电开关(向上搬)，向右旋控制电柜侧面的钥匙，接通示教操作盒电源及HC5902接口板电源；打开PC机及CRT电源开关。4、在HNC-IR教学机器人控制单元(PC机)的安装子目录下，运行N.bat批处理文件。此时，屏幕显示系统的主操作界面。5、机器人各轴回参考点，建立关节空间坐标系、同时也建立了迪卡尔空间坐标系 (具体操作见1.3.4) 。6、手动运行机器人(具体操作见示教操作盒使用介绍)。7、实验完成后，退出机器人系统，先按下示教操作盒上的“急停”按钮，再在系统主操作界面下按“ALT+X”键。注意事项：(1) 参加实验的同学在示教操作前一定要站在机器人工作区域外，实验过程中不要随意走动。(2) 机器人各轴运动不要超出其运动范围，实验操作过程中要注意系统或示教盒上的警示，并使该轴脱离超程位置。(超程解除见1.4.2节)(3)学生在实验教师指导下操作。六、思考题1、当机器人大臂不上电(静止不动)时，如何保证机器人的大臂在小臂、手腕部分等的重力作用下不会向负方向旋转？2、机器人工作过程中，手部位资是如何保证的？3、试说明谐波减速器在机器人传动的主要作用及优缺点。实验二工业机器人的运动控制一、实验目的1、通过实际编程，实现2个木块位置的互换，掌握HNC-IR型教学机器人基本编程指令的使用。2、学习示教编程获取各点位置姿态的原理。3、熟悉机器人及其控制系统的基本操作处理方法。二、实验设备及材料1、HNCIR型教学机器人（2台）。2、两个方木块。三、实验内容及步骤1、开机，机器人回零以建立坐标系。2、将2个方木块(分别编号为1号、2号)放在机器人的运动范围内，固定不动，并将位置做上标记，并编号为1号位置，2号位置。3、在示教编程界面下，给定SPEED，OPEN(打开)手爪；4、手动操作机器人，在手爪位于1号木块正上方约5mm处停止，选择自己希望的运行方式(编程指令)，记录该点位姿A，并确认程序段；5、手动操作机器人，在手爪完全插入1号木块处停止，选择自已希望的方式(编程指令)，记录该点位姿B，并确认程序段。6、DELAY(延时等待)一段时间，并CLOSE(关闭)手爪。7、手动操作机器人，在手爪位于1号木块正上方任一点处停止，选择自已希望的方式(编程指令)，记录该点位姿C，并确认程序段。8、手动操作机器人