Improved filtering method for improving navigation accuracy