|
|
EDA365欢迎您登录!
您需要 登录 才可以下载或查看,没有帐号?注册
x
机器人在关节空间圆弧的轨迹规划仿真出现错误,仿真结果显示
. a3 V0 J9 v: B# P. r??? Error using ==> plot. m T! i2 e+ i$ \
Conversion to double from cell is not possible.2 J; s$ j; ?8 r2 d/ a! \# K
Error in ==> sy2 at 29# X o& ^ O$ ?- ^$ u3 b8 z
plot(t{i},q(:,1))
# d! b# Z% C- q& [& V1 R+ ~麻烦帮忙解答,谢谢!0 k) B8 F; [6 j# D- E2 U* d
+ Y+ z, O6 g( y: k
程序如下:7 Z) h4 @$ d4 x3 c! f7 J2 O% S9 D
L{1}=link([0 0 -pi/2 0 0],'mod');
8 I8 F8 U' X6 o* r1 A- K- GL{2}=link([pi/2 0 pi/2 0 0],'mod');
9 n. e, O7 t% r$ x( R9 M' k; FL{3}=link([0 1150 0 0 0],'mod');5 P+ h& s5 I) D7 D" B
L{4}=link([pi/2 0 0 1466 0],'mod');
1 g1 G2 u+ P3 s' I- A7 |( n) F: ?L{5}=link([pi/2 -188 0 0 0],'mod');1 Y! r8 H; Y1 z
hithd=robot(L,'hithdrobot');
* Q! g9 x# Q, l' uclear L2 |4 O3 {$ f: E4 S1 q
alpha=0:pi/80:2*pi;%定义圆弧角: l9 Z* W* N% Z& H
R=30;%给定半径 U$ b: V2 a, g
a1=2022.5+R*sin(alpha);%定义x变量3 u' H4 A8 `! j/ ?# e
b1=30-R*cos(alpha);%定义y变量
4 T/ \, B( _& g! i9 @# ?. G" Ffor i=1:1:41. X7 r; O8 c0 M9 o
T{i}=[0 1 0 a1(:,i);0 0 1 b1(:,i);1 0 0 -230;0 0 0 1];%定义半圆弧上41个点的齐次变换矩阵
5 j8 A/ i# y1 z! oend9 L, _% g; _9 a7 J6 o8 h$ n
for i=1:1:40
' B0 p8 \, a8 L7 F# I t{i}=[i:.025:i+1]';: ^3 ^* q; U4 V+ g: ^5 d) C C
Ta{i}=ctraj(T{i},T{i+1},length(t{i}));%生成40个线段的笛卡尔轨迹
" S4 x/ o1 N2 y& j4 ?& t& Gend
8 j( C7 p B' `7 O" V& ~for i=1:1:402 \2 `# N) t* d. A0 N) d1 f" n
tic;
7 C: C, H6 ~ k2 @+ o6 Qq{i}=ikine(hithd,Ta{i});%运动学逆解40个线段的关节坐标
$ t. y. t- a" b6 C, E, v. vtoc
4 { i0 A. A) s- H. W% o9 Z, bend: E6 U, \( r, d9 I' O+ e
subplot(3,1,1)
2 C. e: s1 H) J& kplot(t{i},q(:,1))2 M/ L+ t: ^" E: _5 K. I
xlabel('Time(s)');1 d6 }. ]5 o% U6 S, ^
ylabel('Joint 1(rad)')1 T! i4 V5 }0 A) a4 L
subplot(3,1,2): R8 z6 B ?# l# H3 A* F
plot(t{i},q(:,2))
) T6 S" \# c g! Vxlabel('Time(s)');
/ v5 }2 }% @& j' eylabel('Joint 2(rad)')
* ]. D( r5 i# |subplot(3,1,3)
: F% |5 V4 V/ c" ^5 I" l2 J% vplot(t{i},q(:,3))4 ^% D8 @8 m2 {9 ^
xlabel('Time(s)');$ b( Y2 B4 H: m
ylabel('Joint 3(rad)')
) c- n: h! {) \: m- H khold on3 d" h) g; P q" l9 U- |( e
|
|