amhsrobotics4681 / 2020-First-Rise

File Repoitory for 2020 First Robotics 4681 Team
1 stars 0 forks source link

Stephens Sample Code #3

Closed sprice134 closed 4 years ago

sprice134 commented 4 years ago

DISCLAIMER This is not code that has been run through a compiler yet, simply structured pseudocode to give a framework. DO NOT copy and paste it into the code.

Code For the Brayden Wheel

private boolean switchPressed = false; public int currentBallTotal = 0; private DigitalInput m_DIOlimitSwitchWheel; private PWMVictorSPX m_Wheel; private final int kWheelSpeed = .3; //arbitrary value

public void BallIntakeInit(){ m_DIOlimitSwitchWheel = new DigitalInput(#); m_Wheel = PWMVictorSPX(#);

} public void mainMethod(){
if (m_DIOlimitSwitchWheel.get() && !switchPressed){ switchPressed = true; m_Wheel.set(kWheelSpeed); currentBallTotal ++;
} if (switchPressed){ if (!m_DIOlimitSwitchWheel.get()){ m_Wheel.set(0); switchPressed = false; } } } public boolean returnSwtich(){ return m_DIOlimitSwitchWheel.get(); } public void manualOverrideOn(){ m_Wheel.set(kWheelSpeed); } public void manualOverrideOff(){ m_Wheel.set(0); }