机器人技术之机械臂的制作.docx

1、机器人技术之机械臂的制作机器人技术之机械臂的制作燕山大学课 程 设 计 说 明 书题目：智能车及装配机器人系统的设计与制作姓 名：尤振民 李明 胡强强 布贺宁分 工：尤振民：机械手三维图形的制作及动画仿真李明：资料收集，机械手臂编程及调试 胡强强：机械手臂的尺寸设计，轨迹规划 布贺宁：机械手臂方案论证，项目报告，PPT课程名称：机器人技术基础指导教师：李艳文、姚建涛、张庆玲2011年10月1.摘要12.前言13.方案论证14.硬件设计45.软件设计56.修改建议117.项目心得128.参考文献12智能车及装配机器人系统的设计与制作说明书1摘要机器人技术是一个集环境感知、轨迹规划、机械手应用等功

2、能于一体的机电一体化系统。它是集中了计算机、机构学、传感技术、电子技术、人工智能及自动控制等多科而形成的高新技术。本次课程设计的装配机器人智能小车就是这种高新技术综合体的一种尝试。装配机器人智能小车主要由机械系统，环境识别系统，运动控制系统及机械臂控制系统组成。小车以单片机为核心，附以外围电路，采用光电检测器进行检测故障和循迹，并用软件控制小车及机械臂的运动，从而实现小车的自动行驶、转弯、寻迹检测、避障、停止及装配等功能的智能控制系统。2前言本文介绍了智能车及装配机器人系统。它是在智能循迹小车的基础上，自主设计一个球形果装配的机械手并装配到原有的智能小车上，完成装配机电一体化系统的设计、制作，

3、进行机器人运动控制规划，控制机器人完成一系列复杂动作，如手抓张合、车体回转，智能循迹避障、协同作业等任务。3机械手方案论证3.1机械手臂方案设计设计方案有如下三种:A方案如图3-1（a）所示。由于手臂要执行装配作业，于是我们首先想到了平行四边行的稳定性，便设计了如下方案。该方案稳定性较好，使用电机数量也少，节约了成本，但它同时也限制了机械手的灵活性，且机械手不能抓取地面上的物体，缩小了机械手的操作空间。图3-1（a）B方案如图3-1（b）所示。该方案改进了方案A的机械手不能抓取到地面的缺点，但Z轴转动只能靠小车的转动来实现，耗能多，不符合“多动小关节、少动大关节”原则，而且需要控制车轮方能实现

4、，车轮依靠步进电机控制，从而给编程和后期调试带来不便。 图3-1（b）C方案如图3-1（c）所示。该方案在基座处又加了一个电机，改进了方案B的缺点，在球形果偏离预定位置时仍能通过腰关机的转动来实现作业，增强了机械手的灵活性,并能实现预定工作空间。 图3-1（c）经过分析比较我们最终选定方案C。3.2机械手爪方案设计方案一如图3-2（a）所示。该方案手爪张合灵活且结构简单，易于实现，但由于其为悬臂结构且铝合金材料强度有限，不能抓取强度很大的物体。 图3-2（a）方案二如图3-2（b）所示。该方案了在支撑手度便会相应增长，影响其强度，因此选机座高度为40mm；样基座将不会非常的稳定，为此，我们采用

5、在三角铝合金的下面加木质垫片来稳定其位置，并用木质的支撑来支持基座，这样也可以很好的吸收舵机工作时产生的震动。图4-1机械手抓球时的位姿4.1.2机械臂二、三尺寸的确定根据要求，基座到球形果的距离即机械手最大高度为430mm，而小车在装配是的停车位置距球形果175mm。为保证机械手能装配到球形果，我们选定与末端执行器相连的手臂长为175mm；而为保证机械手能达到最大高度，我们选定与机座相连的手臂长为200mm。横向距离：175+200=375350mm；垂直距离：200+175+40=410400mm，即所设计的尺寸符合任务要求。4.2 机械手爪设计 手爪的外形如图所示，球形果的直径为30mm

6、-80mm。为保证在装配过程中不致损伤球形果表面，在手爪上需要加装海绵，让手爪能够有效的抓紧球形果。海绵的长度设计为80mm，同时设定手爪内部的海绵厚度为5mm，这样两边的厚度加和为10m。并且保证小球在被夹紧时手爪是平行的（这样可以更有效的夹紧）5软件设计5.1位移分析分析确定连杆参数图5-1 机械手初始位姿连杆参数iai-1(mm)i-1()di（mm）关节变量初值()10040102090025.7320100384.340-90175 5.1.1运动学正解说明：由几何关系算得连杆转角，带入验证x y z 的坐标关系。a1 a2 a3 表示连杆1、2、3的转角。最后解得，矩阵最后一列表示

