机器人的方案设计书

1、ZHUZHOU PROFESSIONAL TECHNOLOGY COLLEGE毕业设计（论文）标 题：学生姓名：系 部: 专 业：班 级：指导教师：株洲职业技术学院教务处制摘要 I第一章机器人概述 1第二章机器人实验平台介绍及机械手的设计 32.1 基座及连杆 32.2 机械手的设计 42.3 驱动方式 52.4 传动方式 62.5 制动器 7第三章控制系统硬件93.1 控制系统模式的选择 93.2 控制系统的搭建 9第四章控制系统软件 124.1 预期的功能 124.2 实现方法 12结论 15参考文献 16后记 17在当今大规模制造业中，企业为提咼生产效率，保障产品质量，普 遍重视生产过程

2、的自动化程度，工业机器人作为自动化生产线上的重要 成员，逐渐被企业所认同并采用。工业机器人的技术水平和应用程度在 一定程度上反映了一个国家工业自动化的水平，目前，工业机器人主要 承担着焊接、喷涂、搬运以及堆垛等重复性并且劳动强度极大的工作， 工作方式一般采取示教再现的方式。本文将设计一台四自由度的工业机器人，用于给冲压设备运送物料 首先，本文将设计机器人的底座、大臂、小臂和机械手的结构，然后选 择合适的传动方式、驱动方式，搭建机器人的结构平台；在此基础上， 本文将设计该机器人的控制系统，包括数据采集卡和伺服放大器的选择、 反馈方式和反馈元件的选择、端子板电路的设计以及控制软件的设计， 重点加强

3、控制软件的可靠性和机器人运行过程的安全性，最终实现的目 标包括：关节的伺服控制和制动问题、实时监测机器人的各个关节的运 动情况、机器人的示教编程和在线修改程序、设置参考点和回参考点。关键词：机器人 编程伺服制动第一章机器人概述在现代工业中，生产过程的机械化、自动化已成为突出的主题。化工等连续性 生产过程的自动化已基本得到解决。但在机械工业中，加工、装配等生产是不连续 的。专用机床是大批量生产自动化的有效办法；程控机床、数控机床、加工中心等 自动化机械是有效地解决多品种小批量生产自动化的重要办法。但除切削加工本身 外，还有大量的装卸、搬运、装配等作业，有待于进一步实现机械化。机器人的出 现并得到

4、应用，为这些作业的机械化奠定了良好的基础。机器人是一种具有人体上肢的部分功能，工作程序固定的自动化装置。机器人 具有结构简单、成本低廉、维修容易的优势，但功能较少，适应性较差。目前我国 常把具有上述特点的机器人称为专用机器人，而把工业机械人称为通用机器人。简而言之，机器人就是用机器代替人手，把工件由某个地方移向指定的工作位 置，或按照工作要求以操纵工件进行加工。机器人一般分为三类。第一类是不需要人工操作的通用机器人，也即本文所研 究的对象。它是一种独立的、不附属于某一主机的装置，可以根据任务的需要编制 程序，以完成各项规定操作。它是除具备普通机械的物理性能之外，还具备通用机 械、记忆智能的三元

5、机械。第二类是需要人工操作的，称为操作机(Manipulator )它起源于原子、军事工业，先是通过操作机来完成特定的作业，后来发展到用无线 电讯号操作机器人来进行探测月球等。工业中采用的锻造操作机也属于这一范畴。 第三类是专业机器人，主要附属于自动机床或自动生产线上，用以解决机床上下料 和工件传送。这种机器人在国外通常被称之为“Mechanical Hand ”，它是为主机服务的，由主机驱动。除少数外，工作程序一般是固定的，因此是专用的。机器人按照结构形式的不同又可分为多种类型，其中关节型机器人以其结构紧 凑，所占空间体积小，相对工作空间最大，甚至能绕过基座周围的一些障碍物等这 样一些特点，

