|
EDA365欢迎您登录!
您需要 登录 才可以下载或查看,没有帐号?注册
x
机器人在关节空间圆弧的轨迹规划仿真出现错误,仿真结果显示5 d [, J8 P- K. c3 S6 h
??? Error using ==> plot
& B' f9 @# P/ h6 v @5 J: EConversion to double from cell is not possible.$ q& M7 l7 c: M( e
Error in ==> sy2 at 29. E6 t. c% v4 h" N5 r3 V' ?) H/ Y
plot(t{i},q(:,1)). p$ p' s* ?# E$ f
麻烦帮忙解答,谢谢!0 T! o) z$ x4 I5 K: r' ]6 g6 V& A
/ a, L7 }" M& A( X, G: {程序如下:7 T) }% z. X0 j+ {* e. o% K. i
L{1}=link([0 0 -pi/2 0 0],'mod');
7 p9 F4 T; @& F' t1 T* TL{2}=link([pi/2 0 pi/2 0 0],'mod');& @( u0 \" i3 y' i8 \" L1 q1 S0 P, A
L{3}=link([0 1150 0 0 0],'mod');; j; O& V% z' N2 e5 e/ s$ V
L{4}=link([pi/2 0 0 1466 0],'mod');
& l+ V* y+ L* V5 ~L{5}=link([pi/2 -188 0 0 0],'mod');
3 j. S4 r( n& V# Ohithd=robot(L,'hithdrobot');
, U' K. T; |; i" N/ ?7 r# ?clear L
: _2 P: q4 G. K) @2 \5 Ualpha=0:pi/80:2*pi;%定义圆弧角( }$ | N. P/ {* Q8 l- W
R=30;%给定半径6 d6 N1 M8 W8 b, q% F6 ^2 ~7 W
a1=2022.5+R*sin(alpha);%定义x变量
) J: n1 h( X6 D6 M z+ u/ ab1=30-R*cos(alpha);%定义y变量2 q5 r C8 j* _0 F, T" n5 ~
for i=1:1:41
' k4 Q0 R% t9 pT{i}=[0 1 0 a1(:,i);0 0 1 b1(:,i);1 0 0 -230;0 0 0 1];%定义半圆弧上41个点的齐次变换矩阵- t+ M" f* f* d3 p( P8 o- a
end
3 H5 s" x/ P$ mfor i=1:1:40
3 y8 E E+ q, O% ? t{i}=[i:.025:i+1]';
1 s; J4 Z. u8 e1 Y9 b4 d c2 O7 TTa{i}=ctraj(T{i},T{i+1},length(t{i}));%生成40个线段的笛卡尔轨迹
9 n0 M+ x: g$ G5 m! s$ aend) ]$ \$ C, U: Y. t/ M" }
for i=1:1:40
! s& L4 s7 m6 m5 e3 F+ Vtic;
* t) n) n. F6 f+ a$ e3 Rq{i}=ikine(hithd,Ta{i});%运动学逆解40个线段的关节坐标
. ?) q1 @* x/ M% }- }0 [toc( `0 ~% E* N: M7 a F( u
end' X- ? f: K. J7 Q6 Y3 Y
subplot(3,1,1)0 @: |2 b. b1 Z) S+ d6 G
plot(t{i},q(:,1))
2 x9 h- m3 s* d# X! z* N: Xxlabel('Time(s)');0 p( ^2 M5 E6 B+ g( O, a
ylabel('Joint 1(rad)')
$ ^' S7 S+ x7 S/ C, f& j# y7 msubplot(3,1,2)7 M$ P# B4 E3 u2 L6 I
plot(t{i},q(:,2))
' E# W& q6 _5 u p3 A" \+ B: ^xlabel('Time(s)');2 J' Y& `* a; |2 q, e! d+ ~
ylabel('Joint 2(rad)')0 }' q6 I7 K. L. s7 b
subplot(3,1,3)6 s* v! J' m/ k/ Z1 z7 x
plot(t{i},q(:,3))
1 z. v* c* d; jxlabel('Time(s)');! `9 Z: O. ^: K3 c, O3 R/ u
ylabel('Joint 3(rad)')2 F# w) e% D8 b. N. I
hold on1 M, G/ { D* Z( ^7 b& W
|
|