update utilities to new named joints
remove print statements in legIK
add geometry and tests