diff --git a/src/main/java/frc/robot/subsystems/DriveSubsystem.java b/src/main/java/frc/robot/subsystems/DriveSubsystem.java index 85b5c8e..15ee203 100644 --- a/src/main/java/frc/robot/subsystems/DriveSubsystem.java +++ b/src/main/java/frc/robot/subsystems/DriveSubsystem.java @@ -15,6 +15,7 @@ import com.pathplanner.lib.commands.PathPlannerAuto; import com.pathplanner.lib.config.PIDConstants; import com.pathplanner.lib.config.RobotConfig; import com.pathplanner.lib.controllers.PPHolonomicDriveController; +import com.pathplanner.lib.util.PathPlannerLogging; import edu.wpi.first.math.VecBuilder; import edu.wpi.first.math.geometry.Pose2d; @@ -180,6 +181,9 @@ public class DriveSubsystem extends TestableSubsystem { autoChooser.setDefaultOption("Do Nothing", Commands.none()); SmartDashboard.putData("Auto Chooser", autoChooser); + // PathPlannerLogging.setLogActivePathCallback((List pose) -> {}); + PathPlannerLogging.setLogTargetPoseCallback((Pose2d targetPose) -> { Logger.recordOutput("PathPlanner-TargetPose", targetPose);}); + } catch (Exception e) { e.printStackTrace(); }