加入 Gitee
与超过 1200万 开发者一起发现、参与优秀开源项目,私有仓库也完全免费 :)
免费加入
文件
该仓库未声明开源许可证文件(LICENSE),使用请关注具体项目描述及其代码上游依赖。
克隆/下载
iJack.m 7.22 KB
一键复制 编辑 原始数据 按行查看 历史
radica1113 提交于 2016-03-19 22:31 . first commit
function jj=iJack(o)
o1=o(1);
o2=o(2);
o3=o(3);
o4=o(4);
o5=o(5);
o6=o(6);
Jack=[ 0.10915*cos(o1) + 0.0823*cos(o1)*cos(o5) + 0.425*cos(o2)*sin(o1) - 0.39225*sin(o1)*sin(o2)*sin(o3) + 0.39225*cos(o2)*cos(o3)*sin(o1) - 0.094649999999999998023803016167221*cos(o2)*cos(o3)*sin(o1)*sin(o4) - 0.094649999999999998023803016167221*cos(o2)*cos(o4)*sin(o1)*sin(o3) - 0.094649999999999998023803016167221*cos(o3)*cos(o4)*sin(o1)*sin(o2) + 0.094649999999999998023803016167221*sin(o1)*sin(o2)*sin(o3)*sin(o4) + 0.0823*cos(o2)*cos(o3)*cos(o4)*sin(o1)*sin(o5) - 0.0823*cos(o2)*sin(o1)*sin(o3)*sin(o4)*sin(o5) - 0.0823*cos(o3)*sin(o1)*sin(o2)*sin(o4)*sin(o5) - 0.0823*cos(o4)*sin(o1)*sin(o2)*sin(o3)*sin(o5), 0.425*cos(o1)*sin(o2) + 0.39225*cos(o1)*cos(o2)*sin(o3) + 0.39225*cos(o1)*cos(o3)*sin(o2) + 0.094649999999999998023803016167221*cos(o1)*cos(o2)*cos(o3)*cos(o4) - 0.094649999999999998023803016167221*cos(o1)*cos(o2)*sin(o3)*sin(o4) - 0.094649999999999998023803016167221*cos(o1)*cos(o3)*sin(o2)*sin(o4) - 0.094649999999999998023803016167221*cos(o1)*cos(o4)*sin(o2)*sin(o3) + 0.0823*cos(o1)*cos(o2)*cos(o3)*sin(o4)*sin(o5) + 0.0823*cos(o1)*cos(o2)*cos(o4)*sin(o3)*sin(o5) + 0.0823*cos(o1)*cos(o3)*cos(o4)*sin(o2)*sin(o5) - 0.0823*cos(o1)*sin(o2)*sin(o3)*sin(o4)*sin(o5), 0.39225*cos(o1)*cos(o2)*sin(o3) + 0.39225*cos(o1)*cos(o3)*sin(o2) + 0.094649999999999998023803016167221*cos(o1)*cos(o2)*cos(o3)*cos(o4) - 0.094649999999999998023803016167221*cos(o1)*cos(o2)*sin(o3)*sin(o4) - 0.094649999999999998023803016167221*cos(o1)*cos(o3)*sin(o2)*sin(o4) - 0.094649999999999998023803016167221*cos(o1)*cos(o4)*sin(o2)*sin(o3) + 0.0823*cos(o1)*cos(o2)*cos(o3)*sin(o4)*sin(o5) + 0.0823*cos(o1)*cos(o2)*cos(o4)*sin(o3)*sin(o5) + 0.0823*cos(o1)*cos(o3)*cos(o4)*sin(o2)*sin(o5) - 0.0823*cos(o1)*sin(o2)*sin(o3)*sin(o4)*sin(o5), 0.094649999999999998023803016167221*cos(o1)*cos(o2)*cos(o3)*cos(o4) - 0.094649999999999998023803016167221*cos(o1)*cos(o2)*sin(o3)*sin(o4) - 0.094649999999999998023803016167221*cos(o1)*cos(o3)*sin(o2)*sin(o4) - 0.094649999999999998023803016167221*cos(o1)*cos(o4)*sin(o2)*sin(o3) + 0.0823*cos(o1)*cos(o2)*cos(o3)*sin(o4)*sin(o5) + 0.0823*cos(o1)*cos(o2)*cos(o4)*sin(o3)*sin(o5) + 0.0823*cos(o1)*cos(o3)*cos(o4)*sin(o2)*sin(o5) - 0.0823*cos(o1)*sin(o2)*sin(o3)*sin(o4)*sin(o5), 0.0823*cos(o1)*cos(o2)*cos(o5)*sin(o3)*sin(o4) - 0.0823*cos(o1)*cos(o2)*cos(o3)*cos(o4)*cos(o5) - 0.0823*sin(o1)*sin(o5) + 0.0823*cos(o1)*cos(o3)*cos(o5)*sin(o2)*sin(o4) + 0.0823*cos(o1)*cos(o4)*cos(o5)*sin(o2)*sin(o3), 0;
0.10915*sin(o1) - 0.425*cos(o1)*cos(o2) + 0.0823*cos(o5)*sin(o1) - 0.39225*cos(o1)*cos(o2)*cos(o3) + 0.39225*cos(o1)*sin(o2)*sin(o3) + 0.094649999999999998023803016167221*cos(o1)*cos(o2)*cos(o3)*sin(o4) + 0.094649999999999998023803016167221*cos(o1)*cos(o2)*cos(o4)*sin(o3) + 0.094649999999999998023803016167221*cos(o1)*cos(o3)*cos(o4)*sin(o2) - 0.094649999999999998023803016167221*cos(o1)*sin(o2)*sin(o3)*sin(o4) - 0.0823*cos(o1)*cos(o2)*cos(o3)*cos(o4)*sin(o5) + 0.0823*cos(o1)*cos(o2)*sin(o3)*sin(o4)*sin(o5) + 0.0823*cos(o1)*cos(o3)*sin(o2)*sin(o4)*sin(o5) + 0.0823*cos(o1)*cos(o4)*sin(o2)*sin(o3)*sin(o5), 0.425*sin(o1)*sin(o2) + 0.39225*cos(o2)*sin(o1)*sin(o3) + 0.39225*cos(o3)*sin(o1)*sin(o2) + 0.094649999999999998023803016167221*cos(o2)*cos(o3)*cos(o4)*sin(o1) - 0.094649999999999998023803016167221*cos(o2)*sin(o1)*sin(o3)*sin(o4) - 0.094649999999999998023803016167221*cos(o3)*sin(o1)*sin(o2)*sin(o4) - 0.094649999999999998023803016167221*cos(o4)*sin(o1)*sin(o2)*sin(o3) + 0.0823*cos(o2)*cos(o3)*sin(o1)*sin(o4)*sin(o5) + 0.0823*cos(o2)*cos(o4)*sin(o1)*sin(o3)*sin(o5) + 0.0823*cos(o3)*cos(o4)*sin(o1)*sin(o2)*sin(o5) - 0.0823*sin(o1)*sin(o2)*sin(o3)*sin(o4)*sin(o5), 0.39225*cos(o2)*sin(o1)*sin(o3) + 0.39225*cos(o3)*sin(o1)*sin(o2) + 0.094649999999999998023803016167221*cos(o2)*cos(o3)*cos(o4)*sin(o1) - 0.094649999999999998023803016167221*cos(o2)*sin(o1)*sin(o3)*sin(o4) - 0.094649999999999998023803016167221*cos(o3)*sin(o1)*sin(o2)*sin(o4) - 0.094649999999999998023803016167221*cos(o4)*sin(o1)*sin(o2)*sin(o3) + 0.0823*cos(o2)*cos(o3)*sin(o1)*sin(o4)*sin(o5) + 0.0823*cos(o2)*cos(o4)*sin(o1)*sin(o3)*sin(o5) + 0.0823*cos(o3)*cos(o4)*sin(o1)*sin(o2)*sin(o5) - 0.0823*sin(o1)*sin(o2)*sin(o3)*sin(o4)*sin(o5), 0.094649999999999998023803016167221*cos(o2)*cos(o3)*cos(o4)*sin(o1) - 0.094649999999999998023803016167221*cos(o2)*sin(o1)*sin(o3)*sin(o4) - 0.094649999999999998023803016167221*cos(o3)*sin(o1)*sin(o2)*sin(o4) - 0.094649999999999998023803016167221*cos(o4)*sin(o1)*sin(o2)*sin(o3) + 0.0823*cos(o2)*cos(o3)*sin(o1)*sin(o4)*sin(o5) + 0.0823*cos(o2)*cos(o4)*sin(o1)*sin(o3)*sin(o5) + 0.0823*cos(o3)*cos(o4)*sin(o1)*sin(o2)*sin(o5) - 0.0823*sin(o1)*sin(o2)*sin(o3)*sin(o4)*sin(o5), 0.0823*cos(o1)*sin(o5) - 0.0823*cos(o2)*cos(o3)*cos(o4)*cos(o5)*sin(o1) + 0.0823*cos(o2)*cos(o5)*sin(o1)*sin(o3)*sin(o4) + 0.0823*cos(o3)*cos(o5)*sin(o1)*sin(o2)*sin(o4) + 0.0823*cos(o4)*cos(o5)*sin(o1)*sin(o2)*sin(o3), 0;
0, 0.094649999999999998023803016167221*sin(o2 + o3 + o4) - 0.04115*sin(1.0*o5 - o3 - o4 - o2) - 0.04115*sin(o2 + o3 + o4 + o5) - 0.39225*cos(o2 + o3) - 0.425*cos(o2), 0.094649999999999998023803016167221*sin(o2 + o3 + o4) - 0.04115*sin(1.0*o5 - o3 - o4 - o2) - 0.04115*sin(o2 + o3 + o4 + o5) - 0.39225*cos(o2 + o3), 0.094649999999999998023803016167221*sin(o2 + o3 + o4) - 0.04115*sin(1.0*o5 - o3 - o4 - o2) - 0.04115*sin(o2 + o3 + o4 + o5), 0.04115*sin(1.0*o5 - o3 - o4 - o2) - 0.04115*sin(o2 + o3 + o4 + o5), 0];
jj=transpose(Jack)*inv(Jack*transpose(Jack));
end
马建仓 AI 助手
尝试更多
代码解读
代码找茬
代码优化