加入 Gitee
与超过 1200万 开发者一起发现、参与优秀开源项目,私有仓库也完全免费 :)
免费加入
文件
该仓库未声明开源许可证文件(LICENSE),使用请关注具体项目描述及其代码上游依赖。
克隆/下载
ur5fwdtrans.m 872 Bytes
一键复制 编辑 原始数据 按行查看 历史
radica1113 提交于 2016-03-19 22:31 . first commit
function [ G ] = ur5fwdtrans( tt, i )
d1 = 0.089159;
d2 = 0;
d3 = 0;
d4 = 0.10915;
d5 = 0.09465;
d6 = 0.0823;
a1 = 0;
a2 = -0.425;
a3 = -0.39225;
a4 = 0;
a5 = 0;
a6 = 0;
alpha1 = pi/2;
alpha2 = 0;
alpha3 = 0;
alpha4 = pi/2;
alpha5 = -pi/2;
alpha6 = 0;
T01 = DH(a1, alpha1, d1, tt(1));
T12 = DH(a2, alpha2, d2, tt(2));
T23 = DH(a3, alpha3, d3, tt(3));
T34 = DH(a4, alpha4, d4, tt(4));
T45 = DH(a5, alpha5, d5, tt(5));
T56 = DH(a6, alpha6, d6, tt(6));
if i==1
G = T01;
elseif i==2
G = T01 * T12;
elseif i==3
G = T01 * T12 * T23;
elseif i==4
G = T01 * T12 * T23 * T34;
elseif i==5
G = T01 * T12 * T23 * T34 * T45;
elseif i==6
G = T01 * T12 * T23 * T34 * T45 * T56;
else
G = eye(4);
end
end
马建仓 AI 助手
尝试更多
代码解读
代码找茬
代码优化