diff --git a/src/main/java/frc/robot/Constants.java b/src/main/java/frc/robot/Constants.java index a701539..f104adf 100644 --- a/src/main/java/frc/robot/Constants.java +++ b/src/main/java/frc/robot/Constants.java @@ -246,4 +246,11 @@ public static class LEDConstants { public static class LoggingConstants { public static final double LOG_ALERT_INTERVAL = 5; // Interval (in s) between logs of an alert if its text doesn't change } + + public static class EndEffectorConstants { + public static final int MOTOR_SPEED = 0; + public static final int endEffectorMotorID = 0; + } + + } diff --git a/src/main/java/frc/robot/subsystems/end effector/endEffector.java b/src/main/java/frc/robot/subsystems/end effector/endEffector.java index a1c60c9..e5d1b51 100644 --- a/src/main/java/frc/robot/subsystems/end effector/endEffector.java +++ b/src/main/java/frc/robot/subsystems/end effector/endEffector.java @@ -1,17 +1,30 @@ -public class endEffector extends SubsystemBase{ - private final CANSparkMax endEffectorMotor; - private final int MOTOR_SPEED; +import edu.wpi.first.wpilibj2.command.SubsystemBase; +import frc.robot.Constants.EndEffectorConstants; - public endEffector(int endEffectorMotorID) { - endEffectorMotor = new CANSparkMaxSparkMax(endEffectorMotorID); - MOTOR_SPEED = 2 +import com.revrobotics.spark.SparkMax; +import com.revrobotics.spark.SparkBase.PersistMode; +import com.revrobotics.spark.SparkBase.ResetMode; +import com.revrobotics.spark.SparkLowLevel.MotorType; +import com.revrobotics.spark.config.SparkMaxConfig; +import com.revrobotics.spark.config.SparkBaseConfig.IdleMode; + +public class EndEffector extends SubsystemBase { + private final SparkMax endEffectorMotor; + + public EndEffector(int endEffectorMotorID) { + endEffectorMotor = new SparkMax(endEffectorMotorID, MotorType.kBrushless); + SparkMaxConfig config = new SparkMaxConfig(); + config.smartCurrentLimit(40); + config.idleMode(IdleMode.kBrake); + config.inverted(false); + endEffectorMotor.configure(config, ResetMode.kResetSafeParameters, PersistMode.kPersistParameters); } public void stopMotor() { endEffectorMotor.stopMotor(); - } + } - public void runMotor () { - endEffectorMotor.set(MOTOR_SPEED); + public void runMotor() { + endEffectorMotor.set(EndEffectorConstants.MOTOR_SPEED); } } \ No newline at end of file