Cleaned up the up, added flags (see documentation), resampling of the PCD files (experimental)