From 4b2f2c899ccde3d75f7b209aad862305454d20b6 Mon Sep 17 00:00:00 2001 From: 66945 <54561572+66945@users.noreply.github.com> Date: Tue, 22 Mar 2022 18:04:17 -0600 Subject: [PATCH] test prnts --- .../frc4388/robot/commands/ShooterCommands/TrackTarget.java | 2 ++ 1 file changed, 2 insertions(+) diff --git a/src/main/java/frc4388/robot/commands/ShooterCommands/TrackTarget.java b/src/main/java/frc4388/robot/commands/ShooterCommands/TrackTarget.java index 0428899..346081e 100644 --- a/src/main/java/frc4388/robot/commands/ShooterCommands/TrackTarget.java +++ b/src/main/java/frc4388/robot/commands/ShooterCommands/TrackTarget.java @@ -92,9 +92,11 @@ public class TrackTarget extends CommandBase { // points = getFakePoints(); //// points = filterPoints(points); Point average = VisionOdometry.averagePoint(points); + System.out.println("Average Point: " + average.toString()); double output = (average.x - VisionConstants.LIME_HIXELS/2.d) / VisionConstants.LIME_HIXELS; output *= 2.0; + System.out.println("Output: " + output); m_turret.runTurretWithInput(output); // double position = m_turret.m_boomBoomRotateEncoder.getPosition();