/** This function is called periodically during autonomous */
public void autonomousPeriodic() {
if (AUTONOMOUS_ENABLED) {
Autonomous.updateAutonomous();
}
// updates data to the driverstation, such as println
driverstation.sendData();
}
/** This function is called periodically during operator control */
public void teleopPeriodic() {
// Read driverstation inputs
driverstation.readInputs();
// Branch based on mode
if (driverstation.JoystickDriverCalibrate) {
driverstation.println("Mode: Calibrate", 1);
updateCalibrateControl();
} else {
driverstation.println("Mode: Drive", 1);
updateDriveControl();
updateNavigatorControl();
// compressor.update();
}
// Send printed data to driverstation
driverstation.sendData();
}
