A pose pruning driven solution to pose feature GraphSLAM
- Publication Type:
- Journal Article
- Advanced Robotics, 2015, 29 (10), pp. 683 - 698
- Issue Date:
© 2015 Taylor & Francis and The Robotics Society of Japan. To build consistent feature-based map for the environment, GraphSLAM forms the graph using the collected information, with poses of robot and features being nodes while the odometry and observations being binary edges (edge links to two nodes). As the number of kept nodes grows unboundedly while robot moves, this method will become intractable for long-duration operation. In this paper, we propose a pose pruning-driven solution for pose feature Simultaneous localization and mapping by relating the size of graph to the size of map instead of the length of trajectory. It consists of two steps: (1) An online pose pruning algorithm that can select a pose to be pruned based on the contribution of the pose. Different from conventional methods considering the spatial distance between poses, the contribution is based on the feature observations of poses, taking mapping into consideration. (2) An edge generation algorithm that can build new consistent binary edges from -nary edge (edge links to nodes) induced by marginalizing the pruned pose. The type of new edges remains invariant (i.e. they are either odometry or pose to feature observations), so no extra change is required to be made on the GraphSLAM optimizer, making the proposed solution modular. In the experiment, we first employ this system on simulation data-sets to show how it works. Then the large-scale data-sets: DLR, Victoria Park, and CityTrees10000 are used to evaluate its performance.
Please use this identifier to cite or link to this item: