Fixed bug using catkin_pkg