diff --git a/recipes-ros/octomap-ros/octomap-ros_0.4.0.bb b/recipes-ros/octomap-ros/octomap-ros_0.4.0.bb
index b1305ed..04847fe 100644
--- a/recipes-ros/octomap-ros/octomap-ros_0.4.0.bb
+++ b/recipes-ros/octomap-ros/octomap-ros_0.4.0.bb
@@ -17,4 +17,5 @@ do_configure_append() {
     sed -i -e 's: /usr/lib/liboctomap.so: ${STAGING_LIBDIR}/liboctomap.so:g' \
         -e 's: /usr/lib/liboctomath.so: ${STAGING_LIBDIR}/liboctomath.so:g' \
         ${B}/CMakeFiles/octomap_ros.dir/build.make
+    sed -i -e 's:-L\/opt\/ros\/indigo\/lib::g' ${B}/CMakeFiles/octomap_ros.dir/link.txt
 }