diff --git a/src/main/java/frc/robot/subsystems/intake/Intake.java b/src/main/java/frc/robot/subsystems/intake/Intake.java index dc054da..f5bb45e 100644 --- a/src/main/java/frc/robot/subsystems/intake/Intake.java +++ b/src/main/java/frc/robot/subsystems/intake/Intake.java @@ -2,6 +2,7 @@ import static edu.wpi.first.units.Units.RotationsPerSecond; +import edu.wpi.first.units.measure.Angle; import edu.wpi.first.units.measure.AngularVelocity; import edu.wpi.first.wpilibj2.command.SubsystemBase; import frc.lib.W8.io.motor.MotorIO.PIDSlot; @@ -21,6 +22,18 @@ public void setVelocity(double velocity) { _io.runVelocity(angVelo, Constants.IntakeConstants.ACCELERATION, PIDSlot.SLOT_0); } + public AngularVelocity getVelocity() { + return _io.getVelocity(); + } + + public Angle getPosition() { + return _io.getPosition(); + } + + public void stop() { + setVelocity(0); + } + @Override public void periodic() {} }