Update UD_rviz_interaction.cpp

Added voxel filter and pointcloud to mesh(working).