Finish forward geometry implementation with Choreonoid (see #19)
Enhance Torque implementation (#18, #19)
Enhance minimum-jerk-problem (see #3)