cnc-club.ru

Sub Main()

' Center X+X-Y-Y+ Outside Probing Script
' Author verser
' vers.by - touch probes, tool setters and precision home switches

Code "G0 G53 z-1"
Code "G0 G53 x299,09 y37.22" 'Z probe pozition
Code "G0 G53 z-60"
sleep 100
While IsMoving()
wend

Dim FRate1, FRate2
Dim DMax, Latch, EdgeLength
Dim XYclearance
Dim AutoZeroFlag
Dim ToolNo
Dim ToolD
Dim ProbeD
Dim Zdepth
Dim XHit, YHit, ZHit
Dim XbHit, YbHit, Diameter

Dim Zpos

Dim XScale, YScale, ZScale

Dim AbsIncFlag

Dim CurrentFeed

'Init vars
FRate1 = 60
FRate2 = 40
DMax = 5
ToolNo = GetCurrentTool()
ToolD = 2
Latch = 1
XYclearance = 5
EdgeLength = 5
Zdepth = 5

If GetOEMLED(1871) Then
AutoZeroFlag=1
Else
AutoZeroFlag=0
End If

AbsIncFlag = GetOEMLED(49) ' Get the current G91 state

'Temporary save all Axis Scale factors
XScale = GetOEMDRO(59)
YScale = GetOEMDRO(60)
ZScale = GetOEMDRO(61)

'Set All Axis' Scale to 1
SetOEMDRO(59,1)
SetOEMDRO(60,1)
SetOEMDRO(61,1)
Sleep(250)


'Check for Errors

If GetOemLED(16)<>0 Then ' Check for Machine Coordinates
Message "Please change to working coordinates"
SetOEMDRO(59,XScale)
SetOEMDRO(60,YScale)
SetOEMDRO(61,ZScale)
Sleep(250)
Exit Sub ' Exit if in Machine Coordinates
End If

If GetOemLED(825)<>0 Then
Message "Probe is active! Check connection and try again"
Call SetOEMDRO(59,XScale)
Call SetOEMDRO(60,YScale)
Call SetOEMDRO(61,ZScale)
Sleep(250)
Exit Sub ' Exit if probe is tripped
End If


CurrentFeed = GetOEMDRO(818) 'FeedRate()

'main working

'Save Z start position
Zpos = GetDRO(2)
'Safe Go to X+ start position
If Not SafeMoveX((-EdgeLength-XYclearance),CurrentFeed) Then
PushMSG("Manually return to the starting position and repeat the search")
Exit Sub
End If
If Not SafeMoveZ((-Zdepth),CurrentFeed) Then
PushMSG("Manually return to the starting position and repeat the search")
Exit Sub
End If
'Probe X+
XHit=ProbeX(1,DMax,Latch,FRate1,FRate2)
If XHit=999999 Then
Exit Sub
End If
'Indicate result
SetUserLabel (4, Format(XHit+ProbeD/2, "####0.000"))
'Safe back to start position
If Not SafeMoveZ((Zdepth),CurrentFeed) Then
PushMSG("Return to the search position is interrupted")
Exit Sub
End If
'Move to X- start position
If Not SafeMoveX(XHit+ProbeD/2-GetDRO(0)+2*EdgeLength+XYclearance,CurrentFeed) Then
PushMSG("Return to the search position is interrupted")
Exit Sub
End If
If Not SafeMoveZ((-Zdepth),CurrentFeed) Then
PushMSG("Manually return to the starting position and repeat the search")
Exit Sub
End If
'Probe X-
XbHit=ProbeX(-1,DMax,Latch,FRate1,FRate2)
If XbHit=999999 Then
Exit Sub
End If
'Indicate result
SetUserLabel (2, Format(XbHit-ProbeD/2, "####0.000"))
SetUserLabel (3, Format((XbHit+XHit)/2, "####0.000"))
SetUserLabel (5, Format(Abs(XbHit-XHit-ProbeD), "####0.000"))
PushMSG("X+ = " & (XHit+ProbeD/2) & ", Xc = " & (XbHit+XHit)/2 & ", X- = " & (XbHit-ProbeD/2) & ", Lx = " & Abs(XbHit-XHit-ProbeD))
'Safe back to start position
If Not SafeMoveZ((Zdepth),CurrentFeed) Then
PushMSG("Return to the search position is interrupted")
Exit Sub
End If
'Move to Center point
If Not SafeMoveX((XbHit+XHit)/2-GetDRO(0),CurrentFeed) Then
PushMSG("Return to the search position is interrupted")
Exit Sub
End If

