package org.usfirst.frc.team3501.robot.commands.driving;
-import org.usfirst.frc.team3501.robot.MathLib;
import org.usfirst.frc.team3501.robot.Robot;
import org.usfirst.frc.team3501.robot.subsystems.DriveTrain;
import org.usfirst.frc.team3501.robot.utils.PIDController;
private double driveI;
private double driveD;
- public DriveDistance(double distance, double maxTimeOut) {
+ public DriveDistance(double distance, double motorVal) {
requires(driveTrain);
this.maxTimeOut = maxTimeOut;
this.target = distance;
- private double target;
- private double gyroP;
- private double gyroI;
- private double gyroD;
-
- private double driveP;
- private double driveI;
- private double driveD;
-
- public DriveDistance(double distance, double motorVal) {
- requires(driveTrain);
this.driveP = driveTrain.driveP;
this.driveI = driveTrain.driveI;
this.driveD = driveTrain.driveD;
driveTrain.printEncoderOutput();
// System.out.println("turn: " + xVal);
- double leftDrive = MathLib.calcLeftTankDrive(-xVal, yVal);
- double rightDrive = MathLib.calcRightTankDrive(xVal, -yVal);
-
- this.driveTrain.setMotorValues(leftDrive, rightDrive);
-
- System.out.println(driveTrain.getAvgEncoderDistance());
- // System.out.println("motorval: " + yVal);
}
@Override