Add function to convert Inverse Quat to Rotation Matrix