ros node and utilities to create heightmaps from a pointcloud