add leg fk/ik and tests