MATLAB OPTIMIZATION for BoundingQuadruped