Zrobiłem Ci symulację obydwóch wersji programów, sam zobacz różnicę ...
Wydaje mi się że zdecydowanie pierwsza wersja
Przyjąłem że toczysz płytką DMMG o promieniu 1 mm
Zwróć uwagę na kolory - czerwony to wjazd na G0.
Musiałem dopisać G1 przy G42 , inaczej raczej crash