Debug and test minimum jerk trajectory.