Improvement of Simultaneous Localization and Mapping Based on Extended Kalman Filter Using Iterative Closest Point Algorithm