/** This function is called periodically during operator control */
public void teleopPeriodic() {
Scheduler.getInstance().run();
drivetrain.smartDashboardPush();
purpleSensor.smartDashboardPush();
gripper.smartDashboardPush();
elevator.smartDashboardPush();
}
public void disabledPeriodic() {
Scheduler.getInstance().run();
purpleSensor.smartDashboardPush();
drivetrain.smartDashboardPush();
gripper.smartDashboardPush();
elevator.smartDashboardPush();
if (drivetrain.getResetButton() && !drivetrain.isResetDisabled()) {
drivetrain.resetEncoders();
purpleSensor.zeroHeading();
}
}