三自由度机械手臂设计说明书讲解

SHANDONGＵＮＩＶＥＲＳＩＴＹＯＦＴＥＣＨＮＯＬＯＧＹ
课程设计说明书
三自由度机械手臂设计
学院：农业工程与食品科学学院
专业：农业机械化及其自动化
学生姓名：赵国0911034036
学生姓名：李继飞0911034030
学生姓名：程小岩0912034039
指导教师：程卫东
2013 年1 月
摘要
在当今大规模制造业中，企业为提高生产效率，保障产品质量，普遍重视生产过程的自动化程度，工业机器人作为自动化生产线上的重要成员，逐渐被企业所认同并采用。

工业机器人的技术水平和应用程度在一定程度上反映了一个国家工业自动化的水平，目前，工业机器人主要承担着焊接、喷涂、搬运以及堆垛等重复性并且劳动强度极大的工作，工作方式一般采取示教再现的方式。

本文将设计一台四自由度的工业机器人，用于给冲压设备运送物料。

首先，本文将设计机器人的底座、大臂、小臂和机械手的结构，然后选择合适的传动方式、驱动方式，搭建机器人的结构平台；在此基础上，本文将设计该机器人的控制系统，包括数据采集卡和伺服放大器的选择、反馈方式和反馈元件的选择、端子板电路的设计以及控制软件的设计，重点加强控制软件的可靠性和机器人运行过程的安全性，最终实现的目标包括：关节的伺服控制和制动问题、实时监测机器人的各个关节的运动情况、机器人的示教编程和在线修改程序、设置参考点和回参考点。

目录
第1章绪论 (5)
1.1 机器人概述 (5)
第2章机器人实验平台介绍及机械手的设计 (6)
2.1自由度及关节 (6)
2.2 基座及连杆 (6)
2.2.1 基座 (6)
2.2.2 机械臂 (6)
2.3 机械手的设计 (6)
2.4 驱动方式 (8)
2.5 传动方式 (9)
2.6 制动器 (10)
第3章控制系统硬件 (11)
3.1 控制系统模式的选择 (11)
3.2 控制系统的搭建 (11)
3.2.1 工控机 (12)
3.2.2 数据采集卡 (12)
3.2.3 伺服放大器 (13)
3.2.4 端子板 (14)
3.2.5电位器及其标定 (15)
3.2.6电源 (16)
第4章控制系统软件 (16)
4.1预期的功能 (16)
4.2 实现方法 (16)
4.2.1实时显示各个关节角及运动范围控制 (16)
4.2.2直流电机的伺服控制 (16)
4.2.3电机的自锁 (16)
4.2.4示教编程及在线修改程序 (17)
第5章总结 (18)
5.1 所完成的工作 (18)
5.2 设计经验 (18)
参考文献 (20)
第1章绪论
1.1 机器人概述
在现代工业中，生产过程的机械化、自动化已成为突出的主题。

化工等连续性生产过程的自动化已基本得到解决。

但在机械工业中，加工、装配等生产是不连续的。

专用机床是大批量生产自动化的有效办法；程控机床、数控机床、加工中心等自动化机械是有效地解决多品种小批量生产自动化的重要办法。

但除切削加工本身外，还有大量的装卸、搬运、装配等作业，有待于进一步实现机械化。

机器人的出现并得到应用，为这些作业的机械化奠定了良好的基础。

“工业机器人”（Industrial Robot）：多数是指程序可变（编）的独立的自动抓取、搬运工件、操作工具的装置（国内称作工业机器人或通用机器人）。

机器人是一种具有人体上肢的部分功能，工作程序固定的自动化装置。

机器人具有结构简单、成本低廉、维修容易的优势，但功能较少，适应性较差。

目前我国常把具有上述特点的机器人称为专用机器人，而把工业机械人称为通用机器人。

简而言之，机器人就是用机器代替人手，把工件由某个地方移向指定的工作位置，或按照工作要求以操纵工件进行加工。

机器人一般分为三类。

第一类是不需要人工操作的通用机器人，也即本文所研究的对象。

它是一种独立的、不附属于某一主机的装置，可以根据任务的需要编制程序，以完成各项规定操作。

