To enhance the overall performance, some effective methods to deal with outliers are proposed, such as the polynomial time (O(N2) outlier removal method [32]. Since the road is relatively flat, only a two-dimensional map is needed. In contrast, when it comes to offroad navigation in rough...