28 #ifndef HOLD_TRAJECTORY_BUILDER_H
29 #define HOLD_TRAJECTORY_BUILDER_H
42 template<
class SegmentImpl,
class HardwareInterface>
53 using JointHandle =
typename HardwareInterface::ResourceHandleType;
74 template<
class SegmentImpl,
class HardwareInterface>
81 template<
class SegmentImpl,
class HardwareInterface>
96 for (
unsigned int joint_index = 0; joint_index < joints_.size(); ++joint_index)
98 hold_start_state_.position[0] = joints_[joint_index].getPosition();
99 hold_start_state_.velocity[0] = 0.0;
100 hold_start_state_.acceleration[0] = 0.0;
102 Segment& segment {(*hold_traj)[joint_index].front()};
103 segment.init(start_time, hold_start_state_,
104 start_time, hold_start_state_);
112 #endif // HOLD_TRAJECTORY_BUILDER_H