Need similar function to matrixToOmegaPhiKappa but to get yaw pitch roll values for example it could be called matrixToYawPitchRoll.