add the computation of the 3x3 rotation matrix from Roll Pitch and Yaw