Added variables for parameters in potentiometer constructor

[3501/2015-FRC-Spark] / src / org / usfirst / frc3501 / RiceCatRobot / subsystems / Arm.java

package org.usfirst.frc3501.RiceCatRobot.subsystems;

import org.usfirst.frc3501.RiceCatRobot.RobotMap;

import edu.wpi.first.wpilibj.AnalogInput;
import edu.wpi.first.wpilibj.AnalogPotentiometer;
import edu.wpi.first.wpilibj.CANJaguar;
import edu.wpi.first.wpilibj.command.Subsystem;

public class Arm extends Subsystem {
  private CANJaguar left, right;
  public AnalogPotentiometer analogPotentiometer;
  static final double ANGLE_RANGE = 360;
  static final double INITIAL_ANGLE = 30;

  public Arm() {
    left = new CANJaguar(RobotMap.ARM_LEFT);
    right = new CANJaguar(RobotMap.ARM_RIGHT);
    AnalogInput analogInput = new AnalogInput(1);
    analogPotentiometer = new AnalogPotentiometer(analogInput, ANGLE_RANGE, INITIAL_ANGLE);
  }

  public void initDefaultCommand() {
  }

  public void fineTuneControl(double d) {
    if (Math.abs(d) < 0.05) {
      d = 0;
    } else if (d > 0) {
      d *= d;
    } else {
      d *= -d;
    }
    setArmSpeeds(d);
  }

  public void setLeft(double speed) {
    left.set(-speed);
  }

  public void setRight(double speed) {
    right.set(-speed);
  }

  public void setArmSpeeds(double speed) {
    setLeft(speed);
    setRight(speed);
  }

  public void stop() {
    left.set(0);
    right.set(0);
  }
  
}