Merge pull request #8 from rctoris/groovy-devel

Major refactoring of URDF
Merge branch 'groovy-devel' of github.com:rctoris/ros3djs into groovy-devel
super messy version of interactive markers working