diff --git a/src/main/java/frc/robot/commands/Limelighter.java b/src/main/java/frc/robot/commands/Limelighter.java index 811f3ec..345c982 100644 --- a/src/main/java/frc/robot/commands/Limelighter.java +++ b/src/main/java/frc/robot/commands/Limelighter.java @@ -65,6 +65,9 @@ public class Limelighter extends Command { x = 11.915394; BotPose = limelight3g.getBotPoseRed(); } + botx = BotPose[0]; + boty = BotPose[1]; + calcul = limelight3g.Calcule(botx, x, boty, 4, angle); if(calcul > -5 && calcul < 5){ drivetrain.setControl( drive.withRotationalRate(0));