I downloaded the drivers you included but I'm pretty overwhelmed by all the different VIs. How are you managing your position? Would it be possible to simply send it many different positions the way you're getting it from point A to point B? I'm thinking, instead of saying "Go to Point B" tell it "Go to point B, then C, then D..." and end up at your original destination?
Feel free to include your code or at least let me know which of the VI's you're using in that library.