initial multi-step implementation
before adding new cvxgen implemtnation
it works, but now I'm changing to the posture version
adds posture-aware cvx version