Fixes a missing sub path in the build paths
Another fix
Remove debug print
Fixed bug using catkin_pkg