Scheduler.getInstance().add(new DriveDistance(Setpoint, Speed));
+ SmartDashboard.putNumber(Constants.DriveTrain.P_Val, 0);
+ SmartDashboard.putNumber(Constants.DriveTrain.I_Val, 0);
+ SmartDashboard.putNumber(Constants.DriveTrain.D_Val, 0);
+ SmartDashboard.putNumber(Constants.DriveTrain.TARGET_DIST, 50);
+ SmartDashboard.putNumber(Constants.DriveTrain.MOTOR_VAL, 0.5);
+
}
@Override