Handle different ROS_PACKAGE_PATH for "catkin build" tool