Double and Single Stance work independently

Things still do not converge well for the Work cost function, but
actuation squared works great.