0 BEGIN PGM 8170-fr MM 
1 ;Déterminer le centre de perçage avec trois
2 ;points de mesure et initialisation du point
3 ;de référence X/Y au centre.
4 ;Pour iTNC530 et TNC426 à partir du
5 ;logiciel n° 280 472-XX
6 ;
7 BLK FORM 0.1 Z  X+0  Y+0  Z-50
8 BLK FORM 0.2  X+50  Y+50  Z+0
9 ;
10 ;Appel du palpeur
11 TOOL CALL 501 Z
12 ;
13 ;Définition des paramètres
14 FN 0: Q30 =+25 ;CENTRE DU TROU DANS L'AXE X
15 FN 0: Q31 =+25 ;CENTRE DU TROU DANS L'AXE Y
16 FN 0: Q32 =-5 ;MESURE EN HAUTEUR ! CENTRE DE LA BOULE DE PALPAGE !
17 FN 0: Q33 =+40 ;DIAMÈTRE DU CERCLE DE TROUS
18 FN 0: Q34 =+0 ;1er ANGLE DU POINT DE PALPAGE ! POSITIF !
19 FN 0: Q35 =+120 ;2e ANGLE DU POINT DE PALPAGE ! POSITIF !
20 FN 0: Q36 =+240 ;3e ANGLE DU POINT DE PALPAGE ! POSITIF !
21 FN 0: Q37 =+5 ;DISTANCE DE SÉCURITÉ SUPPLÉMENTAIRE DANS LE SENS DU PALPAGE ! Supplémentaire à MP6140!
22 FN 0: Q38 =+20 ;HAUTEUR DE SÉCURITÉ ! ABSOLUE !
23 FN 0: Q60 =+0 ;NOUVEAU POINT DE RÉFÉRENCE SUR AXE X
24 FN 0: Q61 =+0 ;NOUVEAU POINT DE RÉFÉRENCE SUR AXE Y
25 ;Paramétrages terminés !
26 ;
27 ;Décider si le premier angle doit être recalculé
28 FN 12: IF +Q34 LT +180 GOTO LBL 1
29 FN 9: IF +Q34 EQU +180 GOTO LBL 1
30 FN 11: IF +Q34 GT +0 GOTO LBL 1
31 FN 9: IF +Q34 EQU +0 GOTO LBL 1
32 FN 1: Q34 =-360 + +Q34
33 ;
34 ;Calculs
35 LBL 1
36 FN 18: SYSREAD Q39 = ID1000 NR6140
37 FN 3: Q37 =+Q37 * +Q37
38 FN 5: Q37 = SQRT +Q37
39 FN 2: Q40 =+Q32 - +Q108
40 FN 4: Q41 =+Q33 DIV +2
41 FN 2: Q42 =+Q41 - +Q37
42 FN 2: Q43 =+Q42 - +Q39
43 FN 2: Q44 =+Q43 - +Q108
44 ;
45 ;Calcul de la position du 1er point de palpage
46 FN 7: Q50 = COS +Q34
47 FN 3: Q51 =+Q50 * +Q42
48 FN 1: Q52 =+Q51 + +Q30
49 FN 6: Q53 = SIN +Q34
50 FN 3: Q54 =+Q53 * +Q42
51 FN 1: Q55 =+Q54 + +Q31
52 FN 3: Q56 =+Q50 * +Q44
53 FN 1: Q57 =+Q56 + +Q30
54 FN 3: Q58 =+Q53 * +Q44
55 FN 1: Q59 =+Q54 + +Q31
56 L  Z+Q38 R0 FMAX
57 L  X+Q57  Y+Q59 FMAX
58 L  Z+2 FMAX
59 L  Z+Q40 F2000
60 ;1er cycle de palpage
61 TCH PROBE 1.0 BEZUGSPUNKT POLAR
62 TCH PROBE 1.1 X WINKEL:+Q34
63 TCH PROBE 1.2  X+Q52  Y+Q55  Z+Q32
64 FN 0: Q90 =+Q115
65 FN 0: Q91 =+Q116
66 L  Z+Q38 FMAX
67 ;
68 ;Décider si le deuxième angle doit être recalculé
69 FN 12: IF +Q35 LT +180 GOTO LBL 2
70 FN 9: IF +Q35 EQU +180 GOTO LBL 2
71 FN 11: IF +Q35 GT +0 GOTO LBL 2
72 FN 9: IF +Q35 EQU +0 GOTO LBL 2
73 FN 1: Q35 =-360 + +Q35
74 ;
75 ;Calcul de la position du 2e point de palpage
76 LBL 2
77 FN 7: Q50 = COS +Q35
78 FN 3: Q51 =+Q50 * +Q42
79 FN 1: Q52 =+Q51 + +Q30
80 FN 6: Q53 = SIN +Q35
81 FN 3: Q54 =+Q53 * +Q42
82 FN 1: Q55 =+Q54 + +Q31
83 FN 3: Q56 =+Q50 * +Q44
84 FN 1: Q57 =+Q56 + +Q30
85 FN 3: Q58 =+Q53 * +Q44
86 FN 1: Q59 =+Q58 + +Q31
87 L  Z+Q38 R0 FMAX
88 L  X+Q57  Y+Q59 FMAX
89 L  Z+2 FMAX
90 L  Z+Q40 F2000
91 ;2e cycle de palpage
92 TCH PROBE 1.0 BEZUGSPUNKT POLAR
93 TCH PROBE 1.1 X WINKEL:+Q35
94 TCH PROBE 1.2  X+Q52  Y+Q55  Z+Q32
95 FN 0: Q92 =+Q115
96 FN 0: Q93 =+Q116
97 L  Z+Q38 FMAX
98 ;
99 ;Décider si le troisième angle doit être recalculé
100 FN 12: IF +Q36 LT +180 GOTO LBL 3
101 FN 9: IF +Q36 EQU +180 GOTO LBL 3
102 FN 11: IF +Q36 GT +0 GOTO LBL 3
103 FN 9: IF +Q36 EQU +0 GOTO LBL 3
104 FN 1: Q36 =-360 + +Q36
105 ;
106 ;Calcul de la position du 3e point de palpage
107 LBL 3
108 FN 7: Q50 = COS +Q36
109 FN 3: Q51 =+Q50 * +Q42
110 FN 1: Q52 =+Q51 + +Q30
111 FN 6: Q53 = SIN +Q36
112 FN 3: Q54 =+Q53 * +Q42
113 FN 1: Q55 =+Q54 + +Q31
114 FN 3: Q56 =+Q50 * +Q44
115 FN 1: Q57 =+Q56 + +Q30
116 FN 3: Q58 =+Q53 * +Q44
117 FN 1: Q59 =+Q58 + +Q31
118 L  Z+Q38 R0 FMAX
119 L  X+Q57  Y+Q59 FMAX
120 L  Z+2 FMAX
121 L  Z+Q40 F2000
122 ;3e cycle de palpage
123 TCH PROBE 1.0 BEZUGSPUNKT POLAR
124 TCH PROBE 1.1 X WINKEL:+Q36
125 TCH PROBE 1.2  X+Q52  Y+Q55  Z+Q32
126 FN 0: Q94 =+Q115
127 FN 0: Q95 =+Q116
128 L  Z+Q38 FMAX
129 ;
130 ;
131 ;Déterminer le point central du cercle
132 FN 23: Q97 = CDATA Q90
133 ;Placer les points de référence X et Y
134 FN 25: PRESET =  X /+Q97 /+Q60
135 FN 25: PRESET =  Y /+Q98 /+Q61
136 ;
137 ;Fin du programme
138 M30
139 END PGM 8170-fr MM