Team4388/2026KPopRobotHunters
1
0
Fork 0
mirror of https://github.com/Team4388/2026KPopRobotHunters.git synced 2026-06-09 00:38:03 -06:00
Code Issues Packages Projects Releases Wiki Activity

torque retract upper and lower curent lim thresh

Browse Source
This commit is contained in:
Shikhar
2026-03-31 20:51:47 -06:00
parent 2407a900c9
commit 958bdc46fd
5 changed files with 23 additions and 13 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/main/java/frc4388/robot/subsystems/intake/Intake.java
+11 -3
View File
@@ -40,6 +40,7 @@ public class Intake extends SubsystemBase {
RectractTorque,
Bouncing
}
private boolean overCompressed = false;
private IntakeMode mode = IntakeMode.Idle;
@@ -87,7 +88,6 @@ public class Intake extends SubsystemBase {
// }
@Override
public void periodic() {
// FaultReporter.register(this); // TODO Implement fault reporter
@@ -100,6 +100,14 @@ public class Intake extends SubsystemBase {
io.updateInputs(state);
if (state.armMotorCurrent.in(Amps) < IntakeConstants.INTAKE_SQUEEZE_CURRENT_LOWER_THRESHOLD.get()){
overCompressed = false;
} else if (state.armMotorCurrent.in(Amps) > IntakeConstants.INTAKE_SQUEEZE_CURRENT_UPPER_THRESHOLD.get()) {
overCompressed = true;
}
Logger.recordOutput("overCompressed", overCompressed);
// getCurrentTime
switch (mode) {
@@ -160,9 +168,9 @@ public class Intake extends SubsystemBase {
break;
case RectractTorque:
io.setRollerOutput(state, IntakeConstants.ROLLER_RETRACT_PERCENT_OUTPUT.get());
if (state.armMotorCurrent.in(Amps) < IntakeConstants.INTAKE_SQUEEZE_CURRENT_LIMIT.get()){
if (!overCompressed){
io.armOutput(IntakeConstants.ARM_SQUEEZE_PERCENT_OUTPUT.get());
} else {
} else if (overCompressed) {
io.armOutput(IntakeConstants.ARM_REDUCED_SQUEEZE_PERCENT_OUTPUT.get());
}
if(state.intakeEncoder.in(Rotations) > IntakeConstants.ARM_REVERSE_ROLLER_RANGE.get()) {