[stabilization] attitude quat: fix psi angle