机器人基础三级项目

1、燕山大学课程研究项目报告自平衡小车机器人系统的设计与制作学院：机械工程学院年级专业：机电20121/2班课程名称：机电一体化系统设汁组号：3学生姓名：武进、熊进、冯少日、张陶然组内分I：张三，车体设计与组装，45%李四，软件设讣与调试，55%指导教师：姚建涛、刘晓飞日期：2015.1()摘要本报告主要介绍打磨机器人的机械臂和机械手的设汁方法、思路、原理以及运动 控制等，并结合智能车结构绘制三维图、模拟仿真以及讣算分析实现打磨、抓取等工 作要求。报告主要分为三大部分：第一部分为进行机械臂方案选取，通过综合考虑选 择最优方案，并绘制三维图；第二部分也是最重要的步骤为工作空间的分析（包括求 运动学正

2、解与反解）、速度分析与轨迹规划：第三部分为设计总结及心得体会。通过设计过程中查阅大量资料，组内组间积极讨论最终形成此最终报告，但能力 有限，对于本报告中的不足与错误希望老师批评指正。关键词：机械臂，方案选取，三维图，工作空间，速度，轨迹规划前言机器人学是一门迅速发展的综合性前沿学科，进入21世纪，人类对空间的利用越 来越迫切，随着航天技术的发展，人类在太空中的活动也越来越多。未来将有大量的 空间生产、空间加工、空间装配和空间设备的维护修理工作要做。但是，由于空间操 作环境的特殊性和不确左性，以及载人航天技术的限制，太空中仍然需要由机器人来 代替人进行一系列的作业。因此,，机器人的研发技术将成为

3、未来宇宙开发过程的关键 技术之一。现普遍将机器人划分为两类：一般机器人和智能机器人。一般机器人是指不具有 智能，只具有一般编程能力和操作功能的机器人。到目前为止，在世界范围内还没有 一个统一的智能机器人定义。大多数专家认为智能机器人至少要具备以下三个要素： 一是感觉要素，用来认识周围环境状态：二是运动要素，对外界做岀反应性动作：三 是思考要素，根据感觉要素所得到的信息，思考出采用什么样的动作。本次课程设汁 的打磨机器人小车属于智能机器人的范畴，集中了计算机、机构学、传感技术、电子 技术、人工智能及自动控制等多科。为了实现打磨以及抓取、移动、放苣物体等功能，机械臂与机械手的设讣尤为重 要。本次项

4、目对于我们扩展思路、分析问题、解决问题的能力进行了综合性锻炼，也 将对今后职业生涯产生重要影响。目录刖言I第1章 设计方案的确定 1第2章参数确定82.1机 械 手 臂 的 设il-102.2位移分析112.3机械手爪设计11第3章工 作 空 间 分析123. 1运动学正解133. 2运动学反解15第4章速度分析16第5轨迹规划17第6项目总结18第7心得体18第8参考文献18第1章设计方案与参数确定1.1机械手臂的设计该设计设计方案有如下三种：（1）该机械臂有3个转动关节，此结构比较简单，易制造，但由于它的工作范囤相对 较小，所以不采取这种方案。图 3-1 （a）（2）该机械臂有4个转动关节

5、，手腕的转动用于实现工件的位姿变化更顺 畅。此结构比较简单，易制造，它的工作范用也相对较大，但由于所抓取的工件有一 定的质量，单臂刚度尅能会受到限制，所以不易采取这种方案。图31 <b)(3) 该机械诱由四个转动关节组成.其中于部分为内外板，在夹取了螺栓后在重力产生的转动力矩 下.螺栓自动下垂为竖直状态，便于装配。该机械瞬结构较为简做，综合J'上述两种方案的优点， 易于实现抓取与装配目标。所以为昴终方案°图31 (c) 经过分析比较我们最终选左方案3。1.2位移分析分析确左连杆参数臂四臂二0臂图51机械手初始位姿连杆参数ia“(mm)<5(° )山(mm

6、)关节变量初值(° )1000()102148.590870、03148.500°3-90400()0手抓0-901101.3机械手爪的设计机械手爪的设汁也有三种方案：(1) 该方机械手爪的结构还是比较简单的，它通过推动中间滑块，实现手爪的张合, 它的最大缺点是张开的范围太小，并且控制不好的话，有时会将滑块从两尖角推出， 所以不采取这种方案。（2）这种方案解决了方案一所存在的部分问题，张开的角度也是比较大的，但是结构 比较复杂，制逍成本比较髙，考虑到经费和加工条件，不采取此方案。（3）最后这种方案结构比较简单，已加工制造，且手爪張开的角度比较大，满足要求. 所以采取方案三。

