Делаем программу для нарезки резьбы не очень понятно как построить алгоритм

на фануке знаю как пытаюсь сименс 828D пристроить программа должна выглядеть примерно так есть ошибки которые пока не знаю как решить
N1
N2 ;O0222;
N3 ;(UNIVERSALNII KONUS)
N4 ;(KORREKTOR=R FREZI)
N5 ;(PO SPIRALI)
N6 ;(OBRABOTKA SVERHU VNIZ)
N7 ;(X,Y-CENTR)
N8 ;(Z-VERH)
N9 ;(----------------------------------------)
N10 R101=0.0;(Z.VERH)
N11 R102=6.0;(Z GLUBINA KONUSA S UCHETOM NEDOBEGA I PEREBEGA)
N12 R103=6.86;(RADIUS OTV. BOLSHOI)
N13 R104=TAN(22);(UGOL KONUSA POLOVINA RAZVERNUTOGO UGLA)
N14 R105=0.8;(SHAG.Z NA RADIUS)
N15 R106=2;(NAPRAVLENIE G02/G03)
N15 R108=54;
N15 R109=50; PODACA
N16 ;(----------------------------------------)
N17
N18 IF[R106 EQ2]THEN R110=42;(KORREKTOR PRI G02)
N19 IF[R106 EQ3]THEN R110=41;(KORREKTOR PRI G03)
N20 G=R108
N21 G80G69
N22 G17G40G80G90
N23 G00 D1
N24 M08
N25 G00X0.0Y0.0;(KOORDINATI OTVERSTIYA)
N26 G00Z20.0
N27 G00Z0.0;
N28 G1 G=R110 X=R103 Z=-R101 F1000M8
N29 WHILE R101<=R102
N30 R101=R101+R105;
N31 R103=R103-(R104*R105);
N32 G=R106 X=-R103 J=R103 Z=-R101 F=R109;
N33 R103=R103-(R104*R105);
N34 R101=R101+R105;
N35 G=R106 X=R103 J=R103 Z=-R101 F=R109
N36 ENDWHILE
N37 G40
N38 G1X0 Y0
N39 G00GZ20.
N40 M30