An implementation of the Normalized Distance Transform 3D robotic mapping algorithm proposed by Saarinen, et al., ICRA 2013