Added step function and options for individual hip and ankle control