摘要

Usually, there are observation blind areas existing in that the distribution of land marks like angular point and line segment is parse in indoor environment. Then the locating accuracy of vehicle and the estimating precision of land marks is affected by the lack of observed quantities when using the traditional single feature matching algorithm. To solve these problems, the adaptive segmentation method of LADAR is studied, and the extraction algorithm of different types of land marks is researched, then the extended Kalman filter is presented based on the mixed feature matching observation model. At the same time, a test prototype of MEMS IMU/LADAR integrated navigation system is designed. To validate the filtering fusion algorithm, the analysis and tests are carried out in the indoor environment. The test results show that the accuracy of proposed algorithm relative to the traditional algorithm(a single point or line feature match integrated location algorithm) in the structured indoor environment increass about 60%. This indicates that the algorithm is efficient when used to improve accuracy of the MEMS IMU/LADAR integrated navigation system.

全文