MATH: Fix quaternion implementation and update users.
EMI: Remove setYaw.