https://github.com/RomaTeng/EKF-SLAM-on-Manifold
Raw File
Tip revision: 12d7d8d88c84161baed173e38d49dedb4adb2b96 authored by Teng Zhang on 26 February 2017, 15:09:17 UTC
Record my control paper
Tip revision: 12d7d8d
euler2rotation_matrix.m
function y = euler2rotation_matrix( X )
% compute rotation matrix from euler angle
% X     - euler angle
% y     - rotation matrix
    a = X(1); %x
    b = X(2); %y
    c = X(3); %z
    y = [cos(c)*cos(b) -sin(c)*cos(a)+cos(c)*sin(b)*sin(a) sin(c)*sin(a)+cos(c)*cos(a)*sin(b);...
         sin(c)*cos(b)  cos(c)*cos(a)+sin(a)*sin(b)*sin(c) -cos(c)*sin(a)+sin(b)*sin(c)*cos(a);...
         -sin(b) cos(b)*sin(a) cos(b)*cos(a)];
end
back to top