climb修改

This commit is contained in:
OnDYCLaptop
2026-03-07 12:43:00 +08:00
parent 093a0b93c9
commit 056362fe10
@@ -83,9 +83,24 @@ public class IntakerSubsystem extends SubsystemBase{
stopIntakerotater();
}
public void IntakerDownNonStop(){
double currentPosition = getIntakerotaterPosition();
if (currentPosition > Constants.Intaker.intakeRotaterDownLimit) {
// move down (negative power) while above the lower limit
intakerotater.set(-0.05);
} else {
// at or below lower limit: stop
stopIntakerotater();
}
}
public void IntakerUpNonStop(){
double currentPosition = getIntakerotaterPosition();
if (currentPosition < Constants.Intaker.intakeRotaterUpLimit) {
// move up while below the upper limit
intakerotater.set(0.1);
} else {
// at or above upper limit: stop
stopIntakerotater();
}
}
}