Initial version in which a point cloud is extracted from a dataset and obstacles selected using a mask (just for debugging)