att_pos_estimator_ekf: fixes, mathlib: minor changes