Robot is running even it is suppose to stay put for initialization of gyroscope. Is there a way to initialize the gyroscope without spending precious time of 2 seconds in pre Auton? But the main problem really is that the robot is moving ahead even if it is suppose to wait until gyroscope is done calibrating.
void vexcodeInit( void ) {
Brain.Screen.print(“Device initialization…”);
Brain.Screen.setCursor(2, 1);
// calibrate the drivetrain gyro
wait(200, msec);
TurnGyroSmart.calibrate();
Brain.Screen.print(“Calibrating Gyro for Drivetrain”);
// wait for the gyro calibration process to finish
while (TurnGyroSmart.isCalibrating()) {
wait(25, msec);
}
// reset the screen now that the calibration is complete
Brain.Screen.clearScreen();
Brain.Screen.setCursor(1,1);
wait(50, msec);
Brain.Screen.clearScreen();
}
void pre_auton(void) {
// Initializing Robot Configuration. DO NOT REMOVE!
vexcodeInit();
// All activities that occur before the competition starts
// Example: clearing encoders, setting servo positions, …
}
int main() {
// Run the pre-autonomous function.
pre_auton();
// Set up callbacks for autonomous and driver control periods.
Competition.autonomous(autonomous);
Competition.drivercontrol(usercontrol);
// Prevent main from exiting with an infinite loop.
while (true) {
wait(50, msec);
}
}