From 9545f926789154661d1d13bdf27d8ec451e7982c Mon Sep 17 00:00:00 2001 From: Robert Haschke Date: Sun, 25 Feb 2018 23:02:18 +0100 Subject: [PATCH] GenerateGraspPose::reset() --- .../moveit/task_constructor/stages/generate_grasp_pose.h | 1 + core/src/stages/generate_grasp_pose.cpp | 7 +++++++ 2 files changed, 8 insertions(+) diff --git a/core/include/moveit/task_constructor/stages/generate_grasp_pose.h b/core/include/moveit/task_constructor/stages/generate_grasp_pose.h index f81ee5d0..9f4b4885 100644 --- a/core/include/moveit/task_constructor/stages/generate_grasp_pose.h +++ b/core/include/moveit/task_constructor/stages/generate_grasp_pose.h @@ -47,6 +47,7 @@ class GenerateGraspPose : public MonitoringGenerator { public: GenerateGraspPose(const std::string& name); + void reset() override; bool canCompute() const override; bool compute() override; diff --git a/core/src/stages/generate_grasp_pose.cpp b/core/src/stages/generate_grasp_pose.cpp index 53582637..6bd164a3 100644 --- a/core/src/stages/generate_grasp_pose.cpp +++ b/core/src/stages/generate_grasp_pose.cpp @@ -85,6 +85,13 @@ void GenerateGraspPose::setAngleDelta(double delta){ setProperty("angle_delta", delta); } +void GenerateGraspPose::reset() +{ + scene_.reset(); + current_angle_ = 0.0; + MonitoringGenerator::reset(); +} + void GenerateGraspPose::onNewSolution(const SolutionBase& s) { if (scene_)