diff --git a/src/main/java/frc4388/robot/Constants.java b/src/main/java/frc4388/robot/Constants.java index 0d55be6..d35a01e 100644 --- a/src/main/java/frc4388/robot/Constants.java +++ b/src/main/java/frc4388/robot/Constants.java @@ -39,7 +39,7 @@ public final class Constants { /* Trajectory Constants */ public static final double MAX_SPEED_METERS_PER_SECOND = 3; public static final double MAX_ACCELERATION_METERS_PER_SECOND_SQUARED = 3; - public static final double TRACK_WIDTH_METERS = 0.648; ///TODO: SET THIS SOON! + public static final double TRACK_WIDTH_METERS = 0.648; public static final DifferentialDriveKinematics kDriveKinematics = new DifferentialDriveKinematics(TRACK_WIDTH_METERS); /* Remote Sensors */ @@ -71,6 +71,7 @@ public final class Constants { public static final double TICKS_PER_INCH = TICKS_PER_WHEEL_REV/INCHES_PER_WHEEL_REV; public static final double INCHES_PER_TICK = 1/TICKS_PER_INCH; public static final double INCHES_PER_METER = 39.370; + public static final double METERS_PER_INCH = 1/INCHES_PER_METER; } public static final class IntakeConstants { diff --git a/src/main/java/frc4388/robot/subsystems/Drive.java b/src/main/java/frc4388/robot/subsystems/Drive.java index 5db8a18..7a153e4 100644 --- a/src/main/java/frc4388/robot/subsystems/Drive.java +++ b/src/main/java/frc4388/robot/subsystems/Drive.java @@ -544,7 +544,7 @@ public class Drive extends SubsystemBase { * @return The converted value in meters */ public double inchesToMeters(double inches) { - return inches / DriveConstants.INCHES_PER_METER; + return inches * DriveConstants.METERS_PER_INCH; } /**