Improved print_plot() function.
Created subdirectory for tests with capture point.
Fixed indices of rotation matrices.
Added wb_extensions. Simple bounds on footstep positions.
Initial state is variable with equality constraint.
Use CoP positions as control variables.
Improved documentation.
Implemented formulation with simple bounds.