https://123dok.co/document/yng9mpep-time-optimal-trajectory-planning-robot-torque-impulse-constraints.html