liftBottomSwitch = wpilib.DigitalInput(robotMap.liftBottomSwitch) liftTopSwitch = wpilib.DigitalInput(robotMap.liftTopSwitch) #compressor compressor = wpilib.Compressor(robotMap.pressureSwitch,robotMap.compressorSpike) #encoders shootEncoder = wpilib.Encoder( robotMap.shootEncoder1 , robotMap.shootEncoder2 , True, wpilib.CounterBase.k1X) feedEncoder = wpilib.Encoder(robotMap.feedEncoder1, robotMap.feedEncoder2, True, wpilib.CounterBase.k1X) leftDriveEncoder = wpilib.Encoder( robotMap.leftDriveEncoder1 , robotMap.leftDriveEncoder2 , True, wpilib.CounterBase.k4X) rightDriveEncoder = wpilib.Encoder( robotMap.rightDriveEncoder1 , robotMap.rightDriveEncoder2 , True, wpilib.CounterBase.k4X) encoderHighTest = wpilib.DigitalOutput(9) #initialize smartDashboard SmartDashboard.init() analog = wpilib.AnalogModule(robotMap.analogModule) #variables frontValue = 0 deltaFront = 0 backValue = 0 deltaBack = 0 direction = -1 fnum = 0 bnum = 0 lsense = (lstick.GetThrottle() -1)*(-0.5) rsense = (rstick.GetThrottle() -1)*(-0.5) mode = 0 stage = 0
