diff --git a/.gradle/5.0/fileChanges/last-build.bin b/.gradle/5.0/fileChanges/last-build.bin new file mode 100644 index 0000000..f76dd23 Binary files /dev/null and b/.gradle/5.0/fileChanges/last-build.bin differ diff --git a/.gradle/5.0/fileHashes/fileHashes.lock b/.gradle/5.0/fileHashes/fileHashes.lock new file mode 100644 index 0000000..0267d29 Binary files /dev/null and b/.gradle/5.0/fileHashes/fileHashes.lock differ diff --git a/.gradle/5.0/gc.properties b/.gradle/5.0/gc.properties new file mode 100644 index 0000000..e69de29 diff --git a/.gradle/5.0/taskHistory/taskHistory.bin b/.gradle/5.0/taskHistory/taskHistory.bin new file mode 100644 index 0000000..b78194e Binary files /dev/null and b/.gradle/5.0/taskHistory/taskHistory.bin differ diff --git a/.gradle/5.0/taskHistory/taskHistory.lock b/.gradle/5.0/taskHistory/taskHistory.lock new file mode 100644 index 0000000..7107d2c Binary files /dev/null and b/.gradle/5.0/taskHistory/taskHistory.lock differ diff --git a/.gradle/buildOutputCleanup/buildOutputCleanup.lock b/.gradle/buildOutputCleanup/buildOutputCleanup.lock new file mode 100644 index 0000000..dd1db5d Binary files /dev/null and b/.gradle/buildOutputCleanup/buildOutputCleanup.lock differ diff --git a/.gradle/buildOutputCleanup/cache.properties b/.gradle/buildOutputCleanup/cache.properties new file mode 100644 index 0000000..2194bd8 --- /dev/null +++ b/.gradle/buildOutputCleanup/cache.properties @@ -0,0 +1,2 @@ +#Sat Jan 19 11:45:29 MST 2019 +gradle.version=5.0 diff --git a/.gradle/vcs-1/gc.properties b/.gradle/vcs-1/gc.properties new file mode 100644 index 0000000..e69de29 diff --git a/.wpilib/wpilib_preferences.json b/.wpilib/wpilib_preferences.json new file mode 100644 index 0000000..6639f9b --- /dev/null +++ b/.wpilib/wpilib_preferences.json @@ -0,0 +1,6 @@ +{ + "currentLanguage": "java", + "enableCppIntellisense": false, + "projectYear": "none", + "teamNumber": 4388 +} \ No newline at end of file diff --git a/2019robot/src/main/java/org/usfirst/frc4388/robot/subsystems/Drive.java b/2019robot/src/main/java/org/usfirst/frc4388/robot/subsystems/Drive.java index 2c65d1f..d2df606 100644 --- a/2019robot/src/main/java/org/usfirst/frc4388/robot/subsystems/Drive.java +++ b/2019robot/src/main/java/org/usfirst/frc4388/robot/subsystems/Drive.java @@ -38,6 +38,7 @@ import com.ctre.phoenix.motorcontrol.NeutralMode; import com.kauailabs.navx.frc.AHRS; import com.revrobotics.CANEncoder; +import com.revrobotics.CANPIDController; import com.revrobotics.CANSparkMax; import com.revrobotics.CANSparkMaxLowLevel.MotorType; @@ -93,7 +94,7 @@ public class Drive extends Subsystem implements ControlLoopable public static final double MP_MAX_TURN_T2 = 200; // Motor controllers - private ArrayList motorControllers = new ArrayList(); + private ArrayList motorControllers = new ArrayList(); private CANSparkMax leftDrive1; private CANSparkMax leftDrive2; @@ -264,11 +265,12 @@ public class Drive extends Subsystem implements ControlLoopable rightDrive2.setNeutralMode(NeutralMode.Brake); rightDrive2.set(ControlMode.Follower, rightDrive1.getDeviceID()); - + leftPIDController = new CANPIDController(leftDrive1); + rightPIDController = new CANPIDController(rightDrive1); - motorControllers.add(leftDrive1); - motorControllers.add(rightDrive1); + motorControllers.add(leftPIDController); + motorControllers.add(rightPIDController); //m_drive = new RobotDrive(leftDrive1, rightDrive1); //m_drive.setInvertedMotor(RobotDrive.MotorType.kRearLeft, true); @@ -757,14 +759,16 @@ public class Drive extends Subsystem implements ControlLoopable } @Override + public void setPeriodMs(long periodMs) { + /* mpStraightController = new MPTalonPIDController(periodMs, mpStraightPIDParams, motorControllers); mpTurnController = new MPSoftwarePIDController(periodMs, mpTurnPIDParams, motorControllers); pidTurnController = new SoftwarePIDController(pidTurnPIDParams, motorControllers); mpPathController = new MPTalonPIDPathController(periodMs, mpPathPIDParams, motorControllers); mpPathVelocityController = new MPTalonPIDPathVelocityController(periodMs, mpPathVelocityPIDParams, motorControllers); adaptivePursuitController = new AdaptivePurePursuitController(periodMs, adaptivePursuitPIDParams, motorControllers); - + */ this.periodMs = periodMs; }