1 Star 1 Fork 1

Cybaster / all_calibration

加入 Gitee
与超过 1200万 开发者一起发现、参与优秀开源项目,私有仓库也完全免费 :)
免费加入
克隆/下载
calculate_error.m 510 Bytes
一键复制 编辑 原始数据 按行查看 历史
Cybaster 提交于 2023-09-30 11:20 . Initial commit
function error_x = calculate_error(delta_para, DH_para, x_real, Q)
[n, ~] = size(Q);
Alpha = DH_para.Alpha + delta_para(1:6);
A = DH_para.A + delta_para(7:12);
D = DH_para.D + delta_para(13:18);
Theta = DH_para.Theta + delta_para(19:24);
for i = 1:6
L(i) = Link('alpha',Alpha(i),'a', A(i),'d', D(i)); L(i).offset = Theta(i); L(i).qlim=[-pi, pi]; L(i).mdh = 1;
end
robot = SerialLink(L, 'name', 'UR');
for i = 1:n
qi = Q(i, :);
x_th(3*i-2:3*i, 1) = robot.fkine(qi).t;
end
error_x = x_real - x_th;
1
https://gitee.com/chaomingsanhua/all_calibration.git
git@gitee.com:chaomingsanhua/all_calibration.git
chaomingsanhua
all_calibration
all_calibration
master

搜索帮助