From ff1a4919a7c6cda0b2b1cf5204d5cb05c3f72b86 Mon Sep 17 00:00:00 2001 From: samuel desharnais Date: Tue, 28 Nov 2023 18:43:37 -0500 Subject: [PATCH] gbn --- src/main/java/frc/robot/subsystems/Drive.java | 7 ++++--- 1 file changed, 4 insertions(+), 3 deletions(-) diff --git a/src/main/java/frc/robot/subsystems/Drive.java b/src/main/java/frc/robot/subsystems/Drive.java index 9d97d48..d2391d1 100644 --- a/src/main/java/frc/robot/subsystems/Drive.java +++ b/src/main/java/frc/robot/subsystems/Drive.java @@ -8,6 +8,7 @@ import java.io.File; import java.io.IOException; import edu.wpi.first.math.geometry.Translation2d; +import edu.wpi.first.math.kinematics.SwerveModulePosition; import edu.wpi.first.wpilibj.Filesystem; import edu.wpi.first.wpilibj2.command.SubsystemBase; import swervelib.SwerveDrive; @@ -30,9 +31,9 @@ public class Drive extends SubsystemBase { e.printStackTrace(); } } - /* public double distance(){ - return - }*/ + public SwerveModulePosition[] distance(){ + return swerveDrive.getModulePositions(); + } @Override public void periodic() { // This method will be called once per scheduler run