encoder weird

This commit is contained in:
2026-03-01 14:50:55 -05:00
parent 866e6b99df
commit 80ef3a3431
2 changed files with 14 additions and 6 deletions

View File

@@ -7,6 +7,7 @@ import org.littletonrobotics.junction.Logger;
import com.revrobotics.AbsoluteEncoder;
import com.revrobotics.PersistMode;
import com.revrobotics.RelativeEncoder;
import com.revrobotics.ResetMode;
import com.revrobotics.spark.SparkClosedLoopController;
import com.revrobotics.spark.SparkMax;
@@ -25,6 +26,8 @@ public class Shooter extends SubsystemBase {
private AbsoluteEncoder leftEncoder;
private AbsoluteEncoder rightEncoder;
private RelativeEncoder rightRelative;
private SparkClosedLoopController leftClosedLoopController;
private SparkClosedLoopController rightClosedLoopController;
@@ -54,6 +57,8 @@ public class Shooter extends SubsystemBase {
// TODO Set this to the initial startup speed
targetSpeeds = null;
rightRelative = rightMotor.getEncoder();
}
@Override
@@ -66,6 +71,9 @@ public class Shooter extends SubsystemBase {
Logger.recordOutput("Shooter/LeftRollers/CurrentRPM", leftEncoder.getVelocity());
Logger.recordOutput("Shooter/RightRollers/CurrentRPM", rightEncoder.getVelocity());
Logger.recordOutput("Shooter/RightRollers/rightmotor", rightRelative.getVelocity());
// TODO How does the SparkMAX controller determine "at setpoint"? Is there any tolerance?
Logger.recordOutput("Shooter/LeftRollers/AtSetpoint", leftClosedLoopController.isAtSetpoint());
Logger.recordOutput("Shooter/RightRollers/AtSetpoint", rightClosedLoopController.isAtSetpoint());
@@ -85,7 +93,7 @@ public class Shooter extends SubsystemBase {
);
rightClosedLoopController.setSetpoint(
-targetSpeeds.getSpeedRPM(),
targetSpeeds.getSpeedRPM(),
ControlType.kVelocity
);
}