Tủ điều khiển - Controller Mach3

[maycncmini]

Code

Sub Main()
OldTool = GetOEMDRO (1200)
x = GetToolChangeStart( 0 )
y = GetToolChangeStart( 1 )
z = GetToolChangeStart( 2 )
a = GetToolChangeStart( 3 )
b = GetToolChangeStart( 4 )
c = GetToolChangeStart( 5 )
tool = GetSelectedTool()
NewTool = tool
'Tool Changer Macro (Bed Type)
MaxToolNum = 10 'Max number off tools for the changer
ToolDown = 160. 'Z Pos to Get or drop a tool
ToolUp = 0.0 'Z Hieght to Rapid from tool to tool
If NewTool = OldTool Then
Exit Sub
End If
While NewTool > MaxToolNum
NewTool = Question ("Toi da chi co " & MaxToolNum)
Wend
Code "G00 G90 G53 Z" & ToolUp
While IsMoving()
Wend

ActivateSignal(Output2) 'Mo Dinh vi chot BT30
Code "G4 P9.0" 'Wait for the tool to release
'SystemWaitFor (9) 'Wait for the tool Release Limit switch


Code "G53 Z0.0" & ToolUp


While IsMoving()
Wend
Code "G53 Z" & ToolDown
Code "G4 P2.0"
While IsMoving()
Wend

Call MovePos(NewTool)


DeActivateSignal(Output2) 'Tat Dinh vi chot BT30
Code "G4 P1.0" 'Wait for the tool to Clamp
While IsMoving()
Wend
Code "G53 Z" & ToolUp
Call SetUserDRO (1200,NewTool)
SetCurrentTool( NewTool )
Code "G00 X" & x & " Y" & y'Move back to where the tool change was prompted
End Sub

Sub MovePos(ByVal ToolNumber As Integer)

Select Case ToolNumber
Case Is = 1
Apos = 36.00
Case Is = 2
Apos = 72.00
Case Is = 3
Apos = 108.00
Case Is = 4
Apos = 144.00
Case Is = 5
Apos = 180.00
Case Is = 6
Apos = 216.00
Case Is = 7
Apos = 252.00
Case Is = 8
Apos = 288.00
Case Is = 9
Apos = 324.00
Case Is = 10
Apos = 0.0
End Select

Code "G53 A" & APos


End Sub
Main