Conditional Compatibility Branch and Bound for Feature Cloud Matching

In this paper, we consider the problem of data association in feature cloud matching. While Joint Compatibility (JC) test is a widely adopted technique for searching the global optimal data association, it becomes less restrictive as more features are well matched. The early well-matched features contribute little to total matching cost while the gating threshold increases in the chi-square test, which allows the acceptance of bad feature pairings in the last step. In this paper, we propose the Conditional Compatibility (CC) test, which is not only more restrictive than JC test, but also probabilistically sound. The proposed test of a new feature pairing is based on the conditional probability distribution of feature locations given the early pairings. CC test can be added into any JC test based search algorithm, such as Joint Compatibility Branch and Bound (JCBB), Incremental Posterior Joint Compatibility (IPJC) and FastJCBB, without increasing much computational complexity. The more restrictive criterion of accepting a feature pairing, not only helps to reject bad associations, but also bounds the search space, which substantially improves the search efficiency. The real matching experiments justify that our algorithm produces better feature cloud matching results in a more efficient manner.

[1]  Eduardo Mario Nebot,et al.  Optimization of the simultaneous localization and map-building algorithm for real-time implementation , 2001, IEEE Trans. Robotics Autom..

[2]  Paul J. Besl,et al.  A Method for Registration of 3-D Shapes , 1992, IEEE Trans. Pattern Anal. Mach. Intell..

[3]  Emilio Frazzoli,et al.  Fast Joint Compatibility Branch and Bound for feature cloud matching , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[4]  Marcelo H. Ang,et al.  Perception, Planning, Control, and Coordination for Autonomous Vehicles , 2017 .

[5]  Marcelo H. Ang,et al.  Spatio-temporal motion features for laser-based moving objects detection and tracking , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[6]  Juan D. Tardós,et al.  Data association in stochastic mapping using the joint compatibility test , 2001, IEEE Trans. Robotics Autom..

[7]  Marcelo H. Ang,et al.  Scalable Cooperative Localization with Minimal Sensor Configuration , 2014, DARS.

[8]  Marc Levoy,et al.  Efficient variants of the ICP algorithm , 2001, Proceedings Third International Conference on 3-D Digital Imaging and Modeling.

[9]  Marcelo H. Ang,et al.  Autonomous golf cars for public trial of mobility-on-demand service , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[10]  Marcelo H. Ang,et al.  Multi-vehicle motion coordination using V2V communication , 2015, 2015 IEEE Intelligent Vehicles Symposium (IV).

[11]  Emilio Frazzoli,et al.  Mapping with synthetic 2D LIDAR in 3D urban environment , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[12]  Edwin Olson,et al.  IPJC: The Incremental Posterior Joint Compatibility test for fast feature cloud matching , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[13]  Hai Liu,et al.  Fast and Robust Data Association Using Posterior Based Approximate Joint Compatibility Test , 2014, IEEE Transactions on Industrial Informatics.

[14]  Y. Bar-Shalom Tracking and data association , 1988 .

[15]  Sebastian Thrun,et al.  Probabilistic robotics , 2002, CACM.

[16]  Edwin Olson,et al.  Real-time correlative scan matching , 2009, 2009 IEEE International Conference on Robotics and Automation.

[17]  José A. Castellanos,et al.  Map Building and SLAM Algorithms , 2018, Autonomous Mobile Robots.