'Safe Go to Y- start position
If Not SafeMoveY((EdgeLength+XYclearance),CurrentFeed) Then
PushMSG("Manually return to the starting position and repeat the search")
Exit Sub
End If
If Not SafeMoveZ((-Zdepth),CurrentFeed) Then
PushMSG("Manually return to the starting position and repeat the search")
Exit Sub
End If
'Probe Y-
YHit=ProbeY(-1,DMax,Latch,FRate1,FRate2)
If YHit=999999 Then
Exit Sub
End If
'Indicate result
SetUserLabel (6, Format(YHit-ProbeD/2, "####0.000"))
'Safe back to start position
If Not SafeMoveZ((Zdepth),CurrentFeed) Then
PushMSG("Return to the search position is interrupted")
Exit Sub
End If
'Move to Y+ start position
If Not SafeMoveY(YHit+ProbeD/2-GetDRO(1)-2*EdgeLength-XYclearance,CurrentFeed) Then
PushMSG("Return to the search position is interrupted")
Exit Sub
End If
If Not SafeMoveZ((-Zdepth),CurrentFeed) Then
PushMSG("Manually return to the starting position and repeat the search")
Exit Sub
End If
'Probe Y+
YbHit=ProbeY(1,DMax,Latch,FRate1,FRate2)
If YbHit=999999 Then
Exit Sub
End If
'Indicate result
SetUserLabel (8, Format(YbHit+ProbeD/2, "####0.000"))
SetUserLabel (7, Format((YbHit+YHit)/2, "####0.000"))
SetUserLabel (9, Format(Abs(YbHit-YHit+ProbeD), "####0.000"))
Diameter=(Abs(YbHit-YHit+ProbeD)+Abs(XbHit-XHit-ProbeD))/2
SetUserLabel (11, Format(Diameter, "####0.000"))
PushMSG("Y+ = " & (YbHit+ProbeD/2) & ", Yc = " & (YbHit+YHit)/2 & ", Y- = " & YHit-ProbeD/2 & ", Ly = " & Abs(YbHit-YHit+ProbeD) & ", Diam = " & Diameter)
'Safe back to start position
If Not SafeMoveZ((Zdepth),CurrentFeed) Then
PushMSG("Return to the search position is interrupted")
Exit Sub
End If
'Move to Center point
If Not SafeMoveY((YbHit+YHit)/2-GetDRO(1),CurrentFeed) Then
PushMSG("Return to the search position is interrupted")
Exit Sub
End If


If AutoZeroFlag = 1 Then
SetOEMDRO(800, GetDRO(0)-(XbHit+XHit)/2)
Sleep(150)
SetOEMDRO(801, GetDRO(1)-(YbHit+YHit)/2)
Sleep(150)
End If

'epilog

SetOEMDRO(59,XScale)
SetOEMDRO(60,YScale)
SetOEMDRO(61,ZScale)
Sleep(250)

Call SetLED49(AbsIncFlag)
SetOEMDRO(818,CurrentFeed) 'SetFeedRate(CurrentFeed)
Sleep(125)

End Sub


'Functions

