My team is having difficulties with running our autonomous program. The issue is that one version of our autonomous is not running properly, and instead of going forward and picking up cubes, it simply moves our cube tray forward one inch and stops. A safer version of our autonomous that we have been running has been functioning properly, where all it does is go forward and come back. We have inspected the file, and cannot determine what the problem in our newer autonomous is. Does anyone have a solution for this issue? Thank you in advance.
This is our autonomous program.
void autonomous(void) {
// User control code here, inside the loop
RightArm.rotateFor(360, rotationUnits::deg, 95, velocityUnits::pct, false);
LeftArm.rotateFor(-360, rotationUnits::deg, 95, velocityUnits::pct);
RightArm.rotateFor(-360, rotationUnits::deg, 75, velocityUnits::pct, false);
LeftArm.rotateFor(360, rotationUnits::deg, 75, velocityUnits::pct);
RightChassis.rotateFor(-360, rotationUnits::deg, 50, velocityUnits::pct, false);
LeftChassis.rotateFor(360, rotationUnits::deg, 50, velocityUnits::pct, false);
RightIntake.rotateFor(-1400, rotationUnits::deg, 70, velocityUnits::pct, false);
LeftIntake.rotateFor(1400, rotationUnits::deg, 70, velocityUnits::pct);
//right - left +
RightChassis.rotateFor(225, rotationUnits::deg, 50, velocityUnits::pct, false);
LeftChassis.rotateFor(225, rotationUnits::deg, 50, velocityUnits::pct);
RightChassis.rotateFor(-380, rotationUnits::deg, 50, velocityUnits::pct, false);
LeftChassis.rotateFor(380, rotationUnits::deg, 50, velocityUnits::pct, false);
RightIntake.rotateFor(-1700, rotationUnits::deg, 70, velocityUnits::pct, false);
LeftIntake.rotateFor(1700, rotationUnits::deg, 70, velocityUnits::pct);
//RightChassis.rotateFor(225, rotationUnits::deg, 50, velocityUnits::pct, false);
//LeftChassis.rotateFor(225, rotationUnits::deg, 50, velocityUnits::pct);
}