mirror of
https://github.com/Team4388/2019-Hit-or-Miss.git
synced 2026-06-09 08:38:06 -06:00
Arm.java Cleanup
This commit is contained in:
@@ -99,7 +99,7 @@ public class Robot extends TimedRobot
|
||||
drive.resetEncoders();
|
||||
drive.resetGyro();
|
||||
drive.setIsRed(getAlliance().equals(Alliance.Red));
|
||||
arm.resetencoder();
|
||||
arm.resetEncoder();
|
||||
|
||||
}
|
||||
|
||||
|
||||
@@ -142,7 +142,7 @@ public class Arm extends Subsystem implements ControlLoopable
|
||||
public void resetZeroPosition(double position) {
|
||||
mpController.resetZeroPosition(position);
|
||||
}
|
||||
public void resetencoder(){
|
||||
public void resetEncoder(){
|
||||
motor1.setPosition(0);
|
||||
}
|
||||
|
||||
@@ -175,7 +175,7 @@ public class Arm extends Subsystem implements ControlLoopable
|
||||
public void updatePositionPID(double targetPositionInches) {
|
||||
targetPositionInchesPID = limitPosition(targetPositionInches);
|
||||
if (limitPosition(motor1.getPositionWorld()) == MIN_POSITION_INCHES){
|
||||
resetencoder();
|
||||
resetEncoder();
|
||||
}
|
||||
double startPositionInches = motor1.getPositionWorld();
|
||||
//mpController.setTarget(targetPositionInchesPID, targetPositionInchesPID > startPositionInches ? KF_UP : KF_DOWN);
|
||||
@@ -276,7 +276,7 @@ public class Arm extends Subsystem implements ControlLoopable
|
||||
lastControlLoopUpdateTimestamp = currentTimestamp;
|
||||
|
||||
if (motor1.getSensorCollection().isRevLimitSwitchClosed()){
|
||||
motor1.setPosition(0);
|
||||
resetEncoder();
|
||||
}
|
||||
|
||||
// Do the update
|
||||
|
||||
Reference in New Issue
Block a user