Fix waypoints

FRCTeam3044 · Jul 18, 2024 · 514f61c · 514f61c
1 parent 5e05aea
commit 514f61c
Showing 1 changed file with 3 additions and 3 deletions.
diff --git a/Pathfinding/src/main/java/me/nabdev/pathfinding/structures/Path.java b/Pathfinding/src/main/java/me/nabdev/pathfinding/structures/Path.java
@@ -96,8 +96,8 @@ public void setUnsnappedTarget(Vertex unsnappedTarget) {
      * @param path The path to add.
      */
     public void addPath(Path path) {
-        this.addAll(path);
         this.add(target);
+        this.addAll(path);
         createFullPath();
         setUnsnappedTarget(path.getUnsnappedTarget());
         this.target = path.getTarget();
@@ -383,8 +383,8 @@ public ArrayList<Pose2d> asPose2dList() {
      */
     public Trajectory asTrajectory(TrajectoryConfig config) throws ImpossiblePathException {
         try {
-        return TrajectoryGenerator.generateTrajectory(asPose2dList(), config);
-        } catch (TrajectoryGenerationException e){
+            return TrajectoryGenerator.generateTrajectory(asPose2dList(), config);
+        } catch (TrajectoryGenerationException e) {
             throw new ImpossiblePathException("Failed to generate trajectory for path. Error: " + e.getMessage());
         }
     }