Continued work on ik_node.py; working on function subproblem2