机器人技术大作业(puma机器人的关节坐标建立、D-H参数表给出、正逆运动学推导、matlab工作空间建立)(共7页).docx

《机器人技术大作业(puma机器人的关节坐标建立、D-H参数表给出、正逆运动学推导、matlab工作空间建立)(共7页).docx》由会员分享，可在线阅读，更多相关《机器人技术大作业(puma机器人的关节坐标建立、D-H参数表给出、正逆运动学推导、matlab工作空间建立)(共7页).docx（7页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。

1、精选优质文档-倾情为你奉上PUMA机器人大作业1 坐标系建立：坐标系可以简化为：2 D-H参数表：PUMA机器人的杆件参数:，关节运动范围190000-160o160o20-900-225o45o3-9000-45o 225o40-90-110 o 170 o509000-100 o 100 o60-900-266 o 266 o3 正运动学推导由式可得：，机械手变换矩阵4 逆运动学推导1求用逆变换左乘方程两边：得三角代换 ，式中，得到的解2求矩阵方程两端的元素（1，4）和（2，4）分别对应相等平方和为：其中 解得：3求在矩阵方程两边左乘逆变换。方程两边的元素（1，4）和（3，4）分别对应相等

2、，得联立，得和和表达式的分母相等，且为正，于是根据解和的四种可能组合，可以得到相应的四种可能值，于是可得到的四种可能解式中取与相对应的值。4求令两边元素（1，3）和（2，3）分别对应相等，则可得只要，便可求出当时，机械手处于奇异形位。5求根据矩阵两边元素（1，3）和（2，3）分别对应相等，可得6求根据矩阵两边元素（2，1）和（1，1）分别对应相等，可得从而求得5 Matlab编程得出工作空间可以将连杆6的原点做为机器人的动点，连杆6原点相对于坐标系0就是的、，已知：Matlab程序如下：clc,clearlength2=431.8;length3=20.32;d2=149.09;d4=433.

3、07;a=pi/180;for a1=-160*a:20*a:160*a for a2=-225*a:20*a:45*a a3=-45*a:20*a:225*a for k=1:length(a3) px(k)=cos(a1)*(length2*cos(a2)+length3*cos(a2+a3(k)-d4*sin(a2+a3(k)-d2*sin(a1) py(k)=sin(a1)*(length2*cos(a2)+length3*cos(a2+a3(k)-d4*sin(a2+a3(k)+d2*cos(a1) pz(k)=-a3(k)*sin(a2+a3(k)-length2*sin(a2)-d4*cos(a2+a3(k) end plot3(px,py,pz),title(机器人的工作空间),xlabel(x mm),ylabel(y mm),zlabel(z mm) hold on grid on endend机器人工作空间三维空间：专心-专注-专业