diff --git a/include/iri_nav_module/follow_lp_module_bt.h b/include/iri_nav_module/follow_lp_module_bt.h
index a46b81764da5702c7035e79b2b88302e9cb52b90..cba089d48948f1eba3d615fe06e80ba5f664d494 100644
--- a/include/iri_nav_module/follow_lp_module_bt.h
+++ b/include/iri_nav_module/follow_lp_module_bt.h
@@ -105,7 +105,7 @@ class CFollowLPModuleBT
       ROS_ERROR("CFollowLPModuleBT::set_update_dist-> Incorrect or missing input. It needs the following input ports: update_dist(double)");
       return BT::NodeStatus::FAILURE;
     }
-    double xy=bt_update_dist.value();
+    double update_dist=bt_update_dist.value();
     if(this->module.set_update_dist(update_dist)==DYN_RECONF_SUCCESSFULL)
       return BT::NodeStatus::SUCCESS;
     else
@@ -156,12 +156,12 @@ class CFollowLPModuleBT
     double follow_dist;
     if(this->module.get_follow_dist(follow_dist)==DYN_RECONF_SUCCESSFULL)
     {
-      self.setOutput("follow_dist", yaw);
+      self.setOutput("follow_dist", follow_dist);
       return BT::NodeStatus::SUCCESS;
     }
     else
     { //Just beacuse in case of error to put something on the output port
-      self.setOutput("follow_dist", yaw);
+      self.setOutput("follow_dist", follow_dist);
       return BT::NodeStatus::FAILURE;
     }
   }