src/test/java/test/ros.controlsServer seems to be on a good way to work