找回密码
 注册
关于网站域名变更的通知
查看: 512|回复: 3
打印 上一主题 下一主题

机器人在关节空间圆弧的轨迹规划仿真出现错误

[复制链接]

该用户从未签到

跳转到指定楼层
1#
发表于 2020-11-18 16:11 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式

EDA365欢迎您登录!

您需要 登录 才可以下载或查看,没有帐号?注册

x
机器人在关节空间圆弧的轨迹规划仿真出现错误,仿真结果显示
3 f7 ~8 ?! S/ I+ z* }??? Error using ==> plot
0 u3 D& }7 {$ o" x1 f  z+ DConversion to double from cell is not possible.. G! M, t3 s1 F' Y/ N* _3 I$ Z
Error in ==> sy2 at 29
! U. G6 t/ L" z: W* Cplot(t{i},q(:,1))
; S! X, @  s3 S3 a5 q: g. G4 R麻烦帮忙解答,谢谢!
$ E  \& V4 {( J2 f9 y6 H* w* F
  t/ [+ s- j% \+ E7 Y3 c5 Q9 V程序如下:
" [/ u6 |5 v+ n8 t9 `L{1}=link([0 0 -pi/2 0 0],'mod');
- C# W) B% ^6 EL{2}=link([pi/2 0 pi/2 0 0],'mod');, s& ]2 R  l$ j' @( n, u
L{3}=link([0 1150 0 0 0],'mod');. X& j5 A5 v- ~$ J& t9 Z* y. I
L{4}=link([pi/2 0 0 1466 0],'mod');
0 a2 r/ _) Z* j9 p3 {1 A/ W0 QL{5}=link([pi/2 -188 0 0 0],'mod');
+ G4 ?* U" @8 g2 W9 @hithd=robot(L,'hithdrobot');
% ]$ `1 W+ a7 ?7 ~- n8 Q8 eclear L% H- J. }3 n7 r- [+ |
alpha=0:pi/80:2*pi;%定义圆弧角4 `& ?9 v) z( X8 U6 o" S
R=30;%给定半径$ ?# F( a" Y" q
a1=2022.5+R*sin(alpha);%定义x变量
) q. _+ ~. _5 [; D% y1 Hb1=30-R*cos(alpha);%定义y变量
- P( z! H, A5 w" k1 A: k% Q1 Sfor i=1:1:41" q0 i6 _' C% l0 \% n
T{i}=[0 1 0 a1(:,i);0 0 1 b1(:,i);1 0 0 -230;0 0 0 1];%定义半圆弧上41个点的齐次变换矩阵
- T& y0 N4 J$ `end
5 w4 G, W+ [) [2 ?2 Afor i=1:1:40
, n" m- S$ X# l: R   t{i}=[i:.025:i+1]';
$ {. ]' u* X3 K8 |7 T  T8 u8 xTa{i}=ctraj(T{i},T{i+1},length(t{i}));%生成40个线段的笛卡尔轨迹
! l; F$ j+ w) R: z5 [, T# mend1 e) K6 E; C" z* O% I
for i=1:1:40
; a  r( T4 F2 J; Y' o1 z! btic;
( F2 F+ a8 m' i0 [9 Fq{i}=ikine(hithd,Ta{i});%运动学逆解40个线段的关节坐标
5 v( E, J) u, A& o+ L9 p' Gtoc
  M4 p3 B; I1 q+ [, ]end
, M6 b% {# d- [2 Q% b! j" u3 Usubplot(3,1,1)' J* E6 t( x/ d- d" [' U
plot(t{i},q(:,1))% n9 F2 D( a+ p2 D/ \
xlabel('Time(s)');
4 L6 i9 C9 J$ w* uylabel('Joint 1(rad)')- h+ S) Z5 \& |* @9 O
subplot(3,1,2)" m% n0 v, _( n4 V" R) G) s6 u+ G
plot(t{i},q(:,2))3 B5 T0 E9 b" ^: f4 p% i6 y
xlabel('Time(s)');, G# [( h. W+ ^6 n) |9 C; F. y# \
ylabel('Joint 2(rad)')
( }7 V1 t# G* X5 ?$ R/ y/ D4 psubplot(3,1,3)
; N# o2 i: a' j$ ], l8 lplot(t{i},q(:,3))5 q* Y0 w* z. R) s8 t4 T
xlabel('Time(s)');
* |0 i* n% N: q8 S: t7 |, Zylabel('Joint 3(rad)')
/ |$ p2 l# _3 {& I% p% Khold on+ ?  N% S; K$ c( r. r

该用户从未签到

2#
发表于 2020-11-18 17:13 | 只看该作者
帮你顶一下

该用户从未签到

4#
发表于 2020-11-19 14:22 | 只看该作者
楼主解决了吗?我也遇到这个问题了
您需要登录后才可以回帖 登录 | 注册

本版积分规则

关闭

推荐内容上一条 /1 下一条

EDA365公众号

关于我们|手机版|EDA365电子论坛网 ( 粤ICP备18020198号-1 )

GMT+8, 2025-11-24 15:19 , Processed in 0.171875 second(s), 23 queries , Gzip On.

深圳市墨知创新科技有限公司

地址:深圳市南山区科技生态园2栋A座805 电话:19926409050

快速回复 返回顶部 返回列表