[PD] Calculate rotation from translation & Gimbal Fix issue (euler, quaternion)