加入 Gitee
与超过 1200万 开发者一起发现、参与优秀开源项目,私有仓库也完全免费 :)
免费加入
文件
该仓库未声明开源许可证文件(LICENSE),使用请关注具体项目描述及其代码上游依赖。
克隆/下载
eulerzyxinv.m 688 Bytes
一键复制 编辑 原始数据 按行查看 历史
radica1113 提交于 2016-03-19 22:31 . first commit
function [ theta ] = eulerzyxinv( rot_mat )
% The rotational matrix can be represented by:
% R = Rx(t1) * Ry(t2) * Rz(t3)
theta = [0,0,0];
% If the rotational matrix represents a singularity
if abs(rot_mat(3,3)) < eps && abs(rot_mat(2,3)) < eps
theta(1) = 0;
theta(2) = atan2(rot_mat(1,3), rot_mat(3,3));
theta(3) = atan2(rot_mat(2,1), rot_mat(2,2));
% Normal case
else
theta(1) = atan2(-rot_mat(2,3), rot_mat(3,3));
sinr = sin(theta(1));
cosr = cos(theta(1));
theta(2) = atan2(rot_mat(1,3), cosr * rot_mat(3,3) - sinr * rot_mat(2,3));
theta(3) = atan2(-rot_mat(1,2), rot_mat(1,1));
end
end
马建仓 AI 助手
尝试更多
代码解读
代码找茬
代码优化