Add setup script
Merge branch 'groovy_unstable' of github.com:uscauv/uscauv-ros-config into groovy_unstable