' Getriebeschaltung MACH3 Mikron WF3DP

'Spannungsversorgung Ventile EIN
SetOutbit(90,14)

rpm = GetRPM()

'If rpm = 0 Then
'rpm = InputBox("RPM?")
'End If



If rpm <= 335 Then
	Call Gang1
ElseIf rpm <= 1319 Then
	Call Gang2
ElseIf rpm <= 2239 Then
	Call Gang3	
ElseIf rpm <= 3150 Then
	Call Gang4
Else 
'	Message "Gewählte Drehzahl zu hoch"
'	DOOEMButton (1003)
End If

SetSpinSpeed (rpm)

' Gänge
' 1: output 90, 11/13 input 91, 1/3
' 2: output 90, 11/12 input 91, 1/4
' 3: output 90, 10/13 input 91, 2/3
' 4: output 90, 10/12 input 91, 2/4
' Spindle Festdrehzahl output 90, 2 + DoSpinCW()
'


        
Sub Gang1
	SetPulley(1)
	
	' Positonsschalter Gangstellung abfragen 
	If GetInBit(91,1) And GetInBit(91,3) Then
		Message "Gang 1 war schon eingelegt"	
				Exit Sub
	End If
	
	' Motor ein  Festdrehzahl ein und Spannungsversorung SERVO ein
	DoSpinCW()
	SetOutbit(90,2)
	SetOutbit(90,14)

'	Hebel mitte schalten

	Sleep 1500 

	ResetOutbit(90,10)
	SetOutbit(90,11)

	
	Sleep 1500
	
	' Gangestellung abfragen
	If   GetInBit(91,1)=0 Then
		Message "Stellung Hebel mitte nicht erreicht " & Time & " " & GetInBit(91,1)
		SLEEP 1500
		ResetOutbit(90,10)
		SetOutbit(90,11)
		SLEEP 1500

		If GetInBit(91,1)=0 Then
			Message " Hebel mitte für Gang1 kann nicht eingelegt werden"
	                ' Befehl Stop
	                DOOEMButton (1003)
		End If
	End If
	'Hebel rechts schalten
	
	ResetOutbit(90,12)
	SetOutbit(90,13)

	
	Sleep 1500
	
	' Gangestellung abfragen
	If   GetInBit(91,3)=0 Then
		Message "Stellung Hebel rechts nicht erreicht " & Time & " " & GetInBit(91,1)
		SLEEP 1500
		ResetOutbit(90,12)
		SetOutbit(90,13)
		SLEEP 1500

		If GetInBit(91,3)=0 Then
			Message "Hebel rechts für Gang1 kann nicht eingelegt werden"
	                ' Befehl Stop
	                DOOEMButton (1003)
		End If
	End If

	
	' Motor Festdrehzahl und Spannungsversorung aus
	ResetOutbit(90,10)
	ResetOutbit(90,11)
	ResetOutbit(90,12)
	ResetOutbit(90,13)

	DoSpinStop()
	ResetOutbit(90,2)
	Message "Gang 1 eingelegt"
End Sub

Sub Gang2
	SetPulley(2)
		
	
	' Positonsschalter Gangstellung abfragen 
	If GetInBit(91,1) And GetInBit(91,4) Then
		Message "Gang 2 war schon eingelegt"	
		Exit Sub
	End If
	
	' Motor ein  Festdrehzahl ein und Spannungsversorung SERVO ein
	DoSpinCW()
	SetOutbit(90,2)
	SetOutbit(90,14)

'	Hebel mitte schalten

	Sleep 1500 

	ResetOutbit(90,10)
	SetOutbit(90,11)

	
	Sleep 1500
	
	' Gangestellung abfragen
	If   GetInBit(91,1)=0 Then
		Message "Stellung Hebel mitte nicht erreicht " & Time & " " & GetInBit(91,1)
		SLEEP 1500
		ResetOutbit(90,10)
		SetOutbit(90,11)
		SLEEP 1500

		If GetInBit(91,1)=0 Then
			Message " Hebel mitte für Gang 2 kann nicht eingelegt werden"
	                ' Befehl Stop
	                DOOEMButton (1003)
		End If
	End If
	'Hebel rechts schalten
	
	ResetOutbit(90,13)
	SetOutbit(90,12)

	
	Sleep 1500
	
	' Gangestellung abfragen
	If   GetInBit(91,4)=0 Then
		Message "Stellung Hebel rechts nicht erreicht " & Time & " " & GetInBit(91,1)
		SLEEP 1500
		ResetOutbit(90,13)
		SetOutbit(90,12)
		SLEEP 1500

		If GetInBit(91,4)=0 Then
			Message "Hebel rechts für Gang 2 kann nicht eingelegt werden"
	                ' Befehl Stop
	                DOOEMButton (1003)
		End If
	End If

	
	' Motor Festdrehzahl und Spannungsversorung aus
	ResetOutbit(90,10)
	ResetOutbit(90,11)
	ResetOutbit(90,12)
	ResetOutbit(90,13)

	DoSpinStop()
	ResetOutbit(90,2)
	Message "Gang 2 eingelegt"
	
