Fix a bug on the test script when adding the left/right feet polygonal constraint. Now the CoM height looks normal. Bilinear alternation performs better than the premature terminated NLP in the test.