Running valgrind I got an invalid read at https://github.com/humanoid-path-planner/hpp-pinocchio/blob/97580c46c3ed81a4e976bec10e326c7a04098b8c/src/center-of-mass-computation.cc#L71. Adding `assert(root < roots_.size());` before this line confirms the issue.