diff --git a/moveit_py/src/moveit/moveit_ros/planning_scene_monitor/planning_scene_monitor.cpp b/moveit_py/src/moveit/moveit_ros/planning_scene_monitor/planning_scene_monitor.cpp index f59103e3cb..f5487cc68d 100644 --- a/moveit_py/src/moveit/moveit_ros/planning_scene_monitor/planning_scene_monitor.cpp +++ b/moveit_py/src/moveit/moveit_ros/planning_scene_monitor/planning_scene_monitor.cpp @@ -79,17 +79,6 @@ void LockedPlanningSceneContextManagerRW::lockedPlanningSceneRwExit(const py::ob ls_rw_.reset(); } -// TODO: simplify with typecaster -void applyPlanningScene(std::shared_ptr& planning_scene_monitor, - const moveit_msgs::msg::PlanningScene& planning_scene) -{ - // lock planning scene - { - planning_scene_monitor::LockedPlanningSceneRW scene(planning_scene_monitor); - scene->usePlanningSceneMsg(planning_scene); - } -} - void initPlanningSceneMonitor(py::module& m) { py::class_( diff --git a/moveit_py/src/moveit/moveit_ros/planning_scene_monitor/planning_scene_monitor.h b/moveit_py/src/moveit/moveit_ros/planning_scene_monitor/planning_scene_monitor.h index e6b5e514bf..f914f444cd 100644 --- a/moveit_py/src/moveit/moveit_ros/planning_scene_monitor/planning_scene_monitor.h +++ b/moveit_py/src/moveit/moveit_ros/planning_scene_monitor/planning_scene_monitor.h @@ -90,14 +90,6 @@ readWrite(const planning_scene_monitor::PlanningSceneMonitorPtr& planning_scene_ LockedPlanningSceneContextManagerRO readOnly(const planning_scene_monitor::PlanningSceneMonitorPtr& planning_scene_monitor); -// const planning_scene::PlanningScenePtr& locked_planning_scene_enter_(LockedPlanningSceneContextManager& context_manager); - -// void locked_planning_scene_exit_(LockedPlanningSceneContextManager& context_manager, const py::object& type, -// const py::object& value, const py::object& traceback); - -void applyPlanningScene(std::shared_ptr& planning_scene_monitor, - const moveit_msgs::msg::PlanningScene& planning_scene); - void initPlanningSceneMonitor(py::module& m); void initContextManagers(py::module& m);