Call reset before initializing the task

Signed-off-by: Paul Gesel <[email protected]>

Author: pac48

core/src/task.cpp

@@ -248,6 +248,7 @@ moveit::core::MoveItErrorCode Task::plan(size_t max_solutions) {
 	auto guard = sg::make_scope_guard([this]() noexcept { this->resetPreemptRequest(); });
 
 	auto impl = pimpl();
+	reset();
 	init();
 
 	// Print state and return success if there are solutions otherwise the input error_code