mirror of
https://github.com/Team4388/2019-Hit-or-Miss.git
synced 2026-06-08 16:18:02 -06:00
Reenable old code
This commit is contained in:
@@ -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;
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user