Galkov, посмотрите здесь https://forum.hiasm.com/post/303755, наверное у вас есть наработки по поиску оптимального перемещения для двух-координатного сверла