This commit is contained in:
OnDYCLaptop
2026-03-05 20:30:33 +08:00
4 changed files with 33 additions and 0 deletions
+6
View File
@@ -78,12 +78,18 @@ public final class Constants {
public static final String LIMELIGHT_NAME_Shooter = "limelight-shooter"; public static final String LIMELIGHT_NAME_Shooter = "limelight-shooter";
public static final String LIMELIGHT_NAME_Intaker = "limelight-intaker"; public static final String LIMELIGHT_NAME_Intaker = "limelight-intaker";
public static final Boolean UsingMetaTag2 = true; public static final Boolean UsingMetaTag2 = true;
<<<<<<< HEAD
public static final int Pipeline = 1; public static final int Pipeline = 1;
public static final double TXDeadHand = 0.5; public static final double TXDeadHand = 0.5;
public static final double TZDeadHand = 0.5; public static final double TZDeadHand = 0.5;
public static final double AutoClimbAlignSpeed = 0.1; public static final double AutoClimbAlignSpeed = 0.1;
public static final double AutoClimbAlignTolerance = 0.1; public static final double AutoClimbAlignTolerance = 0.1;
public static final double AutoClimbmaxAngularVelocity = 0.1; public static final double AutoClimbmaxAngularVelocity = 0.1;
=======
public static final double AutoClimbAlignSpeed = 0.5;//等查资料
public static final double AutoClimbAlignTolerance = 0.1;//?
public static final double AutoClimbmaxAngularVelocity = 0.5;//等查资料
>>>>>>> a8acbce9dc302adc52e28e6f8c205677f50ea20e
} }
public class Field { public class Field {
@@ -144,6 +144,11 @@ public class RobotContainer {
controllerlower.a() controllerlower.a()
.onTrue(robotStatusManager.setStatusCommand(RobotStatus.Climbing)) .onTrue(robotStatusManager.setStatusCommand(RobotStatus.Climbing))
.onFalse(robotStatusManager.setStatusCommand(RobotStatus.AllTelop)); .onFalse(robotStatusManager.setStatusCommand(RobotStatus.AllTelop));
<<<<<<< HEAD
=======
>>>>>>> a8acbce9dc302adc52e28e6f8c205677f50ea20e
} }
private void configueShooter(){ private void configueShooter(){
@@ -131,6 +131,14 @@ public class CommandSwerveDrivetrain extends TunerSwerveDrivetrain implements Su
); );
} }
<<<<<<< HEAD
=======
>>>>>>> a8acbce9dc302adc52e28e6f8c205677f50ea20e
private static final double kMaxVisionJumpMeters = 1.0; private static final double kMaxVisionJumpMeters = 1.0;
private static final double kMaxOmegaDegPerSec = 360.0; private static final double kMaxOmegaDegPerSec = 360.0;
@@ -274,6 +282,10 @@ public class CommandSwerveDrivetrain extends TunerSwerveDrivetrain implements Su
return true; return true;
} }
<<<<<<< HEAD
=======
>>>>>>> a8acbce9dc302adc52e28e6f8c205677f50ea20e
public String driveToAprilTag(){ public String driveToAprilTag(){
//Rotation2d targetHeading = getPose().getRotation(); //Rotation2d targetHeading = getPose().getRotation();
if(!LimelightSupplier.isTargetVisible() ){ if(!LimelightSupplier.isTargetVisible() ){
@@ -284,12 +296,18 @@ public class CommandSwerveDrivetrain extends TunerSwerveDrivetrain implements Su
for(int id : new int[]{16,32}){ for(int id : new int[]{16,32}){
if(id == trueId){ if(id == trueId){
ifRightTag = true; ifRightTag = true;
<<<<<<< HEAD
System.out.println("Target get."); System.out.println("Target get.");
=======
>>>>>>> a8acbce9dc302adc52e28e6f8c205677f50ea20e
break; break;
} }
} }
if(!ifRightTag){ if(!ifRightTag){
<<<<<<< HEAD
System.out.println("No Target."); System.out.println("No Target.");
=======
>>>>>>> a8acbce9dc302adc52e28e6f8c205677f50ea20e
return "No Target"; return "No Target";
} }
double tx = LimelightSupplier.getTX() ; double tx = LimelightSupplier.getTX() ;
@@ -84,6 +84,7 @@ public class LimelightSupplier extends SubsystemBase {
SmartDashboard.putString("LimelightPipeType", LimelightHelpers.getCurrentPipelineType(Constants.Limelight.LIMELIGHT_NAME_Intaker)); SmartDashboard.putString("LimelightPipeType", LimelightHelpers.getCurrentPipelineType(Constants.Limelight.LIMELIGHT_NAME_Intaker));
if (isTargetVisible()){ if (isTargetVisible()){
SmartDashboard.putString("LimelightTargetVisible", "YES"); SmartDashboard.putString("LimelightTargetVisible", "YES");
<<<<<<< HEAD
// SmartDashboard.putNumber("LimelightTX", getTX()); // SmartDashboard.putNumber("LimelightTX", getTX());
// SmartDashboard.putNumber("LimelightTY", getTY()); // SmartDashboard.putNumber("LimelightTY", getTY());
SmartDashboard.putNumber("LimelightTA", getTA()); SmartDashboard.putNumber("LimelightTA", getTA());
@@ -94,6 +95,9 @@ public class LimelightSupplier extends SubsystemBase {
// s += " "; // s += " ";
// } // }
// SmartDashboard.putString("LimeLightTP", s); // SmartDashboard.putString("LimeLightTP", s);
=======
SmartDashboard.putNumber("LimelightTA", getTA());
>>>>>>> a8acbce9dc302adc52e28e6f8c205677f50ea20e
SmartDashboard.putNumber("TargetRY", getTargetRotationY()); SmartDashboard.putNumber("TargetRY", getTargetRotationY());
SmartDashboard.putNumber("TargetTX", getTX()); SmartDashboard.putNumber("TargetTX", getTX());
SmartDashboard.putNumber("TargetTZ", getTargetTZ()); SmartDashboard.putNumber("TargetTZ", getTargetTZ());