1、RBT-6T/S01S 桌面型串联关节式机器人实验指导书哈尔滨工业大学博实精密测控有限责任公司哈尔滨工业大学博实精密测控有限责任公司- I -目 录实验 1 机器人的认识 11.1 实验目的 11.2 实验设备 11.3 实验原理 11.4 实验步骤 51.5 注意事项 6实验 2 机器人的机械系统 72.1 实验目的 72.2 实验设备 72.3 实验原理 72.4 实验步骤 122.5 注意事项 14实验 3 机器人的控制系统 153.1 实验目的 153.2 实验设备 153.3 实验原理 153.4 实验步骤 193.5 注意事项 21实验 4 机器人示教编程与再现控制 224.1 实
2、验目的 224.2 实验设备 224.3 实验原理 224.4 实验步骤 234.5 思考题 244.6 注意事项 24实验 5 机器人坐标系的建立 255.1 实验目的 255.2 实验设备 255.3 实验原理 255.4 实验步骤 275.5 思考题 31实验 6 机器人正运动学分析 336.1 实验目的 336.2 实验设备 336.3 实验原理 336.4 实验步骤 336.5 思考题 36哈尔滨工业大学博实精密测控有限责任公司- II -实验 7 机器人逆运动学分析 377.1 实验目的 377.2 实验设备 377.3 实验原理 377.4 实验步骤 387.5 思考题 41实验
3、 8 机器人的搬运装配实验 428.1 实验目的 428.2 实验设备 428.3 实验原理 428.4 实验步骤 428.5 注意事项 44哈尔滨工业大学博实精密测控有限责任公司第 1 页 共 52 页实验 1 机器人的认识1.1 实验目的1、 了解机器人的机构组成；2、 掌握机器人的工作原理；3、 熟悉机器人的性能指标；4、 掌握机器人的基本功能及示教运动过程。1.2 实验设备1、 RBT-6T/S01S 机器人一台；2、 RBT-6T/S01S 机器人控制柜一台；3、 装有运动控制卡和控制软件的计算机一台；4、 轴和轴套各一个。1.3 实验原理机器人是一种具有高度灵活性的自动化机器，是一
4、种复杂的机电一体化设备。机器人按技术层次分为：固定程序控制机器人、示教再现机器人和智能机器人等。本课程所使用的机器人为 6 自由度串联机器人，其轴线相互平行或垂直，能够在空间内进行定位，采用伺服电机和步进电机混合驱动，主要传动部件采用可视化设计，控制简单，编程方便，是专为满足高等院校机电一体化、自动控制等专业进行机电及控制课程串联关节式实验需要和相关工业机器人应用培训需要而最新开发的机器人，它是一个多输入多输出的动力学复杂系统，是进行控制系统设计的理想平台。它具有高度的能动性和灵活性，具有广阔的开阔空间，是进行运动规划和编程系统设计的理想对象。整个系统包括机器人 1 台、电控柜 1 台、控制卡
5、 2 块、实验附件 1 套（包括轴、套）和机器人控制软件 1 套（实验设备用户可选） 。机器人采用串联式开链结构，即机器人各连杆由旋转关节或移动关节串联连接，如图 1-1 所示。各关节轴线相互平行或垂直。连杆的一端装在固定的支座上（底座） ，另一端处于自由状态，可安装各种工具以实现机器人作业。关节的作用是使相互联接的两个连杆产生相对运动。关节的传动采用模块化结构，由锥齿轮、同步齿型带和谐波减速器等多种传动结构配合实现。机器人各关节采用伺服电机和步进电机混合驱动，并通过 Windows 环境下的软件编程和运动控制卡实现对机器人的控制，使机器人能够在工作空间内任意位置精确定位。哈尔滨工业大学博实精
6、密测控有限责任公司第 2 页 共 52 页图 1-1 机器人结构机器人技术参数如表 1-1 所示。标 1-1 机器人技术参数结构形式 串联关节式驱动方式 步进伺服混合驱动负载能力 3Kg重复定位精度 0.08mm关节 -150 150关节 -135 -45关节 -70 50关节 -90 90关节 -90 90动作范围关节 -180 180关节 60o / S关节 60o / S关节 60o / S关节 60o / S关节 60o / S最大速度关节 120o / S哈尔滨工业大学博实精密测控有限责任公司第 3 页 共 52 页最大展开半径 610 mm高度 850 mm本 体 重 量 40Kg
7、操作方式 示教再现/编程电源容量 单相 220V 50Hz 4A预备知识：1、 机器人的英文名缘由机器人是一种具有某种仿人功能的自动机，机器人的国际名叫“罗伯特”（ROBOT） 。“ROBOT”一词源于捷克作家卡列尔查培于 1920 年的一部名叫作 罗萨姆的万能机器人公司的幻想剧，罗伯特是该剧主人公的名字，他是既忠诚又勤劳的机器人。2、 机器人的定义（我国科学家的定义）机器人是一种自动化的机器，所不同的是这种机器具备一些与人或生物相似的智能能力，如感知能力、规划能力、动作能力和协同能力，是一种具有高度灵活性的自动化机器。3、 机器人的三原则1、 机器人不能伤害人类；2、 在不违反第一条的情况下
8、，机器人必须遵守人类的命令；3、 在不违反第一、二条的情况下，机器人应能保护自己。4、 机器人发展史1、 古代机器人：（1） 中国机关人世界最早的机器人列子、汤问篇中记载西周穆王时，有位名叫偃师的能工巧匠就制造了一个能歌善舞的伶人机器人。春秋后期，木匠鲁班制造的木鸟，能在空中飞行“三日不下” 。1800 年前的汉代，大科学家张衡发明的计里鼓车。计里鼓车每行一里，车上木人击鼓一下，每行十里击钟一下。后汉三国时期，诸葛亮成功地创造出了“木牛流马”，并用其运送军粮，支援前方战争。最早的军事机器人（2） 西方最早的机器人，是公元前 2 世纪古希腊人发明的最原始的机器人自动机。1738 年，法国天才技师
9、杰克戴 瓦克逊发明了一只机器鸭。2、 现代机器人：1954 年美国戴沃尔最早提出了工业机器人的概念，并申请了专利。哈尔滨工业大学博实精密测控有限责任公司第 4 页 共 52 页1959 年第一台工业机器人（可编程、圆坐标）在美国诞生，开创了机器人发展的新纪元。1967 年日本成立了人工手研究会（现改名为仿生机构研究会） ，同年召开了日本首届机器人学术会。1970 年在美国召开了第一届国际工业机器人学术会议。1980 年被称为“机器人元年” 。5、 机器人的组成部分机器人的手操作系统，作用是抓住一个工作对象使其按工作或作战要求动作。机器人的眼感测系统，作用是观测工作对象及其周围环境的信息，通过收
10、集信息将其反馈给控制中心，作为对机器人行为控制和协调的依据。机器人神经系统信息传输系统，作用是将传感器和观测器获得的各种信息下传上达，交给各执行及其附属设备。机器人的心脏动力系统，作用是负责向机器人提供动力，主要设备有各种发动机，发电机及其附属设备。机器人的大脑指挥控制系统。作用是加工处理各种信息，指挥、控制机器人的各种行动。图 1-2 6、 机器人的种类按技术层次分为固定程序控制机器人、示教再现机器人、数控机器人、遥控机器人和智能机器人。按工作自由度分为自主机器人、半自主机器人和摇控机器人。7、 机器人的用途1） 勤劳忠诚的员工不计报酬；2） 未知世界的使者不知“天高地厚”；3） 未到战争中
11、的圣斗士不晓得皮肉之苦；4） 保姆、白衣天使和明星不用包装炒作。8、 机器人的未来发展人性化、智能化、普及化。哈尔滨工业大学博实精密测控有限责任公司第 5 页 共 52 页1.4 实验步骤1、 连接好气路，启动气泵到预定压力；2、 启动计算机，运行机器人软件，出现如图 1-3 所示主界面；3、 接通控制柜电源，按下“启动”按钮；图 1-3 主界面4、 点击主界面“机器人复位”按钮，机器人进行回零运动。观察机器人的运动，六个关节全部运动完成后，机器人处于零点位置；5、 点击“关节示教”按钮，出现如图 1-4 所示界面，按下“打开”按钮，在机器人软件目录下选择示教文件 1.RBT，示教数据会在示教
12、列表中显示；6、 装配操作演示，在 2 个支架的相应位置上分别放置轴和轴套，然后按下“再现”按钮，机器人实现装配动作；7、 运动完毕后，按下“复位”按钮，机器人回到零点位置，关闭对话框；8、 如果想再做一次装配动作，把轴放回相应位置，按下“再现”按钮即可；9、 点击“机器人复位”按钮，使机器人回到零点位置；10、 按下控制柜上的“停止”按钮，断开控制柜电源；11、 退出机器人软件，关闭计算机。哈尔滨工业大学博实精密测控有限责任公司第 6 页 共 52 页图 1-4 关节示教界面1.5 注意事项1、 在老师的指导下进行实验；2、 机器人通电后，身体的任何部位不要进入机器人运动可达范围之内；3、
13、机器人运动不正常时，及时按下控制柜的急停开关。哈尔滨工业大学博实精密测控有限责任公司第 7 页 共 44 页实验 2 机器人的机械系统2.1 实验目的1、 了解机器人机械系统的组成；2、 了解机器人机械系统各部分的原理及作用；3、 掌握机器人单轴运动的方法。2.2 实验设备1、 RBT-6T/S01S 机器人一台；2、 RBT-6T/S01S 机器人控制柜一台；3、 装有运动控制卡和控制软件的计算机一台。2.3 实验原理机器人机械系统主要由以下几大部分组成：原动部件、传动部件、执行部件。基本机械结构连接方式为原动部件传动部件执行部件。机器人的传动简图如图 2-1 所示。关节传动链主要由伺服（或
14、步进）电机、减速器构成。关节传动链主要由伺服电机、减速器构成。关节传动链主要由步进电机、同步带、减速器构成。关节传动链主要由步进电机、减速器构成。关节传动链主要由步进电机、同步带、减速器构成。关节传动链主要由步进电机、减速器构成。在机器人末端还有一个气动夹持器。原动部件包括步进电机和伺服电机两大类，关节采用伺服（或步进）电机驱动方式、关节采用伺服电机驱动方式；关节、采用步进电机驱动方式。本机器人中采用了同步齿型带传动、谐波减速传动等传动方式。执行部件采用了气动手爪机构，以完成抓取作业。下面对机器人中采用的各传动部件的工作原理及特点作以简要介绍。哈尔滨工业大学博实精密测控有限责任公司第 8 页
15、共 44 页图 2-1 机器人传动简图1、 同步齿型带传动同步齿型带传动是通过带齿与轮齿的啮合传递运动和动力，如图 2-2 所示。与摩擦型带传动相比，同步带传动兼有带传动、链传动和齿轮传动的一些特点，与一般带传动相比具有以下特点：1） 传动比准确，同步带传动是啮合传动，工作时无滑动；2） 传动效率高，可达 98%以上，节能效果明显；3） 不需依靠摩擦传动，预紧张力小，对轴和轴承的作用力小，带轮直径小，所占空间小，重量轻，结构紧凑；4） 传动平稳，动态特性良好，能吸振，噪音小；5） 齿型带较薄，允许线速度高，可达 50m/s；6） 使用广泛，传递功率由几瓦至数千瓦，速比可达 10 左右；7） 使
16、用保养方便，不需要润滑，耐油、耐磨性和抗老化好，还能在高温、灰尘、水及腐蚀介质等恶劣环境中工作；8） 安装要求较高，两带轮轴心线平行度要高，中心距要求严格；9） 带和带轮的制造工艺复杂、成本高。尽管如此，同步带传动不失为一种十分经济的传动装置，现已广泛用于要求精密定位的各种机械传动中。哈尔滨工业大学博实精密测控有限责任公司第 9 页 共 44 页图 2-2 同步齿型带传动结构2、 谐波齿轮传动谐波齿轮传动由三个基本构件组成：1） 谐波发生器（简称波发生器）是由凸轮（通常为椭圆形）及薄壁轴承组成，随着凸轮转动，薄壁轴承的外环作椭圆形变形运动（弹性范围内） ；2） 刚轮是刚性的内齿轮；3） 柔轮是
17、薄壳形元件，具有弹性的外齿轮。以上三个构件可以任意固定一个，成为减速传动及增速传动；或者发生器、刚轮主动，柔轮从动，成为差动机构（即转动的代数合成） 。谐波传动工作过程如下图 2-3 所示，当波发生器为主动时，凸轮在柔轮内转动，使长轴附近柔轮及薄壁轴承发生变形（可控的弹性变形） ，这时柔轮的齿就在变形的过程中进入（啮合）或退出（啮出）刚轮的齿间，在波发生器的长轴处处于完全啮合，而短轴方向的齿就处于完全的脱开状态。图 2-3 谐波齿轮传动工作过程波发生器通常为椭圆形的凸轮，凸轮位于薄壁轴承内。薄壁轴承装在柔轮内，此时柔轮由原来的圆形而变成椭圆形，椭圆长轴两端的柔轮与之配合的刚轮齿则处于完全啮合状
18、态，即柔轮的外齿与刚轮的内齿沿齿高啮合。这是啮合区，一般有 30%左右的齿处在啮合状态；椭圆短轴两端的柔轮齿与刚轮齿处于完全脱开状态，简称脱开；在波发生器长轴和短轴之间的柔轮齿，沿柔轮周长的不同区段内，有的逐渐退出刚轮齿间，处在半脱开状态，称之为啮出；有的逐渐进入刚轮齿间，处在半啮合状态，称之为啮入。哈尔滨工业大学博实精密测控有限责任公司第 10 页 共 44 页波发生器在柔轮内转动时，迫使柔轮产生连续的弹性变形，此时波发生器的连续转动，就使柔轮齿的啮入啮合啮出脱开这四种状态循环往复不断地改变各自原来的啮合状态。这种现象称之为错齿运动，正是这一错齿运动，使减速器可以将输入的高速转动变为输出的低
19、速转动。对于双波发生器的谐波齿轮传动，当波发生器顺时针转动 1/8 周时，柔轮齿与刚轮齿就由原来的啮入状态而成啮合状态，而原来脱开状态就成为啮入状态。同样道理，啮出变为脱开，啮合变为啮出，这样柔轮相对刚轮转动（角位移）了 1/4 齿；同理，波发生器再转动 1/8 周时，重复上述过程，这时柔轮位移一个齿距。依此类推，波发生器相对刚轮转动一周时，柔轮相对刚轮的位移为两个齿距。柔轮齿和刚轮齿在节圆处啮合过程就如同两个纯滚动（无滑动）的圆环一样，两者在任何瞬间，在节圆上转过的弧长必须相等。由于柔轮比刚轮在节圆周长上少了两个齿距，所以柔轮在啮合过程中，就必须相对刚轮转过两个齿距的角位移，这个角位移正是减
20、速器输出轴的转动，从而实现了减速的目的。波发生器的连续转动，迫使柔轮上的一点不断的改变位置，这时在柔轮的节圆的任一点，随着波发生器角位移的过程，形成一个上下左右相对称的和谐波，故称之为：“谐波”。谐波齿轮传动的特点：1） 传动比大、单级传动比为 70320；2） 侧隙小。由于其啮合原理不同于一般齿轮传动，侧隙很小，甚至可以实现无侧隙传动；3） 精度高。同时啮合齿数达到总齿数的 20%左右，在相 180的两个对称方向上同时啮合，因此误差被平均化，从而达到高运动精度；4） 零件数少、安装方便。仅有三个基本部件，且输入轴与输出轴为同轴线，因此结构简单，安装方便；5） 体积小、重量轻。与一般减速器比较
21、，输出力矩相同时，通常其体积可减小2/3，重量可减小 1/2；6） 承载能力大。因同时啮合齿数多，柔轮又采用了高疲劳强度的特殊钢材，从而获得了高的承载能力；7） 效率高。在齿的啮合部分滑移量极小，摩擦损失少。即使在高速比情况下，还能维持高的效率；8） 运转平稳。周向速度低，又实现了力的平衡，故噪声低、振动小；9） 可向密闭空间传递运动。利用其柔性的特点，可向密闭空间传递运动。这一点是其它任何机械传动无法实现的。3、 齿轮传动齿轮传动的分类：哈尔滨工业大学博实精密测控有限责任公司第 11 页 共 44 页齿轮传动的特点：1） 瞬时传动比恒定。非圆齿轮传动的瞬时传动比又能按需要的变化规律设计；2）
22、 传动比范围大，可用于减速或增速；3） 速度（指节圆圆周速度）和传动功率的范围大，可用于高速（v40m/s） 、中速和低速（v25m/s ）的传动；功率可从小于 1W 到 105Kw；4） 传动效率高，一对高精度的渐开线圆柱齿轮，效率可达 99%以上；5） 结构紧凑，适用于近距离传动；6） 制造成本较高，某些具有特殊齿形或精度很高的齿轮，因需要专用或高精度的机床、刀具和量仪等，故制造工艺复杂，成本高；7） 精度不高的齿轮，传动时噪声、振动和冲击大，污染环境；8） 无过载保护作用。4、 RV 传动图 2-4 RV 减速器实物图RV 传动是在摆线针轮传动基础上发展起来的一种新型传动，它具有体积小，
23、重量轻，传动比范围大，传动效率高等一系列优点，比单纯的摆线针轮行星传动具有更小的体积和更大的过载能力，且输出轴刚度大，因而在国内外受到广泛重视，在日本机器人的传动机构中，已在很大程度上逐渐取代单纯的摆线针轮行星传动和谐波传动。RV 传动原理如图 2-5 所示，它由渐开线圆柱齿轮行星减速机构和摆线针轮行星减速机构二部分组成渐开线行星齿轮 2 与曲柄轴 3 连成一体, 作为摆线针轮传动部分的输入,如果渐开线中心齿轮 1 顺时针方向旋转,那么渐开线行星齿轮在公转的同时还有逆时针方向自转, 并通过曲柄轴带动摆线轮做偏心运动,此时,摆线轮在其轴线公转的同时,哈尔滨工业大学博实精密测控有限责任公司第 12
24、 页 共 44 页还将反向自转, 即顺时针转动. 同时还通过曲柄轴推动钢架结构的输出机构顺时针方向转动. 按照封闭差动轮系求解传动比基本方法，可以计算出 RV 传动的传动比计算公式如下：i16=1+Z2*Z5/Z1其中 Z1-渐开线中心轮齿数Z2-渐开线行星轮齿数Z5-针轮齿数，Z 5Z 4+1Z4 -摆线轮齿数图 2-5 RV 传动简图RV 传动作为一种新型传动，从结构上看，其基本特点可概括如下：1） 如果传动机构置于行星架的支撑主轴承内，那么这种传动的轴向尺寸可大大缩小；2） 采用二级减速机构，处于低速极的摆线针轮行星传动更加平稳，同时，由于转臂轴承个数增多且内外环相对转速下降，其寿命也可
25、大大提高；3） 只要设计合理，就可以获得很高的运动精度和很小的回差；4） RV 传动的输出机构是采用两端支承的尽可能大的钢性圆盘输出结构，比一般摆线减速器的输出架构（悬臂梁结构）具有更大的刚度，且抗冲击性能也有很大提高；5） 传动比范围大，因为即使摆线轮齿数不变，只改变渐开线齿数，就可以得到很多的速比。其传动比为 i=31 171；6） 传动效率高，其传动效率为 =0.850.92。2.4 实验步骤1、 教师介绍机器人机械系统中原动部分、传动部分以及执行部分的位置及在机器人系统中的工作状况；哈尔滨工业大学博实精密测控有限责任公司第 13 页 共 44 页2、 启动计算机，运行机器人软件；3、
26、接通控制柜电源，按下“启动”按钮；图 2-6 关节运动界面4、 点击主界面“机器人复位”按钮，机器人进行回零运动。观察机器人的运动，六个关节全部运动完成后，机器人处于零点位置；5、 点击主界面“关节运动”按钮, 出现如图 2-6 所示界面；6、 选择“关节” ，关节方向选择“正向” ，启动方式选择“加速” ，运动方式选择“位置模式” ，运行速度取默认值，目标位置取-120 度，点击“启动”按钮，观察机器人第关节运动情况；7、 选择“关节” ，关节方向选择“反向” ，启动方式选择“加速” ，运动方式选择“速度模式” ，运行速度取默认值，点击“启动”按钮，观察机器人第关节运动情况，然后点击“立即停
27、止”按钮；8、 选择“关节” ，关节方向选择“正向” ，启动方式选择“匀速” ，运动方式选择“位置模式” ，运行速度取默认值，目标位置取-120 度，点击“启动”按钮，观察机器人第关节运动情况；9、 选择“关节” ，关节方向选择“反向” ，启动方式选择“匀速” ，运动方式选择“速度模式” ，运行速度取默认值，点击“启动”按钮,观察机器人第关节运动情况，然后点击“立即停止”按钮；10、 选择“关节” ，关节方向选择“正向” ，启动方式选择“加速”,运动方式选择“位置模式” ，运行速度取默认值，目标位置取 30 度，点击“启动”按钮,观察机器人第关节运动情况；11、 选择“关节” ，关节方向选择“
28、反向” ，启动方式选择“加速”,运动方式选择“速度模式” ，运行速度取默认值，点击“启动”按钮观察机器人第关节运动情况，然后点击“立即停止”按钮；12、 选择“关节” ，关节方向选择“正向” ，启动方式选择“匀速”,运动方式选择“位置模式” ，运行速度取默认值，目标位置取 60 度，点击“启动”按钮,观察机器人第关节运动情况；哈尔滨工业大学博实精密测控有限责任公司第 14 页 共 44 页13、 选择“关节” ，关节方向选择“反向” ，启动方式选择“匀速” ，运动方式选择“速度模式” ，运行速度取默认值，点击“启动”按钮观察机器人第关节运动情况，然后点击“立即停止”按钮；14、 选择“关节”，
29、关节方向选择“正向”， 启动方式选择“加速” ， 运动方式选择“位置模式” ，运行速度取默认值，目标位置取 60 度，点击“启动”按钮,观察机器人第关节运动情况；15、 选择“关节”，关节方向选择“反向” ， 启动方式选择“加速” ， 运动方式选择“速度模式” ，运行速度取默认值，点击“启动”按钮观察机器人第关节运动情况，然后点击“减速停止”按钮；16、 选择“关节”，关节方向选择“正向”，启动方式选择“加速” ，运动方式选择“位置模式” ，运行速度取默认值，目标位置取 60 度，点击“启动”按钮,观察机器人第关节运动情况；17、 选择“关节”，关节方向选择“反向”，启动方式选择“加速” ，运
30、动方式选择“速度模式” ，运行速度取默认值，点击“启动”按钮观察机器人第关节运动情况，然后点击“减速停止”按钮；18、 点击“退出”按钮，退出关节运动界面；19、 点击“机器人复位”按钮，使机器人回到零点位置；20、 按下控制柜上的“停止”按钮，断开控制柜电源；21、 退出机器人软件，关闭计算机。2.5 注意事项1、 在老师的指导下进行实验；2、 机器人通电后，身体的任何部位不要进入机器人运动可达范围之内；3、 机器人运动不正常时，及时按下控制柜的急停开关。哈尔滨工业大学博实精密测控有限责任公司第 15 页 共 44 页实验 3 机器人的控制系统3.1 实验目的1、 了解机器人控制系统的组成；
31、2、 熟悉机器人控制系统各部分的原理及作用。3.2 实验设备1、 RBT-6T/S01S 机器人一台；2、 RBT-6T/S01S 机器人控制柜一台；3、 装有运动控制卡和控制软件的计算机一台。3.3 实验原理RBT-6T/S01S 机器人控制系统主要由计算机、伺服（步进）电机驱动器及伺服（步进）电机、电源、控制柜、操作电路等几部分组成。计算机内安装有运动控制卡和机器人控制软件。 运动控制卡由高性能 DSP 处理器、CPLD 可编程器件及伺服电机接口器件等组成，用于实现伺服电机的位置、速度、加速度的控制及多个伺服电机的多轴协调控制。其主要功能为：S 形、梯形自动加减速曲线规划；输出控制脉冲到电
32、机驱动器使电机运动；具有编码器位置反馈信号接口，监控电机实际运行状态；能利用零位开关、减速开关及编码器 Z 相信号实现高速高精度原点返回操作；具有伺服驱动器报警信号 ALM 等伺服驱动器专用信号接口。伺服（步进）电机驱动器用来把运动控制卡提供的低功率的脉冲信号转换为能驱动电机的大功率电信号,以驱动电机带动负载旋转。电源部分用来给控制柜提供各驱动器的控制用电源，包括相关保护、滤波器件等。操作电路提供电气系统所需的电源开、关顺序操作及保护、报警、状态指示等控制操作。下面对本系统中所使用的步进电机及伺服电机系统作以简要介绍。1、 步进电机控制系统示意图如图 3-1 所示。图 3-1 步进电机控制系统
33、哈尔滨工业大学博实精密测控有限责任公司第 16 页 共 44 页其主要的控制信号有：1） 步进脉冲信号 CP ：这是最重要的一路信号，控制卡发出此信号用来控制步进电机旋转，驱动器每接受一个脉冲信号 CP，就驱动步进电机旋转一 个步距角，CP 的频率和步进电机的转速成正比，CP 的脉冲个数决定了步进电机旋转的角度。这样，控制系统通过脉冲信号 CP 就可以达到控制电机位置和速度的目的。2） 方向电平信号 DIR ：控制卡发出此信号用来控制电机的旋转方向。比如说，此信号为高电平时电机为顺时针旋转，此信号为低电平时电机则为反方向逆时针旋转。3） 使能信号 EN ：此信号在不连接时默认为有效状态，这时驱
34、动器正常工作。当此信号回路导通时，驱动器停止工作，此信号为选用信号。2、 本书提供两种伺服控制系统示意图，如图 3-2、图 3-3 所示。用户可根据需要自行选择阅读。哈尔滨工业大学博实精密测控有限责任公司第 17 页 共 44 页图 3-2 安川 YSKAWA -系列 SGDM 型伺服控制系统示意图哈尔滨工业大学博实精密测控有限责任公司第 18 页 共 44 页图 3-3 富士 FUJI FALDIC-W 系列伺服控制系统示意图其主要控制信号有：1） 脉冲信号 PULS ：此信号由运动控制卡发出，驱动器接收此信号驱动伺服电机旋转；2） 方向信号 SIGN ：此信号由运动控制卡发出，用来控制电机
35、旋转方向；3） 原点信号 ORG ：由零位开关发出。ORG 信号可单独用于寻零操作，ORG 信号也可与编码器 Z 相信号配合得到精度更高的寻零操作；4） 限位信号 EL ：由限位开关发出。+EL 为电机运行正方向的限位信号，-EL 为电机运行负方向的限位信号，当与电机运行相同方向的 EL 信号为“ON ”状态时，控制卡立即停止发出脉冲，电机自动停止运行。这个信号被锁存，即使 EL 又恢复成哈尔滨工业大学博实精密测控有限责任公司第 19 页 共 44 页“OFF”状态，控制卡也不会再发出脉冲，可由指令发出相反方向运动的脉冲链使电机反向运动，解除这一锁存状态；5） 驱动器报警信号 ALM：由驱动器
36、发出。当驱动器发生故障时，报警信号 ALM为“ON”状态，控制卡接收到这个信号后立即停止发出脉冲，电机自动停止运行；6） 伺服 ON 信号：由运动控制卡发出，伺服驱动器接收到此信号后，即处于伺服状态；7） 编码器信号：编码器输出 A、B、Z 相信号送到伺服驱动器，经伺服驱动器分频后发送到运动控制卡，用来反馈伺服电机实际运行位置及实现闭环控制。3.4 实验步骤1、 介绍控制柜各组成部分（教师讲解）结合实验原理，介绍 RBT-6T/S01S 机器人的控制系统的组成，电控系统主要由电机及驱动器、断路器、开关电源、按钮指示灯等其他附件组成。控制柜前视图如图 3-4所示，电气安装板布局图如图 3-5 所
37、示，控制柜侧视图如图 3-6 所示。电气元件具体说明如下：SA1：电源开关，用于接通和断开控制柜电源；HL1：电源指示灯；HL2：报警指示灯；SB1：启动按钮，接通电机驱动器主回路电源；SB2：停止按钮，切断电机驱动器主回路电源；SB3：急停按钮；图 3-4 控制柜前视图哈尔滨工业大学博实精密测控有限责任公司第 20 页 共 44 页图 3-5 电气安装板布局图DRV1DRV6: 驱动器；P1：开关电源，为电机驱动器提供 DC24V 电源；AP1：接口板，用于机器人各轴命令脉冲和限位开关等信号的转接；XT1：接线端子排；QF1：断路器，控制系统出现过电流时，自动切断电源回路，保护设备及人员安全
38、；KM1：交流接触器，切断和接通电源主回路；NF1：滤波器，滤除交流电源产生的噪声；图 3-5 控制柜侧视图CN1CN4：圆形连接器，位于控制柜后部，用来连接控制柜和机器人之间的电缆；XS1：电源插座；2、 控制柜的使用1） 接通控制柜电源；哈尔滨工业大学博实精密测控有限责任公司第 21 页 共 44 页2） 按下“启动”按钮；3） 使用结束后，按下“停止”按钮；4） 断开控制柜电源。3.5 注意事项1、 在老师的指导下进行实验；2、 机器人通电后，身体的任何部位不要进入机器人运动可达范围之内；3、 机器人运动不正常时，及时按下控制柜的急停开关。哈尔滨工业大学博实精密测控有限责任公司第 22
39、页 共 44 页实验 4 机器人示教编程与再现控制 4.1 实验目的1、 了解机器人示教与再现的原理；2、 掌握机器人示教和再现过程的操作方法。4.2 实验设备1、 RBT-6T/S01S 机器人一台；2、 RBT-6T/S01S 机器人控制柜一台；3、 装有运动控制卡和控制软件的计算机一台。4.3 实验原理机器人的示教-再现过程是分为四个步骤进行的，它包括：机器人示教(teach programming)，就是操作者把规定的目标动作(包括每个运动部件，每个运动轴的动作)一步一步的教给机器人。示教的简繁，标志着机器人自动化水平的高低。记忆，即是机器人将操作者所示教的各个点的动作顺序信息、动作速
40、度信息、位姿信息等记录在存储器中。存储信息的形式、存储存量的大小决定机器人能够进行的操作的复杂程度。再现，便是将示教信息再次浮现，即根据需要，将存储器所存储的信息读出，向执行机构发出具体的指令。至于是根据给定顺序再现，还是根据工作情况，由机器人自动选择相应的程序再现这一功能的不同，标志着机器人对工作环境的适应性。操作，指机器人以再现信号作为输入指令，使执行机构重复示教过程规定的各种动作。在示教-再现这一动作循环中，示教和记忆是同时进行的；再现和操作也是同时进行的。这种方式是的机器人控制中比较方便和常用的方法之一。示教的方法有很多种，有主从式，编程式，示教盒式等多种。主从式既是由结构相同的大、小
41、两个机器人组成，当操作者对主动小机器人手把手进行操作控制的时候，由于两机器人所对应关节之间装有传感器，所以从动大机器人可以以相同的运动姿态完成所示教操作。编程式既是运用上位机进行控制，将示教点以程序的格式输入到计算机中，当再现时，按照程序语句一条一条的执行。这种方法除了计算机外，不需要任何其他设备，简单可靠，适用小批量、单件机器人的控制。示教盒和上位机控制的方法大体一致，只是由示教盒中的单片机代替了电脑，从而使示教过程简单化。这种方法由于成本较高，所以适用在较大批量的成型的产品中。哈尔滨工业大学博实精密测控有限责任公司第 23 页 共 44 页4.4 实验步骤1、 启动计算机，运行机器人软件；
42、2、 接通控制柜电源，按下“启动”按钮；3、 点击主界面“机器人复位”按钮，机器人进行回零运动。观察机器人的运动，六个关节全部运动完成后，机器人处于零点位置；4、 点击“关节示教”按钮，出现如图 4-1 所示界面；5、 在“速度”中选择示教速度(由左到右从低速到高速 1.5 度/秒、6 度/秒、12 度/秒、24 度/秒共四个挡，默认是 6 度/ 秒，一般情况下建议选择 12 度/秒) ；在“关节运动”中有每个关节的正反向运动，持续按下相应关节的按钮，机器人的关节会按照指令运动，松开相应的按钮，机器人的关节会停止运动；6、 在机器人“各关节状态”和“当前坐标”中，可以实时显示机器人的运动状态，
43、当每运动到一个点，必须按下“记录”按钮，在再现时机器人将忽略中间过程而只再现各个点，在“示教列表”中会记录并显示机器人相应关节运动的信息，继续运动其他关节，直到整个示教程序完成；图 4-1 关节示教界面7、 点击“保存”按钮，示教完的信息以(*.RBT)格式保存在示教文件中；8、 点击“再现”按钮，机器人按照记录的机器人关节信息再现一遍运动轨迹；9、 点击“清空”按钮会把示教列表全部清除。哈尔滨工业大学博实精密测控有限责任公司第 24 页 共 44 页10、 点击“退出”按钮，退出当前界面；11、 点击“机器人复位”按钮，使机器人回到零点位置；12、 按下控制柜上的“停止”按钮，断开控制柜电源
44、；13、 退出机器人软件，关闭计算机。4.5 思考题1、 通过实验总结机器人示教再现的概念；2、 试分析机器人的示教属于PTP(点到点)控制还是输入CP(连续轨迹)控制。思考题参考答案1、 示教，就是人把规定的动作(包括每个运动部件，每个运动轴的动作) 教给机器人，然后将示教的各种信息存储起来；再现，便是将上述示教信息再现，即根据需要，将存储的信息读出，向执行机构发出具体指令。2、 机器人的示教属于 PTP(点到点) 控制。4.6 注意事项1、 在老师的指导下进行实验；2、 机器人通电后，身体的任何部位不要进入机器人运动可达范围之内；3、 机器人运动不正常时，及时按下控制柜的急停开关。哈尔滨工
45、业大学博实精密测控有限责任公司第 25 页 共 44 页实验 5 机器人坐标系的建立5.1 实验目的1、 了解机器人建立坐标系的意义；2、 了解机器人坐标系的类型；3、 掌握用D-H方法建立机器人坐标系的步骤。5.2 实验设备1、 RBT-6T/S01S机器人一台；2、 RBT-6T/S01S机器人控制柜一台；3、 装有运动控制卡和控制软件的计算机一台。5.3 实验原理机器人通常是由一系列连杆和相应的运动副组合而成的空间开式链，实现复杂的运动，完成规定的操作。因此，机器人运动学描述的第一步，自然是描述这些连杆之间以及它们和操作对象(工件或工具 )之间的相对运动关系。假定这些连杆和运动副都是刚性
46、的，描述刚体的位置和姿态( 简称位姿) 的方法是这样的：首先规定一个直角坐标系，相对于该坐标系，点的位置可以用 3 维列向量表示；刚体的方位可用 33 的旋转矩阵来表示，而 44 的齐次变换矩阵则可将刚体位置和姿态(位姿 )的描述统一起来。机器人的每个关节坐标系的建立可参照以下的三原则：1） 轴沿着第 n 个关节的运动轴；1nz2） 轴垂直于 轴并指向离开 轴的方向；x1z1nz3） 轴的方向按右手定则确定。ny机器人坐标系建立的方法常用的是 D-H 方法，这种方法严格定义了每个关节的坐标系，并对连杆和关节定义了 4 个参数，如图 5-1。哈尔滨工业大学博实精密测控有限责任公司第 26 页 共
47、 44 页图 5-1 转动关节连杆四参数示意图机器人机械手是由一系列连接在一起的连杆（杆件）构成的。需要用两个参数来描述一个连杆，即公共法线距离 和垂直于 所在平面内两轴的夹角 ；需要另外两个iai i参数来表示相邻两杆的关系，即两连杆的相对位置 和两连杆法线的夹角 。idi除第一个和最后一个连杆外，每个连杆两端的轴线各有一条法线，分别为前、后相邻连杆的公共法线。这两法线间的距离即为 。我们称 为连杆长度， 为连杆扭角，iiai为两连杆距离， 为两连杆夹角。idi机器人机械手上坐标系的配置取决于机械手连杆连接的类型。有两种连接转动关节和棱柱联轴节。对于转动关节， 为关节变量。连杆 i 的坐标系
48、原点位于关节 i 和ii+1 的公共法线与关节 i+1 轴线的交点上。如果两相邻连杆的轴线相交于一点，那么原点就在这一交点上。如果两轴线互相平行，那么就选择原点使对下一连杆（其坐标原点已确定）的距离 为零。连杆 i 的 z 轴与关节 i+1 的轴线在一直线上，而 x 轴则在关1id节 i 和 i+1 的公共法线上，其方向从 i 指向 i+1，当两关节轴线相交时，x 轴的方向与两矢量的交积 平行或反向平行，x 轴的方向总是沿着公共法线从转轴 n 指向 i+1。iiz当两轴 和 平行且同向时，第 i 个转动关节的 为零。 1i i一旦对全部连杆规定坐标系之后，我们就能够按照下列顺序由两个旋转和两个
49、平移来建立相邻两连杆 i-1 与 i 之间的相对关系。绕 轴旋转 角，使 轴转到与 同一平面内。1izi1ixix沿 轴平移一距离 ，把 移到与 同一直线上。i idii沿 i 轴平移距离 ，把连杆 i-l 的坐标系移到使其原点与连杆 n 的坐标系原点重1ia合的地方。绕 轴旋转 角，使 转到与 同一直线上。1ixiizi这种关系可由表示连杆 i 对连杆 i-1 相对位置的四个齐次变换来描述，并叫做矩阵。此关系式为iA哈尔滨工业大学博实精密测控有限责任公司第 27 页 共 44 页（式 5-1）(,)(0,)(,0)(,)ii ii iARotzTransdransRotxa展开上式可得（式 5- 1001111 iiii iiiii dcssscc2）当机械手各连杆的坐标系被规定之后，就能够列出各连杆的常量参数。 对于跟在旋转关节 i 后的连杆，这些参数为 ， 和 。对于跟在棱柱联轴节 i 后的连杆来id1iai说，这些参数为 和
