Merge pull request #6 from adamjardim/groovy-devel

Groovy devel
Merge branch 'groovy-devel' of github.com:WPI-RAIL/youbot_driver into groovy-devel