change array name from levelsToDegrees to armPotValues
[3501/stronghold-2016] / src / org / usfirst / frc / team3501 / robot / subsystems / DefenseArm.java
CommitLineData
ebd3530c
YN
1package org.usfirst.frc.team3501.robot.subsystems;\r
2\r
da11cb45
YN
3import org.usfirst.frc.team3501.robot.Constants;\r
4\r
3f5489cc 5import edu.wpi.first.wpilibj.AnalogPotentiometer;\r
3d825b61 6import edu.wpi.first.wpilibj.CANTalon;\r
ebd3530c
YN
7import edu.wpi.first.wpilibj.command.Subsystem;\r
8\r
5585bd31 9public class DefenseArm extends Subsystem {\r
3f5489cc
YN
10 // Defense arm related objects\r
11 private AnalogPotentiometer potentiometer;\r
3d825b61 12 private CANTalon defenseArmMotor;\r
da11cb45 13\r
3f5489cc
YN
14 // Defense arm specific constants that relate to the degrees per pulse value\r
15 // for the potentiometers\r
da11cb45 16 private final static double PULSES_PER_ROTATION = 1; // in pulses\r
3f5489cc
YN
17 private final static double FULL_RANGE = 270.0; // in degrees\r
18 private final static double OFFSET = -135.0; // in degrees\r
3d825b61 19 private Double[] levelsToDegrees = { 0.0, 45.0, 90.0 }; // 3 level array;\r
8d2a8664 20\r
54b029e6
YA
21 // angles at 0,45,90\r
22 // degrees\r
da11cb45
YN
23\r
24 public DefenseArm() {\r
25 potentiometer = new AnalogPotentiometer(Constants.DefenseArm.CHANNEL,\r
26 FULL_RANGE, OFFSET);\r
8d2a8664 27 defenseArmMotor = new CANTalon(Constants.DefenseArm.PORT);\r
da11cb45
YN
28 }\r
29\r
8d2a8664 30 public double getLevel(int desiredArmLocation) {\r
3d825b61 31 return levelsToDegrees[desiredArmLocation];\r
da11cb45
YN
32 }\r
33\r
8d2a8664
YA
34 public void moveArmTo(int levelsToDegrees) {\r
35\r
36 }\r
37\r
38 public void moveArmDown(int levelsToDegrees) {\r
39 // to move arm down levels\r
40 if (levelsToDegrees > 0 & levelsToDegrees < 45) {\r
41 levelsToDegrees = 0;\r
42 if (levelsToDegrees > 45 & levelsToDegrees < 90) {\r
43 levelsToDegrees = 45;\r
44\r
45 }\r
46 }\r
47 }\r
48\r
49 public void moveArmUp(int levelsToDegrees) {\r
50 // to move arm up levels\r
51 if (levelsToDegrees < 45 & levelsToDegrees > 0) {\r
52 levelsToDegrees = 45;\r
53 if (levelsToDegrees < 90 & levelsToDegrees > 45) {\r
54 levelsToDegrees = 90;\r
55\r
56 }\r
da11cb45 57\r
8d2a8664 58 }\r
da11cb45 59 }\r
3f5489cc 60\r
76273676
YN
61 @Override\r
62 protected void initDefaultCommand() {\r
63 }\r
ebd3530c 64}\r