7、通过综合考虑，我们决龙选择第三种方案。第二章工作空间分析2.1运动学正解说明：由几何关系算得连杆转角，带入验证xyz的坐标关系。ala2a3表示连杆1、2、3的转角。最后解得;7矩阵最后一列表示小球在原点坐标系中的位置。syms al a2 a3 a4 dl d2 d3 d4 ;%连杆间齐次变换矩阵t 1 O=cos(a 1) -sin(a 1) 0 O;sin(a 1 )*cos(0) cos(a 1 )*cos(0) -sin(O) -d 1 *sin(O);sin(al)*sin(O) cos(al)*sin(0) cos(O) d 1 *cos(0);0 00 1|;T21=cos(a

8、2) -sin(a2) 0 0;sin(a2)*cos(pi/2) cos(a2)*cos(pi/2) -sin(pi/2) -d2*sin(pi/2); sin(a2)*sin(pi/2) cos(a2)*sin(pi/2) cos(pi/2) d2*cos(pi/2);0 00 1;T32=cos(a3) -sin(a3) 0 201;sin(a3)*cos(0) cos(a3)*cos(0) -sin(O) -d3*sin(0);sin(a3)*sin(0) cos(a3)*sin(0) cos(O)d3*cos(0);0 00 1:T43=cos(a4) -sin(a4) 0 0;si

9、n(a4)*cos(0) cos(a4)*cos(0) -sin(O) -d4*sin(0);sin(a4)*sin(0) cos(a4)*sin(0) cos(O) d4*cos(0);0 00 1J:T40=T10*T21*T32*T43%代入初值：al=0*pi/180;a2=O*pi/18O;a3=-90*pi/180;a4=0*pi/180;dl=0;d2=87;d3=0;d4=0;%解得T40 =0.0000 1.0000 0 201.0000-0.00000.0000-1.0000-87.00000 1.0000-1.00000.00000.0000 0.000000.0000

10、1.0000 0 201.0000 -0.0000 0.0000 -1.0000 87.0000 -1.0000 0.0000 0.0000 0.00000 0 0 1.00002.2运动学反解运动学反解是已知末端连杆的位姿，求解关节变量的过程。syms al a2 a3 a4T10=cos(al ) -sin(al ) 0 0;sin(al)*cos(0) cos(al )*cos(0) -sin(0) -dl*sin(O);sin(al)*sin(O) cos(al)*sin(0) cos(O) d 1 *cos(0);0 00 1J:T21=cos(a2) -sin(a2) 0 0;si

