Adjust reference motion in minimum jerk problem
Aesthetic adjustment in minimum jerk problem
Enable feet position in minimum jerk problem.