EKF: Improve yaw alignment
EKF: Improve yaw alignment

Uses best conditioned of 321 or 312 Euler sequence to calculate initial yaw angle.
Allows alignment of yaw angle using external vision data

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