This commit is contained in:
Alyssum-chenyiyi
2026-03-06 19:41:28 +08:00
3 changed files with 6 additions and 2 deletions
@@ -160,6 +160,7 @@ public class DriveControls {
Math.max(Math.abs(raw), 0.4), Math.max(Math.abs(raw), 0.4),
raw raw
); );
vy = isRedAlliance ? -vy : vy;
} }
autoControlNetworkTable.getEntry("BumpDifference").setDouble(differenceBump); autoControlNetworkTable.getEntry("BumpDifference").setDouble(differenceBump);
@@ -189,6 +190,7 @@ public class DriveControls {
Math.max(Math.abs(raw), 0.4), Math.max(Math.abs(raw), 0.4),
raw raw
); );
vy = isRedAlliance ? -vy : vy;
} }
autoControlNetworkTable.getEntry("TrenchDifference").setDouble(differenceTrench); autoControlNetworkTable.getEntry("TrenchDifference").setDouble(differenceTrench);
Rotation2d currentAngle = drivetrain.getState().Pose.getRotation(); Rotation2d currentAngle = drivetrain.getState().Pose.getRotation();
@@ -212,7 +214,8 @@ public class DriveControls {
if (fieldCentricEnabled || isAutoLike) { if (fieldCentricEnabled || isAutoLike) {
// 自动状态用 BlueAlliance(不翻转),手柄 field-centric 仍用原 fieldCentric(OperatorPerspective) // 自动状态用 BlueAlliance(不翻转),手柄 field-centric 仍用原 fieldCentric(OperatorPerspective)
var chosen = isAutoLike ? fieldCentricAuto : fieldCentric; //var chosen = isAutoLike ? fieldCentricAuto : fieldCentric;
var chosen = fieldCentric;
return chosen return chosen
.withVelocityX(vx) .withVelocityX(vx)
.withVelocityY(vy) .withVelocityY(vy)
@@ -75,6 +75,7 @@ public class IntakerControls {
double getterspeed = 0; double getterspeed = 0;
double conveyoyspeedforintake = 15; double conveyoyspeedforintake = 15;
double statorCurrent = ShooterSubsystem.getConveyorStatorCurrent(); double statorCurrent = ShooterSubsystem.getConveyorStatorCurrent();
if (controller.getLeftTriggerAxis() > 0.1) { if (controller.getLeftTriggerAxis() > 0.1) {
getterspeed = controller.getLeftTriggerAxis() * Constants.Intaker.IntakeGetterK + Constants.Intaker.Getterminspeed; getterspeed = controller.getLeftTriggerAxis() * Constants.Intaker.IntakeGetterK + Constants.Intaker.Getterminspeed;
ShooterSubsystem.setConveyorSpeedByRPS(conveyoyspeedforintake); ShooterSubsystem.setConveyorSpeedByRPS(conveyoyspeedforintake);
@@ -86,6 +86,6 @@ public class IntakerSubsystem extends SubsystemBase{
intakerotater.set(-0.05); intakerotater.set(-0.05);
} }
public void IntakerUpNonStop(){ public void IntakerUpNonStop(){
intakerotater.set(0.2); intakerotater.set(0.1);
} }
} }