Skip to content

Commit

Permalink
Error Bugfix
Browse files Browse the repository at this point in the history
  • Loading branch information
Mason-Lam committed Sep 1, 2023
1 parent a0f4148 commit 800dc16
Showing 1 changed file with 8 additions and 7 deletions.
15 changes: 8 additions & 7 deletions src/main/java/frc/team3128/commands/CmdTrajectory.java
Original file line number Diff line number Diff line change
Expand Up @@ -56,15 +56,16 @@ private ArrayList<PathPoint> generatePoses() {

private ArrayList<PathPoint> generatePoints() {
final ArrayList<PathPoint> points = new ArrayList<PathPoint>();
final ArrayList<Pose2d> positions = generatePoses();
//final ArrayList<Pose2d> positions = generatePoses();

final Rotation2d heading = Rotation2d.fromDegrees(180);
for (int i = 0; i < positions.size(); i++) {
final Pose2d pose = positions.get(i);
final PathPoint point = new PathPoint(pose.getTranslation(), heading, pose.getRotation());
points.add(point);
}
// final Rotation2d heading = Rotation2d.fromDegrees(180);
// for (int i = 0; i < positions.size(); i++) {
// final Pose2d pose = positions.get(i);
// final PathPoint point = new PathPoint(pose.getTranslation(), heading, pose.getRotation());
// points.add(point);
// }

// return points;
return points;
}

Expand Down

0 comments on commit 800dc16

Please sign in to comment.