This commit is contained in:
@ -32,6 +32,11 @@ public class Drive extends SubsystemBase {
|
||||
}
|
||||
|
||||
public Drive() {
|
||||
try {
|
||||
this.swerveDrive = new SwerveParser(swerveJsonDirectory).createSwerveDrive(2);
|
||||
} catch (IOException e) {
|
||||
e.printStackTrace();
|
||||
}
|
||||
AutoBuilder.configureHolonomic(swerveDrive::getPose, swerveDrive::resetOdometry, swerveDrive::getRobotVelocity, swerveDrive::setChassisSpeeds, new HolonomicPathFollowerConfig(
|
||||
new PIDConstants(5,0,0), new PIDConstants(5,0,0), 4.5,
|
||||
0.275,
|
||||
@ -43,11 +48,6 @@ public class Drive extends SubsystemBase {
|
||||
}
|
||||
return false;
|
||||
}, this);
|
||||
try {
|
||||
this.swerveDrive = new SwerveParser(swerveJsonDirectory).createSwerveDrive(2);
|
||||
} catch (IOException e) {
|
||||
e.printStackTrace();
|
||||
}
|
||||
}
|
||||
|
||||
public SwerveModulePosition[] distance(){
|
||||
|
Reference in New Issue
Block a user