package org.usfirst.frc.team3501.robot;
+import org.usfirst.frc.team3501.robot.commands.driving.DriveDistance;
import org.usfirst.frc.team3501.robot.subsystems.DriveTrain;
import org.usfirst.frc.team3501.robot.subsystems.Intake;
import org.usfirst.frc.team3501.robot.subsystems.Shooter;
SmartDashboard.putNumber(Constants.DriveTrain.P_Val, -1);
SmartDashboard.putNumber(Constants.DriveTrain.I_Val, -1);
SmartDashboard.putNumber(Constants.DriveTrain.D_Val, -1);
+ SmartDashboard.putNumber(Constants.DriveTrain.TARGET_DIST, 50);
}
double P = SmartDashboard.getNumber(Constants.DriveTrain.P_Val, -1);
double I = SmartDashboard.getNumber(Constants.DriveTrain.I_Val, -1);
double D = SmartDashboard.getNumber(Constants.DriveTrain.D_Val, -1);
+
+ double SETPOINT = SmartDashboard.getNumber(Constants.DriveTrain.TARGET_DIST,
+ -1);
+
DriveTrain.getDriveTrain().getDriveController().setConstants(P, I, D);
+
+ new DriveDistance(SETPOINT, 0.5).start();
}
@Override