Use Choreonoid (optionally) in minimum-jerk-problem
Improve ZMP tests