Added running of currently passing tests to .travis.yml.
Removed debug-write in CMakeLists.txt.
Merge pull request #131 from ros-planning/travis-runs-tests

Added running of currently passing tests to .travis.yml.