Always switch reference foot in the beginning of SS (not in the middle of DS).
Always switch reference foot in the beginning of SS (not in the middle of DS).

asherikov/smpc_solver,asherikov/smpc_solver