reset the preempt flag when leaving Task::plan()

core/src/task.cpp

@@ -46,6 +46,8 @@
 #include <moveit/robot_model_loader/robot_model_loader.h>
 #include <moveit/planning_pipeline/planning_pipeline.h>
 
+#include <scope_guard/scope_guard.hpp>
+
 #include <functional>
 
 namespace {
@@ -234,6 +236,9 @@ void Task::compute() {
 }
 
 moveit::core::MoveItErrorCode Task::plan(size_t max_solutions) {
+	// ensure that the preempt flag is resetted once this method is exited
+	auto guard = sg::make_scope_guard([this]() noexcept { this->resetPreemptFlag(); });
+
 	auto impl = pimpl();
 	init();