diff --git a/lib/src/main/java/org/fairportrobotics/frc/robolib/vision/limelight/Limelight.java b/lib/src/main/java/org/fairportrobotics/frc/robolib/vision/limelight/Limelight.java index 3d6e2f3..cc2a4ba 100644 --- a/lib/src/main/java/org/fairportrobotics/frc/robolib/vision/limelight/Limelight.java +++ b/lib/src/main/java/org/fairportrobotics/frc/robolib/vision/limelight/Limelight.java @@ -15,6 +15,8 @@ public class Limelight { this.name = name; this.poseEstimator = poseEstimator; this.pose=pose; + + LimelightHelpers.setCameraPose_RobotSpace(name, pose.getX(), pose.getY(), pose.getZ(), Math.toDegrees(pose.getRotation().getX()), Math.toDegrees(pose.getRotation().getY()), Math.toDegrees(pose.getRotation().getZ())); } public LimelightHelpers.PoseEstimate updateOdometry() {