Better / cleaner initialization of the attitude estimator