Fix issues and add conversion from Euler angles to Quaternion