Skip to content
Snippets Groups Projects
Commit 3975fb35 authored by Mirko Wächter's avatar Mirko Wächter
Browse files

using shiftTime method now in trajectory controller

parent 76c2ae7d
No related branches found
No related tags found
No related merge requests found
......@@ -168,7 +168,14 @@ void TrajectoryControllerSubUnit::loadJointTraj(const TrajectoryBasePtr& jointTr
return;
}
this->jointTraj = this->jointTraj->normalize(0, *this->jointTraj->getTimestamps().rbegin() - *this->jointTraj->getTimestamps().begin());
if (this->jointTraj->size() == 0)
{
ARMARX_ERROR << "Error when loading TrajectoryPlayer: trajectory is empty !!!";
return;
}
auto startTime = this->jointTraj->begin()->getTimestamp();
this->jointTraj->shiftTime(-startTime);
usedJoints = this->jointTraj->getDimensionNames();
ARMARX_INFO << VAROUT(usedJoints);
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment