|
|
EDA365欢迎您登录!
您需要 登录 才可以下载或查看,没有帐号?注册
x
matlab robotics toolbox的逆运动学求解ikine为题。0 r3 d: N& y/ T7 T5 H, M
代码如下:/ @2 H" t! `( L/ G5 j0 O# |
clear all;
5 ^ o& q. `9 Xclc;- i X+ K+ B/ C. u; q0 K, \' U
startup_rvc;9 ^( y3 ?% ]4 V1 _5 D0 ]0 L7 O' {
L(1) = Link([0,0.194,0.45,0,0]);
$ J& u( a3 r6 T) k: JL(1).qlim=([-130*pi/180,130*pi/180]);
! A# x- k" K6 n9 o) v9 _2 P: ?L(2) = Link([0,0.072,0.35,0,0]);
' J5 R9 Z2 [5 K* D$ xL(2).qlim=([-5*pi/6,5*pi/6]); w( w( d/ T& p
L(3) = Link([0,0,0,0,1]);
2 v y6 L* T9 E/ R2 R+ q3 dL(3).qlim=[0,0.5]; ( u. ]5 U) z) ` R z& }" ?
L(4) = Link([0,0,0,0,0]);
. v9 V, v8 [; rL(4).qlim=([-pi,pi]);
4 a* O8 e% ?* S! e6 |- Ybot = SerialLink(L); %连接连杆
( R/ u7 q) O% G1 cbot.name='SCARA';
3 o0 J5 }& a3 l! g8 R, rbot.display() %显示D-H参数表( f, j: ?. q8 p! b
bot.teach()) g# ~. A# x" z1 E
$ `8 D5 Q, m9 L) k: LT=[-0.2588 0.9659 0 0.1344;-0.9659 -0.2588 0 0.7278;0 0 1 0.366;0 0 0 1]
2 [1 w: ^0 K# R1 i3 p0 Xinverse_kinematics=bot.ikine(T) %逆向运动学. 这个逆解为啥就是不能求?????
, [* o) I) i l) b$ |+ i& p1 |" P
, x8 }" e! |3 i1 a Z
1 v' N7 V) B0 F1 x! Y& L3 {6 j) rtheta1=inverse_kinematics(1);% N; `# r1 q6 \+ N. B+ Q h, Q
theta2=inverse_kinematics(2);, r; n( M+ [: m9 U9 j7 ~5 U+ ^
d=inverse_kinematics(3);4 Y3 `( k- V+ F7 K, t2 |7 C) [
theta4=inverse_kinematics(4);
7 V0 _& g2 ]- }, x9 [! o( Uforward_kinematics=bot.fkine([theta1 theta2 d theta4])
" a. d* O2 L& I错误信息:6 K: M1 i& y; |7 @7 p* [* i
Error using SerialLink/ikine (line 164)
" R- E. d+ V8 c- m+ C4 INumber of robot DOF must be >= the same number of 1s in the mask matrix' O7 R5 n# L5 Q
& b) P( U- ?6 a2 G9 AError in ikine (line 19): l: d( P4 D! u' M
inverse_kinematics=bot.ikine(T)
0 Q4 G; _1 C7 {- F- K
0 E( c% i5 p( q( {" v& E8 s$ M) p/ X3 p
7 a* S7 b6 W9 z/ ]
求助大神! V" f9 d$ ^- }9 h& N4 @
|
|