精品文档燕山大学课 程 设 计 说 明 书题目：智能车及多功能机器人系统的设计与制作 --启动开关、涂胶及装配机械臂设计及控制模型建立姓 名： 分 工： 课程名称：机器人技术根底 指导教师： 智能车及多功能机器人系统的设计与制作 --启动开关、涂胶及装配机械臂设计及控制模型建立摘 要：本次设计以单片机为核心，分为三个局部，采用光电检测器循迹、避障、并用软件控制小车机械臂动作从而实现小车的自动行驶、转弯、寻迹检测、避障、停止、涂胶及装配等功能的智能控制系统机械臂局部，分为涂胶、装配螺栓两个动作，通过求正反解、速度雅克比、进行轨迹规划，通过单片机控制，实现功能前 言：机械手臂是目前在机械人技术领域中得到最广泛实际应用的自动化机械装置，在工业制造、医学治疗、娱乐效劳、军事、半导体制造以及太空探索等领域都能见到它的身影尽管它们的形态各有不同，但它们都有一个共同的特点，就是能够接受指令，精确地定位到三维〔或二维〕空间上的某一点进行作业在三级工程智能移动小车的根底上设计出机械臂和手爪，与小车组装为一体，通过程序控制，实现小车的避障，循迹，通讯，以及装配螺栓的动作。
装配机器人智能小车主要由机械系统，环境识别系统，运动控制系统及机械臂控制系统组成目录1 任务分析 42 方案设计一 53 方案设计二 53.1 机械臂尺寸确实定 53.2 工作空间 63.3 初始位置 73.3.1运动学正解 73.3.2 运动学反解 93.4 任意位姿 103.4.1 涂胶板竖直情形 103.4.2 开关和采果情形 153.5 速度分析 163.6 轨迹规划 183.7 详细程序 214 总结 225 参考文献 231 任务分析 要求在已设计的智能小车上加装机械臂，如图1完成：1、 按动开关，启动生产线； 2、 从地面的指定位置捡起直径为50-100mm的球；3、 到涂胶工位完成涂胶；4、 找到迷宫入口，进入迷宫——实现穿越迷宫5、 寻迹——到装配工位车体或机械臂旋转——手爪张开——实现对指定物体装配参数：承料台的高度：300mm螺栓规格：直径50mm开关高度：310mm(280~320mm)开关大小：60x60mm胶刷：圆柱形，直径50~100mm图12 方案设计一将机械手安装在小车侧面，可采用两个转动副的结构，此结构简单，只需控制三个电机，即可完成所需任务但是涂胶和装配螺栓时，手臂侧产生了一个向下的力，这个力使得小车产生一个侧向翻转力矩，可能会使小车不稳定，且这样的机械臂只能在一个平面内运动，在应用范围上受到限制。
3 方案设计二3.1 机械臂尺寸确实定 尺寸的设计主要考虑涂胶工位是否能实现同时在考虑涂胶工位时，考虑机械手最难到达的位置就是设计时重点考虑的位置涂胶工位参数如下：小车的高度80mm；假设小车在涂胶时，小车机械臂1涂胶板边界为200mm；涂胶中心线高260mm；涂胶用的圆柱刷直径80mm；涂胶偏移中心最大距离设为100mm；涂胶用的圆柱刷压入板3mm；根据以上尺寸考虑到如果机座太高那么整个机械手稳定性将降低，而机座太低那么机械臂2长度便会相应增长，影响工作空间，因此选给出杆1的尺寸为85mm；杆2的尺寸为180mm，杆3的尺寸为150mm如图2图2 机构简图 3.2 工作空间在solidworks中建立了机构简图后，直接描绘出工作空间，如图3图3 工作空间 工作空间是以机械臂1末端为圆心，机械臂2和机械臂3差值为半径的小圆，和机械臂2和机械臂3的和为大圆所围成的圆环，再围绕机械臂1回转形成的空心球环下面验算其他任意位姿位能否实现3.3 初始位置图4 初始位置 连杆参数表连杆参数iai-1(mm)αi-1(°)di〔mm〕关节变量初值(°)10085θ1020-900θ2-135318000θ34540-90150-90-903.3.1运动学正解由几何关系算得连杆转角θ1=0，θ2=-135，θ3=45，解得,带入验证x y z 的坐标,其中矩阵最后一列表示小球在原点坐标系中的位置。
syms a0 a1 a2 a3 y0 y1 y2 y3 d1 d2 d3 d4 x1 x2 x3 x4 %yi表示扭角，xi表示关节角a0=0a1=0a2=180a3=0y0=(0/180)*piy1=(-90/180)*piy2=(0/180)*piy3=(-90/180)*pid1=85d2=0d3=0d4=150x1=(0/180)*pix2=(-135/180)*pix3=(45/180)*pix4=(-90/180)*piT10=[cos(x1) -sin(x1) 0 a0;sin(x1)*cos(y0) cos(x1)*cos(y0) -sin(y0) -d1*sin(y0);sin(x1)*sin(y0) cos(x1)*sin(y0) cos(y0) d1*cos(y0);0 0 0 1]T21=[cos(x2) -sin(x2) 0 a1;sin(x2)*cos(y1) cos(x2)*cos(y1) -sin(y1) -d2*sin(y1);sin(x2)*sin(y1) cos(x2)*sin(y1) cos(y1) d2*cos(y1);0 0 0 1]T32=[cos(x3) -sin(x3) 0 a2;sin(x3)*cos(y2) cos(x3)*cos(y2) -sin(y2) -d3*sin(y2);sin(x3)*sin(y2) cos(x3)*sin(y2) cos(y2) d3*cos(y2);0 0 0 1]T43=[cos(x4) -sin(x4) 0 a3;sin(x4)*cos(y3) cos(x4)*cos(y3) -sin(y3) -d4*sin(y3);sin(x4)*sin(y3) cos(x4)*sin(y3) cos(y3) d4*cos(y3);0 0 0 1]T40=T10*T21*T32*T43T40 = -0.0000 0.0000 1.0000 22.7208 1.0000 -0.0000 0.0000 0.0000 0.0000 1.0000 0.0000 212.2792 0 0 0 1.0000所得结果和用solidworks仿真一致。
3.3.2 运动学反解 代入坐标x=--47.8461，y=0， z=210.0000根据等式左右两端对应相等解出关节旋转角度选择最优解syms a0 a1 a2 a3 y1 y2 y3 y4 y5 d1 d2 d3 d4 x1 x2 x3 x4 a b ca0=0a1=0a2=180a3=0y0=(0/180)*piy1=(-90/180)*piy2=(0/180)*piy3=(-90/180)*pid1=85d2=0d3=0d4=150x4=(-90/180)*pia=22.72 b=0c=212.28T10=[cos(x1) -sin(x1) 0 a0;sin(x1)*cos(y0) cos(x1)*cos(y0) -sin(y0) -d1*sin(y0);sin(x1)*sin(y0) cos(x1)*sin(y0) cos(y0) d1*cos(y0);0 0 0 1]T21=[cos(x2) -sin(x2) 0 a1;sin(x2)*cos(y1) cos(x2)*cos(y1) -sin(y1) -d2*sin(y1);sin(x2)*sin(y1) cos(x2)*sin(y1) cos(y1) d2*cos(y1);0 0 0 1]T32=[cos(x3) -sin(x3) 0 a2;sin(x3)*cos(y2) cos(x3)*cos(y2) -sin(y2) -d3*sin(y2);sin(x3)*sin(y2) cos(x3)*sin(y2) cos(y2) d3*cos(y2);0 0 0 1]T43=[cos(x4) -sin(x4) 0 a3;sin(x4)*cos(y3) cos(x4)*cos(y3) -sin(y3) -d4*sin(y3);sin(x4)*sin(y3) cos(x4)*sin(y3) cos(y3) d4*cos(y3);0 0 0 1]T40=T10*T21*T32*T43f1=a-T40(1,4)f2=b-T40(2,4)f3=c-T40(3,4)[x1,x2,x3]=solve(f1,f2,f3,x1,x2,x3)%转化为角度值x11=vpa(x1*180/pi,6)x22=vpa(x2*180/pi,6)x33=vpa(x3*180/pi,6)结果：x11 = -.350831e-14 -180.000 -.350836e-14 -180.000x22 = -135.000 -155.242 -24.7576 -44.9995x33 = 44.9998 44.9998 135.000 135.000 即，θ1=0，θ2=-135，θ3=45 满足所需设计3.4 任意位姿3.4.1 涂胶情形 当机械臂在最高位时，如图5 图5 涂胶板竖直最高位可用求反解的方式验证，程序如下：syms a0 a1 a2 a3 y1 y2 y3 y4 y5 d1 d2 d3 d4 x1 x2 x3 x4 a b ca0=0a1=0a2=180a3=0y0=(0/180)*piy1=(-90/180)*piy2=(0/180)*piy3=(-90/180)*pid1=85d2=0d3=0d4=150x4=(-90/180)*pia=250b=0c=290T10=[cos(x1) -sin(x1) 0 a0;sin(x1)*cos(y0) cos(x1)*cos(y0) -sin(y0) -d1*sin(y0);sin(x1)*sin(y0) cos(x1)*sin(y0) cos(y0) d1*cos(y0);0 0 0 1]T21=[cos(x2) -sin(x2) 0 a1;sin(x2)*cos(y1) cos(x2)*cos(y1) -sin(y1) -d2*sin(y1);sin(x2)*sin(y1) cos(x2)*sin(y1) cos(y1) d2*cos(y1);0 0 0 1]T32=[cos(x3) -sin(x3) 0 a2;sin(x3)*cos(y2) cos(x3)*cos(y2) -sin(y2) -d3*sin(y2);sin(x3)*sin。