Skip to content

Commit

Permalink
Revert "Fix generation of Solution msg: consider backward operation"
Browse files Browse the repository at this point in the history
This reverts commit 4aac679, because
MoveIt2 is missing a port of moveit/moveit#3538.
  • Loading branch information
rhaschke committed Mar 13, 2024
1 parent c3a69ab commit b40e932
Showing 1 changed file with 1 addition and 4 deletions.
5 changes: 1 addition & 4 deletions core/src/storage.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -240,10 +240,7 @@ void SubTrajectory::appendTo(moveit_task_constructor_msgs::msg::Solution& msg, I
if (trajectory())
trajectory()->getRobotTrajectoryMsg(t.trajectory);

if (this->end()->scene()->getParent() == this->start()->scene())
this->end()->scene()->getPlanningSceneDiffMsg(t.scene_diff);
else
this->end()->scene()->getPlanningSceneMsg(t.scene_diff);
this->end()->scene()->getPlanningSceneDiffMsg(t.scene_diff);
}

double SubTrajectory::computeCost(const CostTerm& f, std::string& comment) const {
Expand Down

0 comments on commit b40e932

Please sign in to comment.