Holonomic::Trajectory<State_t>::Trajectory (const Trajectory<State_t> &trajectoryIn)
{
    endState = new State_t (trajectoryIn.getEndState());
}