trying to make it work with moveIt and some more calibration of jaco