package frc.robot;

import edu.wpi.first.wpilibj.TimedRobot;

public class Robot extends TimedRobot {

  final int BUTTON_A = 1;
  final int BUTTON_B = 2;
  final int BUTTON_X = 3;
  final int BUTTON_Y = 4;
  final int LEFT_SHOULDER_BUTTON = 5;
  final int RIGHT_SHOULDER_BUTTON = 6;
  final int BACK_BUTTON = 7;
  final int START_BUTTON = 8;
  final int LEFT_ANALOG_STICK_BUTTON = 9;
  final int RIGHT_ANALOG_STICK_BUTTON = 10;
  double LEFT_ANALOG_STICK_X_AXIS; // = drive.stick.getRawAXIS(0);
  double LEFT_ANALOG_STICK_Y_AXIS; // = drive.stick.getRawAXIS(1);
  double LEFT_ANALOG_TRIGGER; // = drive.stick.getRawAxis(2);
  double RIGHT_ANALOG_TRIGGER; // = drive.stick.getRawAxis(3);
  double RIGHT_ANALOG_STICK_X_AXIS; // = drive.stick.getRawAxis(4);
  double RIGHT_ANALOG_STICK_Y_AXIS; // = drive.stick.getRawAXIS(5);

  RobotDrive drive;
  Intake intake;
  // Lift lift;
  Pneumatics pneumatics = new Pneumatics();

  @Override
  public void robotInit() {

    drive = new RobotDrive();
    intake = new Intake();
    // lift = new Lift();
    // pneumatics = new Pneumatics();

  }

  @Override
  public void robotPeriodic() {
  }

  @Override
  public void autonomousInit() {

  }

  @Override
  public void autonomousPeriodic() {

  }

  @Override
  public void teleopPeriodic() {

    intake.Inhale();
    intake.Exhale();

    // pneumatics.doubleExtend();
    // pneumatics.doubleContract();
    // pneumatics.singleExtend();
    // pneumatics.singleContract();

    // lift.OuterLift();

    LEFT_ANALOG_STICK_X_AXIS = drive.stick.getRawAxis(0);
    LEFT_ANALOG_STICK_Y_AXIS = drive.stick.getRawAxis(1);

    // Basic ArcadeDrive function used for driving
    drive.diff_drive.arcadeDrive(-LEFT_ANALOG_STICK_Y_AXIS, LEFT_ANALOG_STICK_X_AXIS);

  }

  @Override
  public void testPeriodic() {
  }
}