11、n(a2)*cos(pi/2) cos(a2严cos(pi/2) -sin(pi/2) -d2*sin(pi/2); sin(a2)*sin(pi/2) cos(a2)*sin(pi/2) cos(pi/2) d2*cos(pi/2);0 00 1;T32=cos(a3) -sin(a3) 0 201;sin(a3)*cos(0) cos(a3)*cos(0) -sin(O) -d3*sin(0);sin(a3)*sin(0) cos(a3)*sin(0) cos(O) d3*cos(0);0 00 1:T43=cos(a4) -sin(a4) 0 0;sin(a4)*cos(-pi/2) c

12、os(a4)*cos(-pi/2) -sin(-pi/2) -d4*sin(-pi/2); sin(a4)*sin(-pi/2) cos(a4)*sin(-pi/2) cos(-pi/2) d4*cos(-pi/2);0 0 0 1;T40=T10*T21*T32*T43;Tl=inv(T10);%求 T10 的逆矩阵。T41=TI*T40;%T41=T2I*T32*T43对应元素相等即可求出各关节变量。另见附录一第3章速度分析先求岀雅克比矩阵，我们可以得到末端执行器速度与各关节的速度关系。 al=0*pi/180;a2=0*pi/180;a3=-90*pi/180;a4=0*pi/180;d

13、l=0;A （ I W*01 I Z）ssojo= i y：（£：l）OkL»Z：（£°£：【）O£J£Z U£4£：l）031=ZZ 再刚刃庚彩z%：（£t：I）Oll=IZ（y£：i）Ki=ttd：（忙£：【）£厶丄兀闭 ：（方£：【）乙厶丄吒闭 马三興胡皈一目沓和：（忙£：【）【厶丄=1闭£ti=m £frl=£tl £tl*Z£l=Ztl ：£址*乙£丄屛乙丄=lkL：

14、（£：£：【）0址=0悅1：（£：£：【）0£丄=0£爼 ：（£：£：【）0乙丄=0乙爼 购三蚩匾磁一蚩曲马三蚩底马一虫01丄和：（£：£：【）01丄=01爼011=011 U14：011=031 忆£丄*【乙丄*01丄=0£丄 :£地沈£丄*忆丄*01丄=0忆LHl 000-（0）so3*frP（O）soo（oHqs*（怦）soo（oHqs*（诫Ms ：（O）U!s#p （o）uis- （o）so»（诧）soo（o）so»（诫）U0O

15、 o（tB）uis-（怦”03=£姙Hl 000X0）SO3*£P（o）soo（0）U!S*（£U）SO3（O）U!S*（£C）U!S：（O）U!S*£P（O）UIS-（0）SO3*（£E）SO3（0）SO0（£B）UIS： I0Z o（£B）UIS-（£B）SO3=2£1 tl 000-（r/?d）soo*zp（Z/id）S03!d）u!s*（茅）sen（/id）uis*（）uis ：（Z/!d）U!sup（2/rd）uis- （"d）soo*（茅）soo（3/id）so3*（jB）

16、uis：o 0 （讪!s（茅）s（x>=忆丄 :l 0 0 0-（0）so3*lP（0）so3 （o）U!S*（ie）so3（O）U!s*（ie）uis Xo）uis* I p- （o）UTS- （o）so»（ l B）SO3 （o）so»（ I E）uis：o 0 （I K）uis- （I B）soo=o 11 O=tP ：0=£P £8=ZPR2=cross(Z2,(R20*P42);R3=cross(Z3,(R30*P43);R4=cross(Z4,(R40*P44);J二R1 R2 R3 R4;Z1 Z2 Z3 Z4得J =87.00000

17、00201.00000.0000000201.00000000000-1.0000-1.0000-1.00001.00000.00000.00000.0000第4章轨迹规划我们通过三维模拟，得到个关节角位移和角速度的曲线如下:角位移：0M «畑ZH Z4>199«C«“Jig亠 nsicc a© tu 120 ie> :<«2< :u :2c303*»?po备<关节二角位移关节一角位移u12ap30«r12t ICO ：0C24230対关右三角位移0000 比 1d6 2仪关节一角速度4

18、7;231712036$ 园Mff“24 K 53437148 幻 >3191l3(MCi-115I.W 040 f.M1201.« ZOO 2.40 2003.20 3W <K>时目rg关节四角位移IM 0% IK 2M 3«2S 的 «« 7U 8«253C关右二角速度a CO2 黛 3sa 4d<5 他Gtt 734 l.tZWR :«ec>24Q»£O0% I2e 233 归 4 k) £U eB8 784 3&247362S13GSNJP-佗总«&

19、#171;S8«关节三角速度关肖四角速度第5章项目总结机械臂与机械手的设汁与运动控制是机器人实现自身功能的非常重要的一个环 节，尽管我们通过学习与自身能力结合完成了本次项目，但其内容与功能上仍有不足 与缺陷，希望将来能有有机会再次完善。本报告主要概述了利用maTlab和SolidWorks来实现机械臂运动模拟的整个过程和 基本原理。机械臂模拟是建立在机器人的基础之上，以矩阵为基本单位，通过矩阵变 换以及maTlab数学计算求得运动学的正解与反解，简化了计算过程；然后利用 SolidWorks三维建模进行运动模拟，它的运动可以通过修改运动轨迹来改善机械臂的 运行情况，避免了大量的编程，

20、使运动模拟更加快捷简便。总之机械臂与机械手的设计有各种务样的方案等着我们去思考实现，相信如果再 有机会我们能够比现在做得更好。第六章心得体会本次课程设计时间紧任务重，通过全组人员的通力协作终于在汇报前按时完成， 在此过程中也让我们更深入的了解了机器人这门课程的实际应用。本次设计综合了所学的机器人学的所有知识，是对过去学习的检验，同时也是巩 固提高、温故知新的过程。通过此次设il使我们发现如今学习到的知识面还是太窄， 内容有限，仅仅为取得考试成绩所学的知识根本远远不够，只有更广泛的学习和调查 各方面的资料才能达到真頁的提高。首先面临机械臂多种方案的设汁，开始无从下手, 后通过查阅各方资料不断吸取

21、新的内容才完成了项目的第一步，最重要的运动学正反 解在实际计算时也面临很多困难，再者就是在完成此次项目的同时还交叉着其他各科 的许多项目与考试，如何合理的安排时间调髙项目的进行效率也是一个考验。设计过程中，在老师、助教以及同学的帮助和配合下，才使得项目如期基本完成, 这体现了团队精神的重要性。本次课程实践项目无论在专业知识还是在学习能力上都 对我们有很大的启发，也非常感谢老师和助教的指导。参考文献1. 刘杰机电一体化技术基础与产品设讣冶金工业出版社.20032. 李广弟朱丿J秀冷祖祁讯片机基础北京航空航天大学出版社，20073. 熊有伦机器人技术基础华中科技大学出版社附录T41 =(sin(a

22、 1 )*(cos(a4)*(cos(a3)*(21511 *cos(a 1 )*sin(a2)/4064+ cos(a2)*sin(a 1)sin(a3)*(sin(al )*sin(a2)-(2151 l*cos(al)*cos(a2)/4064)(21511 *sin(a4)*(cos(a3)*(sin(a l)*sin(a2) -(21511 *cos(a l)*cos(a2)/4064)+sin(a3)*(21511 *cos(a 1 )*sin(a2)/4064+cos(a2)*sin(a l)/4064+cos(a 1 )*sin(a4)/(cos(a 1 )A2+sin(a 1

23、)A2)- (cos(a l)*(sin(a 1 )*sin(a4)+cos(a4)*(cos(a3)*(21511 *sin(a l)*sin(a2)/4064- cos(a 1 )*cos(a2)+sin(a3)*(cos(a I )*sin(a2)+(21511 *cos(a2)*sin(a 1)/4064)+(21511 *sin(a4)*(cos(a3)*(cos(a 1 )*sin(a2)+(21511 *cos(a2)*sin(a 1 )/4064)-sin(a3)*(21511 *sin(al )*sin(a2) )/4064 - cos(a 1 )*cos(a2)/4064)

24、/(cos(a 1 )A2 + sin(al)A2),- (sin(a 1 )*(21511 *cos(a4)*(cos(a3)*(sin(al)*sin(a2) - (21511 *cos(a 1 )*cos(a2)/4064) + sin(a3)*(21511 *cos(a 1 )*sin(a2)/4064 + cos(a2)*sin(a l)/4064 - cos(a 1 )*cos(a4) + sin(a4)*(cos(a3)*(21511 *cos(a 1 )*sin(a2)/4064+ cos(a2)*sin(a 1)sin(a3)*(sin(al )*sin(a2) - (215

25、11 *cos(a 1 )*cos(a2)/4064)/(cos(a 1 )A2 + sin(al)A2) (cos(a 1 )*(21511 *cos(a4)*(cos(a3)*(cos(a 1 )*sin(a2) + (21511 *cos(a2)*sin(a 1)/4064) sin(a3)*(21511 *sin(a 1 )*sin(a2)/4064-cos(a 1 )*cos(a2)/4064-sin(a4)*(cos(a3)*(21511 *sin(a 1 )*sin(a2)/4064- cos(a 1 )*cos(a2)+sin(a3)*(cos(a 1 )*sin(a2) +

26、(21511 *cos(a2)*sin(a 1 )/4064) + cos(a4)*sin(a 1 )/(cos(a 1 )A2 + sin(al)A2),(cos(a 1 )*(21511 *sin(a 1 )/4064 cos(a3)*(cos(al)*sin(a2) +(21511 *cos(a2)*sin(a 1)/4064)+sin(a3)*(21511 *sin(a l)*sin(a2)/4064-cos(a 1 )*cos(a2)/(cos(a 1 )A2 + sin(al)A2)(sin(a 1 )*(21511 *cos(a 1 )/4064 + cos(a3)* n(al)

27、*sin(a2)(21511 *cos(a 1 )*cos(a2)/4064)+ sin(a3)*(21511 *cos(al)*sin(a2)/4064 + cos(a2)*sin(a 1) )/(cos(a 1 )A2 + sin(al )A2), (cos(a 1 )*(87*sin(al) - (1 *sin(a 1 )*sin(a2)/4064 + 201 *cos(al)*cos(a2)/(cos(a 1)A2 +sin(a 1)A2)+(sin(a 1 )*(1 *cos(a 1 )*sin(a2)/406487*cos(a 1)+201 *cos(a2)*sin(al)/(co

28、s(al)A2 + sin(al)A2)(cos(a 1 )*(cos(a4)*(cos(a3)*(21511 *cos(a 1 )*sin(a2)/4064+ cos(a2)*sin(a I)sin(a3)*(sin(a 1 )*sin(a2)-(21511 *sin(a4)*(cos(a3)*(sin(al )*sin(a2) sin(a3)*(21511 *cos(a l)*sin(a2)/4064cos(al )*sin(a4)/(cos(al )A2+ sin(al)A2)cos(a4)*(cos(a3)*(21511 *sin(a l)*sin(a2)/4064(21511 *co

29、s(a 1 )*cos(a2)/4064)-(2151 l*cos(al)*cos(a2)/4064)+cos(a2)*sin(a I)/4064+ (sin(a l)*(sin(a 1 )*sin(a4)+-cos(al)*cos(a2)+sin(a3 )*(cos(a 1 )*sin(a2)+(2151 l*cos(a2)*sin(a 1)/4064)+(21511 *sin(a4)*(cos(a3)*(cos(a 1 )*sin(a2)+(21511 *cos(a2)*sin(a 1 )74064)- sin(a3)*(21511 *sin(a 1 )*sin(a2)/4064 - co

30、s(a 1 )*cos(a2)/4064)/(cos(a 1 )A2 + sin(al)A2), (sin(a 1)*(21511 *cos(a4)*(cos(a3)*(cos(a 1 )*sin(a2) + (21511 *cos(a2)*sin(a 1 )74064)-sin(a3)*(21511 *sin(al )*sin(a2)/4064cos(a 1 )*cos(a2)/4064sin(a4)*(cos(a3)*(21511 *sin(a 1 )*sin(a2)/4064cos(a 1 )*cos(a2)+sin(a3)*(cos(al )*sin(a2) + (21511 *cos

31、(a2)*sin(a 1 )/4064) + cos(a4)*sin(a 1 )/(cos(a 1 )A2 + sin(a 1)A2)-(cos(a 1 )*(21511 *cos(a4)*(cos(a3)*(sin(a 1 )*sin(a2)(21511 *cos(a 1 )*cos(a2)/4064)+sin(a3)*(21511 *cos(a 1 )*sin(a2)/4064+cos(a2)*sin(a l)/4064cos(a 1 )*cos(a4)+sin(a4)*(cos(a3)*(21511 *cos(a 1 )*sin(a2)/4064+ cos(a2)*sin(a 1)-si

32、n(a3)*(sin(a 1 )*sin(a2) - (21511 *cos(a 1 )*cos(a2)/4064)/(cos(a 1)A2 + sin(a 1 )A2),- (cos(a 1 )*(21511 *cos(a 1 )/4064 + cos(a3)*(sin(al )*sin(a2) - (21511 *cos(a 1 )*cos(a2)/4064) + sin(a3)*(21511 *cos(al)*sin(a2)/4064 + cos(a2)*sin(al)/(cos(al)A2 + sin(al)A2)- (sin(a 1 )*(215 ll*sin(a 1)/4064 -

33、 cos(a3)*(cos(al)*sin(a2) + (21511 *cos(a2)*sin(a1)/4064) + sin(a3)*(21511 *sin(a 1 )*sin(a2)/4064 - cos(al )*cos(a2)/(cos(al )A2 + sin(al)A2), (cos(a 1)*( 1 *cos(a 1 )*sin(a2)/4064 - 87*cos(a 1) + 201 *cos(a2)*sin(a 1 )/(cos(a 1 )A2 + sin(a 1)A2)- (sin(a l)*(87*sin(a 1)-(1 *sin(a l)*sin(a2)/4064+201 *cos(al)*cos(a2)/(cos(al)A2 + sin(al)A2)cos(a4)*(cos(a2)*sin(a3) + cos(a3)*sin(a2) -(21511*sin(a4)/4064-(21511 *sin(a4)*(sin(a2)*sin(a3)-cos(a2)*cos(a3)/4064,(2151 l*cos(a4)/4064 (2151 l*cos(a4)*n