Udał mi się nie dawno zbudować prostą maszynkę CNC

I już natknąłem się na problem. Mianowicie próbuję zmusić Macha3 do wycięcia koła o zadanej średnicy powiedzmy 86.5883mm lecz program nie chce mi uwzględnić G41 i wziąć pod uwagę średnicy narzędzia a dokładniej w ogóle nie zaczyna ciąć koła jak dodam G41 lub G42. Kod poniżej:
Kod: Zaznacz cały
G90G80G49
G0 Z0.1000
G90.1
S0
G0 Z0.1000
G0 X-43.2941 Y0.0000
M3
F1.000 G1 Z0.0000
G2 X-43.2941 Y0.0000 I0.0000 j0.0000
G40
M5
G0 Z0.1000
G0 X0 Y0
M5M30
Jeszcze jedno pytanie nawet jeśli użyję G41 lub 42 to doczytałem się że komendę tą mam dodać bezpośrednio przed danym poleceniem, a co z punktem wejściowym?
Pozdrawiam Michał