added hip nudge gains
eliminated NANs by memsetting balCmd. Changed leg lengths