driveTrain.getGyroController().setConstants(gyroP, gyroI, gyroD);
Scheduler.getInstance().add(new DriveDistance(Setpoint, Speed));
+
}
@Override
public void autonomousPeriodic() {
Scheduler.getInstance().run();
- DriveTrain.getDriveTrain().getDriveController().setConstants(
}