RTAB-Map library Mathieu Labbe GPL http://rtabmap.googlecode.com