diff --git a/src/safe_cmd_alg_node.cpp b/src/safe_cmd_alg_node.cpp
index dd85a25c48f171f726fc702286e36edb5851f9f5..5f192f929137953efecd89b77ebe652580eab06e 100644
--- a/src/safe_cmd_alg_node.cpp
+++ b/src/safe_cmd_alg_node.cpp
@@ -267,7 +267,6 @@ void SafeCmdAlgNode::get_footprint_at(std::vector<geometry_msgs::Point> &footpri
 
 bool SafeCmdAlgNode::check_collision(pcl::PointCloud<pcl::PointXYZ>::Ptr &scan_points,std::vector<geometry_msgs::Point> &footprint,pcl::PointCloud<pcl::PointXYZ> &collision_points)
 {
-  double distance;
   bool collision=false;
   pcl::ExtractIndices<pcl::PointXYZ> extract;
   pcl::PointIndices::Ptr inliers(new pcl::PointIndices());