Function ProbeX(Dir,DMax,Latch,FRate1,FRate2)
Dim Res
Dim Xstart
Dim Ftmp
Dim AbsIncF
ProbeX=999999
Xstart = GetDRO(0)
Ftmp = FeedRate() 'FeedRate()
AbsIncF=GetOEMLED(49)
'Fast Probe X
Code "G91"
Code "F" & FRate1
Sleep(125)
Call WaitProbeReady()
Code "G31 X" & (Dir*DMax)
While IsMoving()
Wend
Res = GetVar(2000)
' PushMSG("Res=" & Res &", Xstart=" & Xstart & ", DMax=" & DMax & ", FRate1=" & FRate1)
If Abs(Res - Xstart - Dir*DMax) < 0.01 Then
PushMSG("Error: G31 X search finished without making contact")
PushMSG("Manually return to the starting position and repeat the search")
Call SetLED49(AbsIncF)
SetOEMDRO(818,Ftmp)
Sleep(125)
Exit Function
End If
'Move back
Code "G00 X" & -Dir*Latch
While IsMoving()
Wend
Call WaitProbeReady()
'Latch Probe X
Xstart = GetDRO(0)
Code "F" & FRate2
Sleep(125)
Code "G31 X" & Dir*Latch*2
While IsMoving()
Wend
'Save result
Res = GetVar(2000)
If Abs(Res - Xstart - Dir*Latch*2) < 0.01 Then
PushMSG("Error: G31 X latch finished without making contact")
PushMSG("Manually return to the starting position and repeat the search")
Call SetLED49(AbsIncF)
SetOEMDRO(818,Ftmp)
Sleep(125)
Exit Function
End If
Code "G00 X" & -Dir*Latch
While IsMoving()
Wend
Call SetLED49(AbsIncF)
SetOEMDRO(818,Ftmp)
Sleep(125)
ProbeX=Res
End Function

Function ProbeY(Dir,DMax,Latch,FRate1,FRate2)
Dim Res
Dim Ystart
Dim Ftmp
Dim AbsIncF
ProbeY=999999
Ystart = GetDRO(1)
Ftmp = FeedRate() 'FeedRate()
AbsIncF=GetOEMLED(49)
'Fast Probe Y
Code "G91"
Code "F" & FRate1
Sleep(125)
Call WaitProbeReady()
Code "G31 Y" & (Dir*DMax)
While IsMoving()
Wend
Res = GetVar(2001)
' PushMSG("Res=" & Res &", Ystart=" & Ystart & ", DMax=" & DMax & ", FRate1=" & FRate1)
If Abs(Res - Ystart - Dir*DMax) < 0.01 Then
PushMSG("Error: G31 Y search finished without making contact")
PushMSG("Manually return to the starting position and repeat the search")
Call SetLED49(AbsIncF)
SetOEMDRO(818,Ftmp)
Sleep(125)
Exit Function
End If
'Move back
Code "G00 Y" & -Dir*Latch
While IsMoving()
Wend
Call WaitProbeReady()
'Latch Probe Y
Ystart = GetDRO(1)
Code "F" & FRate2
Sleep(125)
Code "G31 Y" & Dir*Latch*2
While IsMoving()
Wend
'Save result
Res = GetVar(2001)
If Abs(Res - Ystart - Dir*Latch*2) < 0.01 Then
PushMSG("Error: G31 Y latch finished without making contact")
PushMSG("Manually return to the starting position and repeat the search")
Call SetLED49(AbsIncF)
SetOEMDRO(818,Ftmp)
Sleep(125)
Exit Function
End If
Code "G00 Y" & -Dir*Latch
While IsMoving()
Wend
Call SetLED49(AbsIncF)
SetOEMDRO(818,Ftmp)
Sleep(125)
ProbeY=Res
End Function

Function SafeMoveX(X1, F1) As Boolean 'return 1 (error) if probe tripped
Dim Xstart
Dim Ftmp
Dim AbsIncF
SafeMoveX=True
Xstart = GetDRO(0)
Ftmp = FeedRate() 'FeedRate()
AbsIncF=GetOEMLED(49)
Code "G91"
Code "F" & F1
Sleep(125)
Call WaitProbeReady()
Code "G31 X" & X1
While IsMoving()
Wend
XHit = GetVar(2000)
Call SetLED49(AbsIncF)
If Abs(XHit - Xstart - X1) > 0.01 Then
SafeMoveX=False
PushMSG("Error! Probe tripped during X movement")
End If
SetOEMDRO(818,Ftmp)
Sleep(125)
End Function

