add getCartPos() and getJacobian() functions for the GUI, still need to be tested