The points now publish in rviz