From 603696f29405c1a30211e31b487be8dfa70f09b3 Mon Sep 17 00:00:00 2001 From: Robert Haschke Date: Sat, 24 Mar 2018 11:02:03 +0100 Subject: [PATCH] add missing reset() --- core/include/moveit/task_constructor/stages/generate_pose.h | 3 ++- core/src/stages/generate_pose.cpp | 6 ++++++ 2 files changed, 8 insertions(+), 1 deletion(-) diff --git a/core/include/moveit/task_constructor/stages/generate_pose.h b/core/include/moveit/task_constructor/stages/generate_pose.h index d7893639..0817e494 100644 --- a/core/include/moveit/task_constructor/stages/generate_pose.h +++ b/core/include/moveit/task_constructor/stages/generate_pose.h @@ -47,6 +47,7 @@ class GeneratePose : public MonitoringGenerator { public: GeneratePose(const std::string& name); + void reset() override; bool canCompute() const override; bool compute() override; @@ -57,7 +58,7 @@ public: protected: void onNewSolution(const SolutionBase& s) override; - std::deque scenes_; + std::deque scenes_; }; } } } diff --git a/core/src/stages/generate_pose.cpp b/core/src/stages/generate_pose.cpp index d54eef54..3d1307a0 100644 --- a/core/src/stages/generate_pose.cpp +++ b/core/src/stages/generate_pose.cpp @@ -53,6 +53,12 @@ GeneratePose::GeneratePose(const std::string& name) p.declare("pose", "target pose to pass on in spawned states"); } +void GeneratePose::reset() +{ + MonitoringGenerator::reset(); + scenes_.clear(); +} + void GeneratePose::onNewSolution(const SolutionBase& s) { scenes_.push_back(s.end()->scene()->diff());