diff --git a/src/graph/helper.cc b/src/graph/helper.cc index 671bec9..308d2c2 100644 --- a/src/graph/helper.cc +++ b/src/graph/helper.cc @@ -988,7 +988,7 @@ GraphPtr_t graphBuilder(const ProblemSolverPtr_t& ps, assert(robot.robotFrames(od.name).size() != 0); for (const FrameIndex& f : robot.robotFrames(od.name)) { if (model.frames[f].type != ::pinocchio::JOINT) continue; - const JointIndex j = model.frames[f].parent; + const JointIndex j = model.frames[f].parentJoint; JointPtr_t oj(Joint::create(ps->robot(), j)); LiegroupSpacePtr_t space(oj->configurationSpace()); LiegroupElement lge(robot.currentConfiguration().segment(