它是除具备普通机械的物理性能之外，还具备通用机械、记忆智能的三元机械。

第二类是需要人工操作的，称为操作机（Manipulator）。

它起源于原子、军事工业，先是通过操作机来完成特定的作业，后来发展到用无线电讯号操作机器人来进行探测月球等。

工业中采用的锻造操作机也属于这一范畴。

第三类是专业机器人，主要附属于自动机床或自动生产线上，用以解决机床上下料和工件传送。

这种机器人在国外通常被称之为“Mechanical Hand”，它是为主机服务的，由主机驱动。

除少数外，工作程序一般是固定的，因此是专用的。

机器人按照结构形式的不同又可分为多种类型，其中关节型机器人以其结构紧凑，所占空间体积小，相对工作空间最大，甚至能绕过基座周围的一些障碍物等这样一些特点，成为机器人中使用最多的一种结构形式，世界一些著名机器人的本体部分都采用这种机构形式的机器人。

第2章实验平台介绍及机械手的设计该设计的目的是为了设计一台物料搬运机器人，利用现有已经报废的焊接机器人，本文的中结构设计主要偏向于对原有机构的改造和机械手的设计。

2.1自由度及关节
该机器人具有三个自由度，即腰关节、肩关节、肘关节，都为转动关节；
还有一个用于夹持物料的机械手。

2.2基座及连杆
2.2.1 基座
基座是整个机器人本体的支撑。

为保证机器人运行的稳定性，采用两块“Z”字形实心铸铁作支撑。

基座上面是接线盒子，所有电机的驱动信号和反馈信号都从中出入。

接线盒子外面，有一个引入线出口和一个引出线出口。

2.2.2 机械臂
大臂长度230mm 小臂长度240mm
2.3机械手的设计
工业机器人的手又称为末端执行器，它使机器人直接用于抓取和握紧（吸附）专用
工具（如喷枪、扳手、焊具、喷头等）进行操作的部件。

它具有模仿人手动作的功能，并安装于机器人手臂的前端。

由于被握工件的形状、尺寸、重量、材质及表面状态等不同，因此工业机器人末端操作器是多种多样的，大致可分为以下几类：
（1）夹钳式取料手
（2）吸附式取料手
（3）专用操作器及转换器
（4）仿生多指灵巧手
本文设计对象为物料搬运机器人，并不需要复杂的多指人工指，只需要设计能从不同角度抓取工件的钳形指。

手指是直接与工件接触的部件。

手指松开和夹紧工件，是通过手指的张开与闭合来实现的。

该设计采用两个手指，其外形如图2.3所示
图2.1 机械手手指形状
传动机构是向手指传递运动和动力，以实现夹紧和松开动作的机构。

根据手指开合的动作特点分为回转型和平移形。

本文采用回转型传动机构。

图2.4为初步设计的机械手机构简图（只画出了一半，另外一半关于中心线对称）。

图2.2 机械手机构简图
在图2.4中，O为电机输出轴，曲柄OA、连杆AB、滑块B和支架构成曲柄滑块机构；滑块B、连杆BC、摇杆CE和支架构成滑块摇杆机构。

通过两个机构串联，使电机最终驱动DE的来回摆动，从而实现手指的开合运动。

图2.4中的黑线和蓝线表示机构运行的两个极限位置。

为便于手指的顺利合拢，可以在两个手指之间设置一个弹簧，这样还可以提供适当的夹紧力。

另外，在选用电机的时候，要使电机的功率足以克服弹簧的收缩和张开，并且提供足够加紧物体的力。

2.4驱动方式
该机器人一共具有四个独立的转动关节，连同末端机械手的运动，一共需要五个动力源。

机器人常用的驱动方式有液压驱动、气压驱动和电机驱动三种类型。

机器人驱动系统各有其优缺点，通常对机器人的驱动系统的要求有：1）．驱动系统的质量尽可能要轻，单位质量的输出功率要高，效率也要高；2）．反应速度要快，即要求力矩质量比和力矩转动惯量比要大，能够进行频繁地起、制动，正、反转切换；
3）．驱动尽可能灵活，位移偏差和速度偏差要小；
4）．安全可靠；
5）．操作和维护方便；
6）．对环境无污染，噪声要小；
7）．经济上合理，尤其要尽量减少占地面积。

