Particle flow filter algorithm based on “innovation error”