Sub Main()
' Based on the macros created be Big Tex -  May 25 2010
' and modified by Poppa Bear 11dec10


Dim ZNew, Zplate, ZMaxRetract, Zplatetomaterial
Dim XWork, YWork, XMachine, YMachine, ZMachine
Dim XScale, YScale, ZScale
Dim XPlate, YPlate, xtoprobe, ytoprobe
Dim PlateOffset, MatOffset, TotalOffset
Dim MatOffsetYN
Dim ZClear, ClearAllow
Dim CurrentFeed
Dim CurrentAbsInc
Dim Response
Dim CurrentOffset
Dim ZOffset

XWork = GetOEMDRO(800)  ' Get Current X Work Coordinate
YWork = GetOEMDRO(801)  ' Get Current Y Work Coordinate
XMachine = GetOemDRO(83)  ' Get Current X Machine Coordinate
YMachine = GetOemDRO(84)  ' Get Current Y Machine Coordinate
ZMachine = GetOemDRO(85)   ' Get Current Z Machine Coordinate
XPlate = GetUserDRO(1811)  ' Get X Machine Coordinate location of the touch plate
YPlate = GetUserDRO(1812)  ' Get Y Machine Coordinate location of the touch plate
PlateOffset = GetUserDRO(1851)  ' Get Plate Thickness DRO
MatOffset = GetUserDRO(1815)  ' Get Material Offset DRO
CurrentOffset = GetOEMDRO(46)  ' Get Current Coordinate system 1 = G54, 2 = G55, ....

If GetOEMLED(1863) Then  ' Set Flag if Material Offset is used
	MatOffsetYN=1
	Else
	MatOffsetYN=0
End If

'Get Axis Scale factors
XScale = GetOEMDRO(59)
YScale = GetOEMDRO(60)
ZScale = GetOEMDRO(61)

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


CurrentFeed = GetOemDRO(818)  ' Get the current feedrate to return to later
CurrentAbsInc = GetOemLED(48)   ' Get the current G90/G91 state
Zclear=GetOEMDRO(1814) ' Get Z Clearance Plane from DRO

'//////// the block below will set all your reusable vars depending on Inch or mm.
'//////// this sets the vars so you only need ONE large block of probing code.

If GetOEMLED(801) Then  ' On = English Measure INCH

FirstProbeDist = 6.0 ' Probe down 6 inches
FirstRetractDist = 0.05 ' Then retract .05 inch
SecProbeDist = 0.25 ' Then probe down .25 inches
FirstProbeFeed = 10.0 ' First probe feed @ 10 ipm
SecondProbeFeed = 1.0 ' Second probe feed @ 1 ipm
ClearAllow = 0.125 ' Max Allowable Clearance = Z Machine Zero - .125in

Else ' Off = Metric Measure MM

FirstProbeDist = 150.0 ' Probe down 150mm
FirstRetractDist = 1.0 ' Then retract 1mm
SecProbeDist = 6.0 ' Then probe down 6mm
FirstProbeFeed = 250.0 ' First probe feed @ 250 mm/min
SecondProbeFeed = 25.0 ' Second probe feed @ 25 mm/min
ClearAllow = 2.0 ' Max Allowable Clearance = Z Machine Zero - 2mm

End If

'//////// Error Condition checking code

If GetOemLED(16)<>0 Then ' Check for Machine Coordinates
Code "(Please change to working coordinates)"
Exit Sub ' Exit if in Machine Coordinates
End If

If GetOemLED(825)<>0 Then
Code "(Z-Plate Grounded Check connection and try again)"
Exit Sub ' Exit if probe is tripped
End If

If PlateOffset < 0 Then
Code "(Plate Thickness < 0 - Please Correct and try again)"
Exit Sub ' Exit If Plate Thickness is less than 0
End If

If MatOffsetYN=1 Then
	If MatOffset < 0 Then
	Code "(Warning - Material Offset < 0)"
	Sleep(3000)
	End If
End If

If ZClear <= 0 Then
Code "(Clearance Plane Must > 0 - Please Reset)"
Exit Sub ' Exit If Clearance Plane is less than  or equal to 0
End If


If MatOffsetYN=1 Then  ' If Use Material Offset = Yes
	TotalOffset = PlateOffset - MatOffset
	Else
	TotalOffset = PlateOffset
End If


'//////// Start Probing Code, Probe In -Z direction.
'//////// The vars will be Inch or Metric from above if/else statment

sleep(1000) ' Pause for 1 second to give time to position probe plate

Code "F" & FirstProbeFeed ' Set feedrate to 10 ipm or 300mm/min

Code "(Probing for Z Zero.....)" ' Puts this message in the status bar

ZNew = (GetOEMDro(802) - FirstProbeDist ) ' Probe move to current Z - 6 inches
Code "G90 G31 Z" & Znew

While IsMoving() ' Wait for probe move to finish
Wend

ZNew = GetOEMDro(802) ' Read the touch point
Code "G0 Z" & ( ZNew + FirstRetractDist ) ' Move up .05 inch or 1mm in case of overshoot

While IsMoving()
Wend

Code "F" & SecondProbeFeed ' Set feedrate to 1 ipm or 25mm/min

ZNew = (GetOEMDro(802) - SecProbeDist ) ' Probe move to current Z - .25 inches
Code "G90 G31 Z" & Znew

While IsMoving()
Wend

ZNew = GetOEMDro(802) ' Read the touch point
Code "G0 Z" & ZNew ' Move back to hit point in case of overshoot

