diff --git a/src/main/kotlin/frc/team449/robot2024/constants/drives/SwerveConstants.kt b/src/main/kotlin/frc/team449/robot2024/constants/drives/SwerveConstants.kt index cfb8268..0547e76 100644 --- a/src/main/kotlin/frc/team449/robot2024/constants/drives/SwerveConstants.kt +++ b/src/main/kotlin/frc/team449/robot2024/constants/drives/SwerveConstants.kt @@ -38,7 +38,7 @@ object SwerveConstants { const val DRIVE_KA = 0.43365 + 0.035 + 0.0185 // TODO: Figure out this value - const val STEER_KS = 0.05 + const val STEER_KS = 0.05 / 12.0 /** PID gains for driving each module*/ const val DRIVE_KP = 0.475 diff --git a/src/main/kotlin/frc/team449/robot2024/constants/subsystem/PivotConstants.kt b/src/main/kotlin/frc/team449/robot2024/constants/subsystem/PivotConstants.kt index 4920398..934649a 100644 --- a/src/main/kotlin/frc/team449/robot2024/constants/subsystem/PivotConstants.kt +++ b/src/main/kotlin/frc/team449/robot2024/constants/subsystem/PivotConstants.kt @@ -68,7 +68,7 @@ object PivotConstants { val SHOOT_ANYWHERE_POS_TOLERANCE = Units.degreesToRadians(0.95) val MAX_POS_ERROR = Units.degreesToRadians(1.65) - val AMP_TOL_RANGE = 75.0..115.0 + val AMP_TOL_RANGE = Units.degreesToRadians(75.0)..Units.degreesToRadians(115.0) val AMP_VEL_TOL = Units.degreesToRadians(115.0) val STOW_TOL = Units.degreesToRadians(12.5) val MAX_VEL_ERROR = Units.degreesToRadians(30.0)