Closed brianhou closed 7 years ago
@mkoval I had some issues implementing this in the way you described. I think the problem is that when we receive a goal, we immediately try to convert the entire ROS JointTrajectory
into an aikido::trajectory::Spline
in the controlled space. The way I've done it in https://github.com/personalrobotics/aikido/issues/217 is to pass in the current configuration into aikido::control::ros::toSplineJointTrajectory
and edit each waypoint before computing the splines. What do you think?
@mkoval's original suggestion: