scara机器人运动控制系统设计Word格式文档下载.docx
《scara机器人运动控制系统设计Word格式文档下载.docx》由会员分享，可在线阅读，更多相关《scara机器人运动控制系统设计Word格式文档下载.docx（47页珍藏版）》请在冰点文库上搜索。
5.2 机器人关键零部件设计 33
5.3 大臂和小臂机械结构设计 33
5.4 腕部机械结构设计 33
5.4.1 滚珠丝杠部分 33
5.4.2 主轴部分 34
5.4.3 其它设计 34
6 硬件设计与选型 35
6.1 机器人关键零部件的选型 35
6.1.1 步进电机的计算和选择 35
6.1.2 同步带的选择计算 36
6.1.3 滚珠丝杠的选型设计及计算 38
6.2 运动控制系统的硬件 41
6.2.1 运动控制卡选择 41
6.2.2 步进电机驱动器的选择 41
7 软件设计及系统集成 43
7.1 运动控制卡的编程 43
7.2 系统控制软件的设计 43
7.2.1 控制系统主要模块 43
7.2.2 控制系统软件的VC实现 43
参考文献 45
附录 46
自述
经过了半个学期大约八周的机器人控制课程的学习，说真心话，对自己的表现不是很满意，未能理解机器人控制技术的精髓，甚至于说连皮毛都没有。
在学期末老师布置的作业中，在有限的时间里，面对着一个完全生疏的领域，说实话，自己是不知所措的，不知道该从哪里入手，稀里糊涂之中，下载了大量的文献论文，质量参差不齐，选择了一篇自己看来较为完整的学位论文，对他的内容进行了从头到尾的阅读，但是仍然彷徨与迷茫，很多不理解的东西，文中也并未给出解释。
这使得我从开始就没有起一个好头。
在这之后，为了完成作业，每天会硬着头皮在做自己研究方向至于抽出一定的时间来阅读一些关于本作业的中文文献，但是很遗憾，在一周之后，眼看着离交作业的时间越来越近，自己又无法全身心的投入到该设计中，在有限的精力下所读得的这一部分资料，任然连皮毛都不懂。
但是没办法，只能开始写作了。
仿照着别人的写。
边看边写，在模仿他人的同时，夹杂着自己的很少一部分的自身的理解。
当然在这其中，也有着诸多的错误而由于自身水平所限无法发现而已。
其实，我想老师也明白，让我们这种之前从未接触过机器人设计的学生，来写出一篇自己设计的机器人的论文无疑是异常困难的，况且在这仅有的两周时间，神乎其神。
所以说我自己也不否认这篇蹩脚的低水平的文章大多数是参考了别人来的文章，但是我认为这幸亏不是毕业论文，只是为了作业并增进对机器人控制技术了解的必要之举。
我不内疚，因为这篇文章都是我自己输入的，文章的每个角落里有哪些内容我都异常的熟悉，哪些地方存在着我自己的理解也异常的熟知。
包括其中的上百条公式，都是一手一手码出来的，虽然没能做到对一条公式的理解，但是都有去做了解。
太多的问题来不及去表达，特此写下这篇自述讲讲自己的对这门课程的认识，相信我在之后的求学或工作生涯中任然能够再对机器人控制这门学科进行深入的学习和研究。
说声抱歉，老师要求的软件源代码，由于自己的水平所限，以及查找资料未果，没能附着一篇哪怕蹩脚的控制源码。
再次抱歉。
摘要
本设计说明书首先对SCARA机器人做了一个全面的分析，从主体结构到运动学算法分析，再到机器人的动力学分析。
运用经典的动力学和运动学方法分析了SCARA机器人的。
之后对SCARA机器人的轨迹规划做了分析，理解了轨迹规划的具体实现步骤。
紧接着，又对机器人的控制策略及其主要遵循的机制做了一个简单的解释。
应该说能够大体了解该机器人的控制方法。
之后，对整个机器人的整体控制思路做除了阐述，使我们能够清晰的了解了整体及局部的控制是如何实现的。
最后，通过现实设计需求，指定相应参数，根据实际选择合适的主要设备部件，这些主要设备部件的计算及其作用进行了详细的解释。
并且在附录中给出了主要的元器件清单。
虽然不太全面，但还是能够利用其实现大概功能。
文章的最后还提出了软件的实现方法，讲解了如何利用控制卡实现对机器人的运动控制。
文章基本上SCARA机器人所需要的分析方面，文中均有提及，但是由于水平所限，有些不太理解的方面无法给出详尽的解释及解决方案，希望在自己将来能够有机会继续深入研究有关机器人的相关问题。
1引言
20世纪中期，因为计算机自动化和原子能技术的发展，现代机器人开始在美国得到重视和研究，工业机器人也因此不断得以应用。
工业机器人的特点是能实现自动控制、能重复编程、自由度较多，经常搭配刀具或其它可装配的加工工具，从而实现搬运材料、工件等动作，完成各种作业，属于一种柔性自动化设备。
工业机器人是机器人学的一个分支，它代表了机电一体化的最高成就。
自1962年美国推出世界上第一台UnJmation型和Versatran型工业机器人以来，工业机器人技术迅猛发展，工业机器人技术综合了机械工程学、电气工程学、微电子工程学、计算机工程学、控制工程学、信息传感工程学、声学工程学、仿生学以及人工智能工程学等多门尖端学科，是感知、决策、行动和交互四大技术的综合的高新技术，具有广泛的研究和应用价值，工业机器人应用水平代表了国家工业自动化水平。
随着工业机器人在制造业的应用范围越来越广阔，其标准化、模块化、网络化和智能化的程度也越来越高，功能越来越强，并向着成套技术和装备的方向发展。
机器人应用从传统制造业向非制造业转变，向以人为中心的个人化和微小型方向发展，并将服务于人类活动的各个领域。
总趋势是从狭义的机器人概念向广义的机器人技术RT概念转移；
从工业机器人产业向解决工程应用方案业务的机器人技术产业发展。
机器人技术（RT）的内涵已变为“灵活应用机器人技术的、具有实在动作功能的智能化系统”。
我国的机器人研发始于上世纪70年代初，前10年处于研究单位自行开展研究状态，发展比较缓慢。
1985年后开始列人国家有关计划，发展比较快。
特别是在“七五”、“八五”、“九五”机器人技术国家攻关、“863”高技术发展计划的重点支持下，我国的机器人技术取得了重大发展，主要表现在机器人基础技术，机器人的单元技术和基础元部件的研发，机器人控制装置的研制，机器人操作机研制和机器人的应用工程等方面。
工业机器人根据机械结构和坐标系特点可分为直角坐标型3P、圆柱坐标型R2P、球坐标型2RP和关节坐标型（3R）的机器人，关节坐标型机器人的结构类似于人手臂，其位置和姿态完全由旋转运动实现，而平面关节型机器人，即SCARASelectiveComplianceAssemblyRobotArm机器人可看作关节坐标型机器人的特例。
SCARA（SelectiveComplianceAssemblyRobotArm，中文译名：
选择顺应性装配机器手臂）是一种圆柱坐标型的特殊类型的工业机器人。
SCARA机器人有3个旋转关节，其轴线相互平行，在平面内进行定位和定向。
另一个关节是移动关节，用于完成末端件在垂直于平面的运动。
它最适用于平面定位，垂直方向进行装配的作业。
SCARA系统在x，y方向上具有顺从性，而在Z轴方向具有良好的刚度，此特性特别适合于装配工作，例如将一个圆头针插入一个圆孔，故SCARA系统首先大量用于装配印刷电路板和电子零部件；
SCARA的另一个特点是其串接的两杆结构，类似人的手臂，可以伸进有限空间中作业然后收回，适合于搬动和取放物件，如集成电路板等。
图1-1SCARA机器人
2系统分析及算法分析
2.1SCARA机器人的结构分析
2.1.1SCARA机器人的总体结构
SCARA机器人有四个旋转自由度和一个移动自由度，各旋转关节轴线相互平行，使机器人能在平面上定位和定向，一个移动关节实现腕部的垂直运动。
以平田公司AR-F650H型号的SCARA机器人为例，如图2-1所示，三个旋转自由度为A轴、B轴和W轴，移动自由度为Z轴。
在实际使用中，需要装配与其腕部
适合的手腕，以实现特定的用途。
图2-1AR-F650H型号的SCARA机器人
各关节电机都使用伺服电机，A轴和B轴的减速器选用谐波减速器，z轴和w轴采用滚珠丝杠一花键轴的一体式结构，并选用同步带减速。
SCARA机器人的传动方式如下：
A轴旋转：
A轴电机一谐波减速器一A轴；
B轴旋转：
B轴电机一谐波减速器一B轴；
’
z轴垂直直线运动：
Z轴电机一同步带一丝杠螺母一主轴；
W轴旋转：
w轴电机一同步带一花键螺母一主轴。
伺服电机与减速器是机器人结构中的核心部件，它们对机器人的性能有着很
大的影响。
目前机器人中使用的减速器主要有三种：
精密行星减速器、RV减速器和谐波减速器。
谐波减速器和RV减速器因为具有很高的传动效率和精度，在机器人中的使用较多。
RV减速器是有两级减速的全封闭式摆线针轮减速器，具有减速比大、同轴线传动、传动精度高、刚度大等特点，适用于负载大、速度高和精度高的场合。
谐波减速器是利用行星齿轮传动原理发展而来的新型减速器，也具有传动比大、传动精度高、体积小、重量轻等优点，而且制造成本相对前者要低很多。
在SCARA机器人中，谐波减速器的应用更为广泛。
2.1.2SCARA机器人各关节的装配结构
大臂（A轴）的装配结构见图2-2。
图2-2第一自由度剖面图
1.轴2.轴承套3.轴承4.外壳5.拧紧螺丝6.端盖7.电机
小臂（B轴）的装配结构图2-3。
图2-3第二自由度结构图
1.底部端盖2.套杯3.大臂4.旋转轴5.小臂6.步进电机7.电机轴（输出轴）
8.内六角螺丝钉9.深沟球轴承10.小圆螺母11.内六角螺钉
2.1.3SCARA机器人腕部关节的运动
手腕部关节结构装配图如图2-4
图2-4第三、四自由度结构示意图
1.小臂2.支撑架3.筋板4.丝杠轴5.丝杠螺母6.连接板7.步进电机
8.可移动板9.小带轮10.同步带11.小圆螺母12.套筒13.大带轮14.直线导轨15.滑块
16.步进电机17.电机轴18.电机连接板
19.连接件20.深沟球轴承21.套杯22.透盖23.主轴24.气动夹头
2.2SCARA机器人的运动学分析
2.2.1机器人位姿的数学描述
1.位置描述
要想完全定位一个刚体，只需要确定刚体上某一点在空间的位置和姿态即可。
假设某一刚体上任意一点为，那么在直角坐标系中这个刚体的位置可以用一个3×
1的列矢量表示，如式（2.1）所示。
（2.1）
式中，是点在坐标系中的对应坐标值，如图2-6所示。
图2-6刚体在空间中的位姿
2.方位描述
要求解机器人的正运动学和逆运动学问题，首先要知道各连杆的位姿，即连杆的位置和姿态。
上面已经说过位置的表示方法，姿态可以用机器人连杆上的坐标系（固联工具坐标系）的方位表示。
一般是在机器人连杆末端建立一个于连杆固联的坐标系来确定方位。
具体做法是用坐标系的三个坐标轴单位向量相对于参考坐标系的三个坐标轴单位向量的方向余弦组成3×
3矩阵，它用以描述物体相对于参考坐标系的方位，也就是B的姿态。
（2.2）
式中，----旋转矩阵；
----参考坐标系；
----与物体固联的坐标系；
有9个元素，其中有3个元素相互独立。
前面已经指出是的三个单位向量，三者之间存在两两垂直的关系，所以这9个元素满足6个约束条件（即正交条件）：
（2.3）
可见，旋转矩阵是正交的，并且满足条件：
（2.4）
如果轴旋转角度，那么各轴的旋转矩阵如下：
（2.5）
（2.6）
（2.7）
3.位姿描述
求解运动学问题要求出机器人末端的位姿。
前面已经说明了任一点相对于参考坐标系的位置和姿态的表示方法，现在进一步说明物体在空间中的位姿描述。
首先在物体上建立一个坐标系，的坐标系原点选择通常是的特征点，例如物体的重心。
接着分析坐标系在参考坐标系中的位姿，我们用矢量表示的坐标系原点，那么的姿态可用三个坐标轴的单位向量相对于参考坐标系的对应单位向量的余弦值构成的旋转矩阵表示。
那么物体相对于参考坐标系的位姿就能用的位置和姿态来描述，即有
（2.8）
如果只想知道物体在参考系中的位置，可以令式（2.8）中的旋转矩阵为单位矩阵；
同样若只想知道物体在参考系下的姿态，可以令式（2.8）中的位置矢量为零。
4.坐标系变换
在直角坐标系中，任一点可表示为，若用四个数组成列向量来表示，且它们之间关系为那么称为三维空间点的齐次坐标。
设矢量沿着矢量平移，相当于和两矢量叠加，如图2-7所示。
图2-7坐标系平移变换
即有：
（2.9）
式（2.9）中，即为齐次平移矩阵。
同理，若假设为旋转矩阵，则：
（2.10）
式（2.10）为齐次旋转矩阵。
那么平移加旋转的变换矩阵为：
（2.11）
位姿的齐次坐标变换矩阵即为式（2.11）。
2.2.2SCARA机器人的D-H坐标变换
1.D-H表示法
D-H法是在一定的规则下建立各个连杆坐标系，然后用4×
4的齐次变换矩阵来描述各连杆间的相对位姿关系，再通过变换矩阵的运算就可以求出机器人末端相对基座（参考坐标系）的位姿矩阵。
每个连杆都用这四个参数来描述，其中表示连杆长度，表示连杆扭角，表示两相邻连杆的距离，表示两相邻连杆的夹角，描述连杆i本身的特征，描述连杆i-1和i间的联系。
对于旋转关节，是关节变量，是关节参数；
对于平移关节，是关节变量，是关节参数。
下图2-8所示为n个关节的广义连杆系统，取相邻杆件i-1和i，及对应的关节i-1和i来研究连杆间的齐次变换矩阵。
首先建立连杆i-1和连杆i间的参考坐标系，建立过程要遵循以下规则：
图2-8D-H模型参数示意图
1）互轴与第i+1个关节轴线重合；
2）轴垂直于和轴，并指向轴的方向；
3）和轴相交时，以交点为原点；
和轴异面时，以其公垂线与轴的交点为原点；
和轴平行时，以和的公垂线与轴的交点为原点；
4）轴则通过右手坐标系规则建立。
由以上可知连杆i-1与连杆i之间的变换矩阵由两个旋转和两个平移变换总共四个齐次变换来描述，其关系式为：
（2.12）
式中：
表示坐标系沿轴旋转角；
表示坐标系沿轴平移距离；
表示坐标系绕轴旋转角；
表示坐标系沿轴平移距离。
展开式（2.12）可得：
（2.13）
式中，，以下相同。
根据式（2.13）能得到各连杆的变换矩阵，机器人末端相对于基座的位姿矩阵可由各连杆的变换矩阵相乘得到：
（2.14）
式中，表示机器人末端位姿矩阵；
表示机器人末端姿态矩阵；
珐一表示机器人末端坐标系原点相对基座坐标系原点的位置矢量。
2.SCARA机器人的D-H坐标变换
SCARA机器人属于串联机器人，有四个自由度：
3个旋转副，1个移动副。
根据上述D-H坐标系建立方法分别建立机器人的各关节坐标系，如图2-9所示。
图2-9SCARA机器人连杆坐标系
由图2-10得到SCARA机器人各连杆的参数，如表2-1所示。
表2-1SCARA机器人连杆参数表
关节i
（mm）
（rad）
关节变量
其他
1
-
2
=400mm
3
=250mm
4
由式（2．13）可得各连杆的位姿矩阵为：
（2.15）
2.2.3SCARA机器人的正运动学分析
机器人的运动学正问题（DKP-DirectKinematicProblems），即已知各关节参数，求解机器人末端执行器相对参考系的位姿矩阵。
在求出SCARA机器人各关节的位姿变换矩阵后，再将各变换矩阵连续右乘就能得到机器人末端执行器的位姿方程：
（2.16）
由式（2.16）可得：
（2.17）
2.2.4SCARA机器人的逆运动学分析
机器人运动学逆问题（IKP-InverseKinematicProblems），即己知各关节的参数和机器人末端执行器的位姿矩阵，求解各关节的运动变量。
1.求关节变量
对式（2.16）矩阵左右两端做矩阵逆乘，可以得到：
而
且有
即有
（2.18）
令式（2.18）中的第一行和第二行的第四列的元素对应相等：
（2.19）
由式（2.18）可以得到：
（2.20）
式中，；
。
其中正负号表示的解可能有两个。
2.求关节变量
将的值代入到式（2.19）可得：
（2.21）
其中，。
3.求关节变量
令式（2.18）中第三行第四列的元素对应相等可得：
（2.22）
4.求关节变量
令式（2.18）中第二行第-N的元素对应相等可得：
（2.23）
则可得：
（2.24）
通过上述计算，SCARA机器人的逆解都已求出。
从计算结果可以看出，逆解可能存在多组，虽然都符合求解要求，但是要选择符合实际的一组最优解。
2.3SCARA机器人动力学分析
机器人的静力和动力分析是其操作机设计、动态性能分析、控制器设计、动态仿真的基础。
机器人作为一个复杂的动力学系统，存在严重的非线性，它是由多个关节和多个连杆组成，具有多输入和多输出，之间存在错综复杂的耦合关系。
因此分析机器人的动力学特性，必须从系统角度综合考虑。
研究机器人动力学的目的是多方面的。
首先是为了实时控制的目的，利用机器人的动力学模型，才有可能进行最优控制，以期达到最优指标和更好的性能。
问题的复杂性在于实时的动力学计算。
因此各种方案都要做某些简化假设。
拟定最优控制方案仍然是当前控制理论的研究课题。
此外，利用动力学方程中重力项的计算结果，可进行前馈补偿，以达到更好的动态性能。
机械手的动力学模型还可用于调节伺服系统的增益，改善系统的性能。
2.3.1动力学建模方法
基于不同的力学方程和原理，目前有多种动力学分析方法，如拉格朗日（Lagrange）法、牛顿一欧拉（Newton-Euler）法、凯恩（Kane）法、高斯（Gauss）法和罗伯逊一魏登堡（Roberson—Wittenberg）法等。
应该说，只要在理论力学和分析力学中有一种动力学分析方法，就有一种机器人动力学分析方法。
我们今天主要说说拉格朗日法。
Lagrange法基于系统能量，对于任何机械系统，其Lagrange函数为系统动能和系统势能之差，即，其中可以用任意选取的坐标系来表示，例如广义坐标，。
不限于笛卡尔坐标。
本文采用Lagrange法来分析和求解SCARA机器人的动力学问题，其具体的推导公式见后文。
Lagrange法特点：
1.能以最简单的形式推导非常复杂的系统动力学方程，且具有显式结构；
2.由于状态方程简单便于设计补偿所有非线性因素的控制规律，可实现闭环控制；
3.采用这种具有显式结构，可用来分析和设计关节变量空间的高级控制策略；
4.设计反馈控制器时，用动力学系数使反作用力的非线性影响最小；
5.由于解决正逆动力学问题时，均必须计算动力学参数，故在解决简单问题时，较之Newton-Euler法更繁琐，然而随着系统复杂程度的增加，采用此法反而使得问题简单。
2.3.2Lagrange函数
计算系统动能为时，SCARA机器人的每一个构件，可看作一般运动的刚体，其动能由移动和转动两部分组成，即，对于整个机构（驱动器动能也可加入总动能中，此处省略）。
在运动分析中：
，即，式中和是相应和的雅克比矩阵的元素，故当下标大于i时，即由i+1到时，由于关节变量到对杆i的质心速度和角速度不产生作用，其相应的雅可比矩阵元素为零。
于是有
（2.25）
式中，定义为总惯性张量。
计算系统势能时，以基础坐标零点为相对零点，（重心加速度）为列向量，则，其中为各杆质心向量。
因此，系统的Lagrange函数为：
（2.26）
2.3.3机器人拉氏动力学方程
系统的动力学方程（称第二类Lagrange方程）为;
（2.27）
式中，为动能和势能的广义坐标，为相应的广义速度，称广义力:
如果是直线坐标，则相应的是力；
反之，如果是角度坐标，则相应的是力矩，由于势能不显，故有：
（2.28）
将、值代入，并用矢量形式表示，则前述的动力学方程（拉氏方程的一般公式）：
其中，，分别表示关节的位置、速度、加速度向量；
表示惯量矩阵
描述科里奥利力和向心力的对动力学性能的影响，向心力与相关，科里奥利力与相关；
描述粘滞摩擦力和库仑摩擦力，一般在刚体动力学分析中不考虑摩擦力，动力学模型中的摩擦力影响问题的收敛性；
表示重力项；
表示对应g处位姿状态的所有外力。
显式结构化得：
（2.29）
其中，表示的关节力矩驱动矢量，；
，也都是矢量，分别代表表关节量、关
升级会员 