Update particles in vectorparticlefilter so that it is not a member any more
Also, write particles at initialization and predict so that they can be published
Const a couple of arguments used from updatePointCloud