Skip to content

Commit

Permalink
Add explanation for scene reset
Browse files Browse the repository at this point in the history
  • Loading branch information
sjahr authored Oct 23, 2023
1 parent 71d9c3e commit dd6f683
Showing 1 changed file with 2 additions and 1 deletion.
3 changes: 2 additions & 1 deletion core/src/task.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -281,7 +281,8 @@ moveit::core::MoveItErrorCode Task::execute(const SolutionBase& s) {
moveit_task_constructor_msgs::action::ExecuteTaskSolution::Goal goal;
s.toMsg(goal.solution, pimpl()->introspection_.get());

// Reset joint values in scene diff
// Reset joint values in scene diff to prevent any execution capability from
// modifying the planning scene joint values
for (auto& sub_trajectory : goal.solution.sub_trajectory) {
sub_trajectory.scene_diff.robot_state.joint_state = sensor_msgs::msg::JointState();
sub_trajectory.scene_diff.robot_state.multi_dof_joint_state = sensor_msgs::msg::MultiDOFJointState();
Expand Down

0 comments on commit dd6f683

Please sign in to comment.