MACRO: Hole center by 3 points

[Simtech]

Hi all,

I recently received a request to create a macro program to extract the center point of a hole (or cylinder) given 3 points along the hole or cylinder's edge (by using an edge finder for example).

 

In Fanuc style, this is what I've come up with.

 

Run program O9101 when probe is in first position (stores X and Y in #111 and #112)

Run program O9102 when probe is in second position (stores X and Y in #121 and #122)

Run program O9103 when probe is in third position (stores X and Y in #131 and #132 retracts and moves to center)

Use machine coordinates to enter Work Offset.

 

Any comments are welcome!

 

Regards,

 

Luc

 

O9101

#111=#5021 (POSITION OF MACHINE X AXIS - POINT 1)

#112=#5022 (POSITION OF MACHINE Y AXIS - POINT 1)

M30

 

O9102

#121=#5021 (POSITION OF MACHINE X AXIS - POINT 2)

#122=#5022 (POSITION OF MACHINE Y AXIS - POINT 2)

M30

 

 

O9103(CIRCLE CENTER FROM 3 POINTS)

(O9101: USED TO STORE POINT 1 IN #111 AND #112)

(09102: USED TO STORE POINT 2 IN #121 AND #122)

(#131=#5021 (POSITION OF MACHINE X AXIS))

(#132=#5022 (POSITION OF MACHINE Y AXIS))

(#100: SLOPE OF LINE A)

(#101: SLOPE OF LINE

(#102: SLOPE OF LINE PERP TO A)

(#103: SLOPE OF LINE PERP TO B - NOT USED)

(#104: SLOPE A TIMES SLOPE

(#105: Y1-Y3)

(#106: X1+X2)

(#107: X2+X3)

(#108: SLOPE B - SLOPE A)

(#109: Y1+Y2)

(#110: X-#106/2)

(#141: POINT X OF CENTER)

(#142: POINT Y OF CENTER)

(***** VARIABLE CALCULATIONS *****)

#100=(#122-#112)/(#121-#111)

#101=(#132-#122)/(#131-#121)

#102=(-1/#100)

#103=(-1/#101)

#104=(#100*#101)

#105=(#112-#132)

#106=(#111+#121)

#107=(#121+#131)

#108=(#101-#100)

#109=(#112+#122)

#141=((#104*#105)+(#101*#106)-(#100*#107))/(2*#108)

#110=(#141-(#106/2))

#142=(*#102*#110)+(#109/2)

(***** MACHINE MOUVEMENT *****)

G91 G00 Z5.0

G53 G01 X#141 Y#142 F10.0

(***** END OF MACRO *****)

M30

%

[Simtech]

Oops, remove parenthesis on these lines

 

#131=#5021 (POSITION OF MACHINE X AXIS)

#132=#5022 (POSITION OF MACHINE Y AXIS)

 

Corrected below!!!

 

 

Hi all,

I recently received a request to create a macro program to extract the center point of a hole (or cylinder) given 3 points along the hole or cylinder's edge (by using an edge finder for example).

 

In Fanuc style, this is what I've come up with.

 

Run program O9101 when probe is in first position (stores X and Y in #111 and #112)

Run program O9102 when probe is in second position (stores X and Y in #121 and #122)

Run program O9103 when probe is in third position (stores X and Y in #131 and #132 retracts and moves to center)

Use machine coordinates to enter Work Offset.

 

Any comments are welcome!

 

Regards,

 

Luc

 

O9101

#111=#5021 (POSITION OF MACHINE X AXIS - POINT 1)

#112=#5022 (POSITION OF MACHINE Y AXIS - POINT 1)

M30

 

O9102

#121=#5021 (POSITION OF MACHINE X AXIS - POINT 2)

#122=#5022 (POSITION OF MACHINE Y AXIS - POINT 2)

M30

 

 

O9103(CIRCLE CENTER FROM 3 POINTS)

(O9101: USED TO STORE POINT 1 IN #111 AND #112)

(09102: USED TO STORE POINT 2 IN #121 AND #122)

#131=#5021 (POSITION OF MACHINE X AXIS)

#132=#5022 (POSITION OF MACHINE Y AXIS)

(#100: SLOPE OF LINE A)

(#101: SLOPE OF LINE

(#102: SLOPE OF LINE PERP TO A)

(#103: SLOPE OF LINE PERP TO B - NOT USED)

(#104: SLOPE A TIMES SLOPE

(#105: Y1-Y3)

(#106: X1+X2)

(#107: X2+X3)

(#108: SLOPE B - SLOPE A)

(#109: Y1+Y2)

(#110: X-#106/2)

(#141: POINT X OF CENTER)

(#142: POINT Y OF CENTER)

(***** VARIABLE CALCULATIONS *****)

#100=(#122-#112)/(#121-#111)

#101=(#132-#122)/(#131-#121)

#102=(-1/#100)

#103=(-1/#101)

#104=(#100*#101)

#105=(#112-#132)

#106=(#111+#121)

#107=(#121+#131)

#108=(#101-#100)

#109=(#112+#122)

#141=((#104*#105)+(#101*#106)-(#100*#107))/(2*#108)

#110=(#141-(#106/2))

#142=(*#102*#110)+(#109/2)

(***** MACHINE MOUVEMENT *****)

G91 G00 Z5.0

G53 G01 X#141 Y#142 F10.0

(***** END OF MACRO *****)

M30

%

[rocheey1]

Oops, remove parenthesis on these lines

 

#131=#5021 (POSITION OF MACHINE X AXIS)

#132=#5022 (POSITION OF MACHINE Y AXIS)

 

Corrected below!!!

 

nice code.... although I dont think my control is new enough to take the 'Smiley Face' GCodes that showed up in the second post.

I'm not sure about compatability on this one, but couldnt you put all 3 routines together, and prompt the user using "#3001=1 [PROMPT STRING]" for the user to touch off each edge ?

[Simtech]

Smiley Face comes from the new forum app, I'm not used to it yet. Need to deactivate Smiley Faces I guess.

Not sure about the #3001=1 on the Fanuc, will look it up, it would be much easier, thanks!

 

nice code.... although I dont think my control is new enough to take the 'Smiley Face' GCodes that showed up in the second post.

I'm not sure about compatability on this one, but couldnt you put all 3 routines together, and prompt the user using "#3001=1 [PROMPT STRING]" for the user to touch off each edge ?

[Simtech]

This is what I'm thinking:

The #3000=1(MESSAGE) will stop the program execution with the MESSAGE appearing in the Alarm Screen Display. Once the program has been stopped, we need to exit the program, to get back in the JOG or HANDLE modes to move the machine axis to the following position.

After that, we need to re-execute a program to get the coordinates of the next point.

Thats why I split it up in 3 different programs.

 

Maybe there's a better way???

 

Smiley Face comes from the new forum app, I'm not used to it yet. Need to deactivate Smiley Faces I guess.

Not sure about the #3001=1 on the Fanuc, will look it up, it would be much easier, thanks!