2013 fork of https://svn.code.sf.net/p/tum-ros-pkg/code/highlevel/SnapMapICP/