代码拉取完成,页面将自动刷新
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
此处可能存在不合适展示的内容,页面不予展示。您可通过相关编辑功能自查并修改。
如您确认内容无涉及 不当用语 / 纯广告导流 / 暴力 / 低俗色情 / 侵权 / 盗版 / 虚假 / 无价值内容或违法国家有关法律法规的内容,可点击提交进行申诉,我们将尽快为您处理。