--- /dev/null
+package org.usfirst.frc.team3501.robot.commands.driving;
+
+import org.usfirst.frc.team3501.robot.Robot;
+
+public class SlaveWheel {
+
+ // Left motor and wheel(s) are Master, right motor and wheel(s) are slave
+
+ double masterVal = Robot.getDriveTrain().getLeftSpeed();
+ double slaveVal = Robot.getDriveTrain().getRightSpeed();
+
+ double distL, distR;
+
+ double error = 0;
+ double k = 0.1;
+
+ public double calculateError() {
+ distL = Robot.getDriveTrain().getLeftEncoderDistance();
+ distR = Robot.getDriveTrain().getRightEncoderDistance();
+ error = distL - distR;
+ return error;
+ }
+
+ // repeat every 20 milliseconds?
+
+}