6、成为机器人中使用最多的一种结构形式，世界一些著名机器人的本体 部分都采用这种机构形式的机器人。要机器人像人一样拿取东西，最简单的基本条件是要有一套类似于指、腕、臂、 关节等部分组成的抓取和移动机构一一执行机构；像肌肉那样使手臂运动的驱动-传动系统；像大脑那样指挥手动作的控制系统。这些系统的性能就决定了机器人的 性能。一般而言，机器人通常就是由执行机构、驱动-传动系统和控制系统这三部 分组成，如图1.1所示：图1.1机器人的一般组成机器人的机械系统主要由执行机构和驱动-传动系统组成。执行机构是机器人 赖以完成工作任务的实体，通常由连杆和关节组成，由驱动一传动系统提供动力， 按控制系统的要求完成工

7、作任务。驱动-传动系统主要包括驱动机构和传动系统。 驱动机构提供机器人各关节所需要的动力，传动系统则将驱动力转换为满足机器人 各关节力矩和运动所要求的驱动力或力矩。有的文献则把机器人分为机械系统、驱 动系统和控制系统三大部分。其中的机械系统又叫操作机构(Ma nipulator)，相当于本文中的执行机构部分。第二章实验平台介绍及机械手的设计2.1基座及连杆基座基座是整个机器人本体的支撑。为保证机器人运行的稳定性，采用两块“z”字形实心铸铁作支撑。基座上面是接线盒子，所有电机的驱动信号和反馈信号都从中出入。接线盒子 外面，有一个引入线出口和一个引出线出口。2.1.2 大臂与小臂大臂长度230mm

8、具体尺寸如图2.1所示：图2.1大臂外形小臂长度240mm具体尺寸如图2.2所示：图2.2小臂外形2.2机械手的设计工业机器人的手又称为末端执行器，它使机器人直接用于抓取和握紧专用工具（如喷枪、扳手、焊具、喷头等）进行操作的部件。它具有模仿人手动作的功能， 并安装于机器人手臂的前端。由于被握工件的形状、尺寸、重量、材质及表面状态 等不同，因此工业机器人末端操作器是多种多样的，大致可分为以下几类：（1）夹钳式取料手（2）吸附式取料手（3）专用操作器及转换器（4）仿生多指灵巧手本文设计对象为物料搬运机器人，并不需要复杂的多指人工指，只需要设计能从不同角度抓取工件的钳形指。传动机构是向手指传递运动和

9、动力，以实现夹紧和松开动作的机构。根据手指开合的动作特点分为回转型和平移形。本文采用回转型传动机构。图2.3为初步设计的机械手机构简图（只画出了一半，另外一半关于中心线对称）。图2.3机械手机构简图在图2.3中，0为电机输出轴，曲柄 OA连杆AB滑块B和支架构成曲柄滑块 机构；滑块B连杆BC摇杆CE和支架构成滑块摇杆机构。通过两个机构串联，使 电机最终驱动DE的来回摆动，从而实现手指的开合运动。为便于手指的顺利合拢，可以在两个手指之间设置一个弹簧，这样还可以提供 适当的夹紧力2.3驱动方式机器人常用的驱动方式有液压驱动、气压驱动和电机驱动三种类型。这三种方法各有所长，各种驱动方式的特点见表2.

10、1 :表2.1三种驱动方式的特点对照内容驱动方式液压驱动气动驱动电机驱动输出功率很大，压力范围为 50140Pa大，压力范围为4860Pa,最大可达Pa较大控制性能利用液体的不 可压缩性，控制精 度较高，输出功率 大，可无级调速， 反应灵敏，可实现 连续轨迹控制气体压缩性大， 精度低，阻尼效果 差，低速不易控制， 难以实现咼速、咼 精度的连续轨迹控 制控制精度高，功 率较大，能精确定位， 反应灵敏，可实现咼 速、高精度的连续轨 迹控制，伺服特性好， 控制系统复杂结构性能及体积结构适当，执 行机构可标准化、 模拟化，易实现直 接驱动。功率/质量 比大，体积小，结 构紧凑，密封问题 较大结构适当，

