I don't think your Autonomous section is doing what you want. The two while loops:
Quote:
while(topMicro.get() == true) {
rollMotor = 0.4;
}
while(bottomMicro.get() == true) {
rollMotor = 0.4;
}
|
These don't actually set the motor speed during autonomous, they only set your local double variables. In fact, I don't see anywhere in the autonomous code where you actually send the values to the motors.
You're probably starting up in Autonomous and seeing nothing happen (because no motors are set to actual values). You are also likely getting stuck in the loops above.
In teleop, I see a similar while loop:
Quote:
while(i<3) {
rollMotor = 0.4;
if (topMicro.get() == true) {
i++;
}
}
|
Again, this doesn't actually send the rollMotor value to the motor - you set the local double variable, but are stuck in the loop because i never increments - you don't ever get down to the point where you send values to the controller.
It's very important to watch how you use loops when dealing with this robot code!
Edit: oops... didn't notice that c never changed from 0... I guess you won't hit those loops!