Wrote a pretty general setup for IK solver. Need to change the crane game stuff as well. If the push_one_arm stuff still works then we should be golden.