搬运机械手反解运动控制系统的设计文档格式.docx
- 文档编号:19893919
- 上传时间:2023-01-11
- 格式:DOCX
- 页数:31
- 大小:593.46KB
搬运机械手反解运动控制系统的设计文档格式.docx
《搬运机械手反解运动控制系统的设计文档格式.docx》由会员分享,可在线阅读,更多相关《搬运机械手反解运动控制系统的设计文档格式.docx(31页珍藏版)》请在冰豆网上搜索。
戴沃尔在此后还设计了一种可以接受示教而完成各种简单的重复动作的机器人。
在任务的执行过程中,机器人的各个关节在伺服驱动下依次再现上述位置,故这种机器人的主要技术功能被称为可编程和示教-再现功能。
1959年第一台工业机器人在美国诞生,开创了机器人发展的新纪元。
当今机器人技术正逐渐向着具有行走能力、多种感觉能力以及对作业环境的较强自适应能力的方面发展。
美国贝尔科尔公司已成功地将神经网络装配在芯片上,其分析速度比普通计算机快千万倍,可更快、更好地完成语言识别、图像处理等工作[1]。
目前,美国在机器人技术的综合研究水平上仍处于领先地位,而日本生产的机器人在数量、种类方面则居世界首位。
机器人技术的发展推动了机器人学的建立,许多国家成立了机器人协会,美国、日本、英国、瑞典等国家设立了机器人学学位。
20世纪70年代以来,许多大学开设了机器人课程,开展了机器人学的研究工作,如美国的MIT、RPI、Stanford、Carnegie-Mellon、Conell、Purdue、UniversityofCalifornia等大学都是研究机器人学富有成果的著名学府。
随着机器人学的发展,相关的国际学术交流活动也日渐增多,目前最有影响的国际会议是IEEE每年举行的机器人学及自动化国际会议,此外还有国际工业机器人会议(ISIR)和国际工业机器人技术会议(CIRT)等。
出版的相关期刊有“RobotToday”、“RoboticsResearch”、“RoboticsandAutomation”等多种[1]。
在当今这个新型工业化时代,机械手已逐步的被用于工业生产各个行业中,以下是两种非常典型的工业机械手(如图1.2、图1.3)。
图1.2点焊机器人
图1.3PUMA700机器人
机械手虽然目前还不如人手那样灵活,但从外形来看,它和人的手臂相似,是由一系列刚性连杆通过一系列柔性关节交替连接而成的开式链。
它具有能不断重复工作和劳动、不知疲劳、不怕危险、抓举重物的力量比人手大等特点。
机器人的研究、开发和应用涉及多刚体动力学、机构学、机械设计、传感技术、电气液压驱动、控制工程、智能控制、计算机科学技术、人工智能和仿生学等学科,机器人技术是一门跨学科的综合性技术,机器人应用水平是一个国家工业自动化水平的重要标志。
当代对机
器人的研究十分活跃,应用日益广泛的领域。
例如:
(1)机床加工工件的装卸,特别是在自动化车床、组合机床上使用较为普遍。
(2)在装配作业中应用广泛,在电子行业中它可以用来装配印制电路板,在机械
行业中它可以用来组装零部件。
(3)可在劳动条件差,单调重复易子疲劳的工作环境工作,以代替人的劳动。
(4)可在危险场合下工作,如军工品的装卸、危险品及有害物的搬运等。
(5)宇宙及海洋的开发。
(6)军事工程及生物医学方面的研究和试验。
随着工业的发展,科学技术不断进步,机器人学的不断完善,工业机器人成了可编程序的机电一体化的装置,在操纵控制下能按规定的程序完成一定的工作,更具有记忆,示数,再现等仿人功能,因此它已经成为柔性制造系统(FMS),自动化工厂(FA),计算机集成制造系统(CIMS)的自动化工具[2]。
1.2机器人的分类
根据不同的标准,机器人也相应有不同的种类。
工业机器人的机械结构部分可看作是由一些连杆通过关节组装起来的。
通常有两种关节,即转动关节和移动关节。
连杆和关节按不同的坐标形式组装,机器人可分为五种:
直角坐标型机器人、圆柱坐标型机器人、球坐标型机器人、关节型机器人和并联机器人,本论文中控制的对象为一五自由度的关节型机械手,它属于关节型机器人中的一个典型。
关节坐标型机器人主要由立柱、前臂和后臂组成(图1.4),PUMA机器人是其代表。
图1.4关节型机器人
机器人的运动由前、后臂的俯仰及立柱的回转构成,其结构最紧凑,灵活性大,占地面积最小,工作空间最大,能与其他机器人协调工作,避障性好,但位置精度较低,有平衡问题,控制存在耦合,故比较复杂,这种机器人目前应用得最多[1]。
1.3工业机器人的发展现状以及在各国的产业发展及预测
机器人是最典型的机电一体化装备,技术附加值很高,应用范围很广,作为先进制造业的支撑技术和信息化社会的新兴产业,将对未来生产和社会发展起越来越重要的作用。
国外专家预测,机器人产业是继汽车、计算机之后出现的新的大型高技术产业。
据UNECE(联合国欧洲经济委员会)和IFR(国际机器人联合会)统计,从20世纪下半叶起,世界机器人产业一直保持着稳步增长的良好势头,80年代工业机器人进入发展中期,汽车、电子等行业开始大量使用工业机器人,推动了机器人产业的发展。
工业机器人的应用满足了人们特性化的要求,产品的批量越来越大,品种越来越多,而且产品的一致性也大大提高,为商家占有了更多的市场份额,获得了更多的市场利润。
90年代初期,工业机器人的生产与需求达到了一个技术成熟期,1990年世界上新装备工业机器人80943台,1991年装备了76443台,到1991年底世界上已有53万台工业机器人工作在各条战线上。
进入90年代,机器人产品发展速度加快,年销售量增长率平均在10%左右;
2004年增长率达到了创记录的20%,其中,亚洲机器人增长幅度最为突出,增长43%,如图1.5所示。
数据来源:
UNECEHE和IFR
注1:
其中日本在2000年以前的统计数据,包括了所有机器人的数目,与各国数据缺乏可比性。
注2:
韩国的数据包括了所有类型的工业机器人,与各国的数据缺乏可比性。
图1.52003年制造业中每1万名雇员拥有工业机器人的数量[4]
UNECE估计,2004年全球至少安装了10万台新的工业机器人。
其中:
欧盟31100台(比2003年增加15%,但比2001年的记录仅增加1%);
北美16100台(比2003年增加27%,比2000年的记录高24%);
亚洲51400台,主要在日本,但中国市场增长迅速(比2003年增长24%)。
以下我们还可以从表1.1中的数据了界工业机器人在各国的产业发展与预测。
表1.1全球工业机器人年度安装量和年运行总量及2007年的预测数(单位:
台)[3]
国家或地区
年度安装量
运行总量
2002年
2003年
2007年
日本
25373
31588
41300
350169
348734
349400
美国
9955
12693
15900
103515
112390
145100
欧盟
26096
27114
34400
233769
249200
325900
其他欧洲国家
582
922
1300
11009
11409
14200
亚洲/澳洲
5123
6695
8900
60427
65419
78500
其他国家
1466
2764
4500
44216
13620
27200
总计(除日,韩)
39244
45528
58700
375671
404193
590900
总计(包括日,韩)
68595
81776
106300
770105
800722
997700
UNECE和IFR
注:
日韩的统计口径和其他国家有所出入。
从近几年世界机器人推出的产品来看,工业机器人技术正在向智能机器和智能系统的方向发展,其发展趋势主要为结构的模块化和可重构化,控制技术的开放化、PC化和网络化,伺服驱动技术的数字化和分散化,多传感器融合技术的实用化,工作环境设计的优化和作业的柔性化,以及系统的网络化和智能化等方面。
UNECE和IFR预测,至2007年,全球运行的工业机器人总量将从2003年的800772台,增长至2007年的997700台,年平均增长5.6%。
其中,日本年度工业机器人总量将从2003年的348734增长至2007年的349400台,年平均增长0.048%;
欧洲将从2003年的249200台增长至2007年的325900台,年平均增长6.9%;
美国从2003年的112390台增长到2007年的145100台,年平均增长6.6%。
全球新安装机器人的数量从2003年的81776台增至2007年的10600台,年平均增长6.7%。
其中,日本工业机器人的年度安装量将从2003年的31577增长至2007年的41300台,年平均增长6.9%;
欧洲将从2003年的27114台增长至2007年的34400台,年平均增长6.1%;
美国从2003年的12693台增长至2007年的15900台,年平均增长5.8%[5]。
1.4我国工业机器人发展现状及前景
我国的机器人技术起步较晚,约于20世纪70年代末、80年代初开始。
以后的20多年中,在步行机器人、精密装配机器人、多自由度关节机器人的研制等国际前沿领域逐步缩小了与世界先进水平的差距。
从近几年来看,我国已经有很多单位和企业已经着手机器人的研究和开发,已经研究出多种型号的机器人。
我国工业机器人经过二十多年的发展已经在产业化的道路上迈出了新的步伐。
近几年,我国工业机器人以及包含工业机器人的自动化生产线和工程项目、相关产品的年销售额已经超过3亿元。
国家“863”计划当中,我国的工业机器人已经广泛的应用于汽车、电子行业当中,其发展水平也已经逐步接近世界先进水平,相信以目前的发展水平会在不久的将来赶上各先进国家的步伐。
1.5论文的意义和研究内容
机器人技术是近30年来迅速发展起来的一门综合学科。
它综合了力学、机构学、机械设计学、计算机工程、自动控制、传感技术、电液驱动技术、人工智能、仿生学等学科的有关知识和最新研究成果,代表了机电一体化的最高成就。
机器人学是随着机器人的发展而发展的,而它的发展与完善又不断地推动着机器人技术水平的提高,扩大着机器人的应用领域;
同时机器人学也极大地促进了控制技术、人工智能、传感技术、仿生学等学科的发展,所以机器人学是一门集中反映高新技术的新兴学科。
科学的进步与技术的创新,为机器人的研究与应用开辟了广阔的思路与空间。
工业机器人由操作机(机械本体)、控制器、伺服驱动系统和检测传感装置构成,是一种仿人操作、自动控制、可重复编程、能在三维空间完成各种作业的机电一体化、自动化生产设备。
特别适合于多品种、变批量的柔性生产。
它对稳定、提高产品质量,提高生产效率,改善劳动条件和产品的快速更新换代起着十分重要的作用。
从某种意义上说它是机器的进化过程产物,是工业以及非产业界的重要生产和服务性设备,也是先进制造技术领域不可缺少的自动化设备。
现代科学技术的迅速发展,尤其是进入80年代以来,机器人技术的进步与其在各个领域的广泛应用,引起了各国专家学者的普遍关注。
许多发达国家均把机器人技术的开发、研究列入国家高新技术发展计划。
我国现代化建设的十五计划的“211工程”中就有一个“智能移动机器人系统”建设项目[6]。
本文结合当今工业机器人的研究现状和发展方向,具体阐述了一种五自由度关节式机器人的控制系统的设计与开发过程。
分析了机械手的总体结构参数,系统地对本机械手的逆运动学进行了分析。
在同组同学用齐次坐标变换的方法对机械手的运动学正解进行了分析和研究的基础上,对机械手的运动学逆解进行了分析和研究,并用代数法求出结论表达式。
然后选择其中的一组最优的解,利用PLC控制器编程来控制机械手的运动。
参考文献
[1]刘极峰,易际明,等.机器人技术基础[M].北京:
高等教育出版社,2006年5月
[2]熊有伦.机器人技术基础[M].武汉:
华中科技大学出版社,1996年
[3]马光,申桂英,等.工业机器人的现状及发展趋势[J].南京化工大学学报,2003(3)
[4]朱力.目前各国机器人发展情况[J].中国青年科技2003(11)
[5]张效祖.工业机器人的现状与发展趋势[J].世界制造技术与装备市场,2004(5)
[6]郝海青.串联关节式机械手的控制系统分析与设计.万方数据库硕博士论文,2002
第二章机械手的结构和功能及基本技术参数
2.1机械手的结构和功能
本文所涉及的五自由度机械手是建立在GR-1型教学机械手的基础之上,它有五个旋转关节和一个抓取物体的工具(手爪),还配有示教盒和控制器(除机械部分外基本已失效)。
主要由机械部分和控制系统两部分组成:
机械部分:
该机械手是一个关节型机械手,结构简单,并且全部采用开放式结构。
其6个自由度皆由直流伺服电机驱动。
控制系统:
通过对控制器进行编程,由光电闭环伺服回路引导机械手末端手爪,可以实现对其准确定位。
其设计特点可归纳为:
(1)机械设计采用裸体式以便能看清楚所有运动副的工作情况。
(2)机构和功能与大型工业机器人类似。
(3)用直流伺服电机和链传动作为执行机构,其工作状态也和工业机器人、CNC装置的情况类似。
(4)采用全数字控制方案,每个关节的直流伺服电机都装有光电编码器,用高传动比以获得较高的关节角位移分辨率。
(5)控制器可同时控制6个直流伺服电机,用户可认为控制器是透明的,致力与软件开发。
该机械手结构图和部件传动图如图2.1—2.4所示。
图2.1腰传动图
腰部通过一对齿轮副直接传动。
安装在底座上的直流伺服电机的输出经减速器变速后,通过齿轮传动使腰部绕垂直轴线旋转,其旋转的角度不小于180°
。
从动齿轮上装有行程开关,对腰部传动进行限位检测,可实现最大限位控制。
图2.2上臂传动图
上臂固定在腰部从动齿轮上,安装在腰部上的伺服电机通过链传动带动上臂进行摆动幅度不小于270°
的运动,并且随腰部一起传动。
图2.3前臂传动图
前臂固定在上臂末端轴(肘关节轴线)上,其驱动电机固定在腰部,通过2级链传动带动前臂转动。
采用链轮张紧链条,二级链传动第一级参数与上臂的参数相同,次级传动是等比传动。
图2.4手传动图
手传动驱动电机固定在腰部,通过2级链传动带动手绕前臂末端轴线转动。
它是二级链传动带动及钢丝绳传动相结合。
其中,次级链传动和钢丝绳传动都是等比传动,都是用链轮张紧,其转动幅度不小于270°
腕部装有2个直流伺服电机,一个通过齿轮传动驱动腕的旋转运动,一个通过连杆机构带动手爪的开合。
此外,在机器人本体下面还有安装底板,用于稳定机身,防止在机器人的肘,臂伸出时,机器人倾倒。
除了齿轮传动外,链传动也是GR-1型示教机械手重要的传动方式。
该机械手的上臂,前臂和手是通过链轮传动实现运动的。
各机械结构为基本空间缩放结构,用高强度铝合金材料制成。
机械手的运动由腰部转动、上臂摆动、前臂摆动、手俯仰、腕旋转和手爪开闭6个动作部分组成。
各关节和手腕的运动用直流伺服电机驱动,电机的输出轴上安装有光电编码器,用于位置检测,并将位置信号反馈到控制器输入端,构成伺服电机驱动回路的闭环反馈控制。
2.2机械手的基本参数
机械手的基本参数如下:
a、外形尺寸:
340×
530(复位状态,包括底座)
b、自由度:
5(不包括手指开闭控制)
c、各关节活动范围:
腰:
≥±
180°
肩:
≥200°
肘:
≥270°
手俯仰:
手指旋转:
≥360°
d、最大活动区:
垂直方向:
850mm
水平方向:
600mm
e、各轴的分辨率:
轴
电机代号
分辨率(度/脉冲)
手指旋转
B
0.24
手俯仰
C
0.11
前臂
D
上臂
E
躯干
F
0.14
f、运动速度:
≥20度/秒
g、重复精度:
≤1mm
h、最大负重:
≥1kg
i、机械手重:
11.0kg(包括底座)
j、基本尺寸:
躯干:
115×
215mm
腰高:
153mm
肩高:
249mm
上、前臂长:
228mm
手前部:
137mm
手后部:
68mm
手指:
50mm
k、运动控制:
数字式光电闭环伺服回路
l、驱动方式:
直流伺服电机
第三章连杆坐标系间的变换矩阵
3.1齐次坐标与手部位姿矩阵
本设计中我们所研究的搬运机械手实质上是由一系列关节连接而成的空间连杆开式链机构。
而要研究此机械手,就必须对机器人运动学有一个基本的了解。
机器人运动学中的一个最基本问题就是齐次坐标、机器人的位姿分析。
在选定的直角坐标系{A}中,空间任一点P的位置可以用3 1的位置矢量AP表示,其左上标表示选定的坐标系{A},此时有
AP = [PXPYPZ]T(2.1)
式中:
PX、PY、PZ是点P在坐标系{A}中的三个位置坐标分量,如图3.1所示。
图3.1空间任一点的坐标表示
将一个n维空间的点用n + 1维坐标表示,则该n + 1维坐标即为n维坐标的齐次坐标。
用齐次坐标的规格化形式表示即:
P = [PXPYPZ1]T(2.2)
在图3.2中,i、j、k分别表示直角坐标系中X、Y、Z坐标轴的单位矢量,用齐次坐标表示之,则有:
图3.2坐标轴的方向表示
X = [1000]T
Y = [0100]T
Z = [0010]T
图3.2中所示的矢量u的方向用4 1列阵可表达为:
u= [abc0]T(2.3)
a = cos,b = cos,c = cos
手部的位置矢量为固定参考系原点指向手部坐标系{B}原点的矢量P,手部的方向矢量为n、o、a。
于是手部的位姿可用4 4矩阵表示为
(2.4)
3.2连杆坐标系间的齐次变换矩阵的表示方法
在对机器人进行运动学分析是,可以直接对机器人进行某种抽象,将连杆抽象为直线,而将关节抽象为点,这样对分析结果不会产生影响。
这是机器人的运动学建模。
在运动学的建模中,坐标系的选择有很多种,而最为常见的Denavit-Hartenberg方法(D-H方法),其坐标系的建立如下:
连杆i的坐标系的Zi轴位于连杆i与连杆i + 1的转动关节轴线上;
连杆i的两端轴线的公垂线为连杆坐标系的Xi轴,方向指向下一个连杆;
公垂线与Zi的交点为坐标系原点;
坐标系的Yi轴由Xi和Zi经右手法则确定。
两连杆间的关系由4个参数来描述,其中两个参数用来描述连杆,即公共法线的距离ai和垂直于ai所在平面内两关节轴线(Zi–1和Zi)的夹角αi;
另两个参数表示相邻两杆的关系,即两连杆的相对位置di和两连杆法线的夹角i。
ai称为连杆长度,αi为连杆扭角,di为两连杆距离,θi为两连杆夹角。
用
表示机器人连杆n坐标系的坐标变换成连杆n–1坐标系的坐标的齐次坐标变换矩阵,通常写成
对于n个关节的机器人,前一个关节向后一个关节的坐标齐次变换矩阵分别为:
其中,
表示杆件1上的1号坐标系到机座的0号坐标系的齐次坐标变换矩阵。
3.3连杆坐标系间变换矩阵的确定
一旦对全部连杆规定坐标系后,就能建立相邻两连杆i与i+ 1之间的相对关系,连杆i–1的坐标系经过变换可以与连杆i的坐标系重合。
如果把表示相邻连杆相对空间关系的矩阵称为A矩阵,那么根据上述变换步骤,从连杆i到连杆i–1的坐标变换矩阵
为:
= Rot(Z,
)Trans(0,0,
)Rot(X,
)
(2.4)
上式为在D-H坐标系中,机械手中转动关节坐标与其前一个关节坐标的齐次变换矩阵。
能描述连杆坐标系之间相对平移和旋转的齐次变换。
描述第一个连杆对于机身的位姿,
描述第二个连杆坐标系相对于第一个连杆坐标系的位姿。
如果已知一点在最末一个坐标系(如n坐标系)的坐标,要把它表示成前一个坐标系(如
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 搬运 机械手 解运 控制系统 设计