报错索引超出数组元素的数目(2)。 出错 ceshi2 (line 23) T3 = DH(3, a(3), alpha(3), d(3), theta(3)+beta(3));
时间: 2023-10-09 22:14:22 浏览: 98
关于C#索引超出了数组界限的问题??
4星 · 用户满意度95%
这个错误通常出现在数组下标超出了数组长度的范围,导致访问了不存在的元素。在这个问题中,错误信息显示是在第23行发生的,即 DH 函数的调用中出现了问题。
根据错误信息,发现是在访问数组 a、alpha、d 或 theta 时出现了超出范围的问题。因此,需要检查这些数组的长度是否正确。
在这段代码中,数组的长度应该是 4,因为机械臂是由 4 个关节组成的。因此,我们需要检查这些数组的长度是否正确,并且检查是否存在其它的错误。
下面是修改后的代码,你可以将其复制粘贴到 MATLAB 中,再运行一下:
```matlab
clear all; clc;
du = pi/180;
a = [0+0.001, 185+0.0079, 0+0.005, 120+0.12];
alpha = [pi/2+0.003, 0+0.001, pi/2+0.005, pi/2];
d = [0+0.001, 0+0.0079, 90+0.005, 0+0.12];
theta = [90*du+0.02, 0, 0.023, 0.08];
beta = zeros(1, 4)+0;
L1(1) = Link('d', d(1), 'a', a(1), 'alpha', alpha(1), 'qlim', [180*du, 365*du], 'modified');
L1(2) = Link('d', d(2), 'a', a(2), 'alpha', alpha(2), 'qlim', [3*du, 63*du], 'modified');
L1(3) = Link('d', d(3), 'a', a(3), 'alpha', alpha(3), 'qlim', [60*du, 120*du], 'modified');
L1(4) = Link('d', d(4), 'a', a(4), 'alpha', alpha(4), 'qlim', [230*du, 326*du], 'modified');
Needle = SerialLink(L1, 'name', 'Needle');
T1 = DH(1, a(1), alpha(1), d(1), theta(1)+beta(1));
T2 = DH(2, a(2), alpha(2), d(2), theta(2)+beta(2));
T3 = DH(3, a(3), alpha(3), d(3), theta(3)+beta(3));
T4 = DH(4, a(4), alpha(4), d(4), theta(4)+beta(4));
T = T1*T2*T3*T4;
delta_a = 0.001;
delta_T = zeros(4, 4);
for i = 1:4
delta_T = delta_T + diff(T, a(i))*delta_a;
end
delta_alpha = 0.003;
for i = 1:4
delta_T = delta_T + diff(T, alpha(i))*delta_alpha;
end
delta_d = 0.005;
for i = 1:4
delta_T = delta_T + diff(T, d(i))*delta_d;
end
delta_theta = 0.02*du;
for i = 1:4
delta_T = delta_T + diff(T, theta(i))*delta_theta;
end
delta_beta = 0.0;
for i = 1:4
delta_T = delta_T + diff(T, beta(i))*delta_beta;
end
q = [theta(1), 0, theta(3), theta(4)];
T = Needle.fkine(q);
pos = T(1:3, 4);
euler = tr2eul(T, 'ZYX')/du;
delta_pos = delta_T(1:3, 4);
delta_euler = tr2eul(delta_T, 'ZYX')/du;
```
在这个修改后的代码中,我重新排列了数组的顺序,并且在 Link 对象的设置中,也按照了 DH 矩阵的顺序设置了 d, a, alpha, theta。这样就避免了数组下标超出范围的问题。
阅读全文