added analog potentiometer object in Arm class
[3501/2015-FRC-Spark] / src / org / usfirst / frc3501 / RiceCatRobot / subsystems / Arm.java
1 package org.usfirst.frc3501.RiceCatRobot.subsystems;
2
3 import org.usfirst.frc3501.RiceCatRobot.RobotMap;
4
5 import edu.wpi.first.wpilibj.AnalogPotentiometer;
6 import edu.wpi.first.wpilibj.CANJaguar;
7 import edu.wpi.first.wpilibj.command.Subsystem;
8
9 public class Arm extends Subsystem {
10 private CANJaguar left, right;
11 public AnalogPotentiometer analogPotentiometer;
12
13 public Arm() {
14 left = new CANJaguar(RobotMap.ARM_LEFT);
15 right = new CANJaguar(RobotMap.ARM_RIGHT);
16 }
17
18 public void initDefaultCommand() {
19 }
20
21 public void fineTuneControl(double d) {
22 if (Math.abs(d) < 0.05) {
23 d = 0;
24 } else if (d > 0) {
25 d *= d;
26 } else {
27 d *= -d;
28 }
29 setArmSpeeds(d);
30 }
31
32 public void setLeft(double speed) {
33 left.set(-speed);
34 }
35
36 public void setRight(double speed) {
37 right.set(-speed);
38 }
39
40 public void setArmSpeeds(double speed) {
41 setLeft(speed);
42 setRight(speed);
43 }
44
45 public void stop() {
46 left.set(0);
47 right.set(0);
48 }
49
50 }