Hallo liebe Community,
ich arbeite derzeit an einer SAMAG TFZ-3L-1500 ( Tiefbohrwerk ) mit iTNC530 und mit Rundtisch und schwenkbarer A-Achse.
Um möglichst wenig Verfahrwege bei 4-seitiger Bearbeitung zu haben, versuche ich mich momentan an einem Unterprogramm welches über die Notwendigkeit eines Verfahrens auf einen Sicherheitsabstand zum Schwenken der Achsen entscheiden soll.
Ziel ist, dass bei Tischstellung 0°, 90°, 180° und 270° und A-Achse = 0° kein Sicherheitsabstand angefahren werden soll,
bei allen anderen Winkelstellung hingegen schon.
Bisher sieht mein Programm aus wie folgt :
CODE
0 BEGIN PGM Rotation MM
1 CALL LBL 1
2 LBL 5
3 FN 1: Q1700 =+360 + +Q1700
4 CALL LBL 4
5 LBL 2
6 CALL PGM TNC:\Sicherheit.h
7 CALL LBL 3
8 LBL 1
9 FN 18: SYSREAD Q1700 = ID210 NR5 IDX2
10 FN 18: SYSREAD Q1701 = ID270 NR1 IDX5
11 FN 18: SYSREAD Q1702 = ID210 NR5 IDX1
12 FN 18: SYSREAD Q1703 = ID270 NR1 IDX4
13 FN 1: Q1704 =+Q1701 + +0.005
14 FN 2: Q1705 =+Q1701 - +0.005
15 FN 1: Q1706 =+Q1703 + +0.005
16 FN 2: Q1707 =+Q1703 - +0.005
17 FN 12: IF +Q1700 LT +0 GOTO LBL 5
18 LBL 4
19 FN 12: IF +Q1700 LT +Q1705 GOTO LBL 2
20 FN 11: IF +Q1700 GT +Q1704 GOTO LBL 2
21 FN 12: IF +Q1702 LT +Q1707 GOTO LBL 2
22 FN 11: IF +Q1702 GT +Q1706 GOTO LBL 2
23 CALL LBL 3
24 LBL 3
25 END PGM Rotation MM
Weiter komme ich irgendwie nicht, ist der Ansatz evtl. schon falsch ?
Vielen Dank schonmal für eure Hilfe.