gbn

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