Enhance minimum jerk Choreonoid plugin (help solve #10, #27)