diff --git a/rasms_manipulator/src/behavior_tree_nodes/Move.cpp b/rasms_manipulator/src/behavior_tree_nodes/Move.cpp index d1c86b2..cd76b08 100644 --- a/rasms_manipulator/src/behavior_tree_nodes/Move.cpp +++ b/rasms_manipulator/src/behavior_tree_nodes/Move.cpp @@ -88,7 +88,7 @@ void Move::on_tick() std::cerr << "No coordinate for waypoint [" << goal << "]" << std::endl; } - std::string PLANNING_GROUP = "rasms_arm_group";\ + std::string PLANNING_GROUP = "rasms_arm_group"; moveit::planning_interface::MoveGroupInterface move_group(PLANNING_GROUP); geometry_msgs::msg::PoseStamped goal_pos; @@ -106,6 +106,7 @@ void Move::on_tick() if (success) { move_group.execute(my_plan); + move_group.move(); } else { return; }