Here are some spots of dynamic memory allocation in the realtime update method of the JTC we should try to get rid of:
In fill_partial_goal():
|
trajectory_msg->joint_names.push_back(joint_names_[index]); |
And several other places.
In sort_to_local_joint_order():
output.resize(mapping.size(), 0.0);