Move rotation matrix creation functionality from rigidTrans to function fiPar2Matrix

This is convenient since I need this functionality in drr as well