give this one a try (lots of log spam, but it just worked for me end-to-end)
it is still doing funny movement between measurements. In my case the measurement points are 50mm apart and it goes off about 100-150mm in a seemingly random direction before coming back to the next location.
edit: it would help if I included the link 