Began work on calculating density and downsampling using voxel filter.