|
|
我试了一下是可以的。最近研究这块,希望可以交流一下。工具箱资料是peter corke写的那本吗? H3 ^8 F7 p+ Y: B5 ]* |, ?2 {7 G6 |
希望对你有用。 G: C+ r" o5 I3 ]
L{1} =link([0 0 0 0 0],'mod');
3 M% P/ c) R' q9 N) {L{2} = link([-pi/2 0 0 0.3 0],'mod');' X x! Z4 s8 X% @/ d
L{3} = link([0 0.4 0 -0.1 0],'mod');
, I; D2 C& O: b' {0 O, }& IL{4} =link([pi/2 0.02 0 0.4 0],'mod');& t4 F9 ?1 Q6 r3 w
L{5} =link([-pi/2 0 0 0 0],'mod');
/ I5 L# S0 }3 @; g8 \ hL{6} =link([pi/2 0 0 0 0],'mod');
5 t# c+ p$ l6 k7 P: Rp560m=robot(L)
+ l- ~8 U8 P, y6 ep560b = p560m; % duplicate the robot
8 [) X. w0 I( A5 s- Ip560b.name ='Another Puma 560'; % give it a unique name% n( U1 |6 h1 w9 p* |! j' K
p560b.base = transl([-0.5 0.5 0]); % move its base
# l- \+ o9 L, u. q V. wc=[0 0 pi/2 0 0 0];
7 ]0 R' K& i5 {" c$ H. q- jplot(p560m, c); % display it at ready position
) G, _" t3 C$ i/ mhold on;6 G1 g1 O: d8 @2 ?* Y$ g3 O" E3 G- m
plot(p560b, c); % display it at ready position
1 p2 W8 R1 G* m5 w; I0 ^! h) wt = [0:0.05:1];
S8 z0 x2 s% C) T* wqr = [0 pi/2 -pi/2 0 0 0];% c0 l: X/ u" t4 d
jt = jtraj(c, qr, t); % trajectory to stretch pose
. C$ a9 A$ y) c q; i) h- zfor q = jt' % for all points on the path! x7 D/ V3 X1 t9 t1 X/ F/ S- Z! o
% hold on
: _ N& ^* A9 m& y5 P plot(p560m, q');
3 h7 T$ R: o9 ^ ]& J% hold on( e j8 M: \( Y" J- z' C
plot(p560b, q');* w1 w C6 V" g1 {
end |
|