Na symulacji wygląda dobrze, a jak będzie to zobaczymy. Nic innego nie znalazłem co mogło by sprawdzać otrzymane współrzędne ( odrzucić ewentualne błędy pomiaru) i wygładzić kształt. Myślę ze zagęszczenie punktów pomiarowych poprawi znacząco otrzymany kontur kosztem czasu skanowania powierzchni.
G64 można użyć z parametrem "P 0.1" lub innej wartości co "zabezpieczy" wykonywany kształt.