Add getRotation2d method

Sean-Weber · Sean-Weber · commit 58112c935f33 · 2022-03-29T13:49:37.000-07:00
diff --git a/src/main/java/frc/robot/lib/path/RobotPath.java b/src/main/java/frc/robot/lib/path/RobotPath.java
@@ -66,7 +66,9 @@ public RobotPath(List<Pose2d> poses, boolean isInverted, DrivetrainInterface dt)
         this.maxAccelMps2 = dt.getMaxAccelMps2();
         this.maxSpeedMps = dt.getMaxSpeedMps();
     }
-
+    public Rotation2d getRotation2d(int index){
+        return poses.get(index).getRotation();
+    }
     /**
      * Gets a path command for the given path
      * 

Original file line number	Diff line number	Diff line change
`@@ -66,7 +66,9 @@ public RobotPath(List<Pose2d> poses, boolean isInverted, DrivetrainInterface dt)`
`66`	`66`	`this.maxAccelMps2 = dt.getMaxAccelMps2();`
`67`	`67`	`this.maxSpeedMps = dt.getMaxSpeedMps();`
`68`	`68`	`}`
`69`		`-`
	`69`	`+ public Rotation2d getRotation2d(int index){`
	`70`	`+ return poses.get(index).getRotation();`
	`71`	`+ }`
`70`	`72`	`/**`
`71`	`73`	`* Gets a path command for the given path`
`72`	`74`	`*`