Public Pastes
SHARE
TWEET

robot.py edit?

a guest Jan 10th, 2011 30 Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
  1. import wpilib
  2.  
  3. stick1 = wpilib.Joystick(1)
  4.  
  5. def checkRestart():
  6.     if stick1.GetRawButton(10):
  7.         raise RuntimeError("Restart")
  8.  
  9. def disabled():
  10.     while wpilib.IsDisabled():
  11.         checkRestart()
  12.         wpilib.Wait(0.01)
  13.  
  14. def autonomous():
  15.     while wpilib.IsAutonomous() and wpilib.IsEnabled():
  16.         checkRestart()
  17.         wpilib.Wait(0.01)
  18.  
  19. def teleop():
  20.     while wpilib.IsOperatorControl() and wpilib.IsEnabled():
  21.         checkRestart()
  22.         wpilib.Wait(0.01)
  23.  
  24. def run():
  25.     """Main loop"""
  26.     while 1:
  27.         try:
  28.             if wpilib.IsDisabled():
  29.                 print("Running disabled()")
  30.                 disabled()
  31.                 while wpilib.IsDisabled():
  32.                     wpilib.Wait(0.01)
  33.             elif wpilib.IsAutonomous():
  34.                 print("Running autonomous()")
  35.                 autonomous()
  36.                 while wpilib.IsAutonomous() and wpilib.IsEnabled():
  37.                     wpilib.Wait(0.01)
  38.             else:
  39.                 print("Running teleop()")
  40.                 teleop()
  41.                 while wpilib.IsOperatorControl() and wpilib.IsEnabled():
  42.                     wpilib.Wait(0.01)
  43.         except:
  44.             print("There was a code error")
  45.             while 1:
  46.                 checkRestart()
RAW Paste Data
Top