|
EDA365欢迎您登录!
您需要 登录 才可以下载或查看,没有帐号?注册
x
机器人在关节空间圆弧的轨迹规划仿真出现错误,仿真结果显示
2 I; q. {) T6 S s$ p7 d??? Error using ==> plot ^! ]/ \ \( T/ o% U
Conversion to double from cell is not possible.* ]- c9 v/ H% B: |$ Y+ |7 p
Error in ==> sy2 at 29
( L2 J6 |" I; B k) N) iplot(t{i},q(:,1))
& w1 {5 _) f* b" P* j; Z! a* m5 ]" }$ {麻烦帮忙解答,谢谢!" N. {6 e- E8 K8 d x
: t2 a$ p) R. w$ S程序如下:
) J! a9 n9 N% w( L9 i! D9 z! s. rL{1}=link([0 0 -pi/2 0 0],'mod');
3 E0 y0 H1 P$ N" ML{2}=link([pi/2 0 pi/2 0 0],'mod');
) x2 ]; h; J" Q. N" w: XL{3}=link([0 1150 0 0 0],'mod');2 Z" h g' |: M: _: F
L{4}=link([pi/2 0 0 1466 0],'mod');$ A* E$ b: ~0 t
L{5}=link([pi/2 -188 0 0 0],'mod');" }& r& f% k0 ^2 f. [ m$ o/ b# I
hithd=robot(L,'hithdrobot');$ ?# @$ q2 ?- s& H
clear L
8 K- s9 b# {/ j$ v# R) n7 N5 @alpha=0:pi/80:2*pi;%定义圆弧角! _, h* y3 e0 z) V% i$ G
R=30;%给定半径
j- U' K( p w) N- S1 L: Na1=2022.5+R*sin(alpha);%定义x变量+ Z1 ?/ ~. y1 \; ?
b1=30-R*cos(alpha);%定义y变量7 d; M1 v9 D9 I3 c) |% [% m
for i=1:1:41- P" l# y* E" u. Y
T{i}=[0 1 0 a1(:,i);0 0 1 b1(:,i);1 0 0 -230;0 0 0 1];%定义半圆弧上41个点的齐次变换矩阵
: W2 j' \& x& q( W/ |; O4 C. D/ |end3 I& \' O% r) }7 }
for i=1:1:40
& G" W [* e: ]8 y0 u5 d3 ~ t{i}=[i:.025:i+1]';
' I% s2 n/ y- L: p, S0 mTa{i}=ctraj(T{i},T{i+1},length(t{i}));%生成40个线段的笛卡尔轨迹9 C7 ~3 `0 L* J1 C* V# x1 s5 s
end" i% ]4 r3 N! S: ~ x7 S" r
for i=1:1:40+ f! R& I) P( p P
tic;
* c$ ]8 E5 y% p! ]+ w3 z& _# D8 bq{i}=ikine(hithd,Ta{i});%运动学逆解40个线段的关节坐标, J! ]* \, t% B j" C3 y6 v- N
toc
. \3 ~, v0 a1 g& n: W" n) h; F3 Nend
& l6 L' k, k! s. f1 jsubplot(3,1,1)5 E3 K2 ~9 N% H" r! b) {: E
plot(t{i},q(:,1))
) T8 ? H* t+ \/ nxlabel('Time(s)');
/ a3 w9 F% J' N7 Uylabel('Joint 1(rad)')4 }+ j# D: X* K, I! d
subplot(3,1,2)& M- ?' ^! p0 R3 g- s. R
plot(t{i},q(:,2))
, A9 t! N1 K9 I W8 n7 o3 Fxlabel('Time(s)');" z* W! U5 z- o1 F) E3 M8 K8 b+ M
ylabel('Joint 2(rad)')6 ~6 o2 j& P! G
subplot(3,1,3)
( N) X; `- R$ A7 k$ fplot(t{i},q(:,3))+ \% E8 N% _5 \' @
xlabel('Time(s)');
+ E( \7 B3 @0 Y4 ~' b9 X( fylabel('Joint 3(rad)')
, z2 i- d. h1 A0 r- ~hold on6 I( V4 Y4 v0 Q5 @5 F- D2 Q
|
|