diff --git a/moveit_core/collision_detection/src/collision_octomap_filter.cpp b/moveit_core/collision_detection/src/collision_octomap_filter.cpp index 3e407db29e..aca52fa2c8 100644 --- a/moveit_core/collision_detection/src/collision_octomap_filter.cpp +++ b/moveit_core/collision_detection/src/collision_octomap_filter.cpp @@ -126,15 +126,15 @@ int collision_detection::refineContactNormals(const World::ObjectConstPtr& objec octree->begin_leafs_bbx(bbx_min, bbx_max); octomap::OcTreeBaseImpl::leaf_bbx_iterator leafs_end = octree->end_leafs_bbx(); - int count = 0; + // int count = 0; for (; it != leafs_end; ++it) { const octomap::point3d pt = it.getCoordinate(); - // double prob = it->getOccupancy(); if (octree->isNodeOccupied(*it)) // magic number! { - count++; node_centers.push_back(pt); + // count++; + // double prob = it->getOccupancy(); // RCLCPP_INFO(getLogger(), "Adding point %d with prob %.3f at [%.3f, %.3f, %.3f]", // count, prob, pt.x(), pt.y(), pt.z()); } diff --git a/moveit_py/src/moveit/moveit_core/robot_state/robot_state.h b/moveit_py/src/moveit/moveit_core/robot_state/robot_state.h index e688705898..97530dd76e 100644 --- a/moveit_py/src/moveit/moveit_core/robot_state/robot_state.h +++ b/moveit_py/src/moveit/moveit_core/robot_state/robot_state.h @@ -38,7 +38,10 @@ #include #include +#pragma GCC diagnostic push +#pragma GCC diagnostic ignored "-Wmaybe-uninitialized" #include +#pragma GCC diagnostic pop #include #include #include