fix to match new interfaces
more bug fixes to get drakeWalking(Momentum) working