getCartPos() and getJacobian() work