Skip to content

Commit b10217b

Browse files
Fix TrajOpt Ifopt collision cost and constraint naming
1 parent 6a823c2 commit b10217b

File tree

1 file changed

+8
-1
lines changed

1 file changed

+8
-1
lines changed

tesseract_motion_planners/trajopt_ifopt/src/trajopt_ifopt_utils.cpp

Lines changed: 8 additions & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -269,6 +269,13 @@ createCollisionConstraints(const std::vector<trajopt_ifopt::JointPosition::Const
269269
}
270270
else
271271
{
272+
const std::string prefix = (config->type == tesseract_collision::CollisionEvaluatorType::LVS_CONTINUOUS) ? "LVSCont"
273+
"inuousC"
274+
"ollisio"
275+
"n_" :
276+
"Continu"
277+
"ousColl"
278+
"ision_";
272279
bool time0_fixed = (std::find(fixed_indices.begin(), fixed_indices.end(), 0) != fixed_indices.end());
273280
for (std::size_t i = 1; i < vars.size(); ++i)
274281
{
@@ -302,7 +309,7 @@ createCollisionConstraints(const std::vector<trajopt_ifopt::JointPosition::Const
302309
position_vars_fixed,
303310
std::min(config->max_num_cnt, static_cast<int>(cp.size())),
304311
fixed_sparsity,
305-
"LVSDiscreteCollision_" + std::to_string(i)));
312+
prefix + std::to_string(i)));
306313

307314
time0_fixed = time1_fixed;
308315
}

0 commit comments

Comments
 (0)