tests/minimum-jerk-problem.cc: ZMP support (close #2)