diff --git a/core/include/moveit/task_constructor/storage.h b/core/include/moveit/task_constructor/storage.h index 0b7dd54cb..e0796980d 100644 --- a/core/include/moveit/task_constructor/storage.h +++ b/core/include/moveit/task_constructor/storage.h @@ -94,10 +94,9 @@ class InterfaceState */ struct Priority : std::tuple { - Priority(unsigned int depth, double cost, Status status = ENABLED) - : std::tuple(status, depth, cost) { - assert(std::isfinite(cost)); - } + Priority(unsigned int depth, double cost, Status status) + : std::tuple(status, depth, cost) {} + Priority(unsigned int depth, double cost) : Priority(depth, cost, std::isfinite(cost) ? ENABLED : PRUNED) {} // Constructor copying depth and cost, but modifying its status Priority(const Priority& other, Status status) : Priority(other.depth(), other.cost(), status) {}