GitHub

rpy_from_dcm.m

% RPY_FROM_DCM Roll, pitch, yaw Euler angles from rotation matrix. % [rpy] = RPY_FROM_DCM(R) computes roll, pitch and yaw angles from the ...
GitHub

Numeric error produces unexpected behavior on RPY angles computation

This problem is caused by the numeric error that origins from the LookupTransform function. Changing the std::cout precision to 20 is possible to see that the actual ...