基于上述驱动系统的特点和机器人驱动系统的设计要求，本文选用直流伺服电机驱动的方式对机器人进行驱动。

表2.2为选定的各个关节电机型号及其相关参数。

表2.1机器人驱动电机参数
电机
参数
腰关节肩关节肘关节腕关节手爪
型号
MAXO
N2332
MAXO
N2332
MAXO
N2332
MULTIP
LEX
STELL-
MULTIP
LEX
STELL-
SERVO SERVO 额定
电压
18v 18v 18v 6v 6v
额定转矩
18.2
N·m
18.2
N·m
18.2
N·m
10.3
N·m
10.3
N·m
最大转矩
67.4
N·m
67.4
N·m
67.4
N·m
额定转速
7980
rpm
7980
rpm
7980
rpm
5460rp
m
5460rp
m
最高转速转子惯量
9200
rpm
18.4
gcm·cm
9200
rpm
18.4
gcm·cm
9200
rpm
18.4
gcm·cm
2.5传动方式
由于一般的电机驱动系统输出的力矩较小，需要通过传动机构来增加力矩，提高带负载能力。

对机器人的传动机构的一般要求有：
（1）结构紧凑，即具有相同的传动功率和传动比时体积最小，重量最轻；
（2）传动刚度大，即由驱动器的输出轴到连杆关节的转轴在相同的扭矩时角度变形要小，这样可以提高整机的固有频率，并大大减轻整机的低频振动；
（3）回差要小，即由正转到反转时空行程要小，这样可以得到较高的位置控制精度；
（4）寿命长、价格低。

本文所选用的电机都采用了电机和齿轮轮系一体化的设计，结构紧凑，具有很强的带负载能力，但是不能通过电机直接驱动各个连杆的运动。

为减小机构运行过程的冲击和振动，并且不降低控制精度，采用了齿形带传动。

齿形带传动是同步带的一种，用来传递平行轴间的运动或将回转运动转换成直线运动，在本文中主要用于腰关节、肩关节和肘关节的传动。

齿形带传动原理如图2.7所示。

齿轮带的传动比计算公式为
2
112z z n n i ==
齿轮带的平均速度a v 为
2211n t z n t z v a ⋅⋅=⋅⋅=
2.6制动器
制动器及其作用：
制动器是将机械运动部分的能量变为热能释放，从而使运动的机械速度降低或者停止的装置，它大致可分为机械制动器和电气制动起两类。

在机器人机构中，学要使用制动器的情况如下： ① 特殊情况下的瞬间停止和需要采取安全措施 ② 停电时，防止运动部分下滑而破坏其他装置。

机械制动器：
机械制动器有螺旋式自动加载制动器、盘式制动器、闸瓦式制动器和电磁制动器等几种。

其中最典型的是电磁制动器。

在机器人的驱动系统中常使用伺服电动机，伺服电机本身的特性决定了电磁制动器是不可缺少的部件。

从原理上讲，这种制动器就是用弹簧力制动的盘式制动器，只有励磁电流通过线圈时制动器打开，这时制动器不起制动作用，而当电源断开线圈中无励磁
电流时，在弹簧力的作用下处于制动状态的常闭方式。

因此
这种制动器被称为无励磁动作型电磁制动器。

又因为这种制动器常用于安全制动场合，所以也称为安全制动器。

电气制动器
电动机是将电能转换为机械能的装置，反之，他也具有将旋转机械能转换为电能的发电功能。

换言之，伺服电机是一种能量转换装置，可将电能转换为机械能，同时也能通过其反过程来达到制动的目的。

但对于直流电机、同步电机和感应电机等各种不同类型的电机，必须分别采用适当的制动电路。

本文中，该机器人实验平台未安装机械制动器，因此机器人的肩关节和轴关节在停止转动的时候，会因为重力因素而下落。

另外，由于各方面限制，不方便在原有机构上添加机械制动器，所以只能通过软件来实现肩关节和轴关节的电气制动。

