0  BEGIN PGM SL2_275 MM 
1  FN 22: FUNCT Q0 FNR1 PIN0 PIN1 ;INIT KONTURBEARBEITUNG
2  FN 9: IF +Q0 EQU +0 GOTO LBL 1
3  FN 14: ERROR= 1015
4  FN 9: IF +0 EQU +0 GOTO LBL 254
5  LBL 1
6  FN 22: FUNCT Q0 FNR121 PIN0 PIN0 PIN35 ;SAVE Q0-Q35
7  FN 17: SYSWRITE ID 30 NR10 =+Q207 ;VORSCHUB FRAESEN
8  FN 18: SYSREAD Q0 = ID31 NR31 IDX0 ;LABELNUMMER
9  FN 22: FUNCT Q0 FNR3 PINQ0 PIN0 PIN1 ;OFFENE KONTUR LESEN
10 FN 18: SYSREAD Q30 = ID212
11 FN 9: IF +Q0 EQU +0 GOTO LBL 2
12 FN 14: ERROR= 1015
13 FN 9: IF +0 EQU +0 GOTO LBL 253
14 LBL 2
15 FN 18: SYSREAD Q24 = ID20 NR3 ;WZ-Achse
16 FN 1: Q24 =+Q24 + +1 ; wg. x==1
17 FN 18: SYSREAD Q22 = ID220 NR2 IDXQ24 ;VERSCHIEBUNG
18 FN 18: SYSREAD Q23 = ID210 NR4 IDXQ24 ;SKALIERUNG
19 Q5 = Q23 * Q203 + Q22 ;WS-HOEHE ; TRANSFORMATION
20 Q6 = Q5 - SGN Q201 * ABS Q200 * Q23
21 Q7 = Q5 - SGN Q201 * ABS Q204 * Q23 ; RZG-HOEHE ; TRANSFORMATION
22 Q17 = Q203 - SGN Q201 * ABS Q204 ; IM EINGABESYSTEM
23 Q1 = Q23 * Q201 ; TIEFE SKALIEREN
24 FN 1: Q8 =+Q24 + +1
25 FN 1: Q9 =+Q8 + +1
26 FN 11: IF +4 GT +Q8 GOTO LBL 201
27 FN 2: Q8 =+Q8 - +3
28 LBL 201
29 FN 11: IF +4 GT +Q9 GOTO LBL 202
30 FN 2: Q9 =+Q9 - +3
31 LBL 202
32 FN 18: SYSREAD Q8 = ID210 NR4 IDXQ8 ;SKALIERUNG
33 FN 18: SYSREAD Q9 = ID210 NR4 IDXQ9 ;SKALIERUNG
34 FN 9: IF +Q8 EQU +Q9 GOTO LBL 203
35 FN 14: ERROR= 1108
36 LBL 203
37 Q219 = Q8 * Q219
38 Q10 = Q23 * Q200
39 FN 17: SYSWRITE ID 31 NR21 =+Q206 ;PENDELVORSCHUB
40 FN 17: SYSWRITE ID 31 NR18 =+0 ; UEBERGANGSRADIUS
41 FN 17: SYSWRITE ID 31 NR22 =+Q7 ;SICHERE HOEHE
42 FN 17: SYSWRITE ID 31 NR23 =+Q5 ;WERKSTUECKHOEHE
43 FN 17: SYSWRITE ID 31 NR24 =+Q6 ;ZYKLUSBEGINNHOEHE
44 FN 17: SYSWRITE ID 30 NR1 =+Q10 ;SICHERHEITSABSTAND
45 FN 9: IF +Q1 EQU +0 GOTO LBL 4
46 FN 12: IF +Q1 LT +0 GOTO LBL 4
47 FN 18: SYSREAD Q29 = ID1000 NR7441
48 FN 12: IF +Q29 LT +4 GOTO LBL 4
49 FN 14: ERROR= 1077
50 FN 9: IF +0 EQU +0 GOTO LBL 253
51 LBL 4
52 Q10 = ABS Q202
53 Q24 = ABS Q1
54 FN 11: IF +Q24 GT +Q10 GOTO LBL 14
55 FN 0: Q10 =+Q24 ;
56 LBL 14
57 FN 17: SYSWRITE ID 31 NR17 =+Q368 ;SCHLICHTAUFMASS
58 FN 17: SYSWRITE ID 30 NR3 =+Q10 ;ZUSTELLTIEFE
59 FN 17: SYSWRITE ID 30 NR4 =+Q206 ;VORSCHUB TIEFE
60 FN 17: SYSWRITE ID 30 NR11 =+Q351 ; FRAESART
61 FN 17: SYSWRITE ID 31 NR29 =+Q219 ; NUTBREITE
62 FN 17: SYSWRITE ID 31 NR26 =+Q436 ; ZUSTELLUNG PRO UMLAUF
63 FN 22: FUNCT Q0 FNR112
64 FN 17: SYSWRITE ID 212 =+3
65 FN 0: Q24 =+0 ;AKT. ZUSTELLTIEFE
66 FN 0: Q25 =+Q6 ;ZYKLUSBEGINNHOEHE
67 FN 0: Q26 =+0 ;AKTUELLE ZUSTELLUNG
68 FN 18: SYSREAD Q23 = ID200 NR0 IDX0 ;RADIUS AKT.WERKZEUG
69 Q23 = Q219 / 2 - Q23
70 LBL 16 ; KONTURNUT
71 FN 9: IF +Q215 EQU +2 GOTO LBL 17
72 LBL 13 ; KONTURNUT
73 CALL LBL 9
74 FN 22: FUNCT Q0 FNR43 PIN0 PEX+Q366 ; KONTUR FRAESEN
75 CALL LBL 10
76 FN 1: Q25 =+Q6 + +Q24 ;AKT.BEARBEITUNGSHOEHE
77 FN 10: IF +Q24 NE +Q1 GOTO LBL 13
78 FN 9: IF +Q215 EQU +1 GOTO LBL 253
79 LBL 17
80 FN 10: IF +Q338 NE +0 GOTO LBL 18
81 FN 0: Q338 =+Q1
82 LBL 18
83 Q10 = ABS Q338
84 FN 17: SYSWRITE ID 30 NR3 =+Q10 ;ZUSTELLTIEFE
85 FN 17: SYSWRITE ID 30 NR10 =+Q385 ;VORSCHUB SCHLICHTEN
86 FN 22: FUNCT Q0 FNR4 PIN0 PIN1024 ; LOCALER LABEL
87 FN 22: FUNCT Q0 FNR11 PIN0 PIN1025 ; LOCALER LABEL
88 FN 22: FUNCT Q0 FNR4 PIN1025 PIN1024 PIN1 ;CONCATENATE
89 FN 22: FUNCT Q0 FNR18 PIN1024 ;CLOSE
90 FN 0: Q0 =-2
91 FN 22: FUNCT Q0 FNR10 PIN1024 PIN0 PINQ0 ;KONTURCHARAKTERISTIK
92 FN 22: FUNCT Q0 FNR30 PIN1024 PEX+Q23 ;KONTUR KORRIGIEREN
93 FN 0: Q24 =+0 ;AKT. ZUSTELLTIEFE
94 FN 0: Q25 =+Q6 ;ZYKLUSBEGINNHOEHE
95 FN 0: Q26 =+0 ;AKTUELLE ZUSTELLUNG
96 LBL 15 ; KONTURNUT SCHLICHTEN
97 CALL LBL 8
98 FN 1: Q25 =+Q5 + +Q24 ;AKT.BEARBEITUNGSHOEHE
99 FN 17: SYSWRITE ID 30 NR1 =+0 ;SICHERHEITSABSTAND
100 FN 10: IF +Q24 NE +Q1 GOTO LBL 15
101 FN 9: IF +0 EQU +0 GOTO LBL 253
102 LBL 8
103 CALL LBL 9
104 L FQ207 ;
105 FN 22: FUNCT Q0 FNR40 PIN0 ;KONTUR FRAESEN
106 CALL LBL 10
107 LBL 0
108 LBL 9
109 FN 0: Q26 =+Q24 ;
110 Q28 = SGN Q1 * Q10
111 Q24 = Q24 + Q28
112 Q31 = ABS Q24
113 Q29 = ABS Q1
114 FN 12: IF +Q31 LT +Q29 GOTO LBL 11
115 FN 0: Q24 =+Q1 ;LETZE ZUSTELLUNG
116 Q28 = Q24 - Q26
117 LBL 11
118 FN 17: SYSWRITE ID 31 NR23 =+Q5 ;WERKSTUECKHOEHE
119 FN 17: SYSWRITE ID 31 NR24 =+Q25 ;ZYKLUSBEGINNHOEHE
120 FN 17: SYSWRITE ID 30 NR2 =+Q28 ;AKT.FRAESZUSTELLUNG
121 LBL 0
122 LBL 10
123 FN 18: SYSREAD Q27 = ID270 NR1 IDX1 ; BEZUGS POSITION X
124 FN 18: SYSREAD Q28 = ID270 NR1 IDX2 ; BEZUGS POSITION Y
125 FN 18: SYSREAD Q29 = ID270 NR1 IDX3 ; BEZUGS POSITION Z
126 L  Z+Q29 FQ206 ; DUMMY BEZUG Z AN GEO
127 L  X+Q27  Y+Q28 FQ207 ; DUMMY BEZUG X,Y AN GEO
128 FN 10: IF +Q24 NE +Q1 GOTO LBL 97
129 L  Z+Q17 FMAX ; IM EINGABESYSTEM
130 LBL 97
131 LBL 0
132 LBL 253
133 FN 17: SYSWRITE ID 212 =+Q30
134 FN 22: FUNCT Q0 FNR121 PIN1 PIN0 PIN35 ;RESTORE Q0-Q35
135 FN 22: FUNCT Q0 FNR2
136 LBL 254
137 END PGM SL2_275 MM 
