team2059/ford-java
2
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

Autoformatted

Browse Source
This commit is contained in:
Austen Adler 2016-09-19 12:14:01 -04:00
parent b9b0ee6628
commit 3128d3e31b
No known key found for this signature in database
GPG Key ID: 7ECEE590CCDFE3F1
1 changed files with 8 additions and 11 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

19
src/org/usfirst/frc/team2059/robot/subsystems/MainArm.java
View File

@ -11,7 +11,6 @@ public class MainArm extends PIDSubsystem {
AnalogInput pot = new AnalogInput(RobotMap.armPot);
DigitalInput limitSwitchBottom = new DigitalInput(RobotMap.armBottomLim);
DigitalInput limitSwitchTop = new DigitalInput(RobotMap.armTopLim);
public MainArm() {
super("MainArm", 0.06, 0.0, 0.002);
getPIDController().setContinuous(false);
@ -38,20 +37,18 @@ public class MainArm extends PIDSubsystem {
return potToDegrees(getRaw());
}
private double potToDegrees(double pot) {
System.out.println(limitSwitchBottom.get());
if (!limitSwitchBottom.get()){
RobotMap.zeroDegrees = getRaw();
System.out.println("====Bottom Switch====\n" + getRaw());
} else if (!limitSwitchTop.get()){
RobotMap.ninetyDegrees = getRaw();
System.out.println("====Top Switch====\n" + getRaw());
}
System.out.println(limitSwitchBottom.get());
if (!limitSwitchBottom.get()) {
RobotMap.zeroDegrees = getRaw();
System.out.println("====Bottom Switch====\n" + getRaw());
} else if (!limitSwitchTop.get()) {
RobotMap.ninetyDegrees = getRaw();
System.out.println("====Top Switch====\n" + getRaw());
}
double min = RobotMap.zeroDegrees;
double max = RobotMap.ninetyDegrees;
System.out.println((pot - min) / (Math.abs(min - max) / 90));
return (pot - min) / (Math.abs(min - max) / 90);
}
}
// vim: sw=2:ts=2:sts=2