雅可比矩陣描述了關(guān)節(jié)空間和笛卡爾空間的速度和角速度映射關(guān)系。
初學(xué)者入門通常會(huì)使用matlab中的robotics toolbox，在進(jìn)行操作空間末端速度求解時(shí)會(huì)有疑問(wèn)jacob0函數(shù)是怎樣實(shí)現(xiàn)的。
在網(wǎng)上有很多人公布了jacobian求解的代碼，但是都不能運(yùn)行出正確的結(jié)果，本文給出了與機(jī)器人工具箱jacob0函數(shù)出一樣結(jié)果的方法。
其公式基于：
syms theta1 theta2 theta3 theta4 theta5 theta6
theta1 = 0;theta2 = -90;theta3 = 90; theta4 =-180; theta5 = -90; theta6 = 0;
T01 = trans(theta1, 0, 0, 90); %theta是角度制
T12 = trans(theta2, 129,-310, 0);
T23 = trans(theta3,-129,-286, 0);
T34 = trans(theta4,93.5, 0, 90);
T45 = trans(theta5,93.5, 0,-90);
T56 = trans(theta6,67.5, 0, 0);
T02 = T01*T12;
T03 = T01*T12*T23;
T04 = T01*T12*T23*T34;
T05 = T01*T12*T23*T34*T45;
T06 = T01*T12*T23*T34*T45*T56;
P01 = [T01(1,4);T01(2,4);T01(3,4)];
P02 = [T02(1,4);T02(2,4);T02(3,4)];
P03 = [T03(1,4);T03(2,4);T03(3,4)];
P04 = [T04(1,4);T04(2,4);T04(3,4)];
P05 = [T05(1,4);T05(2,4);T05(3,4)];
P06 = [T06(1,4);T06(2,4);T06(3,4)];
z1 = T01(1:3,3);
z2 = T02(1:3,3);
z3 = T03(1:3,3);
z4 = T04(1:3,3);
z5 = T05(1:3,3);
z6 = T06(1:3,3);
j1 = [cross([0;0;1],P06 );[0;0;1]];
j2 = [cross(z1,P06-P01);z1];
j3 = [cross(z2,P06-P02);z2];
j4 = [cross(z3,P06-P03);z3];
j5 = [cross(z4,P06-P04);z4];
j6 = [cross(z5,P06-P05);z5];
jacobian0 = [j1,j2,j3,j4,j5,j6]
function T = trans(theta, d, a, alpha)
T = [cos(deg2rad(theta)),-cos(deg2rad(alpha))*sin(deg2rad(theta)), sin(deg2rad(alpha))*sin(deg2rad(theta)),a*cos(deg2rad(theta));
sin(deg2rad(theta)), cos(deg2rad(alpha))*cos(deg2rad(theta)),-sin(deg2rad(alpha))*cos(deg2rad(theta)),a*sin(deg2rad(theta));
0, sin(deg2rad(alpha)), cos(deg2rad(alpha)), d;
0, 0, 0, 1];
end
輸出結(jié)果：
對(duì)你有幫助的話就幫忙點(diǎn)個(gè)贊吧~文章來(lái)源：http://www.zghlxwxcb.cn/news/detail-807840.html
機(jī)器人工具箱結(jié)果：
文章來(lái)源地址http://www.zghlxwxcb.cn/news/detail-807840.html
到了這里，關(guān)于6自由度機(jī)械臂雅克比矩陣求解，結(jié)果同jacob0函數(shù)的文章就介紹完了。如果您還想了解更多內(nèi)容，請(qǐng)?jiān)谟疑辖撬阉鱐OY模板網(wǎng)以前的文章或繼續(xù)瀏覽下面的相關(guān)文章，希望大家以后多多支持TOY模板網(wǎng)！
