def run_old():
"""Main loop, old"""
while 1:
if wpi.IsDisabled():
print("Running disabled()")
disabled()
while wpi.IsDisabled():
wpi.Wait(0.01)
elif wpi.IsAutonomous():
print("Running autonomous()")
autonomous()
while wpi.IsAutonomous() and wpi.IsEnabled():
wpi.Wait(0.01)
else:
print("Running teleop()")
teleop()
while wpi.IsOperatorControl() and wpi.IsEnabled():
wpi.Wait(0.01)
def run():
"""Main loop"""
print("Start compressor")
compressor.Start()
while 1:
if wpilib.IsDisabled():
print("Running disabled()")
disabled()
while wpilib.IsDisabled():
wpilib.Wait(0.01)
elif wpilib.IsAutonomous():
print("Running autonomous()")
autonomous()
while wpilib.IsAutonomous() and wpilib.IsEnabled():
wpilib.Wait(0.01)
else:
print("Running teleop()")
teleop()
while wpilib.IsOperatorControl() and wpilib.IsEnabled():
wpilib.Wait(0.01)
def Disabled(self):
self.dog.SetEnabled(True)
for type, component in self.components.items():
component.disabled_init()
while wpilib.IsDisabled():
self.dog.Feed()
for type, component in self.components.items():
component.disabled_tick(wpilib.Timer.GetFPGATimestamp())
wpilib.Wait(0.01)
self.dog.SetEnabled(False)
def disabled():
print("Robot Disabled For Stuff")
while wpi.IsDisabled():
checkRestart()
wpi.Wait(0.01)
def disabled():
while wpilib.IsDisabled():
checkRestart()
wpilib.Wait(0.01)
