diff --git a/src/main/java/frc4388/robot/Robot.java b/src/main/java/frc4388/robot/Robot.java index 7ab8717..f9cdd12 100644 --- a/src/main/java/frc4388/robot/Robot.java +++ b/src/main/java/frc4388/robot/Robot.java @@ -147,9 +147,9 @@ public class Robot extends TimedRobot { Vector2D secondBallPosition = new Vector2D(-(40.44 * (Math.sqrt(2.00) / 2.00)) - ((82.83 - 7.58) * (Math.sqrt(2.00) / 2.00)) - (82.83 / 2.00), -(40.44 * (Math.sqrt(2.00) / 2.00)) + ((82.83 - 7.58) * (Math.sqrt(2.00) / 2.00)) - (219.25 / 2.00)); // * position of second ball, relative to hub. Vector2D firstToSecond = Vector2D.subtract(secondBallPosition, firstBallPosition); - System.out.println("First Ball (FEET): " + Vector2D.divide(firstBallPosition, 12).toString()); - System.out.println("Second Ball (FEET): " + Vector2D.divide(secondBallPosition, 12).toString()); - System.out.println("First To Second (FEET): " + Vector2D.divide(firstToSecond, 12).toString()); + // System.out.println("First Ball (FEET): " + Vector2D.divide(firstBallPosition, 12).toString()); + // System.out.println("Second Ball (FEET): " + Vector2D.divide(secondBallPosition, 12).toString()); + // System.out.println("First To Second (FEET): " + Vector2D.divide(firstToSecond, 12).toString()); // current = // m_robotContainer.m_robotBoomBoom.getCurrent() + diff --git a/src/main/java/frc4388/robot/subsystems/Climber.java b/src/main/java/frc4388/robot/subsystems/Climber.java index cf6c633..ba1e7e4 100644 --- a/src/main/java/frc4388/robot/subsystems/Climber.java +++ b/src/main/java/frc4388/robot/subsystems/Climber.java @@ -18,7 +18,7 @@ public class Climber extends SubsystemBase { /** Creates a new Climber */ public Climber(WPI_TalonFX elbow) { this.elbow = elbow; - elbow.configReverseLimitSwitchSource(LimitSwitchSource.FeedbackConnector, LimitSwitchNormal.NormallyOpen); + elbow.configForwardLimitSwitchSource(LimitSwitchSource.FeedbackConnector, LimitSwitchNormal.NormallyOpen); elbow.overrideLimitSwitchesEnable(true); //Check elbow.configReverseSoftLimitThreshold(ClimberConstants.ELBOW_FORWARD_SOFT_LIMIT); // Tune @@ -40,6 +40,6 @@ public class Climber extends SubsystemBase { @Override public void periodic() { SmartDashboard.putNumber("Elbow Angle", elbow.getSelectedSensorPosition()); - SmartDashboard.putBoolean("Climber Folded", (elbow.isRevLimitSwitchClosed() == 1)); + SmartDashboard.putBoolean("Climber Folded", (elbow.isFwdLimitSwitchClosed() == 1)); } } \ No newline at end of file