|
我试了一下是可以的。最近研究这块,希望可以交流一下。工具箱资料是peter corke写的那本吗?
9 e4 u3 }$ P0 V, C希望对你有用。
9 Y, \7 w) y) K( v* qL{1} =link([0 0 0 0 0],'mod');
) I+ k" j+ E; g& R1 gL{2} = link([-pi/2 0 0 0.3 0],'mod');
2 m6 [; T+ y1 P: ]L{3} = link([0 0.4 0 -0.1 0],'mod');" m- R g4 m! h6 Q) F
L{4} =link([pi/2 0.02 0 0.4 0],'mod');5 ?8 c- q+ F8 y% B) U2 p- y1 j- V
L{5} =link([-pi/2 0 0 0 0],'mod');
" J, V) }- M0 dL{6} =link([pi/2 0 0 0 0],'mod');5 b- a, p% S4 L, `
p560m=robot(L)6 I: B# x& |) o$ v, _' }& ?# D
p560b = p560m; % duplicate the robot6 L$ Z2 _% d: `6 ?
p560b.name ='Another Puma 560'; % give it a unique name
# B" t- H& e) [' P; `( Z; xp560b.base = transl([-0.5 0.5 0]); % move its base, }1 f3 k( q4 }7 R, a8 G/ s! b
c=[0 0 pi/2 0 0 0];
+ J- j/ w% P' s+ f* splot(p560m, c); % display it at ready position
2 q9 k4 K; m8 d8 w2 T1 |( v0 Bhold on;) M3 H) ]) G$ N7 f; K( z
plot(p560b, c); % display it at ready position+ L6 E. _) d/ X; `9 Q
t = [0:0.05:1];
: D0 j5 l& N) dqr = [0 pi/2 -pi/2 0 0 0];1 Q3 K5 _# I" h! H4 V& P
jt = jtraj(c, qr, t); % trajectory to stretch pose
1 I4 L4 O: w+ e( Afor q = jt' % for all points on the path
, [! d% \3 N9 ?7 z, l% hold on
7 {' Q i1 k6 p# ~ plot(p560m, q');0 K+ o+ c, I7 H9 S
% hold on1 y" z- F7 ?( K' u. }9 T
plot(p560b, q');4 t! x* n( ?. z7 Z: [2 {$ M
end |
|