While IsMoving()
Wend

Call SetOEMDRO (802, TotalOffset) ' Set the Z axis DRO to plate thickness
sleep(500) ' Pause for DRO to update.

'Make Sure Z Clearance Plane is below Home Switch. If not, Notify User and Proceed.
ZMaxRetract = Abs(GetOemDRO(85)) - ClearAllow ' Distance to Home Switch - Clearance Allowance

If ZClear - TotalOffset > ZMaxRetract Then

	Response = MsgBox ("Warning !!!" & (Chr(13)) & "Z Clearance Plane is Above Z Axis Home Switch." & (Chr(13)) & "Press OK To Retract Safely Below Switch" & (Chr(13)) & "Or Press Cancel to Exit Operation",49,"Insufficient Z Clearance!!")

	If Response = 1 Then ' If OK
		ZClear = TotalOffset + ZMaxRetract ' Retract to Z Machine zero - .125in or 2mm
		ElseIf Response = 2 Then ' If Cancel
		Exit Sub
	End If
End If
	
Code "G0 Z" & ZClear ' Retract to Z Clearance Plane

While IsMoving()
Wend

' Move to fixed plate location and probe again

Code "G53 G0 X" & XPlate & " Y" & YPlate ' Rapid to the location of the plate

While IsMoving()
Wend

Code "F" & FirstProbeFeed ' Set feedrate to 10 ipm or 300mm/min

If GetOemLED(825)<>0 Then
Code "(Z-Plate Grounded Check connection and try again)"
Exit Sub ' Exit if probe is tripped
End If

Code "(Probing for Reference Position.....)" ' Puts this message in the status bar

ZPlate = (GetOEMDRO(802) - FirstProbeDist) 
Code "G90 G31 Z" & Zplate ' Probe move to current Z - 6 inches

While IsMoving()
Wend

Sleep (200)

ZPlate = GetOEMDro(802) ' Read the touch point
Code "G0 Z" & ( ZPlate + FirstRetractDist ) ' Move up .1 inch in case of overshoot

While IsMoving()
Wend

Code "F" & SecondProbeFeed ' Set feedrate to 1 ipm or 25mm/min

ZPlate = (GetOEMDRO(802) - SecProbeDist)
Code "G90 G31 Z" & Zplate ' Probe move to current Z - .25 inches

While IsMoving()
Wend

ZPlate = GetOEMDro(802) ' Read the touch point
Code "G1 Z" & ZPlate ' Move back to hit point in case of overshoot

While IsMoving()
Wend

Zplatetomaterial = GetOEMDRO(802) ' Record the current coordinate of the bottom of the tool and plate

Call SetUserDRO(1813,Zplatetomaterial) ' This sets a user DRO to the difference between the top of material and top of plate
sleep(500) ' Pause for DRO to update.

Code "G0 Z" & ZClear ' Move up to the  amount specified in the Z Clearance Plane DRO

While IsMoving()
Wend

Code "G0 X" & XWork & " Y" & YWork ' Returns to the previous XY job location

While IsMoving()
Wend

Code "F" & CurrentFeed ' Reset to original feed rate


If GetOEMLED(801) Then 'ON = English Measure INCH
Code "(Material Offset is Now Calculated in Inches)" 'puts this message in the status bar
Else 'OFF = Metric Measure MM
Code "(Material Offset is Now Calculated in mm's)" 'puts this message in the status bar
End If

If CurrentAbsInc = 0 Then 'if G91 was in effect before then return to it
Code "G91" 
End If 

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


If CurrentOffset = 1 Then
ZOffset=GetVar(5223)
ElseIf CurrentOffset = 2 Then
ZOffset=GetVar(5243)
ElseIf CurrentOffset = 3 Then
ZOffset=GetVar(5263)
ElseIf CurrentOffset = 4 Then
ZOffset=GetVar(5283)
ElseIf CurrentOffset = 5 Then
ZOffset=GetVar(5303)
ElseIf CurrentOffset = 6 Then
ZOffset=GetVar(5323)
ElseIf CurrentOffset = 7 Then
ZOffset=GetVar(5343)
ElseIf CurrentOffset = 8 Then
ZOffset=GetVar(5363)
ElseIf CurrentOffset = 9 Then
ZOffset=GetVar(5383)
ElseIf CurrentOffset = 10 Then
ZOffset=GetVar(5403)
ElseIf CurrentOffset = 11 Then
ZOffset=GetVar(5423)
ElseIf CurrentOffset = 12 Then
ZOffset=GetVar(5443)
ElseIf CurrentOffset = 13 Then
ZOffset=GetVar(5463)
ElseIf CurrentOffset = 14 Then
ZOffset=GetVar(5483)
ElseIf CurrentOffset = 15 Then
ZOffset=GetVar(5503)
ElseIf CurrentOffset = 16 Then
ZOffset=GetVar(5523)
ElseIf CurrentOffset = 17 Then
ZOffset=GetVar(5543)
ElseIf CurrentOffset = 18 Then
ZOffset=GetVar(5563)
End If

For X = 5223 To 5563 Step 20
SetVar(X, ZOffset)
Next X
Sleep(250)

If Not FileName() = "No File Loaded." Then
	If GetOEMLED(1865) Then
	MsgBox "Start Spindle, then press OK to Continue",48,"Start Spindle"
	'Else
	'DoSpinCW()
	'While IsMoving()
	'Wend
	End If
	
DoOEMButton(1000) ' Cycle Start
End If

End Sub