mirror of
https://github.com/team2059/Zaphod
synced 2024-12-18 20:12:28 -05:00
updated the main.py and started work on a drive.py with a drive class that will take the joystick input and power the motors
This commit is contained in:
parent
5a002751f5
commit
b72e5261cf
6
python/drive.py
Normal file
6
python/drive.py
Normal file
@ -0,0 +1,6 @@
|
||||
try:
|
||||
import wpilib
|
||||
except ImportError:
|
||||
from pyfrc import wpilib
|
||||
class drive():
|
||||
def _init_(self, rightBack, rightMid, rightFront, leftBack, leftMid, leftFront):
|
36
python/main.py
Normal file
36
python/main.py
Normal file
@ -0,0 +1,36 @@
|
||||
import sys
|
||||
import drive
|
||||
try:
|
||||
import wpilib
|
||||
except ImportError:
|
||||
from pyfrc import wpilib
|
||||
DriveStick = wpilib.Joystick(1)
|
||||
ShootStick = wpilib.Joystick(2)
|
||||
leftMotor = wpilib.Jaguar(1)
|
||||
compressor = wpilib.Compressor(2,1)
|
||||
def restartCode():
|
||||
if stick.GetRawButton(2):
|
||||
raise RuntimeError("restarting")
|
||||
# Contains the Disabled, Auto, and Teleop functions
|
||||
class Zaphod(wpilib.SimpleRobot):
|
||||
def Disabled(self):
|
||||
while self.IsDisabled():
|
||||
wpilib.Wait(0.01)
|
||||
def Autonomous(self):
|
||||
self.GetWatchdog().SetEnabled(False)
|
||||
while self.IsAutonomous() and self.IsEnabled():
|
||||
wpilib.Wait(0.01)
|
||||
def OperatorControl(self):
|
||||
# Create the watchdog (and actually use it)
|
||||
dog = self.GetWatchdog()
|
||||
dog.SetEnabled(True)
|
||||
dog.SetExpiration(0.25)
|
||||
compressor.Start()
|
||||
while self.IsOperatorControl() and self.IsEnabled():
|
||||
dog.Feed()
|
||||
leftMotor.Set(DriveStick.GetY())
|
||||
wpilib.Wait(0.04)
|
||||
def run():
|
||||
robot = Zaphod()
|
||||
robot.StartCompetition()
|
||||
return robot
|
Loading…
Reference in New Issue
Block a user