采用电气制动器，其优点在于：在不增加驱动系统质量的同时又具有制动功能，这是非常理想的情况，而在机器人上安装机械制动器会使质量有所增加，故应尽量避免。

缺点在于：这种方法不如机械制动器工作可靠，断电的时候将失去制动作用。

第3章控制系统硬件
3.1 控制系统模式的选择
构建机器人平台的核心是建立机器人的控制系统。

首先需要选择和硬件平台，控制系统硬件平台对于系统的开放性、实现方式和开发工作量有很大的影响。

一般常用的控制系统硬件平台应满足：硬件系统基于标准总线机构，具有可伸缩性；硬件结构具有必要的实时计算能力；硬件系统模块化，便于添加或更改各种接口、传感器和特殊计算机等；低成本。

到目前为止，一般机器人控制系统的硬件平台可以大致分为两类：基于VME总线（Versamodel Eurocard由Motorola公司1981年推出的第一代32位工业开放标准总线）的系统和基于PC总线的系统。

近年来，随着PC机性能的快速发展，可靠性大为提高，价格却大幅度降低，以PC机为核心的控制系统已广泛被机器人控制领域所接受。

基于PC机控制系统一般包括单PC控制模式，PC+PC的控制模式，PC+分布式控制器的控制模式，PC+DSP运动控制卡的控制模式，PC+数据采集卡的控制模式，由于基于采集卡的控制方式灵活，成本低廉，有利于本文设计中的废物利用，在程序和算法上可以自主编制各类算法，适合本课题研究的需要。

因此本文选定PC+数据采集卡的控制方式。

3.2控制系统的搭建
图3.1 控制系统框图
3.2.1工控机
在此选用研华工业控制机,主频233MHz,内存128兆，32位数据总线。

底板有9个ISA插槽，4个PCI插槽，带VGA显示器。

其性能价格比优越，兼容性好，有利于软硬件维护和升级。

与普通个人计算机相比工业控制PC机有以下优点：·芯片筛选要比一般个人计算机严格；
·芯片驱动能力较强；
·整机内部结构属于工业加强型，具有较强的防震和抗干扰性能；
·对环境（如温度、湿度、灰尘等）的要求要比一般计算机低得多。

3.2.2数据采集卡
在本设计中我们主要用到研华公司的PCL812PG和PCL726，其参数如下。

PCL-812PG
主要特点：
路单端12位模拟量输入
路12位模拟量输出
采样速率可编程，最快达30KHz
带DMA或中断的A/D
路数字量输出
PCL-726
主要特点：
路独立D/A输出
位分辨率双缓冲D/A转换器
路数字量输入及16路数字量输出
多种电压范围：+/-10V，+/-5V，0—+5V，0—+10V和4—20mA电流环。

3.2.3伺服放大器
在驱动系统设计过程中，主要是对伺服电机的驱动，本文中利用报废机器人上的maxon电机驱动关节，因此同样选用maxon伺服电机驱动器（maxon motor control4-Q-DC Servo Control LSC 30/2）进行驱动，如图3.2所示，这是专门针对maxon 电机设计的伺服电机放大控制器，具有很强的控制功能和稳定性，电源电压12~30v之
间，1、2接线端子接伺服电机，直接给电机供电，3，4接线端与电源相连，7、8接控制电压，通过数据采集卡输出的模拟电压信号进入这两个接线端来控制电机的转速大小和正反转，13、14接测速计（本文中未用），3、4、10之间是一个光耦合器，输入“准备好”信号。

在伺服控制器前面，有5个旋钮调节器涌来调节电机的五个参数，下边有10个DIP 开关，用来选择控制器工作状态。

12345678910111213141516电源控制电压测速计
1
2
3
4
5
6
7
8
9
10P 1P 2P 3P 4P 5gain
n max
I ×R
Offset
on
off I max
4k Ω电机
图3.2伺服放大器接线及其调节示意
3.2.4端子板
不同的被测信号通过不同的传送路线到采集卡，而采集卡在工控机机箱内，不变直接连接到工业系统中的各种传感器或执行器。

