No nie wiem czy reszta to pikuś, a jedyny problem to wzór na zagłębianie w osi X.
(tu chyba wystarczy zparametryzować G12-fanuc-interpolacja układu
współrzędnych biegunowych)

Każde kolejne zagłębienie na nowej pozycji w osi Z,
musi wystartować zawsze z tej samej pozycji kątowej wrzeciona.
Więc rozpoczęcie ruchu w osi X musi być zsynchronizowane z
pozycją kątową wrzeciona.
Jestem ciekaw jak to chcesz uzyskać?