Function SafeMoveY(Y1, F1) As Boolean 'return 1 (error) if probe tripped
Dim Ystart
Dim Ftmp
Dim AbsIncF
SafeMoveY=True
Ystart = GetDRO(1)
Ftmp = FeedRate() 'FeedRate()
AbsIncF=GetOEMLED(49)
Code "G91"
Code "F" & F1
Sleep(125)
Call WaitProbeReady()
Code "G31 Y" & Y1
While IsMoving()
Wend
YHit = GetVar(2001)
Call SetLED49(AbsIncF)
If Abs(YHit - Ystart - Y1) > 0.01 Then
SafeMoveY=False
PushMSG("Error! Probe tripped during Y movement")
End If
SetOEMDRO(818,Ftmp)
Sleep(125)
End Function

Function SafeMoveZ(Z1, F1) As Boolean 'return 1 (error) if probe tripped
Dim Zstart
Dim Ftmp
Dim AbsIncF
SafeMoveZ=True
Zstart = GetDRO(2)
Ftmp = FeedRate() 'FeedRate()
AbsIncF=GetOEMLED(49)
Code "G91"
Code "F" & F1
Sleep(125)
Call WaitProbeReady()
Code "G31 Z" & Z1
While IsMoving()
Sleep(100)
Wend
ZHit = GetVar(2002)
Call SetLED49(AbsIncF)
If Abs(ZHit - Zstart - Z1) > 0.01 Then
SafeMoveZ=False
PushMSG("Error! Probe tripped during Z movement")
End If
SetOEMDRO(818,Ftmp)
Sleep(125)
End Function

Function PushMSG(Str1 As String) As Boolean
SetUserLabel (21,GetUserLabel(20))
SetUserLabel (20,GetUserLabel(19))
SetUserLabel (19,GetUserLabel(18))
SetUserLabel (18,GetUserLabel(17))
SetUserLabel (17,Str1)
Message Str1
PushMSG=True
End Function

Sub WaitProbeReady()
While GetOemLED(825)
Sleep(100)
Wend
End Sub

Sub SetLED49(Flag)
If Flag Then
Code "G91"
Sleep(125)
Else
Code "G90"
Sleep(125)
End If
End Sub

Rem VBScript To probe In the z axis

DoOemButton(1003)

If GetOemLed (825) <> 0 Then 'Check to see if the probe is already grounded or faulty
Code "(Z-Plate is grounded, check connection and try again)" 'this goes in the status bar if aplicable
Else
'Code "G4 P1" 'Pause 1 seconds to give time to position probe plate
Sleep 100
PlateOffset = -40.27 '<--- !!!!!!!!!!!!!! Write here you plate thickness !!!!!!!!!!!!!!
CurrentFeed = GetOemDRO(818) 'Get the current feedrate to return to later
Code "F400" 'slow down feedrate to 4 ipm
Sleep 100

Rem Probe In the z direction
ZNew = GetDro(2) - 150 'probe move to current z - 50 mm
Code "G31Z" &ZNew
While IsMoving() 'wait for probe move to finish
Wend

ZNew = GetVar(2002) 'read the touch point
Code "G0 Z" &ZNew + 2 'move back to hit point incase there was overshoot
While IsMoving ()
Wend

Rem Probe 2 In the z direction
Code "F50"
ZNew = GetDro(2) - 6 'probe move to current z - 6 mm
Code "G31Z" &ZNew
While IsMoving() 'wait for probe move to finish
Wend


If PlateOffset <> 0 Then
Call SetDro (2, PlateOffset) 'set the Z axis DRO to plate thickness
'Code "G4 P1" 'Pause for Dro to update.
Sleep 500
ZNew = PlateOffset + 2 'ZNew = plate thickness + 2 mm
Sleep 100
'ZNew = 2 ' as variant. But ZNew coordinate should be more than a thickness of a plate
Code "G0 Z" &ZNew 'put the Z retract height you want here
Code "(Z axis is now zeroed)" 'puts this message in the status bar
End If

Sleep 100
Code "F" &CurrentFeed 'Returns to prior feed rate
End If