tests/minimum-jerk-problem.cc: Log ZMP trajectory at each iteration
Handle base position and attitude in ForwardGeometry (partially solve #19)
Use finite difference gradient in forward geometry from Choreoonoid
Add tests for forward geometry from Choreoonoid
Make sure the initial trajectory is plotted correctly in tests/minimum-jerk-problem.cc