End Sub

Sub Gang3
	SetPulley(3)
			
	
	' Positonsschalter Gangstellung abfragen 
	If GetInBit(91,2) And GetInBit(91,3) Then
		Message "Gang 3 war schon eingelegt"	
		Exit Sub
	End If
	
	' Motor ein  Festdrehzahl ein und Spannungsversorung SERVO ein
	DoSpinCW()
	SetOutbit(90,2)
	SetOutbit(90,14)

'	Hebel mitte schalten

	Sleep 1500 

	ResetOutbit(90,11)
	SetOutbit(90,10)

	
	Sleep 1500
	
	' Gangestellung abfragen
	If   GetInBit(91,2)=0 Then
		Message "Stellung Hebel mitte nicht erreicht " & Time & " " & GetInBit(91,1)
		SLEEP 1500
		ResetOutbit(90,11)
		SetOutbit(90,10)
		SLEEP 1500

		If GetInBit(91,2)=0 Then
			Message " Hebel mitte für Gang 3 kann nicht eingelegt werden"
	                ' Befehl Stop
	                DOOEMButton (1003)
		End If
	End If
	'Hebel rechts schalten
	
	ResetOutbit(90,12)
	SetOutbit(90,13)

	
	Sleep 1500
	
	' Gangestellung abfragen
	If   GetInBit(91,3)=0 Then
		Message "Stellung Hebel rechts nicht erreicht " & Time & " " & GetInBit(91,1)
		SLEEP 1500
		ResetOutbit(90,12)
		SetOutbit(90,13)
		SLEEP 1500

		If GetInBit(91,3)=0 Then
			Message "Hebel rechts für Gang 3 kann nicht eingelegt werden"
	                ' Befehl Stop
	                DOOEMButton (1003)
		End If
	End If

	
	' Motor Festdrehzahl und Spannungsversorung aus
	ResetOutbit(90,10)
	ResetOutbit(90,11)
	ResetOutbit(90,12)
	ResetOutbit(90,13)

	DoSpinStop()
	ResetOutbit(90,2)
	Message "Gang 3 eingelegt"
End Sub

Sub Gang4
	SetPulley(4)
	' Positonsschalter Gangstellung abfragen 
	If GetInBit(91,2) And GetInBit(91,4) Then
		Message "Gang 4 war schon eingelegt"	
		Exit Sub
	End If
	
	' Motor ein  Festdrehzahl ein und Spannungsversorung SERVO ein
	DoSpinCW()
	SetOutbit(90,2)
	SetOutbit(90,14)

'	Hebel mitte schalten

	Sleep 1500 

	ResetOutbit(90,11)
	SetOutbit(90,10)

	
	Sleep 1500
	
	' Gangestellung abfragen
	If   GetInBit(91,2)=0 Then
		Message "Stellung Hebel mitte nicht erreicht " & Time & " " & GetInBit(91,1)
		SLEEP 1500
		ResetOutbit(90,11)
		SetOutbit(90,10)
		SLEEP 1500

		If GetInBit(91,2)=0 Then
			Message " Hebel mitte für Gang 4 kann nicht eingelegt werden"
	                ' Befehl Stop
	                DOOEMButton (1003)
		End If
	End If
	'Hebel rechts schalten
	
	ResetOutbit(90,13)
	SetOutbit(90,12)

	
	Sleep 1500
	
	' Gangestellung abfragen
	If   GetInBit(91,4)=0 Then
		Message "Stellung Hebel rechts nicht erreicht " & Time & " " & GetInBit(91,4)
		SLEEP 1500
		ResetOutbit(90,13)
		SetOutbit(90,12)
		SLEEP 1500

		If GetInBit(91,4)=0 Then
			Message "Hebel rechts für Gang 4 kann nicht eingelegt werden"
	                ' Befehl Stop
	                DOOEMButton (1003)
		End If
	End If

	
	' Motor Festdrehzahl und Spannungsversorung aus
	ResetOutbit(90,10)
	ResetOutbit(90,11)
	ResetOutbit(90,12)
	ResetOutbit(90,13)

	DoSpinStop()
	ResetOutbit(90,2)
	Message "Gang 4 eingelegt"

End Sub