Fixes and refactoring in diff_drive_controller

* the `diff_drive_test` was not building in hydro
* added catkin conditional testing