Put the version of vtk to pointcloud2 with rgb workaround. Did some adjustment for the pointCloudToVtk.cpp