|
|
EDA365欢迎您登录!
您需要 登录 才可以下载或查看,没有帐号?注册
x
机器人在关节空间圆弧的轨迹规划仿真出现错误,仿真结果显示
8 C7 Z% O" S7 }1 a??? Error using ==> plot
9 C7 ~ E2 V! c! K& J5 i! R# U# [: J) s5 cConversion to double from cell is not possible.* @9 v$ _5 Z4 }3 l, {4 x8 D8 q) Y
Error in ==> sy2 at 29: M) `- e2 l3 M( {+ y; V5 t
plot(t{i},q(:,1))8 B* @6 @+ s" y; L
麻烦帮忙解答,谢谢!
6 v# d% X/ j) S! H% b/ z
" A' \' D. v$ A6 X程序如下:1 n" S0 M2 _! i6 l; K: O
L{1}=link([0 0 -pi/2 0 0],'mod');
; {1 k% R# d' P. g9 LL{2}=link([pi/2 0 pi/2 0 0],'mod');
& C6 [. j* n' l8 eL{3}=link([0 1150 0 0 0],'mod');6 O6 G; ~$ u d+ j3 i4 V/ M0 t5 g
L{4}=link([pi/2 0 0 1466 0],'mod');0 j- g. @5 b+ J/ l" z5 ~4 j' O
L{5}=link([pi/2 -188 0 0 0],'mod');
3 m( F7 M) u& s2 d$ shithd=robot(L,'hithdrobot');* ?1 M& c! m8 E4 W
clear L7 b$ u$ f- P; Y* g0 ?7 c/ o- f
alpha=0:pi/80:2*pi;%定义圆弧角
! i4 p0 t4 P- t$ |6 \R=30;%给定半径0 d& L2 n2 S- V. e5 Y2 o+ y5 L
a1=2022.5+R*sin(alpha);%定义x变量
- |' L+ j0 j. S+ m3 v9 U/ {b1=30-R*cos(alpha);%定义y变量6 j% U$ z* r. E8 H
for i=1:1:412 l* n) y+ b: k3 N7 H) ]7 r6 B
T{i}=[0 1 0 a1(:,i);0 0 1 b1(:,i);1 0 0 -230;0 0 0 1];%定义半圆弧上41个点的齐次变换矩阵
7 k8 I* o/ l( ~0 h% dend7 z N4 x0 O7 t t: J$ o: w
for i=1:1:40
4 J' P) H" g3 N t{i}=[i:.025:i+1]';
& J9 j5 K6 ^2 W1 `6 F% x/ uTa{i}=ctraj(T{i},T{i+1},length(t{i}));%生成40个线段的笛卡尔轨迹
" [3 X' `& n- V3 D M' \' \, o- gend' k. _3 X) r) g- }
for i=1:1:40& r' _. o% N9 a; g9 j6 R S
tic;2 q/ @$ X5 p4 _% D6 x! k# f t% o9 ]+ A
q{i}=ikine(hithd,Ta{i});%运动学逆解40个线段的关节坐标: w! n# e6 |9 W+ N/ }. b# e$ G
toc+ }1 w- ]7 d- h D
end0 ~" R1 }. g2 Q6 R$ J9 J
subplot(3,1,1)
$ ^. X1 H6 M5 Q% R* X' k$ Xplot(t{i},q(:,1))
& ~( G0 @2 T% [4 Cxlabel('Time(s)'); s' h) i( _& ^4 X
ylabel('Joint 1(rad)'), B: F/ b* k8 A& H: Z" b# U1 r
subplot(3,1,2)% y. K9 Z5 Y; q
plot(t{i},q(:,2))' [, c$ A7 r; w! ^6 `( S: @
xlabel('Time(s)');* w7 W- k: @& |; M; x
ylabel('Joint 2(rad)')2 R. y# b" c! n. R6 U
subplot(3,1,3)( A6 k' w+ G `& X. k. O
plot(t{i},q(:,3))$ k+ @5 X$ d* R
xlabel('Time(s)');9 R+ Z% ]3 y6 o& i2 B' E+ z5 b
ylabel('Joint 3(rad)')
8 j& e6 O' x7 O N! ~hold on
9 B( C' a/ r* C+ O/ m% ?' u; Z |
|