knee controller added

simulation doesn't step up knee angle