Minor changes.

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());