mirror of
https://github.com/Team4388/2026KPopRobotHunters.git
synced 2026-06-09 00:38:03 -06:00
squidward
This commit is contained in:
@@ -76,17 +76,20 @@ public class Intake extends SubsystemBase {
|
||||
io.setRollerVelocity(state, RotationsPerSecond.of(0));
|
||||
break;
|
||||
case Extending:
|
||||
io.armOutput(0.1);
|
||||
io.armOutput(IntakeConstants.ARM_EXTEND_PERCENT_OUTPUT.get());
|
||||
io.setRollerVelocity(state, RotationsPerSecond.of(IntakeConstants.ROLLER_ACTIVE.get()));
|
||||
break;
|
||||
case Retracting:
|
||||
io.armOutput(-0.1);
|
||||
io.armOutput(IntakeConstants.ARM_RETRACT_PERCENT_OUTPUT.get());
|
||||
io.setRollerVelocity(state, RotationsPerSecond.of(0));
|
||||
break;
|
||||
case Idle:
|
||||
case Idle:
|
||||
io.stopArm();
|
||||
break;
|
||||
}
|
||||
if (state.retractedLimit){
|
||||
this.mode = IntakeMode.Retracted;
|
||||
}
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
@@ -95,7 +95,7 @@ public class IntakeReal implements IntakeIO {
|
||||
public void stopArm(){
|
||||
m_armMotor.set(0);
|
||||
}
|
||||
|
||||
|
||||
@Override
|
||||
public void armOutput(double percentOutput){
|
||||
var d = new DutyCycleOut(0);
|
||||
@@ -109,7 +109,7 @@ public class IntakeReal implements IntakeIO {
|
||||
public void updateInputs(IntakeState state) {
|
||||
state.armAngle = m_armMotor.getPosition().getValue().div(IntakeConstants.ARM_MOTOR_GEAR_RATIO);
|
||||
state.armMotorCurrent = m_armMotor.getStatorCurrent().getValue();
|
||||
state.retractedLimit = m_armLimitSwitch.get();
|
||||
state.retractedLimit = !m_armLimitSwitch.get();
|
||||
state.rollerVelocity = m_rollerMotor.getVelocity().getValue().div(IntakeConstants.ROLLER_MOTOR_GEAR_RATIO);
|
||||
state.rollerMotorCurrent = m_rollerMotor.getStatorCurrent().getValue();
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user