11、执 行机构可标准化、 模拟化，易实现直 接驱动。功率/质量 比大，体积小，结 构紧凑，密封问题 较小伺服电动机易于 标准化，结构性能好， 噪声低，电动机一般 需配置减速装置，除 DD电动机外，难以直 接驱动，结构紧凑， 无密封问题安全性防爆性能较 好，用液压油作传 动介质，在一定条 件下有火灾危险防爆性能好， 高于 1000kPa（10 个 大气压）时应注意 设备的抗压性设备自身无爆炸 和火灾危险，直流有 刷电动机换向时有火 花，对环境的防爆性 能较差对环境的影响液压系统易漏油，对环境有污染排气时有噪声无机器人驱动系统各有其优缺点，通常对机器人的驱动系统的要求有：(1) 驱动系统的质量尽可能要

12、轻，单位质量的输出功率要高，效率也要高；(2 )反应速度要快，即要求力矩质量比和力矩转动惯量比要大，能够进行频繁 地起、制动，正、反转切换；(3 )驱动尽可能灵活，位移偏差和速度偏差要小；(4 )安全可靠；(5 )操作和维护方便；(6 )对环境无污染，噪声要小；(7 )经济上合理，尤其要尽量减少占地面积。基于上述驱动系统的特点和机器人驱动系统的设计要求，本文选用直流伺服电 机驱动的方式对机器人进行驱动。表 2.2为选定的各个关节电机型号及其相关参数表2.2机器人驱动电机参数电机参数腰关节肩关节肘关节腕关节手爪型号MAXON2332MAXON2332MAXON2332MULTIPLEXSTELL

13、-SERVOMULTIPLEXSTELL-SERVO额定电压18v18v18v6v6v额定转矩18.2 N m18.2 N m18.2 N m10.3 N m10.3 N m最大转矩67.4N m67.4N m67.4N m额定转速7980rpm7980rpm7980rpm5460rpm5460rpm最高转速9200rpm9200rpm9200rpm转子惯量18.4gcm cm18.4gcm cm18.4gcm cm2.4传动方式由于一般的电机驱动系统输出的力矩较小，需要通过传动机构来增加力矩，提 高带负载能力。对机器人的传动机构的一般要求有：(1) 结构紧凑，即具有相同的传动功率和传动比时体

14、积最小，重量最轻；(2) 传动刚度大，即由驱动器的输出轴到连杆关节的转轴在相同的扭矩时角度 变形要小，这样可以提高整机的固有频率，并大大减轻整机的低频振动;(3) 回差要小，即由正转到反转时空行程要小，这样可以得到较高的位置控制 精度；(4) 寿命长、价格低。本文所选用的电机都采用了电机和齿轮轮系一体化的设计，结构紧凑，具有很 强的带负载能力，但是不能通过电机直接驱动各个连杆的运动。为减小机构运行过 程的冲击和振动，并且不降低控制精度，采用了齿形带传动。齿形带传动是同步带的一种，用来传递平行轴间的运动或将回转运动转换成直 线运动，在本文中主要用于腰关节、肩关节和肘关节的传动。齿轮带的传动比计算

15、公式为压 Ziini Z2齿轮带的平均速度Va为va 二 z1 t 口 = z2 t n22.5制动器制动器及其作用：制动器是将机械运动部分的能量变为热能释放，从而使运动 的机械速度降低或者停止的装置，它大致可分为机械制动器和电气制动器两类。在机器人机构中，需要使用制动器的情况如下：(1) 特殊情况下的瞬间停止和需要采取安全措施；(2) 停电时，防止运动部分下滑而破坏其他装置。机械制动器有螺旋式自动加载制动器、盘式制动器、闸瓦式制动器和电磁制动 器等几种。其中最典型的是电磁制动器。在机器人的驱动系统中常使用伺服电动机，伺服电机本身的特性决定了电磁制 动器是不可缺少的部件。从原理上讲，这种制动器

