Reenable old code

This commit is contained in:
HFocus
2019-03-18 16:58:49 -06:00
parent df88b29380
commit 4b90f82ec1
3 changed files with 4 additions and 4 deletions
@@ -122,7 +122,7 @@ public class OI
//stow.whenPressed(new StowArm());
//stow.whenPressed(new setLEDPattern(LEDPatterns.SOLID_GREEN));
//SmartDashboard.putData("switch to manuel", new SetManual());
SmartDashboard.putData("switch to manuel", new SetManual());
// SmartDashboard.putData("run turn test", new TestTurn());
SmartDashboard.putData("grab from station", new GrabFromLoadingSatation());
SmartDashboard.putData("wrist test", new wristTest());
@@ -370,7 +370,7 @@ public class Arm extends Subsystem implements ControlLoopable
double deltaPosition = joystickPosition * joystickInchesPerMs;
targetPositionInchesMM = targetPositionInchesMM + deltaPosition;
updatePositionMM(targetPositionInchesMM);
Robot.wrist.targetPositionInchesPID = targetPositionInchesPID - (deltaPosition/3);
//Robot.wrist.targetPositionInchesPID = targetPositionInchesPID - (deltaPosition/3);
Robot.wrist.updatePositionPID(Robot.wrist.targetPositionInchesPID);
@@ -194,12 +194,12 @@ public class Wrist extends Subsystem implements ControlLoopable
private double limitPosition(double targetPosition) {
/*if (targetPosition < MIN_POSITION_INCHES) {
if (targetPosition < MIN_POSITION_INCHES) {
return MIN_POSITION_INCHES;
}
else if (targetPosition > MAX_POSITION_INCHES) {
return MAX_POSITION_INCHES;
}*/
}
return targetPosition;
}