Hotfix for attitude estimator EKF init
Merge branch 'master' into mpu6k_queue