Calling the function
rpy2tr(0.6,0.8,1.4)
returns the wrong rotation matrix. In particular, it calls the function rpy2r, that respectively calls rotx, roty, rotz, that use the sind and cosd functions that assume the angles in degrees. I fixed this problem by changing the conversion in radiants as a conversion in degrees.
Calling the function
rpy2tr(0.6,0.8,1.4)returns the wrong rotation matrix. In particular, it calls the functionrpy2r, that respectively callsrotx,roty,rotz, that use thesindandcosdfunctions that assume the angles in degrees. I fixed this problem by changing the conversion in radiants as a conversion in degrees.