|
|
我试了一下是可以的。最近研究这块,希望可以交流一下。工具箱资料是peter corke写的那本吗?+ L5 D- N' ?1 D9 N" }/ p# D- ]% u
希望对你有用。# U( ~( e# L/ l% \3 P
L{1} =link([0 0 0 0 0],'mod');# F; s7 g3 ^7 s ]' O& Q
L{2} = link([-pi/2 0 0 0.3 0],'mod');
. o( v7 A% [/ e* ?& h6 }L{3} = link([0 0.4 0 -0.1 0],'mod');
5 W- ^' f) \% D2 v5 AL{4} =link([pi/2 0.02 0 0.4 0],'mod');
8 \/ v7 F' w, w- }L{5} =link([-pi/2 0 0 0 0],'mod');
% ]3 y) A/ R% C7 J" |( l* E6 eL{6} =link([pi/2 0 0 0 0],'mod');4 q- E" |7 j' Q& T8 y/ E) S% i
p560m=robot(L)
/ _2 T" X* ?2 Ap560b = p560m; % duplicate the robot
* J, q0 B( v6 }" e( y! Dp560b.name ='Another Puma 560'; % give it a unique name
" ^9 { ~; C Q7 U1 ^: Vp560b.base = transl([-0.5 0.5 0]); % move its base5 ]9 r1 d4 @( O. c+ b. d; f3 a# l
c=[0 0 pi/2 0 0 0];6 U% O. s9 V) U0 G+ @
plot(p560m, c); % display it at ready position; b7 p$ A. U3 u: t/ p
hold on;; H2 g$ |1 d8 h0 S. R: S
plot(p560b, c); % display it at ready position, G) s# w, o' S+ C6 e
t = [0:0.05:1];
: q& f( X8 ~- x' v0 Z4 g$ B5 Y$ x) j hqr = [0 pi/2 -pi/2 0 0 0];
8 |7 c- {& l8 X! u0 b- H2 bjt = jtraj(c, qr, t); % trajectory to stretch pose0 q+ k* [$ b# @" g; S+ E$ r; G) y) \
for q = jt' % for all points on the path6 Q6 y7 E4 N& ]; ?. f5 P3 _* v
% hold on
! F6 @3 M3 u( w! u \& ]4 T plot(p560m, q');5 H! [# J5 n) u
% hold on
# R$ j. B8 E& U( L' \; R plot(p560b, q');3 Q% m# _3 u2 s9 M& c; Y
end |
|