thetax=atan2(-R(2,3),R(3,3));
thetay=atan2(R(1,3),sqrt((R(1,1))^2+(R(1,2))^2));
thetaz=atan2(-R(1,2),R(1,1));