Skip to content

Commit

Permalink
[#29] good stuff
Browse files Browse the repository at this point in the history
  • Loading branch information
JoshT208 committed Feb 15, 2024
1 parent 9a6f1ba commit 61312a0
Showing 1 changed file with 5 additions and 3 deletions.
8 changes: 5 additions & 3 deletions src/main/java/frc/robot/command/AlignToTag.java
Original file line number Diff line number Diff line change
Expand Up @@ -43,7 +43,7 @@ public AlignToTag(Pose2d target, Swerve drivetrain, SwerveRequest.FieldCentric d
this.drivetrain = drivetrain;
this.drive = drive;
this.limelights = limelights;

this.driver=driver;
//limelight = limelights.getStopMe();

//limelightPrevPipeline = limelight.getPipeline();
Expand All @@ -57,17 +57,19 @@ public AlignToTag(Pose2d target, Swerve drivetrain, SwerveRequest.FieldCentric d
@Override
public void initialize() {
aligning = false;
new PointAtTag(drivetrain, limelights, driver);
//pointAtTag = new PointAtTag(target ,drivetrain, drive, limelights, driver);
// pointAtTag = new PointAtTag(drivetrain, limelights, driver);

}

// Called every time the scheduler runs while the command is scheduled.
@Override
public void execute() {
new MoveToPose(target, drivetrain, drive);
new PointAtTag(target, drivetrain, drive, limelights, driver);
if (!aligning) {
if (!(new MoveToPose(target, drivetrain, drive).isFinished())) {
new MoveToPose(target, drivetrain, drive);

} else {
aligning = true;
}
Expand Down

0 comments on commit 61312a0

Please sign in to comment.