/** 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();
    }
  }