ok then something like this should be closer:
Sub Main()
'Global variables declaration
Dim CCWPos as Integer
Dim CWPos as Integer
NewTool = GetSelectedTool()
OldTool = GetCurrentTool()
While NewTool > 8
NewTool = Question ("Enter New Tool Number up to " & MaxToolNum)
Wend
If NewTool = OldTool Then'Compare between actual tool and requested tool
Else
End If
If NewTool > 8 Then'requested tool higher then tool numbers
Else
End If
If NewTool < 1 Then'tool number to low
Else
End If
code("m05")
Call ZatcPosition
Call AtcIn'Activate air cylinder valve to put old tool back to carrousel
Call Unclamp'Spindle: Tool Unclamp
Call AtcDown'lowers atc
Call LeastTravel'determine the least travel to move and Turns CW or CCW
Call AtcUp'raises atc
Call Clamp'Spindle: Tool Clamp
Call AtcOut'retracts atc
Call SetUserDRO (1200,NewTool)'Store new tool as actual tool value
SetCurrentTool( NewTool )
End Sub
Function ZatcPosition()'Move to Z tool position and wait until position reached
code("G53")'Move in Absolute Machine coordinates
code("G00 Z-1") 'Z value as to be checked for exact match with carrousel height
While(IsMoving())
Sleep(100)'temporisation entre while++
Wend
End Function
Function AtcIn()'Put old tool back to carrousel
ActivateSignal(OUTPUT4)'Move carrousel air cylinder to the tool change position adjust output# to match atc slide
code("g04 p01")
End Function
Function Unclamp()'Spindle: Tool Unclamp
ActivateSignal(OUTPUT6)'Release the tool, adjust output number for drawbar output
code("g04 p01")'pause
End Function
Function AtcDown()'lowers atc to rotate
ActivateSignal(OUTPUT5)'solonoid to lower atc
code("G04 p01")'pause
End Function
'Sequence to determine the least travel to move for TC, CW or CCW
Function LeastTravel()
NewTool = GetSelectedTool()
OldTool = GetCurrentTool()
NTool = 8 ' Number of tools changer holds
CWPos = GetSelectedTool() - GetCurrentTool() ' Assume a CW move
If CWPos < 0 Then ' CWPos < 0 ==> rtp < atp
CWPos = CWPos + NTools
End If
CCWPos = NTools - CWPos
If CWPos < CCWPos Then
Call CW()
Else
Call CCW()
End If
End Function
Function CW()'Rotation CW
Dim x As Integer
Dim CTPos As Integer 'Carrousel Tool Position Relative to OldTool Position
CTPos=0
ActivateSignal(OUTPUT7)'Turns the AC Motor On
Deactivatesignal(output8)'atc motor revirsing relay
Sleep(50)
For x=0 To CWPos
While IsActive(input1)'Wait for INPUT1 is off
Sleep(10)
Wend
While NOT IsActive(input1)'Wait for INPUT1 is on
Sleep(10)
Wend
While IsActive(input1)'Wait for INPUT1 is off
Sleep(10)
Wend
While NOT IsActive(input1)'Wait for INPUT1 is on
Sleep(10)
Wend
x=x+1
Next x
CTPos=x
DeactivateSignal(OUTPUT7)
Deactivatesignal(output8)'atc motor revirsing relay
End Function
Function CCW()'Rotation CCW
Dim y As Integer
Dim CTPos As Integer 'Carrousel Tool Position Relative to OldTool Position
CTPos=0
Activatesignal(output8)'atc motor revirsing relay
ActivateSignal(OUTPUT7)'Turns the AC Motor On
Sleep(50)
For y=0 To CCWPos
While IsActive(input1)'Wait for INPUT1 is off
Sleep(10)
Wend
While NOT IsActive(input1)'Wait for INPUT1 is on
Sleep(10)
Wend
While IsActive(input1)'Wait for INPUT1 is off
Sleep(10)
Wend
While NOT IsActive(input1)'Wait for INPUT1 is on
Sleep(10)
Wend
y=y+1
Next y
CTPos=y
DeactivateSignal(OUTPUT7)
Deactivatesignal(output8)
End Function
Function AtcUp()'lifts atc
DeActivateSignal(OUTPUT5)'relay for solonoid to lower/lift atc
code("G04 p01")'pause
End Function
Function Clamp()'power drawbar unactivated
DeactivateSignal(OUTPUT6)'unactivating drawbar relay
End Function
Function AtcOut()'retracts atc
deActivateSignal(OUTPUT4)'atc retract cylinder relay
code("g04 p01")
End Function