EKF: Update yaw innovation calculation to match revised derivation
EKF: Update yaw innovation calculation to match revised derivation

The new derivation does not use magnetic field measurements in the observation model and instead fuses in a heading measurement directly.

PX4/ecl,PX4/ecl,PX4/ecl,PX4/ecl,PX4/ecl