ekf_att_pos_estimator: Fixed mag initialization, now starts with initial measurement instead of defaults for faster convergence