test_02_07: penalize jerk of the swing foot
test_02_08: infeasible arm motion + swing foot jerk penalization.