16、就是用弹簧力制动的盘式制动器, 只有励磁电流通过线圈时制动器打开，这时制动器不起制动作用，而当电源断开线 圈中无励磁电流时，在弹簧力的作用下处于制动状态的常闭方式。电动机是将电能转换为机械能的装置，反之，它也具有将旋转机械能转换为电 能的发电功能。换言之，伺服电机是一种能量转换装置，可将电能转换为机械能， 同时也能通过其反过程来达到制动的目的。但对于直流电机、同步电机和感应电机 等各种不同类型的电机，必须分别采用适当的制动电路。本文中，该机器人实验平台未安装机械制动器，因此机器人的肩关节和轴关节 在停止转动的时候，会因为重力因素而下落。另外，由于各方面限制，不方便在原 有机构上添加机械制动器，

17、所以只能通过软件来实现肩关节和轴关节的电气制动。采用电气制动器，其优点在于：在不增加驱动系统质量的同时又具有制动功能, 这是非常理想的情况，而在机器人上安装机械制动器会使质量有所增加，故应尽量 避免。缺点在于：这种方法不如机械制动器工作可靠，断电的时候将失去制动作用。第三章控制系统硬件3.1控制系统模式的选择构建机器人平台的核心是建立机器人的控制系统。首先需要选择和硬件平台， 控制系统硬件平台对于系统的开放性、实现方式和开发工作量有很大的影响。一般 常用的控制系统硬件平台应满足：硬件系统基于标准总线机构，具有可伸缩性；硬 件结构具有必要的实时计算能力；硬件系统模块化，便于添加或更改各种接口、传

18、 感器和特殊计算机等；低成本。到目前为止，一般机器人控制系统的硬件平台可以 大致分为两类：基于 VME总线(由Motorola公司1981年推出的第一代32位工业开 放标准总线)的系统和基于 PC总线的系统。基于PC机控制系统一般包括单PC控制 模式，PC+PC勺控制模式，PC+分布式控制器的控制模式，PC+DS运动控制卡的控制 模式，PC+数据采集卡的控制模式，由于基于采集卡的控制方式灵活，成本低廉，有 利于本文设计中的废物利用，在程序和算法上可以自主编制各类算法，适合本课题 研究的需要。3.2控制系统的搭建工控机在此选用研华工业控制机,主频233MHz内存128兆，32位数据总线。底板有9

19、 个ISA插槽，4个PCI插槽，带VGA显示器。其性能价格比优越，兼容性好，有利于 软硬件维护和升级。与普通个人计算机相比工业控制PC机有以下优点：(1) 芯片筛选要比一般个人计算机严格；(2) 芯片驱动能力较强；(3) 整机内部结构属于工业加强型，具有较强的防震和抗干扰性能；(4) 对环境(如温度、湿度、灰尘等)的要求要比一般计算机低得多。伺服放大器在驱动系统设计过程中，主要是对伺服电机的驱动，本文中利用报废机器人上 的电机驱动关节，因此同样选用伺服电机驱动器进行驱动，这是专门针对电机设计的伺服电机放大控制器，具有很强的控制功能和稳定性，电源电压12-30v之间，1、2接线端子接伺服电机，直

20、接给电机供电，3，4接线端与电源相连，7、8接控制电 压，通过数据采集卡输出的模拟电压信号进入这两个接线端来控制电机的转速大小 和正反转，13、14接测速计（本文中未用），3、4、10之间是一个光耦合器，输入“准备好”信号。在伺服控制器前面，有 5个旋钮调节器涌来调节电机的五个参数，下边有10个DIP开关，用来选择控制器工作状态。如图 3.1所示：Pl h nmaxP2 F I x RP3 OffsetP4maxP5 gainon off1 -I2 _3 '44 65 .6 7 8 电源0000-.12 3456789012)00000000电机控制电压测速计图3.1伺服放大器接线及其

21、调节示意端子板不同的被测信号通过不同的传送路线到采集卡，而采集卡在工控机机箱内，不 变直接连接到工业系统中的各种传感器或执行器。端子板的主要作用有两个：（1）端子板是采集卡与每一个信号调理电路或驱动装置之间的电器连接部件， 给每一路输入、输出信号提供单独的信号线和地线，使每一路通道可单独接通或断 开，系统检修和排除故障时不必全部停止运行。（2）将每一路信号经过各自的传送路线到达端子板后，可以根据各路信号和传 送路线的特点，在端子板上对各路信号进行简单的调理，如经电阻衰减、分流或经 过RC低通滤波后进入采集卡。图3.2所示为端子板电路:接电源14V接电源10V图3.3所示的电路图中，为防止直流电

