|
|
我试了一下是可以的。最近研究这块,希望可以交流一下。工具箱资料是peter corke写的那本吗?7 a7 t; z" w8 r" m
希望对你有用。 H5 v5 c& p& H+ k# ~
L{1} =link([0 0 0 0 0],'mod');
; k- |* ] `% n) t0 JL{2} = link([-pi/2 0 0 0.3 0],'mod');
, e3 k+ w9 A5 s6 IL{3} = link([0 0.4 0 -0.1 0],'mod');6 H3 L3 D; B7 W3 J7 c0 {
L{4} =link([pi/2 0.02 0 0.4 0],'mod');( s) m, _3 J6 O1 W: r, U
L{5} =link([-pi/2 0 0 0 0],'mod');
5 V4 t3 \! E/ T, X" R8 lL{6} =link([pi/2 0 0 0 0],'mod');# [. U: x5 ?5 [, m! C. G1 b
p560m=robot(L)5 o! F! w8 e7 c; W% r
p560b = p560m; % duplicate the robot. j9 @; m# Y& G. _% d3 ]
p560b.name ='Another Puma 560'; % give it a unique name H5 c# _) H7 }% w$ n; y ]* J
p560b.base = transl([-0.5 0.5 0]); % move its base
; E9 ~. d5 X8 C! fc=[0 0 pi/2 0 0 0];& ^6 |( k* P0 A; G2 N! Y
plot(p560m, c); % display it at ready position
: u X5 q6 Q& i3 ahold on;2 D8 w" S! A& {9 q( _
plot(p560b, c); % display it at ready position
; z. C5 T1 r7 p7 W0 \t = [0:0.05:1];
' G" s, V8 b6 b" u7 I. a2 ?2 W5 q# mqr = [0 pi/2 -pi/2 0 0 0];
- g8 a; U7 }' }8 z4 t; sjt = jtraj(c, qr, t); % trajectory to stretch pose9 l& ? a9 U+ }- L0 o
for q = jt' % for all points on the path( \; W1 G. Y$ d8 C8 `$ p) Z G
% hold on+ R6 c6 p& Z* h4 s6 Y; E! V
plot(p560m, q');- x& r% o* C- R. ]* Y5 b- d: Q
% hold on1 L0 j& B: E+ {5 i
plot(p560b, q');
6 p; i) b( R3 I1 @; G/ gend |
|