src/main/java/frc/robot/Robot.java
@Override
  public void teleopPeriodic() {

    driveTrain(gp1.getRightTriggerAxis()-gp1.getLeftTriggerAxis(), gp1.getLeftX());
    controlIntakeShooterIndex(gp1.getXButton(), gp1.getYButton(), gp2.getRightTriggerAxis()> .5, gp2.getLeftTriggerAxis()> .5, gp2.getRightBumperPressed(), gp2.getLeftBumperPressed());    
    
    controlDriveSpeed(gp1.getAButtonPressed());

    //controlUppeyDowney(gp2.getBButton(), gp2.getXButton());

    climb(gp2.getYButton(), gp2.getAButton(), gp2.getPOV(), gp2.getLeftStickButtonPressed());
   
    if(gp2.getRightStickButtonPressed())
      shooterSetAngle(servoAngle);

    if(gp2.getStartButtonPressed()){
      Camera.changeCam();

    }

    
  }
/** This function is called periodically during operator control. */
This function is called periodically during operator control.
This function is called periodically during operator control .
@Override
  public void teleopPeriodic() {
    driveTrain(gp1.getRightTriggerAxis()-gp1.getLeftTriggerAxis(), gp1.getLeftX());
    controlIntakeShooterIndex(gp1.getXButton(), gp1.getYButton(), gp2.getRightTriggerAxis()> .5, gp2.getLeftTriggerAxis()> .5, gp2.getRightBumperPressed(), gp2.getLeftBumperPressed());    
    controlDriveSpeed(gp1.getAButtonPressed());
    climb(gp2.getYButton(), gp2.getAButton(), gp2.getPOV(), gp2.getLeftStickButtonPressed());
    if(gp2.getRightStickButtonPressed())
      shooterSetAngle(servoAngle);
    if(gp2.getStartButtonPressed()){
      Camera.changeCam();
    }
  }
@ Override public void teleopPeriodic ( ) { driveTrain ( gp1 . getRightTriggerAxis ( ) - gp1 . getLeftTriggerAxis ( ) , gp1 . getLeftX ( ) ) ; controlIntakeShooterIndex ( gp1 . getXButton ( ) , gp1 . getYButton ( ) , gp2 . getRightTriggerAxis ( ) > .5 , gp2 . getLeftTriggerAxis ( ) > .5 , gp2 . getRightBumperPressed ( ) , gp2 . getLeftBumperPressed ( ) ) ; controlDriveSpeed ( gp1 . getAButtonPressed ( ) ) ; climb ( gp2 . getYButton ( ) , gp2 . getAButton ( ) , gp2 . getPOV ( ) , gp2 . getLeftStickButtonPressed ( ) ) ; if ( gp2 . getRightStickButtonPressed ( ) ) shooterSetAngle ( servoAngle ) ; if ( gp2 . getStartButtonPressed ( ) ) { Camera . changeCam ( ) ; } }
This function is called periodically during operator control.
This function is called periodically during operator control .
//controlUppeyDowney(gp2.getBButton(), gp2.getXButton());