|
我试了一下是可以的。最近研究这块,希望可以交流一下。工具箱资料是peter corke写的那本吗?, f! F; `' R4 T4 Y- c6 j
希望对你有用。
% U# s, @/ f4 ^) o. qL{1} =link([0 0 0 0 0],'mod');
/ B7 a' `* C f, f- s! A LL{2} = link([-pi/2 0 0 0.3 0],'mod');
0 n, v( F) r$ [8 QL{3} = link([0 0.4 0 -0.1 0],'mod');
& o U6 G( X- R5 |3 U# r5 DL{4} =link([pi/2 0.02 0 0.4 0],'mod');# j; E6 d. k, y, c; H8 c6 ]4 z
L{5} =link([-pi/2 0 0 0 0],'mod');# H# Y$ Q* `, t
L{6} =link([pi/2 0 0 0 0],'mod');
! E) Q, X5 a. R- B: Ip560m=robot(L)! G! S- L) H& X, D0 S/ P1 C
p560b = p560m; % duplicate the robot2 M/ z" O$ P% f9 U5 j
p560b.name ='Another Puma 560'; % give it a unique name
7 W! C: i. T2 M: r$ up560b.base = transl([-0.5 0.5 0]); % move its base( }" @7 D0 c% I4 t0 t7 b2 {
c=[0 0 pi/2 0 0 0];& O- ]4 V3 V9 n# \! T
plot(p560m, c); % display it at ready position1 J$ g; n$ Z0 w. v2 w8 }# m- B
hold on;
3 @% Z6 C3 o. c. y6 p' P2 N* fplot(p560b, c); % display it at ready position. U. \6 Y$ O6 W' E. H; ?
t = [0:0.05:1];
7 I1 C. D4 }2 F, ]. F( Sqr = [0 pi/2 -pi/2 0 0 0];, s# A* t. Q- q) Q# v& s8 x4 B; _
jt = jtraj(c, qr, t); % trajectory to stretch pose
$ ]. ~8 Y& b9 B" L0 O) T: [for q = jt' % for all points on the path
" a h5 j! a0 i% hold on
$ z# O6 Y I9 C- y! M8 s8 a plot(p560m, q');- X. c/ p J+ I& b; E0 c
% hold on2 ^' s" y, ]2 w* o0 u
plot(p560b, q');
* M4 a4 s2 ~: P5 [end |
|