清华制造系统实验：机器人编程实验指导书

机器人编程实验指导书一.实验目的：1.学习使用和操作机器人。2.掌握机器人的手动控制和程序控制。3.了解程序控制机器人的过程。二．实验内容1.学习并熟悉如何使用示教盒手动调整机器人。2.根据给定的参照文件，了解控制机器人运作的方法和命令。3.手动方式调节机器人,确定机械手的空间行走路径。1)机械手从参考点移动到料带上方取料到参考点。2)机械手从参考点将料送到卡盘上,加工完毕,取料送回料带上的托盘。每条路径确定足够多的点数，确保机械手动作时不发生干涉。4.根据上面确定的空间点编制机器人控制程序。5.机器人空间点运行无误后，由指导教师检查空间点及编制的控制文件，由教师指导完成机器人控制文件的生效，进行程序控制机器人的运行。三．设备情况介绍⑴．RV－M1机器人；⑵．示教盒；⑶．零件毛坯；四．实验步骤：1）阅读相关辅助资料，读懂下面的机器人程序文件，参照此范例文件进行编程。用文本编辑器进行编辑，存成*.rob后缀文件。DL1,204810OB+030ID350GO360TI5370MO32,O380SP7,H400MO100,O480OB-0RN2）熟悉机器人的示教盒的操作方法（操作指导另附）。3）规划机器人的轨迹，用手动方式为机器人设定姿态和位置编码。a.将机器人示教盒上的手动控制开关拨到ON状态。b.对机器人进行初始化。c.执行mov100，将机械手回到点号为100的参考点。根据要求机器人完成的动作，可先依次设定姿态和位置编码，用示教盒调整机械手的行走路径,确定所需的节点数目和大致位置按照空间顺序，依次将机械手以手动方式分别调节到这些节点上，并按照一定的顺序编号、存储，位置号设定为100加上试验组号（例如：对第二组，原预设“51”号位置的坐标点定义为251号位置）。4)用“Mov位置编码（位置编码由自己定）”依次运行一遍，测试机器人的运行过程，确保此机器人要完成的动作无误，并观察是否有干涉以及时调整。5)针对测试结果上机改编和整理机器人的控制程序。将重新编制的控制程序存为“?*.rob”。“？”为组号，如对第一组，为1Convpart1.rob，其它以次类推。6）程序改编完成后，交与指导教师查看，由教师在主程序中设置路径，运行并查看程序的正确性。注意观察：这些程序是如何生效，控制机器人运作的。注意事项：（1）机器人1运行前，要检查是否与周围设备发生干涉。（2）机器人的位置编码是唯一的，一定要按照要求设置自己的位置编码，否则，会将给定文件的位置编码或其他组的位置编码冲掉。（3）构成机器人行走路径的位置点是有一定顺序的，如果中间忽略位置点，可能会发生干涉碰撞。机器人的动作由*.cmd文件控制，例如车单元配套机器人控制文件如下：Rotot1.cmd224IdSignalDescription--2-FormatCode-10NestRobotC:\CIM\CELL1\ROBOTS\NEST.rob171020LoadPart1fromConveyorC:\CIM\CELL1\ROBOTS\Convpar1.rob3712371030LoadPart2fromConveyorC:\CIM\CELL1\ROBOTS\CONVpar2.rob3712371040RetractfromLathe(GO)C:\CIM\CELL1\Robots\LATHPARK.rob3712300050IntoLathe&GripPartC:\CIM\CELL1\ROBOTS\LATHGRIP.rob3712371060RemovePart1fromLathe&placeinConveyorC:\CIM\CELL1\ROBOTS\PAR1CONV.rob3712300070RemovePart2fromLathe&placeinConveyorC:\CIM\CELL1\ROBOTS\PAR2CONV.rob37123000以上控制文件包括7个程序文件：（1）NEST.rob初始化机器人（2）CONVpar1.rob从Conveyor取零件1（3）CONVpar2.rob从Conveyor取零件2（没有使用）（4）LATHPARK.rob从机床上收回机器人手臂（5）LATHGRIP.rob车床工作完毕伸入车床抓取零件（6）PAR1CONV.rob从车床取出零件1并放回Conveyor（7）PAR2CONV.rob从车床取出零件2并放回Conveyor（没有使用）车单元配套机器人的程序只需编制LATHPARK.rob和LATHGRIP.rob；CONVpar2.rob或PAR2CONV.rob程序。同理，铣单元配套机器人的程序与车单元配套机器人程序类似，只需编制millpark.rob和millgrip.rob；CONVpar2.rob或PAR2CONV.rob程序。四．实验结果要求1．机器人行走路径节点的选择保证无干涉。取料送料位置正确。2．程序编写正确，运行正常。3．程序控制机器人完成动作符合实验要求，运行顺利。五．实验总结要求1．实验报告中要对每个文件的每一行注明指令含义。2．实验中遇到的问题，以及相应解决问题的方法。3.实验结果总结。4.实验体会。六．附录（实验机器人的基本说明、操作和编程指令参考说明）（一）基本说明1．标准规格项目规格注释机械结构5自由度，垂直关节机器人操作范围腰部旋转300度（最大速度120度/秒）J1轴肩部旋转130度（最大速度72度/秒）J2轴肘部旋转110度（最大速度109度/秒）J3轴腕部倾斜90度（最大速度100度/秒）J4轴腕部旋转180度（最大速度163度/秒）J5轴臂长上臂250毫米前臂160毫米重量驱动最大1.2kgf（包括手部重量）距机械表面75毫米（重心）最大轨道速度1000毫米/秒（腕部设备表面）图1.3.4中P点的速度复位0.3毫米（腕部设备表面旋转中心）图1.3.4中P点的准确度动力系统直流伺服电机机器人重量大约19kgf电机功率J1至J3轴：30W，J4和J5轴：11W2．基本运动图1.3.5显示了垂直系统中的轴转动。注解1：J1和J5轴转动的正方向分别是从箭头A和B看过去的顺时针方向；注解2：J2，J3和J4轴转动的正方向分别是沿臂部和腕部向上的方向。（二）操作（示教盒的基本功能）1．开关作用（1）ON/OFF（开/关）选择是否能使示教盒上的各键。当机器人通过示教盒来控制时，打开开关ON。当使用个人电脑进行命令传送并控制机器人时，选择开关OFF。一次错误的键操作可以通过将此开关转变为OFF来取消。在编程操作过程中，如果开关设定为ON，不能实现示教盒上的操作。（2）EMG.STOP（紧急停止开关）此按钮用于机器人的紧急停止操作（当开关按下时，信号内部中断）。当开关按下时，机器人立刻停止运动，并且错误指示器LED闪亮（错误模式Ι）。在驱动单元侧面通道的LED4也亮。2．各键作用（1）INC（+ENT）将机器人移动到预先指定位置，此位置数字要大于当前数字。要使机器人按照一定的顺序移动，依序重复按键。（参看命令“IP.”）（2）DEC（+ENT）将机器人移动到预先指定位置，此位置数字要小于当前数字。要使机器人按照一定的顺序移动，依序重复按键。（3）P.S（+Number+ENT）定义当前机器人位置坐标到指定位置号。如果一个数字被指派给两个不同的位置，后定义的优先。为防止错误的产生，不要将机器人姿态设置为接近各轴的极限。（4）P.C（+Number+ENT）取消位置内容中的指定数字。（参看命令“PC.”）（5）NST（+ENT）机器人复位。（参看命令“NT.”）（6）ORG（+ENT）将机器人移至笛卡尔坐标系的参考位置。（7）TRN（+ENT）将驱动单元侧面面板上SOC2中安装的用户EPROM中的内容（程序和位置信息）传送到驱动单元RAM。（8）WRT（+ENT）将驱动单元RAM中的程序和位置信息写入驱动单元侧面面板上SOC2中安装的用户EPROM。（9）MOV（+Number+ENT）将手部末端移至指定位置。（参看命令“MO.”）移动速度为SP4。（10）STEP（+Number+ENT）从指定位置开始逐步执行程序，为使程序能够一步接一步的有序执行，依序重复按键。注意，此时，不需要任何数据入口。如果在执行过程中有错误，则产生错误模式Ⅱ。（11）PTP选择关节缓动操作。此键按下后，其后任何缓动键的操作会实现各关节的运动。当示教盒一打开“ON”时，PTP就设置好了。（12）XYZ选择笛卡尔直角坐标的缓动操作。此键按下后，其后任何缓动键操作会实现笛卡尔坐标系内的各轴的运动。（13）TOOL选择设备缓动操作。此键按下后，其后任何缓动键操作会实现设备坐标系内的各轴的运动（手方向的前进/收缩动作）。（14）ENT完成从（29）至（38）各键的入口以实现相应的操作。（15）X+/B+用笛卡尔缓动操作，将手部末端移至X轴正向（面向机器人的正面，左部为X轴正向），并以关节缓动操作正向旋转腰部（从机器人顶部看为顺时针方向）。（16）X-/B-用笛卡尔缓动操作，将手部末端移至X轴负向（面向机器人的正面，右部为X轴负向），并以关节缓动操作负向旋转腰部（从机器人顶部看为逆时针方向）。（17）Y+/S+用笛卡尔缓动操作，将手部末端移至Y轴正向（机器人的正面为Y轴正向），并以关节缓动操作正向旋转肩部（向上）。（18）Y-/S-用笛卡尔缓动操作，将手部末端移至Y轴负向（机器人的后面为Y轴负向），并以关节缓动操作负向旋转肩部（向下）。（19）Z+/E+4用笛卡尔缓动操作，将手部末端移至Z轴正向（垂直向上），以关节缓动操作正向旋转肘部（向上），并以设备缓动操作向前移动手部。与数字键“4.”作用相同。（20）Z-/E-9用笛卡尔缓动操作，将手部末端移至Z轴负向（垂直向下），以关节缓动操作负向旋转肘部（向下），并以设备缓动操作收缩手部。与数字键“9.”作用相同。（21）P+3在保持由“TL”命令决定的当前位置的情况下，用笛卡尔缓动操作，正向（向上）旋转手部末端，以关节缓动操作正向（向上）倾斜腕部（腕部倾斜）。与数字键“3.”作用相同。（22）P-8在保持由“TL”命令决定的当前位置的情况下，用笛卡尔缓动操作，负向（向下）旋转手部末端，以关节缓动操作负向（向下）倾斜腕部（腕部倾斜）。与数字键“8.”作用相同。（23）R+2正方向（向手部装配表面看去，顺时针方向）弯曲腕部（腕部旋转）。与数字键“2.”作用相同。（24）R-7负方向（向手部装配表面看去，逆时针方向）弯曲腕部（腕部旋转）。与数字键“7.”作用相同。（25）OPTION+1向正方向移动任意轴。与数字键“1.”作用相同。（26）OPTION-6向负方向移动任意轴。与数字键“6.”作用相同。（27）◄O►0打开手夹。与数字键“0.”作用相同。（28）►C◄5关闭手夹。与数字键“5.”作用相同。3．指示器LED的功能4位LED显示如下信息：（1）位置数字当INC，DEC，P.S，P.C，或者MOV键使用时，以3位数显示位置数字。（2）程序行号在程序运行过程中使用STEP键，可以以4位数显示程序行号。（3）示教盒状态指示器（左边第一位数字）“└┘”表示由于释放ENT键的引起的处理过程正在进行或者是已经结束。“∟”表示由于ENT键的释放引起的处理过程无法实现。4．各键相应的智能命令示教盒上各键的功能与由计算机发出的智能命令的功能相对应。INC“IP”DEC“DP”P.S“HE”P.C“PC”NST“NT”ORG“OG”TRN“TR”WRT“WR”MOV“MO”（三）命令描述1．命令综述（1）位置/运动控制命令（24个）这些命令与机器人的位置和运动相关。他们包括那些定义、替换、设置和计算位置数据以及那些影响弧和线性插补和连续路线运动。还包括速度设置，原点设置和夹板装载命令。（2）程序控制命令（19个）这些命令控制程序流程，他们包括子程序，循环和状态跳转，以及记数命令和利用外部信号中断操作的声明。（3）手控制命令（4个）这些命令控制手。这些命令也适用于电动机操作手（可以设置夹紧力和夹紧放