Skip to content
This repository has been archived by the owner on Jan 10, 2025. It is now read-only.

Commit

Permalink
Format
Browse files Browse the repository at this point in the history
  • Loading branch information
simonstoryparker committed Dec 11, 2024
1 parent 77ded31 commit 882f87f
Showing 1 changed file with 9 additions and 5 deletions.
Original file line number Diff line number Diff line change
@@ -1,13 +1,12 @@
package frc.robot.autos.trailblazer.trackers.pure_pursuit;

import java.util.List;

import dev.doglog.DogLog;
import edu.wpi.first.math.geometry.Pose2d;
import edu.wpi.first.math.geometry.Rotation2d;
import edu.wpi.first.math.kinematics.ChassisSpeeds;
import frc.robot.autos.trailblazer.AutoPoint;
import frc.robot.autos.trailblazer.trackers.PathTracker;
import java.util.List;

// TODO: Implement https://github.com/team581/2024-offseason-bot/issues/95
public class PurePursuitPathTracker implements PathTracker {
Expand Down Expand Up @@ -116,9 +115,14 @@ public Pose2d getTargetPose() {
}
} else {

var targetPose = getLookaheadPoint(startingRobotPose, new Pose2d(startX, startY, new Rotation2d()), currentRobotPose, LOOKAHEAD_DISTANCE);
DogLog.log("Autos/Trailblazer/PurePursuitPathTracker/TargetPose", targetPose);
return targetPose;
var targetPose =
getLookaheadPoint(
startingRobotPose,
new Pose2d(startX, startY, new Rotation2d()),
currentRobotPose,
LOOKAHEAD_DISTANCE);
DogLog.log("Autos/Trailblazer/PurePursuitPathTracker/TargetPose", targetPose);
return targetPose;
}
}
var targetPose = lookaheadPoint;
Expand Down

0 comments on commit 882f87f

Please sign in to comment.