7、小球在原点坐标系中的位置。a1=0*pi/180;a2=150*pi/180;a3=-60*pi/180;a4=0*pi/180;d1=40;d2=0;d3=0;d4=176;%连杆间齐次变换矩阵t10=cos(a1) -sin(a1) 0 0;sin(a1)*cos(0) cos(a1)*cos(0) -sin(0) -d1*sin(0); sin(a1)*sin(0) cos(a1)*sin(0) cos(0) d1*cos(0);0 0 0 1;t21=cos(a2) -sin(a2) 0 0;sin(a2)*cos(pi/2) cos(a2)*cos(pi/2) -sin(pi/2)

8、-d2*sin(pi/2); sin(a2)*sin(pi/2) cos(a2)*sin(pi/2) cos(pi/2) d2*cos(pi/2);0 0 0 1;t32=cos(a3) -sin(a3) 0 201;sin(a3)*cos(0) cos(a3)*cos(0) -sin(0) -d3*sin(0); sin(a3)*sin(0) cos(a3)*sin(0) cos(0) d3*cos(0);0 0 0 1;t43=cos(a4) -sin(a4) 0 0;sin(a4)*cos(-pi/2) cos(a4)*cos(-pi/2) -sin(-pi/2) -d4*sin(-pi

9、/2); sin(a4)*sin(-pi/2) cos(a4)*sin(-pi/2) cos(-pi/2) d4*cos(-pi/2);0 0 0 1;t=t10*t21*t32*t43t = -0.0000 -0.0000 -1.0000 -350.0711 0.0000 1.0000 -0.0000 -0.0000 1.0000 -0.0000 -0.0000 140.5000 0 0 0 1.00005.1.1运动学反解说明：代入坐标x=-350，y=0， z=140。根据等式左右两端对应相等。解出关节旋转角度。选择最优解。syms a1 a2 a3a4=0*pi/180;d1=40;d

10、2=0;d3=0;d4=176;x=-350;y=0;z=140;t10=cos(a1) -sin(a1) 0 0;sin(a1)*cos(0) cos(a1)*cos(0) -sin(0) -d1*sin(0); sin(a1)*sin(0) cos(a1)*sin(0) cos(0) d1*cos(0);0 0 0 1;t21=cos(a2) -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*c

11、os(pi/2);0 0 0 1;t32=cos(a3) -sin(a3) 0 201;sin(a3)*cos(0) cos(a3)*cos(0) -sin(0) -d3*sin(0); sin(a3)*sin(0) cos(a3)*sin(0) cos(0) d3*cos(0);0 0 0 1;t43=cos(a4) -sin(a4) 0 0;sin(a4)*cos(-pi/2) cos(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/

12、2);0 0 0 1;t=t10*t21*t32*t43;f1=x-t(1,4);f2=y-t(2,4);f3=z-t(3,4);a1,a2,a3=solve(f1,f2,f3,a1,a2,a3);%转化为角度值a11=vpa(a1*180/pi,6)a22=vpa(a2*180/pi,6)a33=vpa(a3*180/pi,6) a11 = -.761823e-15 -180.000 -180.000 -.761818e-15 a22 = 149.960 30.0398 1.85098 178.149 a33 = -59.7578 -120.242 -59.7578 -120.2425.2速

13、度分析说明：先求出雅克比矩阵，我们可以得到末端执行器速度与各关节的速度关系。在末端执行器速度已知的情况下求的各关节的速度。a1=0*pi/180;a2=150*pi/180;a3=-60*pi/180;a4=0*pi/180;d1=40;d2=0;d3=0;d4=176;t10=cos(a1) -sin(a1) 0 0;sin(a1)*cos(0) cos(a1)*cos(0) -sin(0) -d1*sin(0); sin(a1)*sin(0) cos(a1)*sin(0) cos(0) d1*cos(0);0 0 0 1;t21=cos(a2) -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 0 0 1;t32=cos(a3) -sin(a3) 0 201;sin(a3)*cos(0) cos(a3)*cos(0) -sin(0) -d3*sin(0);