A bug in the swing foot jerk penalization.
Added init_walk_01() function.