22、机产生的噪声影响电路的正常运行，使 用了光电耦合器4N25在机电一体化技术中，光电耦合电路是重要的接口电路。 3.2.4 电位器及电源电位器是一种可调电阻，也是电子电路中用途最广泛的元器件之一。它对外有 三个引出端，其中两个为固定端，另一个是中心抽头。转动或调节电位器转动轴， 其中心抽头与固定端之间的电阻将发生变化。从理论上来讲，电位器应该是线性的 测量元件，但由于电位器的滑动噪声以及滑线电阻的工作过程中的磨损，这种函数 关系并非理想的线性关系，而是存在一定的偏移。电位器和伺服放大器都需要一定的电压，特别是电位计是在10.0V的条件下工作的，稳定的电压对于保证电位计反馈信号的真实性具有重大的影

23、响；而伺服放大 器是在12v-30v范围内工作的，电压只要在此范围内即可。本文采用DH1715A-3型双路稳压稳流电源，可以提供 0-32v电压输出和0-2A 电流输出第四章控制系统软件4.1预期的功能(1) 实时显示各个关节角，并且可以防止各个关节的运动角度超出预定的关 节角范围内；(2) 实现直流电机的伺服控制；(3) 实现电机的自锁；(4) 实现示教编程及在线修改程序；(5) 可以设置参考点，使机器人在空间有一个固定的参考位置，可以回参考 点。4.2实现方法以模块化程序设计思想为指导，以预期要实现的功能作为各个模块，设计控制 软件。从图3.1可以看出，工控机通过数据采集控制。编程的任务其

24、实就是用计算机控 制数据采集卡使之发出或获取一系列数字量、模拟量。研华公司的数据采集卡驱动程序中，附带许多与板卡相关的函数和数据结构以 供使用，极大的方便了程序编写。本文采用了 Visual C+作为编程工具。电机的自锁前面在2.5节中讲到该机器人关节上未装制动器，所以必须通过软件程序实现 关节的自锁，尤其是肩关节和肘关节的自锁。解决思路：大臂和小臂在电机运转时不会由于重力而掉落，在电机停止的时候 却会下落，因为电机一旦停止，就失去了驱动力矩，因此若想让大臂和小臂停止在 预定位置，应该在此位置给关节电机施加一个电压，让它担负起大臂或小臂，而不 让其由于重力而下落。但是，在不同的位置，重力对大臂

25、或小臂的力矩不同，应提 供给电机的电压也不同。程序设计方法：本方法采用传统的PID控制，电压超调后还可以减小，可以避免反弹现象的发 生。下图为程序流程图，如图3.4所示：图3.4程序流程图对于本方法，其控制框图如图3.5所示：图3.5控制框图422编程及在线修改程序设计方法：当机器人停止在某个位置时，可以记录下在该位置所对应的一组关 节角，这一组关节角用一个结构体存储。struct positi onfloat Voltagel;float Voltage2;float Voltage3;float Voltage4;float Voltage5;struct positi on *n ext

26、;记录的位置同时显示在列表框中，记录位置不超过1000个。当记录结束以后，就可以运行刚才记录的一系列位置了，由于采用链表结构存 储程序，所以取用这些程序很方便，只需用一个指针从链表首部开始取程序，逐行 运行，至到链表末尾即可。程序运行的时候，机器人各个关节同时运动，工作效率高；正在运行的那行程 序，以咼亮状态显示。结论1、完成的工作（1）对实验平台的改造本文利用的是报废的焊接机器人，要改造成送料机器人，不但要对末端 执行机构进行重新设计，还要重新布线。（2）对关节轴电位器进行重新标定由于标定电压不同，标定曲线和所得的函数关系就不同，本文选用的是 10v电压。（3）设计端子板电路及驱动电路端子板是计算机、板卡控制信号端与机器人电路端的“桥梁”，承担着信 号调理、驱动