|
|
EDA365欢迎您登录!
您需要 登录 才可以下载或查看,没有帐号?注册
x
机器人在关节空间圆弧的轨迹规划仿真出现错误,仿真结果显示
" x$ p5 U2 d3 `4 K??? Error using ==> plot2 x" M8 B* r' v( M+ |
Conversion to double from cell is not possible.
. c) ~" b3 ^8 G1 @! lError in ==> sy2 at 29$ `/ H& _/ n2 o, Y
plot(t{i},q(:,1))3 {- R/ W# `% T6 M" ~$ T$ [; a
麻烦帮忙解答,谢谢!4 F8 Y0 s$ E- Q! J. r2 G
0 C% |7 v9 _1 {/ H% z ^( g
程序如下:( s! D) Y1 g! ^( [7 [
L{1}=link([0 0 -pi/2 0 0],'mod');; C" K0 b9 j' q; s J' i% U8 O
L{2}=link([pi/2 0 pi/2 0 0],'mod');. Z' l4 ~3 _ t
L{3}=link([0 1150 0 0 0],'mod');+ Q6 s+ s- L4 d" \
L{4}=link([pi/2 0 0 1466 0],'mod');' X0 s- ]) g) F' N# r5 D- q1 M4 w
L{5}=link([pi/2 -188 0 0 0],'mod');
# o) c6 E) i, ?6 ^hithd=robot(L,'hithdrobot'); G/ [+ u9 T v' ^" z. D
clear L
b/ |& L5 s R# J! U5 N Ralpha=0:pi/80:2*pi;%定义圆弧角& K' k: E! o" ?$ {9 ?
R=30;%给定半径: F4 f p; A$ r ~, X4 F- ]
a1=2022.5+R*sin(alpha);%定义x变量. r8 d, }7 @( h% E, ]
b1=30-R*cos(alpha);%定义y变量
% [/ w0 A. h z$ O8 Jfor i=1:1:41
* }6 t& X1 M8 \. B1 A/ p W9 XT{i}=[0 1 0 a1(:,i);0 0 1 b1(:,i);1 0 0 -230;0 0 0 1];%定义半圆弧上41个点的齐次变换矩阵
1 ~* A+ q; S4 V- q, }1 lend
0 Z* |* {+ }8 i P- x0 o: j6 V; ]for i=1:1:40
) v3 r7 Z/ G; [9 o t{i}=[i:.025:i+1]';
" i; a% S$ |0 K hTa{i}=ctraj(T{i},T{i+1},length(t{i}));%生成40个线段的笛卡尔轨迹1 _) }9 C) y. Q: S/ E
end
7 z/ [+ @+ `0 e, a' F ]for i=1:1:40" d& Y" n3 M9 d9 `7 M4 z- H5 m- H
tic;+ E2 l [7 j6 O( e( z6 ^
q{i}=ikine(hithd,Ta{i});%运动学逆解40个线段的关节坐标
% W6 D1 ?0 m# `, x2 otoc/ v- i. N( Z& A, R j
end$ S3 t: o9 I2 B9 z1 ?2 R6 ?# p
subplot(3,1,1)' ?: K; P5 }* [. ]. [1 [* N5 I
plot(t{i},q(:,1))
$ x2 U7 ?2 S; s7 W9 k% `, Z3 P" xxlabel('Time(s)');: e& J7 t( @; _% G
ylabel('Joint 1(rad)')" T! z& G( |/ ]* J v
subplot(3,1,2)
2 x0 T6 B+ C* f2 u' u' ]plot(t{i},q(:,2))/ ?; p( V9 Q' s) J+ v4 U
xlabel('Time(s)');
9 y9 j, A7 u* Y [- Gylabel('Joint 2(rad)')5 w0 [- ?, K/ J/ x+ c
subplot(3,1,3)0 x1 j6 x, t9 Q3 `6 C
plot(t{i},q(:,3))
3 k* B0 O4 s8 e! Rxlabel('Time(s)');
- g: ^: a6 B% C/ Hylabel('Joint 3(rad)')
( r1 C8 S5 q5 w3 { `. I- |hold on' G0 u( \3 Z3 Y
|
|