Clean romeo script.

Remove rviz,
Better loading of the solver.