Rodrigues Rotation Formular