rpm = GetRPM()
If
RPM > 2501
Then
SetPulley(2)
ActivateSignal(OUTPUT5)
End If

If
RPM < 2501
Then
SetPulley(1)
DeActivateSignal(OUTPUT5)

End If 
 SetSpinSpeed( rpm )