端子板的主要作用有两个：
①．端子板是采集卡与每一个信号调理电路或驱动装置之间的电器连接部件，给每一路输入、输出信号提供单独的信号线和地线，使每一路通道可单独接通或断开，系统检修和排除故障时不必全部停止运行。

②．将每一路信号经过各自的传送路线到达端子板后，可以根据各路信号和传送路线的特点，在端子板上对各路信号进行简单的调理，如经电阻衰减、分流或经过RC 低通滤波后进入采集卡。

图3.3所示为端子板电路
图3.3端子板电路
图3.3所示的电路图中，为防止直流电机产生的噪声影响电路的正常运行，使用了光电耦合器4N25。

在机电一体化技术中，光电耦合电路是重要的接口电路。

其中PCL-812PG通过五路数字量输出来控制电机电路的通断，PCL-726通过五路模拟量输出来控制电机的正反转和运行速度，另外PCL-812PG还负责采集五个电位器的电压，以此将电机的运行角度反馈给计算机。

3.2.5电位器及其标定
电位器是一种可调电阻，也是电子电路中用途最广泛的元器件之一。

它对外有三个引出端，其中两个为固定端，另一个是中心抽头。

转动或调节电位器转动轴，其中心抽头与固定端之间的电阻将发生变化。

本文采用的电位器是单圈的，也就是说各关节的运动角度小于360º，对于该机器人已经足够了。

电位器安装在机器人的各个关节输出轴上，所以在关节角的运动范围内，电位计的输出电压和关节角是一一对应的，存在着一定的函数关系。

从理论上来讲，电位器应该是线性的测量元件，但由于电位器的滑动噪声以及滑线
电阻的工作过程中的磨损，这种函数关系并非理想的线性关系，而是存在一定的偏移。

电位器的标定就是根据在各个角度处测量的电压值，拟合出一条直线，近似替代真实的函数关系。

3.2.6电源
电位器和伺服放大器都需要一定的电压，特别是电位计是在10.0v的条件下工作的，稳定的电压对于保证电位计反馈信号的真实性具有重大的影响；而伺服放大器是在
12v~30v范围内工作的，电压只要在此范围内即可。

本文采用DH1715A-3型双路稳压稳流电源，可以提供0~32v电压输出和0~2A电流输出。

这里设定两路电压输出：14.0v——供给伺服放大器运行，10.0v——保证电位计的正常工作。

第4章控制系统软件
以上完成了机器人的本体设计和控制系统硬件的搭建，下面将通过设计控制软件，使计算机通过数据采集卡有条不紊地向外部发送指挥信号，最终驱动机器人各个关节的运动，使之按照人的意愿“工作”。

4.1预期的功能
（1）. 实时显示各个关节角，并且可以防止各个关节的运动角度超出预定的关节角范围内；
（2）. 实现直流电机的伺服控制；
（3）. 实现电机的自锁；
（4）. 实现示教编程及在线修改程序；
4.2 实现方法
以模块化程序设计思想为指导，以预期要实现的功能作为各个模块，设计控制软件。

从图3.1可以看出，工控机通过数据采集控制。

编程的任务其实就是用计算机控制数据采集卡使之发出或获取一系列数字量、模拟量。

研华公司的数据采集卡驱动程序中，附带许多与板卡相关的函数和数据结构以供使用，极大的方便了程序编写。

本文采用了Visual C++作为编程工具。

4.2.1实时显示各个关节角及运动范围控制
在BOOL CRobotDlg::OnInitDialog()函数中，
设置定时器SetTimer(1, gwScanTime, NULL)，
然后在void CRobotDlg::OnTimer(UINT nIDEvent)函数中，
通过调用bool CRobotDlg::position_now(USHORT ka1_chan)，采样电位器输出电压，通过前面的电位器标定函数，换算出各个关节的角度，并显示出来。

在void CRobotDlg::OnChangeAngle?Edit()函数中（?表示1，2，3，4，5），
将换算出的角度与该关节预设的运动范围作比较，看其是否在此区间内，否则弹出警告对话框，并且自动停止该关节的运动。

