0  BEGIN PGM 8245_DE MM 
1  ;NC-Programm, um
2  ;Korrekturwerte fuer die
3  ;Option 3D-ToolComp (Option #92) mit 
4  ;dem Tastsystem zu ermitteln und 
5  ;in die 3DTC-Tabelle zu schreiben.
6  ;Die Tabelle muessen Sie vor dem
7  ;Programmablauf erstellen und
8  ;die Anzahl der benoetigten Zeilen einfuegen.
9  ;In der Spalte Angle definieren Sie 
10 ;die Winkelwerte, bei denen die Steuerung
11 ;den Radius misst.
12 ;Den Pfad der Tabelle
13 ;muessen Sie in der Funktion FN 26
14 ;definieren.
15 ;Am Programmanfang ruft die Steuerung
16 ;ein NC-Programm, mit dem an eine
17 ;Werkstueckkante ein 5mm Radius
18 ;gefraest wird.
19 ;Anschliessend misst die Steuerung
20 ;mit dem Zyklus 444 Punkte auf dem Radius.
21 ;Dazu liest die Steuerung zunaechst den
22 ;definierten Winkel aus der Tabelle, und
23 ;berechnet daraus die Koordinaten und die
24 ;Normalen fuer die Messpunkte.
25 ;Beachten Sie, dass vor dem Messen mit
26 ;dem Zyklus 444 das Tastsystem mit 
27 ;Zyklus 460 in 3D kalibriert werden
28 ;muss!
29 ;Den gemessenen Korrekturwert schreibt
30 ;die Steuerung in die Tabelle.
31 ;Im Satzvorlauf und im Programmtest
32 ;ueberspringt die Steuerung den
33 ;Programmteil messen und schreiben um
34 ;zu vermeiden, dass falsche Werte
35 ;geschrieben werden.
36 ;Nachdem alle Punkte gemessen
37 ;und die Werte in die Tabelle
38 ;geschrieben wurden, springt die
39 ;Steuerung an das Programmende. Im
40 ;Beisielprogramm werden hier zwei
41 ;weitere NC-Programme gerufen. Im ersten
42 ;schlichtet die Steuerung ein weiteres
43 ;Stueck vom Radius 5mm an der
44 ;Werkstueckkante. Hierbei ist zu
45 ;beachten, dass dem Schlichtwerkzeug 
46 ;die Korrekturwerttabelle zugewiesen
47 ;ist.
48 ;Im darauf folgenden NC-Programm 
49 ;misst die Steuerung erneut Punkte auf
50 ;dem Radius, so dass Sie anhand des
51 ;Messprotokolls ueberpruefen koennen,
52 ;ob die Korrektur wirkt.
53 ;
54 BLK FORM 0.1 Z X-50 Y+0 Z-50
55 BLK FORM 0.2  X+0  Y+50  Z+0
56 ;
57 ;Programmaufruf um den Radius
58 ;zu fraesen
59 CALL PGM 82451_de.h
60 ;
61 ;Tabelle, in die die Messergebnisse
62 ;geschrieben werden, oeffnen
63 FN 26: TABOPEN TNC:\system\3D-ToolComp\TAB_8245.3DTC
64 ;
65 ;Eingabeparameter
66 QL20 = 0 ;ERSTE ZEILE DER TABELLE
67 QL21 = 8 ;ANZAHL ZEILEN DER TABELLE
68 QL22 = 5 ;ZU MESSENDER RADIUS
69 QL2 = 3 ;MESSPOSITION IN DER Y-ACHSE
70 ;Parametereingabe Ende
71 ;
72 ;Berechnungen
73 QL23 = QL21 - 1 ;Anzahl der Wiederholungen
74 ;Berechnungen Ende
75 ;
76 ;Bearbeitungsebene schwenken zuruecksetzen
77 PLANE RESET STAY
78 ;Freifahren
79 M140 MB MAX
80 ;
81 ;Werkzeugaufruf Tastsystem
82 TOOL CALL "TOUCH_PROBE" Z S11
83 ;
84 ;Bearbeitungsebene einschwenken
85 PLANE SPATIAL SPA+0 SPB+0 SPC+0 TURN MB MAX FMAX SEQ-
86 ;
87 ;Vorpositionieren
88 L  X+0  Y+0 R0 FMAX
89 L  Z+25 R0 FMAX
90 ;
91 ;Wiederholung
92 LBL "REPETITION"
93 ;Aufruf Unterprogramm CALC
94 CALL LBL "CALC"
95 ;Aufruf Unterprogramm PROBE
96 CALL LBL "PROBE"
97 ;Aufruf Wiederholung
98 CALL LBL "REPETITION" REPQL23
99 ;
100 ;Sprung zum Programmende
101 FN 9: IF +0 EQU +0 GOTO LBL "End"
102 ;
103 ;Unterprogramm Messen
104 LBL "PROBE"
105 FN 18: SYSREAD QL40 = ID992 NR10 ;Pruefen ob Satzvorlauf aktiv
106 FN 9: IF +QL40 EQU +1 GOTO LBL "JUMP" ;Wenn Satzvorlauf aktiv, Sprung ausfuehren 
107 FN 18: SYSREAD QL41 = ID992 NR16 ;Pruefen ob Simulation aktiv
108 FN 9: IF +QL41 EQU +0 GOTO LBL "JUMP" ;Wenn Simulation aktiv, Sprung ausfuehren
109 TCH PROBE 444 ANTASTEN 3D ~
    Q263=+QL1  ;1. PUNKT 1. ACHSE ~
    Q264=+QL2  ;1. PUNKT 2. ACHSE ~
    Q294=+QL3  ;1. PUNKT 3. ACHSE ~
    Q581=+QL11 ;NORMALE HAUPTACHSE ~
    Q582=+QL12 ;NORMALE NEBENACHSE ~
    Q583=+QL13 ;NORMALE WKZ-ACHSE ~
    Q320=+2    ;SICHERHEITS-ABST. ~
    Q260=+25   ;SICHERE HOEHE ~
    QS400="0.015-0.015" ;TOLERANZ ~
    Q309=+0    ;FEHLERREAKTION
110 QL50 = - Q164 ;Messergebnis in Korrekturwert wandeln
111 FN 27: TABWRITE QL20 /"DR2" = QL50 ;Korrekturwert in Tabelle schreiben
112 QL20 = QL20 + 1 ;Nummer der Zeile weiterrechnen
113 ;Sprungmarke zum Ueberspringen der Messung 
114 LBL "JUMP"
115 LBL 0
116 ;Unterprogramm berechnen
117 LBL "CALC"
118 FN 28: TABREAD QL60 =QL20 /"ANGLE" ;Winkel aus Tabelle lesen
119 QL61 = ( SIN QL60 ) * QL22 ;X-Koordinate vom Punkt berechnen
120 QL1 = - QL22 + QL61 ;X-Koordinate vom Punkt berechnen
121 QL62 = COS QL60 * QL22 ;Z-Koordinate vom Punkt berechen
122 QL3 = - QL22 + QL62 ;Z-Koordinate vom Punkt berechnen
123 QL11 = SIN QL60 * 1 ;Normale in der Hauptachse berechnen 
124 QL12 = 0 ;Normale der Nebenachse definieren
125 QL13 = COS QL60 * 1 ;Normale der Werkzeugachse berechnen
126 LBL 0
127 ;
128 ;Programmende
129 LBL "End"
130 ;NC-Programm fuer korrigierte Flaeche aufrufen 
131 CALL PGM 82452_de.h
132 ;NC-Programm fuer Messung aufrufen
133 CALL PGM 82453_de.h
134 M129 M9
135 M30
136 END PGM 8245_DE MM