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