Remove broken test code. Hotfix to #18.
Merge pull request #25 from ros-controls/fix-tests

Remove broken test code. Hotfix for #18.