diff --git a/src/main/java/frc/lib/util/LimelightHelpers.java b/src/main/java/frc/lib/util/LimelightHelpers.java index 624584a..811e7bb 100644 --- a/src/main/java/frc/lib/util/LimelightHelpers.java +++ b/src/main/java/frc/lib/util/LimelightHelpers.java @@ -663,6 +663,10 @@ public static double[] getBotPose_wpiBlue(String limelightName) { return getLimelightNTDoubleArray(limelightName, "botpose_wpiblue"); } + public static double[] getBotPose_orb_wpiBlue(String limelightName) { + return getLimelightNTDoubleArray(limelightName, "botpose_orb_wpiblue"); + } + public static double[] getBotPose_TargetSpace(String limelightName) { return getLimelightNTDoubleArray(limelightName, "botpose_targetspace"); } @@ -758,6 +762,12 @@ public static PoseEstimate getBotPoseEstimate_wpiBlue(String limelightName) { return getBotPoseEstimate(limelightName, "botpose_wpiblue"); } + public static Pose2d getBotPose2d_orb_wpiBlue(String limelightName) { + + double[] result = getBotPose_orb_wpiBlue(limelightName); + return toPose2D(result); + } + /** * Gets the Pose2d and timestamp for use with WPILib pose estimator (addVisionMeasurement) when you are on the BLUE * alliance