Wait until roscore is terminated before script end

Wait until roscore is terminated before script end #1640