UR5e协作机器人正运动学仿真分析
作者:互联网
function [ G ] = ur5fwdtrans( targetJoints, i )
%UR5FWDTRANS - Long Qian
% Forward kinematics of UR5 using transformation theory
% targetJoints specify the joint value for 6 joints of UR5
% i specifies the output transformation from joint 0 to joint i
d1 = 0.089159;
d2 = 0;
d3 = 0;
d4 = 0.10915;
d5 = 0.09465;
d6 = 0.0823;
a1 = 0;
a2 = -0.425;
a3 = -0.39225;
a4 = 0;
a5 = 0;
a6 = 0;
alpha1 = pi/2;
alpha2 = 0;
alpha3 = 0;
alpha4 = pi/2;
alpha5 = -pi/2;
alpha6 = 0;
T01 = DH(a1, alpha1, d1, targetJoints(1));
T12 = DH(a2, alpha2, d2, targetJoints(2));
T23 = DH(a3, alpha3, d3, targetJoints(3));
T34 = DH(a4, alpha4, d4, targetJoints(4));
T45 = DH(a5, alpha5, d5, targetJoints(5));
T56 = DH(a6, alpha6, d6, targetJoints(6));
if i==1
G = T01;
elseif i==
标签:仿真,targetJoints,DH,运动学,joint,UR5e,d6,d4,pi 来源: https://blog.csdn.net/weixin_51367832/article/details/122626019