Refined tests for cartesian point (some test commented out)
Added functionality/tests for gettting multiple joint solutions at multiple cartesian poses