|
我试了一下是可以的。最近研究这块,希望可以交流一下。工具箱资料是peter corke写的那本吗?
4 _+ \; M7 a8 p- t0 w) W希望对你有用。* x6 X/ t5 t; |0 z
L{1} =link([0 0 0 0 0],'mod');
: D& p0 u6 u9 @# T- F, E5 g6 F5 _L{2} = link([-pi/2 0 0 0.3 0],'mod');( [1 U0 [4 t: `1 K- i
L{3} = link([0 0.4 0 -0.1 0],'mod');
* f9 p& c+ J5 P( SL{4} =link([pi/2 0.02 0 0.4 0],'mod');. T! {3 Y4 V1 b8 ^
L{5} =link([-pi/2 0 0 0 0],'mod');0 n( V. P U# [) c* v7 ]
L{6} =link([pi/2 0 0 0 0],'mod');! m% m4 u/ g4 T( V+ q. W1 v
p560m=robot(L)- P q4 R0 H- i" ?, X4 _5 a
p560b = p560m; % duplicate the robot, X8 _" ^; F% ?2 e! z! Q
p560b.name ='Another Puma 560'; % give it a unique name
9 a; X* w+ I/ F T) Ep560b.base = transl([-0.5 0.5 0]); % move its base z' T/ J, Q9 L4 `
c=[0 0 pi/2 0 0 0];
) @% x* E. X& _" ]7 j. w/ `9 R! uplot(p560m, c); % display it at ready position
% i, _. C' @, A# _, Fhold on;* H: X$ B; @. }
plot(p560b, c); % display it at ready position
' F- g; u" H. Q: k7 c& nt = [0:0.05:1];
% Z- f9 E2 N8 a5 f8 ^qr = [0 pi/2 -pi/2 0 0 0];$ i5 x& p6 E# K" ]
jt = jtraj(c, qr, t); % trajectory to stretch pose
2 y8 h m. F' n: \$ s& Z- Qfor q = jt' % for all points on the path
! X. X# C/ j5 k% hold on+ b' @4 l8 x1 n& F, ]) a6 @9 l/ ^
plot(p560m, q');
+ W1 R+ k. @1 s9 P D% hold on
3 ?3 J! \- ^: y F9 o plot(p560b, q');0 F" f7 J T) \% M$ r5 r
end |
|