Fanuc 10M Bearbeitungsebene schwenken

Hallo miteinander,

folgendes Problem:

Eine alte Mori Seiki (Fanuc 10M) mit B Achse Raststufen alle 5 Grad (Vertikalmaschine mit Palette). Für gewöhnlich wird der geschwenkte Zustand mit einem 3D Taster angetastet und in G55 usw übertragen. Um das ganze etwas zu beschleunigen suche ich nach einem Makro, welches den Nullpunkt für den geschwenkten Zustand selbstständig berechnet.

Hierbei stieß ich auf folgendes von Forenmitglieder Gottvati:

%
O8099(NULLPUNKTBERECHNUNG)
(G65 P8099 X Y Z B A)
(X [#24] = NP-VERSCH. VOM AKTIVEN NP AUS)
(Y [#25] = NP-VERSCH. VOM AKTIVEN NP AUS)
(Z [#26] = NP-VERSCH. VOM AKTIVEN NP AUS)
(B [#2] = INKR. DREHUNG VOM AKTIVEN NP AUS)
(A [#1] = NEUER NP /// Z.B.- FUER G56 - A56 UND FUER G54.1 P22 - A54.122 SCHREIBEN)

(ALLGEMEINE NP-VERSCHIEBUNG MUSS AUF 0 GESETZT SEIN)
IF[#5201NE0] GOTO1234
IF[#5202NE0] GOTO1234
IF[#5203NE0] GOTO1234
IF[#5204NE0] GOTO1234
GOTO1235
N1234 #3000=175 (ALLG. NP-VERSCH. NICHT AUF 0)
N1235
#998 =-315 (TISCH-DREHMITTE - X)
#999 =-800 (TISCH-DREHMITTE - Z)
#31 =#[5201 + [#4014-53]*20] (AKT. X-NULLP. AUSL.)
#32 =#[5202 + [#4014-53]*20] (AKT. Y-NULLP. AUSL.)
#33 =#[5203 + [#4014-53]*20] (AKT. Z-NULLP. AUSL.)
#30 =#[5204 + [#4014-53]*20] (AKT. B-NULLP. AUSL.)
IF[#4014EQ[ROUND[#4014]]] GOTO2222
(ERWEITERTE NULLP. AUSL.)
#31 =#[6981 + #4130*20] (AKT. X-NULLP. AUSL.)
#32 =#[6982 + #4130*20] (AKT. Y-NULLP. AUSL.)
#33 =#[6983 + #4130*20] (AKT. Z-NULLP. AUSL.)
#30 =#[6984 + #4130*20] (AKT. B-NULLP. AUSL.)
N2222
#23= SQRT[[#31-#998+#24]*[#31-#998+#24]+[#33-#999+#26]*[#33-#999+#26]] (HP)
#27 = ATAN[#31-#998+#24]/[#33-#999+#26] (WINKEL)
#28 = SIN[#27-#2]*#23+#998 (NEUER X-NP)
#29 = COS[#27-#2]*#23+#999 (NEUER Z-NP)
#22 = #1-53
IF[#1EQROUND[#1]] GOTO4311
#22 = [#1-54.1]*1000
N4311
G90G10L[2+[FIX[#1*10]/10-ROUND[#1]]*180] P#22 X#28 Y[#32+#25] Z#29 B#30 (B#30+#2)
M99
%

Die Frage ist, würde das auf einer alten 10-M funktionieren? Zudem kommt, dass das Koordinatensystem um 180° gedreht ist, wenn man vor der Maschine steht, sprich X+ ist dort, wo eigentlich X- ist. Muss das bei dem Makro noch berücksichtigt werden? Wenn ja, wo müssen Änderungen erfolgen?

Vielen Dank im Voraus!