fill point_cloud field
add RGB color
Merge pull request #41 from garaemon/fix-voxel-grid-manager

fill point_cloud field