Re-add test for minimum jerk trajectory