4.2.2直流电机的伺服控制
对于大功率的直流电机，一般采用PWM控制来调节运行速度，这样可以提高电路及电机的运行效率，而本文中的电机功率并不是很大，为方便期间，采用了线性控制方法来调速。

以关节1为例，与该模块相关的函数有OnZ1Button(), OnF1Button(), OnT1Button()，它们分别表示用来控制电机的正转、反转和停止，其中电机的运行速度靠输入的电压值调节；另外一个函数OnRun1Button()是用来实现电机的位置伺服控制，在预定的关节角范围内，电机可以运行到任何一输入的位置停止。

4.2.3电机的自锁
前面在2.7节中讲到该机器人关节上未装制动器，所以必须通过软件程序实现关节的自锁，尤其是肩关节和肘关节的自锁。

解决思路：大臂和小臂在电机运转时不会由于重力而掉落，在电机停止的时候却会下落，因为电机一旦停止，就失去了驱动力矩，因此若想让大臂和小臂停止在预定位置，应该在此位置给关节电机施加一个电压，让它担负起大臂或小臂，而不让其由于重力而下落。

但是，在不同的位置，重力对大臂或小臂的力矩不同，应提供给电机的电压也不同，如何选取电机的电压呢？
提供给电机的电压小了，不足以抵抗重力的力矩；提供给电机的电压大了，会使电机转动，使大臂或小臂上升；所以，最好能通过程序来自适应选择这个制动电压，方法
有多种，下面是本文的设计过程。

在调用在OnT2Button()或OnT3Button()函数时，先给电机一个0电压，使电机失去驱动力矩，同时调用position_now(USHORT ka1_chan)函数获得此刻的关节位置，然后延时一段时间比如0.1s，再给电机一个小电压，形成一个小的制动力矩，通过采样此刻位置看其是否能使关节制动；如果不能，则使该电压值按照一定的步长线性增加，以增大制动力矩；这通过一个while()循环实现，如果采样位置不再减小，则表示大臂或小臂已停止下落，可跳出循环。

下图为程序流程图：
调用OnT2Button()或OnT3Button()
使电机电压为0，并采样此时位置，将电位器
输出值存放在fV oltage_former中
考虑到大臂或小臂上升时的惯性，
循环采样一直到采样值
fV oltage<=fV oltage_former
循环采样一直到采样值
fV oltage>=fV oltage_former
跳出循环，表示大臂或小臂已经制动在
自所位置了
4.2.4示教编程及在线修改程序
设计方法：当机器人停止在某个位置时，可以记录下在该位置所对应的一组关节角，这一组关节角用一个结构体存储
struct position
float V oltage1;
float V oltage2;
float V oltage3;
float V oltage4;
float V oltage5;
struct position *next;
记录的位置同时显示在列表框中，记录位置不超过1000个。

为了便于对这些位置作修改，本文采用链表来动态存储这些结构体。

当记录结束以后，就可以运行刚才记录的一系列位置了，由于采用链表结构存储程序，所以取用这些程序很方便，只需用一个指针从链表首部开始取程序，逐行运行，至到链表末尾即可。

程序运行的时候，机器人各个关节同时运动，工作效率高；正在运行的那行程序，以高亮状态显示。

另外，对于记录的位置可以做删除、清空等操作。

第5章总结
5.1 所完成的工作
（1）对实验平台的改造
本文利用的是报废的焊接机器人，要改造成送料机器人，不但要对末端执行机构进行重新设计，还要重新布线。

（2）对关节轴电位器进行重新标定
由于标定电压不同，标定曲线和所得的函数关系就不同，本文选用的是10v电压。

（3）设计端子板电路及驱动电路
端子板是计算机、板卡控制信号端与机器人电路端的“桥梁”，承担着信号调理、驱动放大等任务。

（4）控制软件的设计
软件是机器人的“大脑思维”，软件的设计就是将人的意志赋予机器人的“大脑”。

5.2 设计经验
（1）底座设计成长方体不合理
当腰关节在不同的位置时，肩关节运动的下限不同，不便于编程；最好将底座设计成圆柱体，并且下面带有法兰支撑。

（2）最好安装机械制动装置。