import edu.wpi.first.wpilibj.IterativeRobot;
import edu.wpi.first.wpilibj.command.Scheduler;
+import edu.wpi.first.wpilibj.smartdashboard.SmartDashboard;
public class Robot extends IterativeRobot {
private static DriveTrain driveTrain;
@Override
public void autonomousInit() {
driveTrain.setHighGear();
+ SmartDashboard.putNumber("I", -1);
}
@Override
public void autonomousPeriodic() {
Scheduler.getInstance().run();
+ DriveTrain.getDriveTrain().getDriveController().setConstants(
}
import edu.wpi.first.wpilibj.command.Subsystem;
public class DriveTrain extends Subsystem {
- public static double driveP = 0.012, driveI = 0.0011, driveD = -0.002;
+
+ public static double driveP, driveI, driveD;
public static double turnP = 0.004, turnI = 0.0013, turnD = -0.005;
public static double driveStraightGyroP = 0.01;