diff --git a/src/moveit_interface.cpp b/src/moveit_interface.cpp index fe1a6ce..08261b6 100644 --- a/src/moveit_interface.cpp +++ b/src/moveit_interface.cpp @@ -39,7 +39,7 @@ class MoveitInterface : public rclcpp::Node // const moveit::core::JointModelGroup* joint_model_group = robot_state->getJointModelGroup(PLANNING_GROUP); // // planning_scene = std::make_shared(robot_model); -// planning_scene->getCurrentStateNonConst().setToDefaultValues(joint_model_group, "ready"); +// planning_scene->getCurrentStateNonConst().setToDefaultValues(joint_model_group, "ready") move_group_ = std::make_shared(std::shared_ptr(shared_this), PLANNING_GROUP); // const moveit::core::JointModelGroup* joint_model_group = move_group_->getCurrentState()->getJointModelGroup(PLANNING_GROUP);