Split code that is called when a packet is received into functions.

Extended voxel filtering to stored clouds.