This commit is contained in:
OnDYCLaptop
2026-03-05 20:44:11 +08:00
parent f31b614cc3
commit 7cee19994f
5 changed files with 3 additions and 48 deletions
@@ -131,14 +131,6 @@ public class CommandSwerveDrivetrain extends TunerSwerveDrivetrain implements Su
);
}
<<<<<<< HEAD
=======
>>>>>>> a8acbce9dc302adc52e28e6f8c205677f50ea20e
private static final double kMaxVisionJumpMeters = 1.0;
private static final double kMaxOmegaDegPerSec = 360.0;
@@ -282,10 +274,6 @@ public class CommandSwerveDrivetrain extends TunerSwerveDrivetrain implements Su
return true;
}
<<<<<<< HEAD
=======
>>>>>>> a8acbce9dc302adc52e28e6f8c205677f50ea20e
public String driveToAprilTag(){
//Rotation2d targetHeading = getPose().getRotation();
if(!LimelightSupplier.isTargetVisible() ){
@@ -296,18 +284,12 @@ public class CommandSwerveDrivetrain extends TunerSwerveDrivetrain implements Su
for(int id : new int[]{16,32}){
if(id == trueId){
ifRightTag = true;
<<<<<<< HEAD
System.out.println("Target get.");
=======
>>>>>>> a8acbce9dc302adc52e28e6f8c205677f50ea20e
break;
}
}
if(!ifRightTag){
<<<<<<< HEAD
System.out.println("No Target.");
=======
>>>>>>> a8acbce9dc302adc52e28e6f8c205677f50ea20e
return "No Target";
}
double tx = LimelightSupplier.getTX() ;
@@ -84,20 +84,7 @@ public class LimelightSupplier extends SubsystemBase {
SmartDashboard.putString("LimelightPipeType", LimelightHelpers.getCurrentPipelineType(Constants.Limelight.LIMELIGHT_NAME_Intaker));
if (isTargetVisible()){
SmartDashboard.putString("LimelightTargetVisible", "YES");
<<<<<<< HEAD
// SmartDashboard.putNumber("LimelightTX", getTX());
// SmartDashboard.putNumber("LimelightTY", getTY());
SmartDashboard.putNumber("LimelightTA", getTA());
// double[] targetPose = getTargetPose();
// String s = "";
// for(double x : targetPose){
// s += Double.toString(x);
// s += " ";
// }
// SmartDashboard.putString("LimeLightTP", s);
=======
SmartDashboard.putNumber("LimelightTA", getTA());
>>>>>>> a8acbce9dc302adc52e28e6f8c205677f50ea20e
SmartDashboard.putNumber("TargetRY", getTargetRotationY());
SmartDashboard.putNumber("TargetTX", getTX());
SmartDashboard.putNumber("TargetTZ", getTargetTZ());