I'm coding a Kuka robot jacobian matrix. but I get below errors!

10 Ansichten (letzte 30 Tage)
Sina Keshavarz
Sina Keshavarz am 23 Feb. 2017
syms q1 q2 q3 q4 q5 q6 q7 d1 d2 d3 d4 d5 d6 d7 z1 p1
syms a1 a2 a3 a4 a5 a6 a7 l1 l2 l3 l4 l5 l6 l7
d=[0 0 d3 0 d5 0 0];
b=[q1 q2 q3 q4 q5 q6 q7];
%%we define 'a' & 'l' matrice sizes
a=[90 -90 -90 90 90 -90 0];
l=[0 0 0 0 0 0 0];
%%defining 'z' & 'p' as a matrix variable
z=[z1 0 0 0 0 0 0;0 0 0 0 0 0 0;0 0 0 0 0 0 0];
p=[p1 0 0 0 0 0 0;0 0 0 0 0 0 0;0 0 0 0 0 0 0];
%%Calculating Rotation Matrix
T=eye(4);
for i=1:7
%%because cos(pi/2)=!0 ,so we use degrees instead of rads for a
%%matrix
A=[cos(b(i)) -sin(b(i))*cosd(a(i)) sin(b(i))*sind(a(i)) l(i)*cos(b(i));
sin(b(i)) cos(b(i))*cosd(a(i)) -cos(b(i))*sind(a(i)) l(i)*sin(b(i));
0 sind(a(i)) cosd(a(i)) d(i) ;
0 0 0 1 ];
T=T*A;
%%calculating Z & Position Matrices in case to find Jacobian Matrice
z(1:3,i)=T(1:3,3);
p(1:3,i)=T(1:3,4);
end
w=[0;0;0];
P=horzcat(w,p);
Z=horzcat(z,w);
%%Jacobian Matrice
Jac=[cross(Z(:,1),(P(:,8)-P(:,1))) cross(Z(:,2),(P(:,8)-P(:,2)))
cross(Z(:,3),(P(:,8)-P(:,3))) cross(Z(:,4),(P(:,8)-P(:,4)))
cross(Z(:,5),(P(:,8)-P(:,5))) cross(Z(:,6),(P(:,8)-P(:,6)))
cross(Z(:,7),(P(:,8)-P(:,7)));
Z(:,1) Z(:,2) Z(:,3) Z(:,4) Z(:,5) Z(:,6) Z(:,7) ];
simplify(T);simplify(z);simplify(P),simplify(Jac);
Error using sym/cat>checkDimensions (line 74) CAT arguments dimensions are not consistent.
Error in sym/cat>catMany (line 39) [resz, ranges] = checkDimensions(sz,dim);
Error in sym/cat (line 31) ySym = catMany(dim, args);
Error in sym/vertcat (line 19) ySym = cat(1,args{:});
which part of my program is wrong?

Antworten (0)

Kategorien

Mehr zu ROS Toolbox finden Sie in Help Center und File Exchange

Community Treasure Hunt

Find the treasures in MATLAB Central and discover how the community can help you!

Start Hunting!

Translated by