change some variable names to make joint vs link clearer
add function for finding links, emphasize difference between joints and links