This commit is contained in:
OnDYCLaptop
2026-03-02 23:07:46 +08:00
3 changed files with 4 additions and 4 deletions
+1
View File
@@ -124,6 +124,7 @@ public final class Constants {
public static final double climbUpTicks = 94; // TODO: 实测后调整
public static final double climbDownTicks = 0; // TODO: 实测后调整
public static final double climbDownVelocity = -200;
public static final double holdToleranceRot = 0.5;
public static final double deltaDownTicks = 1;
@@ -25,12 +25,12 @@ public class ClimberControls {
//climber.climbUp();
// 优先级:如果同时按,优先上升(你也可以反过来)
if(controller.y().getAsBoolean()&&controller.x().getAsBoolean()){
climber.zeroEncoder();
climber.climbDownNonStop();
}
else if (controller.y().getAsBoolean()) {
climber.climbUp();
} else if (controller.x().getAsBoolean()) {
climber.climbDownNonStop();
climber.climbDown();
} else {
// 松开:记录当前位置 + 锁死
climber.captureHoldPosition();
@@ -73,8 +73,7 @@ public class ClimberSubsystem extends SubsystemBase {
}
public void climbDownNonStop(){
deltaPositionTicks = Constants.Climber.deltaDownTicks;
climberMotor.setControl(positionHoldRequest.withPosition(targetPositionTicks-deltaPositionTicks));
climberMotor.setControl(velocityRequest.withVelocity(Constants.Climber.climbDownVelocity));
}
public void captureHoldPosition() {